 void stopConveyor(){
   driveCounterclockwise(LEFT_CONVEYOR_MOTOR_ID, 0);
   driveCounterclockwise(RIGHT_CONVEYOR_MOTOR_ID, 0);
+  currentConveyorStatus = STOPPED;
 }
 
 void driveWinch(){


  // Open communication with Saberteeth
  Serial3.begin(9600);
  
  stopAllMotors(false);
  //unitTest();


  // Initialize the message
  setupWheelStatus();

 */
void setup(){
  // To start, no motor is moving.
  for(int i = 0; i < 15; ++i)
  {
   motorInMotion[i] = false; 
  }
