From cc432b761c884a0bd8e9d83db0a4e26109fc08b1 Mon Sep 17 00:00:00 2001
From: chen <15335560115@163.com>
Date: 星期五, 08 十一月 2024 15:35:38 +0800
Subject: [PATCH] 安邦手环GPS删除部分无用数据和修改4G波特率9600出厂测试固件
---
keil/include/components/app/src/uwb_radar.c | 299 +++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
1 files changed, 299 insertions(+), 0 deletions(-)
diff --git a/keil/include/components/app/src/uwb_radar.c b/keil/include/components/app/src/uwb_radar.c
new file mode 100644
index 0000000..6f6eacc
--- /dev/null
+++ b/keil/include/components/app/src/uwb_radar.c
@@ -0,0 +1,299 @@
+/*
+ * Copyright (c) 2019-2023 Beijing Hanwei Innovation Technology Ltd. Co. and
+ * its subsidiaries and affiliates (collectly called MKSEMI).
+ *
+ * All rights reserved.
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * 1. Redistributions of source code must retain the above copyright notice,
+ * this list of conditions and the following disclaimer.
+ *
+ * 2. Redistributions in binary form, except as embedded into an MKSEMI
+ * integrated circuit in a product or a software update for such product,
+ * must reproduce the above copyright notice, this list of conditions and
+ * the following disclaimer in the documentation and/or other materials
+ * provided with the distribution.
+ *
+ * 3. Neither the name of MKSEMI nor the names of its contributors may be used
+ * to endorse or promote products derived from this software without
+ * specific prior written permission.
+ *
+ * 4. This software, with or without modification, must only be used with a
+ * MKSEMI integrated circuit.
+ *
+ * 5. Any software provided in binary form under this license must not be
+ * reverse engineered, decompiled, modified and/or disassembled.
+ *
+ * THIS SOFTWARE IS PROVIDED BY MKSEMI "AS IS" AND ANY EXPRESS OR IMPLIED
+ * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
+ * MERCHANTABILITY, NONINFRINGEMENT, AND FITNESS FOR A PARTICULAR PURPOSE ARE
+ * DISCLAIMED. IN NO EVENT SHALL MKSEMI OR CONTRIBUTORS BE LIABLE FOR ANY
+ * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
+ * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
+ * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
+ * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
+ * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
+ * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include "mk_trace.h"
+#include "mk_power.h"
+#include "mk_uwb.h"
+#include "mk_timer.h"
+#include "wsf_msg.h"
+#include "uwb_api.h"
+#include "mk_radar.h"
+#include "uwb_radar.h"
+#if UWB_DUAL_RADAR
+#include "lib_fira.h"
+#endif
+
+// #include "board.h"
+
+#ifndef UWB_RADAR_INTERVAL
+/** Radar standalone mode interval, unit: ms */
+#define UWB_RADAR_INTERVAL (100)
+#endif
+
+struct UWB_RADAR_ENV_T radar_env;
+
+static struct UWB_RADAR_CB_T uwb_radar_cb;
+
+static struct UWB_OP_T radar_op = {
+ .session_configure = NULL,
+ .session_start = NULL,
+ .session_stop = NULL,
+ .session_local_addr_set = NULL,
+ .session_peer_addr_set = NULL,
+ .session_responder_addr_add = NULL,
+ .session_responder_list_clr = NULL,
+ .session_dynamic_update_responder_list = NULL,
+ .session_set_ccc_ursk = NULL,
+ .vendor_session_configure = uwb_radar_configure,
+ .vendor_session_start = uwb_radar_start,
+ .vendor_session_stop = uwb_radar_stop,
+};
+
+static mac_callback_t bak_tx_cb;
+static mac_callback_t bak_rx_cb;
+
+static mac_callback_t force_bak_tx_cb;
+static mac_callback_t force_bak_rx_cb;
+
+static void uwb_radar_tx_process(struct MAC_HW_REPORT_T *tx_report);
+static void uwb_radar_rx_process(struct MAC_HW_REPORT_T *rx_report);
+
+void uwb_radar_session_init(void);
+
+static void uwb_radar_tx_process(struct MAC_HW_REPORT_T *tx_report)
+{
+ radar_env.rx_ant_idx++;
+ if (radar_env.rx_ant_idx == UWB_RADAR_RX_PORT_NUM)
+ {
+ radar_env.rx_ant_idx = 0;
+ }
+
+#if UWB_RADAR_1TNR_MODE == 1
+ // board_led_on(BOARD_LED_2);
+ if (radar_env.rx_ant_idx == 0)
+ {
+ power_off_radio();
+ WsfSetEvent(uwb_radar_cb.handle_id, UWB_RADAR_SAMPLING_COMPLETE_EVT);
+ }
+ else
+ {
+ radar_start(radar_env.rx_ant_idx);
+ }
+ // board_led_off(BOARD_LED_2);
+#else
+ power_off_radio();
+ WsfSetEvent(uwb_radar_cb.handle_id, UWB_RADAR_SAMPLING_COMPLETE_EVT);
+#endif
+}
+
+static void uwb_radar_rx_process(struct MAC_HW_REPORT_T *rx_report)
+{
+ // do nothing
+}
+
+int uwb_radar_init(uint8_t handle_id)
+{
+ /* store handler ID */
+ uwb_radar_cb.handle_id = handle_id;
+
+ /* init rx queue */
+ WSF_QUEUE_INIT(&uwb_radar_cb.msg_queue);
+
+ uwb_radar_cb.radar_alone_timer.handlerId = handle_id;
+ uwb_radar_cb.radar_alone_timer.msg.event = UWB_RADAR_ALONE_WAKEUP_MSG;
+
+ radar_env.sample_count = 0;
+ radar_env.sample_num = 0;
+
+ return 0;
+}
+
+void uwb_radar_alone_timer_set(void)
+{
+ WsfTimerStartMs(&uwb_radar_cb.radar_alone_timer, UWB_RADAR_INTERVAL, WSF_TIMER_PERIODIC);
+}
+
+void uwb_radar_alone_timer_clr(void)
+{
+ WsfTimerStop(&uwb_radar_cb.radar_alone_timer);
+}
+
+int uwb_radar_deinit(void)
+{
+ return 0;
+}
+
+uint32_t uwb_is_radar_mode(void)
+{
+ uint32_t isenable = 0;
+
+ uint32_t lock = int_lock();
+ isenable = radar_env.enable;
+ int_unlock(lock);
+
+ return isenable;
+}
+
+void uwb_radar_start(void)
+{
+ uint32_t lock = int_lock();
+ radar_env.sample_count = 0;
+ radar_env.sample_num = 0;
+ radar_env.rx_ant_idx = 0;
+ radar_env.enable = 0x1U;
+ mac_get_process_handler(&force_bak_tx_cb, &force_bak_rx_cb);
+ int_unlock(lock);
+
+ if (SESSION_TYPE_VENDOR_ALONE_RADAR == uwb_app_config.session_type)
+ {
+ uwb_radar_alone_timer_set();
+ }
+}
+
+void uwb_radar_stop(void)
+{
+ uint32_t lock = int_lock();
+ radar_env.sample_count = 0;
+ radar_env.sample_num = 0;
+ radar_env.enable = 0x0U;
+ int_unlock(lock);
+
+ if (SESSION_TYPE_VENDOR_ALONE_RADAR == uwb_app_config.session_type)
+ {
+ radar_disable();
+ }
+}
+
+/**
+ * @brief UWB radar session initialization function.
+ * @note This function will be called by uwbapi_session_init().
+ */
+void uwb_radar_session_init(void)
+{
+ uwb_radar_creat_event();
+
+ uwbs_handler_init(&radar_op);
+}
+
+void uwb_radar_configure(void)
+{
+ struct UWB_RADAR_T radar_param;
+ radar_param.request = uwb_app_config.session_param.uwb_radar_req;
+ radar_param.ant_id = uwb_app_config.session_param.uwb_radar_rx_ant_id;
+ radar_param.bandwidth = uwb_app_config.session_param.uwb_radar_bandwidth;
+ radar_param.channel_num = uwb_app_config.session_param.uwb_radar_channel_num;
+ radar_param.lna_gain_level = uwb_app_config.session_param.uwb_radar_lna_gain_level;
+ radar_param.pulse_period = uwb_app_config.session_param.uwb_radar_pulse_period;
+ radar_param.ranging_tx_power_level = uwb_app_config.session_param.tx_power_level;
+ radar_param.rx_gain_level = uwb_app_config.session_param.uwb_radar_rx_gain_level;
+ radar_param.sts_len = uwb_app_config.session_param.uwb_radar_sts_len;
+ radar_param.tx_power_level = uwb_app_config.session_param.uwb_radar_tx_power_level;
+ radar_config(&radar_param);
+}
+
+void uwb_radar_alone_continue_trigger(void)
+{
+ WsfSetEvent(uwb_radar_cb.handle_id, UWB_RADAR_START_SAMPLING_EVT);
+}
+
+void uwb_radar_force_destroy_event(void)
+{
+ uint32_t lock = int_lock();
+ mac_register_process_handler(force_bak_tx_cb, force_bak_rx_cb);
+ int_unlock(lock);
+}
+
+void uwb_radar_creat_event(void)
+{
+ uint32_t lock = int_lock();
+
+ if (0 == radar_env.sample_count)
+ {
+ mac_get_process_handler(&bak_tx_cb, &bak_rx_cb);
+ mac_register_process_handler(uwb_radar_tx_process, uwb_radar_rx_process);
+ }
+
+ int_unlock(lock);
+}
+
+void uwb_radar_destroy_event(void)
+{
+ uint32_t lock = int_lock();
+
+ radar_env.sample_count++;
+ if (radar_env.sample_count >= radar_env.sample_num)
+ {
+ radar_env.sample_count = 0;
+ mac_register_process_handler(bak_tx_cb, bak_rx_cb);
+ bak_tx_cb = NULL;
+ bak_rx_cb = NULL;
+ }
+ else
+ {
+ uwb_radar_alone_continue_trigger();
+ }
+
+ int_unlock(lock);
+}
+
+bool ranging_twr_idle_evt(uint32_t idle_duration)
+{
+ bool ret = true;
+
+ radar_env.sample_num = idle_duration / UWB_RADAR_SLOT_DURATION;
+#if UWB_DUAL_RADAR
+ if (ranging_env.responder_slot_idx[SLOT_RESPONSE] == 2)
+ {
+ radar_env.sample_num = (idle_duration / UWB_RADAR_SLOT_DURATION) / 2 + (idle_duration / UWB_RADAR_SLOT_DURATION) % 2;
+ }
+#endif
+ // LOG_INFO(TRACE_MODULE_APP, "radar rounds: %u\r\n", radar_env.sample_num);
+
+ if (radar_env.sample_num)
+ {
+ uwb_radar_alone_continue_trigger();
+ ret = false;
+ }
+
+ return ret;
+}
+
+uint16_t uwb_radar_data_checksum(const uint8_t *data, uint32_t data_len)
+{
+ uint32_t sum = 0;
+ uint16_t check_sum = 0;
+ for (uint32_t i = 0; i < data_len; i++)
+ {
+ sum ^= *(data + i);
+ }
+ check_sum = (uint16_t)(sum & 0xFFFF);
+
+ return check_sum;
+}
--
Gitblit v1.9.3