您的位置 首页 模拟

舵机程序之数据的处理

上位机对于舵机的每次调度信息通过shujuchuli函数提取出来defineBIAOZHI(x,y,z)Biaozhi=x;Biaozhip=y;Biaozhit=zcharASC_zhuan_Va

//上位机关于舵机的每次调度信息经过shujuchuli函数提取出来

#define BIAOZHI(x,y,z) Biaozhi=x;Biaozhip=y;Biaozhit=z
char ASC_zhuan_Valu(char asc)
{
char valu;
switch(asc)
{
case 0x30:valu=0;break; //0的ASC码时0x30,,十进制48
case 0x31:valu=1;break;
case 0x32:valu=2;break;
case 0x33:valu=3;break;
case 0x34:valu=4;break;
case 0x35:valu=5;break;
case 0x36:valu=6;break;
case 0x37:valu=7;break;
case 0x38:valu=8;break;
case 0x39:valu=9;break;
}
return valu;
}
void shujuchuli(char *Huancen,unsigned int *Pwm)//数据处理
{
char Biaozhi,Biaozhip,Biaozhit;
unsigned int Shuju=0,Shujup=0,Shujut=0;
while(*Huancen!=10)
{
if(Biaozhi==1&*Huancen!=80&*Huancen!=84)
{
Shuju=Shuju*10+ASC_zhuan_Valu(*Huancen);
}
if(Biaozhip==1&*Huancen!=35&*Huancen!=84)
{
Shujup=Shujup*10+ASC_zhuan_Valu(*Huancen);
}
if(Biaozhit==1&*Huancen!=80&*Huancen!=35)
{
Shujut=Shujut*10+ASC_zhuan_Valu(*Huancen);
}
if(*Huancen==35) //#
{
BIAOZHI(1,0,0);
}
if(*Huancen==80) //P
{
BIAOZHI(0,1,0);
}
if(*Huancen==84) //T
{
BIAOZHI(0,0,1);
}
Huancen++;
if(*Huancen==10)
{
if(Shujup>500)
{
*(Pwm+Shuju-1)=Shujup;//新的方位数据发生进行调度
}
return;
}
}
}

声明:本文内容来自网络转载或用户投稿,文章版权归原作者和原出处所有。文中观点,不代表本站立场。若有侵权请联系本站删除(kf@86ic.com)https://www.86ic.net/zhishi/moni/255180.html

为您推荐

联系我们

联系我们

在线咨询: QQ交谈

邮箱: kf@86ic.com

关注微信
微信扫一扫关注我们

微信扫一扫关注我们

返回顶部