 int speed = 0;
 int dir = 0;
 
+Metro debug_out = Metro(100);
+
 void setup() {
   pinMode(13, OUTPUT);
   digitalWrite(13, HIGH);

#include <Servo.h>

#define STOP_BUTTON 1
#define DOWN_BUTTON 0
#define UP_BUTTON 2

#define DIST_IN_F 19
int dist_f = 0;
#define DIST_IN_L 20
int dist_l = 0;
#define DIST_IN_R 18
int dist_r = 0;

  wheel_left.attach(MOTOR_OUT_L);
  wheel_right.attach(MOTOR_OUT_R);

  // pinMode(STOP_BUTTON, INPUT_PULLUP);
  // pinMode(DOWN_BUTTON, INPUT_PULLUP);
  // pinMode(UP_BUTTON, INPUT_PULLUP);

  Serial.begin(115200);
}

void loop() {
