From e328ebef585cea2351b37117b2d5ac4978ecd3c0 Mon Sep 17 00:00:00 2001
From: WXK <287788329@qq.com>
Date: 星期二, 11 二月 2025 14:57:23 +0800
Subject: [PATCH] 1111111
---
keil/include/components/app/src/ranging_simple_task.c | 26 ++++++++++++++++----------
1 files changed, 16 insertions(+), 10 deletions(-)
diff --git a/keil/include/components/app/src/ranging_simple_task.c b/keil/include/components/app/src/ranging_simple_task.c
index 466f0e3..dbd4285 100644
--- a/keil/include/components/app/src/ranging_simple_task.c
+++ b/keil/include/components/app/src/ranging_simple_task.c
@@ -147,6 +147,12 @@
const struct UWB_PKT_TX_DONE_IND_T *ind = (const struct UWB_PKT_TX_DONE_IND_T *)param;
uint8_t flag_print = 1;
+ if (ind->status != UWB_TX_OK)
+ {
+ LOG_INFO(TRACE_MODULE_APP, "UWB TX fail 0x%04x\r\n", ind->status);
+ break;
+ }
+
switch (ind->ranging_stage)
{
case RANGING_SYNC:
@@ -268,15 +274,7 @@
if (ind->ranging_stage == RANGING_POLL)
{
- int32_t freq_offset = phy_freq_offset_get();
- int32_t freq_offset_filter = average_filter(freq_offset);
- LOG_INFO(TRACE_MODULE_APP, "CH Freq Offset %d\r\n", freq_offset_filter);
-#if XTAL_AUTO_TUNE_EN
- int32_t ppm = freq_offset_filter / (int32_t)(ch_center_freq_map[uwb_app_config.ppdu_params.ch_num] * 1e-6);
- calib_xtal38m4_load_cap_auto_tune(ppm);
-#endif
-
- struct RANGING_MEASUREMENT_T *range_result = &ranging_env.range_data.measurements[0];
+ struct TWR_MEASUREMENT_T *range_result = &ranging_env.range_data.measurements[0];
uint8_t NLoS, FoM;
ranging_fom_get(&NLoS, &FoM);
range_result->NLoS = NLoS;
@@ -328,7 +326,7 @@
double tof_f = (double)TIMESTAMP_UNIT_TO_NS(ranging_env.tof);
- struct RANGING_MEASUREMENT_T *range_result = &ranging_env.range_data.measurements[0];
+ struct TWR_MEASUREMENT_T *range_result = &ranging_env.range_data.measurements[0];
// update distance result
range_result->distance = (uint16_t)(tof_f * 0.299702547 * VP_VAL - RANGING_CORR);
@@ -422,6 +420,14 @@
{
LOG_INFO(TRACE_MODULE_APP, "Timestamp error\r\n");
}
+
+ int32_t freq_offset = phy_freq_offset_get();
+ int32_t freq_offset_filter = average_filter(freq_offset);
+ LOG_INFO(TRACE_MODULE_APP, "CH Freq Offset %d\r\n", freq_offset_filter);
+#if X38M4_AUTO_TUNE_EN
+ int32_t ppm = freq_offset_filter / (int32_t)(ch_center_freq_map[uwb_app_config.ppdu_params.ch_num] * 1e-6);
+ calib_xtal38m4_load_cap_auto_tune(ppm);
+#endif
}
}
else
--
Gitblit v1.9.3