极客工坊

 找回密码
 注册

QQ登录

只需一步,快速开始

查看: 10829|回复: 2

串口控制两个舵机

[复制链接]
发表于 2017-3-12 11:53:59 | 显示全部楼层 |阅读模式
我想做一个用串口控制的两个舵机系统,希望能控制两个舵机各自执行我的命令。现在我可以用串口控制一个舵机了,求助怎么控制两个!急啊……
回复

使用道具 举报

发表于 2017-3-12 12:27:47 | 显示全部楼层
1、在参数前加标志,如左舵机和右舵机用L和R来表示
2、加判断,如读到R就是控制右舵机
3、发送指令R90L45,代表右舵机90度左舵机45度
回复 支持 反对

使用道具 举报

 楼主| 发表于 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;
    }
  }

我这么写可以吗
回复 支持 反对

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则 需要先绑定手机号

Archiver|联系我们|极客工坊

GMT+8, 2024-3-28 21:09 , Processed in 0.047224 second(s), 18 queries .

Powered by Discuz! X3.4 Licensed

Copyright © 2001-2021, Tencent Cloud.

快速回复 返回顶部 返回列表