/** * 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_common.h" #if NRF_MODULE_ENABLED(ANT_ENCRYPT_NEGOTIATION_SLAVE) #include #include #include "ant_encrypt_config.h" #include "ant_interface.h" #include "ant_parameters.h" #include "nrf_error.h" #include "app_error.h" #include "ant_encrypt_negotiation_slave.h" /** Number of supported channels. */ #define NUMBER_OF_CHANNELS (NRF_SDH_ANT_TOTAL_CHANNELS_ALLOCATED) /** Flag to block other channels from attempting to enable encryption while * another encryption is in the process. */ static volatile bool m_can_enable_crypto = true; /** Array to keep track of which channels are currently tracking. */ static ant_encrypt_tracking_state_t m_encrypt_channel_states[NUMBER_OF_CHANNELS]; /** Array for the slave channels' encryption settings. */ static ant_encrypt_channel_settings_t m_slave_channel_conf[MAX_ANT_CHANNELS]; void ant_channel_encryp_tracking_state_set(uint8_t channel_number, ant_encrypt_tracking_state_t state) { m_encrypt_channel_states[channel_number] = state; } void ant_channel_encryp_negotiation_slave_init(void) { for (uint32_t channel = 0; channel < NUMBER_OF_CHANNELS; channel++) { ant_channel_encryp_tracking_state_set(channel, ANT_ENC_CHANNEL_STAT_TRACKING_UNSUPPORTED); } m_can_enable_crypto = true; } ant_encrypt_tracking_state_t ant_channel_encryp_tracking_state_get(uint8_t channel_number) { return m_encrypt_channel_states[channel_number]; } void ant_slave_channel_encrypt_config(uint8_t channel_number, ant_encrypt_channel_settings_t const * const p_crypto_config) { memcpy(&m_slave_channel_conf[channel_number], p_crypto_config, sizeof(ant_encrypt_channel_settings_t)); } /**@brief Function for handling ANT RX channel events. * * @param[in] p_event_message_buffer The ANT event message buffer. */ static void ant_slave_encrypt_try_enable(uint8_t ant_channel, uint8_t ant_message_id) { uint32_t err_code; ant_encrypt_tracking_state_t track_stat; switch (ant_message_id) { // Broadcast data received. case MESG_BROADCAST_DATA_ID: track_stat = ant_channel_encryp_tracking_state_get(ant_channel); // If the encryption has not yet been negotiated for this channel and another channel // is not currently trying to enable encryption, enable encryption if ((track_stat != ANT_ENC_CHANNEL_STAT_TRACKING_DECRYPTED) && (track_stat != ANT_ENC_CHANNEL_STAT_NEGOTIATING) && m_can_enable_crypto) { // Block other channels from trying to enable encryption until this channel // is finished m_can_enable_crypto = false; ant_channel_encryp_tracking_state_set(ant_channel, ANT_ENC_CHANNEL_STAT_NEGOTIATING); // Enable encryption on ant_channel err_code = ant_channel_encrypt_config_perform(ant_channel, &m_slave_channel_conf[ant_channel]); APP_ERROR_CHECK(err_code); } break; default: break; } } void ant_slave_encrypt_negotiation(ant_evt_t * p_ant_evt) { ant_encrypt_tracking_state_t track_state = ant_channel_encryp_tracking_state_get(p_ant_evt->channel); if (track_state == ANT_ENC_CHANNEL_STAT_TRACKING_UNSUPPORTED) return; switch (p_ant_evt->event) { case EVENT_RX_FAIL_GO_TO_SEARCH: if (track_state == ANT_ENC_CHANNEL_STAT_NEGOTIATING) { m_can_enable_crypto = true; } ant_channel_encryp_tracking_state_set(p_ant_evt->channel, ANT_ENC_CHANNEL_STAT_NOT_TRACKING); break; case EVENT_RX: ant_slave_encrypt_try_enable(p_ant_evt->channel, p_ant_evt->message.ANT_MESSAGE_ucMesgID); break; case EVENT_ENCRYPT_NEGOTIATION_SUCCESS: m_can_enable_crypto = true; ant_channel_encryp_tracking_state_set(p_ant_evt->channel, ANT_ENC_CHANNEL_STAT_TRACKING_DECRYPTED); break; case EVENT_ENCRYPT_NEGOTIATION_FAIL: m_can_enable_crypto = true; ant_channel_encryp_tracking_state_set(p_ant_evt->channel, ANT_ENC_CHANNEL_STAT_TRACKING_ENCRYPTED); break; default: break; } } #endif // NRF_MODULE_ENABLED(ANT_ENCRYPT_NEGOTIATION_SLAVE)