 #include <Servo.h>
+#include "ForceStopVehicle.h"
 #include "LimitSwitch.h"
+#include "ForceStopVehicle.h"
+#include "Hardware.h"
+#include "Vehicle.h"
+#include "AllStates.h"
 
 //////// Pins //////// 
-#define ELEVATOR_SWITCH_PIN     38
-#define DOOR_SWITCH_PIN         36
+#define ELEVATOR_SWITCH_PIN     34
 #define BAG_SWITCH_PIN          32
-#define ELEVATOR_PIN            9
-#define DOOR_PIN                10
+#define DRILL_PIN               11
+#define ELEVATOR_PIN            10
 #define CONVEYOR1_PIN           6
-#define CONVEYOR2_PIN           7
+#define CONVEYOR2_PIN           4
+#define CONVEYOR2_MOTOR_PIN     9
 
 //////// PWM //////// 
 #define CONVEYOR_RUN   1400

      }
      conveyor2.writeMicroseconds(CONVEYOR_RUN);
    }
  }
}


//////// Variables //////// 
LimitSwitch elevatorSwitch(ELEVATOR_SWITCH_PIN);
Servo conveyor1;
Servo conveyor2;

