From c6bf7d2728868250e6b219a55bdc7bf4245b8d7c Mon Sep 17 00:00:00 2001
From: chen <15335560115@163.com>
Date: 星期二, 27 五月 2025 14:47:34 +0800
Subject: [PATCH] 加入snr打印逻辑
---
keil/uwb_app.c | 21 +++++++++++++++++----
1 files changed, 17 insertions(+), 4 deletions(-)
diff --git a/keil/uwb_app.c b/keil/uwb_app.c
index 78c6121..a2bdf68 100644
--- a/keil/uwb_app.c
+++ b/keil/uwb_app.c
@@ -62,6 +62,7 @@
int32_t distance;
uint8_t taglist_num;
float *sts_rssi=NULL;
+float *sts_rssi1=NULL;
extern uint8_t recev_error_num;
extern Operation_step UWB_work_state;
@@ -260,6 +261,8 @@
uint8_t usart_send1[40];
extern uint8_t bat_percent;
double angle_temp;
+float sts_first_rssi_result[4];
+float rssi_result[4];
double angle_calculate(void)
{
double offset;
@@ -269,6 +272,7 @@
// pdoa[2] = pdoa_select_get(2, 3);
//LOG_INFO(TRACE_MODULE_APP, "PDOA:%f,%f,%f\r\n", pdoa[0], pdoa[1], pdoa[2]);
float *iq1 = sts_first_path_iq_get();
+
//LOG_INFO(TRACE_MODULE_APP, "ANT0 IQ: %f %f\r\n", iq1[0], iq1[1]);
//LOG_INFO(TRACE_MODULE_APP, "ANT1 IQ: %f %f\r\n", iq1[2], iq1[3]);
//LOG_INFO(TRACE_MODULE_APP, "ANT2 IQ: %f %f\r\n", iq1[4], iq1[5]);
@@ -298,8 +302,15 @@
//{
//angle2+=180;
//}
+
+//计算端口0和3 rssi和STS 第一路径rssi
+sts_first_rssi_result[0]=iq1[0]*iq1[0]+iq1[1]*iq1[1];//计算天线0的sts rssi
+sts_first_rssi_result[1]=iq1[6]*iq1[6]+iq1[7]*iq1[7];//计算天线3的sts rssi
+rssi_result[0]=20 * log10(sts_first_rssi_result[0] / sts_first_rssi_result[1]) + rssi;//根据相对rssi计算天线0的rssi
+rssi_result[1]=rssi;
return angle;
}
+int8_t snr_result[2];
void buffer_construct(uint16_t tag_id,uint16_t distance_temp,int16_t angle1,uint8_t rssi1)
{
uint16_t checksum = 0;
@@ -313,7 +324,7 @@
usart_send[10] = (uint8_t)rssi1;
usart_send[11] = 0; //BUTTON目前先不写
usart_send[12] = bat_percent; //BATTARY目前先不写
- usart_send[13] = 0; //RESERVE1
+ usart_send[13] = (uint8_t)snr_result[1]; //RESERVE1
usart_send[14] = 0; //RESERVE2
checksum = Checksum_u16(&usart_send[2], 13+10);
memcpy(&usart_send[15+10], &checksum, 2);
@@ -321,9 +332,10 @@
char log_buf[300];
uint32_t u32LogLen1,dataloglenth;
uint32_t cnt_log;
+
void buffer_log_send(uint16_t tag_id,uint16_t distance_temp,int16_t angle1)
{
- dataloglenth = snprintf((char*)&log_buf,sizeof(log_buf), "DATA,%x,%d,%d,%d\n",tag_id,cnt_log++,angle1,distance_temp);
+ dataloglenth = snprintf((char*)&log_buf,sizeof(log_buf), "DATA,%x,%d,%d,%d,%d,%d\n",tag_id,cnt_log++,angle1,distance_temp,(int32_t)rssi_result[1],snr_result[1]);
uart_send(TRACE_PORT_UART0,log_buf,dataloglenth,NULL);
}
void buffer_construct_user(uint16_t tag_id)
@@ -357,6 +369,7 @@
poll_rx_ts_i64 = ranging_rx_time_correct(&rx_rpt);
poll_rx_num++;
rssi = rx_report->rssi;
+ snr_result[1]=rx_report->snr;
receive_flag=1;
}
@@ -938,8 +951,8 @@
}else{
angle_temp+=pd_offset;
buffer_construct(tag_id_recv,distance,(int16_t)angle_temp,rssi);
- uart_send(TRACE_PORT_UART0,usart_send,10+17,NULL);
- //buffer_log_send(tag_id_recv,distance,(int16_t)angle_temp);
+ //uart_send(TRACE_PORT_UART0,usart_send,10+17,NULL);
+ buffer_log_send(tag_id_recv,distance,(int16_t)angle_temp);
}
//LOG_INFO(TRACE_MODULE_APP,"标签ID：%X,距离: %d 角度 :%lf\r\n",g_com_receive_id,distance,angle_temp);
--
Gitblit v1.9.3