舵机小车

卡卡西

   #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);  
}