 int motorSpeed = 100;
 bool isMovingForward = false;
 bool isMovingBackward = false;
+bool safetyDriveMode = true;
 
 String input = "";
   

  if(command == "battery") {
    result = checkBatteryStatus(argument);
  } else if(command == "distance") {
    result = getDistance(argument);
  } else if(command == "forward") {
    result = forward(argument);
  } else if(command == "backward") {

#include <AFMotor.h>
#include <NewPing.h>

#define runEvery(t) for (static typeof(t) _lasttime;\
                         (typeof(t))((typeof(t))millis() - _lasttime) > (t);\
                         _lasttime += (t))

AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
