 #include <SPI.h>
 #include <Wire.h>
 #include <Adafruit_PWMServoDriver.h>
-
-//#define BLUETOOTH
-#define SERIAL_TX 1
-#define SERIAL_RX 0
 
 //Servo Ports
 #define SERVO_TURN 0    //Turn Servo


// Handle API commands
void handleApiCommands(String command) {
  //sendBT(command);
  if (command.startsWith("pickup(0)")) {
    moduleJob = JOB_PICKUP_BACK;
  }

  if (command.startsWith("drop(1)")) {
    moduleJob = JOB_DROP_FRONT;
  }
  if (command.startsWith("initPosition(1)")) {
    moduleJob = JOB_IDLE;
  }
}

// Listen to incomminc commands from BLUETOOTH
void listenBT() {
  String buffer = "";
  #ifdef BLUETOOTH
    if (Serial1.available()) {
      buffer = Serial1.readStringUntil('\n');
    }
  #else
    if (Serial.available()) {
