123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346 |
- #include "sdk_config.h"
- #if ANT_HRM_ENABLED
- #include "nrf_assert.h"
- #include "app_error.h"
- #include "ant_interface.h"
- #include "app_util.h"
- #include "ant_hrm.h"
- #include "ant_hrm_utils.h"
- #include "app_error.h"
- #define NRF_LOG_MODULE_NAME ant_hrm
- #if ANT_HRM_LOG_ENABLED
- #define NRF_LOG_LEVEL ANT_HRM_LOG_LEVEL
- #define NRF_LOG_INFO_COLOR ANT_HRM_INFO_COLOR
- #else
- #define NRF_LOG_LEVEL 0
- #endif
- #include "nrf_log.h"
- NRF_LOG_MODULE_REGISTER();
- #define BACKGROUND_DATA_INTERVAL 64
- #define TX_TOGGLE_DIVISOR 4
- typedef struct
- {
- ant_hrm_page_t page_number : 7;
- uint8_t toggle_bit : 1;
- uint8_t page_payload[7];
- } ant_hrm_message_layout_t;
- static ret_code_t ant_hrm_init(ant_hrm_profile_t * p_profile,
- ant_channel_config_t const * p_channel_config)
- {
- p_profile->channel_number = p_channel_config->channel_number;
- p_profile->page_0 = DEFAULT_ANT_HRM_PAGE0();
- p_profile->page_1 = DEFAULT_ANT_HRM_PAGE1();
- p_profile->page_2 = DEFAULT_ANT_HRM_PAGE2();
- p_profile->page_3 = DEFAULT_ANT_HRM_PAGE3();
- p_profile->page_4 = DEFAULT_ANT_HRM_PAGE4();
- NRF_LOG_INFO("ANT HRM channel %u init", p_profile->channel_number);
- return ant_channel_init(p_channel_config);
- }
- ret_code_t ant_hrm_disp_init(ant_hrm_profile_t * p_profile,
- ant_channel_config_t const * p_channel_config,
- ant_hrm_evt_handler_t evt_handler)
- {
- ASSERT(p_profile != NULL);
- ASSERT(p_channel_config != NULL);
- ASSERT(evt_handler != NULL);
- p_profile->evt_handler = evt_handler;
- return ant_hrm_init(p_profile, p_channel_config);
- }
- ret_code_t ant_hrm_sens_init(ant_hrm_profile_t * p_profile,
- ant_channel_config_t const * p_channel_config,
- ant_hrm_sens_config_t const * p_sens_config)
- {
- ASSERT(p_profile != NULL);
- ASSERT(p_channel_config != NULL);
- ASSERT(p_sens_config != NULL);
- ASSERT(p_sens_config->p_cb != NULL);
- ASSERT(p_sens_config->evt_handler != NULL);
- ASSERT((p_sens_config->main_page_number == ANT_HRM_PAGE_0)
- || (p_sens_config->main_page_number == ANT_HRM_PAGE_4));
- p_profile->evt_handler = p_sens_config->evt_handler;
- p_profile->_cb.p_sens_cb = p_sens_config->p_cb;
- ant_hrm_sens_cb_t * p_hrm_cb = p_profile->_cb.p_sens_cb;
- p_hrm_cb->page_1_present = p_sens_config->page_1_present;
- p_hrm_cb->main_page_number = p_sens_config->main_page_number;
- p_hrm_cb->ext_page_number = p_hrm_cb->page_1_present ? ANT_HRM_PAGE_1 : ANT_HRM_PAGE_2;
- p_hrm_cb->message_counter = 0;
- p_hrm_cb->toggle_bit = true;
- return ant_hrm_init(p_profile, p_channel_config);
- }
- static ant_hrm_page_t next_page_number_get(ant_hrm_profile_t * p_profile)
- {
- ant_hrm_sens_cb_t * p_hrm_cb = p_profile->_cb.p_sens_cb;
- ant_hrm_page_t page_number;
- if (p_hrm_cb->message_counter == (BACKGROUND_DATA_INTERVAL))
- {
- page_number = p_hrm_cb->ext_page_number;
- p_hrm_cb->message_counter = 0;
- p_hrm_cb->ext_page_number++;
- if (p_hrm_cb->ext_page_number > ANT_HRM_PAGE_3)
- {
- p_hrm_cb->ext_page_number = p_hrm_cb->page_1_present ? ANT_HRM_PAGE_1 : ANT_HRM_PAGE_2;
- }
- }
- else
- {
- page_number = p_hrm_cb->main_page_number;
- }
- if (p_hrm_cb->message_counter % TX_TOGGLE_DIVISOR == 0)
- {
- p_hrm_cb->toggle_bit ^= 1;
- }
- p_hrm_cb->message_counter++;
- return page_number;
- }
- static void sens_message_encode(ant_hrm_profile_t * p_profile, uint8_t * p_message_payload)
- {
- ant_hrm_message_layout_t * p_hrm_message_payload =
- (ant_hrm_message_layout_t *)p_message_payload;
- ant_hrm_sens_cb_t * p_hrm_cb = p_profile->_cb.p_sens_cb;
- p_hrm_message_payload->page_number = next_page_number_get(p_profile);
- p_hrm_message_payload->toggle_bit = p_hrm_cb->toggle_bit;
- NRF_LOG_INFO("HRM TX Page number: %u", p_hrm_message_payload->page_number);
- ant_hrm_page_0_encode(p_hrm_message_payload->page_payload, &(p_profile->page_0));
- switch (p_hrm_message_payload->page_number)
- {
- case ANT_HRM_PAGE_0:
-
- break;
- case ANT_HRM_PAGE_1:
- ant_hrm_page_1_encode(p_hrm_message_payload->page_payload, &(p_profile->page_1));
- break;
- case ANT_HRM_PAGE_2:
- ant_hrm_page_2_encode(p_hrm_message_payload->page_payload, &(p_profile->page_2));
- break;
- case ANT_HRM_PAGE_3:
- ant_hrm_page_3_encode(p_hrm_message_payload->page_payload, &(p_profile->page_3));
- break;
- case ANT_HRM_PAGE_4:
- ant_hrm_page_4_encode(p_hrm_message_payload->page_payload, &(p_profile->page_4));
- break;
- default:
- return;
- }
- p_profile->evt_handler(p_profile, (ant_hrm_evt_t)p_hrm_message_payload->page_number);
- }
- static void ant_message_send(ant_hrm_profile_t * p_profile)
- {
- uint32_t err_code;
- uint8_t p_message_payload[ANT_STANDARD_DATA_PAYLOAD_SIZE];
- sens_message_encode(p_profile, p_message_payload);
- err_code =
- sd_ant_broadcast_message_tx(p_profile->channel_number,
- sizeof (p_message_payload),
- p_message_payload);
- APP_ERROR_CHECK(err_code);
- }
- void ant_hrm_sens_evt_handler(ant_evt_t * p_ant_evt, void * p_context)
- {
- ant_hrm_profile_t * p_profile = (ant_hrm_profile_t *)p_context;
- if (p_ant_evt->channel == p_profile->channel_number)
- {
- switch (p_ant_evt->event)
- {
- case EVENT_TX:
- ant_message_send(p_profile);
- break;
- default:
- break;
- }
- }
- }
- ret_code_t ant_hrm_disp_open(ant_hrm_profile_t * p_profile)
- {
- ASSERT(p_profile != NULL);
- NRF_LOG_INFO("ANT HRM channel %u open", p_profile->channel_number);
- return sd_ant_channel_open(p_profile->channel_number);
- }
- ret_code_t ant_hrm_sens_open(ant_hrm_profile_t * p_profile)
- {
- ASSERT(p_profile != NULL);
-
- ant_message_send(p_profile);
- NRF_LOG_INFO("ANT HRM channel %u open", p_profile->channel_number);
- return sd_ant_channel_open(p_profile->channel_number);
- }
- static void disp_message_decode(ant_hrm_profile_t * p_profile, uint8_t * p_message_payload)
- {
- const ant_hrm_message_layout_t * p_hrm_message_payload =
- (ant_hrm_message_layout_t *)p_message_payload;
- NRF_LOG_INFO("HRM RX Page Number: %u", p_hrm_message_payload->page_number);
- ant_hrm_page_0_decode(p_hrm_message_payload->page_payload, &(p_profile->page_0));
- switch (p_hrm_message_payload->page_number)
- {
- case ANT_HRM_PAGE_0:
-
- break;
- case ANT_HRM_PAGE_1:
- ant_hrm_page_1_decode(p_hrm_message_payload->page_payload, &(p_profile->page_1));
- break;
- case ANT_HRM_PAGE_2:
- ant_hrm_page_2_decode(p_hrm_message_payload->page_payload, &(p_profile->page_2));
- break;
- case ANT_HRM_PAGE_3:
- ant_hrm_page_3_decode(p_hrm_message_payload->page_payload, &(p_profile->page_3));
- break;
- case ANT_HRM_PAGE_4:
- ant_hrm_page_4_decode(p_hrm_message_payload->page_payload, &(p_profile->page_4));
- break;
- default:
- return;
- }
- p_profile->evt_handler(p_profile, (ant_hrm_evt_t)p_hrm_message_payload->page_number);
- }
- void ant_hrm_disp_evt_handler(ant_evt_t * p_ant_evt, void * p_context)
- {
- ant_hrm_profile_t * p_profile = ( ant_hrm_profile_t *)p_context;
- if (p_ant_evt->channel == p_profile->channel_number)
- {
- switch (p_ant_evt->event)
- {
- case EVENT_RX:
- if (p_ant_evt->message.ANT_MESSAGE_ucMesgID == MESG_BROADCAST_DATA_ID
- || p_ant_evt->message.ANT_MESSAGE_ucMesgID == MESG_ACKNOWLEDGED_DATA_ID
- || p_ant_evt->message.ANT_MESSAGE_ucMesgID == MESG_BURST_DATA_ID)
- {
- disp_message_decode(p_profile, p_ant_evt->message.ANT_MESSAGE_aucPayload);
- }
- break;
- default:
- break;
- }
- }
- }
- #endif
|