#include <Servo.h>
int servoA = 4;
int servoB = 5;
int servoC = 6;
int servoD = 7;
Servo myservo;
boolean attached=false;
String inData;
void setup() {
// 開啟 Serial port, 通訊速率為 9600 bps
Serial.begin(9600);
// 初始化 LED 接腳
pinMode(servoA, OUTPUT);
pinMode(servoB, OUTPUT);
pinMode(servoC, OUTPUT);
pinMode(servoD, OUTPUT);
}
void loop() {
// 檢查是否有資料可供讀取
if (Serial.available() > 0) {
inData = Serial.readStringUntil('\n');
//int res = inData.indexOf("a");
if (inData.indexOf("a") > -1){
attached = true;
myservo.attach(servoA);
}else if (inData.indexOf("b") > -1){
attached = true;
myservo.attach(servoB);
}else if (inData.indexOf("c") > -1){
attached = true;
myservo.attach(servoC);
}else if (inData.indexOf("d") > -1){
attached = true;
myservo.attach(servoD);
}else if(attached){
int resInt = Serial.parseInt();
myservo.write(resInt);
delay(1000);
myservo.detach();
attached = false;;
}else{}
}
}