def move_teach(duration):
tampy = Tampy()
# original
Pipe = [-1.24, -8.16, -4.30, 68.21, -17.01, 59.76, 0.03]
Trumpet = [-0.46, -19.55, 14.36, 78.28, 2.73, 60.06, 0.01]
# mod to min singularity of joint 6
Pipe = [-1.24, -8.16, -4.30, 68.21, -17.01, 39.76, 0.03]
Trumpet = [-0.46, -19.55, 14.36, 78.28, 2.73, 30.06, 0.01]
tampy.servo_on()
each_time = 5.00
motion_time = 10.00
joint_angle = 0.0
tampy.start_joints()
tampy.log_buf(duration)
tampy.start_timer()
tampy.move_joints(Pipe,
each_time=each_time,
motion_time=motion_time,
duration=duration)
move_reset()
def reset_error():
try:
tampy = Tampy()
except ToroboException as e:
while True:
if fix_joint_angle_limit(e.tampy):
tampy = e.tampy
break
tampy.camera_launch()
tampy.servo_on()
tampy.start_joints()
tampy.log_buf(duration=5.0)
tampy.start_timer()
tampy.move_joints([0.0] * 7, each_time=5.0, duration=5.0, motion_time=5.0)
tampy.servo_off()
print('done')