Update wbTest.py

clubrobot · Jun 1, 2024 · 9564b27 · 9564b27
1 parent e036e22
commit 9564b27
Showing 1 changed file with 4 additions and 2 deletions.
diff --git a/raspberrypi/tests/wbTest.py b/raspberrypi/tests/wbTest.py
@@ -18,7 +18,7 @@
 #wheeledbase.goto_stop(10,0,np.pi)
 #time.sleep(90)
 
-for i in range(100):
+for i in range(1):
     sen=sensors.get_all_sensors()
     detect=np.sum(np.array(sen)<5)>5
 
@@ -32,6 +32,8 @@
 print("Sensors:",sensors)
 
 wheeledbase.start_match()
-wheeledbase.goto_stop(500,0, sensors)
+wheeledbase.goto_stop(0,0, sensors,theta=-math.pi/2)
+time.sleep(1)
+wheeledbase.goto_stop(0,0, sensors,theta=0)
 while 1:
     print(wheeledbase.get_position(),sensors.get_all_sensors())