서보모터 다중제어에 대하여 질문드립니다.

아두이노 메가를 사용하고 있고 버전은 1.0.3을 사용하고 있습니다.

키보드를 통해서 서보모터 5개를 제어하는 하는 방법을 알고 싶습니다. 

아래와 같은 소스로 한개제어는 가능한데 직렬포트창에 1>, 2> 하면 1모터와 2모터의 펄스를 100us만큼씩 변형이 되도록 하고 싶습니다. 

 

어떠한 방법이 있는지 조언좀 부탁드리겠습니다. 소스는 아래와 같습니다.

 

int servoPin = 2;
int minPulse = 600;
int maxPulse = 2400;
int turnRate = 100;
int refreshTime = 20;

int centerServo;
int pulseWidth;
int moveServo;
long lastPulse = 0;

void setup()
{
  pinMode(servoPin, OUTPUT);
  centerServo = maxPulse - ((maxPulse - minPulse)/2);
  pulseWidth = centerServo;
  Serial.begin(9600);
  Serial.println("Arduino Serial Servo Control");
  Serial.println("Press < or > to move. spacebar to center");
  Serial.println();
}

void loop()
{
  if(Serial.available()>0)
  {
    moveServo = Serial.read();
    
    if(moveServo == 44){pulseWidth = pulseWidth - turnRate;}
    if(moveServo == 46){pulseWidth = pulseWidth + turnRate;}
    if(moveServo == 32){pulseWidth = centerServo;}
    
    if(pulseWidth > maxPulse){pulseWidth = maxPulse;}
    if(pulseWidth < minPulse){pulseWidth = minPulse;}
    
    Serial.print("Pulse Width;");
    Serial.print(pulseWidth);
    Serial.println("us");
  }
  
  if(millis() - lastPulse >= refreshTime)
  {
    digitalWrite(servoPin, HIGH);
    delayMicroseconds(pulseWidth);
    digitalWrite(servoPin, LOW);
    lastPulse = millis();
  }
}