mirror of
https://github.com/bluekitchen/btstack.git
synced 2025-03-22 16:20:54 +00:00
added example how to parse advertisements
This commit is contained in:
Milanka Ringwald
parent
15d0eaf5d9
commit
87bf819c95
@ -72,6 +72,7 @@ EXAMPLES = \
|
||||
spp_and_le_counter \
|
||||
spp_counter \
|
||||
spp_streamer \
|
||||
gap_le_advertisements \
|
||||
|
||||
EXAMPLES_USING_LE = \
|
||||
ancs_client \
|
||||
@ -80,6 +81,7 @@ EXAMPLES_USING_LE = \
|
||||
le_counter \
|
||||
le_streamer \
|
||||
spp_and_le_counter \
|
||||
gap_le_advertisements \
|
||||
|
||||
# .o for .c
|
||||
CORE_OBJ = $(CORE:.c=.o)
|
||||
@ -163,6 +165,9 @@ led_counter: ${CORE_OBJ} ${COMMON_OBJ} led_counter.c
|
||||
ble_client: ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_CLIENT_OBJ} ${SM_REAL} ble_client.c
|
||||
${CC} $^ ${CFLAGS} ${LDFLAGS} -o $@
|
||||
|
||||
gap_le_advertisements: ${CORE_OBJ} ${COMMON_OBJ} ad_parser.c gap_le_advertisements.c
|
||||
${CC} $^ ${CFLAGS} ${LDFLAGS} -o $@
|
||||
|
||||
|
||||
clean:
|
||||
rm -f ${EXAMPLES}
|
||||
|
||||
244
example/embedded/gap_le_advertisements.c
Normal file
244
example/embedded/gap_le_advertisements.c
Normal file
@ -0,0 +1,244 @@
|
||||
/*
|
||||
* Copyright (C) 2014 BlueKitchen GmbH
|
||||
*
|
||||
* Redistribution and use in source and binary forms, with or without
|
||||
* modification, are permitted provided that the following conditions
|
||||
* are met:
|
||||
*
|
||||
* 1. Redistributions of source code must retain the above copyright
|
||||
* notice, this list of conditions and the following disclaimer.
|
||||
* 2. Redistributions in binary form must reproduce the above copyright
|
||||
* notice, this list of conditions and the following disclaimer in the
|
||||
* documentation and/or other materials provided with the distribution.
|
||||
* 3. Neither the name of the copyright holders nor the names of
|
||||
* contributors may be used to endorse or promote products derived
|
||||
* from this software without specific prior written permission.
|
||||
* 4. Any redistribution, use, or modification is done solely for
|
||||
* personal benefit and not for any commercial purpose or for
|
||||
* monetary gain.
|
||||
*
|
||||
* THIS SOFTWARE IS PROVIDED BY BLUEKITCHEN GMBH AND CONTRIBUTORS
|
||||
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||||
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||||
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL MATTHIAS
|
||||
* RINGWALD OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||||
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||||
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||||
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||||
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
|
||||
* OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF
|
||||
* THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
|
||||
* SUCH DAMAGE.
|
||||
*
|
||||
* Please inquire about commercial licensing options at
|
||||
* contact@bluekitchen-gmbh.com
|
||||
*
|
||||
*/
|
||||
|
||||
|
||||
// *****************************************************************************
|
||||
/* EXAMPLE_START(gap_le_advertisements): GAP LE Advertisements Dumper
|
||||
*
|
||||
* @text This example shows how to scan for advertisements and how to parse them.
|
||||
*
|
||||
*/
|
||||
// *****************************************************************************
|
||||
|
||||
|
||||
#include <stdint.h>
|
||||
#include <stdio.h>
|
||||
#include <stdlib.h>
|
||||
#include <string.h>
|
||||
|
||||
#include <btstack/hci_cmds.h>
|
||||
|
||||
#include "btstack_memory.h"
|
||||
#include "hci.h"
|
||||
#include "ad_parser.h"
|
||||
|
||||
|
||||
static void handle_hci_event(uint8_t packet_type, uint8_t *packet, uint16_t size);
|
||||
|
||||
static void gap_le_advertisements_setup(){
|
||||
hci_register_packet_handler(handle_hci_event);
|
||||
}
|
||||
|
||||
static char * ad_types[] = {
|
||||
"",
|
||||
"Flags",
|
||||
"Incomplete List of 16-bit Service Class UUIDs",
|
||||
"Complete List of 16-bit Service Class UUIDs",
|
||||
"Incomplete List of 32-bit Service Class UUIDs",
|
||||
"Complete List of 32-bit Service Class UUIDs",
|
||||
"Incomplete List of 128-bit Service Class UUIDs",
|
||||
"Complete List of 128-bit Service Class UUIDs",
|
||||
"Shortened Local Name",
|
||||
"Complete Local Name",
|
||||
"Tx Power Level",
|
||||
"",
|
||||
"",
|
||||
"Class of Device",
|
||||
"Simple Pairing Hash C",
|
||||
"Simple Pairing Randomizer R",
|
||||
"Device ID",
|
||||
"Security Manager TK Value",
|
||||
"Slave Connection Interval Range",
|
||||
"",
|
||||
"List of 16-bit Service Solicitation UUIDs",
|
||||
"List of 128-bit Service Solicitation UUIDs",
|
||||
"Service Data",
|
||||
"Public Target Address",
|
||||
"Random Target Address",
|
||||
"Appearance",
|
||||
"Advertising Interval"
|
||||
};
|
||||
|
||||
static char * flags[] = {
|
||||
"LE Limited Discoverable Mode",
|
||||
"LE General Discoverable Mode",
|
||||
"BR/EDR Not Supported",
|
||||
"Simultaneous LE and BR/EDR to Same Device Capable (Controller)",
|
||||
"Simultaneous LE and BR/EDR to Same Device Capable (Host)",
|
||||
"Reserved",
|
||||
"Reserved",
|
||||
"Reserved"
|
||||
};
|
||||
|
||||
void dump_advertisement_data(uint8_t * adv_data, uint8_t adv_size){
|
||||
ad_context_t 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 size = ad_iterator_get_data_len(&context);
|
||||
uint8_t * data = ad_iterator_get_data(&context);
|
||||
|
||||
if (data_type > 0 && data_type < 0x1B){
|
||||
printf("%s: ", ad_types[data_type]);
|
||||
}
|
||||
int i;
|
||||
// Assigned Numbers GAP
|
||||
switch (data_type){
|
||||
case 0x01: // Flags
|
||||
// show only first octet, ignore rest
|
||||
printf("\n");
|
||||
for (i=0; i<8;i++){
|
||||
if (data[0] & (1<<i)){
|
||||
printf("Flags bit nr. %d : %s\n", i, flags[i]);
|
||||
}
|
||||
}
|
||||
break;
|
||||
case 0x02: // Incomplete List of 16-bit Service Class UUIDs
|
||||
case 0x03: // Complete List of 16-bit Service Class UUIDs
|
||||
case 0x14: // List of 16-bit Service Solicitation UUIDs
|
||||
for (i=0; i<size;i+=2){
|
||||
printf("%02X ", READ_BT_16(data, i));
|
||||
}
|
||||
printf("\n");
|
||||
break;
|
||||
case 0x04: // Incomplete List of 32-bit Service Class UUIDs
|
||||
case 0x05: // Complete List of 32-bit Service Class UUIDs
|
||||
for (i=0; i<size;i+=4){
|
||||
printf("%04X ", READ_BT_32(data, i));
|
||||
}
|
||||
printf("\n");
|
||||
break;
|
||||
case 0x06: // Incomplete List of 128-bit Service Class UUIDs
|
||||
case 0x07: // Complete List of 128-bit Service Class UUIDs
|
||||
case 0x15: // List of 128-bit Service Solicitation UUIDs
|
||||
printUUID128(data);
|
||||
printf("\n");
|
||||
break;
|
||||
case 0x08: // Shortened Local Name
|
||||
case 0x09: // Complete Local Name
|
||||
for (i=0; i<size;i++){
|
||||
printf("%c", (char)(data[i]));
|
||||
}
|
||||
printf("\n");
|
||||
break;
|
||||
case 0x0A: // Tx Power Level
|
||||
printf("%d dBm\n", *(int8_t*)data);
|
||||
break;
|
||||
case 0x12: // Slave Connection Interval Range
|
||||
printf("\n");
|
||||
printf("Minimum Connection Interval %u ms\n", READ_BT_16(data, 0) * 5/4);
|
||||
printf("Maximum Connection Interval %u ms\n", READ_BT_16(data, 2) * 5/4);
|
||||
break;
|
||||
case 0x16: // Service Data
|
||||
printf_hexdump(data, size);
|
||||
break;
|
||||
case 0x17: // Public Target Address
|
||||
case 0x18: // Random Target Address
|
||||
print_bd_addr(data);
|
||||
printf("\n");
|
||||
break;
|
||||
case 0x19: // Appearance
|
||||
// https://developer.bluetooth.org/gatt/characteristics/Pages/CharacteristicViewer.aspx?u=org.bluetooth.characteristic.gap.appearance.xml
|
||||
printf("%02X\n", READ_BT_16(data, 0) );
|
||||
break;
|
||||
case 0x1A: // Advertising Interval
|
||||
printf("%u ms\n", READ_BT_16(data, 0) * 5/8 );
|
||||
break;
|
||||
case 0x3D: // 3D Information Data
|
||||
printf_hexdump(data, size);
|
||||
break;
|
||||
case 0xFF: // Manufacturer Specific Data
|
||||
break;
|
||||
case 0x0D: // Class of Device (3B)
|
||||
case 0x0E: // Simple Pairing Hash C (16B)
|
||||
case 0x0F: // Simple Pairing Randomizer R (16B)
|
||||
case 0x10: // Device ID
|
||||
case 0x11: // Security Manager TK Value (16B)
|
||||
default:
|
||||
printf("Unknown Advertising Data Type\n");
|
||||
break;
|
||||
}
|
||||
|
||||
}
|
||||
}
|
||||
|
||||
static void handle_hci_event(uint8_t packet_type, uint8_t *packet, uint16_t size){
|
||||
if (packet_type != HCI_EVENT_PACKET) return;
|
||||
|
||||
switch (packet[0]) {
|
||||
case BTSTACK_EVENT_STATE:
|
||||
// BTstack activated, get started
|
||||
if (packet[2] == HCI_STATE_WORKING) {
|
||||
printf("BTstack activated, start scaning!\n");
|
||||
le_central_set_scan_parameters(0,0x0030, 0x0030);
|
||||
le_central_start_scan();
|
||||
}
|
||||
break;
|
||||
case GAP_LE_ADVERTISING_REPORT:{
|
||||
int pos = 2;
|
||||
uint8_t event_type = packet[pos++];
|
||||
uint8_t address_type = packet[pos++];
|
||||
bd_addr_t address;
|
||||
memcpy(address, &packet[pos], 6);
|
||||
pos += 6;
|
||||
uint8_t rssi = packet[pos++];
|
||||
uint8_t length = packet[pos++];
|
||||
uint8_t * data = &packet[pos];
|
||||
|
||||
printf("\n\nAdvertisement event: evt-type %u, addr-type %u, addr %s, rssi %u, length adv %u, data: ", event_type,
|
||||
address_type, bd_addr_to_str(address), rssi, length);
|
||||
printf_hexdump(data, length);
|
||||
dump_advertisement_data(data, length);
|
||||
break;
|
||||
}
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
int btstack_main(void);
|
||||
int btstack_main(void)
|
||||
{
|
||||
gap_le_advertisements_setup();
|
||||
|
||||
// turn on!
|
||||
hci_power_control(HCI_POWER_ON);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
/* EXAMPLE_END */
|
||||
Loading…
x
Reference in New Issue
Block a user