初级会员

- 积分
- 142
- 金钱
- 142
- 注册时间
- 2013-11-1
- 在线时间
- 183 小时
|
10金钱
if(15<pitch<30)flag_yaw=1;
else if(30<pitch<45)flag_yaw=2;
else if(45<pitch<60)flag_yaw=3;
else if(60<pitch<90)flag_yaw=4;
else if(-15<pitch<-30)flag_yaw=5;
else if(-30<pitch<-45)flag_yaw=6;
else if(-45<pitch<-60)flag_yaw=7;
else if(-60<pitch<-90)flag_yaw=7;
//上下识别
// if(15<roll<30)flag_yaw=9;
// else if(30<roll<45)flag_yaw=10;
// else if(45<roll<60)flag_yaw=11;
// else if(60<roll<90)flag_yaw=12;
// if(-15<roll<-30)flag_yaw=13;
// else if(-30<roll<-45)flag_yaw=14;
// else if(-45<roll<-60)flag_yaw=15;
// else if(-60<roll<-90)flag_yaw=16;
switch (flag_yaw){
case 1: sprintf((char*)buffer,"\n\rposition = 1 \n\r\0"); flag_yaw=0; break;
case 2: sprintf((char*)buffer,"\n\rposition = 2 \n\r\0"); flag_yaw=0; break;
case 3: sprintf((char*)buffer,"\n\rposition = 3 \n\r\0"); flag_yaw=0; break;
case 4: sprintf((char*)buffer,"\n\rposition = 4 \n\r\0"); flag_yaw=0; break;
case 5: sprintf((char*)buffer,"\n\rposition = 5 \n\r\0"); flag_yaw=0; break;
case 6: sprintf((char*)buffer,"\n\rposition = 6 \n\r\0"); flag_yaw=0; break;
case 7: sprintf((char*)buffer,"\n\rposition = 7 \n\r\0"); flag_yaw=0; break;
case 8: sprintf((char*)buffer,"\n\rposition = 8 \n\r\0"); flag_yaw=0; break;
default: sprintf((char*)buffer,"\n\rposition = unknown\n\r\0"); break;
}
printf("%s\r\n",buffer);
}
串口只输出position = 1
|
|