通用舵机控制程序(角度占空比设置)
- 1、下载文档前请自行甄别文档内容的完整性,平台不提供额外的编辑、内容补充、找答案等附加服务。
- 2、"仅部分预览"的文档,不可在线预览部分如存在完整性等问题,可反馈申请退款(可完整预览的文档不适用该条件!)。
- 3、如文档侵犯您的权益,请联系客服反馈,我们会尽快为您处理(人工客服工作时间:9:00-18:30)。
#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;
}
}
}