from argparse import ArgumentParser
from time import sleep
from frankx import Affine, Robot
if __name__ == '__main__':
parser = ArgumentParser()
parser.add_argument('--host',
default='172.16.0.2',
help='FCI IP of the robot')
args = parser.parse_args()
robot = Robot(args.host)
robot.set_default_behavior()
while True:
state = robot.read_once()
print('\nPose: ', robot.current_pose())
print('O_TT_E: ', state.O_T_EE)
print('Joints: ', state.q)
print('Elbow: ', state.elbow)
sleep(0.05)
from argparse import ArgumentParser
from time import sleep
from frankx import Affine, Robot
if __name__ == '__main__':
parser = ArgumentParser()
parser.add_argument('--host',
default='172.16.0.2',
help='FCI IP of the robot')
args = parser.parse_args()
robot = Robot(args.host)
robot.set_default_behavior()
while True:
print('Pose: ', robot.current_pose())
print('Elbow: ', robot.read_once().elbow)
sleep(0.05)
import time
import numpy as np
from frankx import Affine, Robot
if __name__ == '__main__':
robot = Robot("172.16.0.2")
robot.set_default_behavior()
while True:
print(robot.current_pose())
print(robot.read_once().elbow)
time.sleep(0.05)