diff options
Diffstat (limited to 'thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator')
3 files changed, 347 insertions, 0 deletions
diff --git a/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.c b/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.c new file mode 100644 index 0000000..e06c7a0 --- /dev/null +++ b/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.c @@ -0,0 +1,148 @@ +/** + * Copyright (c) 2015 - 2018, 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 diff --git a/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.h b/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.h new file mode 100644 index 0000000..0d5b84e --- /dev/null +++ b/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator.h @@ -0,0 +1,130 @@ +/** + * Copyright (c) 2015 - 2018, 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__ +/** @} */ diff --git a/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator_local.h b/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator_local.h new file mode 100644 index 0000000..be16be6 --- /dev/null +++ b/thirdparty/nRF5_SDK_15.0.0_a53641a/components/ant/ant_profiles/ant_hrm/simulator/ant_hrm_simulator_local.h @@ -0,0 +1,69 @@ +/** + * Copyright (c) 2015 - 2018, 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__ |