o Initial import.HEADmaster

1 files changed, 223 insertions, 0 deletions

diff --git a/thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_search_uplink/ant_search_uplink.c b/thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_search_uplink/ant_search_uplink.c
new file mode 100644
index 0000000..d39f26e
--- /dev/null
+++ b/thirdparty/nRF5_SDK_15.0.0_a53641a/examples/ant/ant_search_uplink/ant_search_uplink.c
@@ -0,0 +1,223 @@
+/**
+ * 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 "ant_search_uplink.h"
+#include <stdint.h>
+#include "ant_interface.h"
+#include "ant_parameters.h"
+#include "app_error.h"
+#include "app_util.h"
+#include "boards.h"
+#include "sdk_config.h"
+#include "ant_channel_config.h"
+#include "ant_search_config.h"
+#include "nrf_soc.h"
+#include "nrf_sdh.h"
+#include "nrf_sdh_ant.h"
+
+#define WILDCARD_DEVICE_NUMBER          0x00                    /**< Wildcard device number. */
+#define APP_ANT_OBSERVER_PRIO           1                       /**< Application's ANT observer priority. You shouldn't need to modify this value. */
+
+// Operation modes
+static enum
+{
+    MODE_NONE,                                                  /**< Do not send any uplink messages. */
+    MODE_SEND_UPLINK_ANY,                                       /**< Send uplink messages to any devices. */
+    MODE_SEND_UPLINK_SPECIFIC,                                  /**< Send a single uplink message to a specific device. */
+} m_mode;
+
+static uint8_t m_tx_buffer[ANT_STANDARD_DATA_PAYLOAD_SIZE];     /**< Transmit buffer. */
+static uint8_t m_counter;                                       /**< Counter to include in transmit data. */
+static bool    m_sent;
+
+
+/**@brief Send uplink message
+ * @param[in] device_number Device number of intended destination of message. Set to WILDCARD_DEVICE_NUMBER for any node.
+ */
+static void uplink_message_send(uint16_t device_number)
+{
+    uint8_t err_code;
+
+    m_tx_buffer[0] = 0xFF;
+    m_tx_buffer[1] = 0xFF;
+    m_tx_buffer[2] = 0xFF;
+    m_tx_buffer[3] = 0xFF;
+    m_tx_buffer[4] = 0xFF;
+    m_tx_buffer[5] = 0xFF;
+    m_tx_buffer[6] = 0xFF;
+    m_tx_buffer[7] = m_counter;
+
+    if (device_number != WILDCARD_DEVICE_NUMBER)
+    {
+        // Set the channel ID of the specific device to send message to
+        err_code = sd_ant_channel_id_set(ANT_CHANNEL_NUM,
+                                         device_number,
+                                         CHAN_ID_DEV_TYPE,
+                                         CHAN_ID_TRANS_TYPE);
+        APP_ERROR_CHECK(err_code);
+    }
+
+    err_code = sd_ant_broadcast_message_tx(ANT_CHANNEL_NUM,
+                                           ANT_STANDARD_DATA_PAYLOAD_SIZE,
+                                           m_tx_buffer);
+    APP_ERROR_CHECK(err_code);
+
+    m_counter++;
+}
+
+
+void ant_search_uplink_setup(void)
+{
+    uint32_t err_code;
+
+    m_mode    = MODE_NONE;
+    m_counter = 0;
+
+    ant_channel_config_t channel_config =
+    {
+        .channel_number    = ANT_CHANNEL_NUM,
+        .channel_type      = CHANNEL_TYPE_SLAVE,
+        .ext_assign        = EXT_PARAM_ALWAYS_SEARCH,
+        .rf_freq           = RF_FREQ,
+        .transmission_type = CHAN_ID_TRANS_TYPE,
+        .device_type       = CHAN_ID_DEV_TYPE,
+        .device_number     = WILDCARD_DEVICE_NUMBER,
+        .network_number    = ANT_NETWORK_NUM,
+    };
+
+    ant_search_config_t search_config = DEFAULT_ANT_SEARCH_CONFIG(ANT_CHANNEL_NUM);
+
+    // Keep searching always
+    search_config.low_priority_timeout = ANT_LOW_PRIORITY_TIMEOUT_DISABLE;
+
+    // Disable high priority search to minimize disruption to other channels while searching
+    search_config.high_priority_timeout = ANT_HIGH_PRIORITY_SEARCH_DISABLE;
+
+    // Configure the channel
+    err_code = ant_channel_init(&channel_config);
+    APP_ERROR_CHECK(err_code);
+
+    // Configure search parameters
+    err_code = ant_search_init(&search_config);
+    APP_ERROR_CHECK(err_code);
+
+    // Enable extended rx messages, including the channel ID
+    err_code = sd_ant_lib_config_set(ANT_LIB_CONFIG_MESG_OUT_INC_DEVICE_ID);
+    APP_ERROR_CHECK(err_code);
+
+    // Open background scanning channel
+    err_code = sd_ant_channel_open(ANT_CHANNEL_NUM);
+    APP_ERROR_CHECK(err_code);
+}
+
+
+void ant_search_uplink_bsp_evt_handler(bsp_event_t evt)
+{
+    switch (evt)
+    {
+        case BSP_EVENT_KEY_0:
+            m_mode = MODE_SEND_UPLINK_ANY;
+            uplink_message_send(WILDCARD_DEVICE_NUMBER);
+            bsp_board_led_off(BSP_BOARD_LED_1);
+            break;
+
+        case BSP_EVENT_KEY_1:
+            m_mode = MODE_SEND_UPLINK_SPECIFIC;
+            m_sent = false;
+            bsp_board_led_off(BSP_BOARD_LED_1);
+            break;
+
+        default:
+            break; // No implementation needed
+    }
+}
+
+
+void ant_search_uplink_event_handler(ant_evt_t * p_ant_evt, void * p_context)
+{
+    switch (p_ant_evt->event)
+    {
+        case EVENT_TX:
+            bsp_board_led_invert(BSP_BOARD_LED_1);
+            if (m_mode == MODE_SEND_UPLINK_ANY)
+            {
+                uplink_message_send(WILDCARD_DEVICE_NUMBER);
+            }
+            else if (m_mode == MODE_SEND_UPLINK_SPECIFIC)
+            {
+                // Reset the channel ID to wild card to continue receiving messages from any device
+                uint32_t err_code = sd_ant_channel_id_set(ANT_CHANNEL_NUM,
+                                                          WILDCARD_DEVICE_NUMBER,
+                                                          CHAN_ID_DEV_TYPE,
+                                                          CHAN_ID_TRANS_TYPE);
+                APP_ERROR_CHECK(err_code);
+            }
+            break;
+
+        case EVENT_RX:
+            bsp_board_led_invert(BSP_BOARD_LED_0);
+            if (m_mode == MODE_SEND_UPLINK_SPECIFIC && !m_sent)
+            {
+                // Decode extended data to get channel ID of the received message and send message to that specific device
+                if (p_ant_evt->message.ANT_MESSAGE_stExtMesgBF.bANTDeviceID)
+                {
+                    uint16_t device_number = uint16_decode(p_ant_evt->message.ANT_MESSAGE_aucExtData);
+                    uplink_message_send(device_number);
+                    m_sent = true;
+                }
+            }
+            break;
+
+        default:
+            break; // No implementation needed
+    }
+}
+
+NRF_SDH_ANT_OBSERVER(m_ant_observer, APP_ANT_OBSERVER_PRIO, ant_search_uplink_event_handler, NULL);