 {
   p(F("MANUAL: %d, L %03d, F %03d, R %03d, dir %03d, speed %03d, left_mapped %03d, right_mapped %03d"),
     manual_control, dist_l, dist_f, dist_r, dir, speed, left_mapped, right_mapped);
-}+}

      map(speed, 0, 255, right_zero, right_rw_max),
      right_zero,
      map(speed, 0, 255, right_zero, right_fwd_max));

  }
  else
  {

#include <Servo.h>
#include <Metro.h>
//#define Serial Serial1
#include <ResponsiveAnalogRead.h>

#include <stdarg.h>
void p(char *fmt, ... ){
