Know turn behaviour for chapter 12.

2022-10-09 22:33:18 +01:00
parent 07f3f3c96e
commit 1b8533b459
6 changed files with 264 additions and 25 deletions
@@ -67,3 +67,8 @@ def set_left(speed):

 def set_right(speed):
    set_speed(right_motor, speed)
+
+def check_imu_status():
+  sys_status, gyro, accel, mag = imu.calibration_status
+  uart.write(f"Sys: {sys_status}, Gyro: {gyro}, Accel: {accel}, Mag: {mag}\n".encode())
+  return sys_status == 3