舵机的驱动是以PWM信号的占空比来控制的,该PWM信号的周期位20ms,宽度在0.5ms——2.5ms之间,驱使舵机转动角在0——180度之间,一些常用角度对应脉宽如下表:
舵机转动角 | 脉宽 |
---|---|
0 | 0.5 ms |
45 | 1 ms |
90 | 1.5 ms |
135 | 2 ms |
180 | 2.5 ms |
在实际应用过程中,肯定会用到其他的一些非特殊角,就是上面表中没有的角度,便会用到脉宽与角度转换公式:脉宽=转动角 / 90 + 0.5。在用单片机驱动舵机时,可以用定时器产生PWM信号,也可用延时函数来实现PWM信号,为了提高精度,定时器是不二选择。由于脉宽是一个小数并非整数,所以定时器初值就设定100us,也就是0.1ms。程序如下:
#include<reg52.h>sbit servo=P3^0;
unsigned char count=0,angle=0,pulse_width=0;void InitTimer0(void)
{TMOD = 0x01;//0.1ms 11.0592MHz晶振TH0 = 0xFF;TL0 = 0xA4;EA = 1;ET0 = 1;TR0 = 1;
}void IntTimer0()interrupt 1
{TH0 = 0xFF;TL0 = 0xA4;if(count<pulse_width)servo=1;elseservo=0;count++; //0.1ms次数加1count=count%200; //保持周期为20ms,即count加到200时,在模200就等于0,开始下一周期 }void main()
{angle=90; //设置舵机转动90度,此值可在0——180之间变动pulse_width=(angle/90+0.5)*10;InitTimer0();while(1);
}