Working IMU with polling

main/motors.h

@@ -0,0 +1,19 @@
+#pragma once
+
+#include <stdint.h>
+
+#define MOTOR1_FWD_PIN 4
+#define MOTOR1_BAK_PIN 5
+#define MOTOR2_FWD_PIN 6
+#define MOTOR2_BAK_PIN 7
+
+typedef enum {
+    MOTOR1,
+    MOTOR2,
+} motor_t;
+
+typedef int8_t percentile_t;
+
+void init_motors();
+void set_motor(motor_t motor, percentile_t percentile);
+void set_motors(percentile_t left, percentile_t right);