通过Arduino控制二自由度云台

#include

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’同理。

你可能感兴趣的:(arduino,云台,arduino)