chenwei 发表于 2017-3-12 11:53:59

串口控制两个舵机

我想做一个用串口控制的两个舵机系统，希望能控制两个舵机各自执行我的命令。现在我可以用串口控制一个舵机了，求助怎么控制两个！急啊……

kenan13 发表于 2017-3-12 12:27:47

1、在参数前加标志，如左舵机和右舵机用L和R来表示
2、加判断，如读到R就是控制右舵机
3、发送指令R90L45，代表右舵机90度左舵机45度

chenwei 发表于 2017-3-17 20:11:38

#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]
查看完整版本: 串口控制两个舵机