script/test/TestCameraStability2.py

@@ -1,11 +1,14 @@
-cover_detection_debug=False
-
-for pos in ['A', 'B', 'C', 'D', 'E', 'F']:
-    print "Moving to ", pos
-    hexiposi.move(pos)
-    ret =  run("imgproc/CoverDetection")
-    det =  ret[0]
-    print "Detected: ", det
-    if det != pos:
-        raise "Position error"
+cover_detection_debug=True
+while True:
+    for pos in ['A', 'B', 'C', 'D', 'E', 'F']:
+        print "Moving to ", pos
+        hexiposi.move(pos)
+        move_home()
+        move_park()
+        time.sleep(2.0)
+        ret =  run("imgproc/CoverDetection")
+        det =  ret[0]
+        print "Detected: ", det
+        if det != pos:
+            raise Exception("Position error")