12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307130813091310131113121313131413151316131713181319132013211322132313241325132613271328132913301331133213331334133513361337133813391340134113421343134413451346134713481349135013511352135313541355135613571358135913601361136213631364136513661367136813691370137113721373137413751376137713781379138013811382138313841385138613871388138913901391139213931394139513961397139813991400140114021403140414051406140714081409141014111412141314141415141614171418141914201421142214231424142514261427142814291430143114321433143414351436143714381439144014411442144314441445144614471448144914501451145214531454145514561457145814591460146114621463146414651466146714681469147014711472147314741475147614771478147914801481148214831484148514861487148814891490149114921493149414951496149714981499150015011502150315041505150615071508150915101511151215131514151515161517151815191520152115221523152415251526152715281529153015311532153315341535153615371538153915401541154215431544154515461547154815491550155115521553155415551556155715581559156015611562156315641565156615671568156915701571157215731574157515761577157815791580158115821583158415851586158715881589159015911592159315941595159615971598159916001601160216031604160516061607160816091610161116121613161416151616161716181619162016211622162316241625162616271628162916301631163216331634163516361637163816391640164116421643164416451646164716481649165016511652165316541655165616571658165916601661166216631664166516661667166816691670167116721673167416751676167716781679168016811682168316841685168616871688168916901691169216931694169516961697169816991700170117021703170417051706170717081709171017111712171317141715171617171718171917201721172217231724172517261727172817291730173117321733173417351736173717381739174017411742174317441745174617471748174917501751175217531754175517561757175817591760176117621763176417651766176717681769177017711772177317741775177617771778177917801781178217831784178517861787178817891790179117921793179417951796179717981799180018011802180318041805180618071808180918101811181218131814181518161817181818191820182118221823182418251826182718281829183018311832183318341835183618371838183918401841184218431844184518461847184818491850185118521853185418551856185718581859186018611862186318641865186618671868186918701871187218731874187518761877187818791880188118821883188418851886188718881889189018911892189318941895189618971898189919001901190219031904190519061907190819091910191119121913191419151916191719181919192019211922192319241925192619271928192919301931193219331934193519361937193819391940194119421943194419451946194719481949195019511952195319541955195619571958195919601961196219631964196519661967196819691970197119721973197419751976197719781979198019811982198319841985198619871988198919901991199219931994199519961997199819992000200120022003200420052006200720082009201020112012201320142015201620172018201920202021202220232024202520262027202820292030203120322033203420352036203720382039204020412042204320442045204620472048204920502051205220532054205520562057205820592060206120622063206420652066206720682069207020712072207320742075207620772078207920802081208220832084208520862087208820892090209120922093209420952096209720982099210021012102210321042105210621072108210921102111211221132114211521162117211821192120212121222123212421252126212721282129213021312132213321342135213621372138213921402141214221432144214521462147214821492150215121522153215421552156215721582159216021612162216321642165216621672168216921702171217221732174217521762177217821792180218121822183218421852186218721882189219021912192219321942195219621972198219922002201220222032204220522062207220822092210221122122213221422152216221722182219222022212222222322242225222622272228222922302231223222332234223522362237223822392240224122422243224422452246224722482249225022512252225322542255225622572258225922602261226222632264226522662267226822692270227122722273227422752276227722782279228022812282228322842285228622872288228922902291229222932294229522962297229822992300230123022303230423052306230723082309231023112312231323142315231623172318231923202321232223232324232523262327232823292330233123322333233423352336233723382339234023412342234323442345234623472348234923502351235223532354235523562357235823592360236123622363236423652366236723682369237023712372237323742375237623772378237923802381 |
- #include "sdk_common.h"
- #if NRF_MODULE_ENABLED(ANTFS)
- #include "antfs.h"
- #include <string.h>
- #include "defines.h"
- #include "app_error.h"
- #include "app_timer.h"
- #include "ant_error.h"
- #include "ant_parameters.h"
- #include "ant_interface.h"
- #include "ant_key_manager.h"
- #include "crc.h"
- #if ANTFS_CONFIG_DEBUG_LED_ENABLED
- #include "bsp.h"
- #endif
- #define BURST_PACKET_SIZE 8u
- #define ANTFS_CONNECTION_TYPE_OFFSET 0x00u
- #define ANTFS_COMMAND_OFFSET 0x01u
- #define ANTFS_RESPONSE_OFFSET 0x01u
- #define ANTFS_CONTROL_OFFSET 0x02u
- #define ANTFS_DATA_OFFSET 0x03u
- #define ANTFS_BEACON_ID 0x43u
- #define ANTFS_COMMAND_ID 0x44u
- #define STATUS1_OFFSET 0x01u
- #define STATUS2_OFFSET 0x02u
- #define DEVICE_STATE_SHIFT 0x00u
- #define DEVICE_STATE_MASK (0x0Fu << DEVICE_STATE_SHIFT)
- #define DEVICE_STATE_LINK (0x00u << DEVICE_STATE_SHIFT)
- #define DEVICE_STATE_AUTHENTICATE (0x01u << DEVICE_STATE_SHIFT)
- #define DEVICE_STATE_TRANSPORT (0x02u << DEVICE_STATE_SHIFT)
- #define DEVICE_STATE_BUSY (0x03u << DEVICE_STATE_SHIFT)
- #define DEVICE_DESCRIPTOR_OFFSET_0 0x04u
- #define DEVICE_DESCRIPTOR_OFFSET_1 0x05u
- #define DEVICE_DESCRIPTOR_OFFSET_2 0x06u
- #define DEVICE_DESCRIPTOR_OFFSET_3 0x07u
- #define ANTFS_CMD_NONE 0x00u
- #define ANTFS_CMD_LINK_ID 0x02u
- #define ANTFS_CMD_DISCONNECT_ID 0x03u
- #define ANTFS_CMD_AUTHENTICATE_ID 0x04u
- #define ANTFS_CMD_PING_ID 0x05u
- #define ANTFS_CMD_DOWNLOAD_ID 0x09u
- #define ANTFS_CMD_UPLOAD_REQUEST_ID 0x0Au
- #define ANTFS_CMD_ERASE_ID 0x0Bu
- #define ANTFS_CMD_UPLOAD_DATA_ID 0x0Cu
- #define ANTFS_RSP_AUTHENTICATE_ID 0x84u
- #define ANTFS_RSP_DOWNLOAD_ID 0x89u
- #define ANTFS_RSP_UPLOAD_REQ_ID 0x8Au
- #define ANTFS_RSP_ERASE_ID 0x8Bu
- #define ANTFS_RSP_UPLOAD_DATA_ID 0x8Cu
- #define TRANSPORT_CHANNEL_FREQUENCY_OFFSET 0x02u
- #define TRANSPORT_MESSAGE_PERIOD_OFFSET 0x03u
- #define HOST_ID_OFFSET_0 0x04u
- #define HOST_ID_OFFSET_1 0x05u
- #define HOST_ID_OFFSET_2 0x06u
- #define HOST_ID_OFFSET_3 0x07u
- #define COMMAND_TYPE_OFFSET 0x02u
- #define COMMAND_TYPE_PROCEED 0x00u
- #define COMMAND_TYPE_REQUEST_SERIAL 0x01u
- #define COMMAND_TYPE_REQUEST_PAIR 0x02u
- #define COMMAND_TYPE_REQUEST_PASSKEY 0x03u
- #define RESPONSE_TYPE_OFFSET 0x02u
- #define AUTH_RESPONSE_N_A 0x00u
- #define AUTH_RESPONSE_ACCEPT 0x01u
- #define AUTH_RESPONSE_REJECT 0x02u
- #define AUTH_STRING_LENGTH_OFFSET 0x03u
- #define SERIAL_NUMBER_OFFSET_0 0x04u
- #define SERIAL_NUMBER_OFFSET_1 0x05u
- #define SERIAL_NUMBER_OFFSET_2 0x06u
- #define SERIAL_NUMBER_OFFSET_3 0x07u
- #define INITIAL_REQUEST_OFFSET 0x01u
- #define DATA_INDEX_OFFSET_LOW 0x02u
- #define DATA_INDEX_OFFSET_HIGH 0x03u
- #define ADDRESS_PARAMETER_OFFSET_0 0x04u
- #define ADDRESS_PARAMETER_OFFSET_1 0x05u
- #define ADDRESS_PARAMETER_OFFSET_2 0x06u
- #define ADDRESS_PARAMETER_OFFSET_3 0x07u
- #define UPLOAD_CRC_OFFSET_LOW 0x06u
- #define UPLOAD_CRC_OFFSET_HIGH 0x07u
- #if ANTFS_CONFIG_AUTH_TYPE_PASSKEY_ENABLED
- #define AUTHENTICATION_TYPE COMMAND_TYPE_REQUEST_PASSKEY
- #elif ANTFS_CONFIG_AUTH_TYPE_PAIRING_ENABLED
- #define AUTHENTICATION_TYPE COMMAND_TYPE_REQUEST_PAIR
- #elif ANTFS_CONFIG_AUTH_TYPE_PASSTHROUGH_ENABLED
- #define AUTHENTICATION_TYPE COMMAND_TYPE_PROCEED
- #else
- #error "No valid auth type defined"
- #endif
- #define AUTHENTICATION_RETRIES 0x05u
- #define ANTFS_EVENT_QUEUE_SIZE 0x04u
- #define SAVE_DISTANCE 256u
- #define BUFFER_INDEX_MESG_SIZE 0x00u
- #define BUFFER_INDEX_MESG_ID 0x01u
- #define BUFFER_INDEX_CHANNEL_NUM 0x02u
- #define BUFFER_INDEX_MESG_DATA 0x03u
- #define BUFFER_INDEX_RESPONSE_CODE 0x04u
- typedef struct
- {
- char friendly_name[ANTFS_FRIENDLY_NAME_MAX];
- bool is_name_set;
- uint32_t index;
- uint32_t friendly_name_size;
- } friendly_name_t;
- typedef union
- {
- antfs_link_substate_t link_sub_state;
- antfs_authenticate_substate_t auth_sub_state;
- antfs_transport_substate_t trans_sub_state;
- } antfs_substate_t;
- typedef struct
- {
- antfs_state_t state;
- antfs_substate_t sub_state;
- } antfs_states_t;
- typedef struct
- {
- antfs_event_return_t * p_queue;
- uint32_t head;
- uint32_t tail;
- } antfs_event_queue_t;
- static antfs_params_t m_initial_parameters;
- static antfs_beacon_status_byte1_t m_active_beacon_status1_field;
- static uint32_t m_active_beacon_frequency;
- static antfs_states_t m_current_state;
- static friendly_name_t m_friendly_name;
- static ulong_union_t m_link_host_serial_number;
- static uint32_t m_link_command_in_progress;
- static uint32_t m_authenticate_command_type;
- static volatile uint8_t m_burst_wait;
- static uint8_t m_retry;
- APP_TIMER_DEF(m_timer_id);
- #if ANTFS_CONFIG_AUTH_TYPE_PASSKEY_ENABLED
- static uint32_t m_passkey_index;
- #endif
- static bool m_is_data_request_pending;
- static bool m_is_crc_pending;
- static ushort_union_t m_file_index;
- static ulong_union_t m_file_size;
- static ulong_union_t m_max_block_size;
- static ulong_union_t m_link_burst_index;
- static ulong_union_t m_bytes_remaining;
- static ulong_union_t m_max_transfer_index;
- static uint32_t m_bytes_to_write;
- static const uint8_t * mp_upload_data;
- #if ANTFS_CONFIG_UPLOAD_ENABLED
- static ulong_union_t m_block_size;
- #endif
- static uint32_t m_saved_crc_offset;
- static uint32_t m_saved_buffer_crc_offset;
- static uint32_t m_temp_crc_offset;
- static uint16_t m_compared_crc;
- static uint16_t m_transfer_crc;
- static uint16_t m_saved_transfer_crc;
- static uint16_t m_saved_buffer_crc;
- static antfs_event_return_t m_event_queue_buffer[ANTFS_EVENT_QUEUE_SIZE];
- static antfs_event_queue_t m_event_queue;
- static antfs_burst_wait_handler_t m_burst_wait_handler = NULL;
- const char * antfs_hostname_get(void)
- {
- if (m_friendly_name.is_name_set)
- {
- return (m_friendly_name.friendly_name);
- }
- return NULL;
- }
- static void wait_burst_request_to_complete(void)
- {
- while (m_burst_wait != 0)
- {
- if (m_burst_wait_handler != NULL)
- {
- m_burst_wait_handler();
- }
- };
- }
- static void timeout_disable(void)
- {
- m_link_command_in_progress = ANTFS_CMD_NONE;
- const uint32_t err_code = app_timer_stop(m_timer_id);
- APP_ERROR_CHECK(err_code);
- }
- static void beacon_transmit(uint32_t message_type)
- {
- uint8_t beacon_status_byte2;
-
- if (m_link_command_in_progress == ANTFS_CMD_NONE)
- {
- switch (m_current_state.state)
- {
- case ANTFS_STATE_AUTH:
- beacon_status_byte2 = DEVICE_STATE_AUTHENTICATE;
- break;
- case ANTFS_STATE_TRANS:
- beacon_status_byte2 = DEVICE_STATE_TRANSPORT;
- break;
- default:
- beacon_status_byte2 = DEVICE_STATE_LINK;
- break;
- }
- }
- else
- {
- beacon_status_byte2 = DEVICE_STATE_BUSY;
- }
-
- uint8_t tx_buffer[BURST_PACKET_SIZE];
- tx_buffer[0] = ANTFS_BEACON_ID;
- tx_buffer[1] = m_active_beacon_status1_field.status;
- tx_buffer[2] = beacon_status_byte2;
- tx_buffer[3] = AUTHENTICATION_TYPE;
- if ((m_current_state.state == ANTFS_STATE_AUTH) ||
- (m_current_state.state == ANTFS_STATE_TRANS))
- {
- tx_buffer[4] = m_link_host_serial_number.bytes.byte0;
- tx_buffer[5] = m_link_host_serial_number.bytes.byte1;
- tx_buffer[6] = m_link_host_serial_number.bytes.byte2;
- tx_buffer[7] = m_link_host_serial_number.bytes.byte3;
- }
- else
- {
- tx_buffer[4] = m_initial_parameters.beacon_device_type;
- tx_buffer[5] = (m_initial_parameters.beacon_device_type >> 8u);
- tx_buffer[6] = m_initial_parameters.beacon_device_manufacturing_id;
- tx_buffer[7] = (m_initial_parameters.beacon_device_manufacturing_id >> 8u);
- }
- if (message_type == MESG_BROADCAST_DATA_ID)
- {
- if (sd_ant_broadcast_message_tx(ANTFS_CONFIG_CHANNEL_NUMBER, sizeof(tx_buffer), tx_buffer) != NRF_SUCCESS)
- {
-
-
- }
- }
- else if (message_type == MESG_BURST_DATA_ID)
- {
-
- const uint32_t err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_START);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
-
- timeout_disable();
- }
- else
- {
-
- APP_ERROR_HANDLER(message_type);
- }
- }
- static void authenticate_response_transmit(uint8_t response_type,
- uint32_t password_length,
- const uint8_t * p_password)
- {
- ulong_union_t serial_number;
- serial_number.data = m_initial_parameters.client_serial_number;
-
- beacon_transmit(MESG_BURST_DATA_ID);
- uint8_t tx_buffer[BURST_PACKET_SIZE];
- tx_buffer[ANTFS_CONNECTION_TYPE_OFFSET] = ANTFS_COMMAND_ID;
- tx_buffer[ANTFS_RESPONSE_OFFSET] = ANTFS_RSP_AUTHENTICATE_ID;
- tx_buffer[RESPONSE_TYPE_OFFSET] = response_type;
- tx_buffer[AUTH_STRING_LENGTH_OFFSET] = password_length;
- tx_buffer[SERIAL_NUMBER_OFFSET_0] = serial_number.bytes.byte0;
- tx_buffer[SERIAL_NUMBER_OFFSET_1] = serial_number.bytes.byte1;
- tx_buffer[SERIAL_NUMBER_OFFSET_2] = serial_number.bytes.byte2;
- tx_buffer[SERIAL_NUMBER_OFFSET_3] = serial_number.bytes.byte3;
- uint32_t err_code;
- if ((m_current_state.state == ANTFS_STATE_AUTH) &&
- (
- (response_type != AUTH_RESPONSE_REJECT) &&
- password_length &&
- (password_length <= ANTFS_AUTH_STRING_MAX)
- )
- )
- {
-
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_CONTINUE);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
-
- uint8_t tx_buffer_authenticate[ANTFS_AUTH_STRING_MAX + 1u];
- memset(tx_buffer_authenticate, 0, ANTFS_AUTH_STRING_MAX + 1u);
- memcpy(tx_buffer_authenticate, p_password, password_length);
-
- if (password_length & (BURST_PACKET_SIZE - 1u))
- {
- password_length &= ~(BURST_PACKET_SIZE - 1u);
- password_length += BURST_PACKET_SIZE;
- }
-
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- password_length,
- tx_buffer_authenticate,
- BURST_SEGMENT_END);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
- m_link_command_in_progress = ANTFS_RSP_AUTHENTICATE_ID;
- }
- else
- {
-
-
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_END);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
- }
-
- if (response_type == AUTH_RESPONSE_REJECT)
- {
- m_current_state.sub_state.auth_sub_state = ANTFS_AUTH_SUBSTATE_REJECT;
- }
- else if (response_type == AUTH_RESPONSE_ACCEPT)
- {
- m_current_state.sub_state.auth_sub_state = ANTFS_AUTH_SUBSTATE_ACCEPT;
- }
- else
- {
-
- }
- }
- bool antfs_pairing_resp_transmit(bool accept)
- {
- #if ANTFS_CONFIG_AUTH_TYPE_PAIRING_ENABLED
-
- if ((m_current_state.state != ANTFS_STATE_AUTH) ||
- (m_current_state.sub_state.auth_sub_state != ANTFS_AUTH_SUBSTATE_PAIR))
- {
- return false;
- }
- m_link_command_in_progress = ANTFS_CMD_AUTHENTICATE_ID;
- if (accept)
- {
-
- authenticate_response_transmit(AUTH_RESPONSE_ACCEPT,
- ANTFS_PASSKEY_SIZE,
- m_initial_parameters.p_pass_key);
- }
- else
- {
-
- authenticate_response_transmit(AUTH_RESPONSE_REJECT, 0, NULL);
- }
- return true;
- #else
- return false;
- #endif
- }
- static void event_queue_write(antfs_event_t event_code)
- {
- antfs_event_return_t * p_event = NULL;
- #if ANTFS_CONFIG_DEBUG_LED_ENABLED
- uint32_t err_code;
- #endif
-
- if (((m_event_queue.head + 1u) & (ANTFS_EVENT_QUEUE_SIZE - 1u)) != m_event_queue.tail)
- {
- p_event = &(m_event_queue.p_queue[m_event_queue.head]);
- }
- if (p_event != NULL)
- {
-
- p_event->event = event_code;
-
- switch (event_code)
- {
- case ANTFS_EVENT_ERASE_REQUEST:
- p_event->file_index = m_file_index.data;
- p_event->offset = 0;
- p_event->bytes = 0;
- p_event->crc = 0;
- break;
- case ANTFS_EVENT_DOWNLOAD_REQUEST:
- p_event->file_index = m_file_index.data;
-
- p_event->offset = m_link_burst_index.data;
- p_event->bytes = 0;
- p_event->crc = 0;
- break;
- case ANTFS_EVENT_DOWNLOAD_REQUEST_DATA:
- p_event->file_index = m_file_index.data;
-
- p_event->offset = m_link_burst_index.data;
- if (m_bytes_remaining.data > (ANTFS_BURST_BLOCK_SIZE * BURST_PACKET_SIZE))
- {
-
- p_event->bytes = ANTFS_BURST_BLOCK_SIZE * BURST_PACKET_SIZE;
- }
- else
- {
- p_event->bytes = m_bytes_remaining.data;
- }
- p_event->crc = 0;
- break;
- case ANTFS_EVENT_UPLOAD_REQUEST:
- p_event->file_index = m_file_index.data;
-
- p_event->offset = m_link_burst_index.data;
-
- p_event->bytes = m_max_transfer_index.data;
-
- p_event->crc = m_transfer_crc;
- break;
- case ANTFS_EVENT_UPLOAD_DATA:
- p_event->file_index = m_file_index.data;
-
- p_event->offset = m_link_burst_index.data;
-
- p_event->crc = m_transfer_crc;
-
- p_event->bytes = m_bytes_to_write;
-
- memcpy(p_event->data, mp_upload_data, m_bytes_to_write);
- break;
- case ANTFS_EVENT_PAIRING_REQUEST:
- #if ANTFS_CONFIG_DEBUG_LED_ENABLED
- err_code = bsp_indication_set(BSP_INDICATE_BONDING);
- APP_ERROR_CHECK(err_code);
- #endif
- break;
- default:
-
- p_event->file_index = 0;
- p_event->offset = 0;
- p_event->bytes = 0;
- p_event->crc = 0;
- break;
- }
-
- m_event_queue.head = ((m_event_queue.head + 1u) & (ANTFS_EVENT_QUEUE_SIZE - 1u));
- }
- else
- {
-
- APP_ERROR_HANDLER(0);
- }
- }
- static void download_request_response_transmit(uint8_t response)
- {
-
- beacon_transmit(MESG_BURST_DATA_ID);
- uint8_t tx_buffer[BURST_PACKET_SIZE];
-
- tx_buffer[0] = ANTFS_COMMAND_ID;
- tx_buffer[1] = ANTFS_RSP_DOWNLOAD_ID;
- tx_buffer[2] = response;
- tx_buffer[3] = 0;
-
- tx_buffer[4] = m_bytes_remaining.bytes.byte0;
- tx_buffer[5] = m_bytes_remaining.bytes.byte1;
- tx_buffer[6] = m_bytes_remaining.bytes.byte2;
- tx_buffer[7] = m_bytes_remaining.bytes.byte3;
- uint32_t err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_CONTINUE);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
-
-
- tx_buffer[0] = m_link_burst_index.bytes.byte0;
- tx_buffer[1] = m_link_burst_index.bytes.byte1;
- tx_buffer[2] = m_link_burst_index.bytes.byte2;
- tx_buffer[3] = m_link_burst_index.bytes.byte3;
-
- tx_buffer[4] = m_file_size.bytes.byte0;
- tx_buffer[5] = m_file_size.bytes.byte1;
- tx_buffer[6] = m_file_size.bytes.byte2;
- tx_buffer[7] = m_file_size.bytes.byte3;
- if (response || (m_bytes_remaining.data == 0))
- {
-
-
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_END);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
- }
- else
- {
-
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_CONTINUE);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
- }
- m_link_command_in_progress = ANTFS_CMD_DOWNLOAD_ID;
- if (response == 0)
- {
-
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_DOWNLOADING;
- event_queue_write(ANTFS_EVENT_DOWNLOAD_START);
- }
- else
- {
-
- event_queue_write(ANTFS_EVENT_DOWNLOAD_FAIL);
- }
- }
- void antfs_download_req_resp_prepare(uint8_t response,
- const antfs_request_info_t * const p_request_info)
- {
-
- APP_ERROR_CHECK_BOOL((m_current_state.state == ANTFS_STATE_TRANS) &&
- (m_link_command_in_progress == ANTFS_CMD_DOWNLOAD_ID));
- if (response == 0)
- {
-
-
- m_file_size.data = p_request_info->file_size.data;
- if (m_link_burst_index.data > m_file_size.data)
- {
-
- m_link_burst_index.data = m_file_size.data;
- }
-
-
- if ((m_max_block_size.data == 0) || (m_file_size.data < m_max_block_size.data))
- {
-
- m_bytes_remaining.data = m_file_size.data;
- }
- if ((m_file_size.data - m_link_burst_index.data) < m_bytes_remaining.data)
- {
-
- m_bytes_remaining.data = m_file_size.data - m_link_burst_index.data;
- }
-
- if (m_bytes_remaining.data > p_request_info->max_burst_block_size.data)
- {
-
- m_bytes_remaining.data = p_request_info->max_burst_block_size.data;
- }
-
- m_max_transfer_index.data = m_link_burst_index.data + m_bytes_remaining.data;
- if (m_saved_crc_offset == ANTFS_MAX_FILE_SIZE)
- {
-
- response = RESPONSE_INVALID_OPERATION;
- }
- }
- if ((response != 0) || (m_file_size.data == 0))
- {
-
-
- download_request_response_transmit(response);
- }
- else
- {
-
- if (m_link_burst_index.data != m_saved_crc_offset)
- {
- uint32_t temp;
-
- if (m_link_burst_index.data == m_temp_crc_offset)
- {
-
- m_saved_crc_offset = m_link_burst_index.data;
- m_saved_transfer_crc = m_transfer_crc;
- }
-
-
- m_bytes_remaining.data += (m_link_burst_index.data - m_saved_crc_offset);
-
-
- temp = m_link_burst_index.data;
- m_link_burst_index.data = m_saved_crc_offset;
- m_saved_crc_offset = temp;
-
- m_transfer_crc = m_saved_transfer_crc;
- }
- m_temp_crc_offset = m_saved_crc_offset;
- m_is_data_request_pending = true;
-
- event_queue_write(ANTFS_EVENT_DOWNLOAD_REQUEST_DATA);
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_VERIFY_CRC;
- }
- }
- uint32_t antfs_input_data_download(uint16_t index,
- uint32_t offset,
- uint32_t num_bytes,
- const uint8_t * const p_message)
- {
-
- APP_ERROR_CHECK_BOOL((offset == m_link_burst_index.data) && (index == m_file_index.data));
-
- APP_ERROR_CHECK_BOOL(offset <= m_max_transfer_index.data);
- if ((m_current_state.state == ANTFS_STATE_TRANS) &&
- (
- (m_current_state.sub_state.trans_sub_state == ANTFS_TRANS_SUBSTATE_VERIFY_CRC) ||
-
- (m_current_state.sub_state.trans_sub_state == ANTFS_TRANS_SUBSTATE_DOWNLOADING)
- )
- )
- {
- uint32_t block_offset = 0;
- if (m_current_state.sub_state.trans_sub_state == ANTFS_TRANS_SUBSTATE_VERIFY_CRC)
- {
-
- uint32_t response = RESPONSE_MESSAGE_OK;
-
- if (m_link_burst_index.data == m_saved_crc_offset)
- {
-
- if (m_transfer_crc != m_compared_crc)
- {
- response = RESPONSE_INVALID_CRC;
- }
- else
- {
-
- m_temp_crc_offset = m_link_burst_index.data;
- m_saved_crc_offset = m_link_burst_index.data;
- m_saved_buffer_crc_offset = m_link_burst_index.data;
-
- m_saved_transfer_crc = m_compared_crc;
- m_saved_buffer_crc = m_compared_crc;
- m_is_crc_pending = true;
- }
-
- download_request_response_transmit(response);
- }
-
- else if ((m_link_burst_index.data < m_saved_crc_offset) &&
- ((m_saved_crc_offset - m_link_burst_index.data) < num_bytes))
- {
-
- block_offset = m_saved_crc_offset - m_link_burst_index.data;
-
- num_bytes -= block_offset;
-
- m_transfer_crc = crc_crc16_update(m_transfer_crc, p_message, block_offset);
-
- m_bytes_remaining.data -= block_offset;
-
- if (m_transfer_crc != m_compared_crc)
- {
- response = RESPONSE_INVALID_CRC;
- }
- else
- {
-
- m_link_burst_index.data = m_saved_crc_offset;
-
- m_temp_crc_offset = m_link_burst_index.data;
- m_saved_buffer_crc_offset = m_link_burst_index.data;
-
- m_saved_transfer_crc = m_compared_crc;
- m_saved_buffer_crc = m_compared_crc;
- m_is_crc_pending = true;
- }
- download_request_response_transmit(response);
- }
-
- else if (m_link_burst_index.data > m_saved_crc_offset)
- {
- response = RESPONSE_INVALID_CRC;
- download_request_response_transmit(response);
- }
-
- else
- {
- m_is_data_request_pending = false;
-
- m_link_burst_index.data += num_bytes;
- m_bytes_remaining.data -= num_bytes;
-
- m_transfer_crc = crc_crc16_update(m_transfer_crc, p_message, num_bytes);
-
- event_queue_write(ANTFS_EVENT_DOWNLOAD_REQUEST_DATA);
- }
- }
-
- if (m_current_state.sub_state.trans_sub_state == ANTFS_TRANS_SUBSTATE_DOWNLOADING)
- {
- uint32_t num_of_bytes_to_burst = num_bytes;
- if (num_of_bytes_to_burst & (BURST_PACKET_SIZE - 1u))
- {
-
-
- num_of_bytes_to_burst &= ~(BURST_PACKET_SIZE - 1u);
- num_of_bytes_to_burst += BURST_PACKET_SIZE;
- }
- uint32_t err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- num_of_bytes_to_burst,
- (uint8_t*)&(p_message[block_offset]),
- BURST_SEGMENT_CONTINUE);
- if (err_code != NRF_ANT_ERROR_TRANSFER_SEQUENCE_NUMBER_ERROR)
- {
-
-
- APP_ERROR_CHECK(err_code);
- }
- wait_burst_request_to_complete();
-
- m_link_burst_index.data += num_bytes;
-
- m_bytes_remaining.data -= num_bytes;
- m_is_data_request_pending = false;
- m_transfer_crc = crc_crc16_update(m_transfer_crc,
- &(p_message[block_offset]),
- num_bytes);
- if ((m_link_burst_index.data - m_temp_crc_offset) > SAVE_DISTANCE)
- {
-
- m_saved_transfer_crc = m_saved_buffer_crc;
- m_saved_buffer_crc = m_transfer_crc;
-
- m_saved_crc_offset = m_saved_buffer_crc_offset;
- m_saved_buffer_crc_offset = m_link_burst_index.data;
-
- m_temp_crc_offset = m_link_burst_index.data;
- }
- if (!m_is_data_request_pending && (m_link_burst_index.data < m_max_transfer_index.data))
- {
-
-
- event_queue_write(ANTFS_EVENT_DOWNLOAD_REQUEST_DATA);
- m_is_data_request_pending = true;
- }
- else if (m_link_burst_index.data >= m_max_transfer_index.data && m_is_crc_pending)
- {
-
- uint8_t tx_buffer[BURST_PACKET_SIZE];
- tx_buffer[0] = 0;
- tx_buffer[1] = 0;
- tx_buffer[2] = 0;
- tx_buffer[3] = 0;
- tx_buffer[4] = 0;
- tx_buffer[5] = 0;
- tx_buffer[6] = (uint8_t)m_transfer_crc;
- tx_buffer[7] = (uint8_t)(m_transfer_crc >> 8u);
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_END);
- if (err_code != NRF_ANT_ERROR_TRANSFER_SEQUENCE_NUMBER_ERROR)
- {
-
-
- APP_ERROR_CHECK(err_code);
- }
- wait_burst_request_to_complete();
- m_is_crc_pending = false;
- m_max_transfer_index.data = 0;
- }
-
- return num_bytes;
- }
- }
-
- return 0;
- }
- bool antfs_upload_req_resp_transmit(uint8_t response,
- const antfs_request_info_t * const p_request_info)
- {
- #if ANTFS_CONFIG_UPLOAD_ENABLED
- if (m_current_state.state != ANTFS_STATE_TRANS ||
-
- (m_link_command_in_progress != ANTFS_CMD_UPLOAD_REQUEST_ID))
- {
- return false;
- }
-
-
- if (p_request_info->file_index.data != m_file_index.data)
- {
- event_queue_write(ANTFS_EVENT_UPLOAD_FAIL);
- return false;
- }
- ulong_union_t max_mem_size;
-
- max_mem_size.data = p_request_info->max_file_size;
- if (p_request_info->max_burst_block_size.data != 0)
- {
-
- m_block_size.data = p_request_info->max_burst_block_size.data;
- }
- else
- {
-
- m_block_size.data = max_mem_size.data;
- }
- if (response == 0)
- {
- if (m_max_transfer_index.data > max_mem_size.data)
- {
-
- response = RESPONSE_MESSAGE_NOT_ENOUGH_SPACE;
- }
- }
-
- m_transfer_crc = p_request_info->file_crc;
- m_link_burst_index.data = p_request_info->file_size.data;
-
- beacon_transmit(MESG_BURST_DATA_ID);
-
- uint8_t tx_buffer[BURST_PACKET_SIZE];
- tx_buffer[0] = ANTFS_COMMAND_ID;
- tx_buffer[1] = ANTFS_RSP_UPLOAD_REQ_ID;
- tx_buffer[2] = response;
- tx_buffer[3] = 0;
-
- tx_buffer[4] = m_link_burst_index.bytes.byte0;
- tx_buffer[5] = m_link_burst_index.bytes.byte1;
- tx_buffer[6] = m_link_burst_index.bytes.byte2;
- tx_buffer[7] = m_link_burst_index.bytes.byte3;
- uint32_t err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_CONTINUE);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
-
-
- tx_buffer[0] = max_mem_size.bytes.byte0;
- tx_buffer[1] = max_mem_size.bytes.byte1;
- tx_buffer[2] = max_mem_size.bytes.byte2;
- tx_buffer[3] = max_mem_size.bytes.byte3;
-
- tx_buffer[4] = m_block_size.bytes.byte0;
- tx_buffer[5] = m_block_size.bytes.byte1;
- tx_buffer[6] = m_block_size.bytes.byte2;
- tx_buffer[7] = m_block_size.bytes.byte3;
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_CONTINUE);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
-
- tx_buffer[0] = 0;
- tx_buffer[1] = 0;
- tx_buffer[2] = 0;
- tx_buffer[3] = 0;
- tx_buffer[4] = 0;
- tx_buffer[5] = 0;
-
- tx_buffer[6] = (uint8_t) m_transfer_crc;
- tx_buffer[7] = (uint8_t)(m_transfer_crc >> 8);
- err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_END);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
- m_link_command_in_progress = ANTFS_CMD_UPLOAD_REQUEST_ID;
- if (response != 0)
- {
-
-
- m_max_transfer_index.data = 0;
- }
- else
- {
-
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_UPLOAD_WAIT_FOR_DATA;
- }
- return true;
- #else
- return false;
- #endif
- }
- bool antfs_upload_data_resp_transmit(bool data_upload_success)
- {
- #if ANTFS_CONFIG_UPLOAD_ENABLED
-
- if (m_current_state.state != ANTFS_STATE_TRANS)
- {
- return false;
- }
- uint8_t tx_buffer[BURST_PACKET_SIZE];
-
- tx_buffer[0] = ANTFS_COMMAND_ID;
- tx_buffer[1] = ANTFS_RSP_UPLOAD_DATA_ID;
- tx_buffer[2] = (data_upload_success) ? RESPONSE_MESSAGE_OK : RESPONSE_MESSAGE_FAIL;
- tx_buffer[3] = 0;
- tx_buffer[4] = 0;
- tx_buffer[5] = 0;
- tx_buffer[6] = 0;
- tx_buffer[7] = 0;
-
- beacon_transmit(MESG_BURST_DATA_ID);
-
- uint32_t err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_END);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
- m_link_command_in_progress = ANTFS_CMD_UPLOAD_REQUEST_ID;
-
- m_max_transfer_index.data = 0;
- return true;
- #else
- return false;
- #endif
- }
- void antfs_erase_req_resp_transmit(uint8_t response)
- {
-
- APP_ERROR_CHECK_BOOL((m_current_state.state == ANTFS_STATE_TRANS) &&
- (m_link_command_in_progress == ANTFS_CMD_ERASE_ID));
- beacon_transmit(MESG_BURST_DATA_ID);
- uint8_t tx_buffer[BURST_PACKET_SIZE];
-
- tx_buffer[0] = ANTFS_COMMAND_ID;
- tx_buffer[1] = ANTFS_RSP_ERASE_ID;
- tx_buffer[2] = response;
- tx_buffer[3] = 0;
- tx_buffer[4] = 0;
- tx_buffer[5] = 0;
- tx_buffer[6] = 0;
- tx_buffer[7] = 0;
- uint32_t err_code = sd_ant_burst_handler_request(ANTFS_CONFIG_CHANNEL_NUMBER,
- sizeof(tx_buffer),
- tx_buffer,
- BURST_SEGMENT_END);
- APP_ERROR_CHECK(err_code);
- wait_burst_request_to_complete();
- }
- bool antfs_event_extract(antfs_event_return_t * const p_event)
- {
- bool return_value = false;
- if (m_event_queue.head != m_event_queue.tail)
- {
-
- p_event->event = m_event_queue.p_queue[m_event_queue.tail].event;
- p_event->file_index = m_event_queue.p_queue[m_event_queue.tail].file_index;
- p_event->offset = m_event_queue.p_queue[m_event_queue.tail].offset;
- p_event->bytes = m_event_queue.p_queue[m_event_queue.tail].bytes;
- p_event->crc = m_event_queue.p_queue[m_event_queue.tail].crc;
- memcpy(p_event->data,
- m_event_queue.p_queue[m_event_queue.tail].data,
- sizeof(p_event->data));
-
- m_event_queue.tail = ((m_event_queue.tail + 1u) & (ANTFS_EVENT_QUEUE_SIZE - 1u));
- return_value = true;
- }
- return return_value;
- }
- static void channel_period_set(uint32_t link_period)
- {
- uint32_t period;
- switch (link_period)
- {
- default:
-
- case BEACON_PERIOD_0_5_HZ:
- period = 65535u;
- break;
- case BEACON_PERIOD_1_HZ:
- period = 32768u;
- break;
- case BEACON_PERIOD_2_HZ:
- period = 16384u;
- break;
- case BEACON_PERIOD_4_HZ:
- period = 8192u;
- break;
- case BEACON_PERIOD_8_HZ:
- period = 4096u;
- break;
- }
- const uint32_t err_code = sd_ant_channel_period_set(ANTFS_CONFIG_CHANNEL_NUMBER, period);
- APP_ERROR_CHECK(err_code);
- }
- static void timeout_start(uint32_t timeout_in_secs)
- {
- uint32_t err_code = app_timer_stop(m_timer_id);
- APP_ERROR_CHECK(err_code);
- err_code = app_timer_start(m_timer_id,
- APP_TIMER_TICKS((uint32_t)(timeout_in_secs * 1000u)),
- NULL);
- APP_ERROR_CHECK(err_code);
- }
- static void authenticate_layer_transit(void)
- {
- if (m_current_state.state != ANTFS_STATE_OFF)
- {
- m_current_state.state = ANTFS_STATE_AUTH;
- m_current_state.sub_state.auth_sub_state = ANTFS_AUTH_SUBSTATE_NONE;
- m_link_command_in_progress = ANTFS_CMD_NONE;
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- uint32_t err_code = sd_ant_channel_radio_freq_set(ANTFS_CONFIG_CHANNEL_NUMBER, m_active_beacon_frequency);
- APP_ERROR_CHECK(err_code);
- event_queue_write(ANTFS_EVENT_AUTH);
- }
- }
- static void link_layer_cmd_decode(const uint8_t * p_command_buffer)
- {
- if (p_command_buffer[ANTFS_CONNECTION_TYPE_OFFSET] != ANTFS_COMMAND_ID)
- {
- return;
- }
- switch (p_command_buffer[ANTFS_COMMAND_OFFSET])
- {
- case ANTFS_CMD_LINK_ID:
-
- m_active_beacon_frequency =
- p_command_buffer[TRANSPORT_CHANNEL_FREQUENCY_OFFSET];
-
- m_active_beacon_status1_field.parameters.link_period =
- p_command_buffer[TRANSPORT_MESSAGE_PERIOD_OFFSET];
-
- m_link_host_serial_number.bytes.byte0 =
- p_command_buffer[HOST_ID_OFFSET_0];
- m_link_host_serial_number.bytes.byte1 =
- p_command_buffer[HOST_ID_OFFSET_1];
- m_link_host_serial_number.bytes.byte2 =
- p_command_buffer[HOST_ID_OFFSET_2];
- m_link_host_serial_number.bytes.byte3 =
- p_command_buffer[HOST_ID_OFFSET_3];
-
- channel_period_set(m_active_beacon_status1_field.parameters.link_period);
- authenticate_layer_transit();
- break;
- default:
- break;
- }
- }
- static void link_layer_transit(void)
- {
- if (m_current_state.state != ANTFS_STATE_OFF)
- {
- uint32_t err_code;
- #if ANTFS_CONFIG_DEBUG_LED_ENABLED
- err_code = bsp_indication_set(BSP_INDICATE_IDLE);
- APP_ERROR_CHECK(err_code);
- #endif
- m_current_state.state = ANTFS_STATE_LINK;
- m_current_state.sub_state.link_sub_state = ANTFS_LINK_SUBSTATE_NONE;
- m_link_command_in_progress = ANTFS_CMD_NONE;
- m_active_beacon_status1_field = m_initial_parameters.beacon_status_byte1;
- m_active_beacon_frequency = m_initial_parameters.beacon_frequency;
- timeout_disable();
- err_code = sd_ant_channel_radio_freq_set(ANTFS_CONFIG_CHANNEL_NUMBER, m_active_beacon_frequency);
- APP_ERROR_CHECK(err_code);
- event_queue_write(ANTFS_EVENT_LINK);
- }
- }
- static void authenticate_layer_cmd_decode(uint8_t control_byte,
- const uint8_t * p_command_buffer)
- {
-
-
- #if ANTFS_CONFIG_AUTH_TYPE_PASSKEY_ENABLED
- static uint32_t response;
- #endif
- if ((control_byte & ~SEQUENCE_LAST_MESSAGE) == 0 && m_link_command_in_progress != ANTFS_CMD_NONE)
- {
-
- return;
- }
- if (p_command_buffer[ANTFS_CONNECTION_TYPE_OFFSET] == ANTFS_COMMAND_ID &&
- m_link_command_in_progress == ANTFS_CMD_NONE)
- {
- if (p_command_buffer[ANTFS_COMMAND_OFFSET] == ANTFS_CMD_AUTHENTICATE_ID)
- {
-
- if (m_link_host_serial_number.bytes.byte0 != p_command_buffer[HOST_ID_OFFSET_0] ||
- m_link_host_serial_number.bytes.byte1 != p_command_buffer[HOST_ID_OFFSET_1] ||
- m_link_host_serial_number.bytes.byte2 != p_command_buffer[HOST_ID_OFFSET_2] ||
- m_link_host_serial_number.bytes.byte3 != p_command_buffer[HOST_ID_OFFSET_3])
- return;
- m_link_command_in_progress = ANTFS_CMD_AUTHENTICATE_ID;
- m_authenticate_command_type = p_command_buffer[COMMAND_TYPE_OFFSET];
- m_retry = AUTHENTICATION_RETRIES;
- }
- }
- if (m_link_command_in_progress == ANTFS_CMD_AUTHENTICATE_ID)
- {
- switch (m_authenticate_command_type)
- {
- case COMMAND_TYPE_REQUEST_SERIAL:
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- authenticate_response_transmit(AUTH_RESPONSE_N_A,
- ANTFS_REMOTE_FRIENDLY_NAME_MAX,
-
- m_initial_parameters.p_remote_friendly_name);
- }
- break;
- #if ANTFS_CONFIG_AUTH_TYPE_PASSTHROUGH_ENABLED
- case COMMAND_TYPE_PROCEED:
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
-
- authenticate_response_transmit(AUTH_RESPONSE_ACCEPT, 0, NULL);
- }
- break;
- #endif
- #if ANTFS_CONFIG_AUTH_TYPE_PAIRING_ENABLED
- case COMMAND_TYPE_REQUEST_PAIR:
- if ((control_byte & SEQUENCE_NUMBER_ROLLOVER) == 0)
- {
-
-
- m_friendly_name.friendly_name_size =
- p_command_buffer[AUTH_STRING_LENGTH_OFFSET];
- if (m_friendly_name.friendly_name_size > 0)
- {
- if (m_friendly_name.friendly_name_size > ANTFS_FRIENDLY_NAME_MAX)
- {
- m_friendly_name.friendly_name_size = ANTFS_FRIENDLY_NAME_MAX;
- }
- m_friendly_name.index = 0;
- }
- }
- else
- {
-
- if (m_friendly_name.index < ANTFS_FRIENDLY_NAME_MAX)
- {
- uint32_t num_of_bytes = ANTFS_FRIENDLY_NAME_MAX - m_friendly_name.index;
- if (num_of_bytes > 8u)
- {
- num_of_bytes = 8u;
- }
- memcpy((uint8_t*)&m_friendly_name.friendly_name[m_friendly_name.index],
- p_command_buffer,
- num_of_bytes);
- m_friendly_name.index += num_of_bytes;
- }
- }
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
- timeout_start(ANTFS_CONFIG_PAIRING_TIMEOUT);
- if (m_friendly_name.friendly_name_size > 0)
- {
- m_friendly_name.is_name_set = true;
- }
- m_current_state.sub_state.auth_sub_state = ANTFS_AUTH_SUBSTATE_PAIR;
-
- event_queue_write(ANTFS_EVENT_PAIRING_REQUEST);
- }
- break;
- #endif
- #if ANTFS_CONFIG_AUTH_TYPE_PASSKEY_ENABLED
- case COMMAND_TYPE_REQUEST_PASSKEY:
- if ((control_byte & SEQUENCE_NUMBER_ROLLOVER) == 0)
- {
-
-
- const uint32_t passkey_size = p_command_buffer[AUTH_STRING_LENGTH_OFFSET];
-
- response = AUTH_RESPONSE_ACCEPT;
-
- if (passkey_size == ANTFS_PASSKEY_SIZE)
- {
- m_passkey_index = 0;
- }
- else
- {
-
- response = AUTH_RESPONSE_REJECT;
- }
- }
- else
- {
-
- if ((response == AUTH_RESPONSE_ACCEPT) &&
-
- (m_passkey_index != ANTFS_PASSKEY_SIZE))
- {
-
- uint32_t idx = 0;
-
- do
- {
- if (m_initial_parameters.p_pass_key[m_passkey_index++] !=
- p_command_buffer[idx])
- {
-
-
- response = AUTH_RESPONSE_REJECT;
- break;
- }
- ++idx;
- }
- while (idx < BURST_PACKET_SIZE);
- }
- }
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
- if (m_passkey_index < ANTFS_PASSKEY_SIZE)
- {
-
- response = AUTH_RESPONSE_REJECT;
- }
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- m_current_state.sub_state.auth_sub_state = ANTFS_AUTH_SUBSTATE_PASSKEY;
- authenticate_response_transmit(response, 0, NULL);
- }
- break;
- #endif
- default:
- break;
- }
- }
- else if (p_command_buffer[ANTFS_COMMAND_OFFSET] == ANTFS_CMD_DISCONNECT_ID)
- {
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
- link_layer_transit();
- }
- }
- else if (p_command_buffer[ANTFS_COMMAND_OFFSET] == ANTFS_CMD_PING_ID)
- {
-
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- m_link_command_in_progress = ANTFS_CMD_NONE;
- }
- else
- {
-
- }
- }
- static void transport_layer_cmd_decode(uint8_t control_byte, const uint8_t * p_command_buffer)
- {
- ulong_union_t host_serial_number = {0};
- if (p_command_buffer[ANTFS_CONNECTION_TYPE_OFFSET] == ANTFS_COMMAND_ID)
- {
- m_link_command_in_progress = p_command_buffer[ANTFS_COMMAND_OFFSET];
- }
- switch (m_link_command_in_progress)
- {
- case ANTFS_CMD_PING_ID:
-
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- m_link_command_in_progress = ANTFS_CMD_NONE;
- break;
- case ANTFS_CMD_DISCONNECT_ID:
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
- link_layer_transit();
- }
- break;
- case ANTFS_CMD_ERASE_ID:
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
-
- m_file_index.bytes.low = p_command_buffer[DATA_INDEX_OFFSET_LOW];
- m_file_index.bytes.high = p_command_buffer[DATA_INDEX_OFFSET_HIGH];
-
- event_queue_write(ANTFS_EVENT_ERASE_REQUEST);
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- m_link_command_in_progress = ANTFS_CMD_ERASE_ID;
- }
- break;
- case ANTFS_CMD_DOWNLOAD_ID:
- if (m_current_state.sub_state.trans_sub_state != ANTFS_TRANS_SUBSTATE_NONE)
- {
-
- break;
- }
- if ((control_byte & SEQUENCE_NUMBER_MASK) == SEQUENCE_FIRST_MESSAGE)
- {
-
- if ((m_file_index.bytes.low != p_command_buffer[DATA_INDEX_OFFSET_LOW]) ||
- (m_file_index.bytes.high != p_command_buffer[DATA_INDEX_OFFSET_HIGH]))
- {
-
-
-
-
- m_saved_crc_offset = ANTFS_MAX_FILE_SIZE;
- }
-
- m_file_index.bytes.low = p_command_buffer[DATA_INDEX_OFFSET_LOW];
- m_file_index.bytes.high = p_command_buffer[DATA_INDEX_OFFSET_HIGH];
-
- m_link_burst_index.bytes.byte0 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_0];
- m_link_burst_index.bytes.byte1 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_1];
- m_link_burst_index.bytes.byte2 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_2];
- m_link_burst_index.bytes.byte3 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_3];
- }
- else if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
-
- m_compared_crc = (uint16_t)p_command_buffer[DATA_INDEX_OFFSET_LOW];
- m_compared_crc |= ((uint16_t)p_command_buffer[DATA_INDEX_OFFSET_HIGH] << 8u);
-
- m_max_block_size.bytes.byte0 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_0];
- m_max_block_size.bytes.byte1 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_1];
- m_max_block_size.bytes.byte2 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_2];
- m_max_block_size.bytes.byte3 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_3];
-
- m_bytes_remaining.data = m_max_block_size.data;
- if (p_command_buffer[INITIAL_REQUEST_OFFSET])
- {
-
-
- m_saved_crc_offset = m_link_burst_index.data;
- m_saved_buffer_crc_offset = m_link_burst_index.data;
-
- m_transfer_crc = m_compared_crc;
- m_saved_transfer_crc = m_compared_crc;
- m_saved_buffer_crc = m_compared_crc;
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_VERIFY_CRC;
- }
- else
- {
-
- if (m_saved_crc_offset > m_link_burst_index.data)
- {
-
-
-
- m_saved_crc_offset = ANTFS_MAX_FILE_SIZE;
- }
- else
- {
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_VERIFY_CRC;
- }
- }
- m_is_data_request_pending = false;
-
- event_queue_write(ANTFS_EVENT_DOWNLOAD_REQUEST);
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- m_link_command_in_progress = ANTFS_CMD_DOWNLOAD_ID;
- }
- break;
- case ANTFS_CMD_UPLOAD_REQUEST_ID:
- #if ANTFS_CONFIG_UPLOAD_ENABLED
- if ((control_byte & ~SEQUENCE_LAST_MESSAGE) == 0x00)
- {
-
- if ((m_file_index.bytes.low != p_command_buffer[DATA_INDEX_OFFSET_LOW]) ||
- (
- (m_file_index.bytes.high != p_command_buffer[DATA_INDEX_OFFSET_HIGH]) ||
- (m_current_state.sub_state.trans_sub_state == ANTFS_TRANS_SUBSTATE_NONE)
- )
- )
- {
-
-
- m_file_index.bytes.low = p_command_buffer[DATA_INDEX_OFFSET_LOW];
- m_file_index.bytes.high = p_command_buffer[DATA_INDEX_OFFSET_HIGH];
-
-
- m_saved_crc_offset = 0;
- m_saved_transfer_crc = 0;
- }
-
- m_max_transfer_index.bytes.byte0 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_0];
- m_max_transfer_index.bytes.byte1 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_1];
- m_max_transfer_index.bytes.byte2 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_2];
- m_max_transfer_index.bytes.byte3 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_3];
- }
- else if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
-
- m_link_burst_index.bytes.byte0 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_0];
- m_link_burst_index.bytes.byte1 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_1];
- m_link_burst_index.bytes.byte2 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_2];
- m_link_burst_index.bytes.byte3 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_3];
- if (m_link_burst_index.data != ANTFS_MAX_FILE_SIZE)
- {
-
-
- m_saved_crc_offset = m_link_burst_index.data;
- m_saved_transfer_crc = 0;
- }
- m_transfer_crc = m_saved_transfer_crc;
-
- event_queue_write(ANTFS_EVENT_UPLOAD_REQUEST);
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- m_link_command_in_progress = ANTFS_CMD_UPLOAD_REQUEST_ID;
- }
- #endif
- break;
- case ANTFS_CMD_UPLOAD_DATA_ID:
- #if ANTFS_CONFIG_UPLOAD_ENABLED
- if ((control_byte & ~SEQUENCE_LAST_MESSAGE) == 0x00)
- {
-
- if (m_current_state.sub_state.trans_sub_state ==
- ANTFS_TRANS_SUBSTATE_UPLOAD_WAIT_FOR_DATA)
- {
- antfs_event_t event;
-
- m_compared_crc = (uint16_t)p_command_buffer[DATA_INDEX_OFFSET_LOW];
- m_compared_crc |= ((uint16_t)p_command_buffer[DATA_INDEX_OFFSET_HIGH] << 8u);
-
- m_link_burst_index.bytes.byte0 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_0];
- m_link_burst_index.bytes.byte1 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_1];
- m_link_burst_index.bytes.byte2 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_2];
- m_link_burst_index.bytes.byte3 = p_command_buffer[ADDRESS_PARAMETER_OFFSET_3];
- if ((m_link_burst_index.data + m_block_size.data) < m_max_transfer_index.data)
- {
-
- m_max_transfer_index.data = m_link_burst_index.data + m_block_size.data;
- }
- if (m_compared_crc != m_transfer_crc)
- {
-
-
- m_max_transfer_index.data = 0;
-
- event = (antfs_event_t)0;
- }
-
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_UPLOADING;
- event = ANTFS_EVENT_UPLOAD_START;
- m_transfer_crc = m_compared_crc;
- if (m_link_burst_index.data > m_max_transfer_index.data)
- {
-
-
-
- m_max_transfer_index.data = 0;
-
-
- event = (antfs_event_t)0;
- }
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
-
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_NONE;
-
-
- if (event == 0)
- {
- event = ANTFS_EVENT_UPLOAD_FAIL;
- }
- else
- {
- event = ANTFS_EVENT_UPLOAD_COMPLETE;
- }
- }
- if (event != 0)
- {
- event_queue_write(event);
- }
- }
- }
- #endif
- break;
- case ANTFS_CMD_LINK_ID:
- host_serial_number.bytes.byte0 = p_command_buffer[HOST_ID_OFFSET_0];
- host_serial_number.bytes.byte1 = p_command_buffer[HOST_ID_OFFSET_1];
- host_serial_number.bytes.byte2 = p_command_buffer[HOST_ID_OFFSET_2];
- host_serial_number.bytes.byte3 = p_command_buffer[HOST_ID_OFFSET_3];
- if (m_link_host_serial_number.data == host_serial_number.data)
- {
- m_active_beacon_frequency = p_command_buffer[TRANSPORT_CHANNEL_FREQUENCY_OFFSET];
- m_active_beacon_status1_field.parameters.link_period =
- p_command_buffer[TRANSPORT_MESSAGE_PERIOD_OFFSET];
- const uint32_t err_code = sd_ant_channel_radio_freq_set(ANTFS_CONFIG_CHANNEL_NUMBER,
- m_active_beacon_frequency);
- APP_ERROR_CHECK(err_code);
- channel_period_set(m_active_beacon_status1_field.parameters.link_period);
- }
- m_link_command_in_progress = 0;
- break;
- default:
-
- m_link_command_in_progress = 0;
- break;
- }
- }
- static void upload_data_process(uint8_t control_byte, const uint8_t * p_buffer)
- {
- #if ANTFS_CONFIG_UPLOAD_ENABLED
- if (control_byte & SEQUENCE_LAST_MESSAGE)
- {
-
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_NONE;
-
- m_compared_crc = p_buffer[UPLOAD_CRC_OFFSET_LOW ];
- m_compared_crc |= (p_buffer[UPLOAD_CRC_OFFSET_HIGH] << 8u);
- if (m_max_transfer_index.data && (m_compared_crc == m_transfer_crc))
- {
-
- event_queue_write(ANTFS_EVENT_UPLOAD_COMPLETE);
- }
- else
- {
-
- event_queue_write(ANTFS_EVENT_UPLOAD_FAIL);
- }
- m_max_transfer_index.data = 0;
- }
- else
- {
-
-
- m_bytes_to_write = BURST_PACKET_SIZE;
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- if (m_link_burst_index.data > m_max_transfer_index.data)
- {
-
- m_bytes_to_write = 0;
- }
- else
- {
- if ((m_bytes_to_write + m_link_burst_index.data) > m_max_transfer_index.data)
- {
-
-
- m_bytes_to_write = m_max_transfer_index.data - m_link_burst_index.data;
- }
- }
- if (m_bytes_to_write != 0)
- {
- APP_ERROR_CHECK_BOOL(m_bytes_to_write <= BURST_PACKET_SIZE);
-
- mp_upload_data = p_buffer;
- m_transfer_crc = crc_crc16_update(m_transfer_crc, p_buffer, m_bytes_to_write);
-
- event_queue_write(ANTFS_EVENT_UPLOAD_DATA);
-
- m_link_burst_index.data += m_bytes_to_write;
-
- m_saved_crc_offset = m_link_burst_index.data;
- m_saved_transfer_crc = m_transfer_crc;
- }
- }
- #endif
- }
- static void transport_layer_transit(void)
- {
- if (m_current_state.state != ANTFS_STATE_OFF)
- {
- #if ANTFS_CONFIG_DEBUG_LED_ENABLED
- uint32_t err_code = bsp_indication_set(BSP_INDICATE_IDLE);
- APP_ERROR_CHECK(err_code);
- #endif
- m_current_state.state = ANTFS_STATE_TRANS;
- m_current_state.sub_state.trans_sub_state = ANTFS_TRANS_SUBSTATE_NONE;
- timeout_start(ANTFS_CONFIG_LINK_COMMAND_TIMEOUT);
- beacon_transmit(MESG_BROADCAST_DATA_ID);
- event_queue_write(ANTFS_EVENT_TRANS);
- }
- }
- void antfs_message_process(uint8_t * p_message)
- {
- #if ANTFS_CONFIG_DEBUG_LED_ENABLED
- uint32_t err_code;
- #endif
- if (p_message != NULL)
- {
- if ((p_message[BUFFER_INDEX_CHANNEL_NUM] & CHANNEL_NUMBER_MASK) != ANTFS_CONFIG_CHANNEL_NUMBER)
- {
-
- return;
- }
- if ((m_current_state.state == ANTFS_STATE_OFF) &&
- (
- !(
- (p_message[BUFFER_INDEX_MESG_ID] == MESG_RESPONSE_EVENT_ID) &&
- (p_message[BUFFER_INDEX_RESPONSE_CODE] == NO_EVENT)
- )
- )
- )
- {
- return;
- }
- switch (p_message[BUFFER_INDEX_MESG_ID])
- {
- case MESG_BROADCAST_DATA_ID:
-
- break;
- case MESG_ACKNOWLEDGED_DATA_ID:
-
- p_message[ANTFS_CONTROL_OFFSET] |= SEQUENCE_LAST_MESSAGE;
-
- case MESG_BURST_DATA_ID:
- switch (m_current_state.state)
- {
- case ANTFS_STATE_LINK:
- link_layer_cmd_decode(&p_message[ANTFS_DATA_OFFSET]);
- break;
- case ANTFS_STATE_AUTH:
- authenticate_layer_cmd_decode(p_message[ANTFS_CONTROL_OFFSET],
- &p_message[ANTFS_DATA_OFFSET]);
- break;
- case ANTFS_STATE_TRANS:
- if (m_current_state.sub_state.trans_sub_state !=
- ANTFS_TRANS_SUBSTATE_UPLOADING)
- {
- transport_layer_cmd_decode(p_message[ANTFS_CONTROL_OFFSET],
- &p_message[ANTFS_DATA_OFFSET]);
- }
- else
- {
- upload_data_process(p_message[ANTFS_CONTROL_OFFSET],
- &p_message[ANTFS_DATA_OFFSET]);
- }
- break;
- default:
-
- break;
- }
- break;
- case MESG_RESPONSE_EVENT_ID:
-
- switch (p_message[BUFFER_INDEX_RESPONSE_CODE])
- {
- case EVENT_TRANSFER_TX_FAILED:
- m_link_command_in_progress = ANTFS_CMD_NONE;
-
-
- switch (m_current_state.state)
- {
- case ANTFS_STATE_LINK:
- link_layer_transit();
- break;
- case ANTFS_STATE_AUTH:
-
- if (!m_retry)
- {
- authenticate_layer_transit();
- }
- else
- {
- if (m_current_state.sub_state.auth_sub_state == ANTFS_AUTH_SUBSTATE_ACCEPT)
- {
- if (m_authenticate_command_type == COMMAND_TYPE_REQUEST_PAIR)
- {
- authenticate_response_transmit(AUTH_RESPONSE_ACCEPT, ANTFS_PASSKEY_SIZE,
- m_initial_parameters.p_pass_key);
- }
- else
- {
- authenticate_response_transmit(AUTH_RESPONSE_ACCEPT, 0, NULL);
- }
- }
- else if (m_current_state.sub_state.auth_sub_state == ANTFS_AUTH_SUBSTATE_REJECT)
- {
- authenticate_response_transmit(AUTH_RESPONSE_REJECT, 0, NULL);
- }
- else if (m_authenticate_command_type == COMMAND_TYPE_REQUEST_SERIAL)
- {
- authenticate_response_transmit(AUTH_RESPONSE_N_A,
- ANTFS_REMOTE_FRIENDLY_NAME_MAX,
-
- m_initial_parameters.p_remote_friendly_name);
- }
- else
- {
-
- }
- m_retry--;
- }
- break;
- case ANTFS_STATE_TRANS:
- if (m_current_state.sub_state.trans_sub_state ==
- ANTFS_TRANS_SUBSTATE_DOWNLOADING)
- {
- event_queue_write(ANTFS_EVENT_DOWNLOAD_FAIL);
- }
- transport_layer_transit();
- break;
- default:
-
- break;
- }
- break;
- case EVENT_TRANSFER_RX_FAILED:
- m_link_command_in_progress = ANTFS_CMD_NONE;
- if (m_current_state.sub_state.trans_sub_state ==
- ANTFS_TRANS_SUBSTATE_UPLOADING)
- {
- event_queue_write(ANTFS_EVENT_UPLOAD_FAIL);
- m_current_state.sub_state.trans_sub_state =
- ANTFS_TRANS_SUBSTATE_UPLOAD_RESUME;
- }
- else
- {
-
- }
- break;
- case EVENT_TRANSFER_TX_COMPLETED:
- m_link_command_in_progress = ANTFS_CMD_NONE;
-
- switch (m_current_state.state)
- {
- case ANTFS_STATE_AUTH:
- if (m_current_state.sub_state.auth_sub_state ==
- ANTFS_AUTH_SUBSTATE_ACCEPT)
- {
-
- transport_layer_transit();
- }
- else if (m_current_state.sub_state.auth_sub_state ==
- ANTFS_AUTH_SUBSTATE_REJECT)
- {
-
- link_layer_transit();
- }
- else
- {
-
- authenticate_layer_transit();
- }
- break;
- case ANTFS_STATE_TRANS:
- if (m_current_state.sub_state.trans_sub_state ==
- ANTFS_TRANS_SUBSTATE_DOWNLOADING)
- {
- event_queue_write(ANTFS_EVENT_DOWNLOAD_COMPLETE);
- }
- if (m_current_state.sub_state.trans_sub_state !=
- ANTFS_TRANS_SUBSTATE_UPLOAD_WAIT_FOR_DATA)
- {
- transport_layer_transit();
- }
- break;
- default:
- link_layer_transit();
- break;
- }
- break;
- case EVENT_TX:
- #if ANTFS_CONFIG_DEBUG_LED_ENABLED
- err_code = bsp_indication_set(BSP_INDICATE_SENT_OK);
- APP_ERROR_CHECK(err_code);
- #endif
-
- beacon_transmit(MESG_BROADCAST_DATA_ID);
- break;
- case EVENT_CHANNEL_CLOSED:
- event_queue_write(ANTFS_EVENT_CLOSE_COMPLETE);
- break;
- case NO_EVENT:
-
- APP_ERROR_HANDLER(p_message[BUFFER_INDEX_RESPONSE_CODE]);
- break;
- default:
-
- return;
- }
- break;
- default:
-
- return;
- }
- }
- }
- void antfs_channel_setup(void)
- {
-
- uint32_t err_code = ant_fs_key_set(ANTFS_CONFIG_NETWORK_NUMBER);
- APP_ERROR_CHECK(err_code);
- err_code = sd_ant_channel_assign(ANTFS_CONFIG_CHANNEL_NUMBER,
- ANTFS_CHANNEL_TYPE,
- ANTFS_CONFIG_NETWORK_NUMBER,
- 0);
- APP_ERROR_CHECK(err_code);
-
- uint16_t device_number = (uint16_t)(m_initial_parameters.client_serial_number & 0x0000FFFFu);
- if (device_number == 0)
- {
-
- device_number = 2;
- }
- err_code = sd_ant_channel_id_set(ANTFS_CONFIG_CHANNEL_NUMBER,
- device_number,
- ANTFS_CONFIG_DEVICE_TYPE,
- ANTFS_CONFIG_TRANS_TYPE);
- APP_ERROR_CHECK(err_code);
-
- m_current_state.state = ANTFS_STATE_INIT;
-
- link_layer_transit();
- m_current_state.state = ANTFS_STATE_INIT;
- channel_period_set(m_active_beacon_status1_field.parameters.link_period);
- err_code = sd_ant_channel_open(ANTFS_CONFIG_CHANNEL_NUMBER);
- APP_ERROR_CHECK(err_code);
- err_code = sd_ant_channel_radio_tx_power_set(ANTFS_CONFIG_CHANNEL_NUMBER,
- ANTFS_CONFIG_TRANSMIT_POWER,
- ANTFS_CONFIG_CUSTOM_TRANSMIT_POWER);
- APP_ERROR_CHECK(err_code);
- m_current_state.state = ANTFS_STATE_LINK;
- m_current_state.sub_state.link_sub_state = ANTFS_LINK_SUBSTATE_NONE;
- event_queue_write(ANTFS_EVENT_OPEN_COMPLETE);
-
- beacon_transmit(MESG_BROADCAST_DATA_ID);
- }
- static void state_machine_reset(void)
- {
- m_current_state.state = ANTFS_STATE_OFF;
- m_link_command_in_progress = ANTFS_CMD_NONE;
- timeout_disable();
-
- m_event_queue.p_queue = m_event_queue_buffer;
- m_event_queue.head = 0;
- m_event_queue.tail = 0;
-
- m_authenticate_command_type = 0xFFu;
- m_retry = 0;
- m_saved_crc_offset = 0xFFFFFFFFu;
- m_max_transfer_index.data = 0;
- m_is_crc_pending = false;
- m_is_data_request_pending = false;
- m_friendly_name.is_name_set = false;
- m_friendly_name.index = 0;
- memset(m_friendly_name.friendly_name, 0, ANTFS_FRIENDLY_NAME_MAX);
- }
- static void timeout_handle(void * p_context)
- {
- if (m_current_state.state == ANTFS_STATE_OFF)
- {
- return;
- }
- if ((m_current_state.state == ANTFS_STATE_AUTH) &&
-
- (m_current_state.sub_state.auth_sub_state == ANTFS_AUTH_SUBSTATE_PAIR))
- {
-
- authenticate_response_transmit(AUTH_RESPONSE_REJECT, 0, NULL);
- event_queue_write(ANTFS_EVENT_PAIRING_TIMEOUT);
- }
-
- link_layer_transit();
- }
- void antfs_init(const antfs_params_t * const p_params,
- antfs_burst_wait_handler_t burst_wait_handler)
- {
- m_initial_parameters = *p_params;
- m_burst_wait_handler = burst_wait_handler;
- m_active_beacon_status1_field = m_initial_parameters.beacon_status_byte1;
- uint32_t err_code = app_timer_create(&m_timer_id, APP_TIMER_MODE_SINGLE_SHOT, timeout_handle);
- APP_ERROR_CHECK(err_code);
- state_machine_reset();
- err_code = sd_ant_burst_handler_wait_flag_enable((uint8_t *)(&m_burst_wait));
- APP_ERROR_CHECK(err_code);
- }
- #endif
|