/* * ServoEight_FW * ------------------- * */ int i = 0; unsigned char servoone = 0; unsigned char START = 255; unsigned char SERVO = 9; unsigned char POSITION = 150; int val[3]; void setup() { Serial.begin(1200); // connect to the serial port } void loop() { // send data only when you receive data: if (Serial.available() > 0) { // read the incoming byte: for(i=0; i < 3; i = i +1){ val[i] = Serial.read(); delay(100); } updateServo(); } } void updateServo() { if(val[0] == 255){ if(val[1] >= 8 && val[1]<=15) { if(val[2] >= 0 && val[2] <= 254){ unsigned char SERVO = val[1]; unsigned char POSITION = val[2]; Serial.print(START); Serial.print(SERVO); Serial.println(POSITION); } } } }