 }
 
 
-
 /**
  * Is called on starting the arduino.
  * 


  stopAllMotors(false);
  //unitTest();

  // Initialize the current wheel status message
  setupWheelStatus();

void unitTestConveyor()
{
  // Test the conveyor:
  // 2s "dumping" / forwards (clockwise), 1s pause, 2s "collecting" / backwards (counterclockwise).

  //driveClockwise(LEFT_CONVEYOR_MOTOR_ID, CONVEYOR_SPEED);
  driveClockwise(RIGHT_CONVEYOR_MOTOR_ID, CONVEYOR_SPEED);
  delaySeconds(2);
  driveClockwise(RIGHT_CONVEYOR_MOTOR_ID, CONVEYOR_SPEED);
  delaySeconds(1);
  //driveCounterclockwise(LEFT_CONVEYOR_MOTOR_ID, CONVEYOR_SPEED);
  driveCounterclockwise(RIGHT_CONVEYOR_MOTOR_ID, CONVEYOR_SPEED);
  delaySeconds(2);
  //driveCounterclockwise(LEFT_CONVEYOR_MOTOR_ID, 0);
  driveCounterclockwise(RIGHT_CONVEYOR_MOTOR_ID, 0);
  delaySeconds(1);
  
}

