mirror of
https://github.com/bluekitchen/btstack.git
synced 2025-02-20 18:40:31 +00:00
test for advertising event with multiple reports
This commit is contained in:
matthias.ringwald@gmail.com
parent
cac9f13904
commit
e01fe8b6c0
@ -521,7 +521,7 @@ void hci_le_advertisement_address(uint8_t * addr_type, bd_addr_t * addr){
|
||||
}
|
||||
|
||||
#ifdef HAVE_BLE
|
||||
static void le_handle_advertisement_report(uint8_t *packet, int size){
|
||||
void le_handle_advertisement_report(uint8_t *packet, int size){
|
||||
int num_reports = packet[3];
|
||||
int i;
|
||||
int total_data_length = 0;
|
||||
|
||||
@ -6,7 +6,7 @@ BTSTACK_ROOT = ../..
|
||||
CPPUTEST_HOME = ${BTSTACK_ROOT}/test/cpputest
|
||||
|
||||
CFLAGS = -g -Wall -I. -I${BTSTACK_ROOT}/example/libusb -I${BTSTACK_ROOT}/src -I${BTSTACK_ROOT}/ble -I${BTSTACK_ROOT}/include -I$(CPPUTEST_HOME)/include
|
||||
LDFLAGS += -L$(CPPUTEST_HOME) -lCppUTest -lCppUTestExt
|
||||
LDFLAGS += -L$(CPPUTEST_HOME)/lib -lCppUTest -lCppUTestExt
|
||||
|
||||
COMMON = \
|
||||
${BTSTACK_ROOT}/src/utils.c \
|
||||
@ -18,22 +18,17 @@ COMMON = \
|
||||
${BTSTACK_ROOT}/src/run_loop.c \
|
||||
${BTSTACK_ROOT}/src/run_loop_posix.c \
|
||||
${BTSTACK_ROOT}/src/hci_cmds.c \
|
||||
${BTSTACK_ROOT}/ble/att_dispatch.c \
|
||||
${BTSTACK_ROOT}/ble/att.c \
|
||||
${BTSTACK_ROOT}/src/hci_dump.c \
|
||||
${BTSTACK_ROOT}/src/hci.c \
|
||||
${BTSTACK_ROOT}/ble/ad_parser.c \
|
||||
${BTSTACK_ROOT}/ble/gatt_client.c \
|
||||
${BTSTACK_ROOT}/example/libusb/ble_client.c \
|
||||
|
||||
COMMON_OBJ = $(COMMON:.c=.o)
|
||||
|
||||
all: ad_parser le_central
|
||||
all: ad_parser
|
||||
|
||||
ad_parser: ${CORE_OBJ} ${COMMON_OBJ} advertising_data_parser.c
|
||||
${CC} ${CORE_OBJ} ${COMMON_OBJ} advertising_data_parser.c ${CFLAGS} ${LDFLAGS} -o $@
|
||||
|
||||
le_central: ${CORE_OBJ} ${COMMON_OBJ} central.c
|
||||
${CC} ${CORE_OBJ} ${COMMON_OBJ} central.c ${CFLAGS} ${LDFLAGS} -o $@
|
||||
|
||||
clean:
|
||||
rm -f ad_parser le_central
|
||||
rm -f *.o ${BTSTACK_ROOT}/src/*.o
|
||||
|
||||
@ -21,22 +21,123 @@
|
||||
#include "ad_parser.h"
|
||||
#include "l2cap.h"
|
||||
|
||||
void le_handle_advertisement_report(uint8_t *packet, int size);
|
||||
|
||||
typedef struct ad_event {
|
||||
uint8_t type;
|
||||
uint8_t event_type;
|
||||
uint8_t address_type;
|
||||
bd_addr_t address;
|
||||
uint8_t rssi;
|
||||
uint8_t length;
|
||||
uint8_t * data;
|
||||
} ad_event_t;
|
||||
|
||||
static uint8_t ad_data[] = {0x02, 0x01, 0x05, 0x03, 0x02, 0xF0, 0xFF};
|
||||
|
||||
static uint8_t ad_uuid16[] = {0x02, 0x04, 0x78, 0x56, 0x34, 0x12,
|
||||
0x02, 0x04, 0xf0, 0xde, 0xbc, 0x9a};
|
||||
static uint8_t mtk_adv_evt[] = {
|
||||
0x3e, 0x3b, 0x02, 0x03, 0x04, 0x01, 0x55, 0x05, 0x67, 0x5c, 0xc2, 0x4f, 0x00,
|
||||
0xb6, 0x00, 0x00, 0x87, 0x7b, 0x60, 0x70, 0xf3, 0x5c, 0x1b, 0x02, 0x01, 0x02,
|
||||
0x05, 0x09, 0x41, 0x4e, 0x43, 0x53, 0x11, 0x15, 0xd0, 0x00, 0x2d, 0x12, 0x1e,
|
||||
0x4b, 0x0f, 0xa4, 0x99, 0x4e, 0xce, 0xb5, 0x31, 0xf4, 0x05, 0x79, 0xbf, 0x04,
|
||||
0x00, 0x87, 0x7b, 0x60, 0x70, 0xf3, 0x5c, 0x00, 0xc0
|
||||
};
|
||||
|
||||
static uint8_t uuid16[] = { 0x12, 0x34,
|
||||
0x56, 0x78,
|
||||
0x9a, 0xbc,
|
||||
0xde, 0xf0 };
|
||||
static uint8_t adv_evt[] = {
|
||||
0x3E, 0x3B, 0x02, 0x03, 0x04, 0x00, 0x04, 0x01, 0x00, 0x00, 0x55, 0x05, 0x67,
|
||||
0x5C, 0xC2, 0x4F, 0x87, 0x7B, 0x60, 0x70, 0xF3, 0x5C, 0x87, 0x7B, 0x60, 0x70,
|
||||
0xF3, 0x5C, 0x00, 0x1B, 0x00, 0x02, 0x01, 0x02, 0x05, 0x09, 0x41, 0x4E, 0x43,
|
||||
0x53, 0x11, 0x15, 0xD0, 0x00, 0x2D, 0x12, 0x1E, 0x4B, 0x0F, 0xA4, 0x99, 0x4E,
|
||||
0xCE, 0xB5, 0x31, 0xF4, 0x05, 0x79, 0xb6, 0xbf, 0xc0
|
||||
};
|
||||
|
||||
static uint8_t ad_uuid128[] = {0x06, 0x10, 0xf0, 0xde, 0xbc, 0x9a, 0x78, 0x56, 0x34, 0x12, 0xf0, 0xde, 0xbc, 0x9a, 0x78, 0x56, 0x34, 0x12};
|
||||
|
||||
static uint8_t uuid128[] = {0x12, 0x34, 0x56, 0x78, 0x9a, 0xbc, 0xde, 0xf0, 0x12, 0x34, 0x56, 0x78, 0x9a, 0xbc, 0xde, 0xf0} ;
|
||||
int dummy_callback(){
|
||||
return 0;
|
||||
}
|
||||
|
||||
static hci_transport_t dummy_transport = {
|
||||
/* .transport.open = */ NULL,
|
||||
/* .transport.close = */ NULL,
|
||||
/* .transport.send_packet = */ NULL,
|
||||
/* .transport.register_packet_handler = */ (void (*)(void (*)(uint8_t, uint8_t *, uint16_t))) dummy_callback,
|
||||
/* .transport.get_transport_name = */ NULL,
|
||||
/* .transport.set_baudrate = */ NULL,
|
||||
/* .transport.can_send_packet_now = */ NULL,
|
||||
};
|
||||
|
||||
static void dump_ad_event(ad_event_t * e){
|
||||
printf(" * adv. event: evt-type %u, addr-type %u, addr %s, rssi %u, length adv %u, data: ", e->event_type,
|
||||
e->address_type, bd_addr_to_str(e->address), e->rssi, e->length);
|
||||
hexdump(e->data, e->length);
|
||||
|
||||
}
|
||||
|
||||
void packet_handler(uint8_t packet_type, uint8_t *packet, uint16_t size){
|
||||
|
||||
ad_event_t ad_event;
|
||||
int pos = 2;
|
||||
ad_event.event_type = packet[pos++];
|
||||
ad_event.address_type = packet[pos++];
|
||||
memcpy(ad_event.address, &packet[pos], 6);
|
||||
|
||||
pos += 6;
|
||||
ad_event.rssi = packet[pos++];
|
||||
ad_event.length = packet[pos++];
|
||||
ad_event.data = &packet[pos];
|
||||
pos += ad_event.length;
|
||||
dump_ad_event(&ad_event);
|
||||
|
||||
printf("\ndata: \n");
|
||||
|
||||
hexdump(packet, size);
|
||||
|
||||
printf("\n");
|
||||
}
|
||||
|
||||
static void fix_mtk_advertisement_report(uint8_t * packet, uint16_t size){
|
||||
if (packet[0] != 0x3e) return;
|
||||
if (packet[2] != 0x02) return;
|
||||
int num_reports = packet[3];
|
||||
if (num_reports == 1) return;
|
||||
|
||||
uint8_t fixed[257];
|
||||
|
||||
// header is correct
|
||||
memcpy(fixed, packet, 4);
|
||||
|
||||
// get total data length
|
||||
int i;
|
||||
uint16_t pos = 4;
|
||||
int total_data_length = 0;
|
||||
for (i=0; i<num_reports;i++){
|
||||
pos += 8;
|
||||
int data_length = packet[pos++];
|
||||
pos += data_length + 1;
|
||||
total_data_length += data_length;
|
||||
}
|
||||
// reorder reports
|
||||
pos = 4;
|
||||
int data_offset = 0;
|
||||
for (i=0; i<num_reports;i++){
|
||||
fixed[4 + i] = packet[pos++]; // event type
|
||||
fixed[4 +num_reports + i] = packet[pos++]; // address_type;
|
||||
memcpy(&fixed[4+num_reports*2+i*6], &packet[pos], 6); // bd_addr
|
||||
pos += 6;
|
||||
int data_length = packet[pos++];
|
||||
fixed[4+num_reports*8+i] = data_length;
|
||||
memcpy(&fixed[4+num_reports*9+data_offset], &packet[pos], data_length);
|
||||
pos += data_length;
|
||||
data_offset += data_length;
|
||||
fixed[4+num_reports*9+total_data_length + i] = packet[pos++];
|
||||
}
|
||||
memcpy(packet, fixed, size);
|
||||
}
|
||||
|
||||
TEST_GROUP(ADParser){
|
||||
void setup(){
|
||||
hci_init(&dummy_transport, NULL, NULL, NULL);
|
||||
hci_register_packet_handler(packet_handler);
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
@ -65,10 +166,18 @@ TEST(ADParser, TestDataParsing){
|
||||
}
|
||||
}
|
||||
|
||||
TEST(ADParser, TestHasUUID){
|
||||
TEST(ADParser, TestFixMtkAdvertisingReport){
|
||||
fix_mtk_advertisement_report(mtk_adv_evt, sizeof(mtk_adv_evt));
|
||||
int j;
|
||||
for (j = 0; j < sizeof(mtk_adv_evt); j++){
|
||||
CHECK_EQUAL(mtk_adv_evt[j], adv_evt[j]);
|
||||
}
|
||||
}
|
||||
|
||||
TEST(ADParser, TestAdvertisementEventMultipleReports){
|
||||
le_handle_advertisement_report(adv_evt, sizeof(adv_evt));
|
||||
}
|
||||
|
||||
int main (int argc, const char * argv[]){
|
||||
return CommandLineTestRunner::RunAllTests(argc, argv);
|
||||
}
|
||||
}
|
||||
Loading…
x
Reference in New Issue
Block a user