Update wbTest.py

clubrobot · Jun 1, 2024 · 1bf1ed8 · 1bf1ed8
1 parent ddf03f5
commit 1bf1ed8
Showing 1 changed file with 6 additions and 5 deletions.
diff --git a/raspberrypi/tests/wbTest.py b/raspberrypi/tests/wbTest.py
@@ -32,9 +32,10 @@
 print("Sensors:",sensors)
 
 wheeledbase.start_match()
-wheeledbase.goto_stop(0,0, sensors,theta=-math.pi/2)
-time.sleep(1)
 wheeledbase.set_position(1000,1000,0)
-wheeledbase.goto_stop(1000,1000, sensors,theta=0)
-while 1:
-    print(wheeledbase.get_position(),sensors.get_all_sensors())
+wheeledbase.goto_stop(1000,1000, sensors,theta=-math.pi/2)
+time.sleep(1)
+
+#wheeledbase.goto_stop(1000,1000, sensors,theta=0)
+#while 1:
+#    print(wheeledbase.get_position(),sensors.get_all_sensors())