     analogWrite(R_FORWARD, 0);
     analogWrite(R_REVERSE, 0);
 }
+
+void log(String message) {
+    if (DEBUG) {
+        Serial.print(message);
+    }
+}
const float RL_SCALE = 0.75;

const int R_FORWARD = 3;
const int R_REVERSE = 5;

                char* direction = strtok(NULL, ",");
                int speed = atoi(strtok(NULL, ","));

                drive(direction, speed);
            }
            else if (strcmp(token, "stop") == 0) {
                stop();
            }
            else {
                log("Bad command");
            }

            // Clear buffer
