   Serial.begin(115200);
   delay(1000);
   Serial.println("All power to the engines!");
-  tank.init();
+
 }
 
 void loop() {
-  if (DEBUG_MODE) {
+  if (COM_DEBUG_MODE) {
     Serial.print(".");
   }
   Usb.Task();

USBHost Usb;
ADK adk(&Usb, manufacturer, model, accessoryName, versionNumber, url, serialNumber);
// End ADK configuration
bool DEBUG_MODE = true;

uint8_t inBuffer[BUFFSIZE];
uint8_t outBuffer[BUFFSIZE];
char inStringBuffer[BUFFSIZE];
char outStringBuffer[BUFFSIZE];
uint32_t bytesRead = 0;

DualMC33926MotorShield tank;

// Test Variabiles
int randomint;

    last_send = time;
    randomint = random(-1500, 1500);
    memset(outStringBuffer, 0, BUFFSIZE);
    sprintf(outStringBuffer, "%d,%d,%d", command, param1, param2);
    memcpy(outBuffer, outStringBuffer, BUFFSIZE);
    adk.write(strlen(outStringBuffer), outBuffer);
    if (COM_DEBUG_MODE) {
      Serial.print("\nSending | ");
      Serial.print(outStringBuffer);
      Serial.print(" | ");
