diff options
Diffstat (limited to 'thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_multi_channels_encrypted/tx/ant_multi_channels_encrypted_tx.c')
| -rw-r--r-- | thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_multi_channels_encrypted/tx/ant_multi_channels_encrypted_tx.c | 194 |
1 files changed, 194 insertions, 0 deletions
diff --git a/thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_multi_channels_encrypted/tx/ant_multi_channels_encrypted_tx.c b/thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_multi_channels_encrypted/tx/ant_multi_channels_encrypted_tx.c new file mode 100644 index 0000000..b8c9f44 --- /dev/null +++ b/thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_multi_channels_encrypted/tx/ant_multi_channels_encrypted_tx.c @@ -0,0 +1,194 @@ +/** + * This software is subject to the ANT+ Shared Source License + * www.thisisant.com/swlicenses + * Copyright (c) Dynastream Innovations, Inc. 2015 + * 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 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 Dynastream nor the names of its + * contributors may be used to endorse or promote products + * derived from this software without specific prior + * written permission. + * + * The following actions are prohibited: + * 1) Redistribution of source code containing the ANT+ Network + * Key. The ANT+ Network Key is available to ANT+ Adopters. + * Please refer to http://thisisant.com to become an ANT+ + * Adopter and access the key. + * + * 2) Reverse engineering, decompilation, and/or disassembly of + * software provided in binary form under this license. + * + * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND + * CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, + * INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF + * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE HEREBY + * DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER 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; DAMAGE TO ANY DEVICE, 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. SOME STATES DO NOT ALLOW + * THE EXCLUSION OF INCIDENTAL OR CONSEQUENTIAL DAMAGES, SO THE + * ABOVE LIMITATIONS MAY NOT APPLY TO YOU. + * + */ +#include <stdint.h> +#include <stdlib.h> +#include "app_error.h" +#include "boards.h" +#include "ant_interface.h" +#include "ant_parameters.h" +#include "ant_multi_channels_encrypted_tx.h" +#include "ant_channel_config.h" +#include "ant_encrypt_config.h" +#include "sdk_config.h" +#include "nrf_sdh_ant.h" + +/** Size of the broadcast data buffer. */ +#define BROADCAST_DATA_BUFFER_SIZE ANT_STANDARD_DATA_PAYLOAD_SIZE + +/** Encryption key. */ +#define CRYPTO_KEY {0x03, 0x01, 0x04, 0x01, 0x05, 0x09, 0x02, 0x06, 0x05, 0x03, \ + 0x05, 0x08, 0x09, 0x07, 0x09, 0x03} + +/** Number of channels to open <1,NRF_SDH_ANT_TOTAL_CHANNELS_ALLOCATED>. */ +#define NUMBER_OF_CHANNELS_TO_OPEN NRF_SDH_ANT_TOTAL_CHANNELS_ALLOCATED + +/** Application's ANT observer priority. You shouldn't need to modify this value. */ +#define APP_ANT_OBSERVER_PRIO 1 + +// Private variables. +/** Counters to increment the ANT broadcast data payload. */ +static uint8_t m_counter[NUMBER_OF_CHANNELS_TO_OPEN] = { 0u }; + +/** Primary data transmit buffers. */ +static uint8_t m_broadcast_data[BROADCAST_DATA_BUFFER_SIZE] = { 0 }; + +/** Number of channels open. */ +static uint8_t m_num_open_channels = 0; + +/**@brief Function to display the bottom nibble of the input byte. + */ +static void low_nibble_on_leds_display(uint8_t byte_to_display) +{ + bsp_board_leds_off(); + + if ((byte_to_display & 0x01) == 1) + { + bsp_board_led_on(BSP_BOARD_LED_3); + } + if (((byte_to_display >> 1) & 0x01) == 1) + { + bsp_board_led_on(BSP_BOARD_LED_2); + } + if (((byte_to_display >> 2) & 0x01) == 1) + { + bsp_board_led_on(BSP_BOARD_LED_1); + } + if (((byte_to_display >> 3) & 0x01) == 1) + { + bsp_board_led_on(BSP_BOARD_LED_0); + } +} + + +void ant_multi_channels_encrypted_channel_tx_broadcast_setup(void) +{ + uint32_t err_code; + uint32_t i; + + uint8_t crypto_key[] = CRYPTO_KEY; + + ANT_ENCRYPT_STACK_SETTINGS_BASE_DEF(se_conf, crypto_key, (uint8_t *)NRF_FICR->DEVICEID); + + ant_encrypt_channel_settings_t channel_crypto_settings = + { + .mode = ENCRYPTION_BASIC_REQUEST_MODE, + .key_index = 0, + .decimation_rate = 1 + }; + + ant_channel_config_t m_channel_config = + { + .channel_type = CHANNEL_TYPE_MASTER, + .ext_assign = 0x00, + .rf_freq = RF_FREQ, + .transmission_type = CHAN_ID_TRANS_TYPE, + .device_type = CHAN_ID_DEV_TYPE, + .channel_period = CHAN_PERIOD, + .network_number = ANT_NETWORK_NUM, + .p_crypto_settings = &channel_crypto_settings + // .device_number and .channel_number structure members are set below separately. + }; + + err_code = ant_stack_encryption_config(&ANT_ENCRYPT_STACK_SETTINGS_BASE(se_conf)); + APP_ERROR_CHECK(err_code); + + for (i = 0; i < NUMBER_OF_CHANNELS_TO_OPEN; i++) + { + // Fill variable channel ID. + m_channel_config.channel_number = i; + m_channel_config.device_number = i + 1; + + err_code = ant_channel_init(&m_channel_config); + APP_ERROR_CHECK(err_code); + + // Open channel. + err_code = sd_ant_channel_open(i); + APP_ERROR_CHECK(err_code); + + m_num_open_channels++; + } + + low_nibble_on_leds_display(m_num_open_channels); +} + +/**@brief Function for handling a ANT stack event. + * + * @param[in] p_ant_evt ANT stack event. + * @param[in] p_context Context. + */ +static void ant_evt_handler(ant_evt_t * p_ant_evt, void * p_context) +{ + uint32_t err_code; + + switch (p_ant_evt->event) + { + // ANT broadcast success. + // Increment the counter and send a new broadcast. + case EVENT_TX: + // Increment the counter. + m_counter[p_ant_evt->channel]++; + + // Assign a new value to the broadcast data. + m_broadcast_data[BROADCAST_DATA_BUFFER_SIZE - 1] = m_counter[p_ant_evt->channel]; + + // Broadcast the data. + err_code = sd_ant_broadcast_message_tx(p_ant_evt->channel, + BROADCAST_DATA_BUFFER_SIZE, + m_broadcast_data); + APP_ERROR_CHECK(err_code); + break; + + default: + break; + } +} + +NRF_SDH_ANT_OBSERVER(m_ant_observer, APP_ANT_OBSERVER_PRIO, ant_evt_handler, NULL); |