首页 › Arduino › 舵机小车

卡卡西 发表于 2015-6-20 16:18:59

舵机小车

   #include <Servo.h>

   Servo myservo;// 定义舵机对象，最多八个

   int pos = 0;    // 定义舵机转动位置
int in1=5;
int in2=4;
int in3=3;
int in4=2;
int ena=A0;
int enb=A1;
   void setup()
   {
      myservo.attach(9);// 设置舵机控制针
      pinMode(in1,OUTPUT);
      pinMode(in2,OUTPUT);
      pinMode(in3,OUTPUT);
      pinMode(in4,OUTPUT);
      pinMode(ena,OUTPUT);
      pinMode(enb,OUTPUT);
   }

   void loop()
{
    s();
      // 0到180旋转舵机，每次延时15毫秒
      for(pos = 0; pos < 180; pos += 1)
   {
      myservo.write(pos);
      delay(5);
      }
      // 180到0旋转舵机，每次延时15毫秒
      for(pos = 180; pos>=1; pos-=1)
      {                              
      myservo.write(pos);
      delay(5);
       ss();
      }
}
void s()
{
digitalWrite(in1,0);
digitalWrite(in2,1);
digitalWrite(in3,0);
digitalWrite(in4,1);
digitalWrite(ena,1);
digitalWrite(enb,1);
}
void ss()
{
digitalWrite(in1,1);
digitalWrite(in2,0);
digitalWrite(in3,1);
digitalWrite(in4,0);
digitalWrite(ena,1);
digitalWrite(enb,1);
}

查看完整版本: 舵机小车