 #define BR_MOTOR_OUT_PIN 7
 
 //define Servo variables
-Servo FL_MOTOR;
-Servo FR_MOTOR;
-Servo BL_MOTOR;
-Servo BR_MOTOR;
+Servo MOTOR[SERVO_NUM];
 
 void setup()
 {

  else {
    //short read from master
    //Do nothing
    Serial.println("short read from master");
    Serial.print("Expected 8 bytes");
    Serial.print("Received");
    Serial.print(byteCount);
    Serial.print("bytes");
  }

  //Update servo values
  FL_MOTOR.writeMicroseconds(b[0]);
  FR_MOTOR.writeMicroseconds(b[1]);
  BL_MOTOR.writeMicroseconds(b[2]);
  BR_MOTOR.writeMicroseconds(b[3]);


}



void loop()
{

delay(10);	

}


void SetServos(int byteCount)
