 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;

    map(dir, 0, 90, 100, 0),
    right_rw_max, right_zero, right_fwd_max);

  if (debug_out.check() == 1)
  {
    p(F("L %03d, F %03d, R %03d, left_mapped %03d, right_mapped %03d"),
      dist_l, dist_f, dist_r, left_mapped, right_mapped);
  }

  wheel_right.write(right_mapped);
  wheel_left.write(left_mapped);
