int servopin = 7; //定義舵機接口數字接口7 也就是舵機的橙色信號線。
void setup(){
pinMode(servopin,OUTPUT);//設定舵機接口為輸出接口
}
void servopulse( int pulsewidth)//定義一個脈沖函數
{
digitalWrite(servopin,HIGH); //將舵機接口電平至高
delayMicroseconds(pulsewidth); //延時脈寬值的微秒數
digitalWrite(servopin,LOW); //將舵機接口電平至低
delayMicroseconds(20000-pulsewidth);
}
//主循環
void loop() {
for(int i=0;i<=50;i++)//給予舵機足夠的時間讓它轉到指定角度
{ servopulse(560); //引用脈沖函數
}
delay(2000);
for(int i=0;i<=50;i++)//給予舵機足夠的時間讓它轉到指定角度
{servopulse(600); //引用脈沖函數
}
delay(2000);
for(int i=0;i<=50;i++)//給予舵機足夠的時間讓它轉到指定角度
{servopulse(1260); //引用脈沖函數
}
delay(2000);
}
|
