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); 59*69061c1cSMatthias Ringwald static void mesh_lower_transport_outgoing_complete(mesh_segmented_pdu_t * segmented_pdu); 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; 8179eb95b0SMatthias Ringwald // transmission completed either fully ack'ed or remote aborted (while outgoing segment queued at network layer) 8279eb95b0SMatthias Ringwald static bool lower_transport_outgoing_transmission_complete; 8379eb95b0SMatthias Ringwald 8479eb95b0SMatthias Ringwald // active outgoing unsegmented message 8579eb95b0SMatthias Ringwald static mesh_network_pdu_t * lower_transport_outgoing_network_pdu; 8679eb95b0SMatthias Ringwald 8779eb95b0SMatthias Ringwald // deliver to higher layer 8877ba3d3fSMatthias Ringwald static void (*higher_layer_handler)( mesh_transport_callback_type_t callback_type, mesh_transport_status_t status, mesh_pdu_t * pdu); 8979eb95b0SMatthias Ringwald static mesh_pdu_t * mesh_lower_transport_higher_layer_pdu; 9079eb95b0SMatthias Ringwald static btstack_linked_list_t mesh_lower_transport_queued_for_higher_layer; 9177ba3d3fSMatthias Ringwald 9277ba3d3fSMatthias Ringwald static void mesh_print_hex(const char * name, const uint8_t * data, uint16_t len){ 9377ba3d3fSMatthias Ringwald printf("%-20s ", name); 9477ba3d3fSMatthias Ringwald printf_hexdump(data, len); 9577ba3d3fSMatthias Ringwald } 9677ba3d3fSMatthias Ringwald 9777ba3d3fSMatthias Ringwald // utility 9877ba3d3fSMatthias Ringwald 9979eb95b0SMatthias Ringwald mesh_segmented_pdu_t * mesh_segmented_pdu_get(void){ 100a4bbc09dSMatthias Ringwald mesh_segmented_pdu_t * message_pdu = btstack_memory_mesh_segmented_pdu_get(); 101926e8875SMatthias Ringwald if (message_pdu){ 102a4bbc09dSMatthias Ringwald message_pdu->pdu_header.pdu_type = MESH_PDU_TYPE_SEGMENTED; 103926e8875SMatthias Ringwald } 104926e8875SMatthias Ringwald return message_pdu; 105926e8875SMatthias Ringwald } 106926e8875SMatthias Ringwald 10779eb95b0SMatthias Ringwald void mesh_segmented_pdu_free(mesh_segmented_pdu_t * message_pdu){ 108cdcfd2c1SMatthias Ringwald while (message_pdu->segments){ 109cdcfd2c1SMatthias Ringwald mesh_network_pdu_t * segment = (mesh_network_pdu_t *) btstack_linked_list_pop(&message_pdu->segments); 110cdcfd2c1SMatthias Ringwald mesh_network_pdu_free(segment); 111cdcfd2c1SMatthias Ringwald } 112a4bbc09dSMatthias Ringwald btstack_memory_mesh_segmented_pdu_free(message_pdu); 113926e8875SMatthias Ringwald } 114926e8875SMatthias Ringwald 11527e8a9aaSMatthias Ringwald // INCOMING // 11627e8a9aaSMatthias Ringwald 11727e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_deliver_to_higher_layer(void){ 118fc5e2620SMatthias Ringwald if (mesh_lower_transport_higher_layer_pdu == NULL && !btstack_linked_list_empty(&mesh_lower_transport_queued_for_higher_layer)){ 1192ae11e2cSMatthias Ringwald mesh_pdu_t * pdu = (mesh_pdu_t *) btstack_linked_list_pop(&mesh_lower_transport_queued_for_higher_layer); 1202ae11e2cSMatthias Ringwald 1212ae11e2cSMatthias Ringwald switch (pdu->pdu_type){ 1225236fe42SMatthias Ringwald case MESH_PDU_TYPE_NETWORK: 1233d9c3b8eSMatthias Ringwald // unsegmented pdu 124e4121a34SMatthias Ringwald mesh_lower_transport_higher_layer_pdu = (mesh_pdu_t *) pdu; 125e4121a34SMatthias Ringwald pdu->pdu_type = MESH_PDU_TYPE_UNSEGMENTED; 1262ae11e2cSMatthias Ringwald break; 1275236fe42SMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 1282ae11e2cSMatthias Ringwald // segmented control or access pdu 1292ae11e2cSMatthias Ringwald mesh_lower_transport_higher_layer_pdu = pdu; 1302ae11e2cSMatthias Ringwald break; 1315236fe42SMatthias Ringwald default: 1325236fe42SMatthias Ringwald btstack_assert(false); 1335236fe42SMatthias Ringwald break; 1342ae11e2cSMatthias Ringwald } 135fc5e2620SMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_RECEIVED, MESH_TRANSPORT_STATUS_SUCCESS, mesh_lower_transport_higher_layer_pdu); 136fc5e2620SMatthias Ringwald } 137fc5e2620SMatthias Ringwald } 138fc5e2620SMatthias Ringwald 13927e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_queue_for_higher_layer(mesh_pdu_t * pdu){ 140fc5e2620SMatthias Ringwald btstack_linked_list_add_tail(&mesh_lower_transport_queued_for_higher_layer, (btstack_linked_item_t *) pdu); 14127e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_deliver_to_higher_layer(); 1429a0bb1c9SMatthias Ringwald } 14368d3bb6cSMatthias Ringwald 14427e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_setup_acknowledge_message(uint8_t * data, uint8_t obo, uint16_t seq_zero, uint32_t block_ack){ 14577ba3d3fSMatthias Ringwald // printf("ACK Upper Transport, seq_zero %x\n", seq_zero); 14677ba3d3fSMatthias Ringwald data[0] = 0; // SEG = 0, Opcode = 0 14777ba3d3fSMatthias Ringwald big_endian_store_16( data, 1, (obo << 15) | (seq_zero << 2) | 0); // OBO, SeqZero, RFU 14877ba3d3fSMatthias Ringwald big_endian_store_32( data, 3, block_ack); 149b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 15077ba3d3fSMatthias Ringwald mesh_print_hex("ACK Upper Transport", data, 7); 151b66a7a84SMatthias Ringwald #endif 15277ba3d3fSMatthias Ringwald } 15377ba3d3fSMatthias Ringwald 15427e8a9aaSMatthias 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){ 15577ba3d3fSMatthias Ringwald // setup ack message 15677ba3d3fSMatthias Ringwald uint8_t ack_msg[7]; 15727e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_setup_acknowledge_message(ack_msg, 0, seq_zero, block_ack); 15877ba3d3fSMatthias Ringwald // 15977ba3d3fSMatthias 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." 16077ba3d3fSMatthias Ringwald // if (ttl <= 1) return 0; 16177ba3d3fSMatthias Ringwald 16277ba3d3fSMatthias Ringwald // TODO: check transport_pdu_len depending on ctl 16377ba3d3fSMatthias Ringwald 16477ba3d3fSMatthias Ringwald // lookup network by netkey_index 16577ba3d3fSMatthias Ringwald const mesh_network_key_t * network_key = mesh_network_key_list_get(netkey_index); 16677ba3d3fSMatthias Ringwald if (!network_key) return; 16777ba3d3fSMatthias Ringwald 16877ba3d3fSMatthias Ringwald // allocate network_pdu 16977ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu = mesh_network_pdu_get(); 17077ba3d3fSMatthias Ringwald if (!network_pdu) return; 17177ba3d3fSMatthias Ringwald 17277ba3d3fSMatthias Ringwald // setup network_pdu 173c0005391SMatthias Ringwald network_pdu->pdu_header.pdu_type = MESH_PDU_TYPE_SEGMENT_ACKNOWLEDGMENT; 174001c65e0SMatthias 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)); 17577ba3d3fSMatthias Ringwald 17677ba3d3fSMatthias Ringwald // send network_pdu 17777ba3d3fSMatthias Ringwald mesh_network_send_pdu(network_pdu); 17877ba3d3fSMatthias Ringwald } 17977ba3d3fSMatthias Ringwald 18027e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_send_ack_for_segmented_pdu(mesh_segmented_pdu_t * segmented_pdu){ 181bd915455SMatthias Ringwald uint16_t seq_zero = segmented_pdu->seq & 0x1fff; 18227e8a9aaSMatthias Ringwald uint8_t ttl = segmented_pdu->ctl_ttl & 0x7f; 18327e8a9aaSMatthias Ringwald uint16_t dest = segmented_pdu->src; 18427e8a9aaSMatthias Ringwald uint16_t netkey_index = segmented_pdu->netkey_index; 185b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 18677ba3d3fSMatthias Ringwald printf("mesh_transport_send_ack_for_transport_pdu %p with netkey_index %x, TTL = %u, SeqZero = %x, SRC = %x, DST = %x\n", 18727e8a9aaSMatthias Ringwald segmented_pdu, netkey_index, ttl, seq_zero, mesh_node_get_primary_element_address(), dest); 188b66a7a84SMatthias Ringwald #endif 18927e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack(netkey_index, ttl, dest, seq_zero, segmented_pdu->block_ack); 19077ba3d3fSMatthias Ringwald } 19177ba3d3fSMatthias Ringwald 19227e8a9aaSMatthias 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) { 19377ba3d3fSMatthias Ringwald uint8_t ttl = mesh_network_ttl(network_pdu); 19477ba3d3fSMatthias Ringwald uint16_t dest = mesh_network_src(network_pdu); 19577ba3d3fSMatthias Ringwald uint16_t netkey_index = network_pdu->netkey_index; 196b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 19777ba3d3fSMatthias Ringwald printf("mesh_transport_send_ack_for_network_pdu %p with netkey_index %x, TTL = %u, SeqZero = %x, SRC = %x, DST = %x\n", 198001c65e0SMatthias Ringwald network_pdu, netkey_index, ttl, seq_zero, mesh_node_get_primary_element_address(), dest); 199b66a7a84SMatthias Ringwald #endif 20027e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack(netkey_index, ttl, dest, seq_zero, block_ack); 20177ba3d3fSMatthias Ringwald } 20277ba3d3fSMatthias Ringwald 20327e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_stop_acknowledgment_timer(mesh_segmented_pdu_t *segmented_pdu){ 204354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) == 0) return; 205354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 20627e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->acknowledgement_timer); 207926e8875SMatthias Ringwald } 208926e8875SMatthias Ringwald 20927e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_stop_incomplete_timer(mesh_segmented_pdu_t *segmented_pdu){ 210354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER) == 0) return; 211354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER; 21227e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->incomplete_timer); 213926e8875SMatthias Ringwald } 214926e8875SMatthias Ringwald 21527e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_segmented_message_complete(mesh_segmented_pdu_t * segmented_pdu){ 21677ba3d3fSMatthias Ringwald // stop timers 21727e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_stop_acknowledgment_timer(segmented_pdu); 21827e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_stop_incomplete_timer(segmented_pdu); 21977ba3d3fSMatthias Ringwald // stop reassembly 22027e8a9aaSMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(segmented_pdu->src); 22177ba3d3fSMatthias Ringwald if (peer){ 222926e8875SMatthias Ringwald peer->message_pdu = NULL; 223926e8875SMatthias Ringwald } 22477ba3d3fSMatthias Ringwald } 22577ba3d3fSMatthias Ringwald 22627e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_ack_timeout(btstack_timer_source_t *ts){ 22727e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_run_loop_get_timer_context(ts); 228b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 22927e8a9aaSMatthias Ringwald printf("ACK: acknowledgement timer fired for %p, send ACK\n", segmented_pdu); 230b66a7a84SMatthias Ringwald #endif 231354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 23227e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack_for_segmented_pdu(segmented_pdu); 23377ba3d3fSMatthias Ringwald } 23477ba3d3fSMatthias Ringwald 23527e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_incomplete_timeout(btstack_timer_source_t *ts){ 23627e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_run_loop_get_timer_context(ts); 237b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 23827e8a9aaSMatthias Ringwald printf("mesh_lower_transport_incoming_incomplete_timeout for %p - give up\n", segmented_pdu); 239b66a7a84SMatthias Ringwald #endif 24027e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_segmented_message_complete(segmented_pdu); 24177ba3d3fSMatthias Ringwald // free message 2426dac9d64SMatthias Ringwald mesh_segmented_pdu_free(segmented_pdu); 24377ba3d3fSMatthias Ringwald } 24477ba3d3fSMatthias Ringwald 24527e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_start_acknowledgment_timer(mesh_segmented_pdu_t * segmented_pdu, uint32_t timeout){ 246b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 24727e8a9aaSMatthias Ringwald printf("ACK: start rx ack timer for %p, timeout %u ms\n", segmented_pdu, (int) timeout); 248b66a7a84SMatthias Ringwald #endif 24927e8a9aaSMatthias Ringwald btstack_run_loop_set_timer(&segmented_pdu->acknowledgement_timer, timeout); 25027e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_handler(&segmented_pdu->acknowledgement_timer, &mesh_lower_transport_incoming_ack_timeout); 25127e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_context(&segmented_pdu->acknowledgement_timer, segmented_pdu); 25227e8a9aaSMatthias Ringwald btstack_run_loop_add_timer(&segmented_pdu->acknowledgement_timer); 253354884c7SMatthias Ringwald segmented_pdu->flags |= MESH_TRANSPORT_FLAG_ACK_TIMER; 25477ba3d3fSMatthias Ringwald } 25577ba3d3fSMatthias Ringwald 25627e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_restart_incomplete_timer(mesh_segmented_pdu_t * segmented_pdu, uint32_t timeout, 25777ba3d3fSMatthias Ringwald void (*callback)(btstack_timer_source_t *ts)){ 258b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 25927e8a9aaSMatthias Ringwald printf("RX-(re)start incomplete timer for %p, timeout %u ms\n", segmented_pdu, (int) timeout); 260b66a7a84SMatthias Ringwald #endif 261354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER) != 0){ 26227e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->incomplete_timer); 26377ba3d3fSMatthias Ringwald } 26427e8a9aaSMatthias Ringwald btstack_run_loop_set_timer(&segmented_pdu->incomplete_timer, timeout); 26527e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_handler(&segmented_pdu->incomplete_timer, callback); 26627e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_context(&segmented_pdu->incomplete_timer, segmented_pdu); 26727e8a9aaSMatthias Ringwald btstack_run_loop_add_timer(&segmented_pdu->incomplete_timer); 268354884c7SMatthias Ringwald segmented_pdu->flags |= MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER; 26977ba3d3fSMatthias Ringwald } 27077ba3d3fSMatthias Ringwald 27127e8a9aaSMatthias Ringwald static mesh_segmented_pdu_t * mesh_lower_transport_incoming_pdu_for_segmented_message(mesh_network_pdu_t *network_pdu){ 27277ba3d3fSMatthias Ringwald uint16_t src = mesh_network_src(network_pdu); 27377ba3d3fSMatthias Ringwald uint16_t seq_zero = ( big_endian_read_16(mesh_network_pdu_data(network_pdu), 1) >> 2) & 0x1fff; 274b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 27577ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: seq_zero %x\n", seq_zero); 276b66a7a84SMatthias Ringwald #endif 27777ba3d3fSMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(src); 27877ba3d3fSMatthias Ringwald if (!peer) { 27977ba3d3fSMatthias Ringwald return NULL; 28077ba3d3fSMatthias Ringwald } 281b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 28277ba3d3fSMatthias Ringwald printf("mesh_seq_zero_validate(%x, %x) -- last (%x, %x)\n", src, seq_zero, peer->address, peer->seq_zero); 283b66a7a84SMatthias Ringwald #endif 28477ba3d3fSMatthias Ringwald 28577ba3d3fSMatthias Ringwald // reception of transport message ongoing 286926e8875SMatthias Ringwald if (peer->message_pdu){ 28777ba3d3fSMatthias Ringwald // check if segment for same seq zero 288bd915455SMatthias Ringwald uint16_t active_seq_zero = peer->message_pdu->seq & 0x1fff; 28977ba3d3fSMatthias Ringwald if (active_seq_zero == seq_zero) { 290b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 29177ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: segment for current transport pdu with SeqZero %x\n", active_seq_zero); 292b66a7a84SMatthias Ringwald #endif 293926e8875SMatthias Ringwald return peer->message_pdu; 29477ba3d3fSMatthias Ringwald } else { 29577ba3d3fSMatthias Ringwald // seq zero differs from current transport pdu, but current pdu is not complete 296b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 29777ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: drop segment. current transport pdu SeqZero %x, now %x\n", active_seq_zero, seq_zero); 298b66a7a84SMatthias Ringwald #endif 29977ba3d3fSMatthias Ringwald return NULL; 30077ba3d3fSMatthias Ringwald } 30177ba3d3fSMatthias Ringwald } 30277ba3d3fSMatthias Ringwald 30377ba3d3fSMatthias Ringwald // send ACK if segment for previously completed transport pdu (no ongoing reception, block ack is cleared) 30477ba3d3fSMatthias Ringwald if ((seq_zero == peer->seq_zero) && (peer->block_ack != 0)){ 305b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 30677ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: segment for last completed message. send ack\n"); 307b66a7a84SMatthias Ringwald #endif 30827e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack_for_network_pdu(network_pdu, seq_zero, peer->block_ack); 30977ba3d3fSMatthias Ringwald return NULL; 31077ba3d3fSMatthias Ringwald } 31177ba3d3fSMatthias Ringwald 31277ba3d3fSMatthias Ringwald // reconstruct lowest 24 bit of SeqAuth 31377ba3d3fSMatthias Ringwald uint32_t seq = mesh_network_seq(network_pdu); 31477ba3d3fSMatthias Ringwald uint32_t seq_auth = (seq & 0xffe000) | seq_zero; 31577ba3d3fSMatthias Ringwald if (seq_auth > seq){ 31677ba3d3fSMatthias Ringwald seq_auth -= 0x2000; 31777ba3d3fSMatthias Ringwald } 31877ba3d3fSMatthias Ringwald 31977ba3d3fSMatthias Ringwald // no transport pdu active, check new message: seq auth is greater OR seq auth is same but no segments 32077ba3d3fSMatthias Ringwald if (seq_auth > peer->seq_auth || (seq_auth == peer->seq_auth && peer->block_ack == 0)){ 32179eb95b0SMatthias Ringwald mesh_segmented_pdu_t * pdu = mesh_segmented_pdu_get(); 32277ba3d3fSMatthias Ringwald if (!pdu) return NULL; 32377ba3d3fSMatthias Ringwald 32477ba3d3fSMatthias Ringwald // cache network pdu header 3257cb45abfSMatthias Ringwald pdu->ivi_nid = network_pdu->data[0]; 3267cb45abfSMatthias Ringwald pdu->ctl_ttl = network_pdu->data[1]; 3277cb45abfSMatthias Ringwald pdu->src = big_endian_read_16(network_pdu->data, 5); 3287cb45abfSMatthias Ringwald pdu->dst = big_endian_read_16(network_pdu->data, 7); 32977ba3d3fSMatthias Ringwald // store lower 24 bit of SeqAuth for App / Device Nonce 3307cb45abfSMatthias Ringwald pdu->seq = seq_auth; 33177ba3d3fSMatthias Ringwald 332e5828668SMatthias Ringwald // get akf_aid & transmic 333b30b4f6eSMatthias Ringwald pdu->akf_aid_control = network_pdu->data[9] & 0x7f; 334b30b4f6eSMatthias Ringwald if ((network_pdu->data[10] & 0x80) != 0){ 335b30b4f6eSMatthias Ringwald pdu->flags |= MESH_TRANSPORT_FLAG_TRANSMIC_64; 336b30b4f6eSMatthias Ringwald } 337e5828668SMatthias Ringwald 33877ba3d3fSMatthias Ringwald // store meta data in new pdu 33977ba3d3fSMatthias Ringwald pdu->netkey_index = network_pdu->netkey_index; 34077ba3d3fSMatthias Ringwald pdu->block_ack = 0; 341354884c7SMatthias Ringwald pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 34277ba3d3fSMatthias Ringwald 34377ba3d3fSMatthias Ringwald // update peer info 344926e8875SMatthias Ringwald peer->message_pdu = pdu; 34577ba3d3fSMatthias Ringwald peer->seq_zero = seq_zero; 34677ba3d3fSMatthias Ringwald peer->seq_auth = seq_auth; 34777ba3d3fSMatthias Ringwald peer->block_ack = 0; 34877ba3d3fSMatthias Ringwald 349b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 3503945bdb6SMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: setup transport pdu %p for src %x, seq %06x, seq_zero %x\n", pdu, src, 3513945bdb6SMatthias Ringwald pdu->seq, seq_zero); 352b66a7a84SMatthias Ringwald #endif 353926e8875SMatthias Ringwald return peer->message_pdu; 35477ba3d3fSMatthias Ringwald } else { 35577ba3d3fSMatthias Ringwald // seq zero differs from current transport pdu 356b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 35777ba3d3fSMatthias Ringwald printf("mesh_transport_pdu_for_segmented_message: drop segment for old seq %x\n", seq_zero); 358b66a7a84SMatthias Ringwald #endif 35977ba3d3fSMatthias Ringwald return NULL; 36077ba3d3fSMatthias Ringwald } 36177ba3d3fSMatthias Ringwald } 36277ba3d3fSMatthias Ringwald 36327e8a9aaSMatthias Ringwald static void mesh_lower_transport_incoming_process_segment(mesh_segmented_pdu_t * message_pdu, mesh_network_pdu_t * network_pdu){ 36477ba3d3fSMatthias Ringwald 36577ba3d3fSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 36677ba3d3fSMatthias Ringwald uint8_t lower_transport_pdu_len = mesh_network_pdu_len(network_pdu); 36777ba3d3fSMatthias Ringwald 36877ba3d3fSMatthias Ringwald // get seq_zero 36977ba3d3fSMatthias Ringwald uint16_t seq_zero = ( big_endian_read_16(lower_transport_pdu, 1) >> 2) & 0x1fff; 37077ba3d3fSMatthias Ringwald 37177ba3d3fSMatthias Ringwald // get seg fields 37277ba3d3fSMatthias Ringwald uint8_t seg_o = ( big_endian_read_16(lower_transport_pdu, 2) >> 5) & 0x001f; 37377ba3d3fSMatthias Ringwald uint8_t seg_n = lower_transport_pdu[3] & 0x1f; 37477ba3d3fSMatthias Ringwald uint8_t segment_len = lower_transport_pdu_len - 4; 37577ba3d3fSMatthias Ringwald uint8_t * segment_data = &lower_transport_pdu[4]; 37677ba3d3fSMatthias Ringwald 377b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 378b30b4f6eSMatthias Ringwald uint8_t transmic_len = ((message_pdu->flags & MESH_TRANSPORT_FLAG_TRANSMIC_64) != 0) ? 64 : 32; 379b30b4f6eSMatthias 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); 38077ba3d3fSMatthias Ringwald mesh_print_hex("Segment", segment_data, segment_len); 381b66a7a84SMatthias Ringwald #endif 38277ba3d3fSMatthias Ringwald 383926e8875SMatthias Ringwald // drop if already stored 384926e8875SMatthias Ringwald if ((message_pdu->block_ack & (1<<seg_o)) != 0){ 385926e8875SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 386926e8875SMatthias Ringwald return; 387926e8875SMatthias Ringwald } 388926e8875SMatthias Ringwald 38977ba3d3fSMatthias Ringwald // mark as received 390926e8875SMatthias Ringwald message_pdu->block_ack |= (1<<seg_o); 391926e8875SMatthias Ringwald 39216fd08f9SMatthias Ringwald // store segment 39316fd08f9SMatthias Ringwald uint8_t max_segment_len = mesh_network_control(network_pdu) ? 8 : 12; 39416fd08f9SMatthias Ringwald mesh_network_pdu_t * latest_segment = (mesh_network_pdu_t *) btstack_linked_list_get_first_item(&message_pdu->segments); 39516fd08f9SMatthias Ringwald if ((latest_segment != NULL) && ((MESH_NETWORK_PAYLOAD_MAX - latest_segment->len) > (max_segment_len + 1))){ 39616fd08f9SMatthias Ringwald // store in last added segment if there is enough space available 39716fd08f9SMatthias Ringwald latest_segment->data[latest_segment->len++] = seg_o; 39816fd08f9SMatthias Ringwald (void) memcpy(&latest_segment->data[latest_segment->len], &lower_transport_pdu[4], segment_len); 39916fd08f9SMatthias Ringwald latest_segment->len += segment_len; 40016fd08f9SMatthias Ringwald // free buffer 40116fd08f9SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 40216fd08f9SMatthias Ringwald } else { 40316fd08f9SMatthias Ringwald // move to beginning 40416fd08f9SMatthias Ringwald network_pdu->data[0] = seg_o; 40516fd08f9SMatthias Ringwald uint8_t i; 40616fd08f9SMatthias Ringwald for (i=0;i<segment_len;i++){ 40716fd08f9SMatthias Ringwald network_pdu->data[1+i] = network_pdu->data[13+i]; 40816fd08f9SMatthias Ringwald } 40916fd08f9SMatthias Ringwald network_pdu->len = 1 + segment_len; 41016fd08f9SMatthias Ringwald // add this buffer 411926e8875SMatthias Ringwald btstack_linked_list_add(&message_pdu->segments, (btstack_linked_item_t *) network_pdu); 41216fd08f9SMatthias Ringwald } 413926e8875SMatthias Ringwald 41477ba3d3fSMatthias Ringwald // last segment -> store len 41577ba3d3fSMatthias Ringwald if (seg_o == seg_n){ 4168a129166SMatthias Ringwald message_pdu->len = (seg_n * max_segment_len) + segment_len; 417b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 418926e8875SMatthias Ringwald printf("Assembled payload len %u\n", message_pdu->len); 419b66a7a84SMatthias Ringwald #endif 42077ba3d3fSMatthias Ringwald } 42177ba3d3fSMatthias Ringwald 42277ba3d3fSMatthias Ringwald // check for complete 42377ba3d3fSMatthias Ringwald int i; 42477ba3d3fSMatthias Ringwald for (i=0;i<=seg_n;i++){ 425926e8875SMatthias Ringwald if ( (message_pdu->block_ack & (1<<i)) == 0) return; 426926e8875SMatthias Ringwald } 427926e8875SMatthias Ringwald 42877ba3d3fSMatthias Ringwald // store block ack in peer info 4293945bdb6SMatthias Ringwald mesh_peer_t * peer = mesh_peer_for_addr(message_pdu->src); 43077ba3d3fSMatthias Ringwald // TODO: check if NULL check can be removed 43177ba3d3fSMatthias Ringwald if (peer){ 432926e8875SMatthias Ringwald peer->block_ack = message_pdu->block_ack; 43377ba3d3fSMatthias Ringwald } 43477ba3d3fSMatthias Ringwald 43577ba3d3fSMatthias Ringwald // send ack 43627e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_send_ack_for_segmented_pdu(message_pdu); 43777ba3d3fSMatthias Ringwald 43877ba3d3fSMatthias Ringwald // forward to upper transport 43927e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) message_pdu); 4402a974a69SMatthias Ringwald 4412a974a69SMatthias Ringwald // mark as done 44227e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_segmented_message_complete(message_pdu); 44358bb2379SMatthias Ringwald } 44458bb2379SMatthias Ringwald 44577ba3d3fSMatthias Ringwald void mesh_lower_transport_message_processed_by_higher_layer(mesh_pdu_t * pdu){ 446fc5e2620SMatthias Ringwald btstack_assert(pdu == mesh_lower_transport_higher_layer_pdu); 447fc5e2620SMatthias Ringwald mesh_lower_transport_higher_layer_pdu = NULL; 44884011563SMatthias Ringwald mesh_network_pdu_t * network_pdu; 44977ba3d3fSMatthias Ringwald switch (pdu->pdu_type){ 450a4bbc09dSMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 4518a504b30SMatthias Ringwald // free segments 45279eb95b0SMatthias Ringwald mesh_segmented_pdu_free((mesh_segmented_pdu_t *) pdu); 45335699c48SMatthias Ringwald break; 4548facb3eaSMatthias Ringwald case MESH_PDU_TYPE_UNSEGMENTED: 455e4121a34SMatthias Ringwald network_pdu = (mesh_network_pdu_t *) pdu; 45684011563SMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 4572ae11e2cSMatthias Ringwald break; 45877ba3d3fSMatthias Ringwald default: 4593d9c3b8eSMatthias Ringwald btstack_assert(0); 46077ba3d3fSMatthias Ringwald break; 46177ba3d3fSMatthias Ringwald } 46227e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_deliver_to_higher_layer(); 46377ba3d3fSMatthias Ringwald } 46477ba3d3fSMatthias Ringwald 46527e8a9aaSMatthias Ringwald // OUTGOING // 46627e8a9aaSMatthias Ringwald 46727e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_setup_block_ack(mesh_segmented_pdu_t *message_pdu){ 46827e8a9aaSMatthias Ringwald // setup block ack - set bit for segment to send, will be cleared on ack 46927e8a9aaSMatthias Ringwald int ctl = message_pdu->ctl_ttl >> 7; 47027e8a9aaSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 47127e8a9aaSMatthias Ringwald uint8_t seg_n = (message_pdu->len - 1) / max_segment_len; 47227e8a9aaSMatthias Ringwald if (seg_n < 31){ 47327e8a9aaSMatthias Ringwald message_pdu->block_ack = (1 << (seg_n+1)) - 1; 47477ba3d3fSMatthias Ringwald } else { 47527e8a9aaSMatthias Ringwald message_pdu->block_ack = 0xffffffff; 47677ba3d3fSMatthias Ringwald } 47777ba3d3fSMatthias Ringwald } 47877ba3d3fSMatthias Ringwald 479e3f8b4e7SMatthias Ringwald static mesh_segmented_pdu_t * mesh_lower_transport_outgoing_message_for_dst(uint16_t dst){ 480e3f8b4e7SMatthias Ringwald if (lower_transport_outgoing_message != NULL && lower_transport_outgoing_message->dst == dst){ 481e3f8b4e7SMatthias Ringwald return lower_transport_outgoing_message; 482e3f8b4e7SMatthias Ringwald } 483e3f8b4e7SMatthias Ringwald return NULL; 484e3f8b4e7SMatthias Ringwald } 485e3f8b4e7SMatthias Ringwald 48627e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_process_segment_acknowledgement_message(mesh_network_pdu_t *network_pdu){ 487e3f8b4e7SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = mesh_lower_transport_outgoing_message_for_dst( mesh_network_src(network_pdu)); 488e3f8b4e7SMatthias Ringwald if (segmented_pdu == NULL) return; 48927e8a9aaSMatthias Ringwald 49027e8a9aaSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 49127e8a9aaSMatthias Ringwald uint16_t seq_zero_pdu = big_endian_read_16(lower_transport_pdu, 1) >> 2; 49227e8a9aaSMatthias Ringwald uint16_t seq_zero_out = lower_transport_outgoing_message->seq & 0x1fff; 49327e8a9aaSMatthias Ringwald uint32_t block_ack = big_endian_read_32(lower_transport_pdu, 3); 49427e8a9aaSMatthias Ringwald 49527e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 49627e8a9aaSMatthias Ringwald printf("[+] Segment Acknowledgment message with seq_zero %06x, block_ack %08x - outgoing seq %06x, block_ack %08x\n", 497e3f8b4e7SMatthias Ringwald seq_zero_pdu, block_ack, seq_zero_out, segmented_pdu->block_ack); 49827e8a9aaSMatthias Ringwald #endif 49927e8a9aaSMatthias Ringwald 50027e8a9aaSMatthias Ringwald if (block_ack == 0){ 50127e8a9aaSMatthias Ringwald // If a Segment Acknowledgment message with the BlockAck field set to 0x00000000 is received, 50227e8a9aaSMatthias Ringwald // then the Upper Transport PDU shall be immediately cancelled and the higher layers shall be notified that 50327e8a9aaSMatthias Ringwald // the Upper Transport PDU has been cancelled. 50427e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 50527e8a9aaSMatthias Ringwald printf("[+] Block Ack == 0 => Abort\n"); 50627e8a9aaSMatthias Ringwald #endif 507e3f8b4e7SMatthias Ringwald // current? 508e3f8b4e7SMatthias Ringwald if ((lower_transport_outgoing_message == segmented_pdu) && lower_transport_outgoing_segment_at_network_layer){ 50927e8a9aaSMatthias Ringwald lower_transport_outgoing_transmission_complete = true; 51027e8a9aaSMatthias Ringwald } else { 511*69061c1cSMatthias Ringwald mesh_lower_transport_outgoing_complete(segmented_pdu); 51227e8a9aaSMatthias Ringwald } 51327e8a9aaSMatthias Ringwald return; 51427e8a9aaSMatthias Ringwald } 51527e8a9aaSMatthias Ringwald if (seq_zero_pdu != seq_zero_out){ 51627e8a9aaSMatthias Ringwald 51727e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 51827e8a9aaSMatthias Ringwald printf("[!] Seq Zero doesn't match\n"); 51927e8a9aaSMatthias Ringwald #endif 52027e8a9aaSMatthias Ringwald return; 52127e8a9aaSMatthias Ringwald } 52227e8a9aaSMatthias Ringwald 523e3f8b4e7SMatthias Ringwald segmented_pdu->block_ack &= ~block_ack; 52427e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 525e3f8b4e7SMatthias Ringwald printf("[+] Updated block_ack %08x\n", segmented_pdu->block_ack); 52627e8a9aaSMatthias Ringwald #endif 52727e8a9aaSMatthias Ringwald 528e3f8b4e7SMatthias Ringwald if (segmented_pdu->block_ack == 0){ 52927e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 53027e8a9aaSMatthias Ringwald printf("[+] Sent complete\n"); 53127e8a9aaSMatthias Ringwald #endif 53227e8a9aaSMatthias Ringwald 533e3f8b4e7SMatthias Ringwald if ((lower_transport_outgoing_message == segmented_pdu) && lower_transport_outgoing_segment_at_network_layer){ 53427e8a9aaSMatthias Ringwald lower_transport_outgoing_transmission_complete = true; 53527e8a9aaSMatthias Ringwald } else { 536*69061c1cSMatthias Ringwald mesh_lower_transport_outgoing_complete(segmented_pdu); 53727e8a9aaSMatthias Ringwald } 53827e8a9aaSMatthias Ringwald } 53927e8a9aaSMatthias Ringwald } 54027e8a9aaSMatthias Ringwald 54127e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_stop_acknowledgment_timer(mesh_segmented_pdu_t *segmented_pdu){ 542354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) == 0) return; 543354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 54427e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&segmented_pdu->acknowledgement_timer); 54527e8a9aaSMatthias Ringwald } 54627e8a9aaSMatthias Ringwald 54727e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_restart_segment_transmission_timer(mesh_segmented_pdu_t *segmented_pdu){ 54827e8a9aaSMatthias Ringwald // restart segment transmission timer for unicast dst 54927e8a9aaSMatthias Ringwald // - "This timer shall be set to a minimum of 200 + 50 * TTL milliseconds." 55027e8a9aaSMatthias Ringwald uint32_t timeout = 200 + 50 * (segmented_pdu->ctl_ttl & 0x7f); 551354884c7SMatthias Ringwald if ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) != 0){ 55227e8a9aaSMatthias Ringwald btstack_run_loop_remove_timer(&lower_transport_outgoing_message->acknowledgement_timer); 55327e8a9aaSMatthias Ringwald } 55427e8a9aaSMatthias Ringwald 55527e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 55627e8a9aaSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: setup transmission timeout %u ms\n", segmented_pdu, 55727e8a9aaSMatthias Ringwald segmented_pdu->seq, (int) timeout); 55827e8a9aaSMatthias Ringwald #endif 55927e8a9aaSMatthias Ringwald 56027e8a9aaSMatthias Ringwald btstack_run_loop_set_timer(&segmented_pdu->acknowledgement_timer, timeout); 56127e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_handler(&segmented_pdu->acknowledgement_timer, &mesh_lower_transport_outgoing_segment_transmission_timeout); 56227e8a9aaSMatthias Ringwald btstack_run_loop_set_timer_context(&segmented_pdu->acknowledgement_timer, lower_transport_outgoing_message); 56327e8a9aaSMatthias Ringwald btstack_run_loop_add_timer(&segmented_pdu->acknowledgement_timer); 564354884c7SMatthias Ringwald segmented_pdu->flags |= MESH_TRANSPORT_FLAG_ACK_TIMER; 56527e8a9aaSMatthias Ringwald } 56627e8a9aaSMatthias Ringwald 567*69061c1cSMatthias Ringwald static void mesh_lower_transport_outgoing_complete(mesh_segmented_pdu_t * segmented_pdu){ 568*69061c1cSMatthias Ringwald btstack_assert(segmented_pdu != NULL); 56927e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 570*69061c1cSMatthias Ringwald printf("[+] outgoing_complete %p, ack timer active %u, incomplete active %u\n", segmented_pdu, 571*69061c1cSMatthias Ringwald ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) != 0), ((segmented_pdu->flags & MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER) != 0)); 57227e8a9aaSMatthias Ringwald #endif 57327e8a9aaSMatthias Ringwald // stop timers 574*69061c1cSMatthias Ringwald mesh_lower_transport_outgoing_stop_acknowledgment_timer(segmented_pdu); 575*69061c1cSMatthias Ringwald 576*69061c1cSMatthias Ringwald // remove from lists 577*69061c1cSMatthias Ringwald if (lower_transport_outgoing_message == segmented_pdu){ 578*69061c1cSMatthias Ringwald lower_transport_outgoing_message = NULL; 579*69061c1cSMatthias Ringwald } else { 580*69061c1cSMatthias Ringwald btstack_linked_list_remove(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) segmented_pdu); 581*69061c1cSMatthias Ringwald btstack_linked_list_remove(&lower_transport_outgoing_ready, (btstack_linked_item_t *) segmented_pdu); 582*69061c1cSMatthias Ringwald } 58327e8a9aaSMatthias Ringwald 58427e8a9aaSMatthias Ringwald // notify upper transport 585*69061c1cSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SEND_ABORT_BY_REMOTE, (mesh_pdu_t *) segmented_pdu); 58627e8a9aaSMatthias Ringwald } 58727e8a9aaSMatthias Ringwald 58827e8a9aaSMatthias 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){ 58977ba3d3fSMatthias Ringwald 5903945bdb6SMatthias Ringwald int ctl = message_pdu->ctl_ttl >> 7; 59177ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 59277ba3d3fSMatthias Ringwald 593b16fda24SMatthias 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) 594b16fda24SMatthias Ringwald uint32_t seq; 595a7f44e8dSMatthias Ringwald if ((message_pdu->flags & MESH_TRANSPORT_FLAG_SEQ_RESERVED) != 0){ 596a7f44e8dSMatthias Ringwald message_pdu->flags &= ~(MESH_TRANSPORT_FLAG_SEQ_RESERVED); 5973945bdb6SMatthias Ringwald seq = message_pdu->seq; 598b16fda24SMatthias Ringwald } else { 599b16fda24SMatthias Ringwald seq = mesh_sequence_number_next(); 600b16fda24SMatthias Ringwald } 6013945bdb6SMatthias Ringwald uint16_t seq_zero = message_pdu->seq & 0x01fff; 602a7f44e8dSMatthias Ringwald uint8_t seg_n = (message_pdu->len - 1) / max_segment_len; 603b30b4f6eSMatthias Ringwald uint8_t szmic = ((message_pdu->flags & MESH_TRANSPORT_FLAG_TRANSMIC_64) != 0) ? 1 : 0; 6043945bdb6SMatthias Ringwald uint8_t nid = message_pdu->ivi_nid & 0x7f; 6053945bdb6SMatthias Ringwald uint8_t ttl = message_pdu->ctl_ttl & 0x7f; 6063945bdb6SMatthias Ringwald uint16_t src = message_pdu->src; 6073945bdb6SMatthias Ringwald uint16_t dest = message_pdu->dst; 60877ba3d3fSMatthias Ringwald 609b30b4f6eSMatthias Ringwald // only 1 for access messages with 64 bit TransMIC 610b30b4f6eSMatthias Ringwald btstack_assert((szmic == 0) || !ctl); 611b30b4f6eSMatthias Ringwald 61277ba3d3fSMatthias Ringwald // current segment. 61377ba3d3fSMatthias Ringwald uint16_t seg_offset = seg_o * max_segment_len; 61477ba3d3fSMatthias Ringwald 61577ba3d3fSMatthias Ringwald uint8_t lower_transport_pdu_data[16]; 616a7f44e8dSMatthias Ringwald lower_transport_pdu_data[0] = 0x80 | message_pdu->akf_aid_control; 61777ba3d3fSMatthias Ringwald big_endian_store_24(lower_transport_pdu_data, 1, (szmic << 23) | (seq_zero << 10) | (seg_o << 5) | seg_n); 618a7f44e8dSMatthias Ringwald uint16_t segment_len = btstack_min(message_pdu->len - seg_offset, max_segment_len); 619a7f44e8dSMatthias Ringwald 62077ba3d3fSMatthias Ringwald uint16_t lower_transport_pdu_len = 4 + segment_len; 62177ba3d3fSMatthias Ringwald 622a7f44e8dSMatthias Ringwald // find network-pdu with chunk for seg_offset 623a7f44e8dSMatthias Ringwald mesh_network_pdu_t * chunk = (mesh_network_pdu_t *) lower_transport_outgoing_message->segments; 624a7f44e8dSMatthias Ringwald uint16_t chunk_start = 0; 625a7f44e8dSMatthias Ringwald while ((chunk_start + MESH_NETWORK_PAYLOAD_MAX) <= seg_offset){ 626a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 627a7f44e8dSMatthias Ringwald chunk_start += MESH_NETWORK_PAYLOAD_MAX; 628a7f44e8dSMatthias Ringwald } 629a7f44e8dSMatthias Ringwald // first part 630a7f44e8dSMatthias Ringwald uint16_t chunk_offset = seg_offset - chunk_start; 631a7f44e8dSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(MESH_NETWORK_PAYLOAD_MAX - chunk_offset, segment_len); 632a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4], 633a7f44e8dSMatthias Ringwald &chunk->data[chunk_offset], bytes_to_copy); 634a7f44e8dSMatthias Ringwald segment_len -= bytes_to_copy; 635a7f44e8dSMatthias Ringwald // second part 636a7f44e8dSMatthias Ringwald if (segment_len > 0){ 637a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 638a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4+bytes_to_copy], 639a7f44e8dSMatthias Ringwald &chunk->data[0], segment_len); 640a7f44e8dSMatthias Ringwald } 641a7f44e8dSMatthias Ringwald 642a7f44e8dSMatthias 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); 64377ba3d3fSMatthias Ringwald } 64477ba3d3fSMatthias Ringwald 64527e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_send_next_segment(void){ 64679eb95b0SMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 64777ba3d3fSMatthias Ringwald 6481b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 6493945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send next segment\n", lower_transport_outgoing_message, 6503945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq); 6511b639008SMatthias Ringwald #endif 6521b639008SMatthias Ringwald 6533945bdb6SMatthias Ringwald int ctl = lower_transport_outgoing_message->ctl_ttl >> 7; 65477ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 655a7f44e8dSMatthias Ringwald uint8_t seg_n = (lower_transport_outgoing_message->len - 1) / max_segment_len; 65677ba3d3fSMatthias Ringwald 657764c8f0dSMatthias Ringwald // find next unacknowledged segment 658a7f44e8dSMatthias Ringwald while ((lower_transport_outgoing_seg_o <= seg_n) && ((lower_transport_outgoing_message->block_ack & (1 << lower_transport_outgoing_seg_o)) == 0)){ 65977ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 66077ba3d3fSMatthias Ringwald } 66177ba3d3fSMatthias Ringwald 66277ba3d3fSMatthias Ringwald if (lower_transport_outgoing_seg_o > seg_n){ 663b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 6643945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send complete (dst %x)\n", lower_transport_outgoing_message, 6653945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, 6663945bdb6SMatthias Ringwald lower_transport_outgoing_message->dst); 667b66a7a84SMatthias Ringwald #endif 66877ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o = 0; 66977ba3d3fSMatthias Ringwald 67077ba3d3fSMatthias Ringwald // done for unicast, ack timer already set, too 671b4977f35SMatthias Ringwald if (mesh_network_address_unicast(lower_transport_outgoing_message->dst)) { 672*69061c1cSMatthias Ringwald btstack_linked_list_add(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) lower_transport_outgoing_message); 673*69061c1cSMatthias Ringwald lower_transport_outgoing_message = NULL; 674b4977f35SMatthias Ringwald return; 675b4977f35SMatthias Ringwald } 67677ba3d3fSMatthias Ringwald 677b4977f35SMatthias Ringwald // done for group/virtual, no more retries? 678764c8f0dSMatthias Ringwald if (lower_transport_outgoing_message->retry_count == 0){ 679b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 68077ba3d3fSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged -> free\n"); 681b66a7a84SMatthias Ringwald #endif 682*69061c1cSMatthias Ringwald // notify upper transport 683*69061c1cSMatthias Ringwald mesh_lower_transport_outgoing_complete(lower_transport_outgoing_message); 68477ba3d3fSMatthias Ringwald return; 68577ba3d3fSMatthias Ringwald } 68677ba3d3fSMatthias Ringwald 687f874399cSMatthias Ringwald // re-queue mssage 688b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 689764c8f0dSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged retry count %u\n", lower_transport_outgoing_message->retry_count); 690b66a7a84SMatthias Ringwald #endif 691764c8f0dSMatthias Ringwald lower_transport_outgoing_message->retry_count--; 692f874399cSMatthias Ringwald btstack_linked_list_add(&lower_transport_outgoing_ready, (btstack_linked_item_t *) lower_transport_outgoing_message); 693f874399cSMatthias Ringwald lower_transport_outgoing_message = NULL; 694f874399cSMatthias Ringwald mesh_lower_transport_run(); 695f874399cSMatthias Ringwald return; 69677ba3d3fSMatthias Ringwald } 69777ba3d3fSMatthias Ringwald 698eb3826d8SMatthias Ringwald // restart segment transmission timer for unicast dst 6993945bdb6SMatthias Ringwald if (mesh_network_address_unicast(lower_transport_outgoing_message->dst)){ 70027e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_restart_segment_transmission_timer(lower_transport_outgoing_message); 70177ba3d3fSMatthias Ringwald } 70277ba3d3fSMatthias Ringwald 70327e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_setup_segment(lower_transport_outgoing_message, lower_transport_outgoing_seg_o, 70477ba3d3fSMatthias Ringwald lower_transport_outgoing_segment); 70577ba3d3fSMatthias Ringwald 706b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 7073945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send seg_o %x, seg_n %x\n", lower_transport_outgoing_message, 7083945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, lower_transport_outgoing_seg_o, seg_n); 709b0d2aa0bSMatthias Ringwald mesh_print_hex("LowerTransportPDU", &lower_transport_outgoing_segment->data[9], lower_transport_outgoing_segment->len-9); 710b66a7a84SMatthias Ringwald #endif 71177ba3d3fSMatthias Ringwald 71277ba3d3fSMatthias Ringwald // next segment 71377ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 71477ba3d3fSMatthias Ringwald 71577ba3d3fSMatthias Ringwald // send network pdu 716e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = true; 71777ba3d3fSMatthias Ringwald mesh_network_send_pdu(lower_transport_outgoing_segment); 71877ba3d3fSMatthias Ringwald } 71977ba3d3fSMatthias Ringwald 7206d212510SMatthias Ringwald static void mesh_lower_transport_outgoing_setup_sending_segmented_pdus(mesh_segmented_pdu_t *segmented_pdu) { 721a4331339SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send retry count %u\n", segmented_pdu, segmented_pdu->seq, segmented_pdu->retry_count); 722a4331339SMatthias Ringwald 7236d212510SMatthias Ringwald segmented_pdu->retry_count--; 724b489fec0SMatthias Ringwald lower_transport_outgoing_seg_o = 0; 725a4331339SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 726a4331339SMatthias Ringwald lower_transport_outgoing_transmission_complete = false; 727a4331339SMatthias Ringwald 728a4331339SMatthias Ringwald lower_transport_outgoing_message = segmented_pdu; 729b489fec0SMatthias Ringwald } 730b489fec0SMatthias Ringwald 7316d212510SMatthias Ringwald static void mesh_lower_transport_outgoing_segment_transmission_fired(mesh_segmented_pdu_t *segmented_pdu) { 732b489fec0SMatthias Ringwald // once more? 7336d212510SMatthias Ringwald if (segmented_pdu->retry_count == 0){ 734*69061c1cSMatthias Ringwald printf("[!] Lower transport, segmented pdu %p, seq %06x: send failed, retries exhausted\n", segmented_pdu, 735*69061c1cSMatthias Ringwald segmented_pdu->seq); 736*69061c1cSMatthias Ringwald mesh_lower_transport_outgoing_complete(segmented_pdu); 737b489fec0SMatthias Ringwald return; 738b489fec0SMatthias Ringwald } 739b489fec0SMatthias Ringwald 7401b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 741a4331339SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission fired\n", segmented_pdu, segmented_pdu->seq); 7421b639008SMatthias Ringwald #endif 7431b639008SMatthias Ringwald 744a4331339SMatthias Ringwald // re-queue message for sending remaining segments 745*69061c1cSMatthias Ringwald if (lower_transport_outgoing_message == segmented_pdu){ 746*69061c1cSMatthias Ringwald lower_transport_outgoing_message = NULL; 747*69061c1cSMatthias Ringwald } else { 748a4331339SMatthias Ringwald btstack_linked_list_remove(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) segmented_pdu); 749*69061c1cSMatthias Ringwald } 750a4331339SMatthias Ringwald btstack_linked_list_add_tail(&lower_transport_outgoing_ready, (btstack_linked_item_t *) segmented_pdu); 7516dac9d64SMatthias Ringwald 7526dac9d64SMatthias Ringwald // continue 7536dac9d64SMatthias Ringwald mesh_lower_transport_run(); 7541b639008SMatthias Ringwald } 755b489fec0SMatthias Ringwald 75627e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_segment_transmission_timeout(btstack_timer_source_t * ts){ 75727e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_run_loop_get_timer_context(ts); 75827e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 75927e8a9aaSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission timer fired\n", segmented_pdu, 76027e8a9aaSMatthias Ringwald segmented_pdu->seq); 76127e8a9aaSMatthias Ringwald #endif 762354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 76327e8a9aaSMatthias Ringwald 764*69061c1cSMatthias Ringwald if ((segmented_pdu == lower_transport_outgoing_message) && lower_transport_outgoing_segment_at_network_layer){ 76527e8a9aaSMatthias Ringwald lower_transport_outgoing_transmission_timeout = true; 76627e8a9aaSMatthias Ringwald } else { 7676d212510SMatthias Ringwald mesh_lower_transport_outgoing_segment_transmission_fired(segmented_pdu); 76827e8a9aaSMatthias Ringwald } 76927e8a9aaSMatthias Ringwald } 77027e8a9aaSMatthias Ringwald 77127e8a9aaSMatthias Ringwald // GENERAL // 77227e8a9aaSMatthias Ringwald 77377ba3d3fSMatthias Ringwald static void mesh_lower_transport_network_pdu_sent(mesh_network_pdu_t *network_pdu){ 77477ba3d3fSMatthias Ringwald // figure out what pdu was sent 77577ba3d3fSMatthias Ringwald 776c0005391SMatthias Ringwald // Segment Acknowledgment message sent by us? 777c0005391SMatthias Ringwald if (network_pdu->pdu_header.pdu_type == MESH_PDU_TYPE_SEGMENT_ACKNOWLEDGMENT){ 778c0005391SMatthias Ringwald btstack_memory_mesh_network_pdu_free(network_pdu); 779c0005391SMatthias Ringwald return; 780c0005391SMatthias Ringwald } 781c0005391SMatthias Ringwald 7821e6c9225SMatthias Ringwald // single segment? 78377ba3d3fSMatthias Ringwald if (lower_transport_outgoing_segment == network_pdu){ 784a7f44e8dSMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 785b02ff6bdSMatthias Ringwald 7861e6c9225SMatthias Ringwald // of segmented message 787b02ff6bdSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 7883945bdb6SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: network pdu %p sent\n", lower_transport_outgoing_message, 7893945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, network_pdu); 790b02ff6bdSMatthias Ringwald #endif 791b02ff6bdSMatthias Ringwald 792e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 793764c8f0dSMatthias Ringwald if (lower_transport_outgoing_transmission_complete){ 7941b639008SMatthias Ringwald // handle complete 79579eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_complete = false; 79679eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 797*69061c1cSMatthias Ringwald mesh_lower_transport_outgoing_complete(lower_transport_outgoing_message); 7981b639008SMatthias Ringwald return; 7991b639008SMatthias Ringwald } 800b489fec0SMatthias Ringwald if (lower_transport_outgoing_transmission_timeout){ 801b489fec0SMatthias Ringwald // handle timeout 80279eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 8036d212510SMatthias Ringwald mesh_lower_transport_outgoing_segment_transmission_fired(lower_transport_outgoing_message); 8041b639008SMatthias Ringwald return; 805b489fec0SMatthias Ringwald } 806b02ff6bdSMatthias Ringwald 807b489fec0SMatthias Ringwald // send next segment 80827e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_send_next_segment(); 80977ba3d3fSMatthias Ringwald return; 81077ba3d3fSMatthias Ringwald } 81177ba3d3fSMatthias Ringwald 81277ba3d3fSMatthias Ringwald // other 81377ba3d3fSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SUCCESS, (mesh_pdu_t *) network_pdu); 81477ba3d3fSMatthias Ringwald } 81577ba3d3fSMatthias Ringwald 81627e8a9aaSMatthias Ringwald static void mesh_lower_transport_process_unsegmented_control_message(mesh_network_pdu_t *network_pdu){ 81727e8a9aaSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 81827e8a9aaSMatthias Ringwald uint8_t opcode = lower_transport_pdu[0]; 81927e8a9aaSMatthias Ringwald 82027e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 82127e8a9aaSMatthias Ringwald printf("Unsegmented Control message, outgoing message %p, opcode %x\n", lower_transport_outgoing_message, opcode); 82227e8a9aaSMatthias Ringwald #endif 82327e8a9aaSMatthias Ringwald 82427e8a9aaSMatthias Ringwald switch (opcode){ 82527e8a9aaSMatthias Ringwald case 0: 82627e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_process_segment_acknowledgement_message(network_pdu); 82727e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 82827e8a9aaSMatthias Ringwald break; 82927e8a9aaSMatthias Ringwald default: 83027e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 83127e8a9aaSMatthias Ringwald break; 83227e8a9aaSMatthias Ringwald } 83327e8a9aaSMatthias Ringwald } 83427e8a9aaSMatthias Ringwald 83527e8a9aaSMatthias Ringwald static void mesh_lower_transport_process_network_pdu(mesh_network_pdu_t *network_pdu) {// segmented? 83627e8a9aaSMatthias Ringwald if (mesh_network_segmented(network_pdu)){ 83727e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * message_pdu = mesh_lower_transport_incoming_pdu_for_segmented_message(network_pdu); 83827e8a9aaSMatthias Ringwald if (message_pdu) { 83927e8a9aaSMatthias Ringwald // start acknowledgment timer if inactive 840354884c7SMatthias Ringwald if ((message_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) == 0){ 84127e8a9aaSMatthias Ringwald // - "The acknowledgment timer shall be set to a minimum of 150 + 50 * TTL milliseconds" 84227e8a9aaSMatthias Ringwald uint32_t timeout = 150 + 50 * mesh_network_ttl(network_pdu); 84327e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_start_acknowledgment_timer(message_pdu, timeout); 84427e8a9aaSMatthias Ringwald } 84527e8a9aaSMatthias Ringwald // restart incomplete timer 84627e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_restart_incomplete_timer(message_pdu, 10000, 84727e8a9aaSMatthias Ringwald &mesh_lower_transport_incoming_incomplete_timeout); 84827e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_process_segment(message_pdu, network_pdu); 849166cce4dSMatthias Ringwald } else { 85027e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 85127e8a9aaSMatthias Ringwald } 85227e8a9aaSMatthias Ringwald } else { 85327e8a9aaSMatthias Ringwald // control? 85427e8a9aaSMatthias Ringwald if (mesh_network_control(network_pdu)){ 85527e8a9aaSMatthias Ringwald // unsegmented control message (not encrypted) 85627e8a9aaSMatthias Ringwald mesh_lower_transport_process_unsegmented_control_message(network_pdu); 85727e8a9aaSMatthias Ringwald } else { 85827e8a9aaSMatthias Ringwald // unsegmented access message (encrypted) 85927e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 86027e8a9aaSMatthias Ringwald } 86127e8a9aaSMatthias Ringwald } 86227e8a9aaSMatthias Ringwald } 86327e8a9aaSMatthias Ringwald 86427e8a9aaSMatthias Ringwald void mesh_lower_transport_received_message(mesh_network_callback_type_t callback_type, mesh_network_pdu_t *network_pdu){ 86527e8a9aaSMatthias Ringwald mesh_peer_t * peer; 86627e8a9aaSMatthias Ringwald uint16_t src; 86727e8a9aaSMatthias Ringwald uint16_t seq; 86827e8a9aaSMatthias Ringwald switch (callback_type){ 86927e8a9aaSMatthias Ringwald case MESH_NETWORK_PDU_RECEIVED: 87027e8a9aaSMatthias Ringwald src = mesh_network_src(network_pdu); 87127e8a9aaSMatthias Ringwald seq = mesh_network_seq(network_pdu); 87227e8a9aaSMatthias Ringwald peer = mesh_peer_for_addr(src); 87327e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 87427e8a9aaSMatthias Ringwald printf("Transport: received message. SRC %x, SEQ %x\n", src, seq); 87527e8a9aaSMatthias Ringwald #endif 87627e8a9aaSMatthias Ringwald // validate seq 87727e8a9aaSMatthias Ringwald if (peer && seq > peer->seq){ 87827e8a9aaSMatthias Ringwald // track seq 87927e8a9aaSMatthias Ringwald peer->seq = seq; 88027e8a9aaSMatthias Ringwald // process 88127e8a9aaSMatthias Ringwald mesh_lower_transport_process_network_pdu(network_pdu); 88227e8a9aaSMatthias Ringwald mesh_lower_transport_run(); 88327e8a9aaSMatthias Ringwald } else { 88427e8a9aaSMatthias Ringwald // drop packet 88527e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 88627e8a9aaSMatthias Ringwald printf("Transport: drop packet - src/seq auth failed\n"); 88727e8a9aaSMatthias Ringwald #endif 88827e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 88927e8a9aaSMatthias Ringwald } 89027e8a9aaSMatthias Ringwald break; 89127e8a9aaSMatthias Ringwald case MESH_NETWORK_PDU_SENT: 89227e8a9aaSMatthias Ringwald mesh_lower_transport_network_pdu_sent(network_pdu); 89327e8a9aaSMatthias Ringwald break; 89427e8a9aaSMatthias Ringwald default: 89527e8a9aaSMatthias Ringwald break; 896166cce4dSMatthias Ringwald } 897166cce4dSMatthias Ringwald } 898166cce4dSMatthias Ringwald 89977ba3d3fSMatthias Ringwald static void mesh_lower_transport_run(void){ 90077ba3d3fSMatthias Ringwald 90177ba3d3fSMatthias Ringwald // check if outgoing segmented pdu is active 9021e6c9225SMatthias Ringwald if (lower_transport_outgoing_message) return; 90377ba3d3fSMatthias Ringwald 90479eb95b0SMatthias Ringwald while(!btstack_linked_list_empty(&lower_transport_outgoing_ready)) { 90577ba3d3fSMatthias Ringwald // get next message 90677ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu; 907a4bbc09dSMatthias Ringwald mesh_segmented_pdu_t * message_pdu; 90879eb95b0SMatthias Ringwald mesh_pdu_t * pdu = (mesh_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_ready); 90977ba3d3fSMatthias Ringwald switch (pdu->pdu_type) { 910e9c16304SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS: 911e9c16304SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL: 912*69061c1cSMatthias Ringwald printf("[+] Lower transport, unsegmented pdu, sending now %p\n", pdu); 913e9c16304SMatthias Ringwald lower_transport_outgoing_network_pdu = (mesh_network_pdu_t *) pdu; 914e9c16304SMatthias Ringwald mesh_network_send_pdu(lower_transport_outgoing_network_pdu); 915b837963cSMatthias Ringwald break; 916a4bbc09dSMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 917a4bbc09dSMatthias Ringwald message_pdu = (mesh_segmented_pdu_t *) pdu; 918a7f44e8dSMatthias Ringwald // 9193945bdb6SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: run start sending now\n", message_pdu, 9203945bdb6SMatthias Ringwald message_pdu->seq); 92177ba3d3fSMatthias Ringwald // start sending segmented pdu 9226d212510SMatthias Ringwald mesh_lower_transport_outgoing_setup_sending_segmented_pdus(message_pdu); 92327e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_send_next_segment(); 9248fa6125aSMatthias Ringwald break; 92577ba3d3fSMatthias Ringwald default: 9268fa6125aSMatthias Ringwald btstack_assert(false); 92777ba3d3fSMatthias Ringwald break; 92877ba3d3fSMatthias Ringwald } 92977ba3d3fSMatthias Ringwald } 93077ba3d3fSMatthias Ringwald } 93177ba3d3fSMatthias Ringwald 932a4331339SMatthias Ringwald void mesh_lower_transport_send_pdu(mesh_pdu_t *pdu){ 933a4331339SMatthias Ringwald mesh_network_pdu_t * network_pdu; 934a4331339SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu; 935a4331339SMatthias Ringwald switch (pdu->pdu_type){ 936a4331339SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS: 937a4331339SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL: 938a4331339SMatthias Ringwald network_pdu = (mesh_network_pdu_t *) pdu; 939a4331339SMatthias Ringwald btstack_assert(network_pdu->len >= 9); 940a4331339SMatthias Ringwald break; 941a4331339SMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 942a4331339SMatthias Ringwald // set num retries, set of segments to send 943a4331339SMatthias Ringwald segmented_pdu = (mesh_segmented_pdu_t *) pdu; 944a4331339SMatthias Ringwald segmented_pdu->retry_count = 3; 945a4331339SMatthias Ringwald mesh_lower_transport_outgoing_setup_block_ack(segmented_pdu); 946a4331339SMatthias Ringwald break; 947a4331339SMatthias Ringwald default: 948a4331339SMatthias Ringwald btstack_assert(false); 949a4331339SMatthias Ringwald break; 950a4331339SMatthias Ringwald } 951a4331339SMatthias Ringwald btstack_linked_list_add_tail(&lower_transport_outgoing_ready, (btstack_linked_item_t*) pdu); 952a4331339SMatthias Ringwald mesh_lower_transport_run(); 953a4331339SMatthias Ringwald } 954a4331339SMatthias Ringwald 95577ba3d3fSMatthias Ringwald static void mesh_lower_transport_dump_network_pdus(const char *name, btstack_linked_list_t *list){ 95677ba3d3fSMatthias Ringwald printf("List: %s:\n", name); 95777ba3d3fSMatthias Ringwald btstack_linked_list_iterator_t it; 95877ba3d3fSMatthias Ringwald btstack_linked_list_iterator_init(&it, list); 95977ba3d3fSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 96077ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t*) btstack_linked_list_iterator_next(&it); 96177ba3d3fSMatthias Ringwald printf("- %p: ", network_pdu); printf_hexdump(network_pdu->data, network_pdu->len); 96277ba3d3fSMatthias Ringwald } 96377ba3d3fSMatthias Ringwald } 96477ba3d3fSMatthias Ringwald static void mesh_lower_transport_reset_network_pdus(btstack_linked_list_t *list){ 96577ba3d3fSMatthias Ringwald while (!btstack_linked_list_empty(list)){ 96677ba3d3fSMatthias Ringwald mesh_network_pdu_t * pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(list); 96777ba3d3fSMatthias Ringwald btstack_memory_mesh_network_pdu_free(pdu); 96877ba3d3fSMatthias Ringwald } 96977ba3d3fSMatthias Ringwald } 97077ba3d3fSMatthias Ringwald 97133439c2eSMilanka Ringwald bool mesh_lower_transport_can_send_to_dest(uint16_t dest){ 97233439c2eSMilanka Ringwald UNUSED(dest); 973a4331339SMatthias Ringwald // check current 974a4331339SMatthias Ringwald uint16_t num_messages = 0; 975a4331339SMatthias Ringwald if (lower_transport_outgoing_message != NULL) { 976a4331339SMatthias Ringwald if (lower_transport_outgoing_message->dst == dest) { 977a4331339SMatthias Ringwald return false; 978a4331339SMatthias Ringwald } 979a4331339SMatthias Ringwald num_messages++; 980a4331339SMatthias Ringwald } 981a4331339SMatthias Ringwald // check waiting 982a4331339SMatthias Ringwald btstack_linked_list_iterator_t it; 983a4331339SMatthias Ringwald btstack_linked_list_iterator_init(&it, &lower_transport_outgoing_waiting); 984a4331339SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 985a4331339SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_linked_list_iterator_next(&it); 986a4331339SMatthias Ringwald num_messages++; 987cd15e003SMatthias Ringwald if (segmented_pdu->dst == dest){ 988cd15e003SMatthias Ringwald return false; 989a4331339SMatthias Ringwald } 990cd15e003SMatthias Ringwald } 991cd15e003SMatthias Ringwald #ifdef MAX_NR_MESH_OUTGOING_SEGMENTED_MESSAGES 992cd15e003SMatthias Ringwald // limit number of parallel outgoing messages if configured 993cd15e003SMatthias Ringwald if (num_messages >= MAX_NR_MESH_OUTGOING_SEGMENTED_MESSAGES) return false; 994cd15e003SMatthias Ringwald #endif 995a4331339SMatthias Ringwald return true; 996cd16791dSMatthias Ringwald } 997cd16791dSMatthias Ringwald 998cd16791dSMatthias Ringwald void mesh_lower_transport_reserve_slot(void){ 999cd16791dSMatthias Ringwald } 1000cd16791dSMatthias Ringwald 100177ba3d3fSMatthias Ringwald void mesh_lower_transport_dump(void){ 100277ba3d3fSMatthias Ringwald } 100377ba3d3fSMatthias Ringwald 100477ba3d3fSMatthias Ringwald void mesh_lower_transport_reset(void){ 1005a7f44e8dSMatthias Ringwald if (lower_transport_outgoing_message){ 1006a7f44e8dSMatthias Ringwald while (!btstack_linked_list_empty(&lower_transport_outgoing_message->segments)){ 1007a7f44e8dSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_message->segments); 1008a7f44e8dSMatthias Ringwald mesh_network_pdu_free(network_pdu); 1009a7f44e8dSMatthias Ringwald } 1010a7f44e8dSMatthias Ringwald lower_transport_outgoing_message = NULL; 1011a7f44e8dSMatthias Ringwald } 10121e6cebb8SMatthias Ringwald mesh_network_pdu_free(lower_transport_outgoing_segment); 1013e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 10141e6cebb8SMatthias Ringwald lower_transport_outgoing_segment = NULL; 101577ba3d3fSMatthias Ringwald } 101677ba3d3fSMatthias Ringwald 101777ba3d3fSMatthias Ringwald void mesh_lower_transport_init(){ 101877ba3d3fSMatthias Ringwald // register with network layer 101977ba3d3fSMatthias Ringwald mesh_network_set_higher_layer_handler(&mesh_lower_transport_received_message); 102077ba3d3fSMatthias Ringwald // allocate network_pdu for segmentation 1021e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 102277ba3d3fSMatthias Ringwald lower_transport_outgoing_segment = mesh_network_pdu_get(); 102377ba3d3fSMatthias Ringwald } 102477ba3d3fSMatthias Ringwald 102577ba3d3fSMatthias 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)){ 102677ba3d3fSMatthias Ringwald higher_layer_handler = pdu_handler; 102777ba3d3fSMatthias Ringwald } 1028