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)