 
   wait++;
   if (wait > 5000) {
-//    warby.getYaw();
-//    warby.setHeading(0, 300);
-//    warby.rotate(-100.0);
-//    warby.rotateSpecific(45.00);
+    Serial.println("SENRB0" + String(ROBOT_ID) + "HB");
     warby.cycle();
     wait = 0;
   }

#include "Robot.h"

#define LOGGING 1


bool bufDone;

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

  bufLen = 0;
