mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-04-03 10:20:18 +00:00
Code Issues Packages Projects Releases Wiki Activity

mesh: start decoding received messages

Browse Source
This commit is contained in:
Matthias Ringwald 2018-10-25 18:16:05 +02:00
parent 7dc13593a6
commit 2718b724e4
1 changed files with 22 additions and 1 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

23
test/mesh/mesh.c
View File

@ -253,6 +253,7 @@ static int provisioning_data_has_more(provisioning_data_iterator_t * it){
} }
static const mesh_provisioning_data_t * provisioning_data_get_next(provisioning_data_iterator_t * it){ static const mesh_provisioning_data_t * provisioning_data_get_next(provisioning_data_iterator_t * it){
it->first = 0;
return &provisioning_data; return &provisioning_data;
} }
@ -381,6 +382,10 @@ static void process_network_pdu(void){
static void mesh_message_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ static void mesh_message_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
if (packet_type != HCI_EVENT_PACKET) return; if (packet_type != HCI_EVENT_PACKET) return;
const uint8_t * adv_data;
const uint8_t * pdu_data;
uint8_t pdu_len;
uint8_t adv_len;
switch(packet[0]){ switch(packet[0]){
case HCI_EVENT_MESH_META: case HCI_EVENT_MESH_META:
switch(packet[2]){ switch(packet[2]){
@ -418,7 +423,23 @@ static void mesh_message_handler (uint8_t packet_type, uint16_t channel, uint8_t
} }
break; break;
case GAP_EVENT_ADVERTISING_REPORT: case GAP_EVENT_ADVERTISING_REPORT:
printf("received mesh message\n"); adv_len = gap_event_advertising_report_get_data_length(packet);
adv_data = gap_event_advertising_report_get_data(packet);
// validate data item len
pdu_len = adv_data[0] - 1;
printf("adv len %u pdu len %u\n", adv_len, pdu_len);
if ((pdu_len + 2) > adv_len) break;
if (pdu_len < 13) break; // transport PDU len = 0, 32 bit NetMIC
// get transport pdu
pdu_data = &adv_data[2];
printf("received mesh message: ");
printf_hexdump(pdu_data, pdu_len);
// temp..
memcpy(network_pdu_data, pdu_data, pdu_len);
network_pdu_len = pdu_len;
// process
process_network_pdu();
break; break;
default: default:
break; break;