xiaozhengsheng/HL-PDJ-1
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

初始版本

Browse Source
This commit is contained in:
xiaozhengsheng
2025-08-19 09:49:41 +08:00
parent 10f1ddf1c1
commit 6df0f7d96e
2974 changed files with 1712873 additions and 54 deletions
Download Patch File Download Diff File Expand all files Collapse all files

148
components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.c Normal file
View File

@@ -0,0 +1,148 @@
/**
* Copyright (c) 2015 - 2020, Nordic Semiconductor ASA
*
* 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 a Nordic
* Semiconductor ASA 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 Nordic Semiconductor ASA 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
* Nordic Semiconductor ASA 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 NORDIC SEMICONDUCTOR ASA "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 NORDIC SEMICONDUCTOR ASA 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 "sdk_config.h"
#if ANT_HRM_ENABLED
#include "ant_hrm_simulator.h"
#include "ant_hrm_utils.h"
#include "nordic_common.h"
#define ITERATION_ANT_CYCLES HRM_MSG_PERIOD_4Hz ///< period of calculation [1/32678 s], defined in ANT device profile
#define ITERATION_PERIOD (ITERATION_ANT_CYCLES * 1024 / ANT_CLOCK_FREQUENCY) ///< integer part of calculation's period [1/1024 s]
#define ITERATION_FRACTION (ITERATION_ANT_CYCLES * 1024 % ANT_CLOCK_FREQUENCY) ///< fractional part of calculation's period [1/32678 s]
void ant_hrm_simulator_init(ant_hrm_simulator_t * p_simulator,
ant_hrm_simulator_cfg_t const * p_config,
bool auto_change)
{
p_simulator->p_profile = p_config->p_profile;
p_simulator->_cb.sensorsim_cfg = p_config->sensorsim_cfg;
p_simulator->_cb.auto_change = auto_change;
p_simulator->_cb.sensorsim_state.current_val = p_simulator->_cb.sensorsim_cfg.min;
p_simulator->_cb.time_since_last_hb = 0;
p_simulator->_cb.fraction_since_last_hb = 0;
sensorsim_init(&(p_simulator->_cb.sensorsim_state), &(p_simulator->_cb.sensorsim_cfg));
}
void ant_hrm_simulator_one_iteration(ant_hrm_simulator_t * p_simulator)
{
if (p_simulator->_cb.auto_change)
{
UNUSED_PARAMETER(sensorsim_measure(&(p_simulator->_cb.sensorsim_state),
&(p_simulator->_cb.sensorsim_cfg)));
}
// @note: Take a local copy within scope in order to assist the compiler in variable register
// allocation.
const uint32_t computed_heart_rate_value = p_simulator->_cb.sensorsim_state.current_val;
// @note: This implementation assumes that the current instantaneous heart can vary and this
// function is called with static frequency.
// value and the heart rate pulse interval is derived from it. The computation is based on 60
// seconds in a minute and the used time base is 1/1024 seconds.
const uint32_t current_hb_pulse_interval = (60u * 1024u) / computed_heart_rate_value;
// update time from last hb detected
p_simulator->_cb.time_since_last_hb += ITERATION_PERIOD;
// extended celculadion by fraction make calculating accurat in long time perspective
p_simulator->_cb.fraction_since_last_hb += ITERATION_FRACTION;
uint32_t add_period = p_simulator->_cb.fraction_since_last_hb / ANT_CLOCK_FREQUENCY;
if (add_period > 0)
{
p_simulator->_cb.time_since_last_hb++;
p_simulator->_cb.fraction_since_last_hb %= ANT_CLOCK_FREQUENCY;
}
// calc number of hb as will fill
uint32_t new_beats = p_simulator->_cb.time_since_last_hb / current_hb_pulse_interval;
uint32_t add_event_time = new_beats * current_hb_pulse_interval;
if (new_beats > 0)
{
p_simulator->p_profile->HRM_PROFILE_computed_heart_rate =
(uint8_t)computed_heart_rate_value;
// Current heart beat event time is the previous event time added with the current heart rate
// pulse interval.
uint32_t current_heart_beat_event_time = p_simulator->p_profile->HRM_PROFILE_beat_time +
add_event_time;
// Set current event time.
p_simulator->p_profile->HRM_PROFILE_beat_time = current_heart_beat_event_time; // <- B<4,5> <-
// Set previous event time. // p4.B<2,3> <- B<4,5>
p_simulator->p_profile->HRM_PROFILE_prev_beat =
p_simulator->p_profile->HRM_PROFILE_beat_time - current_hb_pulse_interval;
// Event count.
p_simulator->p_profile->HRM_PROFILE_beat_count += new_beats; // B<6>
p_simulator->_cb.time_since_last_hb -= add_event_time;
}
}
void ant_hrm_simulator_increment(ant_hrm_simulator_t * p_simulator)
{
if (!p_simulator->_cb.auto_change)
{
sensorsim_increment(&(p_simulator->_cb.sensorsim_state),
&(p_simulator->_cb.sensorsim_cfg));
}
}
void ant_hrm_simulator_decrement(ant_hrm_simulator_t * p_simulator)
{
if (!p_simulator->_cb.auto_change)
{
sensorsim_decrement(&(p_simulator->_cb.sensorsim_state),
&(p_simulator->_cb.sensorsim_cfg));
}
}
#endif // ANT_HRM_ENABLED

130
components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.h Normal file
View File

@@ -0,0 +1,130 @@
/**
* Copyright (c) 2015 - 2020, Nordic Semiconductor ASA
*
* 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 a Nordic
* Semiconductor ASA 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 Nordic Semiconductor ASA 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
* Nordic Semiconductor ASA 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 NORDIC SEMICONDUCTOR ASA "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 NORDIC SEMICONDUCTOR ASA 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.
*
*/
#ifndef ANT_HRM_SIMULATOR_H__
#define ANT_HRM_SIMULATOR_H__
/** @file
*
* @defgroup ant_sdk_hrm_simulator ANT HRM simulator
* @{
* @ingroup ant_sdk_simulators
* @brief ANT HRM simulator module.
*
* @details This module simulates a pulse for the ANT HRM profile. The module calculates abstract values, which are handled
* by the HRM pages data model to ensure that they are compatible. It provides a handler for changing the heart rate
* value manually and functionality to change the heart rate value automatically.
*
*/
#include <stdint.h>
#include <stdbool.h>
#include "ant_hrm.h"
#include "ant_hrm_utils.h"
#include "sensorsim.h"
#include "ant_hrm_simulator_local.h"
#ifdef __cplusplus
extern "C" {
#endif
/**@brief HRM simulator configuration structure. */
typedef struct
{
ant_hrm_profile_t * p_profile; ///< Related profile.
sensorsim_cfg_t sensorsim_cfg; ///< Sensorsim configuration.
} ant_hrm_simulator_cfg_t;
/**@brief Initialize @ref ant_hrm_simulator_cfg_t.
*/
#define DEFAULT_ANT_HRM_SIMULATOR_CFG(P_PROFILE, MIN_HEART_RATE, MAX_HEART_RATE, INCREMENT) \
{ \
.p_profile = (P_PROFILE), \
.sensorsim_cfg.min = (MIN_HEART_RATE), \
.sensorsim_cfg.max = (MAX_HEART_RATE), \
.sensorsim_cfg.incr = (INCREMENT), \
.sensorsim_cfg.start_at_max = false, \
}
/**@brief HRM simulator structure. */
typedef struct
{
ant_hrm_profile_t * p_profile; ///< Related profile.
ant_hrm_simulator_cb_t _cb; ///< Internal control block.
} ant_hrm_simulator_t;
/**@brief Function for initializing the ANT HRM simulator instance.
*
* @param[in] p_simulator Pointer to the simulator instance.
* @param[in] p_config Pointer to the simulator configuration structure.
* @param[in] auto_change Enable or disable automatic changes of the cadence.
*/
void ant_hrm_simulator_init(ant_hrm_simulator_t * p_simulator,
ant_hrm_simulator_cfg_t const * p_config,
bool auto_change);
/**@brief Function for simulating a device event.
*
* @details Based on this event, the transmitter data is simulated.
*
* This function should be called in the HRM TX event handler.
*/
void ant_hrm_simulator_one_iteration(ant_hrm_simulator_t * p_simulator);
/**@brief Function for incrementing the cadence value.
*
* @param[in] p_simulator Pointer to the simulator instance.
*/
void ant_hrm_simulator_increment(ant_hrm_simulator_t * p_simulator);
/**@brief Function for decrementing the cadence value.
*
* @param[in] p_simulator Pointer to the simulator instance.
*/
void ant_hrm_simulator_decrement(ant_hrm_simulator_t * p_simulator);
#ifdef __cplusplus
}
#endif
#endif // ANT_HRM_SIMULATOR_H__
/** @} */

69
components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator_local.h Normal file
View File

@@ -0,0 +1,69 @@
/**
* Copyright (c) 2015 - 2020, Nordic Semiconductor ASA
*
* 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 a Nordic
* Semiconductor ASA 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 Nordic Semiconductor ASA 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
* Nordic Semiconductor ASA 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 NORDIC SEMICONDUCTOR ASA "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 NORDIC SEMICONDUCTOR ASA 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.
*
*/
#ifndef ANT_HRM_SIMULATOR_LOCAL_H__
#define ANT_HRM_SIMULATOR_LOCAL_H__
#include <stdint.h>
#include <stdbool.h>
#include "ant_hrm.h"
#include "sensorsim.h"
#ifdef __cplusplus
extern "C" {
#endif
/**
* @ingroup ant_sdk_hrm_simulator
* @brief HRM simulator control block structure. */
typedef struct
{
bool auto_change; ///< Cadence will change automatically (if auto_change is set) or manually.
uint32_t time_since_last_hb; ///< Time since last heart beat occurred (integer part).
uint64_t fraction_since_last_hb; ///< Time since last heart beat occurred (fractional part).
sensorsim_state_t sensorsim_state; ///< State of the simulated sensor.
sensorsim_cfg_t sensorsim_cfg; ///< Configuration of the simulated sensor.
} ant_hrm_simulator_cb_t;
#ifdef __cplusplus
}
#endif
#endif // ANT_HRM_SIMULATOR_LOCAL_H__