servo motor sample #4

#include <Servo.h>

#define MAX_DIGIT  3
Servo u_srv;
Servo l_srv;

int deg = 0;
int save_deg = 0;

void setup()
{
  u_srv.attach(10);
  l_srv.attach(12);
  Serial.begin(9600);
}

void loop()
{
  if (Serial.available() > 0) {
        delay(15);
        deg = readData();
        l_srv.write(deg);
        u_srv.write(deg);
    }
    if (save_deg != deg) {
        Serial.print("degree is ");
        Serial.println(deg);
  }

  save_deg = deg;
}

int readData() {
    char c[MAX_DIGIT] = "0";
    for ( int i = 0; i < MAX_DIGIT; i++ ) {
        c[ i ] = Serial.read();
        if ( c[ i ] == '\0' )
            break;
    }
    return atoi( c );
}