movable_sd_speaker: SDspeaker_ProMini.ino

#include <Servo.h>
Servo myservo[2];
char rcvData = 0;
int servo_angle[2];
void setup()
{
    myservo[0].attach(3);
    myservo[1].attach(7); 
    Serial.begin(9600);
    myservo[0].write(90);
    myservo[1].write(90);
}

void loop()
{
    servo_angle[0] = 0;
    servo_angle[1] = 0;
    if(Serial.available() > 0){
        rcvData = Serial.read();
        if(rcvData == 'x'){
            while(!Serial.available()){}
            rcvData = Serial.read() - '0';
            servo_angle[0] = rcvData * 100;
            while(!Serial.available()){}
            rcvData = Serial.read() - '0';
            servo_angle[0] += rcvData * 10;
            while(!Serial.available()){}
            rcvData = Serial.read() - '0';
            servo_angle[0] += rcvData;
            
            if(servo_angle[0] >= 0 && servo_angle[0] <= 180){
                myservo[0].write(servo_angle[0]);
                Serial.print("SERVO X "); 
                Serial.print(servo_angle[0]);   
            }
        }
        else if(rcvData == 'y'){
            while(!Serial.available()){}
            rcvData = Serial.read() - '0';
            servo_angle[1] = rcvData * 100;
            while(!Serial.available()){}
            rcvData = Serial.read() - '0';
            servo_angle[1] += rcvData * 10;
            while(!Serial.available()){}
            rcvData = Serial.read() - '0';
            servo_angle[1] += rcvData;
            
            if(servo_angle[1] >= 0 && servo_angle[1] <= 180){
                myservo[1].write(servo_angle[1]);
                Serial.print("SERVO Y ");
                Serial.println(servo_angle[1]); 
            }
        }   
    }
}