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

#define dirC 12

#define BUF_SIZE 125

typedef struct {
  int pulse;

MotorValues motorB;
MotorValues motorC;

Robot robot;

char buf[BUF_SIZE];
int bufLen;
bool bufDone;

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

  bufLen = 0;
  bufDone = false;
