   }
 
   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;

  wait++;
  if (wait > 5000) {
    Serial.println("SENRB0" + String(ROBOT_ID) + "HB");
    robot.cycle();
    wait = 0;
  }
}
