×
嵌入式 > 技术百科 > 详情

舵机程序之数据的处理

发布时间:2020-06-20 发布时间:
|
//上位机对于舵机的每次调度信息通过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;   
   }
  }
}

 

『本文转载自网络,版权归原作者所有,如有侵权请联系删除』

热门文章 更多
激光跟踪仪市场2023年有望达5.216亿美元