void setup() { } void loop() { a = SerialRead() if (a == 1) { ServoDrive(200, 200) } elseif (a == 2) { ServoDrive(150, -150) } elseif (a == 3) { ServoDrive(0, 0) } elseif (a == 4) { ServoDrive(-150, 150) } elseif (a == 5) { ServoDrive(-150, -150) } Delay(100) } void ServoDrive(int left, int right) { left_pw = map(left, -255, 255, 180, 0) right_pw = map(right, -255, 255, 0, 180) ServoWrite(5, left_pw) ServoWrite(6, right_pw) }