void servopulse(int servopin,int myangle)/*定義一個脈沖函數，用來模擬方式產生PWM值*/
{
pulsewidth=(myangle*11)+500;//將角度轉化為500-2480 的脈寬值
digitalWrite(servopin,HIGH);//將舵機接口電平置高
delayMicroseconds(pulsewidth);//延時脈寬值的微秒數
digitalWrite(servopin,LOW);//將舵機接口電平置低
delay(20-pulsewidth/1000);//延時周期內剩余時間�
} |
