通过Arduino控制二自由度云台

来源:互联网 发布:数据列表测试用例 编辑:程序博客网 时间:2024/04/28 03:45
#include<Servo.h>Servo up,down;      int a=60,b=30;    //上下舵机初始角度void setup()      //初始化{  up.attach(10,1000,2000);        //上面的舵机附加到引脚10        down.attach(9,1000,2000);       //下面的舵机附加到引脚9  up.write(a);                   //上面的舵机初始角度为60°   down.write(b);                 //下面的舵机初始角度为30°  Serial.begin(9600);}void loop(){  while(Serial.available() > 0)     //当Serial.available()>0时,说明串口接收到了数据,可以读取。       {    char flag=Serial.read();    delay(2);     if(flag=='u')     //当串口输入‘u’时,上舵机向上转动5°        a=a+5;     if(flag=='d')    //当串口输入‘d’时,上舵机向下转动5°        a=a-5;     if(flag=='l')    //当串口输入‘l’时,下舵机向左转动5°        b=b+5;     if(flag=='r')    //当串口输入‘r’时,下舵机向右转动5°        b=b-5;  }  up.write(a);  down.write(b);}

此时,当你在串口监视器上输入‘u’时,云台将向上转动5°。输入‘d’,‘r’,‘l’同理。

原创粉丝点击