单片机控制舵机程序

//12MHz

#include <reg51.h>

void InitTimer0(void)

{

TMOD = 0x01

TH0 = 0x0B1

TL0 = 0x0E0

EA = 1

ET0 = 1

TR0 = 1

}

void delay(void) //误差 0us 延时1ms 此处可以修改高电平周期

//修改此处的延时可以更改舵机转的角度 ，45度具体是多少 你可以试试

{

unsigned char a,b,c

for(c=1c>0c--)

for(b=142b>0b--)

for(a=2a>0a--)

}

void main(void)

{

InitTimer0()

P1_2=0

while(1)

}

void Timer0Interrupt(void) interrupt 1

{

//20ms中断

TH0 = 0x0B1

TL0 = 0x0E0

P1_2=1

delay()

P1_2=0

}

可以用任意一个IO引脚和舵机连接，程序上，用两个定时器，定时器1定时20ms，中断时让IO管脚输出高电平，并启动定时器2，定时器2定时1.5至2.5ms，对应舵机的角度，中断时让该管脚输出低电平，并关闭自身。改变定时器2的定时时间，即改变了舵机的转角。

---