 // A small helper
 void error(const __FlashStringHelper*err) {
   #ifdef BLUETOOTH
-    bluetooth.println(err);
+    Serial1.println(err);
   #else
     Serial.println(err);
   #endif

};

int moduleJob;
//static SoftwareSerial1 Serial1{Serial1_TX, Serial1_RX};
HardwareSerial bluetooth = Serial1;


int moveServo(int servo, int from, int to, int s) {
  if (to > from) {


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