Files
X06SA/script/motion/trash.py
2021-05-27 18:03:21 +02:00

43 lines
828 B
Python

def trash():
"""
"""
print "trash"
if robot.simulated:
time.sleep(3.0)
return
#Initial checks
robot.assert_no_task()
robot.reset_motion()
robot.wait_ready()
robot.assert_cleared()
#robot.assert_in_known_point()
was_cold = robot.is_cold()
#Enabling
enable_motion()
robot.move_gonio()
robot.get_gonio()
robot.move_heater(to_bottom = False)
robot.move_heater(to_bottom = True)
try:
for i in range(3):
robot.open_tool()
time.sleep(0.5)
robot.close_tool()
time.sleep(0.5)
finally:
robot.open_tool()
robot.move_heater(to_bottom = False)
if was_cold:
robot.move_cold()
else:
robot.move_home()