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')
def turn_off_currents(duration):
tampy = Tampy()
# tampy.camera_launch()
tampy.servo_on()
tampy.start_currents()
tampy.start_timer()
tampy.log_buf(duration)
motion_time = 700.00
joint_angle = 0.0
for id in range(7):
tampy.start_currents(joint_id=id)
tampy.move_currents([0.0] * 7,
joint_id=id,
duration=duration,
motion_time=duration)
tampy.servo_off()