舵机调试
单片机源程序如下:
- #include <reg52.h>
- sbit duoji2=P2^2;
- sbit duoji20=P0^5;
- sbit XCTZW1=P1^6; // 正转
- sbit XCTZW2=P1^7; // 反转
- int num1=0,num2=0,DJ2=13,DJ20=13;
- void delay_ms(unsigned char i)
- {
- char j;
- while(i--)
- {
- for(j=0;j<115;j++);
- }
- }
- void main()
- {
- IE=0x82;
- TMOD=0x01;
- TH0=(65536-100)/256;
- TL0=(66536-100)%256;
- TR0=1;
- while(1)
- {
- if(!XCTZW1)
- {
- TR0=0;
- delay_ms(100);
- if(XCTZW1==0)
- {
- DJ2=8;
- DJ20=8;
- TR0=1;
- }
- }
- if(!XCTZW2)
- {
- TR0=0;
- delay_ms(100);
- if(XCTZW2==0)
- {
- DJ2=15;
- DJ20=15;
- TR0=1;
- }
- }
- delay_ms(100);
- }
- }
- void Time() interrupt 1
- {
- TH0=(65536-100)/256;
- TL0=(65536-100)%256;
- num1++;
- if(num1==200) num1=0;
- if(num1<DJ2)duoji2=1;
- else duoji2=0;
- num2++;
- if(num2==200) num2=0;
- if(num2<DJ20)duoji20=1;
- else duoji20=0;
- }
复制代码
所有资料51hei提供下载:
舵机正反转调试.zip
(10.02 KB, 下载次数: 34)
|