From f8013e4f432b323dfc3e3725a62858e73176742a Mon Sep 17 00:00:00 2001
From: zhangbo <zhangbo@qq.com>
Date: 星期五, 01 十一月 2024 15:16:32 +0800
Subject: [PATCH] 更换了新的sdk，测试了实际的uwb测距
---
keil/include/components/app/src/uwb_test.c | 36 ++++++++++++++++++++++++++++++++++--
1 files changed, 34 insertions(+), 2 deletions(-)
diff --git a/keil/include/components/app/src/uwb_test.c b/keil/include/components/app/src/uwb_test.c
index 5cbd453..4aab368 100644
--- a/keil/include/components/app/src/uwb_test.c
+++ b/keil/include/components/app/src/uwb_test.c
@@ -158,8 +158,17 @@
ind->rx.phy_timer_count = rx->timestamp;
ind->rx.phr_bits = (uint16_t)rx->phy_header;
ind->rx.status = rx->err_code;
- ind->rx.rssi = rx->rssi;
- ind->rx.snr = rx->snr;
+ // ind->rx.rssi = rx->rssi;
+ // ind->rx.snr = rx->snr;
+ ind->rx.rssi = correct_rssi(rx->rssi);
+ ind->rx.snr = correct_snr(rx->snr);
+
+#if CSI_EN
+ if (ranging_debug_csi_en_get() == 0)
+ {
+ ranging_debug_csi_en_set(1);
+ }
+#endif
if (rx->err_code == UWB_RX_OK)
{
@@ -205,6 +214,29 @@
}
}
}
+#if CSI_EN
+ if (ranging_debug_csi_en_get())
+ {
+ uint8_t frame_idx = 0;
+ debug_csi.frame_idx = frame_idx;
+
+ uint32_t val = REG_READ(0x40003050);
+ debug_csi.frame[frame_idx].rf_gain = (val & 0x07);
+ debug_csi.frame[frame_idx].bb_gain = ((val >> 3) & 0x1f);
+ debug_csi.frame[frame_idx].bd_cnt = phy_bd_cnt_get();
+ debug_csi.frame[frame_idx].sfd_cnt = phy_sfd_cnt_get();
+ debug_csi.frame[frame_idx].error_code = ind->rx.status;
+ if (rx->err_code != 0x0830)
+ {
+ debug_csi.frame[frame_idx].rssi = ind->rx.rssi;
+ debug_csi.frame[frame_idx].snr = ind->rx.snr;
+ debug_csi.frame[frame_idx].channel_power = REG_READ(0x40002064);
+ debug_csi.frame[frame_idx].noise_power = REG_READ(0x40002078);
+ dump_preamble_cir(frame_idx, 128);
+ dump_sts_cir(frame_idx);
+ }
+ }
+#endif
}
// Send the message
--
Gitblit v1.9.3