中级会员
 
- 积分
- 373
- 金钱
- 373
- 注册时间
- 2019-6-4
- 在线时间
- 75 小时
|

楼主 |
发表于 2019-11-6 19:24:54
|
显示全部楼层
NRF24L01_TX_Mode();
// while(1)
// {
if(NRF24L01_TxPacket(tmp_buf)==TX_OK)
{
r=-(int)(roll*100);
p=(int)(pitch*100);
y=-(int)(yaw*10);
delay_ms(50);
if(p>0)//pitch:俯仰角.单位 0.01度。-9000 - 9000 对应 -90.00 -> 90.00 度
{
tmp_buf[0]=1;
tmp_buf[1]=p/256;
tmp_buf[2]=p%256;
pitch2=tmp_buf[1]*256+tmp_buf[2];
printf("\r\npitch2=%d\r\n",(int)pitch2);
}else {
p=-p;
tmp_buf[0]=0;
tmp_buf[1]=p/256;
tmp_buf[2]=p%256;
pitch2=-(tmp_buf[1]*256+tmp_buf[2]);
printf("\r\npitch2=%d\r\n",(int)pitch2);
}
if(r>0)
{
tmp_buf[3]=1;
tmp_buf[4]=r/256;
tmp_buf[5]=r%256;
roll2=tmp_buf[4]*256+tmp_buf[5];
printf("roll2=%d\r\n",(int)roll2);
}else {
r=-r;
tmp_buf[3]=0;
tmp_buf[4]=r/256;
tmp_buf[5]=r%256;
roll2=-(tmp_buf[4]*256+tmp_buf[5]);
printf("roll2=%d\r\n",(int)roll2);
}
if(y>0)
{
tmp_buf[6]=1;
tmp_buf[7]=y/256;
tmp_buf[8]=y%256;
yaw2=tmp_buf[7]*256+tmp_buf[8];
printf("yaw2=%d\r\n",(int)yaw2);
}else {
y=-y;
tmp_buf[6]=0;
tmp_buf[7]=y/256;
tmp_buf[8]=y%256;
yaw2=-(tmp_buf[7]*256+tmp_buf[8]);
printf("yaw2=%d\r\n",(int)yaw2);
}
delay_ms(300);
LED0=0;
LED1=1;
}else LED1=0;
只发送一次数据,如何循环发送?
|
|