Update wbTest.py

clubrobot · Jun 1, 2024 · b389274 · b389274
1 parent 852a937
commit b389274
Showing 1 changed file with 8 additions and 1 deletion.
diff --git a/raspberrypi/tests/wbTest.py b/raspberrypi/tests/wbTest.py
@@ -19,11 +19,18 @@
 #time.sleep(90)
 
 for i in range(100):
-    print(i,sensors.get_all_sensors())
+    sen=sensors.get_all_sensors()
+    detect=np.sum(sen<0)>5
+
+    print(i,sensors.get_all_sensors(),detect)
+    if(detect):
+        print("RESET-------------------")
+        sensors = Sensors()
     time.sleep(1)
 
 print("BONNE ANN2e")
 print("Sensors:",sensors)
+
 wheeledbase.start_match()
 wheeledbase.goto_stop(500,0, sensors)
 while 1: