串口控制两个舵机
我想做一个用串口控制的两个舵机系统,希望能控制两个舵机各自执行我的命令。现在我可以用串口控制一个舵机了,求助怎么控制两个!急啊…… 1、在参数前加标志,如左舵机和右舵机用L和R来表示2、加判断,如读到R就是控制右舵机
3、发送指令R90L45,代表右舵机90度左舵机45度 #include<Servo.h>
Servo servo2D;
Servo servo3D;
int angle;
String inString="";
char whichservo=' ';
boolean stringComplete=false;
void setup() {
Serial.begin(9600);
servo2D.attach(2);
servo3D.attach(3);
servo2D.write(90);
servo3D.write(67);
}
void loop() {
if(stringComplete){
if(whichservo=='X'){
servo2D.write(angle);
}
else if(whichservo='Y'){
servo3D.write(angle);
}
stringComplete=false;
inString="";
whichservo=' ';
}
}
void serialEvent(){
while(Serial.available()>0){
char inChar=Serial.read();
if(isDigit(inChar)){
inString+=inChar;
}
else if(inChar=='\n'){
stringComplete=true;
angle=inString.toInt();
}
else whichservo=inChar;
}
}
我这么写可以吗
页:
[1]