51舵机测试器源代码.docVIP

#include #include unsigned char code LED7Code[] ~0x40,~0x79,~0x24,~0x30,~0x19,~0x12,~0x02,~0x78,~0x00,~0x10,~0x88 ; unsigned char TIM0H; unsigned char TIM0L; unsigned int NUM; void delay unsigned int i ; sbit K1 P2^3; //左极限位置 sbit K2 P2^4; //-- sbit K3 P2^5;//中间位置 sbit K4 P2^6;//++ sbit K5 P2^7;//右极限位置 //P0 口为 PPM 舵机信号输出 //P1,P3口各接1位数码管输出 /********************************************************* 主函数 **********************************************************/ void main TMOD 0x11; //定时器1工作在方式1 TH1 0xb1; //20ms定时 TL1 0xe0; EA 1; ET1 1; //允许定时/计数器1 中断 TR1 1; //启动定时/计数器1 中断 TH0 0xfa; //1.5ms定时 TL0 0x24; ET0 1; //允许定时/计数器0 中断 TR0 1; //启动定时/计数器0 中断 NUM 1500; while 1 if K4 0 delay 5 ; if K4 0 NUM++; if NUM 2000 NUM 2000; if K2 0 delay 5 ; if K2 0 NUM--; if NUM 1000 NUM 1000; if K3 0 delay 5 ; if K3 0 NUM 1500; if K5 0 delay 5 ; if K5 0 NUM 2000; if K1 0 delay 5 ; if K1 0 NUM 1000; P1 ~LED7Code[ NUM %1000 /100 ]; P3 ~LED7Code[ NUM /1000 ]; TIM0H 65536-NUM /256 ; TIM0L 65536-NUM %256 ; /********************************************************* 中断服务函数 **********************************************************/ void Time1 void interrupt 3 //3定时器1的中断号 1定时器0的中断号 0外部中断1 2外部中断2 4串口中断 TH1 0xb1; //20ms定时 TL1 0xe0; P0 ~P0; TR0 1; //启动定时/计数器0 中断 void Time0 void interrupt 1 //3定时器1的中断号 1定时器0的中断号 0外部中断1 2外部中断2 4串口中断 TH0 TIM0H; TL0 TIM0L; P0 ~P0; TR0 0; //关闭定时/计数器0 中断 void delay unsigned int i char j; for i; i 0; i-- for j 200; j 0; j-- ;