Create repo

README.md

@@ -0,0 +1 @@
+A repository for our robot in the MRC Robotex Cyprus Rally competition. The robot uses the motor2040 controller and 2 micrometal gearmotors, with encoders attached in order to measure the distance travelled.

sensortest-rally.py

@@ -0,0 +1,14 @@
+import time
+import board
+import adafruit_hcsr04
+
+# Set the sensor pins
+sonar = adafruit_hcsr04.HCSR04(trigger_pin=board.TRIG, echo_pin=board.ECHO)
+
+while True:
+    try:
+        print(f"{sonar.distance:.2f}")
+
+    except RuntimeError:
+        print("Retrying!")
+        time.sleep(0.1)