177ba3d3fSMatthias Ringwald /* 277ba3d3fSMatthias Ringwald * Copyright (C) 2014 BlueKitchen GmbH 377ba3d3fSMatthias Ringwald * 477ba3d3fSMatthias Ringwald * Redistribution and use in source and binary forms, with or without 577ba3d3fSMatthias Ringwald * modification, are permitted provided that the following conditions 677ba3d3fSMatthias Ringwald * are met: 777ba3d3fSMatthias Ringwald * 877ba3d3fSMatthias Ringwald * 1. Redistributions of source code must retain the above copyright 977ba3d3fSMatthias Ringwald * notice, this list of conditions and the following disclaimer. 1077ba3d3fSMatthias Ringwald * 2. Redistributions in binary form must reproduce the above copyright 1177ba3d3fSMatthias Ringwald * notice, this list of conditions and the following disclaimer in the 1277ba3d3fSMatthias Ringwald * documentation and/or other materials provided with the distribution. 1377ba3d3fSMatthias Ringwald * 3. Neither the name of the copyright holders nor the names of 1477ba3d3fSMatthias Ringwald * contributors may be used to endorse or promote products derived 1577ba3d3fSMatthias Ringwald * from this software without specific prior written permission. 1677ba3d3fSMatthias Ringwald * 4. Any redistribution, use, or modification is done solely for 1777ba3d3fSMatthias Ringwald * personal benefit and not for any commercial purpose or for 1877ba3d3fSMatthias Ringwald * monetary gain. 1977ba3d3fSMatthias Ringwald * 2077ba3d3fSMatthias Ringwald * THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS 2177ba3d3fSMatthias Ringwald * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 2277ba3d3fSMatthias Ringwald * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 2377ba3d3fSMatthias Ringwald * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS 2477ba3d3fSMatthias Ringwald * RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 2577ba3d3fSMatthias Ringwald * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 2677ba3d3fSMatthias Ringwald * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS 2777ba3d3fSMatthias Ringwald * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 2877ba3d3fSMatthias Ringwald * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 2977ba3d3fSMatthias Ringwald * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF 3077ba3d3fSMatthias Ringwald * THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 3177ba3d3fSMatthias Ringwald * SUCH DAMAGE. 3277ba3d3fSMatthias Ringwald * 3377ba3d3fSMatthias Ringwald * Please inquire about commercial licensing options at 3477ba3d3fSMatthias Ringwald * [email protected] 3577ba3d3fSMatthias Ringwald * 3677ba3d3fSMatthias Ringwald */ 3777ba3d3fSMatthias Ringwald 382d4000d1SMatthias Ringwald #define BTSTACK_FILE__ "mesh_lower_transport.c" 3977ba3d3fSMatthias Ringwald 4077ba3d3fSMatthias Ringwald #include <stdio.h> 4177ba3d3fSMatthias Ringwald #include <stdlib.h> 4277ba3d3fSMatthias Ringwald #include <string.h> 43fc5e2620SMatthias Ringwald #include <btstack.h> 44f4854a5eSMatthias Ringwald 4577ba3d3fSMatthias Ringwald #include "btstack_memory.h" 46f4854a5eSMatthias Ringwald #include "btstack_util.h" 47f4854a5eSMatthias Ringwald 48683cf298SMatthias Ringwald #include "mesh/beacon.h" 49f4854a5eSMatthias Ringwald #include "mesh/mesh_iv_index_seq_number.h" 50f4854a5eSMatthias Ringwald #include "mesh/mesh_lower_transport.h" 51683cf298SMatthias Ringwald #include "mesh/mesh_node.h" 52f4854a5eSMatthias Ringwald #include "mesh/mesh_peer.h" 5377ba3d3fSMatthias Ringwald 54b66a7a84SMatthias Ringwald #define LOG_LOWER_TRANSPORT 55b66a7a84SMatthias Ringwald 5677ba3d3fSMatthias Ringwald static void (*higher_layer_handler)( mesh_transport_callback_type_t callback_type, mesh_transport_status_t status, mesh_pdu_t * pdu); 5777ba3d3fSMatthias Ringwald 5877ba3d3fSMatthias Ringwald static void mesh_print_hex(const char * name, const uint8_t * data, uint16_t len){ 5977ba3d3fSMatthias Ringwald printf("%-20s ", name); 6077ba3d3fSMatthias Ringwald printf_hexdump(data, len); 6177ba3d3fSMatthias Ringwald } 6277ba3d3fSMatthias Ringwald // static void mesh_print_x(const char * name, uint32_t value){ 6377ba3d3fSMatthias Ringwald // printf("%20s: 0x%x", name, (int) value); 6477ba3d3fSMatthias Ringwald // } 6577ba3d3fSMatthias Ringwald 6677ba3d3fSMatthias Ringwald // utility 6777ba3d3fSMatthias Ringwald 68cdcfd2c1SMatthias Ringwald mesh_message_pdu_t * mesh_message_pdu_get(void){ 69926e8875SMatthias Ringwald mesh_message_pdu_t * message_pdu = btstack_memory_mesh_message_pdu_get(); 70926e8875SMatthias Ringwald if (message_pdu){ 71926e8875SMatthias Ringwald message_pdu->pdu_header.pdu_type = MESH_PDU_TYPE_MESSAGE; 72926e8875SMatthias Ringwald } 73926e8875SMatthias Ringwald return message_pdu; 74926e8875SMatthias Ringwald } 75926e8875SMatthias Ringwald 76cdcfd2c1SMatthias Ringwald void mesh_message_pdu_free(mesh_message_pdu_t * message_pdu){ 77cdcfd2c1SMatthias Ringwald while (message_pdu->segments){ 78cdcfd2c1SMatthias Ringwald mesh_network_pdu_t * segment = (mesh_network_pdu_t *) btstack_linked_list_pop(&message_pdu->segments); 79cdcfd2c1SMatthias Ringwald mesh_network_pdu_free(segment); 80cdcfd2c1SMatthias Ringwald } 81926e8875SMatthias Ringwald btstack_memory_mesh_message_pdu_free(message_pdu); 82926e8875SMatthias Ringwald } 83926e8875SMatthias Ringwald 8435699c48SMatthias Ringwald static void mesh_lower_transport_report_segments_as_processed(mesh_message_pdu_t * message_pdu) { 8535699c48SMatthias Ringwald while (message_pdu->segments){ 8635699c48SMatthias Ringwald mesh_network_pdu_t * segment = (mesh_network_pdu_t *) btstack_linked_list_pop(&message_pdu->segments); 8735699c48SMatthias Ringwald mesh_network_message_processed_by_higher_layer(segment); 8835699c48SMatthias Ringwald } 8935699c48SMatthias Ringwald } 9035699c48SMatthias Ringwald 9135699c48SMatthias Ringwald 9277ba3d3fSMatthias Ringwald // Transport PDU Getter 9377ba3d3fSMatthias Ringwald uint16_t mesh_transport_nid(mesh_transport_pdu_t * transport_pdu){ 9477ba3d3fSMatthias Ringwald return transport_pdu->network_header[0] & 0x7f; 9577ba3d3fSMatthias Ringwald } 9677ba3d3fSMatthias Ringwald uint16_t mesh_transport_ctl(mesh_transport_pdu_t * transport_pdu){ 9777ba3d3fSMatthias Ringwald return transport_pdu->network_header[1] >> 7; 9877ba3d3fSMatthias Ringwald } 9977ba3d3fSMatthias Ringwald uint16_t mesh_transport_ttl(mesh_transport_pdu_t * transport_pdu){ 10077ba3d3fSMatthias Ringwald return transport_pdu->network_header[1] & 0x7f; 10177ba3d3fSMatthias Ringwald } 10277ba3d3fSMatthias Ringwald uint32_t mesh_transport_seq(mesh_transport_pdu_t * transport_pdu){ 10377ba3d3fSMatthias Ringwald return big_endian_read_24(transport_pdu->network_header, 2); 10477ba3d3fSMatthias Ringwald } 10577ba3d3fSMatthias Ringwald uint16_t mesh_transport_src(mesh_transport_pdu_t * transport_pdu){ 10677ba3d3fSMatthias Ringwald return big_endian_read_16(transport_pdu->network_header, 5); 10777ba3d3fSMatthias Ringwald } 10877ba3d3fSMatthias Ringwald uint16_t mesh_transport_dst(mesh_transport_pdu_t * transport_pdu){ 10977ba3d3fSMatthias Ringwald return big_endian_read_16(transport_pdu->network_header, 7); 11077ba3d3fSMatthias Ringwald } 111e9292fe8SMatthias Ringwald uint8_t mesh_transport_control_opcode(mesh_transport_pdu_t * transport_pdu){ 112e9292fe8SMatthias Ringwald return transport_pdu->akf_aid_control & 0x7f; 113e9292fe8SMatthias Ringwald } 11477ba3d3fSMatthias Ringwald void mesh_transport_set_nid_ivi(mesh_transport_pdu_t * transport_pdu, uint8_t nid_ivi){ 11577ba3d3fSMatthias Ringwald transport_pdu->network_header[0] = nid_ivi; 11677ba3d3fSMatthias Ringwald } 11777ba3d3fSMatthias Ringwald void mesh_transport_set_ctl_ttl(mesh_transport_pdu_t * transport_pdu, uint8_t ctl_ttl){ 11877ba3d3fSMatthias Ringwald transport_pdu->network_header[1] = ctl_ttl; 11977ba3d3fSMatthias Ringwald } 12077ba3d3fSMatthias Ringwald void mesh_transport_set_seq(mesh_transport_pdu_t * transport_pdu, uint32_t seq){ 12177ba3d3fSMatthias Ringwald big_endian_store_24(transport_pdu->network_header, 2, seq); 12277ba3d3fSMatthias Ringwald } 12377ba3d3fSMatthias Ringwald void mesh_transport_set_src(mesh_transport_pdu_t * transport_pdu, uint16_t src){ 12477ba3d3fSMatthias Ringwald big_endian_store_16(transport_pdu->network_header, 5, src); 12577ba3d3fSMatthias Ringwald } 12677ba3d3fSMatthias Ringwald void mesh_transport_set_dest(mesh_transport_pdu_t * transport_pdu, uint16_t dest){ 12777ba3d3fSMatthias Ringwald big_endian_store_16(transport_pdu->network_header, 7, dest); 12877ba3d3fSMatthias Ringwald } 12977ba3d3fSMatthias Ringwald 130a7f44e8dSMatthias Ringwald uint16_t mesh_message_nid(mesh_message_pdu_t * message_pdu){ 131a7f44e8dSMatthias Ringwald return message_pdu->network_header[0] & 0x7f; 132a7f44e8dSMatthias Ringwald } 13335699c48SMatthias Ringwald uint16_t mesh_message_ctl(mesh_message_pdu_t * message_pdu){ 13435699c48SMatthias Ringwald return message_pdu->network_header[1] >> 7; 13535699c48SMatthias Ringwald } 136926e8875SMatthias Ringwald static uint16_t mesh_message_ttl(mesh_message_pdu_t * message_pdu){ 137926e8875SMatthias Ringwald return message_pdu->network_header[1] & 0x7f; 138926e8875SMatthias Ringwald } 139a7f44e8dSMatthias Ringwald static uint32_t mesh_message_seq(mesh_message_pdu_t * message_pdu){ 140a7f44e8dSMatthias Ringwald return big_endian_read_24(message_pdu->network_header, 2); 141a7f44e8dSMatthias Ringwald } 142926e8875SMatthias Ringwald static uint16_t mesh_message_src(mesh_message_pdu_t * message_pdu){ 143926e8875SMatthias Ringwald return big_endian_read_16(message_pdu->network_header, 5); 144926e8875SMatthias Ringwald } 145a7f44e8dSMatthias Ringwald static uint16_t mesh_message_dest(mesh_message_pdu_t * message_pdu){ 146a7f44e8dSMatthias Ringwald return big_endian_read_16(message_pdu->network_header, 7); 147926e8875SMatthias Ringwald } 148926e8875SMatthias Ringwald static uint32_t mesh_message_seq_zero(mesh_message_pdu_t * message_pdu){ 149926e8875SMatthias Ringwald return message_pdu->seq_zero; 150926e8875SMatthias Ringwald } 151926e8875SMatthias Ringwald 15277ba3d3fSMatthias Ringwald // lower transport 15377ba3d3fSMatthias Ringwald 15477ba3d3fSMatthias Ringwald // prototypes 15577ba3d3fSMatthias Ringwald 15677ba3d3fSMatthias Ringwald static void mesh_lower_transport_run(void); 157f41d95b9SMatthias Ringwald static void mesh_lower_transport_outgoing_complete(void); 158eb3826d8SMatthias Ringwald static void mesh_lower_transport_network_pdu_sent(mesh_network_pdu_t *network_pdu); 159b9d8f3adSMatthias Ringwald static void mesh_lower_transport_segment_transmission_timeout(btstack_timer_source_t * ts); 16077ba3d3fSMatthias Ringwald 16177ba3d3fSMatthias Ringwald // state 16277ba3d3fSMatthias Ringwald static int lower_transport_retry_count; 16377ba3d3fSMatthias Ringwald 16477ba3d3fSMatthias Ringwald // lower transport ougoing 16577ba3d3fSMatthias Ringwald static btstack_linked_list_t lower_transport_outgoing; 16677ba3d3fSMatthias Ringwald 16777ba3d3fSMatthias Ringwald static mesh_network_pdu_t * lower_transport_outgoing_segment; 16877ba3d3fSMatthias Ringwald static uint16_t lower_transport_outgoing_seg_o; 1691e6c9225SMatthias Ringwald 170a7f44e8dSMatthias Ringwald static mesh_message_pdu_t lower_transport_outgoing_segmented_message_singleton; 171a7f44e8dSMatthias Ringwald 1721e6c9225SMatthias Ringwald static mesh_message_pdu_t * lower_transport_outgoing_message; 1731e6c9225SMatthias Ringwald 174b837963cSMatthias Ringwald static mesh_unsegmented_pdu_t * lower_transport_outgoing_unsegmented_pdu; 175b837963cSMatthias Ringwald 1765f62b711SMatthias Ringwald // segment at network layer 1775f62b711SMatthias Ringwald static int lower_transport_outgoing_segment_queued; 1785f62b711SMatthias Ringwald // transmission timeout occured (while outgoing segment queued at network layer) 1795f62b711SMatthias Ringwald static int lower_transport_outgoing_transmission_timeout; 1801b639008SMatthias Ringwald // transmission completed either fully acked or remote aborted (while outgoing segment queued at network layer) 1811b639008SMatthias Ringwald static int lower_transport_outgoing_trasnmission_complete; 18277ba3d3fSMatthias Ringwald 183fc5e2620SMatthias Ringwald // deliver to higher layer 184fc5e2620SMatthias Ringwald static mesh_pdu_t * mesh_lower_transport_higher_layer_pdu; 185fc5e2620SMatthias Ringwald static btstack_linked_list_t mesh_lower_transport_queued_for_higher_layer; 1868facb3eaSMatthias Ringwald static mesh_unsegmented_pdu_t lower_transport_access_incoming_singleton; 187fc5e2620SMatthias Ringwald 18868d3bb6cSMatthias Ringwald static void mesh_lower_transport_process_segment_acknowledgement_message(mesh_network_pdu_t *network_pdu){ 1898fa6125aSMatthias Ringwald if (lower_transport_outgoing_message == NULL) return; 19068d3bb6cSMatthias Ringwald 19177ba3d3fSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 19268d3bb6cSMatthias Ringwald uint16_t seq_zero_pdu = big_endian_read_16(lower_transport_pdu, 1) >> 2; 1938fa6125aSMatthias Ringwald uint16_t seq_zero_out = mesh_message_seq(lower_transport_outgoing_message) & 0x1fff; 19468d3bb6cSMatthias Ringwald uint32_t block_ack = big_endian_read_32(lower_transport_pdu, 3); 195b66a7a84SMatthias Ringwald 196b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 19777ba3d3fSMatthias Ringwald printf("[+] Segment Acknowledgment message with seq_zero %06x, block_ack %08x - outgoing seq %06x, block_ack %08x\n", 1988fa6125aSMatthias Ringwald seq_zero_pdu, block_ack, seq_zero_out, lower_transport_outgoing_message->block_ack); 199b66a7a84SMatthias Ringwald #endif 20068d3bb6cSMatthias Ringwald 20177ba3d3fSMatthias Ringwald if (block_ack == 0){ 20277ba3d3fSMatthias Ringwald // If a Segment Acknowledgment message with the BlockAck field set to 0x00000000 is received, 20377ba3d3fSMatthias Ringwald // then the Upper Transport PDU shall be immediately cancelled and the higher layers shall be notified that 20477ba3d3fSMatthias Ringwald // the Upper Transport PDU has been cancelled. 205b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 20677ba3d3fSMatthias Ringwald printf("[+] Block Ack == 0 => Abort\n"); 207b66a7a84SMatthias Ringwald #endif 2081b639008SMatthias Ringwald if (lower_transport_outgoing_segment_queued){ 2091b639008SMatthias Ringwald lower_transport_outgoing_trasnmission_complete = 1; 2101b639008SMatthias Ringwald } else { 211f41d95b9SMatthias Ringwald mesh_lower_transport_outgoing_complete(); 2121b639008SMatthias Ringwald } 21368d3bb6cSMatthias Ringwald return; 21477ba3d3fSMatthias Ringwald } 21577ba3d3fSMatthias Ringwald if (seq_zero_pdu != seq_zero_out){ 21668d3bb6cSMatthias Ringwald 217b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 21877ba3d3fSMatthias Ringwald printf("[!] Seq Zero doesn't match\n"); 219b66a7a84SMatthias Ringwald #endif 22068d3bb6cSMatthias Ringwald return; 22177ba3d3fSMatthias Ringwald } 22268d3bb6cSMatthias Ringwald 2238fa6125aSMatthias Ringwald lower_transport_outgoing_message->block_ack &= ~block_ack; 224b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 2258fa6125aSMatthias Ringwald printf("[+] Updated block_ack %08x\n", lower_transport_outgoing_message->block_ack); 226b66a7a84SMatthias Ringwald #endif 22768d3bb6cSMatthias Ringwald 2288fa6125aSMatthias Ringwald if (lower_transport_outgoing_message->block_ack == 0){ 229b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 23077ba3d3fSMatthias Ringwald printf("[+] Sent complete\n"); 231b66a7a84SMatthias Ringwald #endif 2321b639008SMatthias Ringwald 2331b639008SMatthias Ringwald if (lower_transport_outgoing_segment_queued){ 2341b639008SMatthias Ringwald lower_transport_outgoing_trasnmission_complete = 1; 2351b639008SMatthias Ringwald } else { 236f41d95b9SMatthias Ringwald mesh_lower_transport_outgoing_complete(); 23777ba3d3fSMatthias Ringwald } 23868d3bb6cSMatthias Ringwald } 2391b639008SMatthias Ringwald } 240fc5e2620SMatthias Ringwald 241fc5e2620SMatthias Ringwald static void mesh_lower_transport_deliver_to_higher_layer(void){ 242fc5e2620SMatthias Ringwald if (mesh_lower_transport_higher_layer_pdu == NULL && !btstack_linked_list_empty(&mesh_lower_transport_queued_for_higher_layer)){ 2432ae11e2cSMatthias Ringwald mesh_pdu_t * pdu = (mesh_pdu_t *) btstack_linked_list_pop(&mesh_lower_transport_queued_for_higher_layer); 2442ae11e2cSMatthias Ringwald 2452ae11e2cSMatthias Ringwald switch (pdu->pdu_type){ 2462ae11e2cSMatthias Ringwald case MESH_MSG_TYPE_NETWORK_PDU: 2473d9c3b8eSMatthias Ringwald // unsegmented pdu 2482ae11e2cSMatthias Ringwald mesh_lower_transport_higher_layer_pdu = (mesh_pdu_t *) &lower_transport_access_incoming_singleton; 2498facb3eaSMatthias Ringwald lower_transport_access_incoming_singleton.pdu_header.pdu_type = MESH_PDU_TYPE_UNSEGMENTED; 25084011563SMatthias Ringwald lower_transport_access_incoming_singleton.segment = (mesh_network_pdu_t*) pdu; 2512ae11e2cSMatthias Ringwald break; 2522ae11e2cSMatthias Ringwald default: 2532ae11e2cSMatthias Ringwald // segmented control or access pdu 2542ae11e2cSMatthias Ringwald mesh_lower_transport_higher_layer_pdu = pdu; 2552ae11e2cSMatthias Ringwald break; 2562ae11e2cSMatthias Ringwald } 257fc5e2620SMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_RECEIVED, MESH_TRANSPORT_STATUS_SUCCESS, mesh_lower_transport_higher_layer_pdu); 258fc5e2620SMatthias Ringwald } 259fc5e2620SMatthias Ringwald } 260fc5e2620SMatthias Ringwald 261fc5e2620SMatthias Ringwald static void mesh_lower_transport_queue_for_higher_layer(mesh_pdu_t * pdu){ 262fc5e2620SMatthias Ringwald btstack_linked_list_add_tail(&mesh_lower_transport_queued_for_higher_layer, (btstack_linked_item_t *) pdu); 263fc5e2620SMatthias Ringwald mesh_lower_transport_deliver_to_higher_layer(); 2649a0bb1c9SMatthias Ringwald } 26568d3bb6cSMatthias Ringwald 26668d3bb6cSMatthias Ringwald static void mesh_lower_transport_process_unsegmented_control_message(mesh_network_pdu_t *network_pdu){ 26768d3bb6cSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 26868d3bb6cSMatthias Ringwald uint8_t opcode = lower_transport_pdu[0]; 26968d3bb6cSMatthias Ringwald 27068d3bb6cSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 2718fa6125aSMatthias Ringwald printf("Unsegmented Control message, outgoing message %p, opcode %x\n", lower_transport_outgoing_message, opcode); 27268d3bb6cSMatthias Ringwald #endif 27368d3bb6cSMatthias Ringwald 27468d3bb6cSMatthias Ringwald switch (opcode){ 27568d3bb6cSMatthias Ringwald case 0: 27668d3bb6cSMatthias Ringwald mesh_lower_transport_process_segment_acknowledgement_message(network_pdu); 27777ba3d3fSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 27877ba3d3fSMatthias Ringwald break; 27977ba3d3fSMatthias Ringwald default: 280fc5e2620SMatthias Ringwald mesh_lower_transport_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 28177ba3d3fSMatthias Ringwald break; 28277ba3d3fSMatthias Ringwald } 28377ba3d3fSMatthias Ringwald } 28477ba3d3fSMatthias Ringwald 28577ba3d3fSMatthias Ringwald // ack / incomplete message 28677ba3d3fSMatthias Ringwald 28777ba3d3fSMatthias Ringwald static void mesh_lower_transport_setup_segmented_acknowledge_message(uint8_t * data, uint8_t obo, uint16_t seq_zero, uint32_t block_ack){ 28877ba3d3fSMatthias Ringwald // printf("ACK Upper Transport, seq_zero %x\n", seq_zero); 28977ba3d3fSMatthias Ringwald data[0] = 0; // SEG = 0, Opcode = 0 29077ba3d3fSMatthias Ringwald big_endian_store_16( data, 1, (obo << 15) | (seq_zero << 2) | 0); // OBO, SeqZero, RFU 29177ba3d3fSMatthias Ringwald big_endian_store_32( data, 3, block_ack); 292b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 29377ba3d3fSMatthias Ringwald mesh_print_hex("ACK Upper Transport", data, 7); 294b66a7a84SMatthias Ringwald #endif 29577ba3d3fSMatthias Ringwald } 29677ba3d3fSMatthias Ringwald 29777ba3d3fSMatthias Ringwald static void mesh_lower_transport_send_ack(uint16_t netkey_index, uint8_t ttl, uint16_t dest, uint16_t seq_zero, uint32_t block_ack){ 29877ba3d3fSMatthias Ringwald // setup ack message 29977ba3d3fSMatthias Ringwald uint8_t ack_msg[7]; 30077ba3d3fSMatthias Ringwald mesh_lower_transport_setup_segmented_acknowledge_message(ack_msg, 0, seq_zero, block_ack); 30177ba3d3fSMatthias Ringwald // 30277ba3d3fSMatthias Ringwald // "3.4.5.2: The output filter of the interface connected to advertising or GATT bearers shall drop all messages with TTL value set to 1." 30377ba3d3fSMatthias Ringwald // if (ttl <= 1) return 0; 30477ba3d3fSMatthias Ringwald 30577ba3d3fSMatthias Ringwald // TODO: check transport_pdu_len depending on ctl 30677ba3d3fSMatthias Ringwald 30777ba3d3fSMatthias Ringwald // lookup network by netkey_index 30877ba3d3fSMatthias Ringwald const mesh_network_key_t * network_key = mesh_network_key_list_get(netkey_index); 30977ba3d3fSMatthias Ringwald if (!network_key) return; 31077ba3d3fSMatthias Ringwald 31177ba3d3fSMatthias Ringwald // allocate network_pdu 31277ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu = mesh_network_pdu_get(); 31377ba3d3fSMatthias Ringwald if (!network_pdu) return; 31477ba3d3fSMatthias Ringwald 31577ba3d3fSMatthias Ringwald // setup network_pdu 316001c65e0SMatthias Ringwald mesh_network_setup_pdu(network_pdu, netkey_index, network_key->nid, 1, ttl, mesh_sequence_number_next(), mesh_node_get_primary_element_address(), dest, ack_msg, sizeof(ack_msg)); 31777ba3d3fSMatthias Ringwald 31877ba3d3fSMatthias Ringwald // send network_pdu 31977ba3d3fSMatthias Ringwald mesh_network_send_pdu(network_pdu); 32077ba3d3fSMatthias Ringwald } 32177ba3d3fSMatthias Ringwald 322926e8875SMatthias Ringwald static void mesh_lower_transport_send_ack_for_transport_pdu(mesh_message_pdu_t * message_pdu){ 323926e8875SMatthias Ringwald uint16_t seq_zero = mesh_message_seq_zero(message_pdu); 324926e8875SMatthias Ringwald uint8_t ttl = mesh_message_ttl(message_pdu); 325926e8875SMatthias Ringwald uint16_t dest = mesh_message_src(message_pdu); 326926e8875SMatthias Ringwald uint16_t netkey_index = message_pdu->netkey_index; 327b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 32877ba3d3fSMatthias Ringwald printf("mesh_transport_send_ack_for_transport_pdu %p with netkey_index %x, TTL = %u, SeqZero = %x, SRC = %x, DST = %x\n", 329926e8875SMatthias Ringwald message_pdu, netkey_index, ttl, seq_zero, mesh_node_get_primary_element_address(), dest); 330b66a7a84SMatthias Ringwald #endif 331926e8875SMatthias Ringwald mesh_lower_transport_send_ack(netkey_index, ttl, dest, seq_zero, message_pdu->block_ack); 33277ba3d3fSMatthias Ringwald } 33377ba3d3fSMatthias Ringwald 33477ba3d3fSMatthias Ringwald static void mesh_lower_transport_send_ack_for_network_pdu(mesh_network_pdu_t *network_pdu, uint16_t seq_zero, uint32_t block_ack) { 33577ba3d3fSMatthias Ringwald uint8_t ttl = mesh_network_ttl(network_pdu); 33677ba3d3fSMatthias Ringwald uint16_t dest = mesh_network_src(network_pdu); 33777ba3d3fSMatthias Ringwald uint16_t netkey_index = network_pdu->netkey_index; 338b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 33977ba3d3fSMatthias Ringwald printf("mesh_transport_send_ack_for_network_pdu %p with netkey_index %x, TTL = %u, SeqZero = %x, SRC = %x, DST = %x\n", 340001c65e0SMatthias Ringwald network_pdu, netkey_index, ttl, seq_zero, mesh_node_get_primary_element_address(), dest); 341b66a7a84SMatthias Ringwald #endif 34277ba3d3fSMatthias Ringwald mesh_lower_transport_send_ack(netkey_index, ttl, dest, seq_zero, block_ack); 34377ba3d3fSMatthias Ringwald } 34477ba3d3fSMatthias Ringwald 345926e8875SMatthias Ringwald static void mesh_lower_transport_incoming_stop_acknowledgment_timer(mesh_message_pdu_t *message_pdu){ 346926e8875SMatthias Ringwald if (!message_pdu->acknowledgement_timer_active) return; 347926e8875SMatthias Ringwald message_pdu->acknowledgement_timer_active = 0; 348926e8875SMatthias Ringwald btstack_run_loop_remove_timer(&message_pdu->acknowledgement_timer); 349926e8875SMatthias Ringwald } 350926e8875SMatthias Ringwald 351926e8875SMatthias Ringwald static void mesh_lower_transport_incoming_stop_incomplete_timer(mesh_message_pdu_t *message_pdu){ 352926e8875SMatthias Ringwald if (!message_pdu->incomplete_timer_active) return; 353926e8875SMatthias Ringwald message_pdu->incomplete_timer_active = 0; 354926e8875SMatthias Ringwald btstack_run_loop_remove_timer(&message_pdu->incomplete_timer); 355926e8875SMatthias Ringwald } 356926e8875SMatthias Ringwald 357a7f44e8dSMatthias Ringwald static void mesh_lower_transport_outgoing_stop_acknowledgment_timer(mesh_message_pdu_t *message_pdu){ 358a7f44e8dSMatthias Ringwald if (!message_pdu->acknowledgement_timer_active) return; 359a7f44e8dSMatthias Ringwald message_pdu->acknowledgement_timer_active = 0; 360a7f44e8dSMatthias Ringwald btstack_run_loop_remove_timer(&message_pdu->acknowledgement_timer); 36177ba3d3fSMatthias Ringwald } 36277ba3d3fSMatthias Ringwald 363a7f44e8dSMatthias Ringwald static void mesh_lower_transport_outgoing_stop_incomplete_timer(mesh_message_pdu_t *message_pdu){ 364a7f44e8dSMatthias Ringwald if (!message_pdu->incomplete_timer_active) return; 365a7f44e8dSMatthias Ringwald message_pdu->incomplete_timer_active = 0; 366a7f44e8dSMatthias Ringwald btstack_run_loop_remove_timer(&message_pdu->incomplete_timer); 36777ba3d3fSMatthias Ringwald } 36877ba3d3fSMatthias Ringwald 36977ba3d3fSMatthias Ringwald // stops timers and updates reassembly engine 370926e8875SMatthias Ringwald static void mesh_lower_transport_rx_segmented_message_complete(mesh_message_pdu_t * message_pdu){ 37177ba3d3fSMatthias Ringwald // set flag 372926e8875SMatthias Ringwald message_pdu->message_complete = 1; 37377ba3d3fSMatthias Ringwald // stop timers 374926e8875SMatthias Ringwald mesh_lower_transport_incoming_stop_acknowledgment_timer(message_pdu); 375926e8875SMatthias Ringwald mesh_lower_transport_incoming_stop_incomplete_timer(message_pdu); 37677ba3d3fSMatthias Ringwald // stop reassembly 377926e8875SMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(mesh_message_src(message_pdu)); 37877ba3d3fSMatthias Ringwald if (peer){ 379926e8875SMatthias Ringwald peer->message_pdu = NULL; 380926e8875SMatthias Ringwald } 38177ba3d3fSMatthias Ringwald } 38277ba3d3fSMatthias Ringwald 38377ba3d3fSMatthias Ringwald static void mesh_lower_transport_rx_ack_timeout(btstack_timer_source_t *ts){ 384926e8875SMatthias Ringwald mesh_message_pdu_t * message_pdu = (mesh_message_pdu_t *) btstack_run_loop_get_timer_context(ts); 385b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 386926e8875SMatthias Ringwald printf("ACK: acknowledgement timer fired for %p, send ACK\n", message_pdu); 387b66a7a84SMatthias Ringwald #endif 388926e8875SMatthias Ringwald message_pdu->acknowledgement_timer_active = 0; 389926e8875SMatthias Ringwald mesh_lower_transport_send_ack_for_transport_pdu(message_pdu); 39077ba3d3fSMatthias Ringwald } 39177ba3d3fSMatthias Ringwald 39277ba3d3fSMatthias Ringwald static void mesh_lower_transport_rx_incomplete_timeout(btstack_timer_source_t *ts){ 393926e8875SMatthias Ringwald mesh_message_pdu_t * message_pdu = (mesh_message_pdu_t *) btstack_run_loop_get_timer_context(ts); 394b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 395926e8875SMatthias Ringwald printf("mesh_transport_rx_incomplete_timeout for %p - give up\n", message_pdu); 396b66a7a84SMatthias Ringwald #endif 397926e8875SMatthias Ringwald mesh_lower_transport_rx_segmented_message_complete(message_pdu); 3988a504b30SMatthias Ringwald // free segments 3998a504b30SMatthias Ringwald mesh_lower_transport_report_segments_as_processed(message_pdu); 40077ba3d3fSMatthias Ringwald // free message 401926e8875SMatthias Ringwald btstack_memory_mesh_message_pdu_free(message_pdu); 40277ba3d3fSMatthias Ringwald } 40377ba3d3fSMatthias Ringwald 404926e8875SMatthias Ringwald static void mesh_lower_transport_start_rx_acknowledgment_timer(mesh_message_pdu_t * message_pdu, uint32_t timeout){ 405b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 406926e8875SMatthias Ringwald printf("ACK: start rx ack timer for %p, timeout %u ms\n", message_pdu, (int) timeout); 407b66a7a84SMatthias Ringwald #endif 408926e8875SMatthias Ringwald btstack_run_loop_set_timer(&message_pdu->acknowledgement_timer, timeout); 409926e8875SMatthias Ringwald btstack_run_loop_set_timer_handler(&message_pdu->acknowledgement_timer, &mesh_lower_transport_rx_ack_timeout); 410926e8875SMatthias Ringwald btstack_run_loop_set_timer_context(&message_pdu->acknowledgement_timer, message_pdu); 411926e8875SMatthias Ringwald btstack_run_loop_add_timer(&message_pdu->acknowledgement_timer); 412926e8875SMatthias Ringwald message_pdu->acknowledgement_timer_active = 1; 41377ba3d3fSMatthias Ringwald } 41477ba3d3fSMatthias Ringwald 415eb3826d8SMatthias Ringwald static void mesh_lower_transport_tx_restart_segment_transmission_timer(void){ 416eb3826d8SMatthias Ringwald // restart segment transmission timer for unicast dst 417eb3826d8SMatthias Ringwald // - "This timer shall be set to a minimum of 200 + 50 * TTL milliseconds." 4188fa6125aSMatthias Ringwald uint32_t timeout = 200 + 50 * mesh_message_ttl(lower_transport_outgoing_message); 4198fa6125aSMatthias Ringwald if (lower_transport_outgoing_message->acknowledgement_timer_active){ 4208fa6125aSMatthias Ringwald btstack_run_loop_remove_timer(&lower_transport_outgoing_message->acknowledgement_timer); 421eb3826d8SMatthias Ringwald } 422eb3826d8SMatthias Ringwald 423eb3826d8SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 4248fa6125aSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: setup transmission timeout %u ms\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message), (int) timeout); 425eb3826d8SMatthias Ringwald #endif 426eb3826d8SMatthias Ringwald 4278fa6125aSMatthias Ringwald btstack_run_loop_set_timer(&lower_transport_outgoing_message->acknowledgement_timer, timeout); 4288fa6125aSMatthias Ringwald btstack_run_loop_set_timer_handler(&lower_transport_outgoing_message->acknowledgement_timer, &mesh_lower_transport_segment_transmission_timeout); 4298fa6125aSMatthias Ringwald btstack_run_loop_add_timer(&lower_transport_outgoing_message->acknowledgement_timer); 4308fa6125aSMatthias Ringwald lower_transport_outgoing_message->acknowledgement_timer_active = 1; 431eb3826d8SMatthias Ringwald } 432eb3826d8SMatthias Ringwald 433926e8875SMatthias Ringwald static void mesh_lower_transport_incoming_restart_incomplete_timer(mesh_message_pdu_t * message_pdu, uint32_t timeout, 43477ba3d3fSMatthias Ringwald void (*callback)(btstack_timer_source_t *ts)){ 435b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 436926e8875SMatthias Ringwald printf("RX-(re)start incomplete timer for %p, timeout %u ms\n", message_pdu, (int) timeout); 437b66a7a84SMatthias Ringwald #endif 438926e8875SMatthias Ringwald if (message_pdu->incomplete_timer_active){ 439926e8875SMatthias Ringwald btstack_run_loop_remove_timer(&message_pdu->incomplete_timer); 44077ba3d3fSMatthias Ringwald } 441926e8875SMatthias Ringwald btstack_run_loop_set_timer(&message_pdu->incomplete_timer, timeout); 442926e8875SMatthias Ringwald btstack_run_loop_set_timer_handler(&message_pdu->incomplete_timer, callback); 443926e8875SMatthias Ringwald btstack_run_loop_set_timer_context(&message_pdu->incomplete_timer, message_pdu); 444926e8875SMatthias Ringwald btstack_run_loop_add_timer(&message_pdu->incomplete_timer); 445926e8875SMatthias Ringwald message_pdu->incomplete_timer_active = 1; 44677ba3d3fSMatthias Ringwald } 44777ba3d3fSMatthias Ringwald 44877ba3d3fSMatthias Ringwald static void mesh_lower_transport_outgoing_complete(void){ 449a7f44e8dSMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 450b9d8f3adSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 4518fa6125aSMatthias Ringwald printf("mesh_lower_transport_outgoing_complete %p, ack timer active %u, incomplete active %u\n", lower_transport_outgoing_message, 4528fa6125aSMatthias Ringwald lower_transport_outgoing_message->acknowledgement_timer_active, lower_transport_outgoing_message->incomplete_timer_active); 453b9d8f3adSMatthias Ringwald #endif 4541c16f5cfSMatthias Ringwald // stop timers 455a7f44e8dSMatthias Ringwald mesh_lower_transport_outgoing_stop_acknowledgment_timer(lower_transport_outgoing_message); 456a7f44e8dSMatthias Ringwald mesh_lower_transport_outgoing_stop_incomplete_timer(lower_transport_outgoing_message); 457a7f44e8dSMatthias Ringwald 458a7f44e8dSMatthias Ringwald lower_transport_outgoing_message = NULL; 459a7f44e8dSMatthias Ringwald 460f41d95b9SMatthias Ringwald // notify upper transport 4618fa6125aSMatthias Ringwald mesh_message_pdu_t * pdu = lower_transport_outgoing_message; 4628fa6125aSMatthias Ringwald lower_transport_outgoing_message = NULL; 46377ba3d3fSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SEND_ABORT_BY_REMOTE, (mesh_pdu_t *) pdu); 46477ba3d3fSMatthias Ringwald } 46577ba3d3fSMatthias Ringwald 466926e8875SMatthias Ringwald static mesh_message_pdu_t * mesh_lower_transport_pdu_for_segmented_message(mesh_network_pdu_t *network_pdu){ 46777ba3d3fSMatthias Ringwald uint16_t src = mesh_network_src(network_pdu); 46877ba3d3fSMatthias Ringwald uint16_t seq_zero = ( big_endian_read_16(mesh_network_pdu_data(network_pdu), 1) >> 2) & 0x1fff; 469b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 47077ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: seq_zero %x\n", seq_zero); 471b66a7a84SMatthias Ringwald #endif 47277ba3d3fSMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(src); 47377ba3d3fSMatthias Ringwald if (!peer) { 47477ba3d3fSMatthias Ringwald return NULL; 47577ba3d3fSMatthias Ringwald } 476b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 47777ba3d3fSMatthias Ringwald printf("mesh_seq_zero_validate(%x, %x) -- last (%x, %x)\n", src, seq_zero, peer->address, peer->seq_zero); 478b66a7a84SMatthias Ringwald #endif 47977ba3d3fSMatthias Ringwald 48077ba3d3fSMatthias Ringwald // reception of transport message ongoing 481926e8875SMatthias Ringwald if (peer->message_pdu){ 48277ba3d3fSMatthias Ringwald // check if segment for same seq zero 483926e8875SMatthias Ringwald uint16_t active_seq_zero = mesh_message_seq_zero(peer->message_pdu); 48477ba3d3fSMatthias Ringwald if (active_seq_zero == seq_zero) { 485b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 48677ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: segment for current transport pdu with SeqZero %x\n", active_seq_zero); 487b66a7a84SMatthias Ringwald #endif 488926e8875SMatthias Ringwald return peer->message_pdu; 48977ba3d3fSMatthias Ringwald } else { 49077ba3d3fSMatthias Ringwald // seq zero differs from current transport pdu, but current pdu is not complete 491b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 49277ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: drop segment. current transport pdu SeqZero %x, now %x\n", active_seq_zero, seq_zero); 493b66a7a84SMatthias Ringwald #endif 49477ba3d3fSMatthias Ringwald return NULL; 49577ba3d3fSMatthias Ringwald } 49677ba3d3fSMatthias Ringwald } 49777ba3d3fSMatthias Ringwald 49877ba3d3fSMatthias Ringwald // send ACK if segment for previously completed transport pdu (no ongoing reception, block ack is cleared) 49977ba3d3fSMatthias Ringwald if ((seq_zero == peer->seq_zero) && (peer->block_ack != 0)){ 500b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 50177ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: segment for last completed message. send ack\n"); 502b66a7a84SMatthias Ringwald #endif 50377ba3d3fSMatthias Ringwald mesh_lower_transport_send_ack_for_network_pdu(network_pdu, seq_zero, peer->block_ack); 50477ba3d3fSMatthias Ringwald return NULL; 50577ba3d3fSMatthias Ringwald } 50677ba3d3fSMatthias Ringwald 50777ba3d3fSMatthias Ringwald // reconstruct lowest 24 bit of SeqAuth 50877ba3d3fSMatthias Ringwald uint32_t seq = mesh_network_seq(network_pdu); 50977ba3d3fSMatthias Ringwald uint32_t seq_auth = (seq & 0xffe000) | seq_zero; 51077ba3d3fSMatthias Ringwald if (seq_auth > seq){ 51177ba3d3fSMatthias Ringwald seq_auth -= 0x2000; 51277ba3d3fSMatthias Ringwald } 51377ba3d3fSMatthias Ringwald 51477ba3d3fSMatthias Ringwald // no transport pdu active, check new message: seq auth is greater OR seq auth is same but no segments 51577ba3d3fSMatthias Ringwald if (seq_auth > peer->seq_auth || (seq_auth == peer->seq_auth && peer->block_ack == 0)){ 516926e8875SMatthias Ringwald mesh_message_pdu_t * pdu = mesh_message_pdu_get(); 51777ba3d3fSMatthias Ringwald if (!pdu) return NULL; 51877ba3d3fSMatthias Ringwald 51977ba3d3fSMatthias Ringwald // cache network pdu header 5206535961aSMatthias Ringwald (void)memcpy(pdu->network_header, network_pdu->data, 9); 52177ba3d3fSMatthias Ringwald // store lower 24 bit of SeqAuth for App / Device Nonce 52277ba3d3fSMatthias Ringwald big_endian_store_24(pdu->network_header, 2, seq_auth); 52377ba3d3fSMatthias Ringwald 52477ba3d3fSMatthias Ringwald // store meta data in new pdu 52577ba3d3fSMatthias Ringwald pdu->netkey_index = network_pdu->netkey_index; 52677ba3d3fSMatthias Ringwald pdu->block_ack = 0; 52777ba3d3fSMatthias Ringwald pdu->acknowledgement_timer_active = 0; 52877ba3d3fSMatthias Ringwald pdu->message_complete = 0; 52977ba3d3fSMatthias Ringwald pdu->seq_zero = seq_zero; 53077ba3d3fSMatthias Ringwald 53177ba3d3fSMatthias Ringwald // update peer info 532926e8875SMatthias Ringwald peer->message_pdu = pdu; 53377ba3d3fSMatthias Ringwald peer->seq_zero = seq_zero; 53477ba3d3fSMatthias Ringwald peer->seq_auth = seq_auth; 53577ba3d3fSMatthias Ringwald peer->block_ack = 0; 53677ba3d3fSMatthias Ringwald 537b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 538926e8875SMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: setup transport pdu %p for src %x, seq %06x, seq_zero %x\n", pdu, src, mesh_message_seq(pdu), seq_zero); 539b66a7a84SMatthias Ringwald #endif 540926e8875SMatthias Ringwald return peer->message_pdu; 54177ba3d3fSMatthias Ringwald } else { 54277ba3d3fSMatthias Ringwald // seq zero differs from current transport pdu 543b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 54477ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: drop segment for old seq %x\n", seq_zero); 545b66a7a84SMatthias Ringwald #endif 54677ba3d3fSMatthias Ringwald return NULL; 54777ba3d3fSMatthias Ringwald } 54877ba3d3fSMatthias Ringwald } 54977ba3d3fSMatthias Ringwald 550926e8875SMatthias Ringwald static void mesh_lower_transport_process_segment( mesh_message_pdu_t * message_pdu, mesh_network_pdu_t * network_pdu){ 55177ba3d3fSMatthias Ringwald 55277ba3d3fSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 55377ba3d3fSMatthias Ringwald uint8_t lower_transport_pdu_len = mesh_network_pdu_len(network_pdu); 55477ba3d3fSMatthias Ringwald 55577ba3d3fSMatthias Ringwald // get akf_aid & transmic 556926e8875SMatthias Ringwald message_pdu->akf_aid_control = lower_transport_pdu[0] & 0x7f; 557926e8875SMatthias Ringwald message_pdu->transmic_len = lower_transport_pdu[1] & 0x80 ? 8 : 4; 55877ba3d3fSMatthias Ringwald 55977ba3d3fSMatthias Ringwald // get seq_zero 56077ba3d3fSMatthias Ringwald uint16_t seq_zero = ( big_endian_read_16(lower_transport_pdu, 1) >> 2) & 0x1fff; 56177ba3d3fSMatthias Ringwald 56277ba3d3fSMatthias Ringwald // get seg fields 56377ba3d3fSMatthias Ringwald uint8_t seg_o = ( big_endian_read_16(lower_transport_pdu, 2) >> 5) & 0x001f; 56477ba3d3fSMatthias Ringwald uint8_t seg_n = lower_transport_pdu[3] & 0x1f; 56577ba3d3fSMatthias Ringwald uint8_t segment_len = lower_transport_pdu_len - 4; 56677ba3d3fSMatthias Ringwald uint8_t * segment_data = &lower_transport_pdu[4]; 56777ba3d3fSMatthias Ringwald 568b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 569926e8875SMatthias Ringwald printf("mesh_lower_transport_process_segment: seq zero %04x, seg_o %02x, seg_n %02x, transmic len: %u\n", seq_zero, seg_o, seg_n, message_pdu->transmic_len * 8); 57077ba3d3fSMatthias Ringwald mesh_print_hex("Segment", segment_data, segment_len); 571b66a7a84SMatthias Ringwald #endif 57277ba3d3fSMatthias Ringwald 573926e8875SMatthias Ringwald // drop if already stored 574926e8875SMatthias Ringwald if ((message_pdu->block_ack & (1<<seg_o)) != 0){ 575926e8875SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 576926e8875SMatthias Ringwald return; 577926e8875SMatthias Ringwald } 578926e8875SMatthias Ringwald 57977ba3d3fSMatthias Ringwald // mark as received 580926e8875SMatthias Ringwald message_pdu->block_ack |= (1<<seg_o); 581926e8875SMatthias Ringwald 582926e8875SMatthias Ringwald // add to segments 583926e8875SMatthias Ringwald btstack_linked_list_add(&message_pdu->segments, (btstack_linked_item_t *) network_pdu); 584926e8875SMatthias Ringwald 58577ba3d3fSMatthias Ringwald // last segment -> store len 58677ba3d3fSMatthias Ringwald if (seg_o == seg_n){ 587926e8875SMatthias Ringwald message_pdu->len = (seg_n * 12) + segment_len; 588b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 589926e8875SMatthias Ringwald printf("Assembled payload len %u\n", message_pdu->len); 590b66a7a84SMatthias Ringwald #endif 59177ba3d3fSMatthias Ringwald } 59277ba3d3fSMatthias Ringwald 59377ba3d3fSMatthias Ringwald // check for complete 59477ba3d3fSMatthias Ringwald int i; 59577ba3d3fSMatthias Ringwald for (i=0;i<=seg_n;i++){ 596926e8875SMatthias Ringwald if ( (message_pdu->block_ack & (1<<i)) == 0) return; 597926e8875SMatthias Ringwald } 598926e8875SMatthias Ringwald 59977ba3d3fSMatthias Ringwald // store block ack in peer info 600926e8875SMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(mesh_message_src(message_pdu)); 60177ba3d3fSMatthias Ringwald // TODO: check if NULL check can be removed 60277ba3d3fSMatthias Ringwald if (peer){ 603926e8875SMatthias Ringwald peer->block_ack = message_pdu->block_ack; 60477ba3d3fSMatthias Ringwald } 60577ba3d3fSMatthias Ringwald 60677ba3d3fSMatthias Ringwald // send ack 607926e8875SMatthias Ringwald mesh_lower_transport_send_ack_for_transport_pdu(message_pdu); 60877ba3d3fSMatthias Ringwald 60977ba3d3fSMatthias Ringwald // forward to upper transport 610fc5e2620SMatthias Ringwald mesh_lower_transport_queue_for_higher_layer((mesh_pdu_t *) message_pdu); 6112a974a69SMatthias Ringwald 6122a974a69SMatthias Ringwald // mark as done 6132a974a69SMatthias Ringwald mesh_lower_transport_rx_segmented_message_complete(message_pdu); 61477ba3d3fSMatthias Ringwald } 61577ba3d3fSMatthias Ringwald 61658bb2379SMatthias Ringwald static void mesh_lower_transport_process_network_pdu(mesh_network_pdu_t *network_pdu) {// segmented? 61758bb2379SMatthias Ringwald if (mesh_network_segmented(network_pdu)){ 61858bb2379SMatthias Ringwald mesh_message_pdu_t * message_pdu = mesh_lower_transport_pdu_for_segmented_message(network_pdu); 61958bb2379SMatthias Ringwald if (message_pdu) { 62058bb2379SMatthias Ringwald // start acknowledgment timer if inactive 62158bb2379SMatthias Ringwald if (message_pdu->acknowledgement_timer_active == 0){ 62258bb2379SMatthias Ringwald // - "The acknowledgment timer shall be set to a minimum of 150 + 50 * TTL milliseconds" 62358bb2379SMatthias Ringwald uint32_t timeout = 150 + 50 * mesh_network_ttl(network_pdu); 62458bb2379SMatthias Ringwald mesh_lower_transport_start_rx_acknowledgment_timer(message_pdu, timeout); 62558bb2379SMatthias Ringwald } 62658bb2379SMatthias Ringwald // restart incomplete timer 62758bb2379SMatthias Ringwald mesh_lower_transport_incoming_restart_incomplete_timer(message_pdu, 10000, &mesh_lower_transport_rx_incomplete_timeout); 62858bb2379SMatthias Ringwald mesh_lower_transport_process_segment(message_pdu, network_pdu); 62958bb2379SMatthias Ringwald } else { 63058bb2379SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 63158bb2379SMatthias Ringwald } 63258bb2379SMatthias Ringwald } else { 63358bb2379SMatthias Ringwald // control? 63458bb2379SMatthias Ringwald if (mesh_network_control(network_pdu)){ 63558bb2379SMatthias Ringwald // unsegmented control message (not encrypted) 63658bb2379SMatthias Ringwald mesh_lower_transport_process_unsegmented_control_message(network_pdu); 63758bb2379SMatthias Ringwald } else { 63858bb2379SMatthias Ringwald // unsegmented access message (encrypted) 639fc5e2620SMatthias Ringwald mesh_lower_transport_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 64058bb2379SMatthias Ringwald } 64158bb2379SMatthias Ringwald } 64258bb2379SMatthias Ringwald } 64358bb2379SMatthias Ringwald 64477ba3d3fSMatthias Ringwald void mesh_lower_transport_message_processed_by_higher_layer(mesh_pdu_t * pdu){ 645fc5e2620SMatthias Ringwald btstack_assert(pdu == mesh_lower_transport_higher_layer_pdu); 646fc5e2620SMatthias Ringwald mesh_lower_transport_higher_layer_pdu = NULL; 6478facb3eaSMatthias Ringwald mesh_unsegmented_pdu_t * unsegmented_incoming_pdu = (mesh_unsegmented_pdu_t *) pdu; 64884011563SMatthias Ringwald mesh_network_pdu_t * network_pdu; 64977ba3d3fSMatthias Ringwald switch (pdu->pdu_type){ 65035699c48SMatthias Ringwald case MESH_PDU_TYPE_MESSAGE: 6518a504b30SMatthias Ringwald // free segments 65235699c48SMatthias Ringwald mesh_lower_transport_report_segments_as_processed((mesh_message_pdu_t *) pdu); 65335699c48SMatthias Ringwald mesh_message_pdu_free((mesh_message_pdu_t *) pdu); 65435699c48SMatthias Ringwald break; 6558facb3eaSMatthias Ringwald case MESH_PDU_TYPE_UNSEGMENTED: 65684011563SMatthias Ringwald network_pdu = unsegmented_incoming_pdu->segment; 65784011563SMatthias Ringwald unsegmented_incoming_pdu->segment = NULL; 65884011563SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 6592ae11e2cSMatthias Ringwald break; 66077ba3d3fSMatthias Ringwald default: 6613d9c3b8eSMatthias Ringwald btstack_assert(0); 66277ba3d3fSMatthias Ringwald break; 66377ba3d3fSMatthias Ringwald } 664fc5e2620SMatthias Ringwald mesh_lower_transport_deliver_to_higher_layer(); 66577ba3d3fSMatthias Ringwald } 66677ba3d3fSMatthias Ringwald 66777ba3d3fSMatthias Ringwald void mesh_lower_transport_received_message(mesh_network_callback_type_t callback_type, mesh_network_pdu_t *network_pdu){ 66877ba3d3fSMatthias Ringwald mesh_peer_t * peer; 66977ba3d3fSMatthias Ringwald uint16_t src; 67077ba3d3fSMatthias Ringwald uint16_t seq; 67177ba3d3fSMatthias Ringwald switch (callback_type){ 67277ba3d3fSMatthias Ringwald case MESH_NETWORK_PDU_RECEIVED: 67377ba3d3fSMatthias Ringwald src = mesh_network_src(network_pdu); 67477ba3d3fSMatthias Ringwald seq = mesh_network_seq(network_pdu); 67577ba3d3fSMatthias Ringwald peer = mesh_peer_for_addr(src); 676b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 67777ba3d3fSMatthias Ringwald printf("Transport: received message. SRC %x, SEQ %x\n", src, seq); 678b66a7a84SMatthias Ringwald #endif 67977ba3d3fSMatthias Ringwald // validate seq 68077ba3d3fSMatthias Ringwald if (peer && seq > peer->seq){ 68177ba3d3fSMatthias Ringwald // track seq 68277ba3d3fSMatthias Ringwald peer->seq = seq; 68358bb2379SMatthias Ringwald // process 68458bb2379SMatthias Ringwald mesh_lower_transport_process_network_pdu(network_pdu); 68577ba3d3fSMatthias Ringwald mesh_lower_transport_run(); 68677ba3d3fSMatthias Ringwald } else { 68777ba3d3fSMatthias Ringwald // drop packet 688b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 68977ba3d3fSMatthias Ringwald printf("Transport: drop packet - src/seq auth failed\n"); 690b66a7a84SMatthias Ringwald #endif 69177ba3d3fSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 69277ba3d3fSMatthias Ringwald } 69377ba3d3fSMatthias Ringwald break; 69477ba3d3fSMatthias Ringwald case MESH_NETWORK_PDU_SENT: 69577ba3d3fSMatthias Ringwald mesh_lower_transport_network_pdu_sent(network_pdu); 69677ba3d3fSMatthias Ringwald break; 69777ba3d3fSMatthias Ringwald default: 69877ba3d3fSMatthias Ringwald break; 69977ba3d3fSMatthias Ringwald } 70077ba3d3fSMatthias Ringwald } 70177ba3d3fSMatthias Ringwald 702a7f44e8dSMatthias Ringwald static void mesh_lower_transport_setup_segment(mesh_message_pdu_t *message_pdu, uint8_t seg_o, mesh_network_pdu_t *network_pdu){ 70377ba3d3fSMatthias Ringwald 704a7f44e8dSMatthias Ringwald int ctl = mesh_message_ctl(message_pdu); 70577ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 70677ba3d3fSMatthias Ringwald 707b16fda24SMatthias Ringwald // use seq number from transport pdu once if MESH_TRANSPORT_FLAG_SEQ_RESERVED (to allow reserving seq number in upper transport while using all seq numbers) 708b16fda24SMatthias Ringwald uint32_t seq; 709a7f44e8dSMatthias Ringwald if ((message_pdu->flags & MESH_TRANSPORT_FLAG_SEQ_RESERVED) != 0){ 710a7f44e8dSMatthias Ringwald message_pdu->flags &= ~(MESH_TRANSPORT_FLAG_SEQ_RESERVED); 711a7f44e8dSMatthias Ringwald seq = mesh_message_seq(message_pdu); 712b16fda24SMatthias Ringwald } else { 713b16fda24SMatthias Ringwald seq = mesh_sequence_number_next(); 714b16fda24SMatthias Ringwald } 715a7f44e8dSMatthias Ringwald uint16_t seq_zero = mesh_message_seq(message_pdu) & 0x01fff; 716a7f44e8dSMatthias Ringwald uint8_t seg_n = (message_pdu->len - 1) / max_segment_len; 717a7f44e8dSMatthias Ringwald uint8_t szmic = ((!ctl) && (message_pdu->transmic_len == 8)) ? 1 : 0; // only 1 for access messages with 64 bit TransMIC 718a7f44e8dSMatthias Ringwald uint8_t nid = mesh_message_nid(message_pdu); 719a7f44e8dSMatthias Ringwald uint8_t ttl = mesh_message_ttl(message_pdu); 720a7f44e8dSMatthias Ringwald uint16_t src = mesh_message_src(message_pdu); 721a7f44e8dSMatthias Ringwald uint16_t dest = mesh_message_dest(message_pdu); 72277ba3d3fSMatthias Ringwald 72377ba3d3fSMatthias Ringwald // current segment. 72477ba3d3fSMatthias Ringwald uint16_t seg_offset = seg_o * max_segment_len; 72577ba3d3fSMatthias Ringwald 72677ba3d3fSMatthias Ringwald uint8_t lower_transport_pdu_data[16]; 727a7f44e8dSMatthias Ringwald lower_transport_pdu_data[0] = 0x80 | message_pdu->akf_aid_control; 72877ba3d3fSMatthias Ringwald big_endian_store_24(lower_transport_pdu_data, 1, (szmic << 23) | (seq_zero << 10) | (seg_o << 5) | seg_n); 729a7f44e8dSMatthias Ringwald uint16_t segment_len = btstack_min(message_pdu->len - seg_offset, max_segment_len); 730a7f44e8dSMatthias Ringwald 73177ba3d3fSMatthias Ringwald uint16_t lower_transport_pdu_len = 4 + segment_len; 73277ba3d3fSMatthias Ringwald 733a7f44e8dSMatthias Ringwald // find network-pdu with chunk for seg_offset 734a7f44e8dSMatthias Ringwald mesh_network_pdu_t * chunk = (mesh_network_pdu_t *) lower_transport_outgoing_message->segments; 735a7f44e8dSMatthias Ringwald uint16_t chunk_start = 0; 736a7f44e8dSMatthias Ringwald while ((chunk_start + MESH_NETWORK_PAYLOAD_MAX) <= seg_offset){ 737a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 738a7f44e8dSMatthias Ringwald chunk_start += MESH_NETWORK_PAYLOAD_MAX; 739a7f44e8dSMatthias Ringwald } 740a7f44e8dSMatthias Ringwald // first part 741a7f44e8dSMatthias Ringwald uint16_t chunk_offset = seg_offset - chunk_start; 742a7f44e8dSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(MESH_NETWORK_PAYLOAD_MAX - chunk_offset, segment_len); 743a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4], 744a7f44e8dSMatthias Ringwald &chunk->data[chunk_offset], bytes_to_copy); 745a7f44e8dSMatthias Ringwald segment_len -= bytes_to_copy; 746a7f44e8dSMatthias Ringwald // second part 747a7f44e8dSMatthias Ringwald if (segment_len > 0){ 748a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 749a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4+bytes_to_copy], 750a7f44e8dSMatthias Ringwald &chunk->data[0], segment_len); 751a7f44e8dSMatthias Ringwald } 752a7f44e8dSMatthias Ringwald 753a7f44e8dSMatthias Ringwald mesh_network_setup_pdu(network_pdu, message_pdu->netkey_index, nid, 0, ttl, seq, src, dest, lower_transport_pdu_data, lower_transport_pdu_len); 75477ba3d3fSMatthias Ringwald } 75577ba3d3fSMatthias Ringwald 75677ba3d3fSMatthias Ringwald static void mesh_lower_transport_send_next_segment(void){ 7578fa6125aSMatthias Ringwald if (!lower_transport_outgoing_message) return; 75877ba3d3fSMatthias Ringwald 7591b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 760a7f44e8dSMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send next segment\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message)); 7611b639008SMatthias Ringwald #endif 7621b639008SMatthias Ringwald 763a7f44e8dSMatthias Ringwald int ctl = mesh_message_ctl(lower_transport_outgoing_message); 76477ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 765a7f44e8dSMatthias Ringwald uint8_t seg_n = (lower_transport_outgoing_message->len - 1) / max_segment_len; 76677ba3d3fSMatthias Ringwald 76777ba3d3fSMatthias Ringwald // find next unacknowledged segement 768a7f44e8dSMatthias Ringwald while ((lower_transport_outgoing_seg_o <= seg_n) && ((lower_transport_outgoing_message->block_ack & (1 << lower_transport_outgoing_seg_o)) == 0)){ 76977ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 77077ba3d3fSMatthias Ringwald } 77177ba3d3fSMatthias Ringwald 77277ba3d3fSMatthias Ringwald if (lower_transport_outgoing_seg_o > seg_n){ 773b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 7748fa6125aSMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send complete (dst %x)\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message), mesh_message_dest(lower_transport_outgoing_message)); 775b66a7a84SMatthias Ringwald #endif 77677ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o = 0; 77777ba3d3fSMatthias Ringwald 77877ba3d3fSMatthias Ringwald // done for unicast, ack timer already set, too 779a7f44e8dSMatthias Ringwald if (mesh_network_address_unicast(mesh_message_dest(lower_transport_outgoing_message))) return; 78077ba3d3fSMatthias Ringwald 78177ba3d3fSMatthias Ringwald // done, more? 78277ba3d3fSMatthias Ringwald if (lower_transport_retry_count == 0){ 783b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 78477ba3d3fSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged -> free\n"); 785b66a7a84SMatthias Ringwald #endif 78677ba3d3fSMatthias Ringwald // notify upper transport 78777ba3d3fSMatthias Ringwald mesh_lower_transport_outgoing_complete(); 78877ba3d3fSMatthias Ringwald return; 78977ba3d3fSMatthias Ringwald } 79077ba3d3fSMatthias Ringwald 79177ba3d3fSMatthias Ringwald // start retry 792b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 79377ba3d3fSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged retry count %u\n", lower_transport_retry_count); 794b66a7a84SMatthias Ringwald #endif 79577ba3d3fSMatthias Ringwald lower_transport_retry_count--; 79677ba3d3fSMatthias Ringwald } 79777ba3d3fSMatthias Ringwald 798eb3826d8SMatthias Ringwald // restart segment transmission timer for unicast dst 799a7f44e8dSMatthias Ringwald if (mesh_network_address_unicast(mesh_message_dest(lower_transport_outgoing_message))){ 800eb3826d8SMatthias Ringwald mesh_lower_transport_tx_restart_segment_transmission_timer(); 80177ba3d3fSMatthias Ringwald } 80277ba3d3fSMatthias Ringwald 803a7f44e8dSMatthias Ringwald mesh_lower_transport_setup_segment(lower_transport_outgoing_message, lower_transport_outgoing_seg_o, 80477ba3d3fSMatthias Ringwald lower_transport_outgoing_segment); 80577ba3d3fSMatthias Ringwald 806b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 807a7f44e8dSMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send seg_o %x, seg_n %x\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message), lower_transport_outgoing_seg_o, seg_n); 808b0d2aa0bSMatthias Ringwald mesh_print_hex("LowerTransportPDU", &lower_transport_outgoing_segment->data[9], lower_transport_outgoing_segment->len-9); 809b66a7a84SMatthias Ringwald #endif 81077ba3d3fSMatthias Ringwald 81177ba3d3fSMatthias Ringwald // next segment 81277ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 81377ba3d3fSMatthias Ringwald 81477ba3d3fSMatthias Ringwald // send network pdu 815680fc3b5SMatthias Ringwald lower_transport_outgoing_segment_queued = 1; 81677ba3d3fSMatthias Ringwald mesh_network_send_pdu(lower_transport_outgoing_segment); 81777ba3d3fSMatthias Ringwald } 81877ba3d3fSMatthias Ringwald 819b489fec0SMatthias Ringwald static void mesh_lower_transport_setup_sending_segmented_pdus(void){ 8208fa6125aSMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send retry count %u\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message), lower_transport_retry_count); 821b489fec0SMatthias Ringwald lower_transport_retry_count--; 822b489fec0SMatthias Ringwald lower_transport_outgoing_seg_o = 0; 823b489fec0SMatthias Ringwald } 824b489fec0SMatthias Ringwald 825b489fec0SMatthias Ringwald static void mesh_lower_transport_segment_transmission_fired(void){ 826b489fec0SMatthias Ringwald // once more? 827b489fec0SMatthias Ringwald if (lower_transport_retry_count == 0){ 8288fa6125aSMatthias Ringwald printf("[!] Lower transport, segmented pdu %p, seq %06x: send failed, retries exhausted\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message)); 829b489fec0SMatthias Ringwald mesh_lower_transport_outgoing_complete(); 830b489fec0SMatthias Ringwald return; 831b489fec0SMatthias Ringwald } 832b489fec0SMatthias Ringwald 8331b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 8348fa6125aSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission fired\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message) ); 8351b639008SMatthias Ringwald #endif 8361b639008SMatthias Ringwald 837b489fec0SMatthias Ringwald // send remaining segments again 838b489fec0SMatthias Ringwald mesh_lower_transport_setup_sending_segmented_pdus(); 8395f62b711SMatthias Ringwald // send next segment 8401b639008SMatthias Ringwald mesh_lower_transport_send_next_segment(); 8411b639008SMatthias Ringwald } 842b489fec0SMatthias Ringwald 84377ba3d3fSMatthias Ringwald static void mesh_lower_transport_network_pdu_sent(mesh_network_pdu_t *network_pdu){ 84477ba3d3fSMatthias Ringwald // figure out what pdu was sent 84577ba3d3fSMatthias Ringwald 8461e6c9225SMatthias Ringwald // single segment? 84777ba3d3fSMatthias Ringwald if (lower_transport_outgoing_segment == network_pdu){ 848a7f44e8dSMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 849b02ff6bdSMatthias Ringwald 850a7f44e8dSMatthias Ringwald if (lower_transport_outgoing_message->segmented == false){ 8511e6c9225SMatthias Ringwald // of unsegmented message 8521e6c9225SMatthias Ringwald mesh_message_pdu_t * message_pdu = lower_transport_outgoing_message; 8531e6c9225SMatthias Ringwald lower_transport_outgoing_message = NULL; 8541e6c9225SMatthias Ringwald lower_transport_outgoing_segment = NULL; 8551e6c9225SMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SUCCESS, (mesh_pdu_t *) message_pdu); 8561e6c9225SMatthias Ringwald return; 8571e6c9225SMatthias Ringwald 8581e6c9225SMatthias Ringwald } else { 8591e6c9225SMatthias Ringwald // of segmented message 860b02ff6bdSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 8618fa6125aSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: network pdu %p sent\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message), network_pdu); 862b02ff6bdSMatthias Ringwald #endif 863b02ff6bdSMatthias Ringwald 864680fc3b5SMatthias Ringwald lower_transport_outgoing_segment_queued = 0; 8651b639008SMatthias Ringwald if (lower_transport_outgoing_trasnmission_complete){ 8661b639008SMatthias Ringwald // handle complete 8671b639008SMatthias Ringwald lower_transport_outgoing_trasnmission_complete = 0; 8681b639008SMatthias Ringwald lower_transport_outgoing_transmission_timeout = 0; 8691b639008SMatthias Ringwald mesh_lower_transport_outgoing_complete(); 8701b639008SMatthias Ringwald return; 8711b639008SMatthias Ringwald } 872b489fec0SMatthias Ringwald if (lower_transport_outgoing_transmission_timeout){ 873b489fec0SMatthias Ringwald // handle timeout 874b489fec0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = 0; 875b489fec0SMatthias Ringwald mesh_lower_transport_segment_transmission_fired(); 8761b639008SMatthias Ringwald return; 877b489fec0SMatthias Ringwald } 878b02ff6bdSMatthias Ringwald 879b489fec0SMatthias Ringwald // send next segment 88077ba3d3fSMatthias Ringwald mesh_lower_transport_send_next_segment(); 8811e6c9225SMatthias Ringwald } 88277ba3d3fSMatthias Ringwald return; 88377ba3d3fSMatthias Ringwald } 88477ba3d3fSMatthias Ringwald 88577ba3d3fSMatthias Ringwald // Segment Acknowledgment message sent by us? 88677ba3d3fSMatthias Ringwald if (mesh_network_control(network_pdu) && network_pdu->data[0] == 0){ 88777ba3d3fSMatthias Ringwald btstack_memory_mesh_network_pdu_free(network_pdu); 88877ba3d3fSMatthias Ringwald return; 88977ba3d3fSMatthias Ringwald } 89077ba3d3fSMatthias Ringwald 891b837963cSMatthias Ringwald // Unsegmented message 892b837963cSMatthias Ringwald if (lower_transport_outgoing_unsegmented_pdu != NULL){ 893b837963cSMatthias Ringwald mesh_unsegmented_pdu_t * unsegmented_pdu = lower_transport_outgoing_unsegmented_pdu; 894b837963cSMatthias Ringwald lower_transport_outgoing_unsegmented_pdu = NULL; 895b837963cSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SUCCESS, (mesh_pdu_t *) unsegmented_pdu); 896b837963cSMatthias Ringwald return; 897b837963cSMatthias Ringwald } 898b837963cSMatthias Ringwald 89977ba3d3fSMatthias Ringwald // other 90077ba3d3fSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SUCCESS, (mesh_pdu_t *) network_pdu); 90177ba3d3fSMatthias Ringwald } 90277ba3d3fSMatthias Ringwald 903a7f44e8dSMatthias Ringwald static void mesh_lower_transport_setup_block_ack(mesh_message_pdu_t *message_pdu){ 904166cce4dSMatthias Ringwald // setup block ack - set bit for segment to send, will be cleared on ack 905a7f44e8dSMatthias Ringwald int ctl = mesh_message_ctl(message_pdu); 906166cce4dSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 907a7f44e8dSMatthias Ringwald uint8_t seg_n = (message_pdu->len - 1) / max_segment_len; 908166cce4dSMatthias Ringwald if (seg_n < 31){ 909a7f44e8dSMatthias Ringwald message_pdu->block_ack = (1 << (seg_n+1)) - 1; 910166cce4dSMatthias Ringwald } else { 911a7f44e8dSMatthias Ringwald message_pdu->block_ack = 0xffffffff; 912166cce4dSMatthias Ringwald } 913166cce4dSMatthias Ringwald } 914166cce4dSMatthias Ringwald 91577ba3d3fSMatthias Ringwald void mesh_lower_transport_send_pdu(mesh_pdu_t *pdu){ 916a01ba0fdSMatthias Ringwald mesh_unsegmented_pdu_t * unsegmented_pdu; 917a01ba0fdSMatthias Ringwald mesh_network_pdu_t * network_pdu; 918a01ba0fdSMatthias Ringwald switch (pdu->pdu_type){ 919a01ba0fdSMatthias Ringwald case MESH_PDU_TYPE_UNSEGMENTED: 920a01ba0fdSMatthias Ringwald unsegmented_pdu = (mesh_unsegmented_pdu_t *) pdu; 921a01ba0fdSMatthias Ringwald network_pdu = unsegmented_pdu->segment; 922a7f44e8dSMatthias Ringwald btstack_assert(network_pdu->len >= 9); 923a01ba0fdSMatthias Ringwald break; 924a01ba0fdSMatthias Ringwald case MESH_PDU_TYPE_MESSAGE: 925a01ba0fdSMatthias Ringwald break; 926a01ba0fdSMatthias Ringwald default: 927a01ba0fdSMatthias Ringwald btstack_assert(false); 928*d38a7664SMatthias Ringwald break; 92948321319SMatthias Ringwald } 93077ba3d3fSMatthias Ringwald btstack_linked_list_add_tail(&lower_transport_outgoing, (btstack_linked_item_t*) pdu); 93177ba3d3fSMatthias Ringwald mesh_lower_transport_run(); 93277ba3d3fSMatthias Ringwald } 93377ba3d3fSMatthias Ringwald 934b9d8f3adSMatthias Ringwald static void mesh_lower_transport_segment_transmission_timeout(btstack_timer_source_t * ts){ 935eb3826d8SMatthias Ringwald UNUSED(ts); 936b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 9378fa6125aSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission timer fired\n", lower_transport_outgoing_message, mesh_message_seq(lower_transport_outgoing_message)); 938b66a7a84SMatthias Ringwald #endif 9398fa6125aSMatthias Ringwald lower_transport_outgoing_message->acknowledgement_timer_active = 0; 9405bce1015SMatthias Ringwald 941b489fec0SMatthias Ringwald if (lower_transport_outgoing_segment_queued){ 942b489fec0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = 1; 943b489fec0SMatthias Ringwald } else { 944b489fec0SMatthias Ringwald mesh_lower_transport_segment_transmission_fired(); 9455bce1015SMatthias Ringwald } 94677ba3d3fSMatthias Ringwald } 94777ba3d3fSMatthias Ringwald 94877ba3d3fSMatthias Ringwald static void mesh_lower_transport_run(void){ 94977ba3d3fSMatthias Ringwald 95077ba3d3fSMatthias Ringwald // check if outgoing segmented pdu is active 9511e6c9225SMatthias Ringwald if (lower_transport_outgoing_message) return; 95277ba3d3fSMatthias Ringwald 95377ba3d3fSMatthias Ringwald while(!btstack_linked_list_empty(&lower_transport_outgoing)) { 95477ba3d3fSMatthias Ringwald // get next message 95577ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu; 9561e6c9225SMatthias Ringwald mesh_message_pdu_t * message_pdu; 95777ba3d3fSMatthias Ringwald mesh_pdu_t * pdu = (mesh_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing); 95877ba3d3fSMatthias Ringwald switch (pdu->pdu_type) { 959b837963cSMatthias Ringwald case MESH_PDU_TYPE_UNSEGMENTED: 960b837963cSMatthias Ringwald lower_transport_outgoing_unsegmented_pdu = (mesh_unsegmented_pdu_t *) pdu; 961b837963cSMatthias Ringwald network_pdu = lower_transport_outgoing_unsegmented_pdu->segment; 962b837963cSMatthias Ringwald mesh_network_send_pdu(network_pdu); 963b837963cSMatthias Ringwald break; 9641e6c9225SMatthias Ringwald case MESH_PDU_TYPE_MESSAGE: 9651e6c9225SMatthias Ringwald message_pdu = (mesh_message_pdu_t *) pdu; 9668fa6125aSMatthias Ringwald if (message_pdu->segmented){ 967a7f44e8dSMatthias Ringwald // 968a7f44e8dSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: run start sending now\n", message_pdu, mesh_message_seq(message_pdu)); 96977ba3d3fSMatthias Ringwald // start sending segmented pdu 9701b639008SMatthias Ringwald lower_transport_retry_count = 3; 971a7f44e8dSMatthias Ringwald lower_transport_outgoing_message = message_pdu; 972b489fec0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = 0; 9731b639008SMatthias Ringwald lower_transport_outgoing_trasnmission_complete = 0; 974a7f44e8dSMatthias Ringwald mesh_lower_transport_setup_block_ack(message_pdu); 975b489fec0SMatthias Ringwald mesh_lower_transport_setup_sending_segmented_pdus(); 976b489fec0SMatthias Ringwald mesh_lower_transport_send_next_segment(); 9778fa6125aSMatthias Ringwald } else { 978*d38a7664SMatthias Ringwald btstack_assert(false); 9798fa6125aSMatthias Ringwald network_pdu = (mesh_network_pdu_t *) btstack_linked_list_get_first_item(&message_pdu->segments); 9808fa6125aSMatthias Ringwald lower_transport_outgoing_message = message_pdu; 9818fa6125aSMatthias Ringwald lower_transport_outgoing_segment = network_pdu; 9828fa6125aSMatthias Ringwald mesh_network_send_pdu(network_pdu); 9838fa6125aSMatthias Ringwald } 9848fa6125aSMatthias Ringwald break; 98577ba3d3fSMatthias Ringwald default: 9868fa6125aSMatthias Ringwald btstack_assert(false); 98777ba3d3fSMatthias Ringwald break; 98877ba3d3fSMatthias Ringwald } 98977ba3d3fSMatthias Ringwald } 99077ba3d3fSMatthias Ringwald } 99177ba3d3fSMatthias Ringwald 99277ba3d3fSMatthias Ringwald static void mesh_lower_transport_dump_network_pdus(const char *name, btstack_linked_list_t *list){ 99377ba3d3fSMatthias Ringwald printf("List: %s:\n", name); 99477ba3d3fSMatthias Ringwald btstack_linked_list_iterator_t it; 99577ba3d3fSMatthias Ringwald btstack_linked_list_iterator_init(&it, list); 99677ba3d3fSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 99777ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t*) btstack_linked_list_iterator_next(&it); 99877ba3d3fSMatthias Ringwald printf("- %p: ", network_pdu); printf_hexdump(network_pdu->data, network_pdu->len); 99977ba3d3fSMatthias Ringwald } 100077ba3d3fSMatthias Ringwald } 100177ba3d3fSMatthias Ringwald static void mesh_lower_transport_reset_network_pdus(btstack_linked_list_t *list){ 100277ba3d3fSMatthias Ringwald while (!btstack_linked_list_empty(list)){ 100377ba3d3fSMatthias Ringwald mesh_network_pdu_t * pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(list); 100477ba3d3fSMatthias Ringwald btstack_memory_mesh_network_pdu_free(pdu); 100577ba3d3fSMatthias Ringwald } 100677ba3d3fSMatthias Ringwald } 100777ba3d3fSMatthias Ringwald 100833439c2eSMilanka Ringwald bool mesh_lower_transport_can_send_to_dest(uint16_t dest){ 100933439c2eSMilanka Ringwald UNUSED(dest); 10108fa6125aSMatthias Ringwald return (lower_transport_outgoing_message == NULL) && btstack_linked_list_empty(&lower_transport_outgoing); 1011cd16791dSMatthias Ringwald } 1012cd16791dSMatthias Ringwald 1013cd16791dSMatthias Ringwald void mesh_lower_transport_reserve_slot(void){ 1014cd16791dSMatthias Ringwald } 1015cd16791dSMatthias Ringwald 101677ba3d3fSMatthias Ringwald void mesh_lower_transport_dump(void){ 101777ba3d3fSMatthias Ringwald } 101877ba3d3fSMatthias Ringwald 101977ba3d3fSMatthias Ringwald void mesh_lower_transport_reset(void){ 1020a7f44e8dSMatthias Ringwald if (lower_transport_outgoing_message){ 1021a7f44e8dSMatthias Ringwald while (!btstack_linked_list_empty(&lower_transport_outgoing_message->segments)){ 1022a7f44e8dSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_message->segments); 1023a7f44e8dSMatthias Ringwald mesh_network_pdu_free(network_pdu); 1024a7f44e8dSMatthias Ringwald } 1025a7f44e8dSMatthias Ringwald lower_transport_outgoing_message = NULL; 1026a7f44e8dSMatthias Ringwald } 10271e6cebb8SMatthias Ringwald mesh_network_pdu_free(lower_transport_outgoing_segment); 1028680fc3b5SMatthias Ringwald lower_transport_outgoing_segment_queued = 0; 10291e6cebb8SMatthias Ringwald lower_transport_outgoing_segment = NULL; 103077ba3d3fSMatthias Ringwald } 103177ba3d3fSMatthias Ringwald 103277ba3d3fSMatthias Ringwald void mesh_lower_transport_init(){ 103377ba3d3fSMatthias Ringwald // register with network layer 103477ba3d3fSMatthias Ringwald mesh_network_set_higher_layer_handler(&mesh_lower_transport_received_message); 103577ba3d3fSMatthias Ringwald // allocate network_pdu for segmentation 1036680fc3b5SMatthias Ringwald lower_transport_outgoing_segment_queued = 0; 103777ba3d3fSMatthias Ringwald lower_transport_outgoing_segment = mesh_network_pdu_get(); 103877ba3d3fSMatthias Ringwald } 103977ba3d3fSMatthias Ringwald 104077ba3d3fSMatthias Ringwald void mesh_lower_transport_set_higher_layer_handler(void (*pdu_handler)( mesh_transport_callback_type_t callback_type, mesh_transport_status_t status, mesh_pdu_t * pdu)){ 104177ba3d3fSMatthias Ringwald higher_layer_handler = pdu_handler; 104277ba3d3fSMatthias Ringwald } 1043d5f4cd5bSMatthias Ringwald 1044d5f4cd5bSMatthias Ringwald // buffer pool 1045d5f4cd5bSMatthias Ringwald mesh_transport_pdu_t * mesh_transport_pdu_get(void){ 1046d5f4cd5bSMatthias Ringwald mesh_transport_pdu_t * transport_pdu = btstack_memory_mesh_transport_pdu_get(); 1047d5f4cd5bSMatthias Ringwald if (transport_pdu){ 1048d5f4cd5bSMatthias Ringwald transport_pdu->pdu_header.pdu_type = MESH_PDU_TYPE_TRANSPORT; 1049d5f4cd5bSMatthias Ringwald } 1050d5f4cd5bSMatthias Ringwald return transport_pdu; 1051d5f4cd5bSMatthias Ringwald } 1052d5f4cd5bSMatthias Ringwald 1053d5f4cd5bSMatthias Ringwald void mesh_transport_pdu_free(mesh_transport_pdu_t * transport_pdu){ 1054d5f4cd5bSMatthias Ringwald btstack_memory_mesh_transport_pdu_free(transport_pdu); 1055d5f4cd5bSMatthias Ringwald } 1056