From 00efc8bfb6351b8f6ef9914c72374fb9ca61edf9 Mon Sep 17 00:00:00 2001
From: WXK <287788329@qq.com>
Date: 星期五, 03 一月 2025 17:13:26 +0800
Subject: [PATCH] uwb升级读取写入信标
---
keil/uwb_app.c | 232 +++++++++++++++++++++++++++++++++++++++++++++-------------
1 files changed, 180 insertions(+), 52 deletions(-)
diff --git a/keil/uwb_app.c b/keil/uwb_app.c
index 8d8a0cc..e2d1246 100644
--- a/keil/uwb_app.c
+++ b/keil/uwb_app.c
@@ -10,7 +10,7 @@
#include "global_param.h"
#include "board.h"
#include "lib_aoa.h"
-
+#include <serial_at_cmd_app.h>
extern int simple_main(void);
extern int temp_main(void);
void Calibration_Time(void);
@@ -136,7 +136,7 @@
#ifdef DW1000
static struct mk_uwb_configure config = {
.phy_work_mode = (uint8_t)(PHY_TX | PHY_RX),
- .phy_cfg.ch_num = 5, /* Channel number. */
+ .phy_cfg.ch_num = 9, /* Channel number. */
.phy_cfg.code_index = 9, /* TRX preamble code */
.phy_cfg.mean_prf = MEAN_PRF_64M, /* Mean prf 64/128/256M */
.phy_cfg.data_bit_rate = DATA_BR_6M8, /* Data rate 6.8M */
@@ -282,8 +282,17 @@
uint32_t range_timeout_us = 2000000;//yuan5000
uint8_t flag_temp2,flag_temp1;
uint16_t uwb_losttimer;
+uint8_t lorarec_usart_send[200]={0x55,0xaa};
+uint16_t lorarec_tagid;
+extern uint8_t send_lora_data[250];
+uint8_t Lora_upanc_time;
+uint8_t update_tag_time;
+extern uint16_t mubiao_anchor_ID;
+uint8_t Lora_qingqiu_flag;
+extern uint16_t Lora_qingqiu_bao;
static void rx_int_callback(struct MAC_HW_REPORT_T *rx_report)
{ uint8_t valid_sts=0;
+ uint16_t checksum1 = 0,dest_id;
// Power off radio
power_off_radio();
@@ -301,7 +310,74 @@
poll_rx_num++;
rssi = rx_report->rssi;
receive_flag=1;
- Anchor_App();
+// uart_send(UART_ID0, rx_buf,rx_length, NULL);
+ if(rx_buf[MESSAGE_TYPE_IDX]==MBX_POLL)
+ {
+ Anchor_App();
+ }
+ else
+ {
+ memcpy(&lorarec_tagid,&rx_buf[SOURCE_ID_IDX],2);
+ memcpy(&dest_id,&rx_buf[DEST_ID_IDX],2);
+ checksum1=Checksum_u16(rx_buf,rx_length-4);
+ if(!memcmp(&checksum1,&rx_buf[rx_length-4],2)) //CRC16校验是否通过
+ {
+ if(!memcmp(&dev_id,&dest_id,2)/*||dest_id==0xffff||(dest_id==0xfffe&&get_channel==5)*/)
+ {
+ switch(rx_buf[MSG_TYPE_IDX])
+ {
+ case LORA_MSGTYPE_UPDATE_CONFIRM:
+ memset(&send_lora_data,0,sizeof(send_lora_data));
+// Lora_upanc_flag=1; //升级信号启动
+ update_tag_time=20;
+ mubiao_anchor_ID=lorarec_tagid;
+ LOG_INFO(TRACE_MODULE_APP, "收到基站发送来的升级请求\r\n");
+ break;
+ case LORA_MSGTYPE_UPDATEFILE_REQUEST:
+ Lora_upanc_time=0;//数清零,不清零10次后重启
+
+ memcpy(&Lora_qingqiu_bao,&rx_buf[MUQIAN_BAG],2);
+ // Lora_qingqiu_bao=rx_buffer[MUQIAN_BAG];//看基站请求的哪一包
+ Lora_qingqiu_flag= 1; //准备发送标志位1
+ update_tag_time=20;
+// LOG_INFO(TRACE_MODULE_APP, "标签正在请求第%d包\r\n",Lora_qingqiu_bao);
+ Lora_upanc_ing_Poll();
+ break;
+
+ case 0x99:
+ LOG_INFO(TRACE_MODULE_APP, "收到结束升级请求\r\n",Lora_qingqiu_bao);
+ delay_ms(500);
+// Lora_upanc_flag=0;
+ Lora_qingqiu_flag=0;
+ NVIC_SystemReset();
+ break;
+
+ }
+ }
+ }
+ else
+ {
+// switch(rx_buf[MSG_TYPE_IDX])
+// {
+// case LORA_MSGTYPE_READPARARESP:
+ if(rx_buf[MSG_TYPE_IDX]==LORA_MSGTYPE_READPARARESP)
+ {
+ memcpy(&lorarec_usart_send[2],rx_buf,rx_length);
+ uart_send(UART_ID0, lorarec_usart_send,rx_length+2, NULL);
+ for(uint8_t i=0; i<PWTAG_MAXGROUPNUM; i++)
+ {
+ if(pwtag.groupid[i][0]<=lorarec_tagid&&lorarec_tagid<=pwtag.groupid[i][1])
+ {
+ pwtag.remain_time[i] = 0;
+ }
+ }
+// break;
+ }
+
+// }
+ }
+ }
+
#ifdef STS_MODE
valid_sts= sts_valid_check();
if (valid_sts)
@@ -329,9 +405,10 @@
temp_count= phy_timer_count_get();
memcpy(&rx_rpt, rx_report, sizeof(struct MAC_HW_REPORT_T));
rx_length = 0;
- OpenUWB();//再次开启UWB接收
+// OpenUWB();//再次开启UWB接收
}
- //OpenUWB();//再次开启UWB接收
+ OpenUWB();//再次开启UWB接收
+// LOG_INFO(TRACE_MODULE_APP,"RXdone_uwb_rx打开\r\n");
}
/* TX done process handler. */
@@ -346,7 +423,11 @@
temp_count= phy_timer_count_get();
temp_internal=temp_count;
resp_tx_num++;
- OpenUWB();//再次开启UWB接收
+// if(update_tag_time>0)
+// {
+// OpenUWB();//再次开启UWB接收
+// LOG_INFO(TRACE_MODULE_APP,"TXdone_uwb_rx打开\r\n");
+// }
//LOG_INFO(TRACE_MODULE_APP, "poll_rx_num is %d,resp_tx_num is %d\r\n",poll_rx_num,resp_tx_num);
}
}
@@ -443,10 +524,41 @@
anchordata_num=j;
}
-
-
+uint16_t g_com_receive_id;
+uint8_t cmd_flag;
uint8_t Anchor_RecNearPoll(uint8_t ancrec_nearbasepos)//根据自己是否为新基站定制消息去发送，根据是否抢占判断
{
+ cmd_flag=0;
+ uint16_t checksum1 = 0;
+ for(uint8_t i=0; i<PWTAG_MAXGROUPNUM; i++)
+ {
+ if(pwtag.remain_time[i]!=0)
+ {
+ lorarec_tagid=g_com_receive_id;
+ if(pwtag.groupid[i][0]<=lorarec_tagid&&lorarec_tagid<=pwtag.groupid[i][1])
+ {
+ send_buffer[MSG_TYPE_IDX] = LORA_MSGTYPE_WGRESPTAG;
+ send_buffer[MSG_LENGTH] = 14;
+ memcpy(&send_buffer[SOURCE_ID_IDX],&dev_id,2);
+ memcpy(&send_buffer[DEST_ID_IDX],&lorarec_tagid,2);
+ send_buffer[RW_FLAG_IDX] = pwtag.duorxie[i];
+ send_buffer[WRITE_IDX_IDX] = pwtag.index[i];
+ memcpy(&send_buffer[WRITE_VALUE_IDX],pwtag.value[i],pwtag.len[i]);
+
+ checksum1=Checksum_u16(send_buffer,pwtag.len[i]+WRITE_VALUE_IDX);
+ memcpy(&send_buffer[pwtag.len[i]+WRITE_VALUE_IDX],&checksum1,2);
+ resp_tx_en_start_u32 = poll_rx_en_start_u32+US_TO_PHY_TIMER_COUNT(POLL_RX_TO_RESP_TX_DLY_US);
+ flag_temp2=uwb_tx(send_buffer, pwtag.len[i]+WRITE_VALUE_IDX+2,1 ,resp_tx_en_start_u32);//立即发送测试size大小
+ // temp_count1=phy_timer_count_get();
+ //while(mac_is_busy());
+ gpio_pin_clr(SCL_PIN);
+ cmd_flag=1;
+ break;
+ }
+ }
+ }
+ if(cmd_flag==0)
+ {
temp_count2=poll_rx_en_start_u32;
memcpy(&send_buffer[GROUP_ID_IDX],&group_id,1);//组id
@@ -478,6 +590,8 @@
// temp_count1=phy_timer_count_get();
//while(mac_is_busy());
gpio_pin_clr(SCL_PIN);
+ }
+
}
uint16_t uwb_searchcount;
@@ -536,25 +650,28 @@
// update_led_power_state();//更新等状态防止震动卡死在搜索
}
}
-uint16_t g_com_receive_id;
+
void CloseUWB(void)
{
uwb_rx_force_off(1);
uwb_rx_flag=0;
- LOG_INFO(TRACE_MODULE_APP,"关闭uwb_rx\r\n");
+// LOG_INFO(TRACE_MODULE_APP,"关闭uwb_rx\r\n");
}
void OpenUWB(void)
{
flag_temp1=uwb_rx(0, 0,range_timeout_us);//提交接收请求
uwb_rx_flag=1;
- LOG_INFO(TRACE_MODULE_APP,"打开uwb_rx\r\n");
+// LOG_INFO(TRACE_MODULE_APP,"打开uwb_rx\r\n");
}
void UWBOneSecondTask(void)
{
uwb_losttimer++;
+ TagListUpdate();
if(uwb_losttimer>g_com_map[UWB_RNAGE_TIME])
uwb_losttimer=g_com_map[UWB_RNAGE_TIME]+1;//防止溢出
}
+uint8_t uwbsend[200];
+
void UWBIdleTask(void)
{
@@ -562,50 +679,61 @@
{
uwbtasktimer = HIDO_TimerGetTick();
UWBOneSecondTask();
+ uwbsend[0]=0x55;
+ uwbsend[1]=0xaa;
+ uwbsend[2]=0x40;
+ uwbsend[3]=anchordata_num;
+ memcpy(&uwbsend[4],&anchordata_id,anchordata_num*2);
+ memcpy(&uwbsend[4+anchordata_num*2],&anchordata_dist,anchordata_num*2);
+ uart_send(UART_ID0, uwbsend,anchordata_num*4+4, NULL);
+// for(int i=0;i<anchordata_num;i++)
+// {
+// LOG_INFO(TRACE_MODULE_APP,"当前测距基站ID:%x,距离:%d.\r\n",anchordata_id[i],anchordata_dist[i]);
+// }
}
}
int uwb_app_poll(void)
{
- switch(wltag_state)
- {
- case RANGE:
- if(HIDO_TimerGetTick()-wltag_uwbtimer>2&&uwb_rx_flag==0)
- {
- wltag_uwbtimer = HIDO_TimerGetTick();
- OpenUWB();
- }
- else if(HIDO_TimerGetTick()-wltag_uwbtimer>1&&uwb_rx_flag==1)
- {
- wltag_uwbtimer = HIDO_TimerGetTick();
- CloseUWB();
- }
- if(uwb_losttimer>g_com_map[UWB_RNAGE_TIME])
- {
- wltag_statetimer = HIDO_TimerGetTick();
- if(uwb_rx_flag==0)//若要切换到搜索模式时没有开启则开启UWB
- {
- OpenUWB();
- }
- wltag_state = SEARCH;
- }
- break;
- case SEARCH:
- if(HIDO_TimerGetTick()-wltag_statetimer>1)
- {
- wltag_statetimer = HIDO_TimerGetTick();
- wltag_state = CLOSE;
- CloseUWB();
- }
- break;
- case CLOSE:
- if(HIDO_TimerGetTick()-wltag_statetimer>g_com_map[UWB_WAIT_TIME])
- {
- wltag_statetimer = HIDO_TimerGetTick();
- wltag_state = SEARCH;
- OpenUWB();
- }
- break;
- }
+// switch(wltag_state)
+// {
+// case RANGE:
+// if(HIDO_TimerGetTick()-wltag_uwbtimer>2&&uwb_rx_flag==0)
+// {
+// wltag_uwbtimer = HIDO_TimerGetTick();
+// OpenUWB();
+// }
+// else if(HIDO_TimerGetTick()-wltag_uwbtimer>1&&uwb_rx_flag==1)
+// {
+// wltag_uwbtimer = HIDO_TimerGetTick();
+// CloseUWB();
+// }
+// if(uwb_losttimer>g_com_map[UWB_RNAGE_TIME])
+// {
+// wltag_statetimer = HIDO_TimerGetTick();
+// if(uwb_rx_flag==0)//若要切换到搜索模式时没有开启则开启UWB
+// {
+// OpenUWB();
+// }
+// wltag_state = SEARCH;
+// }
+// break;
+// case SEARCH:
+// if(HIDO_TimerGetTick()-wltag_statetimer>1)
+// {
+// wltag_statetimer = HIDO_TimerGetTick();
+// wltag_state = CLOSE;
+// CloseUWB();
+// }
+// break;
+// case CLOSE:
+// if(HIDO_TimerGetTick()-wltag_statetimer>g_com_map[UWB_WAIT_TIME])
+// {
+// wltag_statetimer = HIDO_TimerGetTick();
+// wltag_state = SEARCH;
+// OpenUWB();
+// }
+// break;
+// }
UWBIdleTask();
}
int Anchor_App(void)
@@ -650,7 +778,7 @@
Anchor_RecNearPoll(i);
}
}else{
- OpenUWB();//接收到不是自己的包再次开启UWB接收
+// OpenUWB();//接收到不是自己的包再次开启UWB接收
}
}
--
Gitblit v1.9.3