12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196 |
- /**
- * Copyright (c) 2017 - 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 <string.h>
- #include "ant_conn.h"
- #include "conn_mw_ant.h"
- #include "ble_serialization.h"
- #include "nrf_log_ctrl.h"
- #include "sdk_config.h"
- #define ANT_BUFFER_SIZE_FOR_SD ANT_ENABLE_GET_REQUIRED_SPACE(ANT_SER_CONFIG_TOTAL_CHANNELS_ALLOCATED, \
- ANT_SER_CONFIG_ENCRYPTED_CHANNELS, \
- ANT_SER_CONFIG_BURST_QUEUE_SIZE, \
- ANT_SER_CONFIG_EVENT_QUEUE_SIZE)
- #define ANT_ADV_BURST_CFG_SIZE_MAX (11u)
- #define ANT_CRYPTO_INFO_SIZE (((MESG_CONFIG_ENCRYPT_REQ_CONFIG_USER_DATA_SIZE) - \
- (MESG_CHANNEL_NUM_SIZE)) + \
- ((MESG_CONFIG_ENCRYPT_REQ_CONFIG_ID_SIZE) - \
- (MESG_CHANNEL_NUM_SIZE)))
- #define ANT_CRYPTO_INFO_MAX_SIZE (MESG_CONFIG_ENCRYPT_REQ_CONFIG_USER_DATA_SIZE - \
- MESG_CHANNEL_NUM_SIZE)
- #ifdef ANT_STACK_SUPPORT_REQD
- static union
- {
- uint8_t u8[ANT_BUFFER_SIZE_FOR_SD];
- uint32_t u32[1]; // force allign to uint32_t
- }ant_stack_buffer; /*!< Memory buffer provided in order to support channel configuration */
- #endif
- uint32_t conn_mw_ant_enable(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- ANT_ENABLE params;
- ANT_ENABLE * p_params = ¶ms;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_enable_req_dec(p_rx_buf, rx_buf_len, &p_params);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- SER_ASSERT(p_params -> ucTotalNumberOfChannels == ANT_SER_CONFIG_TOTAL_CHANNELS_ALLOCATED, err_code);
- SER_ASSERT(p_params -> ucNumberOfEncryptedChannels == ANT_SER_CONFIG_ENCRYPTED_CHANNELS, err_code);
- SER_ASSERT(p_params -> usNumberOfEvents == ANT_SER_CONFIG_EVENT_QUEUE_SIZE, err_code);
- SER_ASSERT(p_params -> usMemoryBlockByteSize == ANT_BUFFER_SIZE_FOR_SD, err_code);
- ANT_ENABLE m_ant_enable_cfg =
- {
- .ucTotalNumberOfChannels = p_params -> ucTotalNumberOfChannels,
- .ucNumberOfEncryptedChannels = p_params -> ucNumberOfEncryptedChannels,
- .usNumberOfEvents = p_params -> usNumberOfEvents,
- .pucMemoryBlockStartLocation = ant_stack_buffer.u8,
- .usMemoryBlockByteSize = p_params -> usMemoryBlockByteSize
- };
- sd_err_code = sd_ant_enable(&m_ant_enable_cfg);
- err_code = ant_enable_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_assign(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t type;
- uint8_t network;
- uint8_t ext_assign;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code =ant_channel_assign_req_dec(p_rx_buf, rx_buf_len, &channel, &type, &network, &ext_assign);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- //disabled till codec is adopted.
- sd_err_code = sd_ant_channel_assign(channel, type, network, ext_assign);
- err_code = ant_channel_assign_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_open_with_offset(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint16_t usOffset;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_open_with_offset_req_dec(p_rx_buf, rx_buf_len, &channel, &usOffset);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_open_with_offset(channel, usOffset);
- err_code = ant_channel_open_with_offset_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_id_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint16_t device_number;
- uint8_t device_type;
- uint8_t transmission_type;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code =ant_channel_id_set_req_dec(p_rx_buf, rx_buf_len, &channel, &device_number, &device_type, &transmission_type);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- //disabled till codec is adopted.
- sd_err_code = sd_ant_channel_id_set(channel, device_number, device_type, transmission_type);
- err_code = ant_channel_id_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_period_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint16_t period;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_period_set_req_dec(p_rx_buf, rx_buf_len, &channel, &period);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_period_set(channel, period);
- err_code = ant_channel_period_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_radio_freq_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t freq;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_radio_freq_set_req_dec(p_rx_buf, rx_buf_len, &channel, &freq);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_radio_freq_set(channel, freq);
- err_code = ant_channel_radio_freq_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_broadcast_message_tx(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t size;
- uint8_t mesg[ANT_STANDARD_DATA_PAYLOAD_SIZE];
- uint8_t * p_mesg = mesg;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_broadcast_message_tx_req_dec(p_rx_buf, rx_buf_len, &channel, &size, &p_mesg);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_broadcast_message_tx(channel, size, p_mesg);
- err_code = ant_broadcast_message_tx_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_acknowledge_message_tx(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t size;
- uint8_t mesg[ANT_STANDARD_DATA_PAYLOAD_SIZE];
- uint8_t * p_mesg = mesg;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_acknowledge_message_tx_req_dec(p_rx_buf, rx_buf_len, &channel, &size, &p_mesg);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_acknowledge_message_tx(channel, size, p_mesg);
- err_code = ant_acknowledge_message_tx_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_unassign(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_unassign_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_unassign(channel);
- err_code = ant_channel_unassign_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_close(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_close_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_close(channel);
- err_code = ant_channel_close_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_network_address_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t network;
- uint8_t network_address[MESG_NETWORK_KEY_SIZE - MESG_CHANNEL_NUM_SIZE];
- uint8_t * p_network_address = network_address;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_network_address_set_req_dec(p_rx_buf, rx_buf_len, &network, &p_network_address);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_network_address_set(network, p_network_address);
- err_code = ant_network_address_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_radio_tx_power_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t tx_power;
- uint8_t custom_tx_power;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_radio_tx_power_set_req_dec(p_rx_buf, rx_buf_len, &channel, &tx_power, &custom_tx_power);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_radio_tx_power_set(channel, tx_power, custom_tx_power);
- err_code = ant_channel_radio_tx_power_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_rx_search_timeout_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t timeout;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_rx_search_timeout_set_req_dec(p_rx_buf, rx_buf_len, &channel, &timeout);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_rx_search_timeout_set(channel, timeout);
- err_code = ant_channel_rx_search_timeout_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_low_priority_rx_search_timeout_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t timeout;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_low_priority_rx_search_timeout_set_req_dec(p_rx_buf, rx_buf_len, &channel, &timeout);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_low_priority_rx_search_timeout_set(channel, timeout);
- err_code = ant_channel_low_priority_rx_search_timeout_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_prox_search_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t prox_threshold;
- uint8_t custom_prox_threshold;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_prox_search_set_req_dec(p_rx_buf, rx_buf_len, &channel, &prox_threshold, &custom_prox_threshold);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_prox_search_set(channel, prox_threshold, custom_prox_threshold);
- err_code = ant_prox_search_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_search_waveform_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint16_t waveform;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_search_waveform_set_req_dec(p_rx_buf, rx_buf_len, &channel, &waveform);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_search_waveform_set(channel, waveform);
- err_code = ant_search_waveform_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_id_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint16_t device_number;
- uint8_t device_type;
- uint8_t transmit_type;
- uint8_t channel;
- uint16_t * p_device_number = &device_number;
- uint8_t * p_device_type = &device_type;
- uint8_t * p_transmit_type = &transmit_type;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_id_get_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_id_get(channel, p_device_number, p_device_type, p_transmit_type);
- err_code = ant_channel_id_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, p_device_number, p_device_type, p_transmit_type);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_radio_freq_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t r_freq;
- uint8_t channel;
- uint8_t * p_r_freq = &r_freq;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_radio_freq_get_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_radio_freq_get(channel, p_r_freq);
- err_code = ant_channel_radio_freq_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, p_r_freq);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_period_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint16_t period;
- uint8_t channel;
- uint16_t * p_period = .
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_period_get_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_period_get(channel, p_period);
- err_code = ant_channel_period_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, p_period);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_search_channel_priority_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t search_priority;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_search_channel_priority_set_req_dec(p_rx_buf, rx_buf_len, &channel, &search_priority);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_search_channel_priority_set(channel, search_priority);
- err_code = ant_search_channel_priority_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_active_search_sharing_cycles_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t cycles;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_active_search_sharing_cycles_set_req_dec(p_rx_buf, rx_buf_len, &channel, &cycles);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_active_search_sharing_cycles_set(channel, cycles);
- err_code = ant_active_search_sharing_cycles_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_lib_config_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t ant_lib_config;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_lib_config_set_req_dec(p_rx_buf, rx_buf_len, &ant_lib_config);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_lib_config_set(ant_lib_config);
- err_code = ant_lib_config_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_active_search_sharing_cycles_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t cycles;
- uint8_t channel;
- uint8_t * p_cycles = &cycles;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_active_search_sharing_cycles_get_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_active_search_sharing_cycles_get(channel, p_cycles);
- err_code = ant_active_search_sharing_cycles_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, p_cycles);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_lib_config_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t ant_lib_config;
- uint8_t * p_ant_lib_config = &ant_lib_config;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- sd_err_code = sd_ant_lib_config_get(p_ant_lib_config);
- err_code = ant_lib_config_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, p_ant_lib_config);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_lib_config_clear(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t ant_lib_config;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_lib_config_clear_req_dec(p_rx_buf, rx_buf_len, &ant_lib_config);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_lib_config_clear(ant_lib_config);
- err_code = ant_lib_config_clear_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_stack_reset(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- sd_err_code = sd_ant_stack_reset();
- err_code = ant_stack_reset_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_rx_scan_mode_start(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t sync_channel_packets_only;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_rx_scan_mode_start_req_dec(p_rx_buf, rx_buf_len, &sync_channel_packets_only);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_rx_scan_mode_start(sync_channel_packets_only);
- err_code = ant_rx_scan_mode_start_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_id_list_add(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t dev_id[ANT_ID_SIZE];
- uint8_t * p_dev_id = dev_id;
- uint8_t list_index;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_id_list_add_req_dec(p_rx_buf, rx_buf_len, &channel, &p_dev_id, &list_index);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_id_list_add(channel, p_dev_id, list_index);
- err_code = ant_id_list_add_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_id_list_config(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t id_list_size;
- uint8_t inc_exc_flag;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_id_list_config_req_dec(p_rx_buf, rx_buf_len, &channel, &id_list_size, &inc_exc_flag);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_id_list_config(channel, id_list_size, inc_exc_flag);
- err_code = ant_id_list_config_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_channel_status_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t status;
- uint8_t channel;
- uint8_t * p_status = &status;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_channel_status_get_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_channel_status_get(channel, p_status);
- err_code = ant_channel_status_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, p_status);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_cw_test_mode_init(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- sd_err_code = sd_ant_cw_test_mode_init();
- err_code = ant_cw_test_mode_init_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_cw_test_mode(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t radio_freq;
- uint8_t tx_power;
- uint8_t custom_tx_power;
- uint8_t mode;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_cw_test_mode_req_dec(p_rx_buf, rx_buf_len, &radio_freq, &tx_power, &custom_tx_power, &mode);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_cw_test_mode(radio_freq, tx_power, custom_tx_power, mode);
- err_code = ant_cw_test_mode_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_version_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t version[MESG_BUFFER_SIZE];
- memset(version, 0, sizeof(version));
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- sd_err_code = sd_ant_version_get(version);
- err_code = ant_version_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, version);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_capabilities_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t capabilities[MESG_CAPABILITIES_SIZE];
- memset(capabilities, 0, sizeof(capabilities));
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- sd_err_code = sd_ant_capabilities_get(capabilities);
- err_code = ant_capabilities_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, capabilities);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_crypto_channel_enable(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t enable;
- uint8_t key_num;
- uint8_t decimation_rate;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_crypto_channel_enable_req_dec(p_rx_buf, rx_buf_len, &channel, &enable, &key_num, &decimation_rate);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_crypto_channel_enable(channel, enable, key_num, decimation_rate);
- err_code = ant_crypto_channel_enable_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_adv_burst_config_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t size;
- uint8_t config[ANT_ADV_BURST_CFG_SIZE_MAX];
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_adv_burst_config_set_req_dec(p_rx_buf, rx_buf_len, config, &size);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_adv_burst_config_set(config, size);
- err_code = ant_adv_burst_config_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_crypto_key_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t key_num;
- uint8_t key[SIZE_OF_ENCRYPTED_KEY];
- uint8_t * p_key = key;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_crypto_key_set_req_dec(p_rx_buf, rx_buf_len, &key_num, &p_key);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_crypto_key_set(key_num, p_key);
- err_code = ant_crypto_key_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_crypto_info_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t type;
- uint8_t info[ANT_CRYPTO_INFO_SIZE];
- uint8_t * p_info = info;
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_crypto_info_set_req_dec(p_rx_buf, rx_buf_len, &type, &p_info);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_crypto_info_set(type, p_info);
- err_code = ant_crypto_info_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_crypto_info_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t type;
- uint8_t info[ANT_CRYPTO_INFO_MAX_SIZE];
- memset(info, 0, sizeof(info));
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_crypto_info_get_req_dec(p_rx_buf, rx_buf_len, &type);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_crypto_info_get(type, info);
- err_code = ant_crypto_info_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, type, info);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_coex_config_set(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t coex_config_buffer[(MESG_BUFFER_SIZE / 2) - 1];
- uint8_t adv_coex_config_buffer[(MESG_BUFFER_SIZE / 2) - 1];
- ANT_BUFFER_PTR coex_config =
- {
- .ucBufferSize = 0,
- .pucBuffer = coex_config_buffer
- };
- ANT_BUFFER_PTR adv_coex_config =
- {
- .ucBufferSize = 0,
- .pucBuffer = adv_coex_config_buffer
- };
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_coex_config_set_req_dec(p_rx_buf, rx_buf_len, &channel, &coex_config, &adv_coex_config);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- if (coex_config.ucBufferSize == 0 && adv_coex_config.ucBufferSize == 0)
- {
- sd_err_code = sd_ant_coex_config_set(channel, NULL, NULL);
- }
- else if (coex_config.ucBufferSize == 0)
- {
- sd_err_code = sd_ant_coex_config_set(channel, NULL, &adv_coex_config);
- }
- else if (adv_coex_config.ucBufferSize == 0)
- {
- sd_err_code = sd_ant_coex_config_set(channel, &coex_config, NULL);
- }
- else
- {
- sd_err_code = sd_ant_coex_config_set(channel, &coex_config, &adv_coex_config);
- }
- err_code = ant_coex_config_set_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
- uint32_t conn_ant_coex_config_get(uint8_t const * const p_rx_buf,
- uint32_t rx_buf_len,
- uint8_t * const p_tx_buf,
- uint32_t * const p_tx_buf_len)
- {
- SER_ASSERT_NOT_NULL(p_rx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf);
- SER_ASSERT_NOT_NULL(p_tx_buf_len);
- uint8_t channel;
- uint8_t coex_config_buffer[(MESG_BUFFER_SIZE / 2) - 1];
- uint8_t adv_coex_config_buffer[(MESG_BUFFER_SIZE / 2) - 1];
- ANT_BUFFER_PTR coex_config =
- {
- .ucBufferSize = sizeof(coex_config_buffer),
- .pucBuffer = coex_config_buffer
- };
- ANT_BUFFER_PTR adv_coex_config =
- {
- .ucBufferSize = sizeof(adv_coex_config_buffer),
- .pucBuffer = adv_coex_config_buffer
- };
- uint32_t err_code = NRF_SUCCESS;
- uint32_t sd_err_code = 0;
- err_code = ant_coex_config_get_req_dec(p_rx_buf, rx_buf_len, &channel);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- sd_err_code = sd_ant_coex_config_get(channel, &coex_config, &adv_coex_config);
- err_code = ant_coex_config_get_rsp_enc(sd_err_code, p_tx_buf, p_tx_buf_len, &coex_config, &adv_coex_config);
- SER_ASSERT(err_code == NRF_SUCCESS, err_code);
- return err_code;
- }
|