xref: /btstack/test/mesh/mesh_message_test.cpp (revision df71a9a47903b1296e74a64d69d458c999b3c98c)
184242f88SMatthias Ringwald #include <stdio.h>
284242f88SMatthias Ringwald 
384242f88SMatthias Ringwald #include "CppUTest/TestHarness.h"
484242f88SMatthias Ringwald #include "CppUTest/CommandLineTestRunner.h"
584242f88SMatthias Ringwald 
6aaa248aaSMatthias Ringwald #include "btstack_debug.h"
784242f88SMatthias Ringwald #include "btstack_memory.h"
884242f88SMatthias Ringwald #include "btstack_util.h"
984242f88SMatthias Ringwald #include "mesh/adv_bearer.h"
1084242f88SMatthias Ringwald #include "mesh/gatt_bearer.h"
1163197f45SMatthias Ringwald #include "mesh/mesh_access.h"
1284242f88SMatthias Ringwald #include "mesh/mesh_crypto.h"
1384242f88SMatthias Ringwald #include "mesh/mesh_foundation.h"
1484242f88SMatthias Ringwald #include "mesh/mesh_iv_index_seq_number.h"
1584242f88SMatthias Ringwald #include "mesh/mesh_lower_transport.h"
1684242f88SMatthias Ringwald #include "mesh/mesh_network.h"
1784242f88SMatthias Ringwald #include "mesh/mesh_upper_transport.h"
1884242f88SMatthias Ringwald #include "mesh/provisioning.h"
1984242f88SMatthias Ringwald #include "mesh/mesh_peer.h"
20*df71a9a4SMatthias Ringwald #include "mock.h"
2184242f88SMatthias Ringwald 
2284242f88SMatthias Ringwald 
2384242f88SMatthias Ringwald static mesh_network_pdu_t * received_network_pdu;
2484242f88SMatthias Ringwald static mesh_network_pdu_t * received_proxy_pdu;
2584242f88SMatthias Ringwald 
2684242f88SMatthias Ringwald static uint8_t outgoing_gatt_network_pdu_data[29];
2784242f88SMatthias Ringwald static uint8_t outgoing_gatt_network_pdu_len;
2884242f88SMatthias Ringwald 
2984242f88SMatthias Ringwald static uint8_t outgoing_adv_network_pdu_data[29];
3084242f88SMatthias Ringwald static uint8_t outgoing_adv_network_pdu_len;
3184242f88SMatthias Ringwald 
3284242f88SMatthias Ringwald static uint8_t  recv_upper_transport_pdu_data[100];
3384242f88SMatthias Ringwald static uint16_t recv_upper_transport_pdu_len;
3484242f88SMatthias Ringwald 
3584242f88SMatthias Ringwald #ifdef ENABLE_MESH_ADV_BEARER
3684242f88SMatthias Ringwald static btstack_packet_handler_t adv_packet_handler;
3784242f88SMatthias Ringwald void adv_bearer_register_for_network_pdu(btstack_packet_handler_t packet_handler){
3884242f88SMatthias Ringwald     adv_packet_handler = packet_handler;
3984242f88SMatthias Ringwald }
4084242f88SMatthias Ringwald void adv_bearer_request_can_send_now_for_network_pdu(void){
4184242f88SMatthias Ringwald     // simulate can send now
4284242f88SMatthias Ringwald     uint8_t event[3];
4384242f88SMatthias Ringwald     event[0] = HCI_EVENT_MESH_META;
4484242f88SMatthias Ringwald     event[1] = 1;
4584242f88SMatthias Ringwald     event[2] = MESH_SUBEVENT_CAN_SEND_NOW;
4684242f88SMatthias Ringwald     (*adv_packet_handler)(HCI_EVENT_PACKET, 0, &event[0], sizeof(event));
4784242f88SMatthias Ringwald }
4884242f88SMatthias Ringwald void adv_bearer_send_network_pdu(const uint8_t * network_pdu, uint16_t size, uint8_t count, uint16_t interval){
4984242f88SMatthias Ringwald     (void) count;
5084242f88SMatthias Ringwald     (void) interval;
5184242f88SMatthias Ringwald     // printf("ADV Network PDU: ");
5284242f88SMatthias Ringwald     // printf_hexdump(network_pdu, size);
5384242f88SMatthias Ringwald     memcpy(outgoing_adv_network_pdu_data, network_pdu, size);
5484242f88SMatthias Ringwald     outgoing_adv_network_pdu_len = size;
5584242f88SMatthias Ringwald }
5684242f88SMatthias Ringwald static void adv_bearer_emit_sent(void){
5784242f88SMatthias Ringwald     uint8_t event[3];
5884242f88SMatthias Ringwald     event[0] = HCI_EVENT_MESH_META;
5984242f88SMatthias Ringwald     event[1] = 1;
6084242f88SMatthias Ringwald     event[2] = MESH_SUBEVENT_MESSAGE_SENT;
6184242f88SMatthias Ringwald     (*adv_packet_handler)(HCI_EVENT_PACKET, 0, &event[0], sizeof(event));
6284242f88SMatthias Ringwald }
6384242f88SMatthias Ringwald #endif
6484242f88SMatthias Ringwald 
6584242f88SMatthias Ringwald #ifdef ENABLE_MESH_GATT_BEARER
6684242f88SMatthias Ringwald static btstack_packet_handler_t gatt_packet_handler;
6784242f88SMatthias Ringwald void gatt_bearer_register_for_network_pdu(btstack_packet_handler_t packet_handler){
6884242f88SMatthias Ringwald     gatt_packet_handler = packet_handler;
6984242f88SMatthias Ringwald }
7084242f88SMatthias Ringwald void gatt_bearer_register_for_mesh_proxy_configuration(btstack_packet_handler_t packet_handler){
71*df71a9a4SMatthias Ringwald     UNUSED(packet_handler);
7284242f88SMatthias Ringwald }
7384242f88SMatthias Ringwald void gatt_bearer_request_can_send_now_for_network_pdu(void){
7484242f88SMatthias Ringwald     // simulate can send now
7584242f88SMatthias Ringwald     uint8_t event[3];
7684242f88SMatthias Ringwald     event[0] = HCI_EVENT_MESH_META;
7784242f88SMatthias Ringwald     event[1] = 1;
7884242f88SMatthias Ringwald     event[2] = MESH_SUBEVENT_CAN_SEND_NOW;
7984242f88SMatthias Ringwald     (*gatt_packet_handler)(HCI_EVENT_PACKET, 0, &event[0], sizeof(event));
8084242f88SMatthias Ringwald }
8184242f88SMatthias Ringwald void gatt_bearer_send_network_pdu(const uint8_t * network_pdu, uint16_t size){
8284242f88SMatthias Ringwald     // printf("ADV Network PDU: ");
8384242f88SMatthias Ringwald     // printf_hexdump(network_pdu, size);
8484242f88SMatthias Ringwald     memcpy(outgoing_gatt_network_pdu_data, network_pdu, size);
8584242f88SMatthias Ringwald     outgoing_gatt_network_pdu_len = size;
8684242f88SMatthias Ringwald }
8784242f88SMatthias Ringwald static void gatt_bearer_emit_sent(void){
8884242f88SMatthias Ringwald     uint8_t event[3];
8984242f88SMatthias Ringwald     event[0] = HCI_EVENT_MESH_META;
9084242f88SMatthias Ringwald     event[1] = 1;
9184242f88SMatthias Ringwald     event[2] = MESH_SUBEVENT_MESSAGE_SENT;
9284242f88SMatthias Ringwald     (*gatt_packet_handler)(HCI_EVENT_PACKET, 0, &event[0], sizeof(event));
9384242f88SMatthias Ringwald }
9484242f88SMatthias Ringwald static void gatt_bearer_emit_connected(void){
9584242f88SMatthias Ringwald     uint8_t event[5];
9684242f88SMatthias Ringwald     event[0] = HCI_EVENT_MESH_META;
9784242f88SMatthias Ringwald     event[1] = 1;
9884242f88SMatthias Ringwald     event[2] = MESH_SUBEVENT_PROXY_CONNECTED;
9984242f88SMatthias Ringwald     little_endian_store_16(event, 3, 0x1234);
10084242f88SMatthias Ringwald     (*gatt_packet_handler)(HCI_EVENT_PACKET, 0, &event[0], sizeof(event));
10184242f88SMatthias Ringwald }
10284242f88SMatthias Ringwald #endif
10384242f88SMatthias Ringwald 
10463197f45SMatthias Ringwald // copy from mesh_message.c for now
10563197f45SMatthias Ringwald uint16_t mesh_pdu_dst(mesh_pdu_t * pdu){
10663197f45SMatthias Ringwald     switch (pdu->pdu_type){
107e4121a34SMatthias Ringwald         case MESH_PDU_TYPE_UNSEGMENTED:
10863197f45SMatthias Ringwald         case MESH_PDU_TYPE_NETWORK:
1098ec600ffSMatthias Ringwald         case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL:
11063197f45SMatthias Ringwald             return mesh_network_dst((mesh_network_pdu_t *) pdu);
1112ddfd9e2SMatthias Ringwald         case MESH_PDU_TYPE_ACCESS: {
1122ddfd9e2SMatthias Ringwald             return ((mesh_access_pdu_t *) pdu)->dst;
1132ddfd9e2SMatthias Ringwald         }
114242605faSMatthias Ringwald         case MESH_PDU_TYPE_UPPER_SEGMENTED_ACCESS:
1151b51af65SMatthias Ringwald         case MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS:
116242605faSMatthias Ringwald             return ((mesh_upper_transport_pdu_t *) pdu)->dst;
11763197f45SMatthias Ringwald         default:
1187a0b7488SMatthias Ringwald             btstack_assert(false);
11963197f45SMatthias Ringwald             return MESH_ADDRESS_UNSASSIGNED;
12063197f45SMatthias Ringwald     }
12163197f45SMatthias Ringwald }
12263197f45SMatthias Ringwald uint16_t mesh_pdu_ctl(mesh_pdu_t * pdu){
12363197f45SMatthias Ringwald     switch (pdu->pdu_type){
12463197f45SMatthias Ringwald         case MESH_PDU_TYPE_NETWORK:
1258ec600ffSMatthias Ringwald         case MESH_PDU_TYPE_UPPER_UNSEGMENTED_CONTROL:
12663197f45SMatthias Ringwald             return mesh_network_control((mesh_network_pdu_t *) pdu);
1272ddfd9e2SMatthias Ringwald         case MESH_PDU_TYPE_ACCESS: {
1282ddfd9e2SMatthias Ringwald             return ((mesh_access_pdu_t *) pdu)->ctl_ttl >> 7;
1292ddfd9e2SMatthias Ringwald         }
13063197f45SMatthias Ringwald         default:
1317a0b7488SMatthias Ringwald             btstack_assert(false);
13263197f45SMatthias Ringwald             return 0;
13363197f45SMatthias Ringwald     }
13463197f45SMatthias Ringwald }
13563197f45SMatthias Ringwald 
136*df71a9a4SMatthias Ringwald static void CHECK_EQUAL_ARRAY(uint8_t * expected, uint8_t * actual, int size){
13784242f88SMatthias Ringwald     int i;
13884242f88SMatthias Ringwald     for (i=0; i<size; i++){
13984242f88SMatthias Ringwald         if (expected[i] != actual[i]) {
14084242f88SMatthias Ringwald             printf("offset %u wrong\n", i);
14184242f88SMatthias Ringwald             printf("expected: "); printf_hexdump(expected, size);
14284242f88SMatthias Ringwald             printf("actual:   "); printf_hexdump(actual, size);
14384242f88SMatthias Ringwald         }
14484242f88SMatthias Ringwald         BYTES_EQUAL(expected[i], actual[i]);
14584242f88SMatthias Ringwald     }
14684242f88SMatthias Ringwald }
14784242f88SMatthias Ringwald 
14884242f88SMatthias Ringwald static int scan_hex_byte(const char * byte_string){
149*df71a9a4SMatthias Ringwald     uint8_t upper_nibble = nibble_for_char(*byte_string++);
15084242f88SMatthias Ringwald     if (upper_nibble < 0) return -1;
151*df71a9a4SMatthias Ringwald     uint8_t lower_nibble = nibble_for_char(*byte_string);
15284242f88SMatthias Ringwald     if (lower_nibble < 0) return -1;
15384242f88SMatthias Ringwald     return (upper_nibble << 4) | lower_nibble;
15484242f88SMatthias Ringwald }
15584242f88SMatthias Ringwald 
15684242f88SMatthias Ringwald static int btstack_parse_hex(const char * string, uint16_t len, uint8_t * buffer){
15784242f88SMatthias Ringwald     int i;
15884242f88SMatthias Ringwald     for (i = 0; i < len; i++) {
15984242f88SMatthias Ringwald         int single_byte = scan_hex_byte(string);
16084242f88SMatthias Ringwald         if (single_byte < 0) return 0;
16184242f88SMatthias Ringwald         string += 2;
16284242f88SMatthias Ringwald         buffer[i] = (uint8_t)single_byte;
163*df71a9a4SMatthias Ringwald         // don't check separator after last byte
16484242f88SMatthias Ringwald         if (i == len - 1) {
16584242f88SMatthias Ringwald             return 1;
16684242f88SMatthias Ringwald         }
16784242f88SMatthias Ringwald         // optional seperator
16884242f88SMatthias Ringwald         char separator = *string;
169*df71a9a4SMatthias Ringwald         if (separator == ':' || separator == '-' || separator == ' ') {
17084242f88SMatthias Ringwald             string++;
17184242f88SMatthias Ringwald         }
17284242f88SMatthias Ringwald     }
17384242f88SMatthias Ringwald     return 1;
17484242f88SMatthias Ringwald }
17584242f88SMatthias Ringwald 
17684242f88SMatthias Ringwald #if 0
17784242f88SMatthias Ringwald static void btstack_print_hex(const uint8_t * data, uint16_t len, char separator){
17884242f88SMatthias Ringwald     int i;
17984242f88SMatthias Ringwald     for (i=0;i<len;i++){
18084242f88SMatthias Ringwald         printf("%02x", data[i]);
18184242f88SMatthias Ringwald         if (separator){
18284242f88SMatthias Ringwald             printf("%c", separator);
18384242f88SMatthias Ringwald         }
18484242f88SMatthias Ringwald     }
18584242f88SMatthias Ringwald     printf("\n");
18684242f88SMatthias Ringwald }
18784242f88SMatthias Ringwald #endif
18884242f88SMatthias Ringwald 
18984242f88SMatthias Ringwald static mesh_transport_key_t   test_application_key;
19084242f88SMatthias Ringwald static void mesh_application_key_set(uint16_t netkey_index, uint16_t appkey_index, uint8_t aid, const uint8_t *application_key) {
19184242f88SMatthias Ringwald     test_application_key.netkey_index = netkey_index;
19284242f88SMatthias Ringwald     test_application_key.appkey_index = appkey_index;
19384242f88SMatthias Ringwald     test_application_key.aid   = aid;
19484242f88SMatthias Ringwald     test_application_key.akf   = 1;
19584242f88SMatthias Ringwald     memcpy(test_application_key.key, application_key, 16);
19684242f88SMatthias Ringwald     mesh_transport_key_add(&test_application_key);
19784242f88SMatthias Ringwald }
19884242f88SMatthias Ringwald 
19984242f88SMatthias Ringwald static void load_network_key_nid_68(void){
20084242f88SMatthias Ringwald     mesh_network_key_t * network_key = btstack_memory_mesh_network_key_get();
20184242f88SMatthias Ringwald     network_key->nid = 0x68;
20284242f88SMatthias Ringwald     btstack_parse_hex("0953fa93e7caac9638f58820220a398e", 16, network_key->encryption_key);
20384242f88SMatthias Ringwald     btstack_parse_hex("8b84eedec100067d670971dd2aa700cf", 16, network_key->privacy_key);
20484242f88SMatthias Ringwald     mesh_network_key_add(network_key);
20584242f88SMatthias Ringwald     mesh_subnet_setup_for_netkey_index(network_key->netkey_index);
20684242f88SMatthias Ringwald }
20784242f88SMatthias Ringwald 
20884242f88SMatthias Ringwald static void load_network_key_nid_5e(void){
20984242f88SMatthias Ringwald     mesh_network_key_t * network_key = btstack_memory_mesh_network_key_get();
21084242f88SMatthias Ringwald     network_key->nid = 0x5e;
21184242f88SMatthias Ringwald     btstack_parse_hex("be635105434859f484fc798e043ce40e", 16, network_key->encryption_key);
21284242f88SMatthias Ringwald     btstack_parse_hex("5d396d4b54d3cbafe943e051fe9a4eb8", 16, network_key->privacy_key);
21384242f88SMatthias Ringwald     mesh_network_key_add(network_key);
21484242f88SMatthias Ringwald     mesh_subnet_setup_for_netkey_index(network_key->netkey_index);
21584242f88SMatthias Ringwald }
21684242f88SMatthias Ringwald 
21784242f88SMatthias Ringwald static void load_network_key_nid_10(void){
21884242f88SMatthias Ringwald     mesh_network_key_t * network_key = btstack_memory_mesh_network_key_get();
21984242f88SMatthias Ringwald     network_key->nid = 0x10;
22084242f88SMatthias Ringwald     btstack_parse_hex("3a4fe84a6cc2c6a766ea93f1084d4039", 16, network_key->encryption_key);
22184242f88SMatthias Ringwald     btstack_parse_hex("f695fcce709ccface4d8b7a1e6e39d25", 16, network_key->privacy_key);
22284242f88SMatthias Ringwald     mesh_network_key_add(network_key);
22384242f88SMatthias Ringwald     mesh_subnet_setup_for_netkey_index(network_key->netkey_index);
22484242f88SMatthias Ringwald }
22584242f88SMatthias Ringwald 
22684242f88SMatthias Ringwald static void load_provisioning_data_test_message(void){
22784242f88SMatthias Ringwald     uint8_t application_key[16];
22884242f88SMatthias Ringwald     btstack_parse_hex("63964771734fbd76e3b40519d1d94a48", 16, application_key);
22984242f88SMatthias Ringwald     mesh_application_key_set( 0, 0, 0x26, application_key);
23084242f88SMatthias Ringwald 
23184242f88SMatthias Ringwald     uint8_t device_key[16];
23284242f88SMatthias Ringwald     btstack_parse_hex("9d6dd0e96eb25dc19a40ed9914f8f03f", 16, device_key);
23384242f88SMatthias Ringwald     mesh_transport_set_device_key(device_key);
23484242f88SMatthias Ringwald }
23584242f88SMatthias Ringwald 
23684242f88SMatthias Ringwald static void test_lower_transport_callback_handler(mesh_network_callback_type_t callback_type, mesh_network_pdu_t * network_pdu){
23784242f88SMatthias Ringwald     switch (callback_type){
23884242f88SMatthias Ringwald         case MESH_NETWORK_PDU_RECEIVED:
23984242f88SMatthias Ringwald             printf("test MESH_NETWORK_PDU_RECEIVED\n");
24084242f88SMatthias Ringwald             received_network_pdu = network_pdu;
24184242f88SMatthias Ringwald             break;
24284242f88SMatthias Ringwald         case MESH_NETWORK_PDU_SENT:
24384242f88SMatthias Ringwald             printf("test MESH_NETWORK_PDU_SENT\n");
24484242f88SMatthias Ringwald             mesh_lower_transport_received_message(MESH_NETWORK_PDU_SENT, network_pdu);
24584242f88SMatthias Ringwald             break;
24684242f88SMatthias Ringwald         default:
24784242f88SMatthias Ringwald             break;
24884242f88SMatthias Ringwald     }
24984242f88SMatthias Ringwald }
25084242f88SMatthias Ringwald 
25184242f88SMatthias Ringwald static void test_proxy_server_callback_handler(mesh_network_callback_type_t callback_type, mesh_network_pdu_t * network_pdu){
25284242f88SMatthias Ringwald     switch (callback_type){
25384242f88SMatthias Ringwald         case MESH_NETWORK_PDU_RECEIVED:
25484242f88SMatthias Ringwald             printf("test MESH_PROXY_PDU_RECEIVED\n");
25584242f88SMatthias Ringwald             received_proxy_pdu = network_pdu;
25684242f88SMatthias Ringwald             break;
25784242f88SMatthias Ringwald         case MESH_NETWORK_PDU_SENT:
25884242f88SMatthias Ringwald             // printf("test MESH_PROXY_PDU_SENT\n");
25984242f88SMatthias Ringwald             // mesh_lower_transport_received_mesage(MESH_NETWORK_PDU_SENT, network_pdu);
26084242f88SMatthias Ringwald             break;
2611aa2a11eSMatthias Ringwald         case MESH_NETWORK_PDU_ENCRYPTED:
2621aa2a11eSMatthias Ringwald             printf("test MESH_NETWORK_PDU_ENCRYPTED\n");
2631aa2a11eSMatthias Ringwald             received_proxy_pdu = network_pdu;
2641aa2a11eSMatthias Ringwald             break;
26584242f88SMatthias Ringwald         default:
26684242f88SMatthias Ringwald             break;
26784242f88SMatthias Ringwald     }
26884242f88SMatthias Ringwald }
26984242f88SMatthias Ringwald 
270404d2482SMatthias Ringwald static void test_upper_transport_access_message_handler(mesh_transport_callback_type_t callback_type, mesh_transport_status_t status, mesh_pdu_t * pdu){
271*df71a9a4SMatthias Ringwald     UNUSED(status);
2727a0b7488SMatthias Ringwald 
2737a0b7488SMatthias Ringwald     // ignore pdu sent
2747a0b7488SMatthias Ringwald     if (callback_type == MESH_TRANSPORT_PDU_SENT) return;
2757a0b7488SMatthias Ringwald 
2767a0b7488SMatthias Ringwald     // process pdu received
277160d2809SMatthias Ringwald     mesh_access_pdu_t    * access_pdu;
27884242f88SMatthias Ringwald     mesh_network_pdu_t   * network_pdu;
279a4bbc09dSMatthias Ringwald     mesh_segmented_pdu_t   * message_pdu;
2807a0b7488SMatthias Ringwald 
28184242f88SMatthias Ringwald     switch(pdu->pdu_type){
282160d2809SMatthias Ringwald         case MESH_PDU_TYPE_ACCESS:
283160d2809SMatthias Ringwald             access_pdu = (mesh_access_pdu_t *) pdu;
284160d2809SMatthias Ringwald             printf("test access handler MESH_PDU_TYPE_ACCESS received\n");
285160d2809SMatthias Ringwald             recv_upper_transport_pdu_len = access_pdu->len;
286160d2809SMatthias Ringwald             memcpy(recv_upper_transport_pdu_data, access_pdu->data, recv_upper_transport_pdu_len);
28784242f88SMatthias Ringwald             mesh_upper_transport_message_processed_by_higher_layer(pdu);
28884242f88SMatthias Ringwald             break;
289a4bbc09dSMatthias Ringwald         case MESH_PDU_TYPE_SEGMENTED:
290a4bbc09dSMatthias Ringwald             message_pdu = (mesh_segmented_pdu_t *) pdu;
291a4bbc09dSMatthias Ringwald             printf("test access handler MESH_PDU_TYPE_SEGMENTED received\n");
292aaa248aaSMatthias Ringwald             network_pdu = (mesh_network_pdu_t *) btstack_linked_list_get_first_item(&message_pdu->segments);
29384242f88SMatthias Ringwald             recv_upper_transport_pdu_len = mesh_network_pdu_len(network_pdu)  - 1;
29484242f88SMatthias Ringwald             memcpy(recv_upper_transport_pdu_data, mesh_network_pdu_data(network_pdu) + 1, recv_upper_transport_pdu_len);
29584242f88SMatthias Ringwald             mesh_upper_transport_message_processed_by_higher_layer(pdu);
29684242f88SMatthias Ringwald             break;
29784242f88SMatthias Ringwald         default:
298160d2809SMatthias Ringwald             btstack_assert(0);
29984242f88SMatthias Ringwald             break;
30084242f88SMatthias Ringwald     }
30184242f88SMatthias Ringwald }
30284242f88SMatthias Ringwald 
303404d2482SMatthias Ringwald static void test_upper_transport_control_message_handler(mesh_transport_callback_type_t callback_type, mesh_transport_status_t status, mesh_pdu_t * pdu){
304*df71a9a4SMatthias Ringwald     UNUSED(status);
305*df71a9a4SMatthias Ringwald 
3067a0b7488SMatthias Ringwald     // ignore pdu sent
3077a0b7488SMatthias Ringwald     if (callback_type == MESH_TRANSPORT_PDU_SENT) return;
3087a0b7488SMatthias Ringwald 
3097a0b7488SMatthias Ringwald     // process pdu received
3105131e195SMatthias Ringwald     mesh_control_pdu_t     * control_pdu;
31184242f88SMatthias Ringwald     switch(pdu->pdu_type){
3125131e195SMatthias Ringwald         case MESH_PDU_TYPE_CONTROL:
3135131e195SMatthias Ringwald             control_pdu = (mesh_control_pdu_t *) pdu;
3145131e195SMatthias Ringwald             printf("test MESH_PDU_TYPE_CONTROL\n");
3155131e195SMatthias Ringwald             recv_upper_transport_pdu_len = control_pdu->len + 1;
3165131e195SMatthias Ringwald             recv_upper_transport_pdu_data[0] = control_pdu->akf_aid_control;
3175131e195SMatthias Ringwald             memcpy(&recv_upper_transport_pdu_data[1], control_pdu->data, control_pdu->len);
31884242f88SMatthias Ringwald             mesh_upper_transport_message_processed_by_higher_layer(pdu);
31984242f88SMatthias Ringwald             break;
32084242f88SMatthias Ringwald         default:
321160d2809SMatthias Ringwald             btstack_assert(0);
32284242f88SMatthias Ringwald             break;
32384242f88SMatthias Ringwald     }
32484242f88SMatthias Ringwald }
32584242f88SMatthias Ringwald 
32684242f88SMatthias Ringwald TEST_GROUP(MessageTest){
32784242f88SMatthias Ringwald     void setup(void){
32884242f88SMatthias Ringwald         btstack_memory_init();
32984242f88SMatthias Ringwald         btstack_crypto_init();
33084242f88SMatthias Ringwald         load_provisioning_data_test_message();
33184242f88SMatthias Ringwald         mesh_network_init();
33284242f88SMatthias Ringwald         mesh_lower_transport_init();
33384242f88SMatthias Ringwald         mesh_upper_transport_init();
33484242f88SMatthias Ringwald         mesh_network_key_init();
33584242f88SMatthias Ringwald         // intercept messages between network and lower layer
33684242f88SMatthias Ringwald         mesh_network_set_higher_layer_handler(&test_lower_transport_callback_handler);
33784242f88SMatthias Ringwald         mesh_network_set_proxy_message_handler(&test_proxy_server_callback_handler);
33884242f88SMatthias Ringwald         // register to receive upper transport messages
33984242f88SMatthias Ringwald         mesh_upper_transport_register_access_message_handler(&test_upper_transport_access_message_handler);
34084242f88SMatthias Ringwald         mesh_upper_transport_register_control_message_handler(&test_upper_transport_control_message_handler);
34184242f88SMatthias Ringwald         mesh_seq_auth_reset();
34284242f88SMatthias Ringwald #ifdef ENABLE_MESH_GATT_BEARER
34384242f88SMatthias Ringwald         mesh_foundation_gatt_proxy_set(1);
34484242f88SMatthias Ringwald         gatt_bearer_emit_connected();
34584242f88SMatthias Ringwald #endif
34684242f88SMatthias Ringwald         outgoing_gatt_network_pdu_len = 0;
34784242f88SMatthias Ringwald         outgoing_adv_network_pdu_len = 0;
34884242f88SMatthias Ringwald         received_network_pdu = NULL;
34984242f88SMatthias Ringwald         recv_upper_transport_pdu_len =0;
35084242f88SMatthias Ringwald     }
35184242f88SMatthias Ringwald     void teardown(void){
35284242f88SMatthias Ringwald         // printf("-- teardown start --\n\n");
35384242f88SMatthias Ringwald         btstack_crypto_reset();
35484242f88SMatthias Ringwald         mesh_network_reset();
35584242f88SMatthias Ringwald         mesh_lower_transport_reset();
35684242f88SMatthias Ringwald         mesh_upper_transport_dump();
35784242f88SMatthias Ringwald         mesh_upper_transport_reset();
35884242f88SMatthias Ringwald         // mesh_network_dump();
35984242f88SMatthias Ringwald         // mesh_transport_dump();
36084242f88SMatthias Ringwald         printf("-- teardown complete --\n\n");
36184242f88SMatthias Ringwald     }
36284242f88SMatthias Ringwald };
36384242f88SMatthias Ringwald 
36484242f88SMatthias Ringwald static uint8_t transport_pdu_data[64];
36584242f88SMatthias Ringwald static uint16_t transport_pdu_len;
36684242f88SMatthias Ringwald 
36784242f88SMatthias Ringwald static     uint8_t test_network_pdu_len;
36884242f88SMatthias Ringwald static uint8_t test_network_pdu_data[29];
36984242f88SMatthias Ringwald 
370*df71a9a4SMatthias Ringwald static void test_receive_network_pdus(int count, char ** network_pdus, char ** lower_transport_pdus, char * access_pdu){
37184242f88SMatthias Ringwald     int i;
37284242f88SMatthias Ringwald     for (i=0;i<count;i++){
37384242f88SMatthias Ringwald         test_network_pdu_len = strlen(network_pdus[i]) / 2;
37484242f88SMatthias Ringwald         btstack_parse_hex(network_pdus[i], test_network_pdu_len, test_network_pdu_data);
37584242f88SMatthias Ringwald 
37684242f88SMatthias Ringwald         mesh_network_received_message(test_network_pdu_data, test_network_pdu_len, 0);
37784242f88SMatthias Ringwald 
37884242f88SMatthias Ringwald         while (received_network_pdu == NULL) {
37984242f88SMatthias Ringwald             mock_process_hci_cmd();
38084242f88SMatthias Ringwald         }
38184242f88SMatthias Ringwald 
38284242f88SMatthias Ringwald         transport_pdu_len = strlen(lower_transport_pdus[i]) / 2;
38384242f88SMatthias Ringwald         btstack_parse_hex(lower_transport_pdus[i], transport_pdu_len, transport_pdu_data);
38484242f88SMatthias Ringwald 
38584242f88SMatthias Ringwald         uint8_t * lower_transport_pdu     = mesh_network_pdu_data(received_network_pdu);
38684242f88SMatthias Ringwald         uint8_t   lower_transport_pdu_len = mesh_network_pdu_len(received_network_pdu);
38784242f88SMatthias Ringwald 
38884242f88SMatthias Ringwald         // printf_hexdump(lower_transport_pdu, lower_transport_pdu_len);
38984242f88SMatthias Ringwald 
39084242f88SMatthias Ringwald         CHECK_EQUAL( transport_pdu_len, lower_transport_pdu_len);
39184242f88SMatthias Ringwald         CHECK_EQUAL_ARRAY(transport_pdu_data, lower_transport_pdu, transport_pdu_len);
39284242f88SMatthias Ringwald 
39384242f88SMatthias Ringwald         // forward to mesh_transport
39484242f88SMatthias Ringwald         mesh_lower_transport_received_message(MESH_NETWORK_PDU_RECEIVED, received_network_pdu);
39584242f88SMatthias Ringwald 
39684242f88SMatthias Ringwald         // done
39784242f88SMatthias Ringwald         received_network_pdu = NULL;
39884242f88SMatthias Ringwald     }
39984242f88SMatthias Ringwald 
40084242f88SMatthias Ringwald     // wait for tranport pdu
40184242f88SMatthias Ringwald     while (recv_upper_transport_pdu_len == 0) {
40284242f88SMatthias Ringwald         mock_process_hci_cmd();
40384242f88SMatthias Ringwald     }
40484242f88SMatthias Ringwald 
40584242f88SMatthias Ringwald     transport_pdu_len = strlen(access_pdu) / 2;
40684242f88SMatthias Ringwald     btstack_parse_hex(access_pdu, transport_pdu_len, transport_pdu_data);
40784242f88SMatthias Ringwald 
40884242f88SMatthias Ringwald     printf("UpperTransportPDU: ");
40984242f88SMatthias Ringwald     printf_hexdump(recv_upper_transport_pdu_data, recv_upper_transport_pdu_len);
41084242f88SMatthias Ringwald     CHECK_EQUAL( transport_pdu_len, recv_upper_transport_pdu_len);
41184242f88SMatthias Ringwald     CHECK_EQUAL_ARRAY(transport_pdu_data, recv_upper_transport_pdu_data, transport_pdu_len);
41284242f88SMatthias Ringwald }
41384242f88SMatthias Ringwald 
414*df71a9a4SMatthias Ringwald static void expect_gatt_network_pdu(void){
415*df71a9a4SMatthias Ringwald 
41684242f88SMatthias Ringwald         while (outgoing_gatt_network_pdu_len == 0) {
41784242f88SMatthias Ringwald             mock_process_hci_cmd();
41884242f88SMatthias Ringwald         }
41984242f88SMatthias Ringwald 
42084242f88SMatthias Ringwald         if (outgoing_gatt_network_pdu_len != test_network_pdu_len){
42184242f88SMatthias Ringwald             printf("Test Network PDU (%u): ", outgoing_gatt_network_pdu_len); printf_hexdump(outgoing_gatt_network_pdu_data, outgoing_gatt_network_pdu_len);
42284242f88SMatthias Ringwald             printf("Expected     PDU (%u): ", test_network_pdu_len); printf_hexdump(test_network_pdu_data, test_network_pdu_len);
42384242f88SMatthias Ringwald         }
42484242f88SMatthias Ringwald         CHECK_EQUAL( outgoing_gatt_network_pdu_len, test_network_pdu_len);
42584242f88SMatthias Ringwald         CHECK_EQUAL_ARRAY(test_network_pdu_data, outgoing_gatt_network_pdu_data, test_network_pdu_len);
42684242f88SMatthias Ringwald 
42784242f88SMatthias Ringwald         outgoing_gatt_network_pdu_len = 0;
42884242f88SMatthias Ringwald         gatt_bearer_emit_sent();
42984242f88SMatthias Ringwald }
43084242f88SMatthias Ringwald 
431*df71a9a4SMatthias Ringwald static void expect_adv_network_pdu(void){
43284242f88SMatthias Ringwald         while (outgoing_adv_network_pdu_len == 0) {
43384242f88SMatthias Ringwald             mock_process_hci_cmd();
43484242f88SMatthias Ringwald         }
43584242f88SMatthias Ringwald 
43684242f88SMatthias Ringwald         if (outgoing_adv_network_pdu_len != test_network_pdu_len){
43784242f88SMatthias Ringwald             printf("Test Network PDU (%u): ", outgoing_adv_network_pdu_len); printf_hexdump(outgoing_adv_network_pdu_data, outgoing_adv_network_pdu_len);
43884242f88SMatthias Ringwald             printf("Expected     PDU (%u): ", test_network_pdu_len); printf_hexdump(test_network_pdu_data, test_network_pdu_len);
43984242f88SMatthias Ringwald         }
44084242f88SMatthias Ringwald         CHECK_EQUAL( outgoing_adv_network_pdu_len, test_network_pdu_len);
44184242f88SMatthias Ringwald         CHECK_EQUAL_ARRAY(test_network_pdu_data, outgoing_adv_network_pdu_data, test_network_pdu_len);
44284242f88SMatthias Ringwald 
44384242f88SMatthias Ringwald         outgoing_adv_network_pdu_len = 0;
44484242f88SMatthias Ringwald         adv_bearer_emit_sent();
44584242f88SMatthias Ringwald }
44684242f88SMatthias Ringwald 
447*df71a9a4SMatthias Ringwald static void test_send_access_message(uint16_t netkey_index, uint16_t appkey_index,  uint8_t ttl, uint16_t src, uint16_t dest, uint8_t szmic, char * control_pdu, int count, char ** lower_transport_pdus, char ** network_pdus){
448*df71a9a4SMatthias Ringwald 
449*df71a9a4SMatthias Ringwald     UNUSED(lower_transport_pdus);
45084242f88SMatthias Ringwald 
45184242f88SMatthias Ringwald     transport_pdu_len = strlen(control_pdu) / 2;
45284242f88SMatthias Ringwald     btstack_parse_hex(control_pdu, transport_pdu_len, transport_pdu_data);
45384242f88SMatthias Ringwald 
454734bae65SMatthias Ringwald     mesh_pdu_type_t pdu_type;
45584242f88SMatthias Ringwald     if (count == 1 ){
45684242f88SMatthias Ringwald         // send as unsegmented access pdu
457734bae65SMatthias Ringwald         pdu_type = MESH_PDU_TYPE_UPPER_UNSEGMENTED_ACCESS;
45884242f88SMatthias Ringwald     } else {
45984242f88SMatthias Ringwald         // send as segmented access pdu
460734bae65SMatthias Ringwald         pdu_type = MESH_PDU_TYPE_UPPER_SEGMENTED_ACCESS;
46184242f88SMatthias Ringwald     }
462734bae65SMatthias Ringwald #if 0
463734bae65SMatthias Ringwald     //
464734bae65SMatthias Ringwald     upper_pdu.lower_pdu = NULL;
465734bae65SMatthias Ringwald     upper_pdu.flags = 0;
466734bae65SMatthias Ringwald     upper_pdu.pdu_type = pdu_type;
4678ec600ffSMatthias Ringwald     mesh_pdu_t * pdu = (mesh_pdu_t *) &upper_pdu;
46884242f88SMatthias Ringwald     mesh_upper_transport_setup_access_pdu(pdu, netkey_index, appkey_index, ttl, src, dest, szmic, transport_pdu_data, transport_pdu_len);
469734bae65SMatthias Ringwald #else
470734bae65SMatthias Ringwald     mesh_upper_transport_builder_t builder;
471734bae65SMatthias Ringwald     mesh_upper_transport_message_init(&builder, pdu_type);
472734bae65SMatthias Ringwald     mesh_upper_transport_message_add_data(&builder, transport_pdu_data, transport_pdu_len);
473734bae65SMatthias Ringwald     mesh_pdu_t * pdu = (mesh_pdu_t *) mesh_upper_transport_message_finalize(&builder);
474734bae65SMatthias Ringwald     mesh_upper_transport_setup_access_pdu_header(pdu, netkey_index, appkey_index, ttl, src, dest, szmic);
475734bae65SMatthias Ringwald #endif
47684242f88SMatthias Ringwald     mesh_upper_transport_send_access_pdu(pdu);
47784242f88SMatthias Ringwald 
47884242f88SMatthias Ringwald     // check for all network pdus
47984242f88SMatthias Ringwald     int i;
48084242f88SMatthias Ringwald     for (i=0;i<count;i++){
48184242f88SMatthias Ringwald         // parse expected network pdu
48284242f88SMatthias Ringwald         test_network_pdu_len = strlen(network_pdus[i]) / 2;
48384242f88SMatthias Ringwald         btstack_parse_hex(network_pdus[i], test_network_pdu_len, test_network_pdu_data);
48484242f88SMatthias Ringwald 
48584242f88SMatthias Ringwald #ifdef ENABLE_MESH_GATT_BEARER
486*df71a9a4SMatthias Ringwald         expect_gatt_network_pdu();
48784242f88SMatthias Ringwald #endif
48884242f88SMatthias Ringwald 
48984242f88SMatthias Ringwald #ifdef ENABLE_MESH_ADV_BEARER
490*df71a9a4SMatthias Ringwald         expect_adv_network_pdu();
49184242f88SMatthias Ringwald #endif
49284242f88SMatthias Ringwald     }
493242605faSMatthias Ringwald }
49484242f88SMatthias Ringwald 
495*df71a9a4SMatthias Ringwald static void test_send_control_message(uint16_t netkey_index, uint8_t ttl, uint16_t src, uint16_t dest, char * control_pdu, int count, char ** lower_transport_pdus, char ** network_pdus){
496*df71a9a4SMatthias Ringwald 
497*df71a9a4SMatthias Ringwald     UNUSED(lower_transport_pdus);
49884242f88SMatthias Ringwald 
49984242f88SMatthias Ringwald     transport_pdu_len = strlen(control_pdu) / 2;
50084242f88SMatthias Ringwald     btstack_parse_hex(control_pdu, transport_pdu_len, transport_pdu_data);
50184242f88SMatthias Ringwald 
50284242f88SMatthias Ringwald     uint8_t opcode = transport_pdu_data[0];
50384242f88SMatthias Ringwald 
50484242f88SMatthias Ringwald     mesh_pdu_t * pdu;
50584242f88SMatthias Ringwald     if (transport_pdu_len < 12){
50684242f88SMatthias Ringwald         // send as unsegmented control pdu
5074802c66dSMatthias Ringwald         mesh_network_pdu_t * network_pdu = mesh_network_pdu_get();
5084802c66dSMatthias Ringwald         mesh_upper_transport_setup_unsegmented_control_pdu(network_pdu, netkey_index, ttl, src, dest, opcode, transport_pdu_data+1, transport_pdu_len-1);
5094802c66dSMatthias Ringwald         pdu = (mesh_pdu_t *) network_pdu;
51084242f88SMatthias Ringwald     } else {
5114802c66dSMatthias Ringwald         mesh_upper_transport_builder_t builder;
5124802c66dSMatthias Ringwald         mesh_upper_transport_message_init(&builder, MESH_PDU_TYPE_UPPER_SEGMENTED_CONTROL);
5134802c66dSMatthias Ringwald         mesh_upper_transport_message_add_data(&builder, transport_pdu_data+1, transport_pdu_len-1);
514*df71a9a4SMatthias Ringwald         mesh_upper_transport_pdu_t * final_upper_pdu = (mesh_upper_transport_pdu_t *) mesh_upper_transport_message_finalize(&builder);
515*df71a9a4SMatthias Ringwald         mesh_upper_transport_setup_segmented_control_pdu_header(final_upper_pdu, netkey_index, ttl, src, dest, opcode);
516*df71a9a4SMatthias Ringwald         pdu = (mesh_pdu_t *) final_upper_pdu;
51784242f88SMatthias Ringwald     }
51884242f88SMatthias Ringwald     mesh_upper_transport_send_control_pdu(pdu);
51984242f88SMatthias Ringwald 
52084242f88SMatthias Ringwald     // check for all network pdus
52184242f88SMatthias Ringwald     int i;
52284242f88SMatthias Ringwald     for (i=0;i<count;i++){
52384242f88SMatthias Ringwald         // expected network pdu
52484242f88SMatthias Ringwald         test_network_pdu_len = strlen(network_pdus[i]) / 2;
52584242f88SMatthias Ringwald         btstack_parse_hex(network_pdus[i], test_network_pdu_len, test_network_pdu_data);
52684242f88SMatthias Ringwald 
52784242f88SMatthias Ringwald #ifdef ENABLE_MESH_GATT_BEARER
528*df71a9a4SMatthias Ringwald         expect_gatt_network_pdu();
52984242f88SMatthias Ringwald #endif
53084242f88SMatthias Ringwald 
53184242f88SMatthias Ringwald #ifdef ENABLE_MESH_ADV_BEARER
532*df71a9a4SMatthias Ringwald         expect_adv_network_pdu();
53384242f88SMatthias Ringwald #endif
53484242f88SMatthias Ringwald 
53584242f88SMatthias Ringwald     }
53684242f88SMatthias Ringwald }
53784242f88SMatthias Ringwald #if 1
53884242f88SMatthias Ringwald // Message 1
53984242f88SMatthias Ringwald char * message1_network_pdus[] = {
54084242f88SMatthias Ringwald     (char *) "68eca487516765b5e5bfdacbaf6cb7fb6bff871f035444ce83a670df"
54184242f88SMatthias Ringwald };
54284242f88SMatthias Ringwald char * message1_lower_transport_pdus[] = {
54384242f88SMatthias Ringwald     (char *) "034b50057e400000010000",
54484242f88SMatthias Ringwald };
54584242f88SMatthias Ringwald char * message1_upper_transport_pdu = (char *) "034b50057e400000010000";
54684242f88SMatthias Ringwald TEST(MessageTest, Message1Receive){
54784242f88SMatthias Ringwald     load_network_key_nid_68();
54884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
54984242f88SMatthias Ringwald     test_receive_network_pdus(1, message1_network_pdus, message1_lower_transport_pdus, message1_upper_transport_pdu);
55084242f88SMatthias Ringwald }
55184242f88SMatthias Ringwald TEST(MessageTest, Message1Send){
55284242f88SMatthias Ringwald     uint16_t netkey_index = 0;
55384242f88SMatthias Ringwald     uint8_t  ttl          = 0;
55484242f88SMatthias Ringwald     uint16_t src          = 0x1201;
55584242f88SMatthias Ringwald     uint16_t dest         = 0xfffd;
55684242f88SMatthias Ringwald     uint32_t seq          = 1;
55784242f88SMatthias Ringwald     load_network_key_nid_68();
55884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
55984242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
56084242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message1_upper_transport_pdu, 1, message1_lower_transport_pdus, message1_network_pdus);
56184242f88SMatthias Ringwald }
56284242f88SMatthias Ringwald 
56384242f88SMatthias Ringwald // Message 2
56484242f88SMatthias Ringwald char * message2_network_pdus[] = {
56584242f88SMatthias Ringwald     (char *) "68d4c826296d7979d7dbc0c9b4d43eebec129d20a620d01e"
56684242f88SMatthias Ringwald };
56784242f88SMatthias Ringwald char * message2_lower_transport_pdus[] = {
56884242f88SMatthias Ringwald     (char *) "04320308ba072f",
56984242f88SMatthias Ringwald };
57084242f88SMatthias Ringwald char * message2_upper_transport_pdu = (char *) "04320308ba072f";
57184242f88SMatthias Ringwald TEST(MessageTest, Message2Receive){
57284242f88SMatthias Ringwald     load_network_key_nid_68();
57384242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
57484242f88SMatthias Ringwald     test_receive_network_pdus(1, message2_network_pdus, message2_lower_transport_pdus, message2_upper_transport_pdu);
57584242f88SMatthias Ringwald }
57684242f88SMatthias Ringwald TEST(MessageTest, Message2Send){
57784242f88SMatthias Ringwald     uint16_t netkey_index = 0;
57884242f88SMatthias Ringwald     uint8_t  ttl          = 0;
57984242f88SMatthias Ringwald     uint16_t src          = 0x2345;
58084242f88SMatthias Ringwald     uint16_t dest         = 0x1201;
58184242f88SMatthias Ringwald     uint32_t seq          = 0x014820;
58284242f88SMatthias Ringwald     load_network_key_nid_68();
58384242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
58484242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
58584242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message2_upper_transport_pdu, 1, message2_lower_transport_pdus, message2_network_pdus);
58684242f88SMatthias Ringwald }
58784242f88SMatthias Ringwald 
58884242f88SMatthias Ringwald // Message 3
58984242f88SMatthias Ringwald char * message3_network_pdus[] = {
59084242f88SMatthias Ringwald     (char *) "68da062bc96df253273086b8c5ee00bdd9cfcc62a2ddf572"
59184242f88SMatthias Ringwald };
59284242f88SMatthias Ringwald char * message3_lower_transport_pdus[] = {
59384242f88SMatthias Ringwald     (char *) "04fa0205a6000a",
59484242f88SMatthias Ringwald };
59584242f88SMatthias Ringwald char * message3_upper_transport_pdu = (char *) "04fa0205a6000a";
59684242f88SMatthias Ringwald TEST(MessageTest, Message3Receive){
59784242f88SMatthias Ringwald     load_network_key_nid_68();
59884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
59984242f88SMatthias Ringwald     test_receive_network_pdus(1, message3_network_pdus, message3_lower_transport_pdus, message3_upper_transport_pdu);
60084242f88SMatthias Ringwald }
60184242f88SMatthias Ringwald TEST(MessageTest, Message3Send){
60284242f88SMatthias Ringwald     uint16_t netkey_index = 0;
60384242f88SMatthias Ringwald     uint8_t  ttl          = 0;
60484242f88SMatthias Ringwald     uint16_t src          = 0x2fe3;
60584242f88SMatthias Ringwald     uint16_t dest         = 0x1201;
60684242f88SMatthias Ringwald     uint32_t seq          = 0x2b3832;
60784242f88SMatthias Ringwald     load_network_key_nid_68();
60884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
60984242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
61084242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message3_upper_transport_pdu, 1, message3_lower_transport_pdus, message3_network_pdus);
61184242f88SMatthias Ringwald }
61284242f88SMatthias Ringwald 
61384242f88SMatthias Ringwald // Message 4
61484242f88SMatthias Ringwald char * message4_network_pdus[] = {
61584242f88SMatthias Ringwald     (char *) "5e84eba092380fb0e5d0ad970d579a4e88051c"
61684242f88SMatthias Ringwald };
61784242f88SMatthias Ringwald char * message4_lower_transport_pdus[] = {
61884242f88SMatthias Ringwald     (char *) "0100",
61984242f88SMatthias Ringwald };
62084242f88SMatthias Ringwald char * message4_upper_transport_pdu = (char *) "0100";
62184242f88SMatthias Ringwald TEST(MessageTest, Message4Receive){
62284242f88SMatthias Ringwald     load_network_key_nid_5e();
62384242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
62484242f88SMatthias Ringwald     test_receive_network_pdus(1, message4_network_pdus, message4_lower_transport_pdus, message4_upper_transport_pdu);
62584242f88SMatthias Ringwald }
62684242f88SMatthias Ringwald TEST(MessageTest, Message4Send){
62784242f88SMatthias Ringwald     uint16_t netkey_index = 0;
62884242f88SMatthias Ringwald     uint8_t  ttl          = 0;
62984242f88SMatthias Ringwald     uint16_t src          = 0x1201;
63084242f88SMatthias Ringwald     uint16_t dest         = 0x2345;
63184242f88SMatthias Ringwald     uint32_t seq          = 0x000002;
63284242f88SMatthias Ringwald     load_network_key_nid_5e();
63384242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
63484242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
63584242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message4_upper_transport_pdu, 1, message4_lower_transport_pdus, message4_network_pdus);
63684242f88SMatthias Ringwald }
63784242f88SMatthias Ringwald 
63884242f88SMatthias Ringwald // Message 5
63984242f88SMatthias Ringwald char * message5_network_pdus[] = {
64084242f88SMatthias Ringwald     (char *) "5eafd6f53c43db5c39da1792b1fee9ec74b786c56d3a9dee",
64184242f88SMatthias Ringwald };
64284242f88SMatthias Ringwald char * message5_lower_transport_pdus[] = {
64384242f88SMatthias Ringwald     (char *) "02001234567800",
64484242f88SMatthias Ringwald };
64584242f88SMatthias Ringwald char * message5_upper_transport_pdu = (char *) "02001234567800";
64684242f88SMatthias Ringwald TEST(MessageTest, Message5Receive){
64784242f88SMatthias Ringwald     load_network_key_nid_5e();
64884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
64984242f88SMatthias Ringwald     test_receive_network_pdus(1, message5_network_pdus, message5_lower_transport_pdus, message5_upper_transport_pdu);
65084242f88SMatthias Ringwald }
65184242f88SMatthias Ringwald TEST(MessageTest, Message5Send){
65284242f88SMatthias Ringwald     uint16_t netkey_index = 0;
65384242f88SMatthias Ringwald     uint8_t  ttl          = 0;
65484242f88SMatthias Ringwald     uint16_t src          = 0x2345;
65584242f88SMatthias Ringwald     uint16_t dest         = 0x1201;
65684242f88SMatthias Ringwald     uint32_t seq          = 0x014834;
65784242f88SMatthias Ringwald     load_network_key_nid_5e();
65884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
65984242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
66084242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message5_upper_transport_pdu, 1, message5_lower_transport_pdus, message5_network_pdus);
66184242f88SMatthias Ringwald }
66284242f88SMatthias Ringwald 
66384242f88SMatthias Ringwald // Message 6
66484242f88SMatthias Ringwald char * message6_network_pdus[] = {
66584242f88SMatthias Ringwald     (char *) "68cab5c5348a230afba8c63d4e686364979deaf4fd40961145939cda0e",
66684242f88SMatthias Ringwald     (char *) "681615b5dd4a846cae0c032bf0746f44f1b8cc8ce5edc57e55beed49c0",
66784242f88SMatthias Ringwald };
66884242f88SMatthias Ringwald char * message6_lower_transport_pdus[] = {
66984242f88SMatthias Ringwald     (char *) "8026ac01ee9dddfd2169326d23f3afdf",
67084242f88SMatthias Ringwald     (char *) "8026ac21cfdc18c52fdef772e0e17308",
67184242f88SMatthias Ringwald };
67284242f88SMatthias Ringwald char * message6_upper_transport_pdu = (char *) "0056341263964771734fbd76e3b40519d1d94a48";
67384242f88SMatthias Ringwald TEST(MessageTest, Message6Receive){
67484242f88SMatthias Ringwald     load_network_key_nid_68();
67584242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
67684242f88SMatthias Ringwald     test_receive_network_pdus(2, message6_network_pdus, message6_lower_transport_pdus, message6_upper_transport_pdu);
67784242f88SMatthias Ringwald }
67884242f88SMatthias Ringwald TEST(MessageTest, Message6Send){
67984242f88SMatthias Ringwald     uint16_t netkey_index = 0;
68084242f88SMatthias Ringwald     uint16_t appkey_index = MESH_DEVICE_KEY_INDEX;
68184242f88SMatthias Ringwald     uint8_t  ttl          = 4;
68284242f88SMatthias Ringwald     uint16_t src          = 0x0003;
68384242f88SMatthias Ringwald     uint16_t dest         = 0x1201;
68484242f88SMatthias Ringwald     uint32_t seq          = 0x3129ab;
68584242f88SMatthias Ringwald     uint8_t  szmic        = 0;
68684242f88SMatthias Ringwald 
68784242f88SMatthias Ringwald     load_network_key_nid_68();
68884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
68984242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
69084242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, dest, szmic, message6_upper_transport_pdu, 2, message6_lower_transport_pdus, message6_network_pdus);
69184242f88SMatthias Ringwald }
69284242f88SMatthias Ringwald 
69384242f88SMatthias Ringwald // Message 7 - ACK
69484242f88SMatthias Ringwald char * message7_network_pdus[] = {
69584242f88SMatthias Ringwald     (char *) "68e476b5579c980d0d730f94d7f3509df987bb417eb7c05f",
69684242f88SMatthias Ringwald };
69784242f88SMatthias Ringwald char * message7_lower_transport_pdus[] = {
69884242f88SMatthias Ringwald     (char *) "00a6ac00000002",
69984242f88SMatthias Ringwald };
70084242f88SMatthias Ringwald char * message7_upper_transport_pdu = (char *) "00a6ac00000002";
70184242f88SMatthias Ringwald TEST(MessageTest, Message7Send){
70284242f88SMatthias Ringwald     uint16_t netkey_index = 0;
70384242f88SMatthias Ringwald     uint8_t  ttl          = 0x0b;
70484242f88SMatthias Ringwald     uint16_t src          = 0x2345;
70584242f88SMatthias Ringwald     uint16_t dest         = 0x0003;
70684242f88SMatthias Ringwald     uint32_t seq          = 0x014835;
70784242f88SMatthias Ringwald 
70884242f88SMatthias Ringwald     load_network_key_nid_68();
70984242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
71084242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
71184242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message7_upper_transport_pdu, 1, message7_lower_transport_pdus, message7_network_pdus);
71284242f88SMatthias Ringwald }
71384242f88SMatthias Ringwald // ACK message, handled in mesh_transport - can be checked with test_control_receive_network_pdu
71484242f88SMatthias Ringwald // TEST(MessageTest, Message7Receive){
71584242f88SMatthias Ringwald //     mesh_set_iv_index(0x12345678);
71684242f88SMatthias Ringwald //     test_receive_network_pdus(1, message7_network_pdus, message7_lower_transport_pdus, message7_upper_transport_pdu);
71784242f88SMatthias Ringwald // }
71884242f88SMatthias Ringwald 
71984242f88SMatthias Ringwald // Message 8 - ACK
72084242f88SMatthias Ringwald char * message8_network_pdus[] = {
72184242f88SMatthias Ringwald     (char *) "684daa6267c2cf0e2f91add6f06e66006844cec97f973105ae2534f958",
72284242f88SMatthias Ringwald };
72384242f88SMatthias Ringwald char * message8_lower_transport_pdus[] = {
72484242f88SMatthias Ringwald     (char *) "8026ac01ee9dddfd2169326d23f3afdf",
72584242f88SMatthias Ringwald };
72684242f88SMatthias Ringwald char * message8_upper_transport_pdu = (char *) "8026ac01ee9dddfd2169326d23f3afdf";
72784242f88SMatthias Ringwald // ACK message, handled in mesh_transport - can be checked with test_control_receive_network_pdu
72884242f88SMatthias Ringwald // TEST(MessageTest, Message8Receive){
72984242f88SMatthias Ringwald //     mesh_set_iv_index(0x12345678);
73084242f88SMatthias Ringwald //     test_receive_network_pdus(1, message8_network_pdus, message8_lower_transport_pdus, message8_upper_transport_pdu);
73184242f88SMatthias Ringwald // }
73284242f88SMatthias Ringwald 
73384242f88SMatthias Ringwald // Message 9 - ACK
73484242f88SMatthias Ringwald 
73584242f88SMatthias Ringwald // Message 10
73684242f88SMatthias Ringwald char * message10_network_pdus[] = {
73784242f88SMatthias Ringwald     (char *) "5e7b786568759f7777ed355afaf66d899c1e3d",
73884242f88SMatthias Ringwald };
73984242f88SMatthias Ringwald char * message10_lower_transport_pdus[] = {
74084242f88SMatthias Ringwald     (char *) "0101",
74184242f88SMatthias Ringwald };
74284242f88SMatthias Ringwald char * message10_upper_transport_pdu = (char *) "0101";
74384242f88SMatthias Ringwald TEST(MessageTest, Message10Receive){
74484242f88SMatthias Ringwald     load_network_key_nid_5e();
74584242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
74684242f88SMatthias Ringwald     test_receive_network_pdus(1, message10_network_pdus, message10_lower_transport_pdus, message10_upper_transport_pdu);
74784242f88SMatthias Ringwald }
74884242f88SMatthias Ringwald TEST(MessageTest, Message10Send){
74984242f88SMatthias Ringwald     uint16_t netkey_index = 0;
75084242f88SMatthias Ringwald     uint8_t  ttl          = 0;
75184242f88SMatthias Ringwald     uint16_t src          = 0x1201;
75284242f88SMatthias Ringwald     uint16_t dest         = 0x2345;
75384242f88SMatthias Ringwald     uint32_t seq          = 0x000003;
75484242f88SMatthias Ringwald 
75584242f88SMatthias Ringwald     load_network_key_nid_5e();
75684242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
75784242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
75884242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message10_upper_transport_pdu, 1, message10_lower_transport_pdus, message10_network_pdus);
75984242f88SMatthias Ringwald }
76084242f88SMatthias Ringwald 
76184242f88SMatthias Ringwald // Message 11
76284242f88SMatthias Ringwald // The Friend node responds to this poll with the first segment of the stored message. It also indicates that it has more data.
76384242f88SMatthias Ringwald 
76484242f88SMatthias Ringwald // Message 12
76584242f88SMatthias Ringwald char * message12_network_pdus[] = {
76684242f88SMatthias Ringwald     (char *) "5e8a18fc6e4d05ae21466087599c2426ce9a35",
76784242f88SMatthias Ringwald };
76884242f88SMatthias Ringwald char * message12_lower_transport_pdus[] = {
76984242f88SMatthias Ringwald     (char *) "0101",
77084242f88SMatthias Ringwald };
77184242f88SMatthias Ringwald char * message12_upper_transport_pdu = (char *) "0101";
77284242f88SMatthias Ringwald TEST(MessageTest, Message12Receive){
77384242f88SMatthias Ringwald     load_network_key_nid_5e();
77484242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
77584242f88SMatthias Ringwald     test_receive_network_pdus(1, message12_network_pdus, message12_lower_transport_pdus, message12_upper_transport_pdu);
77684242f88SMatthias Ringwald }
77784242f88SMatthias Ringwald TEST(MessageTest, Message12Send){
77884242f88SMatthias Ringwald     uint16_t netkey_index = 0;
77984242f88SMatthias Ringwald     uint8_t  ttl          = 0;
78084242f88SMatthias Ringwald     uint16_t src          = 0x1201;
78184242f88SMatthias Ringwald     uint16_t dest         = 0x2345;
78284242f88SMatthias Ringwald     uint32_t seq          = 0x000004;
78384242f88SMatthias Ringwald 
78484242f88SMatthias Ringwald     load_network_key_nid_5e();
78584242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
78684242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
78784242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message12_upper_transport_pdu, 1, message12_lower_transport_pdus, message12_network_pdus);
78884242f88SMatthias Ringwald }
78984242f88SMatthias Ringwald 
79084242f88SMatthias Ringwald // Message 13
79184242f88SMatthias Ringwald // The Friend node responds with the same message as last time.
79284242f88SMatthias Ringwald // Message 14
79384242f88SMatthias Ringwald // The Low Power node received the retransmitted stored message. As that message has the MD bit set
79484242f88SMatthias Ringwald // it sends another Friend Poll to obtain the next message.
79584242f88SMatthias Ringwald char * message14_network_pdus[] = {
79684242f88SMatthias Ringwald     (char *) "5e0bbaf92b5c8f7d3ae62a3c75dff683dce24e",
79784242f88SMatthias Ringwald };
79884242f88SMatthias Ringwald char * message14_lower_transport_pdus[] = {
79984242f88SMatthias Ringwald     (char *) "0100",
80084242f88SMatthias Ringwald };
80184242f88SMatthias Ringwald char * message14_upper_transport_pdu = (char *) "0100";
80284242f88SMatthias Ringwald TEST(MessageTest, Message14Receive){
80384242f88SMatthias Ringwald     load_network_key_nid_5e();
80484242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
80584242f88SMatthias Ringwald     test_receive_network_pdus(1, message14_network_pdus, message14_lower_transport_pdus, message14_upper_transport_pdu);
80684242f88SMatthias Ringwald }
80784242f88SMatthias Ringwald TEST(MessageTest, Message14Send){
80884242f88SMatthias Ringwald     uint16_t netkey_index = 0;
80984242f88SMatthias Ringwald     uint8_t  ttl          = 0;
81084242f88SMatthias Ringwald     uint16_t src          = 0x1201;
81184242f88SMatthias Ringwald     uint16_t dest         = 0x2345;
81284242f88SMatthias Ringwald     uint32_t seq          = 0x000005;
81384242f88SMatthias Ringwald 
81484242f88SMatthias Ringwald     load_network_key_nid_5e();
81584242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
81684242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
81784242f88SMatthias Ringwald     test_send_control_message(netkey_index, ttl, src, dest, message14_upper_transport_pdu, 1, message14_lower_transport_pdus, message14_network_pdus);
81884242f88SMatthias Ringwald }
81984242f88SMatthias Ringwald 
82084242f88SMatthias Ringwald // Message 15
82184242f88SMatthias Ringwald // The Friend node responds, with the next message in the friend queue. The Friend node has no more data, so it sets the MD to 0.
82284242f88SMatthias Ringwald char * message15_network_pdus[] = {
82384242f88SMatthias Ringwald     (char *) "5ea8dab50e7ee7f1d29805664d235eacd707217dedfe78497fefec7391",
82484242f88SMatthias Ringwald };
82584242f88SMatthias Ringwald char * message15_lower_transport_pdus[] = {
82684242f88SMatthias Ringwald     (char *) "8026ac21cfdc18c52fdef772e0e17308",
82784242f88SMatthias Ringwald };
82884242f88SMatthias Ringwald char * message15_upper_transport_pdu = (char *) "0100";
82984242f88SMatthias Ringwald // ACK message, handled in mesh_transport - can be checked with test_control_receive_network_pdu
83084242f88SMatthias Ringwald // not sure - no upper access message
83184242f88SMatthias Ringwald // TEST(MessageTest, Message15Receive){
83284242f88SMatthias Ringwald //     load_network_key_nid_5e();
83384242f88SMatthias Ringwald //     mesh_set_iv_index(0x12345678);
83484242f88SMatthias Ringwald //     test_receive_network_pdus(1, message15_network_pdus, message15_lower_transport_pdus, message15_upper_transport_pdu);
83584242f88SMatthias Ringwald // }
83684242f88SMatthias Ringwald 
83784242f88SMatthias Ringwald // Message 16
83884242f88SMatthias Ringwald char * message16_network_pdus[] = {
83984242f88SMatthias Ringwald     (char *) "68e80e5da5af0e6b9be7f5a642f2f98680e61c3a8b47f228",
84084242f88SMatthias Ringwald };
84184242f88SMatthias Ringwald char * message16_lower_transport_pdus[] = {
84284242f88SMatthias Ringwald     (char *) "0089511bf1d1a81c11dcef",
84384242f88SMatthias Ringwald };
84484242f88SMatthias Ringwald char * message16_upper_transport_pdu = (char *) "800300563412";
84584242f88SMatthias Ringwald TEST(MessageTest, Message16Receive){
84684242f88SMatthias Ringwald     load_network_key_nid_68();
84784242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
84884242f88SMatthias Ringwald     test_receive_network_pdus(1, message16_network_pdus, message16_lower_transport_pdus, message16_upper_transport_pdu);
84984242f88SMatthias Ringwald }
85084242f88SMatthias Ringwald TEST(MessageTest, Message16Send){
85184242f88SMatthias Ringwald     uint16_t netkey_index = 0;
85284242f88SMatthias Ringwald     uint16_t appkey_index = MESH_DEVICE_KEY_INDEX;
85384242f88SMatthias Ringwald     uint8_t  ttl          = 0x0b;
85484242f88SMatthias Ringwald     uint16_t src          = 0x1201;
85584242f88SMatthias Ringwald     uint16_t dest         = 0x0003;
85684242f88SMatthias Ringwald     uint32_t seq          = 0x000006;
85784242f88SMatthias Ringwald     uint8_t  szmic        = 0;
85884242f88SMatthias Ringwald 
85984242f88SMatthias Ringwald     load_network_key_nid_68();
86084242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
86184242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
86284242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, dest, szmic, message16_upper_transport_pdu, 1, message16_lower_transport_pdus, message16_network_pdus);
86384242f88SMatthias Ringwald }
86484242f88SMatthias Ringwald 
86584242f88SMatthias Ringwald // Message 17
86684242f88SMatthias Ringwald // A Relay node receives the message from the Low Power node and relays it, decrementing the TTL value.
86784242f88SMatthias Ringwald // Message 18
86884242f88SMatthias Ringwald char * message18_network_pdus[] = {
86984242f88SMatthias Ringwald     (char *) "6848cba437860e5673728a627fb938535508e21a6baf57",
87084242f88SMatthias Ringwald };
87184242f88SMatthias Ringwald char * message18_lower_transport_pdus[] = {
87284242f88SMatthias Ringwald     (char *) "665a8bde6d9106ea078a",
87384242f88SMatthias Ringwald };
87484242f88SMatthias Ringwald char * message18_upper_transport_pdu = (char *) "0400000000";
87584242f88SMatthias Ringwald TEST(MessageTest, Message18Receive){
87684242f88SMatthias Ringwald     load_network_key_nid_68();
87784242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
87884242f88SMatthias Ringwald     test_receive_network_pdus(1, message18_network_pdus, message18_lower_transport_pdus, message18_upper_transport_pdu);
87984242f88SMatthias Ringwald }
88084242f88SMatthias Ringwald TEST(MessageTest, Message18Send){
88184242f88SMatthias Ringwald     uint16_t netkey_index = 0;
88284242f88SMatthias Ringwald     uint16_t appkey_index = 0;
88384242f88SMatthias Ringwald     uint8_t  ttl          = 3;
88484242f88SMatthias Ringwald     uint16_t src          = 0x1201;
88584242f88SMatthias Ringwald     uint16_t dest         = 0xffff;
88684242f88SMatthias Ringwald     uint32_t seq          = 0x00007;
88784242f88SMatthias Ringwald     uint8_t  szmic        = 0;
88884242f88SMatthias Ringwald 
88984242f88SMatthias Ringwald     load_network_key_nid_68();
89084242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
89184242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
89284242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, dest, szmic, message18_upper_transport_pdu, 1, message18_lower_transport_pdus, message18_network_pdus);
89384242f88SMatthias Ringwald }
89484242f88SMatthias Ringwald 
89584242f88SMatthias Ringwald 
89684242f88SMatthias Ringwald // Message 19
89784242f88SMatthias Ringwald // The Low Power node sends another Health Current Status message indicating that there are three faults:
89884242f88SMatthias Ringwald // Battery Low Warning, Power Supply Interrupted Warning, and Supply Voltage Too Low Warning.
89984242f88SMatthias Ringwald char * message19_network_pdus[] = {
90084242f88SMatthias Ringwald     (char *) "68110edeecd83c3010a05e1b23a926023da75d25ba91793736",
90184242f88SMatthias Ringwald };
90284242f88SMatthias Ringwald char * message19_lower_transport_pdus[] = {
90384242f88SMatthias Ringwald     (char *) "66ca6cd88e698d1265f43fc5",
90484242f88SMatthias Ringwald };
90584242f88SMatthias Ringwald char * message19_upper_transport_pdu = (char *) "04000000010703";
90684242f88SMatthias Ringwald TEST(MessageTest, Message19Receive){
90784242f88SMatthias Ringwald     load_network_key_nid_68();
90884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
90984242f88SMatthias Ringwald     test_receive_network_pdus(1, message19_network_pdus, message19_lower_transport_pdus, message19_upper_transport_pdu);
91084242f88SMatthias Ringwald }
91184242f88SMatthias Ringwald TEST(MessageTest, Message19Send){
91284242f88SMatthias Ringwald     uint16_t netkey_index = 0;
91384242f88SMatthias Ringwald     uint16_t appkey_index = 0;
91484242f88SMatthias Ringwald     uint8_t  ttl          = 3;
91584242f88SMatthias Ringwald     uint16_t src          = 0x1201;
91684242f88SMatthias Ringwald     uint16_t dest         = 0xffff;
91784242f88SMatthias Ringwald     uint32_t seq          = 0x00009;
91884242f88SMatthias Ringwald     uint8_t  szmic        = 0;
91984242f88SMatthias Ringwald 
92084242f88SMatthias Ringwald     load_network_key_nid_68();
92184242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
92284242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
92384242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, dest, szmic, message19_upper_transport_pdu, 1, message19_lower_transport_pdus, message19_network_pdus);
92484242f88SMatthias Ringwald }
92584242f88SMatthias Ringwald 
92684242f88SMatthias Ringwald // Message 20
92784242f88SMatthias Ringwald char * message20_network_pdus[] = {
92884242f88SMatthias Ringwald     (char *) "e85cca51e2e8998c3dc87344a16c787f6b08cc897c941a5368",
92984242f88SMatthias Ringwald };
93084242f88SMatthias Ringwald char * message20_lower_transport_pdus[] = {
93184242f88SMatthias Ringwald     (char *) "669c9803e110fea929e9542d",
93284242f88SMatthias Ringwald };
93384242f88SMatthias Ringwald char * message20_upper_transport_pdu = (char *) "04000000010703";
93484242f88SMatthias Ringwald TEST(MessageTest, Message20Receive){
93584242f88SMatthias Ringwald     load_network_key_nid_68();
93684242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
93784242f88SMatthias Ringwald     test_receive_network_pdus(1, message20_network_pdus, message20_lower_transport_pdus, message20_upper_transport_pdu);
93884242f88SMatthias Ringwald }
93984242f88SMatthias Ringwald TEST(MessageTest, Message20Send){
94084242f88SMatthias Ringwald     uint16_t netkey_index = 0;
94184242f88SMatthias Ringwald     uint16_t appkey_index = 0;
94284242f88SMatthias Ringwald     uint8_t  ttl          = 3;
94384242f88SMatthias Ringwald     uint16_t src          = 0x1234;
94484242f88SMatthias Ringwald     uint16_t dest         = 0xffff;
94584242f88SMatthias Ringwald     uint32_t seq          = 0x070809;
94684242f88SMatthias Ringwald     uint8_t  szmic        = 0;
94784242f88SMatthias Ringwald 
94884242f88SMatthias Ringwald     load_network_key_nid_68();
94984242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
95084242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
95184242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, dest, szmic, message20_upper_transport_pdu, 1, message20_lower_transport_pdus, message20_network_pdus);
95284242f88SMatthias Ringwald }
95384242f88SMatthias Ringwald 
95484242f88SMatthias Ringwald // Message 21
95584242f88SMatthias Ringwald // The Low Power node sends a vendor command to a group address.
95684242f88SMatthias Ringwald char * message21_network_pdus[] = {
95784242f88SMatthias Ringwald     (char *) "e84e8fbe003f58a4d61157bb76352ea6307eebfe0f30b83500e9",
95884242f88SMatthias Ringwald };
95984242f88SMatthias Ringwald char * message21_lower_transport_pdus[] = {
96084242f88SMatthias Ringwald     (char *) "664d92e9dfcf3ab85b6e8fcf03",
96184242f88SMatthias Ringwald };
96284242f88SMatthias Ringwald char * message21_upper_transport_pdu = (char *) "d50a0048656c6c6f";
96384242f88SMatthias Ringwald TEST(MessageTest, Message21Receive){
96484242f88SMatthias Ringwald     load_network_key_nid_68();
96584242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
96684242f88SMatthias Ringwald     test_receive_network_pdus(1, message21_network_pdus, message21_lower_transport_pdus, message21_upper_transport_pdu);
96784242f88SMatthias Ringwald }
96884242f88SMatthias Ringwald TEST(MessageTest, Message21Send){
96984242f88SMatthias Ringwald     uint16_t netkey_index = 0;
97084242f88SMatthias Ringwald     uint16_t appkey_index = 0;
97184242f88SMatthias Ringwald     uint8_t  ttl          = 3;
97284242f88SMatthias Ringwald     uint16_t src          = 0x1234;
97384242f88SMatthias Ringwald     uint16_t dest         = 0xc105;
97484242f88SMatthias Ringwald     uint32_t seq          = 0x07080a;
97584242f88SMatthias Ringwald     uint8_t  szmic        = 0;
97684242f88SMatthias Ringwald 
97784242f88SMatthias Ringwald     load_network_key_nid_68();
97884242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
97984242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
98084242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, dest, szmic, message21_upper_transport_pdu, 1, message21_lower_transport_pdus, message21_network_pdus);
98184242f88SMatthias Ringwald }
98284242f88SMatthias Ringwald 
98384242f88SMatthias Ringwald // Message 22
98484242f88SMatthias Ringwald char * message22_network_pdus[] = {
98584242f88SMatthias Ringwald     (char *) "e8d85caecef1e3ed31f3fdcf88a411135fea55df730b6b28e255",
98684242f88SMatthias Ringwald };
98784242f88SMatthias Ringwald char * message22_lower_transport_pdus[] = {
98884242f88SMatthias Ringwald     (char *) "663871b904d431526316ca48a0",
98984242f88SMatthias Ringwald };
99084242f88SMatthias Ringwald char * message22_upper_transport_pdu = (char *) "d50a0048656c6c6f";
99184242f88SMatthias Ringwald char * message22_label_string = (char *) "0073e7e4d8b9440faf8415df4c56c0e1";
99284242f88SMatthias Ringwald 
99384242f88SMatthias Ringwald TEST(MessageTest, Message22Receive){
99484242f88SMatthias Ringwald     load_network_key_nid_68();
99584242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
99684242f88SMatthias Ringwald     uint8_t label_uuid[16];
99784242f88SMatthias Ringwald     btstack_parse_hex(message22_label_string, 16, label_uuid);
99884242f88SMatthias Ringwald     mesh_virtual_address_register(label_uuid, 0xb529);
99984242f88SMatthias Ringwald     test_receive_network_pdus(1, message22_network_pdus, message22_lower_transport_pdus, message22_upper_transport_pdu);
100084242f88SMatthias Ringwald }
100184242f88SMatthias Ringwald 
100284242f88SMatthias Ringwald TEST(MessageTest, Message22Send){
100384242f88SMatthias Ringwald     uint16_t netkey_index = 0;
100484242f88SMatthias Ringwald     uint16_t appkey_index = 0;
100584242f88SMatthias Ringwald     uint8_t  ttl          = 3;
100684242f88SMatthias Ringwald     uint16_t src          = 0x1234;
100784242f88SMatthias Ringwald     uint32_t seq          = 0x07080b;
100884242f88SMatthias Ringwald     uint8_t  szmic        = 0;
100984242f88SMatthias Ringwald 
101084242f88SMatthias Ringwald     load_network_key_nid_68();
101184242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
101284242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
101384242f88SMatthias Ringwald     uint8_t label_uuid[16];
101484242f88SMatthias Ringwald     btstack_parse_hex(message22_label_string, 16, label_uuid);
101584242f88SMatthias Ringwald     mesh_virtual_address_t * virtual_address = mesh_virtual_address_register(label_uuid, 0xb529);
101684242f88SMatthias Ringwald     uint16_t pseudo_dst = virtual_address->pseudo_dst;
101784242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, pseudo_dst, szmic, message22_upper_transport_pdu, 1, message22_lower_transport_pdus, message22_network_pdus);
101884242f88SMatthias Ringwald }
101984242f88SMatthias Ringwald 
102084242f88SMatthias Ringwald // Message 23
102184242f88SMatthias Ringwald char * message23_network_pdus[] = {
102284242f88SMatthias Ringwald     (char *) "e877a48dd5fe2d7a9d696d3dd16a75489696f0b70c711b881385",
102384242f88SMatthias Ringwald };
102484242f88SMatthias Ringwald char * message23_lower_transport_pdus[] = {
102584242f88SMatthias Ringwald     (char *) "662456db5e3100eef65daa7a38",
102684242f88SMatthias Ringwald };
102784242f88SMatthias Ringwald char * message23_upper_transport_pdu = (char *) "d50a0048656c6c6f";
102884242f88SMatthias Ringwald char * message23_label_string = (char *) "f4a002c7fb1e4ca0a469a021de0db875";
102984242f88SMatthias Ringwald 
103084242f88SMatthias Ringwald TEST(MessageTest, Message23Receive){
103184242f88SMatthias Ringwald     load_network_key_nid_68();
103284242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
103384242f88SMatthias Ringwald     uint8_t label_uuid[16];
103484242f88SMatthias Ringwald     btstack_parse_hex(message23_label_string, 16, label_uuid);
103584242f88SMatthias Ringwald     mesh_virtual_address_register(label_uuid, 0x9736);
103684242f88SMatthias Ringwald     test_receive_network_pdus(1, message23_network_pdus, message23_lower_transport_pdus, message23_upper_transport_pdu);
103784242f88SMatthias Ringwald }
103884242f88SMatthias Ringwald TEST(MessageTest, Message23Send){
103984242f88SMatthias Ringwald     uint16_t netkey_index = 0;
104084242f88SMatthias Ringwald     uint16_t appkey_index = 0;
104184242f88SMatthias Ringwald     uint8_t  ttl          = 3;
104284242f88SMatthias Ringwald     uint16_t src          = 0x1234;
104384242f88SMatthias Ringwald     uint32_t seq          = 0x07080c;
104484242f88SMatthias Ringwald     uint8_t  szmic        = 0;
104584242f88SMatthias Ringwald 
104684242f88SMatthias Ringwald     load_network_key_nid_68();
104784242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
104884242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
104984242f88SMatthias Ringwald     uint8_t label_uuid[16];
105084242f88SMatthias Ringwald     btstack_parse_hex(message23_label_string, 16, label_uuid);
105184242f88SMatthias Ringwald     mesh_virtual_address_t * virtual_address = mesh_virtual_address_register(label_uuid, 0x9736);
105284242f88SMatthias Ringwald     uint16_t pseudo_dst = virtual_address->pseudo_dst;
105384242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, pseudo_dst, szmic, message23_upper_transport_pdu, 1, message23_lower_transport_pdus, message23_network_pdus);
105484242f88SMatthias Ringwald }
105584242f88SMatthias Ringwald #endif
105684242f88SMatthias Ringwald 
105784242f88SMatthias Ringwald // Message 24
105884242f88SMatthias Ringwald char * message24_network_pdus[] = {
105984242f88SMatthias Ringwald     (char *) "e8624e65bb8c1794e998b4081f47a35251fdd3896d99e4db489b918599",
106084242f88SMatthias Ringwald     (char *) "e8a7d0f0a2ea42dc2f4dd6fb4db33a6c088d023b47",
106184242f88SMatthias Ringwald };
106284242f88SMatthias Ringwald char * message24_lower_transport_pdus[] = {
106384242f88SMatthias Ringwald     (char *) "e6a03401c3c51d8e476b28e3aa5001f3",
106484242f88SMatthias Ringwald     (char *) "e6a034211c01cea6",
106584242f88SMatthias Ringwald };
106684242f88SMatthias Ringwald char * message24_upper_transport_pdu = (char *) "ea0a00576f726c64";
106784242f88SMatthias Ringwald char * message24_label_string = (char *) "f4a002c7fb1e4ca0a469a021de0db875";
106884242f88SMatthias Ringwald TEST(MessageTest, Message24Receive){
106984242f88SMatthias Ringwald     load_network_key_nid_68();
107084242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
107184242f88SMatthias Ringwald     uint8_t label_uuid[16];
107284242f88SMatthias Ringwald     btstack_parse_hex(message24_label_string, 16, label_uuid);
107384242f88SMatthias Ringwald     mesh_virtual_address_register(label_uuid, 0x9736);
107484242f88SMatthias Ringwald     test_receive_network_pdus(2, message24_network_pdus, message24_lower_transport_pdus, message24_upper_transport_pdu);
107584242f88SMatthias Ringwald }
107684242f88SMatthias Ringwald TEST(MessageTest, Message24Send){
107784242f88SMatthias Ringwald     uint16_t netkey_index = 0;
107884242f88SMatthias Ringwald     uint16_t appkey_index = 0;
107984242f88SMatthias Ringwald     uint8_t  ttl          = 3;
108084242f88SMatthias Ringwald     uint16_t src          = 0x1234;
108184242f88SMatthias Ringwald     uint32_t seq          = 0x07080d;
108284242f88SMatthias Ringwald     uint8_t  szmic        = 1;
108384242f88SMatthias Ringwald 
108484242f88SMatthias Ringwald     load_network_key_nid_68();
108584242f88SMatthias Ringwald     mesh_set_iv_index(0x12345677);
108684242f88SMatthias Ringwald     mesh_sequence_number_set(seq);
108784242f88SMatthias Ringwald     uint8_t label_uuid[16];
108884242f88SMatthias Ringwald     btstack_parse_hex(message24_label_string, 16, label_uuid);
108984242f88SMatthias Ringwald     mesh_virtual_address_t * virtual_address = mesh_virtual_address_register(label_uuid, 0x9736);
109084242f88SMatthias Ringwald     uint16_t pseudo_dst = virtual_address->pseudo_dst;
109184242f88SMatthias Ringwald     test_send_access_message(netkey_index, appkey_index, ttl, src, pseudo_dst, szmic, message24_upper_transport_pdu, 2, message24_lower_transport_pdus, message24_network_pdus);
109284242f88SMatthias Ringwald }
109384242f88SMatthias Ringwald 
109484242f88SMatthias Ringwald // Proxy Configuration Test
109584242f88SMatthias Ringwald char * proxy_config_pdus[] = {
109684242f88SMatthias Ringwald     (char *) "0210386bd60efbbb8b8c28512e792d3711f4b526",
109784242f88SMatthias Ringwald };
109884242f88SMatthias Ringwald char * proxy_config_lower_transport_pdus[] = {
109984242f88SMatthias Ringwald     (char *) "0000",
110084242f88SMatthias Ringwald };
110184242f88SMatthias Ringwald char * proxy_config_upper_transport_pdu = (char *) "ea0a00576f726c64";
110284242f88SMatthias Ringwald TEST(MessageTest, ProxyConfigReceive){
110384242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
110484242f88SMatthias Ringwald     load_network_key_nid_10();
110584242f88SMatthias Ringwald     int i = 0;
110684242f88SMatthias Ringwald     char ** network_pdus = proxy_config_pdus;
110784242f88SMatthias Ringwald     test_network_pdu_len = strlen(network_pdus[i]) / 2;
110884242f88SMatthias Ringwald     btstack_parse_hex(network_pdus[i], test_network_pdu_len, test_network_pdu_data);
110984242f88SMatthias Ringwald     mesh_network_process_proxy_configuration_message(&test_network_pdu_data[1], test_network_pdu_len-1);
111084242f88SMatthias Ringwald     while (received_proxy_pdu == NULL) {
111184242f88SMatthias Ringwald         mock_process_hci_cmd();
111284242f88SMatthias Ringwald     }
111384242f88SMatthias Ringwald     char ** lower_transport_pdus = proxy_config_lower_transport_pdus;
111484242f88SMatthias Ringwald     transport_pdu_len = strlen(lower_transport_pdus[i]) / 2;
111584242f88SMatthias Ringwald     btstack_parse_hex(lower_transport_pdus[i], transport_pdu_len, transport_pdu_data);
111684242f88SMatthias Ringwald 
111784242f88SMatthias Ringwald     uint8_t * lower_transport_pdu     = mesh_network_pdu_data(received_proxy_pdu);
111884242f88SMatthias Ringwald     uint8_t   lower_transport_pdu_len = mesh_network_pdu_len(received_proxy_pdu);
111984242f88SMatthias Ringwald 
112084242f88SMatthias Ringwald     // printf_hexdump(lower_transport_pdu, lower_transport_pdu_len);
112184242f88SMatthias Ringwald 
112284242f88SMatthias Ringwald     CHECK_EQUAL( transport_pdu_len, lower_transport_pdu_len);
112384242f88SMatthias Ringwald     CHECK_EQUAL_ARRAY(transport_pdu_data, lower_transport_pdu, transport_pdu_len);
112484242f88SMatthias Ringwald 
112584242f88SMatthias Ringwald     // done
112684242f88SMatthias Ringwald     mesh_network_message_processed_by_higher_layer(received_proxy_pdu);
112784242f88SMatthias Ringwald     received_proxy_pdu = NULL;
112884242f88SMatthias Ringwald }
112984242f88SMatthias Ringwald 
113084242f88SMatthias Ringwald 
113184242f88SMatthias Ringwald TEST(MessageTest, ProxyConfigSend){
113284242f88SMatthias Ringwald     uint16_t netkey_index = 0;
113384242f88SMatthias Ringwald     uint8_t  ctl          = 1;
113484242f88SMatthias Ringwald     uint8_t  ttl          = 0;
113584242f88SMatthias Ringwald     uint16_t src          = 1;
113684242f88SMatthias Ringwald     uint16_t dest         = 0;
113784242f88SMatthias Ringwald     uint32_t seq          = 1;
113884242f88SMatthias Ringwald     uint8_t  nid          = 0x10;
113984242f88SMatthias Ringwald     mesh_set_iv_index(0x12345678);
114084242f88SMatthias Ringwald     load_network_key_nid_10();
114184242f88SMatthias Ringwald     mesh_network_pdu_t * network_pdu = mesh_network_pdu_get();
114284242f88SMatthias Ringwald     uint8_t data[] = { 0 , 0 };
114384242f88SMatthias Ringwald     mesh_network_setup_pdu(network_pdu, netkey_index, nid, ctl, ttl, seq, src, dest, data, sizeof(data));
11441aa2a11eSMatthias Ringwald     mesh_network_encrypt_proxy_configuration_message(network_pdu);
114584242f88SMatthias Ringwald     while (received_proxy_pdu == NULL) {
114684242f88SMatthias Ringwald         mock_process_hci_cmd();
114784242f88SMatthias Ringwald     }
114884242f88SMatthias Ringwald     uint8_t * proxy_pdu_data  = received_proxy_pdu->data;
114984242f88SMatthias Ringwald     uint8_t   proxy_pdu_len   = received_proxy_pdu->len;
115084242f88SMatthias Ringwald 
115184242f88SMatthias Ringwald     int i = 0;
115284242f88SMatthias Ringwald     char ** network_pdus = proxy_config_pdus;
115384242f88SMatthias Ringwald     transport_pdu_len = strlen(network_pdus[i]) / 2;
115484242f88SMatthias Ringwald     btstack_parse_hex(network_pdus[i], transport_pdu_len, transport_pdu_data);
115584242f88SMatthias Ringwald 
115684242f88SMatthias Ringwald     CHECK_EQUAL( transport_pdu_len-1, proxy_pdu_len);
115784242f88SMatthias Ringwald     CHECK_EQUAL_ARRAY(transport_pdu_data+1, proxy_pdu_data, transport_pdu_len-1);
115884242f88SMatthias Ringwald 
115984242f88SMatthias Ringwald     received_proxy_pdu = NULL;
116084242f88SMatthias Ringwald 
116184242f88SMatthias Ringwald     mesh_network_pdu_free(network_pdu);
116284242f88SMatthias Ringwald }
116384242f88SMatthias Ringwald 
116484242f88SMatthias Ringwald static btstack_crypto_aes128_t crypto_request_aes128;
116584242f88SMatthias Ringwald static uint8_t plaintext[16];
116684242f88SMatthias Ringwald static uint8_t identity_key[16];
116784242f88SMatthias Ringwald static uint8_t hash[16];
116884242f88SMatthias Ringwald static uint8_t random_value[8];
116984242f88SMatthias Ringwald 
117084242f88SMatthias Ringwald static void mesh_proxy_handle_get_aes128(void * arg){
117184242f88SMatthias Ringwald     UNUSED(arg);
117284242f88SMatthias Ringwald     uint8_t expected_hash[8];
117384242f88SMatthias Ringwald     uint8_t expected_random_value[8];
117484242f88SMatthias Ringwald 
117584242f88SMatthias Ringwald     btstack_parse_hex("00861765aefcc57b", 8, expected_hash);
117684242f88SMatthias Ringwald     CHECK_EQUAL_ARRAY(&hash[8], expected_hash, 8);
117784242f88SMatthias Ringwald 
117884242f88SMatthias Ringwald     btstack_parse_hex("34ae608fbbc1f2c6", 8, expected_random_value);
117984242f88SMatthias Ringwald     CHECK_EQUAL_ARRAY(random_value, expected_random_value, 8);
118084242f88SMatthias Ringwald }
118184242f88SMatthias Ringwald 
118284242f88SMatthias Ringwald TEST(MessageTest, ServiceDataUsingNodeIdentityTest){
118384242f88SMatthias Ringwald     btstack_parse_hex("34ae608fbbc1f2c6", 8, random_value);
118484242f88SMatthias Ringwald     memset(plaintext, 0, sizeof(plaintext));
118584242f88SMatthias Ringwald     memcpy(&plaintext[6] , random_value, 8);
118684242f88SMatthias Ringwald     big_endian_store_16(plaintext, 14, 0x1201);
118784242f88SMatthias Ringwald     // 84396c435ac48560b5965385253e210c
118884242f88SMatthias Ringwald     btstack_parse_hex("84396c435ac48560b5965385253e210c", 16, identity_key);
118984242f88SMatthias Ringwald     btstack_crypto_aes128_encrypt(&crypto_request_aes128, identity_key, plaintext, hash, mesh_proxy_handle_get_aes128, NULL);
119084242f88SMatthias Ringwald }
119184242f88SMatthias Ringwald 
119284242f88SMatthias Ringwald // Mesh v1.0, 8.2.1
119384242f88SMatthias Ringwald static btstack_crypto_aes128_cmac_t aes_cmac_request;
119484242f88SMatthias Ringwald static uint8_t k4_result[1];
119584242f88SMatthias Ringwald static void handle_k4_result(void *arg){
1196*df71a9a4SMatthias Ringwald     UNUSED(arg);
119784242f88SMatthias Ringwald     printf("ApplicationkeyIDTest: %02x\n", k4_result[0]);
119884242f88SMatthias Ringwald     CHECK_EQUAL( 0x26, k4_result[0]);
119984242f88SMatthias Ringwald }
120084242f88SMatthias Ringwald TEST(MessageTest, ApplicationkeyIDTest){
120184242f88SMatthias Ringwald     static uint8_t application_key[16];
120284242f88SMatthias Ringwald     btstack_parse_hex("63964771734fbd76e3b40519d1d94a48", 16, application_key);
120384242f88SMatthias Ringwald     mesh_k4(&aes_cmac_request, application_key, &k4_result[0], &handle_k4_result, NULL);
120484242f88SMatthias Ringwald }
120584242f88SMatthias Ringwald 
120684242f88SMatthias Ringwald int main (int argc, const char * argv[]){
120784242f88SMatthias Ringwald     return CommandLineTestRunner::RunAllTests(argc, argv);
120884242f88SMatthias Ringwald }
1209