Arduino驱动舵机-简单测试代码

Arduino驱动舵机

#include <Servo.h>    // 声明调用Servo.h库
Servo myservo;        // 创建一个舵机对象
const int myservoPin = 9;
int pos = 0;          // 变量pos用来存储舵机位置
void setup() {
  // put your setup code here, to run once:
  myservo.attach(myservoPin);  // 将引脚9上的舵机与声明的舵机对象连接起来
}

void loop() {
  // put your main code here, to run repeatedly:
  ServoTest();
}

void ServoTest()
{
   for(pos = 0; pos < 90; pos += 1){    // 舵机从0°转到180°，每次增加1°         
      myservo.write(pos);           // 给舵机写入角度   
      delay(15);                    // 延时15ms让舵机转到指定位置
   }
   for(pos = 90; pos>=0; pos-=1) {    // 舵机从180°转回到0°，每次减小1°                   
       myservo.write(pos);        // 写角度到舵机     
       delay(5);                 // 延时15ms让舵机转到指定位置
    }   
}