   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);
+  // pinMode(STOP_BUTTON, INPUT_PULLUP);
+  // pinMode(DOWN_BUTTON, INPUT_PULLUP);
+  // pinMode(UP_BUTTON, INPUT_PULLUP);
 
-  Serial.begin(9600);
+  Serial.begin(115200);
 }
 
 void loop() {

#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;

int speed = 0;
int dir = 0;

Metro debug_out = Metro(100);

void setup() {
  pinMode(13, OUTPUT);
  digitalWrite(13, HIGH);
