国产UWB芯片工程的仓库
blame | 历史 | 补丁 | 提交 | 提交对比 | 忽略空白
chen
2024-12-25 91c225bf44680a93147c33715bf16eb5adfb0818 
 keil/uwb_tag_.c


@@ -14,10 +14,10 @@


extern int TagRange(void);


void Tag_uwb_init(void);


/* Ranging period: 1s */


#define RANGING_PERIOD_MS (1000)


#define RANGING_PERIOD_MS (10000)




/* This is the delay from the end of the poll frame transmission to the enable of the receiver */


#define POLL_TX_TO_RESP_RX_DLY_US 750U  //yuan700


#define POLL_TX_TO_RESP_RX_DLY_US 550U  //yuan700




#define RESP_RX_TO_FINAL_TX_DLY_US 550U




@@ -25,15 +25,15 @@


#define POLL_DELAY  100U //yuan100U




/* Receive response timeout */


#define RESP_RX_TIMEOUT_US 2500U //Yuan500 10mssuccess 300jixian




#define RESP_RX_TIMEOUT_US_DEFAULT 600U //Yuan500 10mssuccess 300jixian


#define RESP_RX_TIMEOUT_US 2000000


/* Field index in frame */


#define MSG_SEQ_NUM_IDX 2


#define FINAL_MSG_POLL_TX_TS_IDX 10


#define FINAL_MSG_RESP_RX_TS_IDX 14


#define FINAL_MSG_FINAL_TX_TS_IDX 18


#define DELAY_DEFAULT 50000


#define DELAY_BETWEEN_TWO_FRAME_UUS 600  //yuan1400


#define DELAY_BETWEEN_TWO_FRAME_UUS 450  //yuan1400


#define HALF_SECOND_TIME 62400000




uint16_t CmpTagInList(uint16_t tagid);


@@ -47,7 +47,7 @@


};


uint32_t dev_id;


uint8_t group_id;


#ifndef STS_MODE


#ifdef DW1000


/* Default communication configuration. */


static struct mk_uwb_configure config = {//yuan


    .phy_work_mode = (uint8_t)(PHY_TX | PHY_RX),


@@ -64,7 +64,7 @@


    .phy_cfg.sts_seglen = STS_SEGLEN_BPRF_64, /* Number of symbols in an STS segment       */


    .phy_cfg.rx_ant_id = UWB_RX_ANT_3,    /* UWB RX antenna port                       */


};


#else


#elif defined STS_MODE


static struct mk_uwb_configure config = {


    .phy_work_mode = (uint8_t)(PHY_TX | PHY_RX),


    .phy_cfg.ch_num = 5,                      /* Channel number.                           */


@@ -90,6 +90,23 @@


    .sts_key1 = 0xF86050A8,


    .sts_key2 = 0xD1D336AA,


    .sts_key3 = 0x14148674,


};


#else //MKmode


/* Default communication configuration. */


static struct mk_uwb_configure config = {


    .phy_work_mode = (uint8_t)(PHY_TX | PHY_RX),


    .phy_cfg.ch_num = 9,                      /* Channel number.                           */


    .phy_cfg.code_index = 9,                  /* TX preamble code.                         */


    .phy_cfg.mean_prf = MEAN_PRF_64M,         /* Data rate 6.8M                            */


    .phy_cfg.data_bit_rate = DATA_BR_6M8,     /* data rate 6.8M.                           */


    .phy_cfg.sync_sym = PREAM_LEN_128,        /* Preamble duration, length of preamble 128 */


    .phy_cfg.sfd_sym = BPRF_NSFD2_8,          /* Identifier for SFD sequence               */


    .phy_cfg.ranging_bit = 1,                 /* ranging bit set.                          */


    .phy_cfg.trx_mode = TRX_MODE_15_4Z_BPRF,  /* IEEE802.15.4z - BPRF mode                 */


    .phy_cfg.sts_pkt_cfg = STS_PKT_CFG_0,     /* SP0 Frame                                 */


    .phy_cfg.sts_segnum = STS_SEGNUM_BPRF_1,  /* Number of STS segments in the frame       */


    .phy_cfg.sts_seglen = STS_SEGLEN_BPRF_64, /* Number of symbols in an STS segment       */


    .phy_cfg.rx_ant_id = UWB_RX_ANT_3,        /* UWB RX antenna port                       */


};


#endif


///* Default communication configuration. */


@@ -228,13 +245,14 @@




    return rx_timestamp;


}




uint32_t temp_rx_first_stamp,temp_rx_second_stamp;


uint16_t temp_rx_first_id,temp_rx_second_id;


/* RX done process handler. */


static void rx_int_callback(struct MAC_HW_REPORT_T *rx_report)


{


    // Power off radio


    power_off_radio();




      //tempflag=uwb_rx(0, 0, RESP_RX_TIMEOUT_US);


    rx_state = rx_report->err_code;




    /** UWB RX success */


@@ -245,6 +263,14 @@


        memcpy(rx_buf, rx_report->pkt_data, rx_length);


        /* Calculate rx timestamp */


        resp_rx_ts_i64 = ranging_rx_time_correct(rx_report);


         if(temp_rx_first_stamp==0)


         {


         temp_rx_first_stamp=(uint32_t)resp_rx_ts_i64;


         memcpy(&temp_rx_first_id,&rx_buf[1],2);


         }else{


         memcpy(&temp_rx_second_id,&rx_buf[1],2);


         temp_rx_second_stamp=(uint32_t)resp_rx_ts_i64;


         }


            temp_count1=phy_timer_count_get();


               //获取发射端时钟偏差


         resp_rx_num++;


@@ -271,7 +297,7 @@


         temp_count2=phy_timer_count_get();


         


    }


		


      //tempflag=uwb_rx(0, 0, RESP_RX_TIMEOUT_US);//立即开启接受并设置0超时


}




/* TX done process handler. */


@@ -363,7 +389,7 @@


                  uint32_t temp_dist,temp_id,temp_exsis;


                  temp_dist=true_nearbase_distlist[j];


                  temp_id = true_nearbase_idlist[j];


                  temp_exsis=true_exsistbase_list[j];


                  temp_exsis=true_exsistbase_list[i];


                  true_nearbase_distlist[j]=true_nearbase_distlist[j+1];


                  true_nearbase_idlist[j]=true_nearbase_idlist[j+1];


                  true_exsistbase_list[j]=true_exsistbase_list[j+1];


@@ -398,6 +424,7 @@


}


uint32_t count_index;


int tt=1;


float freqlost_count;


void Tag_uwb_init(void)


{


 // The following peripherals will be initialized in the uwb_open function


@@ -410,6 +437,7 @@


    // Set calibration parameters


    uwb_calibration_params_set(config.phy_cfg.ch_num);


#ifdef STS_MODE


	


    // set advanced parameters


    struct PHY_ADV_CONFIG_T adv_config = {


        .thres_fap_detect = 40,


@@ -430,12 +458,13 @@




    // uwb configure


    uwb_configure(config.phy_work_mode, board_param.tx_power_fcc[CALIB_CH(config.phy_cfg.ch_num)], &config.phy_cfg);


#ifdef STS_MODE


#if (defined STS_MODE) || (defined MK_MODE)


      ranging_lib_init();


#endif


    ranging_frame_type_set(config.phy_cfg.sts_pkt_cfg);




}


int sleep_time_step=SLEEP_COUNT;


int TagRange(void)


{      


      phy_timer_open(1, IRQ_PRIORITY_HIGH);


@@ -454,18 +483,20 @@


      poll_tx_ts_i64 = ranging_tx_time_correct(poll_tx_en_start_u32 + phy_shr_duration());//修正时间戳


      temp_count1=phy_timer_count_get();


      while(mac_is_busy());//等待发送完成


   #ifdef BOXING


      gpio_pin_clr(IO_PIN_5);//测试


      gpio_pin_set(IO_PIN_5);//测试


      temp_count2=phy_timer_count_get();


   #endif	


   temp_count2=phy_timer_count_get();


      resp_rx_en_start_u32 =  poll_tx_en_start_u32+ US_TO_PHY_TIMER_COUNT(POLL_TX_TO_RESP_RX_DLY_US);//设置发送多少s后接收按target独立时间起点算+ US_TO_PHY_TIMER_COUNT(POLL_TX_TO_RESP_RX_DLY_US为发送后要多久开启接收时间


      temp_resp=resp_rx_en_start_u32;


   //tempflag=uwb_rx(1, resp_rx_en_start_u32, RESP_RX_TIMEOUT_US);//开启接受并设置接收超时


   tempflag=uwb_rx(0,0, RESP_RX_TIMEOUT_US);


   tempflag=uwb_rx(1,resp_rx_en_start_u32, RESP_RX_TIMEOUT_US);


   


   


   start_receive_count=phy_timer_count_get();


   //poll_timeout=nearbase_num*US_TO_PHY_TIMER_COUNT(DELAY_BETWEEN_TWO_FRAME_UUS)+US_TO_PHY_TIMER_COUNT(RESP_RX_TIMEOUT_US);//多一个多0.4ms默认0.4ms计算为0.125*4*100000,默认开启1mss


   poll_timeout=US_TO_PHY_TIMER_COUNT(RESP_RX_TIMEOUT_US);


   poll_timeout=US_TO_PHY_TIMER_COUNT(RESP_RX_TIMEOUT_US_DEFAULT)+nearbase_num*US_TO_PHY_TIMER_COUNT(DELAY_BETWEEN_TWO_FRAME_UUS);


   end_receive_count=start_receive_count+poll_timeout;


   


   if(end_receive_count>=UINT32_MAX)


@@ -487,16 +518,18 @@


                    break;


            }


      }


		


      temp_count3=phy_timer_count_get();


      if(receive_flag==1)//成功接收数据


      {


         receive_flag=0;


   tempflag=uwb_rx(0, 0, RESP_RX_TIMEOUT_US);//立即开启接受并设置0超时


         //tempflag=uwb_rx(0, 0, RESP_RX_TIMEOUT_US);//立即开启接受并设置0超时


         //接收成功则判断是否为同一组


         if (rx_buf[MESSAGE_TYPE_IDX] == MBX_RESPONSE&&!memcmp(&rx_buf[TAG_ID_IDX],&dev_id,2)&&rx_buf[GROUP_ID_IDX]==group_id) //判断接收到的数据是否是response数据


                     {   


                           memcpy(&rec_nearbaseid,&rx_buf[ANCHOR_ID_IDX],2);


                           rec_nearbasepos=FindNearBasePos(rec_nearbaseid);


                           freqlost_count = 0;


                           SetANCTimestap(rec_nearbasepos,&rx_buf[RESP_MSG_POLL_RX_TS_IDX],&rx_buf[RESP_MSG_RESP_TX_TS_IDX],(uint32_t)resp_rx_ts_i64,&rx_buf[RESP_MSG_ANC_DISTOFFSET],test2,(uint32_t)poll_tx_ts_i64);


                           if(rec_nearbasepos>=nearbase_num)          //发现新的基站


                           {


@@ -508,7 +541,7 @@


              


                     memset(rx_buf, 0, sizeof(rx_buf));//清空接收到的用完的数组


                     rx_length=0;//清0长度


//                     uwb_rx(0, 0, RESP_RX_TIMEOUT_US);//立即开启接受并设置0超时


                     uwb_rx(0, 0, RESP_RX_TIMEOUT_US);//立即开启接受并设置0超时


//                     while(mac_is_busy());


                     //break;//成功接收就退出


      }


@@ -518,8 +551,10 @@


//         #endif


      }else if(receive_flag==2){//接收出错


      receive_flag=0;


      sleep_timer_start(__MS_TO_32K_CNT(sleep_time_count-phy_timer_count_get()%10));//测试


      tempflag=uwb_rx(0, 0, RESP_RX_TIMEOUT_US);//立即开启接受并设置0超时


//      sleep_timer_start(__MS_TO_32K_CNT(SLEEP_COUNT-phy_timer_count_get()%30));//测试


//         sleep_time_step=SLEEP_COUNT-phy_timer_count_get()%10;


      //tempflag=uwb_rx(0, 0, RESP_RX_TIMEOUT_US);//立即开启接受并设置0超时


      temp_count3=phy_timer_count_get();


//      while(mac_is_busy());


      temp_count1=phy_timer_count_get();


@@ -538,6 +573,6 @@


      //dwt_forecetrxoff();


       CalculateDists(poll_tx_ts_i64); //计算距离并更新距离表


       AnchorListUpdate();//更新存活基站列表


   //    Rank_ANchor_list_by_dis();//冒泡排序重新按距离重新排列基站列表最小距离存货基站放到最前面


       Rank_ANchor_list_by_dis();//冒泡排序重新按距离重新排列基站列表最小距离存货基站放到最前面


}


#endif