   }
 
   if (bufDone) {
-    Serial.print("buf: ");
-    Serial.write(buf, bufLen);
-    Serial.println();
+    // Serial.print("buf: ");
+    // Serial.write(buf, bufLen);
+    // Serial.println();
     handleMessage(buf);
 
     bufDone = false;


  wait++;
  if (wait > 5000) {
//    warby.getYaw();
//    warby.setHeading(0, 300);
//    warby.rotate(-100.0);
//    warby.rotateSpecific(45.00);
    warby.cycle();
    wait = 0;
  }

bool bufDone;

void setup() {
  warby = Robot(ROBOT_ID, dirA, pwmA, dirB, pwmB, dirC, pwmC, true);
  warby.stop();

  bufLen = 0;
