 
 void CheckCommandTimeout()
 {
-  if (cmdTimeout == 0) return;
   commandTime = millis();
   if (commandTime >= lastCommandTime) commandTime -= lastCommandTime; else lastCommandTime = 0;
   if (commandTime > cmdTimeout) OnDisconnected();

#define RC_RX_PIN 12
#define RC_TX_PIN 11
RoboClaw roboclaw(RC_RX_PIN, RC_TX_PIN);

//
#define AUX_POWER_PIN 7
#define MOTOR_POWER_PIN 8
#define UPS_POWER_PIN 9

// common vars //
unsigned long lastCommandTime;

void battery()
{
  //unsigned int voltage = (unsigned int)roboclaw.ReadMainBatteryVoltage(RC_ADDR, 0);
  int voltage = analogRead(0) * 4.8828;
  Serial.write('B');
  Serial.println(voltage);
}
