   else pulsePin(MOTOR_DISABLE_PIN, 20);
 }
   
-void CheckDriveCommandTimeout()
-{
-  if (driveCommandTimeout == 0) return;
+void checkDriveCommandTimeout()
+{
   unsigned long driveCommandTime = millis();
   if (driveCommandTime >= lastDriveCommandTime) driveCommandTime -= lastDriveCommandTime; else lastDriveCommandTime = 0;
-  if (driveCommandTime > driveCommandTimeout) driveEnable(false);
+  if (driveCommandTime > DRIVE_COMMAND_TIMEOUT) driveEnable(false);
 }
 
 //=======================================

byte motor_increment = 5;
unsigned int motor_counter = 0;

// servo controller
BMSerial ssc(SSC_RX_PIN, SSC_TX_PIN);
MiniMaestro maestro(ssc);


      tm.displayString("CONN");
      tmMode = 0;
    }
  }
}

void displayVolts()
{
  int voltage = int(ina219.getBusVoltage_V() * 100);
  displayInt(voltage, 2);
}

void displayAmps()
{
  int mA = abs(int(getAvgAmps()));
  displayInt(mA, 1);
}

