mirror/btstack
1
0
Fork 0
mirror of https://github.com/bluekitchen/btstack.git synced 2025-02-04 06:39:53 +00:00
Code Issues Packages Projects Releases Wiki Activity

handle gap-conn-gcep-bv-4

Browse Source
This commit is contained in:
Matthias Ringwald 2015-07-30 16:00:52 +02:00
parent 2c1ed46591
commit b1640c5399
1 changed files with 53 additions and 59 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

112
test/pts/ble_central_test.c
View File

@ -59,6 +59,7 @@
#include "sm.h" #include "sm.h"
#include "att.h" #include "att.h"
#include "att_server.h"
#include "gap_le.h" #include "gap_le.h"
#include "le_device_db.h" #include "le_device_db.h"
#include "stdin_support.h" #include "stdin_support.h"
@ -67,7 +68,7 @@
// test profile // test profile
#include "profile.h" #include "profile.h"
// IXIT // Non standard IXIT
#define PTS_USES_RECONNECTION_ADDRESS_FOR_ITSELF #define PTS_USES_RECONNECTION_ADDRESS_FOR_ITSELF
typedef enum { typedef enum {
@ -75,6 +76,7 @@ typedef enum {
CENTRAL_W4_NAME_QUERY_COMPLETE, CENTRAL_W4_NAME_QUERY_COMPLETE,
CENTRAL_W4_NAME_VALUE, CENTRAL_W4_NAME_VALUE,
CENTRAL_W4_RECONNECTION_ADDRESS_QUERY_COMPLETE, CENTRAL_W4_RECONNECTION_ADDRESS_QUERY_COMPLETE,
CENTRAL_W4_PERIPHERAL_PRIVACY_FLAG_QUERY_COMPLETE,
} central_state_t; } central_state_t;
typedef struct advertising_report { typedef struct advertising_report {
@ -90,7 +92,7 @@ typedef struct advertising_report {
static uint8_t test_irk[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 }; static uint8_t test_irk[] = { 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00 };
static int gap_privacy = 0; static int gap_privacy = 0;
static int gap_bondable = 0; /* static */ int gap_bondable = 0;
static char gap_device_name[20]; static char gap_device_name[20];
static int gap_connectable = 0; static int gap_connectable = 0;
@ -106,21 +108,21 @@ static int ui_passkey = 0;
static int ui_digits_for_passkey = 0; static int ui_digits_for_passkey = 0;
static uint16_t handle = 0; static uint16_t handle = 0;
static bd_addr_t tester_address = {0x00, 0x1B, 0xDC, 0x07, 0x32, 0xef};
static int tester_address_type = 0;
static int reconnection_address_set = 0;
static bd_addr_t non_resolvabe_address = { 0x33, 0x33, 0x33, 0x33, 0x33, 0x33};
static bd_addr_t private_address;
static uint16_t gc_id; static uint16_t gc_id;
static bd_addr_t public_pts_address = {0x00, 0x1B, 0xDC, 0x07, 0x32, 0xef};
static int public_pts_address_type = 0;
static bd_addr_t current_pts_address;
static int current_pts_address_type;
static int reconnection_address_set = 0;
static bd_addr_t our_private_address;
static central_state_t central_state = CENTRAL_IDLE; static central_state_t central_state = CENTRAL_IDLE;
static le_characteristic_t gap_name_characteristic; static le_characteristic_t gap_name_characteristic;
static le_characteristic_t gap_reconnection_address_characteristic; static le_characteristic_t gap_reconnection_address_characteristic;
static le_characteristic_t gap_peripheral_privacy_flag_characteristic;
static void show_usage(); static void show_usage();
static void fill_advertising_report_from_packet(advertising_report_t * report, uint8_t *packet);
static void dump_advertising_report(advertising_report_t * e);
/// ///
static void printUUID(uint8_t * uuid128, uint16_t uuid16){ static void printUUID(uint8_t * uuid128, uint16_t uuid16){
@ -131,31 +133,19 @@ static void printUUID(uint8_t * uuid128, uint16_t uuid16){
} }
} }
static void dump_characteristic(le_characteristic_t * characteristic){ void dump_characteristic(le_characteristic_t * characteristic){
printf(" * characteristic: [0x%04x-0x%04x-0x%04x], properties 0x%02x, uuid ", printf(" * characteristic: [0x%04x-0x%04x-0x%04x], properties 0x%02x, uuid ",
characteristic->start_handle, characteristic->value_handle, characteristic->end_handle, characteristic->properties); characteristic->start_handle, characteristic->value_handle, characteristic->end_handle, characteristic->properties);
printUUID(characteristic->uuid128, characteristic->uuid16); printUUID(characteristic->uuid128, characteristic->uuid16);
printf("\n"); printf("\n");
} }
static void dump_service(le_service_t * service){ void dump_service(le_service_t * service){
printf(" * service: [0x%04x-0x%04x], uuid ", service->start_group_handle, service->end_group_handle); printf(" * service: [0x%04x-0x%04x], uuid ", service->start_group_handle, service->end_group_handle);
printUUID(service->uuid128, service->uuid16); printUUID(service->uuid128, service->uuid16);
printf("\n"); printf("\n");
} }
static void fill_advertising_report_from_packet(advertising_report_t * report, uint8_t *packet){
int pos = 2;
report->event_type = packet[pos++]; // 2
report->address_type = packet[pos++]; // 3
bt_flip_addr(report->address, &packet[pos]); // 4
pos += 6;
report->rssi = packet[pos++]; // 10
report->length = packet[pos++]; // 11
report->data = &packet[pos]; // 12
pos += report->length;
}
const char * ad_event_types[] = { const char * ad_event_types[] = {
"Connectable undirected advertising", "Connectable undirected advertising",
"Connectable directed advertising", "Connectable directed advertising",
@ -168,7 +158,7 @@ static void handle_advertising_event(uint8_t * packet, int size){
// filter PTS // filter PTS
bd_addr_t addr; bd_addr_t addr;
bt_flip_addr(addr, &packet[4]); bt_flip_addr(addr, &packet[4]);
if (memcmp(addr, tester_address, 6)) return; if (memcmp(addr, public_pts_address, 6)) return;
printf("Advertisement: %s, ", ad_event_types[packet[2]]); printf("Advertisement: %s, ", ad_event_types[packet[2]]);
int adv_size = packet[11]; int adv_size = packet[11];
uint8_t * adv_data = &packet[12]; uint8_t * adv_data = &packet[12];
@ -177,7 +167,7 @@ static void handle_advertising_event(uint8_t * packet, int size){
ad_context_t context; ad_context_t context;
for (ad_iterator_init(&context, adv_size, adv_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){ for (ad_iterator_init(&context, adv_size, adv_data) ; ad_iterator_has_more(&context) ; ad_iterator_next(&context)){
uint8_t data_type = ad_iterator_get_data_type(&context); uint8_t data_type = ad_iterator_get_data_type(&context);
uint8_t size = ad_iterator_get_data_len(&context); // uint8_t size = ad_iterator_get_data_len(&context);
uint8_t * data = ad_iterator_get_data(&context); uint8_t * data = ad_iterator_get_data(&context);
switch (data_type){ switch (data_type){
case 1: // AD_FLAGS case 1: // AD_FLAGS
@ -212,11 +202,11 @@ static void update_advertisment_params(void){
case 0: case 0:
case 2: case 2:
case 3: case 3:
gap_advertisements_set_params(adv_int_min, adv_int_max, adv_type, 0, &null_addr, 0x07, 0x00); gap_advertisements_set_params(adv_int_min, adv_int_max, adv_type, 0, null_addr, 0x07, 0x00);
break; break;
case 1: case 1:
case 4: case 4:
gap_advertisements_set_params(adv_int_min, adv_int_max, adv_type, tester_address_type, &tester_address, 0x07, 0x00); gap_advertisements_set_params(adv_int_min, adv_int_max, adv_type, public_pts_address_type, public_pts_address, 0x07, 0x00);
break; break;
} }
} }
@ -226,8 +216,6 @@ static void gap_run(void){
} }
void app_packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ void app_packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){
advertising_report_t report;
switch (packet_type) { switch (packet_type) {
case HCI_EVENT_PACKET: case HCI_EVENT_PACKET:
@ -289,8 +277,6 @@ void app_packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet,
case GAP_LE_ADVERTISING_REPORT: case GAP_LE_ADVERTISING_REPORT:
handle_advertising_event(packet, size); handle_advertising_event(packet, size);
// fill_advertising_report_from_packet(&report, packet);
// dump_advertising_report(&report);
break; break;
default: default:
break; break;
@ -299,12 +285,15 @@ void app_packet_handler (uint8_t packet_type, uint16_t channel, uint8_t *packet,
gap_run(); gap_run();
} }
void use_public_pts_address(void){
memcpy(current_pts_address, public_pts_address, 6);
current_pts_address_type = public_pts_address_type;
}
void handle_gatt_client_event(le_event_t * event){ void handle_gatt_client_event(le_event_t * event){
le_service_t service;
le_characteristic_value_event_t * value; le_characteristic_value_event_t * value;
uint8_t address_type; uint8_t address_type;
uint8_t privacy_flag = 0;
bd_addr_t flipped_address; bd_addr_t flipped_address;
switch(event->type){ switch(event->type){
case GATT_SERVICE_QUERY_RESULT: case GATT_SERVICE_QUERY_RESULT:
@ -333,11 +322,22 @@ void handle_gatt_client_event(le_event_t * event){
break; break;
case CENTRAL_W4_RECONNECTION_ADDRESS_QUERY_COMPLETE: case CENTRAL_W4_RECONNECTION_ADDRESS_QUERY_COMPLETE:
central_state = CENTRAL_IDLE; central_state = CENTRAL_IDLE;
hci_le_advertisement_address(&address_type, private_address); hci_le_advertisement_address(&address_type, our_private_address);
printf("Private address: %s\n", bd_addr_to_str(private_address)); printf("Our private address: %s\n", bd_addr_to_str(our_private_address));
bt_flip_addr(flipped_address, private_address); bt_flip_addr(flipped_address, our_private_address);
gatt_client_write_value_of_characteristic(gc_id, handle, gap_reconnection_address_characteristic.value_handle, 6, flipped_address); gatt_client_write_value_of_characteristic(gc_id, handle, gap_reconnection_address_characteristic.value_handle, 6, flipped_address);
reconnection_address_set = 1; reconnection_address_set = 1;
#ifdef PTS_USES_RECONNECTION_ADDRESS_FOR_ITSELF
memcpy(current_pts_address, our_private_address, 6);
current_pts_address_type = 1;
#endif
break;
case CENTRAL_W4_PERIPHERAL_PRIVACY_FLAG_QUERY_COMPLETE:
central_state = CENTRAL_IDLE;
gatt_client_write_value_of_characteristic(gc_id, handle, gap_peripheral_privacy_flag_characteristic.value_handle, 1, &privacy_flag);
use_public_pts_address();
printf("Peripheral Privacy Flag set to FALSE, connecting to public PTS address again\n");
break;
default: default:
break; break;
} }
@ -352,6 +352,9 @@ void handle_gatt_client_event(le_event_t * event){
gap_reconnection_address_characteristic = ((le_characteristic_event_t *) event)->characteristic; gap_reconnection_address_characteristic = ((le_characteristic_event_t *) event)->characteristic;
printf("GAP Reconnection Address Characteristic found, value handle: 0x04%x\n", gap_reconnection_address_characteristic.value_handle); printf("GAP Reconnection Address Characteristic found, value handle: 0x04%x\n", gap_reconnection_address_characteristic.value_handle);
break; break;
case CENTRAL_W4_PERIPHERAL_PRIVACY_FLAG_QUERY_COMPLETE:
gap_peripheral_privacy_flag_characteristic = ((le_characteristic_event_t *) event)->characteristic;
printf("GAP Peripheral Privacy Flag Characteristic found, value handle: 0x04%x\n", gap_peripheral_privacy_flag_characteristic.value_handle);
default: default:
break; break;
} }
@ -371,6 +374,7 @@ void show_usage(void){
printf("GAP: connectable %u\n", gap_connectable); printf("GAP: connectable %u\n", gap_connectable);
printf("SM: %s, MITM protection %u, OOB data %u, key range [%u..16]\n", printf("SM: %s, MITM protection %u, OOB data %u, key range [%u..16]\n",
sm_io_capabilities, sm_mitm_protection, sm_have_oob_data, sm_min_key_size); sm_io_capabilities, sm_mitm_protection, sm_have_oob_data, sm_min_key_size);
printf("PTS: addr type %u, addr %s\n", current_pts_address_type, current_pts_address);
printf("Privacy %u\n", gap_privacy); printf("Privacy %u\n", gap_privacy);
printf("Device name: %s\n", gap_device_name); printf("Device name: %s\n", gap_device_name);
printf("Value Handle: %x\n", value_handle); printf("Value Handle: %x\n", value_handle);
@ -379,6 +383,7 @@ void show_usage(void){
printf("c/C - connectable off\n"); printf("c/C - connectable off\n");
printf("---\n"); printf("---\n");
printf("1 - enable privacy using random non-resolvable private address\n"); printf("1 - enable privacy using random non-resolvable private address\n");
printf("2 - clear Peripheral Privacy Flag on PTS\n");
printf("s/S - passive/active scanning\n"); printf("s/S - passive/active scanning\n");
printf("a - enable Advertisements\n"); printf("a - enable Advertisements\n");
printf("n - query GAP Device Name\n"); printf("n - query GAP Device Name\n");
@ -433,31 +438,21 @@ int stdin_process(struct data_source *ds){
central_state = CENTRAL_W4_NAME_QUERY_COMPLETE; central_state = CENTRAL_W4_NAME_QUERY_COMPLETE;
gatt_client_discover_characteristics_for_handle_range_by_uuid16(gc_id, handle, 1, 0xffff, GAP_DEVICE_NAME_UUID); gatt_client_discover_characteristics_for_handle_range_by_uuid16(gc_id, handle, 1, 0xffff, GAP_DEVICE_NAME_UUID);
break; break;
case '2':
central_state = CENTRAL_W4_PERIPHERAL_PRIVACY_FLAG_QUERY_COMPLETE;
gatt_client_discover_characteristics_for_handle_range_by_uuid16(gc_id, handle, 1, 0xffff, GAP_PERIPHERAL_PRIVACY_FLAG);
break;
case 'o': case 'o':
central_state = CENTRAL_W4_RECONNECTION_ADDRESS_QUERY_COMPLETE; central_state = CENTRAL_W4_RECONNECTION_ADDRESS_QUERY_COMPLETE;
gatt_client_discover_characteristics_for_handle_range_by_uuid16(gc_id, handle, 1, 0xffff, GAP_RECONNECTION_ADDRESS_UUID); gatt_client_discover_characteristics_for_handle_range_by_uuid16(gc_id, handle, 1, 0xffff, GAP_RECONNECTION_ADDRESS_UUID);
break; break;
case 'p': case 'p':
#ifdef PTS_USES_RECONNECTION_ADDRESS_FOR_ITSELF res = gap_auto_connection_start(current_pts_address_type, current_pts_address);
if (reconnection_address_set){ printf("Auto Connection Establishment to type %u, addr %s -> %x\n", current_pts_address_type, bd_addr_to_str(current_pts_address), res);
res = gap_auto_connection_start(1, private_address);
printf("Auto Connection Establishment to type %u, addr %s -> %x\n", 1, bd_addr_to_str(private_address), res);
break;
}
#endif
res = gap_auto_connection_start(tester_address_type, tester_address);
printf("Auto Connection Establishment to type %u, addr %s -> %x\n", tester_address_type, bd_addr_to_str(tester_address), res);
break; break;
case 'P': case 'P':
#ifdef PTS_USES_RECONNECTION_ADDRESS_FOR_ITSELF le_central_connect(current_pts_address, current_pts_address_type);
if (reconnection_address_set){ printf("Direct Connection Establishment to type %u, addr %s\n", current_pts_address_type, bd_addr_to_str(current_pts_address));
printf("Direct Connection Establishment to type %u, addr %s\n", 1, bd_addr_to_str(non_resolvabe_address));
le_central_connect(non_resolvabe_address, 1);
}
#endif
printf("Direct Connection Establishment to type %u, addr %s\n", tester_address_type, bd_addr_to_str(tester_address));
le_central_connect(tester_address, tester_address_type);
break; break;
case 's': case 's':
if (scanning_active){ if (scanning_active){
@ -566,13 +561,12 @@ int btstack_main(int argc, const char * argv[]){
// Setup LE Device DB // Setup LE Device DB
le_device_db_init(); le_device_db_init();
//
// gap_random_address_set_update_period(300000);
// gap_random_address_set_mode(GAP_RANDOM_ADDRESS_RESOLVABLE);
// set adv params // set adv params
update_advertisment_params(); update_advertisment_params();
memcpy(current_pts_address, public_pts_address, 6);
current_pts_address_type = public_pts_address_type;
// allow foor terminal input // allow foor terminal input
btstack_stdin_setup(stdin_process); btstack_stdin_setup(stdin_process);