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" 4779eb95b0SMatthias Ringwald #include "btstack_bool.h" 48f4854a5eSMatthias Ringwald 49683cf298SMatthias Ringwald #include "mesh/beacon.h" 50f4854a5eSMatthias Ringwald #include "mesh/mesh_iv_index_seq_number.h" 51f4854a5eSMatthias Ringwald #include "mesh/mesh_lower_transport.h" 52683cf298SMatthias Ringwald #include "mesh/mesh_node.h" 53f4854a5eSMatthias Ringwald #include "mesh/mesh_peer.h" 5477ba3d3fSMatthias Ringwald 55b66a7a84SMatthias Ringwald #define LOG_LOWER_TRANSPORT 56b66a7a84SMatthias Ringwald 5727e8a9aaSMatthias Ringwald // prototypes 5879eb95b0SMatthias Ringwald static void mesh_lower_transport_run(void); 5912835760SMatthias Ringwald static void mesh_lower_transport_outgoing_complete(mesh_segmented_pdu_t * segmented_pdu, mesh_transport_status_t status); 6027e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_segment_transmission_timeout(btstack_timer_source_t * ts); 6179eb95b0SMatthias Ringwald 6279eb95b0SMatthias Ringwald 6379eb95b0SMatthias Ringwald // lower transport outgoing state 6479eb95b0SMatthias Ringwald 65b4977f35SMatthias Ringwald // queued mesh_segmented_pdu_t or mesh_network_pdu_t 6679eb95b0SMatthias Ringwald static btstack_linked_list_t lower_transport_outgoing_ready; 6779eb95b0SMatthias Ringwald 68b4977f35SMatthias Ringwald // mesh_segmented_pdu_t to unicast address, segment transmission timer is active 69b4977f35SMatthias Ringwald static btstack_linked_list_t lower_transport_outgoing_waiting; 70b4977f35SMatthias Ringwald 7179eb95b0SMatthias Ringwald // active outgoing segmented message 7279eb95b0SMatthias Ringwald static mesh_segmented_pdu_t * lower_transport_outgoing_message; 73e3f8b4e7SMatthias Ringwald // index of outgoing segment 7479eb95b0SMatthias Ringwald static uint16_t lower_transport_outgoing_seg_o; 75e3f8b4e7SMatthias Ringwald // network pdu with outgoing segment 7679eb95b0SMatthias Ringwald static mesh_network_pdu_t * lower_transport_outgoing_segment; 77e3f8b4e7SMatthias Ringwald // segment currently queued at network layer (only valid for lower_transport_outgoing_message) 78e3f8b4e7SMatthias Ringwald static bool lower_transport_outgoing_segment_at_network_layer; 7979eb95b0SMatthias Ringwald // transmission timeout occurred (while outgoing segment queued at network layer) 8079eb95b0SMatthias Ringwald static bool lower_transport_outgoing_transmission_timeout; 8112835760SMatthias Ringwald // transmission completed fully ack'ed (while outgoing segment queued at network layer) 8279eb95b0SMatthias Ringwald static bool lower_transport_outgoing_transmission_complete; 8312835760SMatthias Ringwald // transmission aborted by remote (while outgoing segment queued at network layer) 8412835760SMatthias Ringwald static bool lower_transport_outgoing_transmission_aborted; 8579eb95b0SMatthias Ringwald 8679eb95b0SMatthias Ringwald // active outgoing unsegmented message 8779eb95b0SMatthias Ringwald static mesh_network_pdu_t * lower_transport_outgoing_network_pdu; 8879eb95b0SMatthias Ringwald 8979eb95b0SMatthias Ringwald // deliver to higher layer 9077ba3d3fSMatthias Ringwald static void (*higher_layer_handler)( mesh_transport_callback_type_t callback_type, mesh_transport_status_t status, mesh_pdu_t * pdu); 9179eb95b0SMatthias Ringwald static mesh_pdu_t * mesh_lower_transport_higher_layer_pdu; 9279eb95b0SMatthias Ringwald static btstack_linked_list_t mesh_lower_transport_queued_for_higher_layer; 9377ba3d3fSMatthias Ringwald 9477ba3d3fSMatthias Ringwald static void mesh_print_hex(const char * name, const uint8_t * data, uint16_t len){ 9577ba3d3fSMatthias Ringwald printf("%-20s ", name); 9677ba3d3fSMatthias Ringwald printf_hexdump(data, len); 9777ba3d3fSMatthias Ringwald } 9877ba3d3fSMatthias Ringwald 9977ba3d3fSMatthias Ringwald // utility 10077ba3d3fSMatthias Ringwald 10179eb95b0SMatthias Ringwald mesh_segmented_pdu_t * mesh_segmented_pdu_get(void){ 102a4bbc09dSMatthias Ringwald mesh_segmented_pdu_t * message_pdu = btstack_memory_mesh_segmented_pdu_get(); 103926e8875SMatthias Ringwald if (message_pdu){ 104a4bbc09dSMatthias Ringwald message_pdu->pdu_header.pdu_type = MESH_PDU_TYPE_SEGMENTED; 105926e8875SMatthias Ringwald } 106926e8875SMatthias Ringwald return message_pdu; 107926e8875SMatthias Ringwald } 108926e8875SMatthias Ringwald 10979eb95b0SMatthias Ringwald void mesh_segmented_pdu_free(mesh_segmented_pdu_t * message_pdu){ 110cdcfd2c1SMatthias Ringwald while (message_pdu->segments){ 111cdcfd2c1SMatthias Ringwald mesh_network_pdu_t * segment = (mesh_network_pdu_t *) btstack_linked_list_pop(&message_pdu->segments); 112cdcfd2c1SMatthias Ringwald mesh_network_pdu_free(segment); 113cdcfd2c1SMatthias Ringwald } 114a4bbc09dSMatthias Ringwald btstack_memory_mesh_segmented_pdu_free(message_pdu); 115926e8875SMatthias Ringwald } 116926e8875SMatthias Ringwald 11727e8a9aaSMatthias Ringwald // INCOMING // 11827e8a9aaSMatthias Ringwald 11927e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_deliver_to_higher_layer(void){ 120fc5e2620SMatthias Ringwald if (mesh_lower_transport_higher_layer_pdu == NULL && !btstack_linked_list_empty(&mesh_lower_transport_queued_for_higher_layer)){ 1212ae11e2cSMatthias Ringwald mesh_pdu_t * pdu = (mesh_pdu_t *) btstack_linked_list_pop(&mesh_lower_transport_queued_for_higher_layer); 1222ae11e2cSMatthias Ringwald 1232ae11e2cSMatthias Ringwald switch (pdu->pdu_type){ 1245236fe42SMatthias Ringwald case MESH_PDU_TYPE_NETWORK: 1253d9c3b8eSMatthias Ringwald // unsegmented pdu 126e4121a34SMatthias Ringwald mesh_lower_transport_higher_layer_pdu = (mesh_pdu_t *) pdu; 127e4121a34SMatthias Ringwald pdu->pdu_type = MESH_PDU_TYPE_UNSEGMENTED; 1282ae11e2cSMatthias Ringwald break; 1295236fe42SMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 1302ae11e2cSMatthias Ringwald // segmented control or access pdu 1312ae11e2cSMatthias Ringwald mesh_lower_transport_higher_layer_pdu = pdu; 1322ae11e2cSMatthias Ringwald break; 1335236fe42SMatthias Ringwald default: 1345236fe42SMatthias Ringwald btstack_assert(false); 1355236fe42SMatthias Ringwald break; 1362ae11e2cSMatthias Ringwald } 137fc5e2620SMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_RECEIVED, MESH_TRANSPORT_STATUS_SUCCESS, mesh_lower_transport_higher_layer_pdu); 138fc5e2620SMatthias Ringwald } 139fc5e2620SMatthias Ringwald } 140fc5e2620SMatthias Ringwald 14127e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_queue_for_higher_layer(mesh_pdu_t * pdu){ 142fc5e2620SMatthias Ringwald btstack_linked_list_add_tail(&mesh_lower_transport_queued_for_higher_layer, (btstack_linked_item_t *) pdu); 14327e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_deliver_to_higher_layer(); 1449a0bb1c9SMatthias Ringwald } 14568d3bb6cSMatthias Ringwald 14627e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_setup_acknowledge_message(uint8_t * data, uint8_t obo, uint16_t seq_zero, uint32_t block_ack){ 14777ba3d3fSMatthias Ringwald // printf("ACK Upper Transport, seq_zero %x\n", seq_zero); 14877ba3d3fSMatthias Ringwald data[0] = 0; // SEG = 0, Opcode = 0 14977ba3d3fSMatthias Ringwald big_endian_store_16( data, 1, (obo << 15) | (seq_zero << 2) | 0); // OBO, SeqZero, RFU 15077ba3d3fSMatthias Ringwald big_endian_store_32( data, 3, block_ack); 151b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 15277ba3d3fSMatthias Ringwald mesh_print_hex("ACK Upper Transport", data, 7); 153b66a7a84SMatthias Ringwald #endif 15477ba3d3fSMatthias Ringwald } 15577ba3d3fSMatthias Ringwald 15627e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_send_ack(uint16_t netkey_index, uint8_t ttl, uint16_t dest, uint16_t seq_zero, uint32_t block_ack){ 15777ba3d3fSMatthias Ringwald // setup ack message 15877ba3d3fSMatthias Ringwald uint8_t ack_msg[7]; 15927e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_setup_acknowledge_message(ack_msg, 0, seq_zero, block_ack); 16077ba3d3fSMatthias Ringwald // 16177ba3d3fSMatthias 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." 16277ba3d3fSMatthias Ringwald // if (ttl <= 1) return 0; 16377ba3d3fSMatthias Ringwald 16477ba3d3fSMatthias Ringwald // TODO: check transport_pdu_len depending on ctl 16577ba3d3fSMatthias Ringwald 16677ba3d3fSMatthias Ringwald // lookup network by netkey_index 16777ba3d3fSMatthias Ringwald const mesh_network_key_t * network_key = mesh_network_key_list_get(netkey_index); 16877ba3d3fSMatthias Ringwald if (!network_key) return; 16977ba3d3fSMatthias Ringwald 17077ba3d3fSMatthias Ringwald // allocate network_pdu 17177ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu = mesh_network_pdu_get(); 17277ba3d3fSMatthias Ringwald if (!network_pdu) return; 17377ba3d3fSMatthias Ringwald 17477ba3d3fSMatthias Ringwald // setup network_pdu 175c0005391SMatthias Ringwald network_pdu->pdu_header.pdu_type = MESH_PDU_TYPE_SEGMENT_ACKNOWLEDGMENT; 176001c65e0SMatthias 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)); 17777ba3d3fSMatthias Ringwald 17877ba3d3fSMatthias Ringwald // send network_pdu 17977ba3d3fSMatthias Ringwald mesh_network_send_pdu(network_pdu); 18077ba3d3fSMatthias Ringwald } 18177ba3d3fSMatthias Ringwald 18227e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_send_ack_for_segmented_pdu(mesh_segmented_pdu_t * segmented_pdu){ 183bd915455SMatthias Ringwald uint16_t seq_zero = segmented_pdu->seq & 0x1fff; 18427e8a9aaSMatthias Ringwald uint8_t ttl = segmented_pdu->ctl_ttl & 0x7f; 18527e8a9aaSMatthias Ringwald uint16_t dest = segmented_pdu->src; 18627e8a9aaSMatthias Ringwald uint16_t netkey_index = segmented_pdu->netkey_index; 187b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 18877ba3d3fSMatthias Ringwald printf("mesh_transport_send_ack_for_transport_pdu %p with netkey_index %x, TTL = %u, SeqZero = %x, SRC = %x, DST = %x\n", 18927e8a9aaSMatthias Ringwald segmented_pdu, netkey_index, ttl, seq_zero, mesh_node_get_primary_element_address(), dest); 190b66a7a84SMatthias Ringwald #endif 19127e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack(netkey_index, ttl, dest, seq_zero, segmented_pdu->block_ack); 19277ba3d3fSMatthias Ringwald } 19377ba3d3fSMatthias Ringwald 19427e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_send_ack_for_network_pdu(mesh_network_pdu_t *network_pdu, uint16_t seq_zero, uint32_t block_ack) { 19577ba3d3fSMatthias Ringwald uint8_t ttl = mesh_network_ttl(network_pdu); 19677ba3d3fSMatthias Ringwald uint16_t dest = mesh_network_src(network_pdu); 19777ba3d3fSMatthias Ringwald uint16_t netkey_index = network_pdu->netkey_index; 198b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 19977ba3d3fSMatthias Ringwald printf("mesh_transport_send_ack_for_network_pdu %p with netkey_index %x, TTL = %u, SeqZero = %x, SRC = %x, DST = %x\n", 200001c65e0SMatthias Ringwald network_pdu, netkey_index, ttl, seq_zero, mesh_node_get_primary_element_address(), dest); 201b66a7a84SMatthias Ringwald #endif 20227e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack(netkey_index, ttl, dest, seq_zero, block_ack); 20377ba3d3fSMatthias Ringwald } 20477ba3d3fSMatthias Ringwald 20527e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_stop_acknowledgment_timer(mesh_segmented_pdu_t *segmented_pdu){ 206354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) == 0) return; 207354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 20827e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->acknowledgement_timer); 209926e8875SMatthias Ringwald } 210926e8875SMatthias Ringwald 21127e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_stop_incomplete_timer(mesh_segmented_pdu_t *segmented_pdu){ 212354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER) == 0) return; 213354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER; 21427e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->incomplete_timer); 215926e8875SMatthias Ringwald } 216926e8875SMatthias Ringwald 21727e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_segmented_message_complete(mesh_segmented_pdu_t * segmented_pdu){ 21877ba3d3fSMatthias Ringwald // stop timers 21927e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_stop_acknowledgment_timer(segmented_pdu); 22027e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_stop_incomplete_timer(segmented_pdu); 22177ba3d3fSMatthias Ringwald // stop reassembly 22227e8a9aaSMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(segmented_pdu->src); 22377ba3d3fSMatthias Ringwald if (peer){ 224926e8875SMatthias Ringwald peer->message_pdu = NULL; 225926e8875SMatthias Ringwald } 22677ba3d3fSMatthias Ringwald } 22777ba3d3fSMatthias Ringwald 22827e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_ack_timeout(btstack_timer_source_t *ts){ 22927e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_run_loop_get_timer_context(ts); 230b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 23127e8a9aaSMatthias Ringwald printf("ACK: acknowledgement timer fired for %p, send ACK\n", segmented_pdu); 232b66a7a84SMatthias Ringwald #endif 233354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 23427e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack_for_segmented_pdu(segmented_pdu); 23577ba3d3fSMatthias Ringwald } 23677ba3d3fSMatthias Ringwald 23727e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_incomplete_timeout(btstack_timer_source_t *ts){ 23827e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_run_loop_get_timer_context(ts); 239b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 24027e8a9aaSMatthias Ringwald printf("mesh_lower_transport_incoming_incomplete_timeout for %p - give up\n", segmented_pdu); 241b66a7a84SMatthias Ringwald #endif 24227e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_segmented_message_complete(segmented_pdu); 24377ba3d3fSMatthias Ringwald // free message 2446dac9d64SMatthias Ringwald mesh_segmented_pdu_free(segmented_pdu); 24577ba3d3fSMatthias Ringwald } 24677ba3d3fSMatthias Ringwald 24727e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_start_acknowledgment_timer(mesh_segmented_pdu_t * segmented_pdu, uint32_t timeout){ 248b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 24927e8a9aaSMatthias Ringwald printf("ACK: start rx ack timer for %p, timeout %u ms\n", segmented_pdu, (int) timeout); 250b66a7a84SMatthias Ringwald #endif 25127e8a9aaSMatthias Ringwald btstack_run_loop_set_timer(&segmented_pdu->acknowledgement_timer, timeout); 25227e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_handler(&segmented_pdu->acknowledgement_timer, &mesh_lower_transport_incoming_ack_timeout); 25327e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_context(&segmented_pdu->acknowledgement_timer, segmented_pdu); 25427e8a9aaSMatthias Ringwald btstack_run_loop_add_timer(&segmented_pdu->acknowledgement_timer); 255354884c7SMatthias Ringwald segmented_pdu->flags |= MESH_TRANSPORT_FLAG_ACK_TIMER; 25677ba3d3fSMatthias Ringwald } 25777ba3d3fSMatthias Ringwald 25827e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_restart_incomplete_timer(mesh_segmented_pdu_t * segmented_pdu, uint32_t timeout, 25977ba3d3fSMatthias Ringwald void (*callback)(btstack_timer_source_t *ts)){ 260b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 26127e8a9aaSMatthias Ringwald printf("RX-(re)start incomplete timer for %p, timeout %u ms\n", segmented_pdu, (int) timeout); 262b66a7a84SMatthias Ringwald #endif 263354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER) != 0){ 26427e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->incomplete_timer); 26577ba3d3fSMatthias Ringwald } 26627e8a9aaSMatthias Ringwald btstack_run_loop_set_timer(&segmented_pdu->incomplete_timer, timeout); 26727e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_handler(&segmented_pdu->incomplete_timer, callback); 26827e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_context(&segmented_pdu->incomplete_timer, segmented_pdu); 26927e8a9aaSMatthias Ringwald btstack_run_loop_add_timer(&segmented_pdu->incomplete_timer); 270354884c7SMatthias Ringwald segmented_pdu->flags |= MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER; 27177ba3d3fSMatthias Ringwald } 27277ba3d3fSMatthias Ringwald 27327e8a9aaSMatthias Ringwald static mesh_segmented_pdu_t * mesh_lower_transport_incoming_pdu_for_segmented_message(mesh_network_pdu_t *network_pdu){ 27477ba3d3fSMatthias Ringwald uint16_t src = mesh_network_src(network_pdu); 27577ba3d3fSMatthias Ringwald uint16_t seq_zero = ( big_endian_read_16(mesh_network_pdu_data(network_pdu), 1) >> 2) & 0x1fff; 276b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 27777ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: seq_zero %x\n", seq_zero); 278b66a7a84SMatthias Ringwald #endif 27977ba3d3fSMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(src); 28077ba3d3fSMatthias Ringwald if (!peer) { 28177ba3d3fSMatthias Ringwald return NULL; 28277ba3d3fSMatthias Ringwald } 283b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 28477ba3d3fSMatthias Ringwald printf("mesh_seq_zero_validate(%x, %x) -- last (%x, %x)\n", src, seq_zero, peer->address, peer->seq_zero); 285b66a7a84SMatthias Ringwald #endif 28677ba3d3fSMatthias Ringwald 28777ba3d3fSMatthias Ringwald // reception of transport message ongoing 288926e8875SMatthias Ringwald if (peer->message_pdu){ 28977ba3d3fSMatthias Ringwald // check if segment for same seq zero 290bd915455SMatthias Ringwald uint16_t active_seq_zero = peer->message_pdu->seq & 0x1fff; 29177ba3d3fSMatthias Ringwald if (active_seq_zero == seq_zero) { 292b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 29377ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: segment for current transport pdu with SeqZero %x\n", active_seq_zero); 294b66a7a84SMatthias Ringwald #endif 295926e8875SMatthias Ringwald return peer->message_pdu; 29677ba3d3fSMatthias Ringwald } else { 29777ba3d3fSMatthias Ringwald // seq zero differs from current transport pdu, but current pdu is not complete 298b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 29977ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: drop segment. current transport pdu SeqZero %x, now %x\n", active_seq_zero, seq_zero); 300b66a7a84SMatthias Ringwald #endif 30177ba3d3fSMatthias Ringwald return NULL; 30277ba3d3fSMatthias Ringwald } 30377ba3d3fSMatthias Ringwald } 30477ba3d3fSMatthias Ringwald 30577ba3d3fSMatthias Ringwald // send ACK if segment for previously completed transport pdu (no ongoing reception, block ack is cleared) 30677ba3d3fSMatthias Ringwald if ((seq_zero == peer->seq_zero) && (peer->block_ack != 0)){ 307b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 30877ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: segment for last completed message. send ack\n"); 309b66a7a84SMatthias Ringwald #endif 31027e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack_for_network_pdu(network_pdu, seq_zero, peer->block_ack); 31177ba3d3fSMatthias Ringwald return NULL; 31277ba3d3fSMatthias Ringwald } 31377ba3d3fSMatthias Ringwald 31477ba3d3fSMatthias Ringwald // reconstruct lowest 24 bit of SeqAuth 31577ba3d3fSMatthias Ringwald uint32_t seq = mesh_network_seq(network_pdu); 31677ba3d3fSMatthias Ringwald uint32_t seq_auth = (seq & 0xffe000) | seq_zero; 31777ba3d3fSMatthias Ringwald if (seq_auth > seq){ 31877ba3d3fSMatthias Ringwald seq_auth -= 0x2000; 31977ba3d3fSMatthias Ringwald } 32077ba3d3fSMatthias Ringwald 32177ba3d3fSMatthias Ringwald // no transport pdu active, check new message: seq auth is greater OR seq auth is same but no segments 32277ba3d3fSMatthias Ringwald if (seq_auth > peer->seq_auth || (seq_auth == peer->seq_auth && peer->block_ack == 0)){ 32379eb95b0SMatthias Ringwald mesh_segmented_pdu_t * pdu = mesh_segmented_pdu_get(); 32477ba3d3fSMatthias Ringwald if (!pdu) return NULL; 32577ba3d3fSMatthias Ringwald 32677ba3d3fSMatthias Ringwald // cache network pdu header 3277cb45abfSMatthias Ringwald pdu->ivi_nid = network_pdu->data[0]; 3287cb45abfSMatthias Ringwald pdu->ctl_ttl = network_pdu->data[1]; 3297cb45abfSMatthias Ringwald pdu->src = big_endian_read_16(network_pdu->data, 5); 3307cb45abfSMatthias Ringwald pdu->dst = big_endian_read_16(network_pdu->data, 7); 33177ba3d3fSMatthias Ringwald // store lower 24 bit of SeqAuth for App / Device Nonce 3327cb45abfSMatthias Ringwald pdu->seq = seq_auth; 33377ba3d3fSMatthias Ringwald 334e5828668SMatthias Ringwald // get akf_aid & transmic 335b30b4f6eSMatthias Ringwald pdu->akf_aid_control = network_pdu->data[9] & 0x7f; 336b30b4f6eSMatthias Ringwald if ((network_pdu->data[10] & 0x80) != 0){ 337b30b4f6eSMatthias Ringwald pdu->flags |= MESH_TRANSPORT_FLAG_TRANSMIC_64; 338b30b4f6eSMatthias Ringwald } 339e5828668SMatthias Ringwald 34077ba3d3fSMatthias Ringwald // store meta data in new pdu 34177ba3d3fSMatthias Ringwald pdu->netkey_index = network_pdu->netkey_index; 34277ba3d3fSMatthias Ringwald pdu->block_ack = 0; 343354884c7SMatthias Ringwald pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 34477ba3d3fSMatthias Ringwald 34577ba3d3fSMatthias Ringwald // update peer info 346926e8875SMatthias Ringwald peer->message_pdu = pdu; 34777ba3d3fSMatthias Ringwald peer->seq_zero = seq_zero; 34877ba3d3fSMatthias Ringwald peer->seq_auth = seq_auth; 34977ba3d3fSMatthias Ringwald peer->block_ack = 0; 35077ba3d3fSMatthias Ringwald 351b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 3523945bdb6SMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: setup transport pdu %p for src %x, seq %06x, seq_zero %x\n", pdu, src, 3533945bdb6SMatthias Ringwald pdu->seq, seq_zero); 354b66a7a84SMatthias Ringwald #endif 355926e8875SMatthias Ringwald return peer->message_pdu; 35677ba3d3fSMatthias Ringwald } else { 35777ba3d3fSMatthias Ringwald // seq zero differs from current transport pdu 358b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 35977ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: drop segment for old seq %x\n", seq_zero); 360b66a7a84SMatthias Ringwald #endif 36177ba3d3fSMatthias Ringwald return NULL; 36277ba3d3fSMatthias Ringwald } 36377ba3d3fSMatthias Ringwald } 36477ba3d3fSMatthias Ringwald 36527e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_process_segment(mesh_segmented_pdu_t * message_pdu, mesh_network_pdu_t * network_pdu){ 36677ba3d3fSMatthias Ringwald 36777ba3d3fSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 36877ba3d3fSMatthias Ringwald uint8_t lower_transport_pdu_len = mesh_network_pdu_len(network_pdu); 36977ba3d3fSMatthias Ringwald 37077ba3d3fSMatthias Ringwald // get seq_zero 37177ba3d3fSMatthias Ringwald uint16_t seq_zero = ( big_endian_read_16(lower_transport_pdu, 1) >> 2) & 0x1fff; 37277ba3d3fSMatthias Ringwald 37377ba3d3fSMatthias Ringwald // get seg fields 37477ba3d3fSMatthias Ringwald uint8_t seg_o = ( big_endian_read_16(lower_transport_pdu, 2) >> 5) & 0x001f; 37577ba3d3fSMatthias Ringwald uint8_t seg_n = lower_transport_pdu[3] & 0x1f; 37677ba3d3fSMatthias Ringwald uint8_t segment_len = lower_transport_pdu_len - 4; 37777ba3d3fSMatthias Ringwald uint8_t * segment_data = &lower_transport_pdu[4]; 37877ba3d3fSMatthias Ringwald 379b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 380b30b4f6eSMatthias Ringwald uint8_t transmic_len = ((message_pdu->flags & MESH_TRANSPORT_FLAG_TRANSMIC_64) != 0) ? 64 : 32; 381b30b4f6eSMatthias Ringwald printf("mesh_lower_transport_incoming_process_segment: seq zero %04x, seg_o %02x, seg_n %02x, transmic len: %u bit\n", seq_zero, seg_o, seg_n, transmic_len); 38277ba3d3fSMatthias Ringwald mesh_print_hex("Segment", segment_data, segment_len); 383b66a7a84SMatthias Ringwald #endif 38477ba3d3fSMatthias Ringwald 385926e8875SMatthias Ringwald // drop if already stored 386926e8875SMatthias Ringwald if ((message_pdu->block_ack & (1<<seg_o)) != 0){ 387926e8875SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 388926e8875SMatthias Ringwald return; 389926e8875SMatthias Ringwald } 390926e8875SMatthias Ringwald 39177ba3d3fSMatthias Ringwald // mark as received 392926e8875SMatthias Ringwald message_pdu->block_ack |= (1<<seg_o); 393926e8875SMatthias Ringwald 39416fd08f9SMatthias Ringwald // store segment 39516fd08f9SMatthias Ringwald uint8_t max_segment_len = mesh_network_control(network_pdu) ? 8 : 12; 39616fd08f9SMatthias Ringwald mesh_network_pdu_t * latest_segment = (mesh_network_pdu_t *) btstack_linked_list_get_first_item(&message_pdu->segments); 39716fd08f9SMatthias Ringwald if ((latest_segment != NULL) && ((MESH_NETWORK_PAYLOAD_MAX - latest_segment->len) > (max_segment_len + 1))){ 39816fd08f9SMatthias Ringwald // store in last added segment if there is enough space available 39916fd08f9SMatthias Ringwald latest_segment->data[latest_segment->len++] = seg_o; 40016fd08f9SMatthias Ringwald (void) memcpy(&latest_segment->data[latest_segment->len], &lower_transport_pdu[4], segment_len); 40116fd08f9SMatthias Ringwald latest_segment->len += segment_len; 40216fd08f9SMatthias Ringwald // free buffer 40316fd08f9SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 40416fd08f9SMatthias Ringwald } else { 40516fd08f9SMatthias Ringwald // move to beginning 40616fd08f9SMatthias Ringwald network_pdu->data[0] = seg_o; 40716fd08f9SMatthias Ringwald uint8_t i; 40816fd08f9SMatthias Ringwald for (i=0;i<segment_len;i++){ 40916fd08f9SMatthias Ringwald network_pdu->data[1+i] = network_pdu->data[13+i]; 41016fd08f9SMatthias Ringwald } 41116fd08f9SMatthias Ringwald network_pdu->len = 1 + segment_len; 41216fd08f9SMatthias Ringwald // add this buffer 413926e8875SMatthias Ringwald btstack_linked_list_add(&message_pdu->segments, (btstack_linked_item_t *) network_pdu); 41416fd08f9SMatthias Ringwald } 415926e8875SMatthias Ringwald 41677ba3d3fSMatthias Ringwald // last segment -> store len 41777ba3d3fSMatthias Ringwald if (seg_o == seg_n){ 4188a129166SMatthias Ringwald message_pdu->len = (seg_n * max_segment_len) + segment_len; 419b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 420926e8875SMatthias Ringwald printf("Assembled payload len %u\n", message_pdu->len); 421b66a7a84SMatthias Ringwald #endif 42277ba3d3fSMatthias Ringwald } 42377ba3d3fSMatthias Ringwald 42477ba3d3fSMatthias Ringwald // check for complete 42577ba3d3fSMatthias Ringwald int i; 42677ba3d3fSMatthias Ringwald for (i=0;i<=seg_n;i++){ 427926e8875SMatthias Ringwald if ( (message_pdu->block_ack & (1<<i)) == 0) return; 428926e8875SMatthias Ringwald } 429926e8875SMatthias Ringwald 43077ba3d3fSMatthias Ringwald // store block ack in peer info 4313945bdb6SMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(message_pdu->src); 43277ba3d3fSMatthias Ringwald // TODO: check if NULL check can be removed 43377ba3d3fSMatthias Ringwald if (peer){ 434926e8875SMatthias Ringwald peer->block_ack = message_pdu->block_ack; 43577ba3d3fSMatthias Ringwald } 43677ba3d3fSMatthias Ringwald 43777ba3d3fSMatthias Ringwald // send ack 43827e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack_for_segmented_pdu(message_pdu); 43977ba3d3fSMatthias Ringwald 44077ba3d3fSMatthias Ringwald // forward to upper transport 44127e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) message_pdu); 4422a974a69SMatthias Ringwald 4432a974a69SMatthias Ringwald // mark as done 44427e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_segmented_message_complete(message_pdu); 44558bb2379SMatthias Ringwald } 44658bb2379SMatthias Ringwald 44777ba3d3fSMatthias Ringwald void mesh_lower_transport_message_processed_by_higher_layer(mesh_pdu_t * pdu){ 448fc5e2620SMatthias Ringwald btstack_assert(pdu == mesh_lower_transport_higher_layer_pdu); 449fc5e2620SMatthias Ringwald mesh_lower_transport_higher_layer_pdu = NULL; 45084011563SMatthias Ringwald mesh_network_pdu_t * network_pdu; 45177ba3d3fSMatthias Ringwald switch (pdu->pdu_type){ 452a4bbc09dSMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 4538a504b30SMatthias Ringwald // free segments 45479eb95b0SMatthias Ringwald mesh_segmented_pdu_free((mesh_segmented_pdu_t *) pdu); 45535699c48SMatthias Ringwald break; 4568facb3eaSMatthias Ringwald case MESH_PDU_TYPE_UNSEGMENTED: 457e4121a34SMatthias Ringwald network_pdu = (mesh_network_pdu_t *) pdu; 45884011563SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 4592ae11e2cSMatthias Ringwald break; 46077ba3d3fSMatthias Ringwald default: 4613d9c3b8eSMatthias Ringwald btstack_assert(0); 46277ba3d3fSMatthias Ringwald break; 46377ba3d3fSMatthias Ringwald } 46427e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_deliver_to_higher_layer(); 46577ba3d3fSMatthias Ringwald } 46677ba3d3fSMatthias Ringwald 46727e8a9aaSMatthias Ringwald // OUTGOING // 46827e8a9aaSMatthias Ringwald 46927e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_setup_block_ack(mesh_segmented_pdu_t *message_pdu){ 47027e8a9aaSMatthias Ringwald // setup block ack - set bit for segment to send, will be cleared on ack 47127e8a9aaSMatthias Ringwald int ctl = message_pdu->ctl_ttl >> 7; 47227e8a9aaSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 47327e8a9aaSMatthias Ringwald uint8_t seg_n = (message_pdu->len - 1) / max_segment_len; 47427e8a9aaSMatthias Ringwald if (seg_n < 31){ 47527e8a9aaSMatthias Ringwald message_pdu->block_ack = (1 << (seg_n+1)) - 1; 47677ba3d3fSMatthias Ringwald } else { 47727e8a9aaSMatthias Ringwald message_pdu->block_ack = 0xffffffff; 47877ba3d3fSMatthias Ringwald } 47977ba3d3fSMatthias Ringwald } 48077ba3d3fSMatthias Ringwald 481e3f8b4e7SMatthias Ringwald static mesh_segmented_pdu_t * mesh_lower_transport_outgoing_message_for_dst(uint16_t dst){ 482e3f8b4e7SMatthias Ringwald if (lower_transport_outgoing_message != NULL && lower_transport_outgoing_message->dst == dst){ 483e3f8b4e7SMatthias Ringwald return lower_transport_outgoing_message; 484e3f8b4e7SMatthias Ringwald } 485e3f8b4e7SMatthias Ringwald return NULL; 486e3f8b4e7SMatthias Ringwald } 487e3f8b4e7SMatthias Ringwald 48827e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_process_segment_acknowledgement_message(mesh_network_pdu_t *network_pdu){ 489e3f8b4e7SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = mesh_lower_transport_outgoing_message_for_dst( mesh_network_src(network_pdu)); 490e3f8b4e7SMatthias Ringwald if (segmented_pdu == NULL) return; 49127e8a9aaSMatthias Ringwald 49227e8a9aaSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 49327e8a9aaSMatthias Ringwald uint16_t seq_zero_pdu = big_endian_read_16(lower_transport_pdu, 1) >> 2; 49427e8a9aaSMatthias Ringwald uint16_t seq_zero_out = lower_transport_outgoing_message->seq & 0x1fff; 49527e8a9aaSMatthias Ringwald uint32_t block_ack = big_endian_read_32(lower_transport_pdu, 3); 49627e8a9aaSMatthias Ringwald 49727e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 49827e8a9aaSMatthias Ringwald printf("[+] Segment Acknowledgment message with seq_zero %06x, block_ack %08x - outgoing seq %06x, block_ack %08x\n", 499e3f8b4e7SMatthias Ringwald seq_zero_pdu, block_ack, seq_zero_out, segmented_pdu->block_ack); 50027e8a9aaSMatthias Ringwald #endif 50127e8a9aaSMatthias Ringwald 50227e8a9aaSMatthias Ringwald if (block_ack == 0){ 50327e8a9aaSMatthias Ringwald // If a Segment Acknowledgment message with the BlockAck field set to 0x00000000 is received, 50427e8a9aaSMatthias Ringwald // then the Upper Transport PDU shall be immediately cancelled and the higher layers shall be notified that 50527e8a9aaSMatthias Ringwald // the Upper Transport PDU has been cancelled. 50627e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 50727e8a9aaSMatthias Ringwald printf("[+] Block Ack == 0 => Abort\n"); 50827e8a9aaSMatthias Ringwald #endif 509e3f8b4e7SMatthias Ringwald // current? 510e3f8b4e7SMatthias Ringwald if ((lower_transport_outgoing_message == segmented_pdu) && lower_transport_outgoing_segment_at_network_layer){ 51112835760SMatthias Ringwald lower_transport_outgoing_transmission_aborted = true; 51227e8a9aaSMatthias Ringwald } else { 51312835760SMatthias Ringwald mesh_lower_transport_outgoing_complete(segmented_pdu, MESH_TRANSPORT_STATUS_SEND_ABORT_BY_REMOTE); 51427e8a9aaSMatthias Ringwald } 51527e8a9aaSMatthias Ringwald return; 51627e8a9aaSMatthias Ringwald } 51727e8a9aaSMatthias Ringwald if (seq_zero_pdu != seq_zero_out){ 51827e8a9aaSMatthias Ringwald 51927e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 52027e8a9aaSMatthias Ringwald printf("[!] Seq Zero doesn't match\n"); 52127e8a9aaSMatthias Ringwald #endif 52227e8a9aaSMatthias Ringwald return; 52327e8a9aaSMatthias Ringwald } 52427e8a9aaSMatthias Ringwald 525e3f8b4e7SMatthias Ringwald segmented_pdu->block_ack &= ~block_ack; 52627e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 527e3f8b4e7SMatthias Ringwald printf("[+] Updated block_ack %08x\n", segmented_pdu->block_ack); 52827e8a9aaSMatthias Ringwald #endif 52927e8a9aaSMatthias Ringwald 530e3f8b4e7SMatthias Ringwald if (segmented_pdu->block_ack == 0){ 53127e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 53227e8a9aaSMatthias Ringwald printf("[+] Sent complete\n"); 53327e8a9aaSMatthias Ringwald #endif 53427e8a9aaSMatthias Ringwald 535e3f8b4e7SMatthias Ringwald if ((lower_transport_outgoing_message == segmented_pdu) && lower_transport_outgoing_segment_at_network_layer){ 53627e8a9aaSMatthias Ringwald lower_transport_outgoing_transmission_complete = true; 53727e8a9aaSMatthias Ringwald } else { 53812835760SMatthias Ringwald mesh_lower_transport_outgoing_complete(segmented_pdu, MESH_TRANSPORT_STATUS_SUCCESS); 53927e8a9aaSMatthias Ringwald } 54027e8a9aaSMatthias Ringwald } 54127e8a9aaSMatthias Ringwald } 54227e8a9aaSMatthias Ringwald 54327e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_stop_acknowledgment_timer(mesh_segmented_pdu_t *segmented_pdu){ 544354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) == 0) return; 545354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 54627e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->acknowledgement_timer); 54727e8a9aaSMatthias Ringwald } 54827e8a9aaSMatthias Ringwald 54927e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_restart_segment_transmission_timer(mesh_segmented_pdu_t *segmented_pdu){ 55027e8a9aaSMatthias Ringwald // restart segment transmission timer for unicast dst 55127e8a9aaSMatthias Ringwald // - "This timer shall be set to a minimum of 200 + 50 * TTL milliseconds." 55227e8a9aaSMatthias Ringwald uint32_t timeout = 200 + 50 * (segmented_pdu->ctl_ttl & 0x7f); 553354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) != 0){ 55427e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&lower_transport_outgoing_message->acknowledgement_timer); 55527e8a9aaSMatthias Ringwald } 55627e8a9aaSMatthias Ringwald 55727e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 55827e8a9aaSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: setup transmission timeout %u ms\n", segmented_pdu, 55927e8a9aaSMatthias Ringwald segmented_pdu->seq, (int) timeout); 56027e8a9aaSMatthias Ringwald #endif 56127e8a9aaSMatthias Ringwald 56227e8a9aaSMatthias Ringwald btstack_run_loop_set_timer(&segmented_pdu->acknowledgement_timer, timeout); 56327e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_handler(&segmented_pdu->acknowledgement_timer, &mesh_lower_transport_outgoing_segment_transmission_timeout); 56427e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_context(&segmented_pdu->acknowledgement_timer, lower_transport_outgoing_message); 56527e8a9aaSMatthias Ringwald btstack_run_loop_add_timer(&segmented_pdu->acknowledgement_timer); 566354884c7SMatthias Ringwald segmented_pdu->flags |= MESH_TRANSPORT_FLAG_ACK_TIMER; 56727e8a9aaSMatthias Ringwald } 56827e8a9aaSMatthias Ringwald 56912835760SMatthias Ringwald static void mesh_lower_transport_outgoing_complete(mesh_segmented_pdu_t * segmented_pdu, mesh_transport_status_t status){ 57069061c1cSMatthias Ringwald btstack_assert(segmented_pdu != NULL); 57127e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 57269061c1cSMatthias Ringwald printf("[+] outgoing_complete %p, ack timer active %u, incomplete active %u\n", segmented_pdu, 57369061c1cSMatthias Ringwald ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) != 0), ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER) != 0)); 57427e8a9aaSMatthias Ringwald #endif 57527e8a9aaSMatthias Ringwald // stop timers 57669061c1cSMatthias Ringwald mesh_lower_transport_outgoing_stop_acknowledgment_timer(segmented_pdu); 57769061c1cSMatthias Ringwald 57869061c1cSMatthias Ringwald // remove from lists 57969061c1cSMatthias Ringwald if (lower_transport_outgoing_message == segmented_pdu){ 58069061c1cSMatthias Ringwald lower_transport_outgoing_message = NULL; 58169061c1cSMatthias Ringwald } else { 58269061c1cSMatthias Ringwald btstack_linked_list_remove(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) segmented_pdu); 58369061c1cSMatthias Ringwald btstack_linked_list_remove(&lower_transport_outgoing_ready, (btstack_linked_item_t *) segmented_pdu); 58469061c1cSMatthias Ringwald } 58527e8a9aaSMatthias Ringwald 58627e8a9aaSMatthias Ringwald // notify upper transport 58712835760SMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, status, (mesh_pdu_t *) segmented_pdu); 58827e8a9aaSMatthias Ringwald } 58927e8a9aaSMatthias Ringwald 59027e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_setup_segment(mesh_segmented_pdu_t *message_pdu, uint8_t seg_o, mesh_network_pdu_t *network_pdu){ 59177ba3d3fSMatthias Ringwald 5923945bdb6SMatthias Ringwald int ctl = message_pdu->ctl_ttl >> 7; 59377ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 59477ba3d3fSMatthias Ringwald 595b16fda24SMatthias 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) 596b16fda24SMatthias Ringwald uint32_t seq; 597a7f44e8dSMatthias Ringwald if ((message_pdu->flags & MESH_TRANSPORT_FLAG_SEQ_RESERVED) != 0){ 598a7f44e8dSMatthias Ringwald message_pdu->flags &= ~(MESH_TRANSPORT_FLAG_SEQ_RESERVED); 5993945bdb6SMatthias Ringwald seq = message_pdu->seq; 600b16fda24SMatthias Ringwald } else { 601b16fda24SMatthias Ringwald seq = mesh_sequence_number_next(); 602b16fda24SMatthias Ringwald } 6033945bdb6SMatthias Ringwald uint16_t seq_zero = message_pdu->seq & 0x01fff; 604a7f44e8dSMatthias Ringwald uint8_t seg_n = (message_pdu->len - 1) / max_segment_len; 605b30b4f6eSMatthias Ringwald uint8_t szmic = ((message_pdu->flags & MESH_TRANSPORT_FLAG_TRANSMIC_64) != 0) ? 1 : 0; 6063945bdb6SMatthias Ringwald uint8_t nid = message_pdu->ivi_nid & 0x7f; 6073945bdb6SMatthias Ringwald uint8_t ttl = message_pdu->ctl_ttl & 0x7f; 6083945bdb6SMatthias Ringwald uint16_t src = message_pdu->src; 6093945bdb6SMatthias Ringwald uint16_t dest = message_pdu->dst; 61077ba3d3fSMatthias Ringwald 611b30b4f6eSMatthias Ringwald // only 1 for access messages with 64 bit TransMIC 612b30b4f6eSMatthias Ringwald btstack_assert((szmic == 0) || !ctl); 613b30b4f6eSMatthias Ringwald 61477ba3d3fSMatthias Ringwald // current segment. 61577ba3d3fSMatthias Ringwald uint16_t seg_offset = seg_o * max_segment_len; 61677ba3d3fSMatthias Ringwald 61777ba3d3fSMatthias Ringwald uint8_t lower_transport_pdu_data[16]; 618a7f44e8dSMatthias Ringwald lower_transport_pdu_data[0] = 0x80 | message_pdu->akf_aid_control; 61977ba3d3fSMatthias Ringwald big_endian_store_24(lower_transport_pdu_data, 1, (szmic << 23) | (seq_zero << 10) | (seg_o << 5) | seg_n); 620a7f44e8dSMatthias Ringwald uint16_t segment_len = btstack_min(message_pdu->len - seg_offset, max_segment_len); 621a7f44e8dSMatthias Ringwald 62277ba3d3fSMatthias Ringwald uint16_t lower_transport_pdu_len = 4 + segment_len; 62377ba3d3fSMatthias Ringwald 624a7f44e8dSMatthias Ringwald // find network-pdu with chunk for seg_offset 625a7f44e8dSMatthias Ringwald mesh_network_pdu_t * chunk = (mesh_network_pdu_t *) lower_transport_outgoing_message->segments; 626a7f44e8dSMatthias Ringwald uint16_t chunk_start = 0; 627a7f44e8dSMatthias Ringwald while ((chunk_start + MESH_NETWORK_PAYLOAD_MAX) <= seg_offset){ 628a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 629a7f44e8dSMatthias Ringwald chunk_start += MESH_NETWORK_PAYLOAD_MAX; 630a7f44e8dSMatthias Ringwald } 631a7f44e8dSMatthias Ringwald // first part 632a7f44e8dSMatthias Ringwald uint16_t chunk_offset = seg_offset - chunk_start; 633a7f44e8dSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(MESH_NETWORK_PAYLOAD_MAX - chunk_offset, segment_len); 634a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4], 635a7f44e8dSMatthias Ringwald &chunk->data[chunk_offset], bytes_to_copy); 636a7f44e8dSMatthias Ringwald segment_len -= bytes_to_copy; 637a7f44e8dSMatthias Ringwald // second part 638a7f44e8dSMatthias Ringwald if (segment_len > 0){ 639a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 640a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4+bytes_to_copy], 641a7f44e8dSMatthias Ringwald &chunk->data[0], segment_len); 642a7f44e8dSMatthias Ringwald } 643a7f44e8dSMatthias Ringwald 644a7f44e8dSMatthias 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); 64577ba3d3fSMatthias Ringwald } 64677ba3d3fSMatthias Ringwald 64727e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_send_next_segment(void){ 64879eb95b0SMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 64977ba3d3fSMatthias Ringwald 6501b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 6513945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send next segment\n", lower_transport_outgoing_message, 6523945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq); 6531b639008SMatthias Ringwald #endif 6541b639008SMatthias Ringwald 6553945bdb6SMatthias Ringwald int ctl = lower_transport_outgoing_message->ctl_ttl >> 7; 65677ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 657a7f44e8dSMatthias Ringwald uint8_t seg_n = (lower_transport_outgoing_message->len - 1) / max_segment_len; 65877ba3d3fSMatthias Ringwald 659764c8f0dSMatthias Ringwald // find next unacknowledged segment 660a7f44e8dSMatthias Ringwald while ((lower_transport_outgoing_seg_o <= seg_n) && ((lower_transport_outgoing_message->block_ack & (1 << lower_transport_outgoing_seg_o)) == 0)){ 66177ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 66277ba3d3fSMatthias Ringwald } 66377ba3d3fSMatthias Ringwald 66477ba3d3fSMatthias Ringwald if (lower_transport_outgoing_seg_o > seg_n){ 665b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 6663945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send complete (dst %x)\n", lower_transport_outgoing_message, 6673945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, 6683945bdb6SMatthias Ringwald lower_transport_outgoing_message->dst); 669b66a7a84SMatthias Ringwald #endif 67077ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o = 0; 67177ba3d3fSMatthias Ringwald 67277ba3d3fSMatthias Ringwald // done for unicast, ack timer already set, too 673b4977f35SMatthias Ringwald if (mesh_network_address_unicast(lower_transport_outgoing_message->dst)) { 67469061c1cSMatthias Ringwald btstack_linked_list_add(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) lower_transport_outgoing_message); 67569061c1cSMatthias Ringwald lower_transport_outgoing_message = NULL; 676b4977f35SMatthias Ringwald return; 677b4977f35SMatthias Ringwald } 67877ba3d3fSMatthias Ringwald 679b4977f35SMatthias Ringwald // done for group/virtual, no more retries? 680764c8f0dSMatthias Ringwald if (lower_transport_outgoing_message->retry_count == 0){ 681b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 68277ba3d3fSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged -> free\n"); 683b66a7a84SMatthias Ringwald #endif 68469061c1cSMatthias Ringwald // notify upper transport 68512835760SMatthias Ringwald mesh_lower_transport_outgoing_complete(lower_transport_outgoing_message, MESH_TRANSPORT_STATUS_SUCCESS); 68677ba3d3fSMatthias Ringwald return; 68777ba3d3fSMatthias Ringwald } 68877ba3d3fSMatthias Ringwald 689f874399cSMatthias Ringwald // re-queue mssage 690b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 691764c8f0dSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged retry count %u\n", lower_transport_outgoing_message->retry_count); 692b66a7a84SMatthias Ringwald #endif 693764c8f0dSMatthias Ringwald lower_transport_outgoing_message->retry_count--; 694f874399cSMatthias Ringwald btstack_linked_list_add(&lower_transport_outgoing_ready, (btstack_linked_item_t *) lower_transport_outgoing_message); 695f874399cSMatthias Ringwald lower_transport_outgoing_message = NULL; 696f874399cSMatthias Ringwald mesh_lower_transport_run(); 697f874399cSMatthias Ringwald return; 69877ba3d3fSMatthias Ringwald } 69977ba3d3fSMatthias Ringwald 700eb3826d8SMatthias Ringwald // restart segment transmission timer for unicast dst 7013945bdb6SMatthias Ringwald if (mesh_network_address_unicast(lower_transport_outgoing_message->dst)){ 70227e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_restart_segment_transmission_timer(lower_transport_outgoing_message); 70377ba3d3fSMatthias Ringwald } 70477ba3d3fSMatthias Ringwald 70527e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_setup_segment(lower_transport_outgoing_message, lower_transport_outgoing_seg_o, 70677ba3d3fSMatthias Ringwald lower_transport_outgoing_segment); 70777ba3d3fSMatthias Ringwald 708b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 7093945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send seg_o %x, seg_n %x\n", lower_transport_outgoing_message, 7103945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, lower_transport_outgoing_seg_o, seg_n); 711b0d2aa0bSMatthias Ringwald mesh_print_hex("LowerTransportPDU", &lower_transport_outgoing_segment->data[9], lower_transport_outgoing_segment->len-9); 712b66a7a84SMatthias Ringwald #endif 71377ba3d3fSMatthias Ringwald 71477ba3d3fSMatthias Ringwald // next segment 71577ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 71677ba3d3fSMatthias Ringwald 71777ba3d3fSMatthias Ringwald // send network pdu 718e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = true; 71977ba3d3fSMatthias Ringwald mesh_network_send_pdu(lower_transport_outgoing_segment); 72077ba3d3fSMatthias Ringwald } 72177ba3d3fSMatthias Ringwald 7226d212510SMatthias Ringwald static void mesh_lower_transport_outgoing_setup_sending_segmented_pdus(mesh_segmented_pdu_t *segmented_pdu) { 723a4331339SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send retry count %u\n", segmented_pdu, segmented_pdu->seq, segmented_pdu->retry_count); 724a4331339SMatthias Ringwald 7256d212510SMatthias Ringwald segmented_pdu->retry_count--; 726b489fec0SMatthias Ringwald lower_transport_outgoing_seg_o = 0; 727a4331339SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 728a4331339SMatthias Ringwald lower_transport_outgoing_transmission_complete = false; 72912835760SMatthias Ringwald lower_transport_outgoing_transmission_aborted = false; 730a4331339SMatthias Ringwald 731a4331339SMatthias Ringwald lower_transport_outgoing_message = segmented_pdu; 732b489fec0SMatthias Ringwald } 733b489fec0SMatthias Ringwald 7346d212510SMatthias Ringwald static void mesh_lower_transport_outgoing_segment_transmission_fired(mesh_segmented_pdu_t *segmented_pdu) { 735b489fec0SMatthias Ringwald // once more? 7366d212510SMatthias Ringwald if (segmented_pdu->retry_count == 0){ 73769061c1cSMatthias Ringwald printf("[!] Lower transport, segmented pdu %p, seq %06x: send failed, retries exhausted\n", segmented_pdu, 73869061c1cSMatthias Ringwald segmented_pdu->seq); 73912835760SMatthias Ringwald mesh_lower_transport_outgoing_complete(segmented_pdu, MESH_TRANSPORT_STATUS_SEND_FAILED); 740b489fec0SMatthias Ringwald return; 741b489fec0SMatthias Ringwald } 742b489fec0SMatthias Ringwald 7431b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 744a4331339SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission fired\n", segmented_pdu, segmented_pdu->seq); 7451b639008SMatthias Ringwald #endif 7461b639008SMatthias Ringwald 747a4331339SMatthias Ringwald // re-queue message for sending remaining segments 74869061c1cSMatthias Ringwald if (lower_transport_outgoing_message == segmented_pdu){ 74969061c1cSMatthias Ringwald lower_transport_outgoing_message = NULL; 75069061c1cSMatthias Ringwald } else { 751a4331339SMatthias Ringwald btstack_linked_list_remove(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) segmented_pdu); 75269061c1cSMatthias Ringwald } 753a4331339SMatthias Ringwald btstack_linked_list_add_tail(&lower_transport_outgoing_ready, (btstack_linked_item_t *) segmented_pdu); 7546dac9d64SMatthias Ringwald 7556dac9d64SMatthias Ringwald // continue 7566dac9d64SMatthias Ringwald mesh_lower_transport_run(); 7571b639008SMatthias Ringwald } 758b489fec0SMatthias Ringwald 75927e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_segment_transmission_timeout(btstack_timer_source_t * ts){ 76027e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_run_loop_get_timer_context(ts); 76127e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 76227e8a9aaSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission timer fired\n", segmented_pdu, 76327e8a9aaSMatthias Ringwald segmented_pdu->seq); 76427e8a9aaSMatthias Ringwald #endif 765354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 76627e8a9aaSMatthias Ringwald 76769061c1cSMatthias Ringwald if ((segmented_pdu == lower_transport_outgoing_message) && lower_transport_outgoing_segment_at_network_layer){ 76827e8a9aaSMatthias Ringwald lower_transport_outgoing_transmission_timeout = true; 76927e8a9aaSMatthias Ringwald } else { 7706d212510SMatthias Ringwald mesh_lower_transport_outgoing_segment_transmission_fired(segmented_pdu); 77127e8a9aaSMatthias Ringwald } 77227e8a9aaSMatthias Ringwald } 77327e8a9aaSMatthias Ringwald 77427e8a9aaSMatthias Ringwald // GENERAL // 77527e8a9aaSMatthias Ringwald 77677ba3d3fSMatthias Ringwald static void mesh_lower_transport_network_pdu_sent(mesh_network_pdu_t *network_pdu){ 77777ba3d3fSMatthias Ringwald // figure out what pdu was sent 77877ba3d3fSMatthias Ringwald 779c0005391SMatthias Ringwald // Segment Acknowledgment message sent by us? 780c0005391SMatthias Ringwald if (network_pdu->pdu_header.pdu_type == MESH_PDU_TYPE_SEGMENT_ACKNOWLEDGMENT){ 781c0005391SMatthias Ringwald btstack_memory_mesh_network_pdu_free(network_pdu); 782c0005391SMatthias Ringwald return; 783c0005391SMatthias Ringwald } 784c0005391SMatthias Ringwald 7851e6c9225SMatthias Ringwald // single segment? 78677ba3d3fSMatthias Ringwald if (lower_transport_outgoing_segment == network_pdu){ 787a7f44e8dSMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 788b02ff6bdSMatthias Ringwald 7891e6c9225SMatthias Ringwald // of segmented message 790b02ff6bdSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 7913945bdb6SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: network pdu %p sent\n", lower_transport_outgoing_message, 7923945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, network_pdu); 793b02ff6bdSMatthias Ringwald #endif 794b02ff6bdSMatthias Ringwald 795e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 796764c8f0dSMatthias Ringwald if (lower_transport_outgoing_transmission_complete){ 79712835760SMatthias Ringwald // handle success 79879eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_complete = false; 79979eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 80012835760SMatthias Ringwald mesh_lower_transport_outgoing_complete(lower_transport_outgoing_message, MESH_TRANSPORT_STATUS_SUCCESS); 80112835760SMatthias Ringwald return; 80212835760SMatthias Ringwald } 80312835760SMatthias Ringwald if (lower_transport_outgoing_transmission_aborted){ 80412835760SMatthias Ringwald // handle abort 80512835760SMatthias Ringwald lower_transport_outgoing_transmission_complete = false; 80612835760SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 80712835760SMatthias Ringwald mesh_lower_transport_outgoing_complete(lower_transport_outgoing_message, MESH_TRANSPORT_STATUS_SEND_ABORT_BY_REMOTE); 8081b639008SMatthias Ringwald return; 8091b639008SMatthias Ringwald } 810b489fec0SMatthias Ringwald if (lower_transport_outgoing_transmission_timeout){ 811b489fec0SMatthias Ringwald // handle timeout 81279eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 8136d212510SMatthias Ringwald mesh_lower_transport_outgoing_segment_transmission_fired(lower_transport_outgoing_message); 8141b639008SMatthias Ringwald return; 815b489fec0SMatthias Ringwald } 816b02ff6bdSMatthias Ringwald 817b489fec0SMatthias Ringwald // send next segment 81827e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_send_next_segment(); 81977ba3d3fSMatthias Ringwald return; 82077ba3d3fSMatthias Ringwald } 82177ba3d3fSMatthias Ringwald 82277ba3d3fSMatthias Ringwald // other 82377ba3d3fSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SUCCESS, (mesh_pdu_t *) network_pdu); 82477ba3d3fSMatthias Ringwald } 82577ba3d3fSMatthias Ringwald 82627e8a9aaSMatthias Ringwald static void mesh_lower_transport_process_unsegmented_control_message(mesh_network_pdu_t *network_pdu){ 82727e8a9aaSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 82827e8a9aaSMatthias Ringwald uint8_t opcode = lower_transport_pdu[0]; 82927e8a9aaSMatthias Ringwald 83027e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 83127e8a9aaSMatthias Ringwald printf("Unsegmented Control message, outgoing message %p, opcode %x\n", lower_transport_outgoing_message, opcode); 83227e8a9aaSMatthias Ringwald #endif 83327e8a9aaSMatthias Ringwald 83427e8a9aaSMatthias Ringwald switch (opcode){ 83527e8a9aaSMatthias Ringwald case 0: 83627e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_process_segment_acknowledgement_message(network_pdu); 83727e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 83827e8a9aaSMatthias Ringwald break; 83927e8a9aaSMatthias Ringwald default: 84027e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 84127e8a9aaSMatthias Ringwald break; 84227e8a9aaSMatthias Ringwald } 84327e8a9aaSMatthias Ringwald } 84427e8a9aaSMatthias Ringwald 84527e8a9aaSMatthias Ringwald static void mesh_lower_transport_process_network_pdu(mesh_network_pdu_t *network_pdu) {// segmented? 84627e8a9aaSMatthias Ringwald if (mesh_network_segmented(network_pdu)){ 84727e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * message_pdu = mesh_lower_transport_incoming_pdu_for_segmented_message(network_pdu); 84827e8a9aaSMatthias Ringwald if (message_pdu) { 84927e8a9aaSMatthias Ringwald // start acknowledgment timer if inactive 850354884c7SMatthias Ringwald if ((message_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) == 0){ 85127e8a9aaSMatthias Ringwald // - "The acknowledgment timer shall be set to a minimum of 150 + 50 * TTL milliseconds" 85227e8a9aaSMatthias Ringwald uint32_t timeout = 150 + 50 * mesh_network_ttl(network_pdu); 85327e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_start_acknowledgment_timer(message_pdu, timeout); 85427e8a9aaSMatthias Ringwald } 85527e8a9aaSMatthias Ringwald // restart incomplete timer 85627e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_restart_incomplete_timer(message_pdu, 10000, 85727e8a9aaSMatthias Ringwald &mesh_lower_transport_incoming_incomplete_timeout); 85827e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_process_segment(message_pdu, network_pdu); 859166cce4dSMatthias Ringwald } else { 86027e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 86127e8a9aaSMatthias Ringwald } 86227e8a9aaSMatthias Ringwald } else { 86327e8a9aaSMatthias Ringwald // control? 86427e8a9aaSMatthias Ringwald if (mesh_network_control(network_pdu)){ 86527e8a9aaSMatthias Ringwald // unsegmented control message (not encrypted) 86627e8a9aaSMatthias Ringwald mesh_lower_transport_process_unsegmented_control_message(network_pdu); 86727e8a9aaSMatthias Ringwald } else { 86827e8a9aaSMatthias Ringwald // unsegmented access message (encrypted) 86927e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 87027e8a9aaSMatthias Ringwald } 87127e8a9aaSMatthias Ringwald } 87227e8a9aaSMatthias Ringwald } 87327e8a9aaSMatthias Ringwald 87427e8a9aaSMatthias Ringwald void mesh_lower_transport_received_message(mesh_network_callback_type_t callback_type, mesh_network_pdu_t *network_pdu){ 87527e8a9aaSMatthias Ringwald mesh_peer_t * peer; 87627e8a9aaSMatthias Ringwald uint16_t src; 87727e8a9aaSMatthias Ringwald uint16_t seq; 87827e8a9aaSMatthias Ringwald switch (callback_type){ 87927e8a9aaSMatthias Ringwald case MESH_NETWORK_PDU_RECEIVED: 88027e8a9aaSMatthias Ringwald src = mesh_network_src(network_pdu); 88127e8a9aaSMatthias Ringwald seq = mesh_network_seq(network_pdu); 88227e8a9aaSMatthias Ringwald peer = mesh_peer_for_addr(src); 88327e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 88427e8a9aaSMatthias Ringwald printf("Transport: received message. SRC %x, SEQ %x\n", src, seq); 88527e8a9aaSMatthias Ringwald #endif 88627e8a9aaSMatthias Ringwald // validate seq 88727e8a9aaSMatthias Ringwald if (peer && seq > peer->seq){ 88827e8a9aaSMatthias Ringwald // track seq 88927e8a9aaSMatthias Ringwald peer->seq = seq; 89027e8a9aaSMatthias Ringwald // process 89127e8a9aaSMatthias Ringwald mesh_lower_transport_process_network_pdu(network_pdu); 89227e8a9aaSMatthias Ringwald mesh_lower_transport_run(); 89327e8a9aaSMatthias Ringwald } else { 89427e8a9aaSMatthias Ringwald // drop packet 89527e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 89627e8a9aaSMatthias Ringwald printf("Transport: drop packet - src/seq auth failed\n"); 89727e8a9aaSMatthias Ringwald #endif 89827e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 89927e8a9aaSMatthias Ringwald } 90027e8a9aaSMatthias Ringwald break; 90127e8a9aaSMatthias Ringwald case MESH_NETWORK_PDU_SENT: 90227e8a9aaSMatthias Ringwald mesh_lower_transport_network_pdu_sent(network_pdu); 90327e8a9aaSMatthias Ringwald break; 90427e8a9aaSMatthias Ringwald default: 90527e8a9aaSMatthias Ringwald break; 906166cce4dSMatthias Ringwald } 907166cce4dSMatthias Ringwald } 908166cce4dSMatthias Ringwald 90977ba3d3fSMatthias Ringwald static void mesh_lower_transport_run(void){ 91077ba3d3fSMatthias Ringwald 91177ba3d3fSMatthias Ringwald // check if outgoing segmented pdu is active 9121e6c9225SMatthias Ringwald if (lower_transport_outgoing_message) return; 91377ba3d3fSMatthias Ringwald 91479eb95b0SMatthias Ringwald while(!btstack_linked_list_empty(&lower_transport_outgoing_ready)) { 91577ba3d3fSMatthias Ringwald // get next message 916a4bbc09dSMatthias Ringwald mesh_segmented_pdu_t * message_pdu; 91779eb95b0SMatthias Ringwald mesh_pdu_t * pdu = (mesh_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_ready); 91877ba3d3fSMatthias Ringwald switch (pdu->pdu_type) { 919e9c16304SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS: 920e9c16304SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL: 92169061c1cSMatthias Ringwald printf("[+] Lower transport, unsegmented pdu, sending now %p\n", pdu); 922e9c16304SMatthias Ringwald lower_transport_outgoing_network_pdu = (mesh_network_pdu_t *) pdu; 923e9c16304SMatthias Ringwald mesh_network_send_pdu(lower_transport_outgoing_network_pdu); 924b837963cSMatthias Ringwald break; 925a4bbc09dSMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 926a4bbc09dSMatthias Ringwald message_pdu = (mesh_segmented_pdu_t *) pdu; 927a7f44e8dSMatthias Ringwald // 9283945bdb6SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: run start sending now\n", message_pdu, 9293945bdb6SMatthias Ringwald message_pdu->seq); 93077ba3d3fSMatthias Ringwald // start sending segmented pdu 9316d212510SMatthias Ringwald mesh_lower_transport_outgoing_setup_sending_segmented_pdus(message_pdu); 93227e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_send_next_segment(); 9338fa6125aSMatthias Ringwald break; 93477ba3d3fSMatthias Ringwald default: 9358fa6125aSMatthias Ringwald btstack_assert(false); 93677ba3d3fSMatthias Ringwald break; 93777ba3d3fSMatthias Ringwald } 93877ba3d3fSMatthias Ringwald } 93977ba3d3fSMatthias Ringwald } 94077ba3d3fSMatthias Ringwald 941a4331339SMatthias Ringwald void mesh_lower_transport_send_pdu(mesh_pdu_t *pdu){ 942a4331339SMatthias Ringwald mesh_network_pdu_t * network_pdu; 943a4331339SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu; 944a4331339SMatthias Ringwald switch (pdu->pdu_type){ 945a4331339SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS: 946a4331339SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL: 947a4331339SMatthias Ringwald network_pdu = (mesh_network_pdu_t *) pdu; 948a4331339SMatthias Ringwald btstack_assert(network_pdu->len >= 9); 949a4331339SMatthias Ringwald break; 950a4331339SMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 951a4331339SMatthias Ringwald // set num retries, set of segments to send 952a4331339SMatthias Ringwald segmented_pdu = (mesh_segmented_pdu_t *) pdu; 953a4331339SMatthias Ringwald segmented_pdu->retry_count = 3; 954a4331339SMatthias Ringwald mesh_lower_transport_outgoing_setup_block_ack(segmented_pdu); 955a4331339SMatthias Ringwald break; 956a4331339SMatthias Ringwald default: 957a4331339SMatthias Ringwald btstack_assert(false); 958a4331339SMatthias Ringwald break; 959a4331339SMatthias Ringwald } 960a4331339SMatthias Ringwald btstack_linked_list_add_tail(&lower_transport_outgoing_ready, (btstack_linked_item_t*) pdu); 961a4331339SMatthias Ringwald mesh_lower_transport_run(); 962a4331339SMatthias Ringwald } 963a4331339SMatthias Ringwald 964*df71a9a4SMatthias Ringwald void mesh_lower_transport_dump_network_pdus(const char *name, btstack_linked_list_t *list){ 96577ba3d3fSMatthias Ringwald printf("List: %s:\n", name); 96677ba3d3fSMatthias Ringwald btstack_linked_list_iterator_t it; 96777ba3d3fSMatthias Ringwald btstack_linked_list_iterator_init(&it, list); 96877ba3d3fSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 96977ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t*) btstack_linked_list_iterator_next(&it); 97077ba3d3fSMatthias Ringwald printf("- %p: ", network_pdu); printf_hexdump(network_pdu->data, network_pdu->len); 97177ba3d3fSMatthias Ringwald } 97277ba3d3fSMatthias Ringwald } 973*df71a9a4SMatthias Ringwald 974*df71a9a4SMatthias Ringwald void mesh_lower_transport_reset_network_pdus(btstack_linked_list_t *list){ 97577ba3d3fSMatthias Ringwald while (!btstack_linked_list_empty(list)){ 97677ba3d3fSMatthias Ringwald mesh_network_pdu_t * pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(list); 97777ba3d3fSMatthias Ringwald btstack_memory_mesh_network_pdu_free(pdu); 97877ba3d3fSMatthias Ringwald } 97977ba3d3fSMatthias Ringwald } 98077ba3d3fSMatthias Ringwald 98133439c2eSMilanka Ringwald bool mesh_lower_transport_can_send_to_dest(uint16_t dest){ 98233439c2eSMilanka Ringwald UNUSED(dest); 983a4331339SMatthias Ringwald // check current 984a4331339SMatthias Ringwald uint16_t num_messages = 0; 985a4331339SMatthias Ringwald if (lower_transport_outgoing_message != NULL) { 986a4331339SMatthias Ringwald if (lower_transport_outgoing_message->dst == dest) { 987a4331339SMatthias Ringwald return false; 988a4331339SMatthias Ringwald } 989a4331339SMatthias Ringwald num_messages++; 990a4331339SMatthias Ringwald } 991a4331339SMatthias Ringwald // check waiting 992a4331339SMatthias Ringwald btstack_linked_list_iterator_t it; 993a4331339SMatthias Ringwald btstack_linked_list_iterator_init(&it, &lower_transport_outgoing_waiting); 994a4331339SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 995a4331339SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_linked_list_iterator_next(&it); 996a4331339SMatthias Ringwald num_messages++; 997cd15e003SMatthias Ringwald if (segmented_pdu->dst == dest){ 998cd15e003SMatthias Ringwald return false; 999a4331339SMatthias Ringwald } 1000cd15e003SMatthias Ringwald } 1001cd15e003SMatthias Ringwald #ifdef MAX_NR_MESH_OUTGOING_SEGMENTED_MESSAGES 1002cd15e003SMatthias Ringwald // limit number of parallel outgoing messages if configured 1003cd15e003SMatthias Ringwald if (num_messages >= MAX_NR_MESH_OUTGOING_SEGMENTED_MESSAGES) return false; 1004cd15e003SMatthias Ringwald #endif 1005a4331339SMatthias Ringwald return true; 1006cd16791dSMatthias Ringwald } 1007cd16791dSMatthias Ringwald 1008cd16791dSMatthias Ringwald void mesh_lower_transport_reserve_slot(void){ 1009cd16791dSMatthias Ringwald } 1010cd16791dSMatthias Ringwald 101177ba3d3fSMatthias Ringwald void mesh_lower_transport_reset(void){ 1012a7f44e8dSMatthias Ringwald if (lower_transport_outgoing_message){ 1013a7f44e8dSMatthias Ringwald while (!btstack_linked_list_empty(&lower_transport_outgoing_message->segments)){ 1014a7f44e8dSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_message->segments); 1015a7f44e8dSMatthias Ringwald mesh_network_pdu_free(network_pdu); 1016a7f44e8dSMatthias Ringwald } 1017a7f44e8dSMatthias Ringwald lower_transport_outgoing_message = NULL; 1018a7f44e8dSMatthias Ringwald } 101984e4acf2SMatthias Ringwald while (!btstack_linked_list_empty(&lower_transport_outgoing_waiting)){ 102084e4acf2SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_waiting); 102184e4acf2SMatthias Ringwald btstack_memory_mesh_segmented_pdu_free(segmented_pdu); 102284e4acf2SMatthias Ringwald } 10231e6cebb8SMatthias Ringwald mesh_network_pdu_free(lower_transport_outgoing_segment); 1024e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 10251e6cebb8SMatthias Ringwald lower_transport_outgoing_segment = NULL; 102677ba3d3fSMatthias Ringwald } 102777ba3d3fSMatthias Ringwald 102877ba3d3fSMatthias Ringwald void mesh_lower_transport_init(){ 102977ba3d3fSMatthias Ringwald // register with network layer 103077ba3d3fSMatthias Ringwald mesh_network_set_higher_layer_handler(&mesh_lower_transport_received_message); 103177ba3d3fSMatthias Ringwald // allocate network_pdu for segmentation 1032e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 103377ba3d3fSMatthias Ringwald lower_transport_outgoing_segment = mesh_network_pdu_get(); 103477ba3d3fSMatthias Ringwald } 103577ba3d3fSMatthias Ringwald 103677ba3d3fSMatthias 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)){ 103777ba3d3fSMatthias Ringwald higher_layer_handler = pdu_handler; 103877ba3d3fSMatthias Ringwald } 1039