通用舵机控制程序(角度占空比设置)

#include

#define sen_port P1 //传感器入口

sbit djkz=P2^7;
sbit DT=P2^6; //无线识别信号


unsigned char wuxian_inp()
{
unsigned char wuxian;
if(DT==1)
{
wuxian = sen_port;
}
else wuxian=0x00;
wuxian &= 0xf0; //其中P1^4-P1^7接入无线按键ABCD四个信号 //其它的,被置为0
return wuxian;
}




void delay1()
{
int i;
int j=0;
while(j<50) //i=430最左边位置 i=500最边 i=430刚好中间的左转90度
{

djkz=1;
for(i=0;i<430;i++);
djkz=0;
for(i=0;i<1200;i++);
j++;
}



}
void delay2()
{
int i;
int j=0;
while(j<50) //i=180中间位置
{
djkz=1;
for(i=0;i<180;i++);
djkz=0;
for(i=0;i<1200;i++);
j++;
}
}

void delay3()
{
int i;
int j=0;
while(j<70) //i=60最右边位置
{
djkz=1;
for(i=0;i<60;i++);
djkz=0;
for(i=0;i<1200;i++);
j++;
}
}

void main()
{
//四键无线遥控控制
while(1){ switch( wuxian_inp())
{
case 0x10: delay1(); break;
case 0x20: delay2(); break;
case 0x40: delay3(); break;

default:
break;
}





}
}