diff --git a/example/libusb/Makefile b/example/libusb/Makefile index 458853d98..1daae0ba7 100644 --- a/example/libusb/Makefile +++ b/example/libusb/Makefile @@ -79,7 +79,7 @@ GATT_SERVER_OBJ = $(GATT_SERVER:.c=.o) # create firmware image from common objects and example source file -all: ${BTSTACK_ROOT}/include/btstack/version.h gatt_browser sdp_rfcomm_query sdp_general_query spp_counter ble_peripheral \ +all: ${BTSTACK_ROOT}/include/btstack/version.h gatt_browser gatt_battery_query sdp_rfcomm_query sdp_general_query spp_counter ble_peripheral \ ble_peripheral_sm_minimal gap_inquiry gap_dedicated_bonding gap_inquiry_and_bond l2cap_test spp_streamer \ classic_test ble_peripheral_uart_csr ble_peripheral_uart_cc256x ancs_client spp_and_le_counter \ sdp_bnep_query \ @@ -152,8 +152,11 @@ ble_client: ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_CLIENT_OBJ} ${SM_REAL} b gatt_browser: ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_CLIENT_OBJ} ${SM_REAL_OBJ} gatt_browser.c ${CC} ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_CLIENT_OBJ} ${SM_REAL_OBJ} gatt_browser.c ${CFLAGS} ${LDFLAGS} -o $@ +gatt_battery_query: ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_CLIENT_OBJ} ${SM_REAL_OBJ} gatt_battery_query.c + ${CC} ${CORE_OBJ} ${COMMON_OBJ} ${ATT_OBJ} ${GATT_CLIENT_OBJ} ${SM_REAL_OBJ} gatt_battery_query.c ${CFLAGS} ${LDFLAGS} -o $@ + clean: - rm -f spp_counter sdp_rfcomm_query sdp_general_query sdp_bnep_query spp_counter_ssp ble_peripheral ble_client gatt_browser \ + rm -f spp_counter sdp_rfcomm_query sdp_general_query sdp_bnep_query spp_counter_ssp ble_peripheral ble_client gatt_battery_query gatt_browser \ gatt_client ancs_client ble_peripheral_sm_minimal classic_test ble_peripheral_uart_csr ble_peripheral_uart \ gap_dedicated_bonding gap_inquiry gap_inquiry_and_bond l2cap_test spp_and_le_counter spp_streamer rm -f *.o *.out *.hex diff --git a/example/libusb/gatt_battery_query.c b/example/libusb/gatt_battery_query.c new file mode 100644 index 000000000..901137494 --- /dev/null +++ b/example/libusb/gatt_battery_query.c @@ -0,0 +1,331 @@ +/* + * Copyright (C) 2011-2013 by 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. This software may not be used in a commercial product + * without an explicit license granted by the copyright holder. + * + * THIS SOFTWARE IS PROVIDED BY MATTHIAS RINGWALD 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. + * + */ + +//***************************************************************************** +// +// BLE Client +// +//***************************************************************************** + +#include +#include +#include +#include +#include +#include +#include +#include + +#include "btstack-config.h" + +#include "ad_parser.h" + +#include "debug.h" +#include "btstack_memory.h" +#include "hci.h" +#include "hci_dump.h" +#include "l2cap.h" +#include "att.h" +#include "gatt_client.h" +#include "sm.h" + +#ifdef HAVE_UART_CC2564 +#include "bt_control_cc256x.h" +#endif + +typedef struct advertising_report { + uint8_t type; + uint8_t event_type; + uint8_t address_type; + bd_addr_t address; + uint8_t rssi; + uint8_t length; + uint8_t * data; +} advertising_report_t; + + +typedef enum { + TC_IDLE, + TC_W4_SCAN_RESULT, + TC_W4_CONNECT, + TC_W4_SERVICE_RESULT, + TC_W4_CHARACTERISTIC_RESULT, + TC_W4_BATTERY_DATA +} gc_state_t; + +static bd_addr_t cmdline_addr = { }; +static int cmdline_addr_found = 0; +static gatt_client_t gc_context; + +static uint16_t battery_service_uuid = 0x180F; +static uint16_t battery_level_characteristic_uuid = 0x2a19; +static le_service_t battery_service; +static le_characteristic_t config_characteristic; + +static gc_state_t state = TC_IDLE; + +static void printUUID(uint8_t * uuid128, uint16_t uuid16){ + if (uuid16){ + printf("%04x",uuid16); + } else { + printUUID128(uuid128); + } +} + +static void dump_advertising_report(advertising_report_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); + printf_hexdump(e->data, e->length); + +} + +static void dump_characteristic_value(le_characteristic_value_event_t * event){ + printf(" * characteristic value of length %d *** ", event->blob_length ); + printf_hexdump(event->blob , event->blob_length); + printf("\n"); +} + +static void dump_characteristic(le_characteristic_t * characteristic){ + printf(" * characteristic: [0x%04x-0x%04x-0x%04x], properties 0x%02x, uuid ", + characteristic->start_handle, characteristic->value_handle, characteristic->end_handle, characteristic->properties); + printUUID(characteristic->uuid128, characteristic->uuid16); + printf("\n"); +} + +static void dump_service(le_service_t * service){ + printf(" * service: [0x%04x-0x%04x], uuid ", service->start_group_handle, service->end_group_handle); + printUUID(service->uuid128, service->uuid16); + printf("\n"); +} + +static void error_code(int status){ + switch(status){ + case ATT_ERROR_INSUFFICIENT_AUTHENTICATION: + printf("ATT_ERROR_INSUFFICIENT_AUTHENTICATION. TODO: security manager is not complete yet.\n"); + break; + default: + printf(" status 0x%02x\n", status); + break; + } +} +void handle_gatt_client_event(le_event_t * event){ + switch(state){ + case TC_W4_SERVICE_RESULT: + switch(event->type){ + case GATT_SERVICE_QUERY_RESULT: + battery_service = ((le_service_event_t *) event)->service; + printf("Battery service found:\n"); + dump_service(&battery_service); + break; + case GATT_QUERY_COMPLETE: + state = TC_W4_CHARACTERISTIC_RESULT; + printf("\nSearch for battery level characteristic in battery service. "); + gatt_client_discover_characteristics_for_service_by_uuid16(&gc_context, &battery_service, battery_level_characteristic_uuid); + break; + default: + break; + } + break; + + case TC_W4_CHARACTERISTIC_RESULT: + switch(event->type){ + case GATT_CHARACTERISTIC_QUERY_RESULT: + printf("Battery level characteristic found:\n"); + config_characteristic = ((le_characteristic_event_t *) event)->characteristic; + dump_characteristic(&config_characteristic); + break; + case GATT_QUERY_COMPLETE: + state = TC_W4_BATTERY_DATA; + printf("\nConfigure battery level characteristic for notify."); + gatt_client_write_client_characteristic_configuration(&gc_context, &config_characteristic, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION); + break; + default: + break; + } + break; + case TC_W4_BATTERY_DATA: + if (event->type == GATT_QUERY_COMPLETE){ + if (((gatt_complete_event_t*)event)->status != 0){ + printf("\nNotification is not possible: "); + error_code(((gatt_complete_event_t*)event)->status); + } + break; + } + if (event->type != GATT_NOTIFICATION) break; + printf("\nBattery Data:\n"); + dump_characteristic_value((le_characteristic_value_event_t *) event); + break; + + default: + printf("error\n"); + break; + } + +} + +static void fill_advertising_report_from_packet(advertising_report_t * report, uint8_t *packet){ + int pos = 2; + report->event_type = packet[pos++]; + report->address_type = packet[pos++]; + memcpy(report->address, &packet[pos], 6); + pos += 6; + report->rssi = packet[pos++]; + report->length = packet[pos++]; + report->data = &packet[pos]; + pos += report->length; + dump_advertising_report(report); + + bd_addr_t found_device_addr; + memcpy(found_device_addr, report->address, 6); + swapX(found_device_addr, report->address, 6); +} + +static void handle_hci_event(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ + if (packet_type != HCI_EVENT_PACKET) return; + advertising_report_t report; + uint16_t gc_handle; + + uint8_t event = packet[0]; + switch (event) { + case BTSTACK_EVENT_STATE: + // BTstack activated, get started + if (packet[2] != HCI_STATE_WORKING) break; + if (cmdline_addr_found){ + printf("Trying to connect to %s\n", bd_addr_to_str(cmdline_addr)); + state = TC_W4_CONNECT; + le_central_connect(&cmdline_addr, 0); + break; + } + printf("BTstack activated, start scanning!\n"); + state = TC_W4_SCAN_RESULT; + le_central_set_scan_parameters(0,0x0030, 0x0030); + le_central_start_scan(); + break; + case GAP_LE_ADVERTISING_REPORT: + if (state != TC_W4_SCAN_RESULT) return; + fill_advertising_report_from_packet(&report, packet); + // stop scanning, and connect to the device + state = TC_W4_CONNECT; + le_central_stop_scan(); + le_central_connect(&report.address,report.address_type); + break; + case HCI_EVENT_LE_META: + // wait for connection complete + if (packet[2] != HCI_SUBEVENT_LE_CONNECTION_COMPLETE) break; + if (state != TC_W4_CONNECT) return; + gc_handle = READ_BT_16(packet, 4); + // initialize gatt client context with handle, and add it to the list of active clients + gatt_client_start(&gc_context, gc_handle); + // query primary services + printf("\nSearch for battery service. "); + state = TC_W4_SERVICE_RESULT; + gatt_client_discover_primary_services_by_uuid16(&gc_context, battery_service_uuid); + break; + case HCI_EVENT_DISCONNECTION_COMPLETE: + printf("\nDISCONNECTED\n"); + gatt_client_stop(&gc_context); + exit(0); + break; + default: + break; + } +} + +static hci_uart_config_t config; +void setup(void){ + /// GET STARTED with BTstack /// + btstack_memory_init(); + run_loop_init(RUN_LOOP_POSIX); + + // use logger: format HCI_DUMP_PACKETLOGGER, HCI_DUMP_BLUEZ or HCI_DUMP_STDOUT + hci_dump_open("/tmp/gatt_browser.pklg", HCI_DUMP_PACKETLOGGER); + + // init HCI + remote_device_db_t * remote_db = (remote_device_db_t *) &remote_device_db_memory; + bt_control_t * control = NULL; +#ifndef HAVE_UART_CC2564 + hci_transport_t * transport = hci_transport_usb_instance(); +#else + hci_transport_t * transport = hci_transport_h4_instance(); + control = bt_control_cc256x_instance(); + // config.device_name = "/dev/tty.usbserial-A600eIDu"; // 5438 + config.device_name = "/dev/tty.usbserial-A800cGd0"; // 5529 + config.baudrate_init = 115200; + config.baudrate_main = 0; + config.flowcontrol = 1; +#endif + hci_init(transport, &config, control, remote_db); + l2cap_init(); + l2cap_register_packet_handler(&handle_hci_event); + + gatt_client_init(); + gatt_client_register_packet_handler(&handle_gatt_client_event); + + sm_init(); + sm_set_io_capabilities(IO_CAPABILITY_NO_INPUT_NO_OUTPUT); +} + +void usage(const char *name){ + fprintf(stderr, "\nUsage: %s [-a|--address aa:bb:cc:dd:ee:ff]\n", name); + fprintf(stderr, "If no argument is provided, GATT browser will start scanning and connect to the first found device.\nTo connect to a specific device use argument [-a].\n\n"); +} + +int main(int argc, const char * argv[]) +{ + int arg = 1; + cmdline_addr_found = 0; + + while (arg < argc) { + if(!strcmp(argv[arg], "-a") || !strcmp(argv[arg], "--address")){ + arg++; + cmdline_addr_found = sscan_bd_addr((uint8_t *)argv[arg], cmdline_addr); + arg++; + continue; + } + usage(argv[0]); + return 0; + } + + setup(); + // turn on! + hci_power_control(HCI_POWER_ON); + // go! + run_loop_execute(); + + // happy compiler! + return 0; +} + + + +