|
楼主 |
发表于 2015-8-11 22:23:41
|
显示全部楼层
if(Q_ANGLE.Roll<0)
{
QQ_ANGLE.Roll=-Q_ANGLE.Roll;
R_UART0_Send("-",1);
delay_10ms();
delay_10ms();
delay_10ms();
}
else QQ_ANGLE.Roll=Q_ANGLE.Roll;
tx_dd[0]=(unsigned int)QQ_ANGLE.Roll /100+48;
tx_dd[1]=(unsigned int)QQ_ANGLE.Roll%100/10+48;
tx_dd[2]=(unsigned int)QQ_ANGLE.Roll%10+48;
tx_dd[3]='.';
tx_dd[4]=(unsigned int)(QQ_ANGLE.Roll*10)%10+48;
tx_dd[5]=(unsigned int)(QQ_ANGLE.Roll*100)%10+48;
R_UART0_Send(tx_dd,6);
delay_10ms();
delay_10ms();
delay_10ms();
void delay_10us()
{
unsigned int i;
for(i=0;i<46;i++)
{
;
}
}
void delay_10ms()
{
unsigned int i;
for(i=0;i<990;i++)
{
delay_10us();
}
}
发送函数是在main里
|
|