Arduino Simple Servo Control

byte data1;

byte data2;


void setup() {

Serial.begin(57600);

pinMode(2, OUTPUT);

pinMode(3, OUTPUT);

}


void loop() {

if(Serial.available() > 1) {

data1 = Serial.read();

data2 = Serial.read();

for(int i = 0; i < 20; i++) {

digitalWrite(data1, HIGH);

delayMicroseconds(data2 * 6 + 700);

digitalWrite(data1, LOW);

delayMicroseconds(22000 - (data2 * 6 + 700));

}

}

}