我用的是STC12C5A60S2,我可以同時操控多個舵機了,但是我按鍵對操縱的四個舵機發出的都是同一個命令,不知道怎么每2個按鍵單獨控制一個舵機,望大佬指導。目前我只寫了4個按鍵
程序基于http://www.zg4o1577.cn/bbs/dpj-156595-1.html按鍵操控編寫
#include<reg52.h>
sbit SG_YEE=P0^0;
sbit SG_PWM=P0^1;
sbit SG_WUHU=P0^2;
sbit SG_DAME=P0^3;
sbit Key_1=P4^1;
sbit Key_2=P4^2;
sbit Key_3=P4^3;
sbit Key_4=P4^4;
unsigned char count=0;
unsigned char PWM_count=5; //1--0度，2--45度，3--90度，4--135度，5--180度
void delay(unsigned char i) //延時
{
unsigned char j,k;
for(j=i;j>0;j--)
for(k=125;k>0;k--);
}
void Timer_Init()
{
TMOD=0X01; //T0定時方式1
TH0=0Xfe;
TL0=0X33; //計數初值設置為0.5ms 每0.5ms進入一次中斷，晶振頻率:11.0592MHZ
ET0=1; //打開定時器0的中斷
TR0=1; //打開定時器0
EA=1; //開總中斷
}
void Timer() interrupt 1 //特別注意此處，0--外部中斷0，1--定時器中斷0，2--外部中斷1，3--定時器中斷1，4--串行口中斷1
{
TR0=0;
TH0=0Xfe;
TL0=0X33; //重新賦計數初值為0.5ms
if(count<=PWM_count)
{
SG_PWM=1;
SG_YEE=1;
SG_WUHU=1;
SG_DAME=1;
}
else
{
SG_PWM=0;
SG_YEE=0;
SG_WUHU=0;
SG_DAME=0;
}
count++;
if(count>=40)
{
count=0;
}
TR0=1;
}
void main()
{
Timer_Init();
while(1)
{
if(Key_1==0)
{
delay(10);
EA=0;
if(Key_1==0)
{
PWM_count=1;
count=0;
EA=1;
}
while(!Key_1);
}
if(Key_2==0)
{
delay(10);
EA=0;
if(Key_2==0)
{
PWM_count=2;
count=0;
EA=1;
}
while(!Key_2);
}
if(Key_3==0);
{
delay(10);
EA=0;
if(Key_3==0);
{
PWM_count=3;
count=0;
EA=1;
}
while(!Key_3);
}
if(Key_4==0);
{
delay(10);
EA=0;
if(Key_3==0);
{
PWM_count=4;
count=0;
EA=1;
}
while(!Key_4);
}
}
}
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
