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