/* * 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 "ble_client.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" #ifdef HAVE_UART_CC2564 #include "bt_control_cc256x.h" #endif // gatt client state typedef enum { W4_ON, IDLE, // START_SCAN, W4_SCANNING, // SCANNING, // STOP_SCAN, W4_SCAN_STOPPED } state_t; static state_t state = W4_ON; static linked_list_t le_central_connections = NULL; void (*ble_client_packet_handler)(uint8_t packet_type, uint8_t *packet, uint16_t size) = NULL; static void ble_packet_handler(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); void (*le_central_callback)(le_event_t * event); static void le_packet_handler(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size); static void le_central_run(); static void hexdump2(void *data, int size){ if (size <= 0) return; int i; for (i=0; inext){ le_central_t * peripheral = (le_central_t *) it; if (peripheral->handle == handle){ return peripheral; } } return NULL; } static le_central_t * get_le_central_context_with_address(uint8_t addr_type, bd_addr_t addr){ linked_item_t *it; for (it = (linked_item_t *) le_central_connections; it ; it = it->next){ le_central_t * peripheral = (le_central_t *) it; if (BD_ADDR_CMP(addr, peripheral->address) == 0 && peripheral->address_type == addr_type){ return peripheral; } } return 0; } static le_central_t * get_le_central_context_with_state(le_central_state_t p_state){ linked_item_t *it; for (it = (linked_item_t *) le_central_connections; it ; it = it->next){ le_central_t * peripheral = (le_central_t *) it; if (peripheral->le_central_state == p_state){ return peripheral; } } return NULL; } static inline le_central_t * get_le_central_w4_connect_cancelled(){ return get_le_central_context_with_state(P_W4_CONNECT_CANCELLED); } static inline le_central_t * get_le_central_w4_connected(){ return get_le_central_context_with_state(P_W4_CONNECTED); } static void handle_advertising_packet(uint8_t *packet, int size){ int num_reports = packet[3]; int i; int total_data_length = 0; int data_offset = 0; for (i=0; inext){ le_central_t * peripheral = (le_central_t *) it; // printf("handle_peripheral_list, status %u\n", peripheral->state); switch (peripheral->le_central_state){ case P_W2_CONNECT: peripheral->le_central_state = P_W4_CONNECTED; hci_send_cmd(&hci_le_create_connection, 1000, // scan interval: 625 ms 1000, // scan interval: 625 ms 0, // don't use whitelist peripheral->address_type, // peer address type peripheral->address, // peer bd addr 0, // our addr type: public 80, // conn interval min 80, // conn interval max (3200 * 0.625) 0, // conn latency 2000, // supervision timeout 0, // min ce length 1000 // max ce length ); return; case P_W2_CANCEL_CONNECT: peripheral->le_central_state = P_W4_CONNECT_CANCELLED; hci_send_cmd(&hci_le_create_connection_cancel); return; case P_W2_DISCONNECT: peripheral->le_central_state = P_W4_DISCONNECTED; hci_send_cmd(&hci_disconnect, peripheral->handle,0x13); return; default: break; } } } le_command_status_t le_central_start_scan(){ if (state != IDLE) return BLE_PERIPHERAL_IN_WRONG_STATE; state = START_SCAN; le_central_run(); return BLE_PERIPHERAL_OK; } le_command_status_t le_central_stop_scan(){ if (state != SCANNING) return BLE_PERIPHERAL_IN_WRONG_STATE; state = STOP_SCAN; le_central_run(); return BLE_PERIPHERAL_OK; } static void le_central_context_init(le_central_t *context, uint8_t addr_type, bd_addr_t addr){ memset(context, 0, sizeof(le_central_t)); context->address_type = addr_type; memcpy (context->address, addr, 6); } le_command_status_t le_central_connect(le_central_t *context, uint8_t addr_type, bd_addr_t addr){ //TODO: align with hci connection list capacity le_central_t * peripheral = get_le_central_context_with_address(addr_type, addr); if (!peripheral) { le_central_context_init(context, addr_type, addr); context->le_central_state = P_W2_CONNECT; linked_list_add(&le_central_connections, (linked_item_t *) context); } else if (peripheral == context) { if (context->le_central_state != P_W2_CONNECT) return BLE_PERIPHERAL_IN_WRONG_STATE; } else { return BLE_PERIPHERAL_DIFFERENT_CONTEXT_FOR_ADDRESS_ALREADY_EXISTS; } le_central_run(); return BLE_PERIPHERAL_OK; } le_command_status_t le_central_disconnect(le_central_t *context){ le_central_t * peripheral = get_le_central_context_with_address(context->address_type, context->address); if (!peripheral || (peripheral && peripheral != context)){ return BLE_PERIPHERAL_DIFFERENT_CONTEXT_FOR_ADDRESS_ALREADY_EXISTS; } switch(context->le_central_state){ case P_W2_CONNECT: linked_list_remove(&le_central_connections, (linked_item_t *) context); send_le_central_connection_complete_event(peripheral, GATT_CONNECTION_COMPLETE, 0); break; case P_W4_CONNECTED: case P_W2_CANCEL_CONNECT: // trigger cancel connect context->le_central_state = P_W2_CANCEL_CONNECT; break; case P_W4_DISCONNECTED: case P_W4_CONNECT_CANCELLED: return BLE_PERIPHERAL_IN_WRONG_STATE; default: context->le_central_state = P_W2_DISCONNECT; break; } le_central_run(); return BLE_PERIPHERAL_OK; } static void le_central_run(){ // check if command is send if (!hci_can_send_packet_now_using_packet_buffer(HCI_COMMAND_DATA_PACKET)) return; if (!l2cap_can_send_connectionless_packet_now()) return; switch(state){ case W4_ON: return; case START_SCAN: state = W4_SCANNING; hci_send_cmd(&hci_le_set_scan_enable, 1, 0); return; case STOP_SCAN: state = W4_SCAN_STOPPED; hci_send_cmd(&hci_le_set_scan_enable, 0, 0); return; default: break; } le_central_handle_context_list(); } static void le_packet_handler(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ switch (packet[0]) { case BTSTACK_EVENT_STATE: // BTstack activated, get started if (packet[2] == HCI_STATE_WORKING) { state = IDLE; } break; case HCI_EVENT_COMMAND_COMPLETE: if (COMMAND_COMPLETE_EVENT(packet, hci_le_set_scan_enable)){ switch(state){ case W4_SCANNING: state = SCANNING; break; case W4_SCAN_STOPPED: state = IDLE; break; default: break; } break; } if (COMMAND_COMPLETE_EVENT(packet, hci_le_create_connection_cancel)){ // printf("packet_handler:: hci_le_create_connection_cancel: cancel connect\n"); if (packet[3] != 0x0B) break; // cancel connection failed, as connection already established le_central_t * peripheral = get_le_central_w4_connect_cancelled(); peripheral->le_central_state = P_W2_DISCONNECT; break; } break; case HCI_EVENT_DISCONNECTION_COMPLETE: { uint16_t handle = READ_BT_16(packet,3); le_central_t * peripheral = get_le_central_context_for_handle(handle); if (!peripheral) break; peripheral->le_central_state = P_IDLE; linked_list_remove(&le_central_connections, (linked_item_t *) peripheral); // TODO shouldn't we send some kind of disconnect complete? send_le_central_connection_complete_event(peripheral, GATT_CONNECTION_COMPLETE, packet[5]); // printf("Peripheral disconnected, and removed from list\n"); break; } case HCI_EVENT_LE_META: switch (packet[2]) { case HCI_SUBEVENT_LE_ADVERTISING_REPORT: if (state != SCANNING) break; handle_advertising_packet(packet, size); break; case HCI_SUBEVENT_LE_CONNECTION_COMPLETE: { le_central_t * peripheral = get_le_central_w4_connected(); if (peripheral){ if (packet[3]){ peripheral->le_central_state = P_IDLE; linked_list_remove(&le_central_connections, (linked_item_t *) peripheral); } else { peripheral->le_central_state = P_CONNECTED; peripheral->handle = READ_BT_16(packet, 4); } send_le_central_connection_complete_event(peripheral, GATT_CONNECTION_COMPLETE, packet[3]); break; } // cancel success? peripheral = get_le_central_w4_connect_cancelled(); if (!peripheral) break; linked_list_remove(&le_central_connections, (linked_item_t *) peripheral); send_le_central_connection_complete_event(peripheral, GATT_CONNECTION_COMPLETE, packet[3]); break; } default: break; } break; default: break; } le_central_run(); } static void ble_packet_handler(void * connection, uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size){ if (packet_type != HCI_EVENT_PACKET) return; le_packet_handler(connection, packet_type, channel, packet, size); gatt_packet_handler(connection, packet_type, channel, packet, size); // hexdump2(packet, size); // printf("\n"); // printf("packet_handler: HCI_EVENT_PACKET %d, packet[0]: 0x%02x, packet[2]: 0x%02x, state %d \n", packet_type == HCI_EVENT_PACKET, // packet[0], packet[2], state); // printf("HCI_EVENT_LE_META 0x%02x, ADVERTISING_REPORT 0x%02x, scanning %d\n", HCI_EVENT_LE_META, HCI_SUBEVENT_LE_ADVERTISING_REPORT, SCANNING); //gatt_client_run(); // forward to app if (!ble_client_packet_handler) return; ble_client_packet_handler(packet_type, packet, size); } // TEST CODE static void printUUID(uint8_t * uuid128, uint16_t uuid16){ printf(", uuid "); if (uuid16){ printf(" 0x%02x",uuid16); } else { printUUID128(uuid128); } printf("\n"); } static void dump_characteristic(le_characteristic_t * characteristic){ printf(" *** characteristic *** properties %x, start handle 0x%02x, value handle 0x%02x, end handle 0x%02x", characteristic->properties, characteristic->start_handle, characteristic->value_handle, characteristic->end_handle); printUUID(characteristic->uuid128, characteristic->uuid16); } 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); hexdump2( e->data, e->length); } static void dump_service(le_service_t * service){ printf(" *** service *** start group handle %02x, end group handle %02x", service->start_group_handle, service->end_group_handle); printUUID(service->uuid128, service->uuid16); } static void dump_descriptor(le_characteristic_descriptor_t * descriptor){ printf(" *** descriptor *** handle 0x%02x, value ", descriptor->handle); hexdump2(descriptor->value, descriptor->value_length); printUUID(descriptor->uuid128, descriptor->uuid16); } //static void dump_characteristic_value(le_characteristic_value_event_t * event){ // printf(" *** characteristic value of length %d *** ", event->characteristic_value_blob_length); // hexdump2(event->characteristic_value, event->characteristic_value_blob_length); // printf("\n"); //} le_central_t test_device; gatt_client_t test_gatt_client_context; le_service_t services[40]; le_characteristic_t characteristics[100]; le_service_t service; le_characteristic_t enable_characteristic; le_characteristic_t config_characteristic; le_characteristic_descriptor_t descriptor; int service_count = 0; int service_index = 0; int characteristic_count = 0; int characteristic_index = 0; uint8_t acc_service_uuid[16] = {0xf0, 0x00, 0xaa, 0x10, 0x04, 0x51, 0x40, 0x00, 0xb0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; uint8_t acc_chr_client_config_uuid[16] = {0xf0, 0x00, 0xaa, 0x11, 0x04, 0x51, 0x40, 0x00, 0xb0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; uint8_t acc_chr_enable_uuid[16] = {0xf0, 0x00, 0xaa, 0x12, 0x04, 0x51, 0x40, 0x00, 0xb0, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00}; uint8_t acc_enable[1] = {0x01}; uint8_t acc_disable[1] = {0x00}; static uint8_t test_device_addr_type = 0; // pick one: // static bd_addr_t test_device_addr = {0x1c, 0xba, 0x8c, 0x20, 0xc7, 0xf6}; // static bd_addr_t test_device_addr = {0x00, 0x1b, 0xdc, 0x05, 0xb5, 0xdc}; // SensorTag 1 static bd_addr_t test_device_addr = {0x34, 0xb1, 0xf7, 0xd1, 0x77, 0x9b}; // SensorTag 2 // static bd_addr_t test_device_addr = {0x00, 0x02, 0x72, 0xdc, 0x31, 0xc1}; // delock40 typedef enum { TC_IDLE, TC_W4_SCAN_RESULT, TC_W4_CONNECT, TC_W4_SERVICE_RESULT, TC_W4_SERVICE_WITH_UUID_RESULT, TC_W4_CHARACTERISTIC_RESULT, TC_W4_CHARACTERISTIC_WITH_UUID_RESULT, TC_W4_CHARACTERISTIC_DESCRIPTOR_RESULT, TC_W4_INCLUDED_SERVICE_RESULT, TC_W4_READ_RESULT, TC_W4_READ_LONG_RESULT, TC_W2_WRITE_WITHOUT_RESPONSE, TC_W4_WRITE_WITHOUT_RESPONSE_SENT, TC_W4_WRITE_RESULT, TC_W4_LONG_WRITE_RESULT, TC_W4_RELIABLE_WRITE_RESULT, TC_W4_ACC_ENABLE, TC_W4_ACC_CLIENT_CONFIG_CHARACTERISTIC_RESULT, TC_W4_ACC_SUBSCRIBE, TC_W4_ACC_DATA, TC_W4_DISCONNECT, TC_DISCONNECTED } tc_state_t; tc_state_t tc_state = TC_IDLE; le_characteristic_t characteristic; uint8_t chr_long_value[26] = { 0x76, 0x75, 0x74, 0x73, 0x72, 0x71, 0x70, 0x6f, 0x6e, 0x6d, 0x6c, 0x6b, 0x6a, 0x69, 0x68, 0x67, 0x66, 0x65, 0x64, 0x63, 0x62, 0x61, 0x60, 0x5f, 0x5e, 0x5d}; uint8_t chr_short_value[1] = {0x86}; // void sm_test_basic_cmds(le_event_t * event){ // le_service_t service; // le_characteristic_descriptor_t descriptor; // switch(tc_state){ // case TC_W4_CONNECT: // if (event->type != GATT_CONNECTION_COMPLETE) break; // tc_state = TC_W4_SERVICE_RESULT; // printf("\n test client - CONNECTED, query services now\n"); // le_central_discover_primary_services(&test_gatt_client_context); // break; // case TC_W4_SERVICE_RESULT: // switch(event->type){ // case GATT_SERVICE_QUERY_RESULT: // service = ((le_service_event_t *) event)->service; // dump_service(&service); // services[service_count++] = service; // break; // case GATT_SERVICE_QUERY_COMPLETE: // tc_state = TC_W4_SERVICE_WITH_UUID_RESULT; // printf("\n test client - SERVICE by SERVICE UUID QUERY\n"); // le_central_discover_primary_services_by_uuid16(&test_gatt_client_context, 0xffff); // break; // default: // break; // } // break; // case TC_W4_SERVICE_WITH_UUID_RESULT: // switch(event->type){ // case GATT_SERVICE_QUERY_RESULT: // service = ((le_service_event_t *) event)->service; // dump_service(&service); // break; // case GATT_SERVICE_QUERY_COMPLETE: // tc_state = TC_W4_CHARACTERISTIC_RESULT; // service_index = 0; // printf("\n test client - CHARACTERISTIC for SERVICE 0x%02x QUERY\n", services[service_index].uuid16); // le_central_discover_characteristics_for_service(&test_gatt_client_context, &services[service_index]); // break; // default: // break; // } // break; // case TC_W4_CHARACTERISTIC_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&characteristic); // characteristics[characteristic_count++] = characteristic; // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE: // if (service_index < service_count) { // tc_state = TC_W4_CHARACTERISTIC_RESULT; // service = services[service_index++]; // printf("\n test client - CHARACTERISTIC for SERVICE 0x%02x QUERY\n", service.uuid16); // le_central_discover_characteristics_for_service(&test_gatt_client_context, &service); // break; // } // tc_state = TC_W4_CHARACTERISTIC_WITH_UUID_RESULT; // service_index = 0; // characteristic_index = 0; // printf("\n test client - CHARACTERISTIC for SERVICE 0x%02x QUERY with UUID 0x%02x\n", // services[0].uuid16, characteristics[0].uuid16); // le_central_discover_characteristics_for_handle_range_by_uuid16(&test_gatt_client_context, // services[0].start_group_handle, services[0].end_group_handle, characteristics[0].uuid16); // break; // default: // break; // } // break; // case TC_W4_CHARACTERISTIC_WITH_UUID_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&characteristic); // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE: // tc_state = TC_W4_CHARACTERISTIC_DESCRIPTOR_RESULT; // printf("\n test client - DESCRIPTOR for CHARACTERISTIC \n"); // dump_characteristic(&characteristics[0]); // le_central_discover_characteristic_descriptors(&test_gatt_client_context, &characteristics[0]); // break; // default: // break; // } // break; // case TC_W4_CHARACTERISTIC_DESCRIPTOR_RESULT: // switch(event->type){ // case GATT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: // descriptor = ((le_characteristic_descriptor_event_t *) event)->characteristic_descriptor; // dump_descriptor(&descriptor); // break; // case GATT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_COMPLETE: // service_index = 0; // service = services[service_index]; // tc_state = TC_W4_INCLUDED_SERVICE_RESULT; // printf("\n test client - INCLUDED SERVICE QUERY, for service %02x\n", service.uuid16); // le_central_find_included_services_for_service(&test_gatt_client_context, &service); // break; // default: // break; // } // break; // case TC_W4_INCLUDED_SERVICE_RESULT: // switch(event->type){ // case GATT_INCLUDED_SERVICE_QUERY_RESULT: // service = ((le_service_event_t *) event)->service; // printf(" *** found included service *** start group handle %02x, end group handle %02x \n", service.start_group_handle, service.end_group_handle); // break; // case GATT_INCLUDED_SERVICE_QUERY_COMPLETE: // if (service_index < service_count) { // service = services[service_index++]; // printf("\n test client - INCLUDED SERVICE QUERY, for service %02x\n", service.uuid16); // le_central_find_included_services_for_service(&test_gatt_client_context, &service); // break; // } // tc_state = TC_W4_DISCONNECT; // printf("\n\n test client - DISCONNECT "); // le_central_disconnect(&test_device); // break; // default: // break; // } // break; // default: // break; // } // } // void sm_test_reads(le_event_t * event){ // switch(tc_state){ // // 59 5a 5d f200 // case TC_W4_CONNECT: // if (event->type != GATT_CONNECTION_COMPLETE) break; // tc_state = TC_W4_CHARACTERISTIC_WITH_UUID_RESULT; // printf("\n test client - CONNECTED, query characteristic now\n"); // le_central_discover_characteristics_for_handle_range_by_uuid16(&test_gatt_client_context, 0x59, 0x5d, 0xf200); // break; // case TC_W4_CHARACTERISTIC_WITH_UUID_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&characteristic); // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE: // tc_state = TC_W4_READ_LONG_RESULT; // printf("\n\n test client - LONG VALUE for CHARACTERISTIC \n"); // le_central_write_value_of_characteristic_without_response(&test_gatt_client_context, characteristic.value_handle, 1, chr_short_value); // break; // default: // break; // } // break; // case TC_W4_READ_LONG_RESULT: // switch (event->type){ // case GATT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT: // dump_characteristic_value((le_characteristic_value_event_t *)event); // break; // case GATT_LONG_CHARACTERISTIC_VALUE_QUERY_COMPLETE: // tc_state = TC_W4_DISCONNECT; // printf("\n\n test client - DISCONNECT "); // le_central_disconnect(&test_device); // break; // default: // printf("TC_W4_READ_LONG_RESULT\n"); // break; // } // break; // default: // break; // } // } // void sm_test_write_no_response(le_event_t * event){ // switch(tc_state){ // case TC_W4_SCAN_RESULT: { // if (event->type != GATT_ADVERTISEMENT) break; // printf("test client - SCAN ACTIVE\n"); // ad_event_t * ad_event = (ad_event_t*) event; // dump_ad_event(ad_event); // // copy found addr // test_device_addr_type = ad_event->address_type; // bd_addr_t found_device_addr; // memcpy(found_device_addr, ad_event->address, 6); // if (memcmp(&found_device_addr, &test_device_addr, 6) != 0) break; // // memcpy(test_device_addr, ad_event->address, 6); // tc_state = TC_W4_CONNECT; // le_central_stop_scan(); // le_central_connect(&test_device, test_device_addr_type, test_device_addr); // break; // } // // 59 5a 5d f200 // case TC_W4_CONNECT: // if (event->type != GATT_CONNECTION_COMPLETE) break; // tc_state = TC_W4_CHARACTERISTIC_WITH_UUID_RESULT; // printf("\n test client - CONNECTED, query characteristic now\n"); // le_central_discover_characteristics_for_handle_range_by_uuid16(&test_gatt_client_context, 0x59, 0x5d, 0xf200); // break; // case TC_W4_CHARACTERISTIC_WITH_UUID_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&characteristic); // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE:{ // printf("\n\n test client - Write VALUE for CHARACTERISTIC \n"); // tc_state = TC_W2_WRITE_WITHOUT_RESPONSE; // le_command_status_t status = le_central_write_value_of_characteristic_without_response(&test_gatt_client_context, characteristic.value_handle, 1, chr_short_value); // if (status != BLE_PERIPHERAL_OK) break; // tc_state = TC_W4_READ_LONG_RESULT; // le_central_read_long_value_of_characteristic(&test_gatt_client_context, &characteristic); // break; // } // default: // break; // } // break; // case TC_W4_READ_LONG_RESULT: // switch (event->type){ // case GATT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT: // dump_characteristic_value((le_characteristic_value_event_t *)event); // break; // case GATT_LONG_CHARACTERISTIC_VALUE_QUERY_COMPLETE: // tc_state = TC_W4_DISCONNECT; // printf("\n\n test client - DISCONNECT "); // le_central_disconnect(&test_device); // break; // default: // printf("TC_W4_READ_LONG_RESULT\n"); // break; // } // break; // default: // break; // } // } // void sm_test_long_writes(le_event_t * event){ // switch(tc_state){ // case TC_W4_CONNECT: // if (event->type != GATT_CONNECTION_COMPLETE) break; // tc_state = TC_W4_CHARACTERISTIC_WITH_UUID_RESULT; // printf("\n test client - CONNECTED, query characteristic now\n"); // le_central_discover_characteristics_for_handle_range_by_uuid16(&test_gatt_client_context, 0x59, 0x5d, 0xf200); // break; // case TC_W4_CHARACTERISTIC_WITH_UUID_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&characteristic); // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE:{ // printf("\n\n test client - Write LONG VALUE for CHARACTERISTIC \n"); // tc_state = TC_W4_WRITE_RESULT; // // le_central_write_value_of_characteristic(&test_gatt_client_context, characteristic.value_handle, 1, chr_short_value); // // le_central_write_long_value_of_characteristic(&test_gatt_client_context, characteristic.value_handle, 26, chr_long_value); // le_central_reliable_write_long_value_of_characteristic(&test_gatt_client_context, characteristic.value_handle, 26, chr_long_value); // break; // } // default: // break; // } // break; // case TC_W4_WRITE_RESULT: // printf("\n\n test client - Write LONG VALUE for CHARACTERISTIC \n"); // tc_state = TC_W4_READ_LONG_RESULT; // le_central_read_long_value_of_characteristic(&test_gatt_client_context, &characteristic); // break; // case TC_W4_READ_LONG_RESULT: // switch (event->type){ // case GATT_LONG_CHARACTERISTIC_VALUE_QUERY_RESULT: // dump_characteristic_value((le_characteristic_value_event_t *)event); // break; // case GATT_LONG_CHARACTERISTIC_VALUE_QUERY_COMPLETE: // tc_state = TC_W4_DISCONNECT; // printf("\n\n test client - DISCONNECT "); // le_central_disconnect(&test_device); // break; // default: // printf("TC_W4_READ_LONG_RESULT\n"); // break; // } // break; // default: // printf("Client, unhandled state %d\n", tc_state); // break; // } // } // void sm_test_write_characteristic_descriptor(le_event_t * event){ // switch(tc_state){ // case TC_W4_CONNECT: // if (event->type != GATT_CONNECTION_COMPLETE) break; // tc_state = TC_W4_SERVICE_RESULT; // printf("\n test client - CONNECTED, query ACC service\n"); // le_central_discover_primary_services_by_uuid128(&test_gatt_client_context, acc_service_uuid); // break; // case TC_W4_SERVICE_RESULT: // switch(event->type){ // case GATT_SERVICE_QUERY_RESULT: // service = ((le_service_event_t *) event)->service; // dump_service(&service); // break; // case GATT_SERVICE_QUERY_COMPLETE: // tc_state = TC_W4_CHARACTERISTIC_RESULT; // printf("\n test client - ENABLE CHARACTERISTIC for SERVICE QUERY : \n"); // dump_service(&service); // le_central_discover_characteristics_for_service_by_uuid128(&test_gatt_client_context, &service, acc_chr_enable_uuid); // break; // default: // break; // } // break; // case TC_W4_CHARACTERISTIC_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // enable_characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&enable_characteristic); // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE: // tc_state = TC_W4_ACC_ENABLE; // printf("\n test client - ACC ENABLE\n"); // le_central_write_value_of_characteristic(&test_gatt_client_context, enable_characteristic.value_handle, 1, acc_enable); // break; // default: // break; // } // break; // case TC_W4_ACC_ENABLE: // tc_state = TC_W4_ACC_CLIENT_CONFIG_CHARACTERISTIC_RESULT; // printf("\n test client - CLIENT CONFIG CHARACTERISTIC for SERVICE QUERY with UUID"); // printUUID128(service.uuid128); // printf("\n"); // le_central_discover_characteristics_for_service_by_uuid128(&test_gatt_client_context, &service, acc_chr_client_config_uuid); // break; // case TC_W4_ACC_CLIENT_CONFIG_CHARACTERISTIC_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // config_characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&config_characteristic); // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE: // tc_state = TC_W4_ACC_DATA; // printf("\n test client - ACC Client Configuration\n"); // le_central_write_client_characteristic_configuration(&test_gatt_client_context, &config_characteristic, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION); // // le_central_write_client_characteristic_configuration(&test_gatt_client_context, &config_characteristic, GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION); // break; // default: // break; // } // break; // case TC_W4_ACC_DATA: // printf("ACC Client Data: "); // if ( event->type != GATT_NOTIFICATION && event->type != GATT_INDICATION ) break; // dump_characteristic_value((le_characteristic_value_event_t *) event); // break; // default: // printf("Client, unhandled state %d\n", tc_state); // break; // } // } // //void sm_test_read_characteristic_descriptor(le_event_t * event){ // switch(tc_state){ // case TC_W4_CONNECT: // if (event->type != GATT_CONNECTION_COMPLETE) break; // tc_state = TC_W4_SERVICE_RESULT; // printf("\n test client - CONNECTED, query ACC service\n"); // le_central_discover_primary_services_by_uuid128(&test_gatt_client_context, acc_service_uuid); // break; // // case TC_W4_SERVICE_RESULT: // switch(event->type){ // case GATT_SERVICE_QUERY_RESULT: // service = ((le_service_event_t *) event)->service; // dump_service(&service); // break; // case GATT_SERVICE_QUERY_COMPLETE: // tc_state = TC_W4_CHARACTERISTIC_RESULT; // printf("\n test client - FIND ENABLE CHARACTERISTIC for SERVICE QUERY : \n"); // dump_service(&service); // le_central_discover_characteristics_for_service_by_uuid128(&test_gatt_client_context, &service, acc_chr_enable_uuid); // break; // default: // break; // } // break; // // case TC_W4_CHARACTERISTIC_RESULT: // switch(event->type){ // case GATT_CHARACTERISTIC_QUERY_RESULT: // enable_characteristic = ((le_characteristic_event_t *) event)->characteristic; // dump_characteristic(&enable_characteristic); // break; // case GATT_CHARACTERISTIC_QUERY_COMPLETE: // tc_state = TC_W4_CHARACTERISTIC_DESCRIPTOR_RESULT; // printf("\n test client - ACC ENABLE\n"); // le_central_discover_characteristic_descriptors(&test_gatt_client_context, &enable_characteristic); // break; // default: // break; // } // break; // // case TC_W4_CHARACTERISTIC_DESCRIPTOR_RESULT: // switch(event->type){ // case GATT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: // descriptor = ((le_characteristic_descriptor_event_t *) event)->characteristic_descriptor; // dump_descriptor(&descriptor); // break; // case GATT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_COMPLETE: // le_central_read_characteristic_descriptor(&test_gatt_client_context, &descriptor); // break; // case GATT_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT:{ // descriptor = ((le_characteristic_descriptor_event_t *) event)->characteristic_descriptor; // dump_descriptor(&descriptor); // tc_state = TC_W4_DISCONNECT; // printf("\n\n test client - DISCONNECT "); // le_central_disconnect(&test_device); // break; // } // default: // break; // } // break; // // default: // printf("Client, unhandled state %d\n", tc_state); // break; // } // //} static void handle_scan_and_connect(le_event_t * event){ if (tc_state != TC_W4_SCAN_RESULT) return; if (event->type != GATT_ADVERTISEMENT) return; printf("test client - SCAN ACTIVE\n"); ad_event_t * ad_event = (ad_event_t*) event; dump_ad_event(ad_event); // copy found addr test_device_addr_type = ad_event->address_type; bd_addr_t found_device_addr; memcpy(found_device_addr, ad_event->address, 6); if (memcmp(&found_device_addr, &test_device_addr, 6) != 0) return; // memcpy(test_device_addr, ad_event->address, 6); tc_state = TC_W4_CONNECT; le_central_stop_scan(); le_central_connect(&test_device, test_device_addr_type, test_device_addr); } static void handle_disconnect(le_event_t * event){ if (tc_state != TC_W4_DISCONNECT) return; if (event->type != GATT_CONNECTION_COMPLETE ) return; printf(" DONE\n"); } static void handle_ble_client_event(le_event_t * event){ handle_scan_and_connect(event); handle_disconnect(event); switch(tc_state){ case TC_W4_CONNECT: { if (event->type != GATT_CONNECTION_COMPLETE) break; tc_state = TC_W4_SERVICE_RESULT; printf("\n test client - CONNECTED, query ACC service\n"); // create gatt client context for this le_central_connection_complete_event_t * peripheral_event = (le_central_connection_complete_event_t *) event; uint16_t handle = peripheral_event->device->handle; gatt_client_start(&test_gatt_client_context, handle); // let's start gatt_client_discover_primary_services_by_uuid128(&test_gatt_client_context, acc_service_uuid); break; } case TC_W4_SERVICE_RESULT: switch(event->type){ case GATT_SERVICE_QUERY_RESULT: service = ((le_service_event_t *) event)->service; dump_service(&service); break; case GATT_SERVICE_QUERY_COMPLETE: tc_state = TC_W4_CHARACTERISTIC_RESULT; printf("\n test client - FIND ENABLE CHARACTERISTIC for SERVICE QUERY : \n"); dump_service(&service); gatt_client_discover_characteristics_for_service_by_uuid128(&test_gatt_client_context, &service, acc_chr_enable_uuid); break; default: break; } break; case TC_W4_CHARACTERISTIC_RESULT: switch(event->type){ case GATT_CHARACTERISTIC_QUERY_RESULT: enable_characteristic = ((le_characteristic_event_t *) event)->characteristic; dump_characteristic(&enable_characteristic); break; case GATT_CHARACTERISTIC_QUERY_COMPLETE: tc_state = TC_W4_CHARACTERISTIC_DESCRIPTOR_RESULT; printf("\n test client - ACC ENABLE\n"); gatt_client_discover_characteristic_descriptors(&test_gatt_client_context, &enable_characteristic); break; default: break; } break; case TC_W4_CHARACTERISTIC_DESCRIPTOR_RESULT: switch(event->type){ case GATT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT: descriptor = ((le_characteristic_descriptor_event_t *) event)->characteristic_descriptor; dump_descriptor(&descriptor); break; case GATT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_COMPLETE: gatt_client_read_long_characteristic_descriptor(&test_gatt_client_context, &descriptor); break; case GATT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_RESULT:{ descriptor = ((le_characteristic_descriptor_event_t *) event)->characteristic_descriptor; dump_descriptor(&descriptor); break; } case GATT_LONG_CHARACTERISTIC_DESCRIPTOR_QUERY_COMPLETE: printf("DONE"); tc_state = TC_W4_DISCONNECT; printf("\n\n test client - DISCONNECT "); le_central_disconnect(&test_device); break; default: break; } break; default: printf("Client, unhandled state %d\n", tc_state); break; } } static void handle_hci_event(uint8_t packet_type, uint8_t *packet, uint16_t size){ le_command_status_t status; 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, get started!\n"); tc_state = TC_W4_SCAN_RESULT; le_central_start_scan(); } break; case DAEMON_EVENT_HCI_PACKET_SENT: switch(tc_state){ case TC_W2_WRITE_WITHOUT_RESPONSE: status = gatt_client_write_value_of_characteristic_without_response(&test_gatt_client_context, characteristic.value_handle, 1, chr_short_value); if (status != BLE_PERIPHERAL_OK) break; tc_state = TC_W4_READ_LONG_RESULT; gatt_client_read_long_value_of_characteristic(&test_gatt_client_context, &characteristic); default: break; } default: break; } } #ifndef UNIT_TEST 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/ble_client.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(); ble_client_init(); ble_client_register_packet_handler(handle_ble_client_event); le_central_register_packet_handler(handle_hci_event); } int main(void) { setup(); // turn on! hci_power_control(HCI_POWER_ON); // go! run_loop_execute(); // happy compiler! return 0; } #endif