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); 5979eb95b0SMatthias Ringwald static void mesh_lower_transport_outgoing_complete(void); 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 242*6dac9d64SMatthias 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 { 51127e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_complete(); 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 { 53627e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_complete(); 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 56727e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_complete(void){ 56827e8a9aaSMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 56927e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 57027e8a9aaSMatthias Ringwald printf("mesh_lower_transport_outgoing_complete %p, ack timer active %u, incomplete active %u\n", lower_transport_outgoing_message, 571354884c7SMatthias Ringwald ((lower_transport_outgoing_message->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) != 0), ((lower_transport_outgoing_message->flags & MESH_TRANSPORT_FLAG_INCOMPLETE_TIMER) != 0)); 57227e8a9aaSMatthias Ringwald #endif 57327e8a9aaSMatthias Ringwald // stop timers 57427e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_stop_acknowledgment_timer(lower_transport_outgoing_message); 57527e8a9aaSMatthias Ringwald 57627e8a9aaSMatthias Ringwald // notify upper transport 57727e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * pdu = lower_transport_outgoing_message; 57827e8a9aaSMatthias Ringwald lower_transport_outgoing_message = NULL; 57927e8a9aaSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SEND_ABORT_BY_REMOTE, (mesh_pdu_t *) pdu); 58027e8a9aaSMatthias Ringwald } 58127e8a9aaSMatthias Ringwald 58227e8a9aaSMatthias 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){ 58377ba3d3fSMatthias Ringwald 5843945bdb6SMatthias Ringwald int ctl = message_pdu->ctl_ttl >> 7; 58577ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 58677ba3d3fSMatthias Ringwald 587b16fda24SMatthias 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) 588b16fda24SMatthias Ringwald uint32_t seq; 589a7f44e8dSMatthias Ringwald if ((message_pdu->flags & MESH_TRANSPORT_FLAG_SEQ_RESERVED) != 0){ 590a7f44e8dSMatthias Ringwald message_pdu->flags &= ~(MESH_TRANSPORT_FLAG_SEQ_RESERVED); 5913945bdb6SMatthias Ringwald seq = message_pdu->seq; 592b16fda24SMatthias Ringwald } else { 593b16fda24SMatthias Ringwald seq = mesh_sequence_number_next(); 594b16fda24SMatthias Ringwald } 5953945bdb6SMatthias Ringwald uint16_t seq_zero = message_pdu->seq & 0x01fff; 596a7f44e8dSMatthias Ringwald uint8_t seg_n = (message_pdu->len - 1) / max_segment_len; 597b30b4f6eSMatthias Ringwald uint8_t szmic = ((message_pdu->flags & MESH_TRANSPORT_FLAG_TRANSMIC_64) != 0) ? 1 : 0; 5983945bdb6SMatthias Ringwald uint8_t nid = message_pdu->ivi_nid & 0x7f; 5993945bdb6SMatthias Ringwald uint8_t ttl = message_pdu->ctl_ttl & 0x7f; 6003945bdb6SMatthias Ringwald uint16_t src = message_pdu->src; 6013945bdb6SMatthias Ringwald uint16_t dest = message_pdu->dst; 60277ba3d3fSMatthias Ringwald 603b30b4f6eSMatthias Ringwald // only 1 for access messages with 64 bit TransMIC 604b30b4f6eSMatthias Ringwald btstack_assert((szmic == 0) || !ctl); 605b30b4f6eSMatthias Ringwald 60677ba3d3fSMatthias Ringwald // current segment. 60777ba3d3fSMatthias Ringwald uint16_t seg_offset = seg_o * max_segment_len; 60877ba3d3fSMatthias Ringwald 60977ba3d3fSMatthias Ringwald uint8_t lower_transport_pdu_data[16]; 610a7f44e8dSMatthias Ringwald lower_transport_pdu_data[0] = 0x80 | message_pdu->akf_aid_control; 61177ba3d3fSMatthias Ringwald big_endian_store_24(lower_transport_pdu_data, 1, (szmic << 23) | (seq_zero << 10) | (seg_o << 5) | seg_n); 612a7f44e8dSMatthias Ringwald uint16_t segment_len = btstack_min(message_pdu->len - seg_offset, max_segment_len); 613a7f44e8dSMatthias Ringwald 61477ba3d3fSMatthias Ringwald uint16_t lower_transport_pdu_len = 4 + segment_len; 61577ba3d3fSMatthias Ringwald 616a7f44e8dSMatthias Ringwald // find network-pdu with chunk for seg_offset 617a7f44e8dSMatthias Ringwald mesh_network_pdu_t * chunk = (mesh_network_pdu_t *) lower_transport_outgoing_message->segments; 618a7f44e8dSMatthias Ringwald uint16_t chunk_start = 0; 619a7f44e8dSMatthias Ringwald while ((chunk_start + MESH_NETWORK_PAYLOAD_MAX) <= seg_offset){ 620a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 621a7f44e8dSMatthias Ringwald chunk_start += MESH_NETWORK_PAYLOAD_MAX; 622a7f44e8dSMatthias Ringwald } 623a7f44e8dSMatthias Ringwald // first part 624a7f44e8dSMatthias Ringwald uint16_t chunk_offset = seg_offset - chunk_start; 625a7f44e8dSMatthias Ringwald uint16_t bytes_to_copy = btstack_min(MESH_NETWORK_PAYLOAD_MAX - chunk_offset, segment_len); 626a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4], 627a7f44e8dSMatthias Ringwald &chunk->data[chunk_offset], bytes_to_copy); 628a7f44e8dSMatthias Ringwald segment_len -= bytes_to_copy; 629a7f44e8dSMatthias Ringwald // second part 630a7f44e8dSMatthias Ringwald if (segment_len > 0){ 631a7f44e8dSMatthias Ringwald chunk = (mesh_network_pdu_t *) chunk->pdu_header.item.next; 632a7f44e8dSMatthias Ringwald (void)memcpy(&lower_transport_pdu_data[4+bytes_to_copy], 633a7f44e8dSMatthias Ringwald &chunk->data[0], segment_len); 634a7f44e8dSMatthias Ringwald } 635a7f44e8dSMatthias Ringwald 636a7f44e8dSMatthias 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); 63777ba3d3fSMatthias Ringwald } 63877ba3d3fSMatthias Ringwald 63927e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_send_next_segment(void){ 64079eb95b0SMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 64177ba3d3fSMatthias Ringwald 6421b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 6433945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send next segment\n", lower_transport_outgoing_message, 6443945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq); 6451b639008SMatthias Ringwald #endif 6461b639008SMatthias Ringwald 6473945bdb6SMatthias Ringwald int ctl = lower_transport_outgoing_message->ctl_ttl >> 7; 64877ba3d3fSMatthias Ringwald uint16_t max_segment_len = ctl ? 8 : 12; // control 8 bytes (64 bit NetMic), access 12 bytes (32 bit NetMIC) 649a7f44e8dSMatthias Ringwald uint8_t seg_n = (lower_transport_outgoing_message->len - 1) / max_segment_len; 65077ba3d3fSMatthias Ringwald 651764c8f0dSMatthias Ringwald // find next unacknowledged segment 652a7f44e8dSMatthias Ringwald while ((lower_transport_outgoing_seg_o <= seg_n) && ((lower_transport_outgoing_message->block_ack & (1 << lower_transport_outgoing_seg_o)) == 0)){ 65377ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 65477ba3d3fSMatthias Ringwald } 65577ba3d3fSMatthias Ringwald 65677ba3d3fSMatthias Ringwald if (lower_transport_outgoing_seg_o > seg_n){ 657b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 6583945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send complete (dst %x)\n", lower_transport_outgoing_message, 6593945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, 6603945bdb6SMatthias Ringwald lower_transport_outgoing_message->dst); 661b66a7a84SMatthias Ringwald #endif 66277ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o = 0; 66377ba3d3fSMatthias Ringwald 66477ba3d3fSMatthias Ringwald // done for unicast, ack timer already set, too 665b4977f35SMatthias Ringwald if (mesh_network_address_unicast(lower_transport_outgoing_message->dst)) { 666b4977f35SMatthias Ringwald // btstack_linked_list_add(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) lower_transport_outgoing_message); 667b4977f35SMatthias Ringwald // lower_transport_outgoing_message = NULL; 668b4977f35SMatthias Ringwald return; 669b4977f35SMatthias Ringwald } 67077ba3d3fSMatthias Ringwald 671b4977f35SMatthias Ringwald // done for group/virtual, no more retries? 672764c8f0dSMatthias Ringwald if (lower_transport_outgoing_message->retry_count == 0){ 673b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 67477ba3d3fSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged -> free\n"); 675b66a7a84SMatthias Ringwald #endif 676b4977f35SMatthias Ringwald // notify upper transport, sets lower_transport_outgoing_message = NULL 67777ba3d3fSMatthias Ringwald mesh_lower_transport_outgoing_complete(); 67877ba3d3fSMatthias Ringwald return; 67977ba3d3fSMatthias Ringwald } 68077ba3d3fSMatthias Ringwald 681f874399cSMatthias Ringwald // re-queue mssage 682b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 683764c8f0dSMatthias Ringwald printf("[+] Lower Transport, message unacknowledged retry count %u\n", lower_transport_outgoing_message->retry_count); 684b66a7a84SMatthias Ringwald #endif 685764c8f0dSMatthias Ringwald lower_transport_outgoing_message->retry_count--; 686f874399cSMatthias Ringwald btstack_linked_list_add(&lower_transport_outgoing_ready, (btstack_linked_item_t *) lower_transport_outgoing_message); 687f874399cSMatthias Ringwald lower_transport_outgoing_message = NULL; 688f874399cSMatthias Ringwald mesh_lower_transport_run(); 689f874399cSMatthias Ringwald return; 69077ba3d3fSMatthias Ringwald } 69177ba3d3fSMatthias Ringwald 692eb3826d8SMatthias Ringwald // restart segment transmission timer for unicast dst 6933945bdb6SMatthias Ringwald if (mesh_network_address_unicast(lower_transport_outgoing_message->dst)){ 69427e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_restart_segment_transmission_timer(lower_transport_outgoing_message); 69577ba3d3fSMatthias Ringwald } 69677ba3d3fSMatthias Ringwald 69727e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_setup_segment(lower_transport_outgoing_message, lower_transport_outgoing_seg_o, 69877ba3d3fSMatthias Ringwald lower_transport_outgoing_segment); 69977ba3d3fSMatthias Ringwald 700b66a7a84SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 7013945bdb6SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send seg_o %x, seg_n %x\n", lower_transport_outgoing_message, 7023945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, lower_transport_outgoing_seg_o, seg_n); 703b0d2aa0bSMatthias Ringwald mesh_print_hex("LowerTransportPDU", &lower_transport_outgoing_segment->data[9], lower_transport_outgoing_segment->len-9); 704b66a7a84SMatthias Ringwald #endif 70577ba3d3fSMatthias Ringwald 70677ba3d3fSMatthias Ringwald // next segment 70777ba3d3fSMatthias Ringwald lower_transport_outgoing_seg_o++; 70877ba3d3fSMatthias Ringwald 70977ba3d3fSMatthias Ringwald // send network pdu 710e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = true; 71177ba3d3fSMatthias Ringwald mesh_network_send_pdu(lower_transport_outgoing_segment); 71277ba3d3fSMatthias Ringwald } 71377ba3d3fSMatthias Ringwald 7146d212510SMatthias Ringwald static void mesh_lower_transport_outgoing_setup_sending_segmented_pdus(mesh_segmented_pdu_t *segmented_pdu) { 715a4331339SMatthias Ringwald printf("[+] Lower Transport, segmented pdu %p, seq %06x: send retry count %u\n", segmented_pdu, segmented_pdu->seq, segmented_pdu->retry_count); 716a4331339SMatthias Ringwald 7176d212510SMatthias Ringwald segmented_pdu->retry_count--; 718b489fec0SMatthias Ringwald lower_transport_outgoing_seg_o = 0; 719a4331339SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 720a4331339SMatthias Ringwald lower_transport_outgoing_transmission_complete = false; 721a4331339SMatthias Ringwald 722a4331339SMatthias Ringwald lower_transport_outgoing_message = segmented_pdu; 723b489fec0SMatthias Ringwald } 724b489fec0SMatthias Ringwald 7256d212510SMatthias Ringwald static void mesh_lower_transport_outgoing_segment_transmission_fired(mesh_segmented_pdu_t *segmented_pdu) { 726b489fec0SMatthias Ringwald // once more? 7276d212510SMatthias Ringwald if (segmented_pdu->retry_count == 0){ 7283945bdb6SMatthias Ringwald printf("[!] Lower transport, segmented pdu %p, seq %06x: send failed, retries exhausted\n", lower_transport_outgoing_message, 7293945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq); 730b489fec0SMatthias Ringwald mesh_lower_transport_outgoing_complete(); 731b489fec0SMatthias Ringwald return; 732b489fec0SMatthias Ringwald } 733b489fec0SMatthias Ringwald 7341b639008SMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 735a4331339SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission fired\n", segmented_pdu, segmented_pdu->seq); 7361b639008SMatthias Ringwald #endif 7371b639008SMatthias Ringwald 738a4331339SMatthias Ringwald // re-queue message for sending remaining segments 739a4331339SMatthias Ringwald btstack_linked_list_remove(&lower_transport_outgoing_waiting, (btstack_linked_item_t *) segmented_pdu); 740a4331339SMatthias Ringwald btstack_linked_list_add_tail(&lower_transport_outgoing_ready, (btstack_linked_item_t *) segmented_pdu); 741*6dac9d64SMatthias Ringwald 742*6dac9d64SMatthias Ringwald // continue 743*6dac9d64SMatthias Ringwald mesh_lower_transport_run(); 7441b639008SMatthias Ringwald } 745b489fec0SMatthias Ringwald 74627e8a9aaSMatthias Ringwald static void mesh_lower_transport_outgoing_segment_transmission_timeout(btstack_timer_source_t * ts){ 74727e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_run_loop_get_timer_context(ts); 74827e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 74927e8a9aaSMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: transmission timer fired\n", segmented_pdu, 75027e8a9aaSMatthias Ringwald segmented_pdu->seq); 75127e8a9aaSMatthias Ringwald #endif 752354884c7SMatthias Ringwald segmented_pdu->flags &= ~MESH_TRANSPORT_FLAG_ACK_TIMER; 75327e8a9aaSMatthias Ringwald 754e3f8b4e7SMatthias Ringwald if (lower_transport_outgoing_segment_at_network_layer){ 75527e8a9aaSMatthias Ringwald lower_transport_outgoing_transmission_timeout = true; 75627e8a9aaSMatthias Ringwald } else { 7576d212510SMatthias Ringwald mesh_lower_transport_outgoing_segment_transmission_fired(segmented_pdu); 75827e8a9aaSMatthias Ringwald } 75927e8a9aaSMatthias Ringwald } 76027e8a9aaSMatthias Ringwald 76127e8a9aaSMatthias Ringwald // GENERAL // 76227e8a9aaSMatthias Ringwald 76377ba3d3fSMatthias Ringwald static void mesh_lower_transport_network_pdu_sent(mesh_network_pdu_t *network_pdu){ 76477ba3d3fSMatthias Ringwald // figure out what pdu was sent 76577ba3d3fSMatthias Ringwald 766c0005391SMatthias Ringwald // Segment Acknowledgment message sent by us? 767c0005391SMatthias Ringwald if (network_pdu->pdu_header.pdu_type == MESH_PDU_TYPE_SEGMENT_ACKNOWLEDGMENT){ 768c0005391SMatthias Ringwald btstack_memory_mesh_network_pdu_free(network_pdu); 769c0005391SMatthias Ringwald return; 770c0005391SMatthias Ringwald } 771c0005391SMatthias Ringwald 7721e6c9225SMatthias Ringwald // single segment? 77377ba3d3fSMatthias Ringwald if (lower_transport_outgoing_segment == network_pdu){ 774a7f44e8dSMatthias Ringwald btstack_assert(lower_transport_outgoing_message != NULL); 775b02ff6bdSMatthias Ringwald 7761e6c9225SMatthias Ringwald // of segmented message 777b02ff6bdSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 7783945bdb6SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: network pdu %p sent\n", lower_transport_outgoing_message, 7793945bdb6SMatthias Ringwald lower_transport_outgoing_message->seq, network_pdu); 780b02ff6bdSMatthias Ringwald #endif 781b02ff6bdSMatthias Ringwald 782e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 783764c8f0dSMatthias Ringwald if (lower_transport_outgoing_transmission_complete){ 7841b639008SMatthias Ringwald // handle complete 78579eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_complete = false; 78679eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 7871b639008SMatthias Ringwald mesh_lower_transport_outgoing_complete(); 7881b639008SMatthias Ringwald return; 7891b639008SMatthias Ringwald } 790b489fec0SMatthias Ringwald if (lower_transport_outgoing_transmission_timeout){ 791b489fec0SMatthias Ringwald // handle timeout 79279eb95b0SMatthias Ringwald lower_transport_outgoing_transmission_timeout = false; 7936d212510SMatthias Ringwald mesh_lower_transport_outgoing_segment_transmission_fired(lower_transport_outgoing_message); 7941b639008SMatthias Ringwald return; 795b489fec0SMatthias Ringwald } 796b02ff6bdSMatthias Ringwald 797b489fec0SMatthias Ringwald // send next segment 79827e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_send_next_segment(); 79977ba3d3fSMatthias Ringwald return; 80077ba3d3fSMatthias Ringwald } 80177ba3d3fSMatthias Ringwald 80277ba3d3fSMatthias Ringwald // other 80377ba3d3fSMatthias Ringwald higher_layer_handler(MESH_TRANSPORT_PDU_SENT, MESH_TRANSPORT_STATUS_SUCCESS, (mesh_pdu_t *) network_pdu); 80477ba3d3fSMatthias Ringwald } 80577ba3d3fSMatthias Ringwald 80627e8a9aaSMatthias Ringwald static void mesh_lower_transport_process_unsegmented_control_message(mesh_network_pdu_t *network_pdu){ 80727e8a9aaSMatthias Ringwald uint8_t * lower_transport_pdu = mesh_network_pdu_data(network_pdu); 80827e8a9aaSMatthias Ringwald uint8_t opcode = lower_transport_pdu[0]; 80927e8a9aaSMatthias Ringwald 81027e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 81127e8a9aaSMatthias Ringwald printf("Unsegmented Control message, outgoing message %p, opcode %x\n", lower_transport_outgoing_message, opcode); 81227e8a9aaSMatthias Ringwald #endif 81327e8a9aaSMatthias Ringwald 81427e8a9aaSMatthias Ringwald switch (opcode){ 81527e8a9aaSMatthias Ringwald case 0: 81627e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_process_segment_acknowledgement_message(network_pdu); 81727e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 81827e8a9aaSMatthias Ringwald break; 81927e8a9aaSMatthias Ringwald default: 82027e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 82127e8a9aaSMatthias Ringwald break; 82227e8a9aaSMatthias Ringwald } 82327e8a9aaSMatthias Ringwald } 82427e8a9aaSMatthias Ringwald 82527e8a9aaSMatthias Ringwald static void mesh_lower_transport_process_network_pdu(mesh_network_pdu_t *network_pdu) {// segmented? 82627e8a9aaSMatthias Ringwald if (mesh_network_segmented(network_pdu)){ 82727e8a9aaSMatthias Ringwald mesh_segmented_pdu_t * message_pdu = mesh_lower_transport_incoming_pdu_for_segmented_message(network_pdu); 82827e8a9aaSMatthias Ringwald if (message_pdu) { 82927e8a9aaSMatthias Ringwald // start acknowledgment timer if inactive 830354884c7SMatthias Ringwald if ((message_pdu->flags & MESH_TRANSPORT_FLAG_ACK_TIMER) == 0){ 83127e8a9aaSMatthias Ringwald // - "The acknowledgment timer shall be set to a minimum of 150 + 50 * TTL milliseconds" 83227e8a9aaSMatthias Ringwald uint32_t timeout = 150 + 50 * mesh_network_ttl(network_pdu); 83327e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_start_acknowledgment_timer(message_pdu, timeout); 83427e8a9aaSMatthias Ringwald } 83527e8a9aaSMatthias Ringwald // restart incomplete timer 83627e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_restart_incomplete_timer(message_pdu, 10000, 83727e8a9aaSMatthias Ringwald &mesh_lower_transport_incoming_incomplete_timeout); 83827e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_process_segment(message_pdu, network_pdu); 839166cce4dSMatthias Ringwald } else { 84027e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 84127e8a9aaSMatthias Ringwald } 84227e8a9aaSMatthias Ringwald } else { 84327e8a9aaSMatthias Ringwald // control? 84427e8a9aaSMatthias Ringwald if (mesh_network_control(network_pdu)){ 84527e8a9aaSMatthias Ringwald // unsegmented control message (not encrypted) 84627e8a9aaSMatthias Ringwald mesh_lower_transport_process_unsegmented_control_message(network_pdu); 84727e8a9aaSMatthias Ringwald } else { 84827e8a9aaSMatthias Ringwald // unsegmented access message (encrypted) 84927e8a9aaSMatthias Ringwald mesh_lower_transport_incoming_queue_for_higher_layer((mesh_pdu_t *) network_pdu); 85027e8a9aaSMatthias Ringwald } 85127e8a9aaSMatthias Ringwald } 85227e8a9aaSMatthias Ringwald } 85327e8a9aaSMatthias Ringwald 85427e8a9aaSMatthias Ringwald void mesh_lower_transport_received_message(mesh_network_callback_type_t callback_type, mesh_network_pdu_t *network_pdu){ 85527e8a9aaSMatthias Ringwald mesh_peer_t * peer; 85627e8a9aaSMatthias Ringwald uint16_t src; 85727e8a9aaSMatthias Ringwald uint16_t seq; 85827e8a9aaSMatthias Ringwald switch (callback_type){ 85927e8a9aaSMatthias Ringwald case MESH_NETWORK_PDU_RECEIVED: 86027e8a9aaSMatthias Ringwald src = mesh_network_src(network_pdu); 86127e8a9aaSMatthias Ringwald seq = mesh_network_seq(network_pdu); 86227e8a9aaSMatthias Ringwald peer = mesh_peer_for_addr(src); 86327e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 86427e8a9aaSMatthias Ringwald printf("Transport: received message. SRC %x, SEQ %x\n", src, seq); 86527e8a9aaSMatthias Ringwald #endif 86627e8a9aaSMatthias Ringwald // validate seq 86727e8a9aaSMatthias Ringwald if (peer && seq > peer->seq){ 86827e8a9aaSMatthias Ringwald // track seq 86927e8a9aaSMatthias Ringwald peer->seq = seq; 87027e8a9aaSMatthias Ringwald // process 87127e8a9aaSMatthias Ringwald mesh_lower_transport_process_network_pdu(network_pdu); 87227e8a9aaSMatthias Ringwald mesh_lower_transport_run(); 87327e8a9aaSMatthias Ringwald } else { 87427e8a9aaSMatthias Ringwald // drop packet 87527e8a9aaSMatthias Ringwald #ifdef LOG_LOWER_TRANSPORT 87627e8a9aaSMatthias Ringwald printf("Transport: drop packet - src/seq auth failed\n"); 87727e8a9aaSMatthias Ringwald #endif 87827e8a9aaSMatthias Ringwald mesh_network_message_processed_by_higher_layer(network_pdu); 87927e8a9aaSMatthias Ringwald } 88027e8a9aaSMatthias Ringwald break; 88127e8a9aaSMatthias Ringwald case MESH_NETWORK_PDU_SENT: 88227e8a9aaSMatthias Ringwald mesh_lower_transport_network_pdu_sent(network_pdu); 88327e8a9aaSMatthias Ringwald break; 88427e8a9aaSMatthias Ringwald default: 88527e8a9aaSMatthias Ringwald break; 886166cce4dSMatthias Ringwald } 887166cce4dSMatthias Ringwald } 888166cce4dSMatthias Ringwald 88977ba3d3fSMatthias Ringwald static void mesh_lower_transport_run(void){ 89077ba3d3fSMatthias Ringwald 89177ba3d3fSMatthias Ringwald // check if outgoing segmented pdu is active 8921e6c9225SMatthias Ringwald if (lower_transport_outgoing_message) return; 89377ba3d3fSMatthias Ringwald 89479eb95b0SMatthias Ringwald while(!btstack_linked_list_empty(&lower_transport_outgoing_ready)) { 89577ba3d3fSMatthias Ringwald // get next message 89677ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu; 897a4bbc09dSMatthias Ringwald mesh_segmented_pdu_t * message_pdu; 89879eb95b0SMatthias Ringwald mesh_pdu_t * pdu = (mesh_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_ready); 89977ba3d3fSMatthias Ringwald switch (pdu->pdu_type) { 900e9c16304SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS: 901e9c16304SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL: 902e9c16304SMatthias Ringwald // lower_transport_outgoing_unsegmented_pdu = (mesh_unsegmented_pdu_t *) pdu; 903e9c16304SMatthias Ringwald // network_pdu = lower_transport_outgoing_unsegmented_pdu->segment; 904e9c16304SMatthias Ringwald lower_transport_outgoing_network_pdu = (mesh_network_pdu_t *) pdu; 905e9c16304SMatthias Ringwald mesh_network_send_pdu(lower_transport_outgoing_network_pdu); 906b837963cSMatthias Ringwald break; 907a4bbc09dSMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 908a4bbc09dSMatthias Ringwald message_pdu = (mesh_segmented_pdu_t *) pdu; 909a7f44e8dSMatthias Ringwald // 9103945bdb6SMatthias Ringwald printf("[+] Lower transport, segmented pdu %p, seq %06x: run start sending now\n", message_pdu, 9113945bdb6SMatthias Ringwald message_pdu->seq); 91277ba3d3fSMatthias Ringwald // start sending segmented pdu 9136d212510SMatthias Ringwald mesh_lower_transport_outgoing_setup_sending_segmented_pdus(message_pdu); 91427e8a9aaSMatthias Ringwald mesh_lower_transport_outgoing_send_next_segment(); 9158fa6125aSMatthias Ringwald break; 91677ba3d3fSMatthias Ringwald default: 9178fa6125aSMatthias Ringwald btstack_assert(false); 91877ba3d3fSMatthias Ringwald break; 91977ba3d3fSMatthias Ringwald } 92077ba3d3fSMatthias Ringwald } 92177ba3d3fSMatthias Ringwald } 92277ba3d3fSMatthias Ringwald 923a4331339SMatthias Ringwald void mesh_lower_transport_send_pdu(mesh_pdu_t *pdu){ 924a4331339SMatthias Ringwald mesh_network_pdu_t * network_pdu; 925a4331339SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu; 926a4331339SMatthias Ringwald switch (pdu->pdu_type){ 927a4331339SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS: 928a4331339SMatthias Ringwald case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL: 929a4331339SMatthias Ringwald network_pdu = (mesh_network_pdu_t *) pdu; 930a4331339SMatthias Ringwald btstack_assert(network_pdu->len >= 9); 931a4331339SMatthias Ringwald break; 932a4331339SMatthias Ringwald case MESH_PDU_TYPE_SEGMENTED: 933a4331339SMatthias Ringwald // set num retries, set of segments to send 934a4331339SMatthias Ringwald segmented_pdu = (mesh_segmented_pdu_t *) pdu; 935a4331339SMatthias Ringwald segmented_pdu->retry_count = 3; 936a4331339SMatthias Ringwald mesh_lower_transport_outgoing_setup_block_ack(segmented_pdu); 937a4331339SMatthias Ringwald break; 938a4331339SMatthias Ringwald default: 939a4331339SMatthias Ringwald btstack_assert(false); 940a4331339SMatthias Ringwald break; 941a4331339SMatthias Ringwald } 942a4331339SMatthias Ringwald btstack_linked_list_add_tail(&lower_transport_outgoing_ready, (btstack_linked_item_t*) pdu); 943a4331339SMatthias Ringwald mesh_lower_transport_run(); 944a4331339SMatthias Ringwald } 945a4331339SMatthias Ringwald 94677ba3d3fSMatthias Ringwald static void mesh_lower_transport_dump_network_pdus(const char *name, btstack_linked_list_t *list){ 94777ba3d3fSMatthias Ringwald printf("List: %s:\n", name); 94877ba3d3fSMatthias Ringwald btstack_linked_list_iterator_t it; 94977ba3d3fSMatthias Ringwald btstack_linked_list_iterator_init(&it, list); 95077ba3d3fSMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 95177ba3d3fSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t*) btstack_linked_list_iterator_next(&it); 95277ba3d3fSMatthias Ringwald printf("- %p: ", network_pdu); printf_hexdump(network_pdu->data, network_pdu->len); 95377ba3d3fSMatthias Ringwald } 95477ba3d3fSMatthias Ringwald } 95577ba3d3fSMatthias Ringwald static void mesh_lower_transport_reset_network_pdus(btstack_linked_list_t *list){ 95677ba3d3fSMatthias Ringwald while (!btstack_linked_list_empty(list)){ 95777ba3d3fSMatthias Ringwald mesh_network_pdu_t * pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(list); 95877ba3d3fSMatthias Ringwald btstack_memory_mesh_network_pdu_free(pdu); 95977ba3d3fSMatthias Ringwald } 96077ba3d3fSMatthias Ringwald } 96177ba3d3fSMatthias Ringwald 96233439c2eSMilanka Ringwald bool mesh_lower_transport_can_send_to_dest(uint16_t dest){ 96333439c2eSMilanka Ringwald UNUSED(dest); 964a4331339SMatthias Ringwald // check current 965a4331339SMatthias Ringwald uint16_t num_messages = 0; 966a4331339SMatthias Ringwald if (lower_transport_outgoing_message != NULL) { 967a4331339SMatthias Ringwald if (lower_transport_outgoing_message->dst == dest) { 968a4331339SMatthias Ringwald return false; 969a4331339SMatthias Ringwald } 970a4331339SMatthias Ringwald num_messages++; 971a4331339SMatthias Ringwald } 972a4331339SMatthias Ringwald // check waiting 973a4331339SMatthias Ringwald btstack_linked_list_iterator_t it; 974a4331339SMatthias Ringwald btstack_linked_list_iterator_init(&it, &lower_transport_outgoing_waiting); 975a4331339SMatthias Ringwald while (btstack_linked_list_iterator_has_next(&it)){ 976a4331339SMatthias Ringwald mesh_segmented_pdu_t * segmented_pdu = (mesh_segmented_pdu_t *) btstack_linked_list_iterator_next(&it); 977a4331339SMatthias Ringwald num_messages++; 978cd15e003SMatthias Ringwald if (segmented_pdu->dst == dest){ 979cd15e003SMatthias Ringwald return false; 980a4331339SMatthias Ringwald } 981cd15e003SMatthias Ringwald } 982cd15e003SMatthias Ringwald #ifdef MAX_NR_MESH_OUTGOING_SEGMENTED_MESSAGES 983cd15e003SMatthias Ringwald // limit number of parallel outgoing messages if configured 984cd15e003SMatthias Ringwald if (num_messages >= MAX_NR_MESH_OUTGOING_SEGMENTED_MESSAGES) return false; 985cd15e003SMatthias Ringwald #endif 986a4331339SMatthias Ringwald return true; 987cd16791dSMatthias Ringwald } 988cd16791dSMatthias Ringwald 989cd16791dSMatthias Ringwald void mesh_lower_transport_reserve_slot(void){ 990cd16791dSMatthias Ringwald } 991cd16791dSMatthias Ringwald 99277ba3d3fSMatthias Ringwald void mesh_lower_transport_dump(void){ 99377ba3d3fSMatthias Ringwald } 99477ba3d3fSMatthias Ringwald 99577ba3d3fSMatthias Ringwald void mesh_lower_transport_reset(void){ 996a7f44e8dSMatthias Ringwald if (lower_transport_outgoing_message){ 997a7f44e8dSMatthias Ringwald while (!btstack_linked_list_empty(&lower_transport_outgoing_message->segments)){ 998a7f44e8dSMatthias Ringwald mesh_network_pdu_t * network_pdu = (mesh_network_pdu_t *) btstack_linked_list_pop(&lower_transport_outgoing_message->segments); 999a7f44e8dSMatthias Ringwald mesh_network_pdu_free(network_pdu); 1000a7f44e8dSMatthias Ringwald } 1001a7f44e8dSMatthias Ringwald lower_transport_outgoing_message = NULL; 1002a7f44e8dSMatthias Ringwald } 10031e6cebb8SMatthias Ringwald mesh_network_pdu_free(lower_transport_outgoing_segment); 1004e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 10051e6cebb8SMatthias Ringwald lower_transport_outgoing_segment = NULL; 100677ba3d3fSMatthias Ringwald } 100777ba3d3fSMatthias Ringwald 100877ba3d3fSMatthias Ringwald void mesh_lower_transport_init(){ 100977ba3d3fSMatthias Ringwald // register with network layer 101077ba3d3fSMatthias Ringwald mesh_network_set_higher_layer_handler(&mesh_lower_transport_received_message); 101177ba3d3fSMatthias Ringwald // allocate network_pdu for segmentation 1012e3f8b4e7SMatthias Ringwald lower_transport_outgoing_segment_at_network_layer = false; 101377ba3d3fSMatthias Ringwald lower_transport_outgoing_segment = mesh_network_pdu_get(); 101477ba3d3fSMatthias Ringwald } 101577ba3d3fSMatthias Ringwald 101677ba3d3fSMatthias 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)){ 101777ba3d3fSMatthias Ringwald higher_layer_handler = pdu_handler; 101877ba3d3fSMatthias Ringwald } 1019