32 lines
1.1 KiB
Python
32 lines
1.1 KiB
Python
import java.util.logging.Level
|
|
|
|
def get_pos_str():
|
|
return "point: " + str(robot.get_current_point()) + " - here: " + str(robot.here()) + " - herej: " + str(robot.herej())
|
|
|
|
enable_motion()
|
|
|
|
get_context().setLogLevel(java.util.logging.Level.FINER)
|
|
try:
|
|
while True:
|
|
#robot.move_dewar()
|
|
#robot.move_park()
|
|
|
|
log("Moving dewar", False)
|
|
flag = robot.start_task('moveDewar')
|
|
print "moveDewar: ", flag
|
|
log("Waiting", False)
|
|
ret = robot.wait_task_finished(TASK_WAIT_ROBOT_POLLING)
|
|
log("Moving dewar finished (" + str(ret) + ") - pos: " + get_pos_str(), False)
|
|
robot.assert_dewar()
|
|
|
|
|
|
log("Moving park", False)
|
|
flag = robot.start_task('movePark')
|
|
print "movePark: ", flag
|
|
log("Waiting", False)
|
|
ret = robot.wait_task_finished(TASK_WAIT_ROBOT_POLLING)
|
|
log("Moving park finished (" + str(ret) + ") - pos: " + get_pos_str(), False)
|
|
robot.assert_park()
|
|
|
|
finally:
|
|
get_context().setLogLevel(java.util.logging.Level.INFO) |