/** * Copyright (c) 2015 - 2017, 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_common.h" #if NRF_MODULE_ENABLED(ANT_BSC) #include "nrf_assert.h" #include "nrf_error.h" #include "app_error.h" #include "ant_interface.h" #include "ant_bsc.h" #include "ant_bsc_utils.h" #define NRF_LOG_MODULE_NAME "ANT_BSC" #if ANT_BSC_LOG_ENABLED #define NRF_LOG_LEVEL ANT_BSC_LOG_LEVEL #define NRF_LOG_INFO_COLOR ANT_BSC_INFO_COLOR #else // ANT_BSC_LOG_ENABLED #define NRF_LOG_LEVEL 0 #endif // ANT_BSC_LOG_ENABLED #include "nrf_log.h" #define MAIN_DATA_INTERVAL 4 /**< The number of background data pages sent between main data pages.*/ #define BACKGROUND_DATA_INTERVAL 64 /**< The number of main data pages sent between background data page. Background data page is sent every 65th message. */ #define TX_TOGGLE_DIVISOR 4 /**< The number of messages between changing state of toggle bit. */ /**@brief BSC message data layout structure. */ typedef struct { ant_bsc_page_t page_number : 7; uint8_t toggle_bit : 1; uint8_t page_payload[7]; }ant_bsc_single_message_layout_t; typedef struct { uint8_t page_payload[8]; }ant_bsc_combined_message_layout_t; typedef union { ant_bsc_single_message_layout_t speed_or_cadence; ant_bsc_combined_message_layout_t combined; }ant_bsc_message_layout_t; /**@brief Function for initializing the ANT BSC profile instance. * * @param[in] p_profile Pointer to the profile instance. * @param[in] p_channel_config Pointer to the ANT channel configuration structure. * * @retval NRF_SUCCESS If initialization was successful. Otherwise, an error code is returned. */ static ret_code_t ant_bsc_init(ant_bsc_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_BSC_PAGE0(); p_profile->page_1 = DEFAULT_ANT_BSC_PAGE1(); p_profile->page_2 = DEFAULT_ANT_BSC_PAGE2(); p_profile->page_3 = DEFAULT_ANT_BSC_PAGE3(); p_profile->page_4 = DEFAULT_ANT_BSC_PAGE4(); p_profile->page_5 = DEFAULT_ANT_BSC_PAGE5(); p_profile->page_comb_0 = DEFAULT_ANT_BSC_COMBINED_PAGE0(); NRF_LOG_INFO("ANT BSC channel %u init\r\n", p_profile->channel_number); return ant_channel_init(p_channel_config); } ret_code_t ant_bsc_disp_init(ant_bsc_profile_t * p_profile, ant_channel_config_t const * p_channel_config, ant_bsc_disp_config_t const * p_disp_config) { ASSERT(p_profile != NULL); ASSERT(p_channel_config != NULL); ASSERT(p_disp_config->evt_handler != NULL); p_profile->evt_handler = p_disp_config->evt_handler; p_profile->_cb.p_disp_cb = p_disp_config->p_cb; p_profile->_cb.p_disp_cb->device_type = p_channel_config->device_type; return ant_bsc_init(p_profile, p_channel_config); } ret_code_t ant_bsc_sens_init(ant_bsc_profile_t * p_profile, ant_channel_config_t const * p_channel_config, ant_bsc_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_BSC_PAGE_0) || (p_sens_config->main_page_number == ANT_BSC_PAGE_5) || (p_sens_config->main_page_number == ANT_BSC_COMB_PAGE_0)); p_profile->evt_handler = p_sens_config->evt_handler; p_profile->_cb.p_sens_cb = p_sens_config->p_cb; p_profile->_cb.p_sens_cb->page_1_present = p_sens_config->page_1_present; p_profile->_cb.p_sens_cb->page_4_present = p_sens_config->page_4_present; p_profile->_cb.p_sens_cb->main_page_number = p_sens_config->main_page_number; p_profile->_cb.p_sens_cb->bkgd_page_number = p_sens_config->page_1_present ? ANT_BSC_PAGE_1 : ANT_BSC_PAGE_2; p_profile->_cb.p_sens_cb->message_counter = 0; p_profile->_cb.p_sens_cb->toggle_bit = true; p_profile->_cb.p_sens_cb->device_type = p_channel_config->device_type; /* Device type is set up in channel config */ return ant_bsc_init(p_profile, p_channel_config); } /**@brief Function for setting the next background page number. * * @param[in] p_profile Pointer to the profile instance. * */ __STATIC_INLINE void next_bkgd_page_number_set(ant_bsc_profile_t * p_profile) { /* Determine the last background page*/ ant_bsc_page_t last_bkgd_page = p_profile->_cb.p_sens_cb->page_4_present ? ANT_BSC_PAGE_4 : ANT_BSC_PAGE_3; /* Switch the background page according to user settings */ ++(p_profile->_cb.p_sens_cb->bkgd_page_number); if (p_profile->_cb.p_sens_cb->bkgd_page_number > last_bkgd_page) { p_profile->_cb.p_sens_cb->bkgd_page_number = p_profile->_cb.p_sens_cb->page_1_present ? ANT_BSC_PAGE_1 : ANT_BSC_PAGE_2; } } /**@brief Function for getting next page number to send. * * @param[in] p_profile Pointer to the profile instance. * * @return Next page number. */ static ant_bsc_page_t next_page_number_get(ant_bsc_profile_t * p_profile) { ant_bsc_page_t page_number; /* This is a single speed or cadence sensor - switch data page */ if (p_profile->_cb.p_sens_cb->message_counter < (BACKGROUND_DATA_INTERVAL)) { /* Return main page */ page_number = p_profile->_cb.p_sens_cb->main_page_number; } else { /* Return background page */ page_number = p_profile->_cb.p_sens_cb->bkgd_page_number; } /* Set page toggle bit */ if ((p_profile->_cb.p_sens_cb->message_counter % TX_TOGGLE_DIVISOR) == 0) { p_profile->_cb.p_sens_cb->toggle_bit ^= 1; } /* Update message counter, wrap when counter equals 64 + 4 */ ++(p_profile->_cb.p_sens_cb->message_counter); if (p_profile->_cb.p_sens_cb->message_counter == (BACKGROUND_DATA_INTERVAL + MAIN_DATA_INTERVAL)) { p_profile->_cb.p_sens_cb->message_counter = 0; /* Set new background data page number */ next_bkgd_page_number_set(p_profile); } return page_number; } /**@brief Function for encoding BSC message. * * @param[in] p_profile Pointer to the profile instance. * @param[out] p_message_payload Pointer to the message payload structure. * * @note Assume to be called each time when Tx window will occur. */ static void sens_message_encode(ant_bsc_profile_t * p_profile, uint8_t * p_message_payload) { ant_bsc_message_layout_t * p_bsc_message_payload = (ant_bsc_message_layout_t *)p_message_payload; ant_bsc_evt_t bsc_sens_event; if (p_profile->_cb.p_sens_cb->device_type == BSC_COMBINED_DEVICE_TYPE) { NRF_LOG_INFO("BSC TX Page: \"Combined Speed & Cadence Page\"\r\n"); ant_bsc_combined_page_0_encode(p_bsc_message_payload->combined.page_payload, &(p_profile->page_comb_0)); bsc_sens_event = (ant_bsc_evt_t) ANT_BSC_COMB_PAGE_0_UPDATED; } else { p_bsc_message_payload->speed_or_cadence.page_number = next_page_number_get(p_profile); p_bsc_message_payload->speed_or_cadence.toggle_bit = p_profile->_cb.p_sens_cb->toggle_bit; NRF_LOG_INFO("BSC TX Page number: %u\r\n", p_bsc_message_payload->speed_or_cadence.page_number); ant_bsc_page_0_encode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_0)); bsc_sens_event = (ant_bsc_evt_t) p_bsc_message_payload->speed_or_cadence.page_number; switch (p_bsc_message_payload->speed_or_cadence.page_number) { case ANT_BSC_PAGE_0: // No implementation needed break; case ANT_BSC_PAGE_1: ant_bsc_page_1_encode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_1)); break; case ANT_BSC_PAGE_2: ant_bsc_page_2_encode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_2)); break; case ANT_BSC_PAGE_3: ant_bsc_page_3_encode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_3)); break; case ANT_BSC_PAGE_4: ant_bsc_page_4_encode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_4)); break; case ANT_BSC_PAGE_5: ant_bsc_page_5_encode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_5)); break; default: // No implementation needed break; } } p_profile->evt_handler(p_profile, bsc_sens_event); } /**@brief Function for setting payload for ANT message and sending it. * * @param[in] p_profile Pointer to the profile instance. */ static void ant_message_send(ant_bsc_profile_t * p_profile) { uint8_t p_message_payload[ANT_STANDARD_DATA_PAYLOAD_SIZE]; uint32_t err_code; 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_bsc_sens_evt_handler(ant_bsc_profile_t * p_profile, ant_evt_t * p_ant_event) { if (p_ant_event->channel == p_profile->channel_number) { switch (p_ant_event->event) { case EVENT_TX: ant_message_send(p_profile); break; default: break; } } } ret_code_t ant_bsc_disp_open(ant_bsc_profile_t * p_profile) { ASSERT(p_profile != NULL); NRF_LOG_INFO("ANT BSC channel %u open\r\n", p_profile->channel_number); return sd_ant_channel_open(p_profile->channel_number); } ret_code_t ant_bsc_sens_open(ant_bsc_profile_t * p_profile) { ASSERT(p_profile != NULL); // Fill tx buffer for the first frame ant_message_send(p_profile); NRF_LOG_INFO("ANT BSC channel %u open\r\n", p_profile->channel_number); return sd_ant_channel_open(p_profile->channel_number); } /**@brief Function for decoding BSC message. * * @param[in,out] p_profile Pointer to the profile instance. * @param[in] p_message_payload Pointer to the message payload structure. * * @note Assume to be call each time when Rx window will occur. */ static void disp_message_decode(ant_bsc_profile_t * p_profile, uint8_t * p_message_payload) { const ant_bsc_message_layout_t * p_bsc_message_payload = (ant_bsc_message_layout_t *)p_message_payload; ant_bsc_evt_t bsc_disp_event; if (p_profile->_cb.p_disp_cb->device_type == BSC_COMBINED_DEVICE_TYPE) { NRF_LOG_INFO("BSC RX Page Number: \"Combined Speed & Cadence Page\"\r\n"); ant_bsc_combined_page_0_decode(p_bsc_message_payload->combined.page_payload, &(p_profile->page_comb_0)); bsc_disp_event = (ant_bsc_evt_t) ANT_BSC_COMB_PAGE_0_UPDATED; } else { NRF_LOG_INFO("BSC RX Page Number: %u\r\n", p_bsc_message_payload->speed_or_cadence.page_number); ant_bsc_page_0_decode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_0)); // Page 0 is present in each message bsc_disp_event = (ant_bsc_evt_t) p_bsc_message_payload->speed_or_cadence.page_number; switch (p_bsc_message_payload->speed_or_cadence.page_number) { case ANT_BSC_PAGE_0: // No implementation needed break; case ANT_BSC_PAGE_1: ant_bsc_page_1_decode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_1)); break; case ANT_BSC_PAGE_2: ant_bsc_page_2_decode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_2)); break; case ANT_BSC_PAGE_3: ant_bsc_page_3_decode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_3)); break; case ANT_BSC_PAGE_4: ant_bsc_page_4_decode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_4)); break; case ANT_BSC_PAGE_5: ant_bsc_page_5_decode(p_bsc_message_payload->speed_or_cadence.page_payload, &(p_profile->page_5)); break; default: // No implementation needed break; } } p_profile->evt_handler(p_profile, bsc_disp_event); } void ant_bsc_disp_evt_handler(ant_bsc_profile_t * p_profile, ant_evt_t * p_ant_event) { if (p_ant_event->channel == p_profile->channel_number) { ANT_MESSAGE * p_message = (ANT_MESSAGE *)p_ant_event->msg.evt_buffer; switch (p_ant_event->event) { case EVENT_RX: if (p_message->ANT_MESSAGE_ucMesgID == MESG_BROADCAST_DATA_ID || p_message->ANT_MESSAGE_ucMesgID == MESG_ACKNOWLEDGED_DATA_ID || p_message->ANT_MESSAGE_ucMesgID == MESG_BURST_DATA_ID) { disp_message_decode(p_profile, p_message->ANT_MESSAGE_aucPayload); } break; default: break; } } } #endif // NRF_MODULE_ENABLED(ANT_BSC)