1对6

zhyinch

2022-03-01 617d989d294c30b5f04f643b1ec7e5d9b4878a1a

 Ô´Âë/ºËÐÄ°å/Src/application/dw_app.c

@@ -1021,6 +1021,7 @@
extern u8 gpsdataready_flag;
extern u16 gps_packlen;
u8 totalpack_num,currentpack_num;
u16 sendtimes;
void RecOnePackData(void)
{
   dwt_setrxtimeout(0);//设定接收超时时间，0位没有超时时间
@@ -1048,7 +1049,7 @@
      {
         recdata_len = frame_len-14;   
         memcpy(rec_gpsdata,&rx_buffer[DATA_IDX],recdata_len);
         if(gpsdataready_flag)
      //   if(gpsdataready_flag)
         {
            gpsdataready_flag = 0;
            tx_sync_msg[MESSAGE_TYPE_IDX]=DATA_RESPONSE;
@@ -1066,13 +1067,15 @@
                  dwt_writetxdata(110+14, tx_sync_msg, 0);//将Poll包数据传给DW1000，将在开启发送时传出去
                  dwt_writetxfctrl(110+14, 0);//设置超宽带发送数据长度
                  dwt_starttx(DWT_START_TX_IMMEDIATE);
                  sendtimes++;
               }else{
                  tx_sync_msg[CURENTPACKNUM_IDX] = 1;
                  memcpy(&tx_sync_msg[DATA_IDX],&RTCMdata[send_i],remain_i);
                  dwt_writetxdata(remain_i+14, tx_sync_msg, 0);//将Poll包数据传给DW1000，将在开启发送时传出去
                  dwt_writetxfctrl(remain_i+14, 0);//设置超宽带发送数据长度
                  dwt_starttx(DWT_START_TX_IMMEDIATE);
                  remain_i = 0;					
                  remain_i = 0;
                  sendtimes++;						
               }
               delay_us(1000);
            }
@@ -1090,9 +1093,12 @@
         double high = 0;
         uint8_t gps_type;
         gps_type = HIDO_UtilStrBufToInt(stPosState[2].m_pData,1);
         if(gps_type!=0)
         {
         GPS_ParseLon(&stPosState[1], &lon);
         GPS_ParseLat(&stPosState[0], &lat);
         GPS_ParseHeight(&stPosState[3], &high);
         }
         printf(fmt,gps_type, high, lat, lon);
   //USART_puts(rec_gpsdata,recdata_len);
      }