script/test/TestCmdSynchronization.py

@@ -1,5 +1,32 @@
-enable_motion()
-while True:
+import java.util.logging.Level
 
-    robot.move_dewar_wait()
-    robot.move_park()
+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_wait()
+    #robot.move_park()
+
+        log("Moving dewar", False)
+        flag = robot.start_task('moveDewar')  
+        print "moveDewar: ", flag        
+        log("Waiting", False)
+        robot.wait_task_finished(TASK_WAIT_ROBOT_POLLING)            
+        log("Moving dewar finished - " + get_pos_str(), False)        
+        robot.assert_dewar_wait()
+
+
+        log("Moving park", False)
+        flag = robot.start_task('movePark')  
+        print "movePark: ", flag
+        log("Waiting", False)
+        robot.wait_task_finished(TASK_WAIT_ROBOT_POLLING)    
+        log("Moving park finished - " + get_pos_str(), False)     
+        robot.assert_park()    
+
+finally:
+    get_context().setLogLevel(java.util.logging.Level.INFO)