ble: add gatt_service_client

This commit is contained in:
Matthias Ringwald 2024-09-25 12:51:44 +02:00
parent 814908c5a4
commit 12879e7550
4 changed files with 1035 additions and 0 deletions

View File

@ -11,6 +11,7 @@ and this project adheres to [Semantic Versioning](http://semver.org/spec/v2.0.0.
### Added
- GATT Client: gatt_client_add_service_changed_handler to receive Service Changed and Database Hash events
- GATT Client: various _with_context functions that provide a service + connection id to GATT query events
- GATT Service Client: generic client discovers characteristics and enabled notifications/indications
- L2CAP: provide access to number of available credits in CBM/ECBM
- HFP HF: support Apple Accessory information with:
- hfp_hf_apple_set_identification

View File

@ -0,0 +1,736 @@
/*
* Copyright (C) 2023 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 BLUEKITCHEN
* GMBH 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
*
*/
#define BTSTACK_FILE__ "gatt_service_client_helper.c"
#ifdef ENABLE_TESTING_SUPPORT
#include <stdio.h>
#endif
#include <stdint.h>
#include <string.h>
#include "ble/gatt_service_client.h"
#include "bluetooth_gatt.h"
#include "btstack_debug.h"
#include "btstack_event.h"
static void gatt_service_client_gatt_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size);
static bool gatt_service_client_intitialized = false;
static uint16_t gatt_service_client_service_cid;
static btstack_linked_list_t gatt_service_clients;
static btstack_packet_callback_registration_t gatt_service_client_hci_callback_registration;
// LE Audio Service Client helper functions
static void gatt_service_client_finalize_connection(gatt_service_client_t * client, gatt_service_client_connection_t * connection){
btstack_assert(client != NULL);
btstack_linked_list_remove(&client->connections, (btstack_linked_item_t*) connection);
}
static gatt_service_client_t * gatt_service_client_get_service_client_for_id(uint16_t service_cid){
btstack_linked_list_iterator_t it;
btstack_linked_list_iterator_init(&it, &gatt_service_clients);
while (btstack_linked_list_iterator_has_next(&it)){
gatt_service_client_t * service_client = (gatt_service_client_t *)btstack_linked_list_iterator_next(&it);
if (service_client->service_id == service_cid) {
return service_client;
};
}
return NULL;
}
static gatt_service_client_connection_t * gatt_service_client_get_connection_for_con_handle_and_service_index(const gatt_service_client_t * client, hci_con_handle_t con_handle, uint8_t service_index){
btstack_linked_list_iterator_t it;
btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &client->connections);
while (btstack_linked_list_iterator_has_next(&it)){
gatt_service_client_connection_t * connection = (gatt_service_client_connection_t *)btstack_linked_list_iterator_next(&it);
if (connection->con_handle != con_handle) continue;
if (connection->service_index != service_index) continue;
return connection;
}
return NULL;
}
static gatt_service_client_connection_t * gatt_service_client_get_connection_for_cid(
const gatt_service_client_t *client, uint16_t connection_cid){
btstack_linked_list_iterator_t it;
btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &client->connections);
while (btstack_linked_list_iterator_has_next(&it)){
gatt_service_client_connection_t * connection = (gatt_service_client_connection_t *)btstack_linked_list_iterator_next(&it);
if (connection->cid != connection_cid) continue;
return connection;
}
return NULL;
}
uint16_t gatt_service_client_get_mtu(const gatt_service_client_connection_t *connection) {
uint16_t mtu = 0;
gatt_client_get_mtu(connection->con_handle, &mtu);
return mtu;
}
uint16_t gatt_service_client_get_connection_id(const gatt_service_client_connection_t * connection){
return connection->cid;
}
hci_con_handle_t gatt_service_client_get_con_handle(const gatt_service_client_connection_t * connection){
return connection->con_handle;
}
uint8_t gatt_service_client_get_service_index(const gatt_service_client_connection_t * connection){
return connection->service_index;
}
uint16_t gatt_service_client_characteristic_uuid16_for_index(const gatt_service_client_t * client, uint8_t characteristic_index){
if (characteristic_index < client->characteristics_desc16_num){
return client->characteristics_desc16[characteristic_index];
} else {
return 0;
}
}
uint16_t gatt_service_client_characteristic_value_handle_for_index(const gatt_service_client_connection_t *connection,
uint8_t characteristic_index) {
return connection->characteristics[characteristic_index].value_handle;
}
uint8_t gatt_service_client_characteristic_index_for_value_handle(const gatt_service_client_connection_t *connection,
uint16_t value_handle) {
for (int i = 0; i < connection->client->characteristics_desc16_num; i++){
if (connection->characteristics[i].value_handle == value_handle) {
return i;
}
}
return GATT_SERVICE_CLIENT_INVALID_INDEX;
}
uint8_t gatt_service_client_att_status_to_error_code(uint8_t att_error_code){
switch (att_error_code){
case ATT_ERROR_SUCCESS:
return ERROR_CODE_SUCCESS;
case ATT_ERROR_INVALID_ATTRIBUTE_VALUE_LENGTH:
return ERROR_CODE_PARAMETER_OUT_OF_MANDATORY_RANGE;
default:
log_info("ATT ERROR 0x%02x mapped to ERROR_CODE_UNSPECIFIED_ERROR", att_error_code);
return ERROR_CODE_UNSPECIFIED_ERROR;
}
}
static void gatt_service_client_emit_connected(btstack_packet_handler_t event_callback, hci_con_handle_t con_handle, uint16_t cid, uint8_t status){
btstack_assert(event_callback != NULL);
log_info("GATT Client Helper, connected 0x%04x, status 0x%02x", con_handle, status);
uint8_t event[9];
int pos = 0;
event[pos++] = HCI_EVENT_GATTSERVICE_META;
event[pos++] = sizeof(event) - 2;
event[pos++] = GATTSERVICE_SUBEVENT_CLIENT_CONNECTED;
little_endian_store_16(event, pos, con_handle);
pos += 2;
little_endian_store_16(event, pos, cid);
pos += 2;
event[pos++] = 0; // num included services
event[pos++] = status;
(*event_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event));
}
static void gatt_service_client_emit_disconnected(btstack_packet_handler_t event_callback, hci_con_handle_t con_handle, uint16_t cid){
btstack_assert(event_callback != NULL);
uint8_t event[7];
int pos = 0;
event[pos++] = HCI_EVENT_GATTSERVICE_META;
event[pos++] = sizeof(event) - 2;
event[pos++] = GATTSERVICE_SUBEVENT_CLIENT_DISCONNECTED;
little_endian_store_16(event, pos, con_handle);
pos += 2;
little_endian_store_16(event, pos, cid);
pos += 2;
(*event_callback)(HCI_EVENT_PACKET, 0, event, sizeof(event));
}
static uint16_t gatt_service_client_get_next_cid(gatt_service_client_t * client){
client->cid_counter = btstack_next_cid_ignoring_zero(client->cid_counter);
return client->cid_counter;
}
static bool gatt_service_client_more_descriptor_queries(const gatt_service_client_t * client, gatt_service_client_connection_t * connection) {
bool next_query_found = false;
while (!next_query_found && (connection->characteristic_index < client->characteristics_desc16_num)) {
uint16_t notify_or_indicate = ATT_PROPERTY_NOTIFY | ATT_PROPERTY_INDICATE;
if ((connection->characteristics[connection->characteristic_index].properties & notify_or_indicate) != 0u){
next_query_found = true;
break;
}
connection->characteristic_index++;
}
return next_query_found;
}
static bool gatt_service_client_have_more_notifications_to_enable(const gatt_service_client_t * client, gatt_service_client_connection_t * connection) {
bool next_query_found = false;
while (!next_query_found && (connection->characteristic_index < client->characteristics_desc16_num)) {
if (connection->characteristics[connection->characteristic_index].client_configuration_handle != 0) {
next_query_found = true;
break;
}
connection->characteristic_index++;
}
return next_query_found;
}
static uint8_t gatt_service_client_register_notification(gatt_service_client_t * client,
gatt_service_client_connection_t *connection) {
gatt_client_characteristic_t characteristic;
uint8_t status = ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
if (connection->characteristics[connection->characteristic_index].client_configuration_handle != 0){
characteristic.value_handle = connection->characteristics[connection->characteristic_index].value_handle;
characteristic.end_handle = connection->characteristics[connection->characteristic_index].end_handle;
characteristic.properties = connection->characteristics[connection->characteristic_index].properties;
if ((connection->characteristics[connection->characteristic_index].properties & ATT_PROPERTY_INDICATE) != 0u){
status = gatt_client_write_client_characteristic_configuration_with_context(
&gatt_service_client_gatt_packet_handler,
connection->con_handle,
&characteristic,
GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_INDICATION,
client->service_id,
connection->cid);
} else if ((connection->characteristics[connection->characteristic_index].properties & ATT_PROPERTY_NOTIFY) != 0u){
status = gatt_client_write_client_characteristic_configuration_with_context(
&gatt_service_client_gatt_packet_handler,
connection->con_handle,
&characteristic,
GATT_CLIENT_CHARACTERISTICS_CONFIGURATION_NOTIFICATION,
client->service_id,
connection->cid);
}
}
return status;
}
static void gatt_service_client_run_for_client(gatt_service_client_t * client, gatt_service_client_connection_t * connection){
uint8_t status = ATT_ERROR_SUCCESS;
gatt_client_service_t service;
gatt_client_characteristic_t characteristic;
switch (connection->state){
case GATT_SERVICE_CLIENT_STATE_W2_QUERY_PRIMARY_SERVICE:
connection->state = GATT_SERVICE_CLIENT_STATE_W4_SERVICE_RESULT;
status = gatt_client_discover_primary_services_by_uuid16_with_context(
&gatt_service_client_gatt_packet_handler,
connection->con_handle,
connection->service_uuid16,
client->service_id,
connection->cid);
break;
case GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTICS:
#ifdef ENABLE_TESTING_SUPPORT
printf("Read characteristics [service 0x%04x]:\n", connection->service_uuid16);
#endif
connection->state = GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_RESULT;
service.start_group_handle = connection->start_handle;
service.end_group_handle = connection->end_handle;
service.uuid16 = connection->service_uuid16;
status = gatt_client_discover_characteristics_for_service_with_context(
&gatt_service_client_gatt_packet_handler,
connection->con_handle,
&service,
client->service_id,
connection->cid);
break;
case GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTIC_DESCRIPTORS:
#ifdef ENABLE_TESTING_SUPPORT
printf("Read client characteristic descriptors for characteristic[%u, uuid16 0x%04x, value_handle 0x%04x]:\n",
connection->characteristic_index,
client->characteristics_desc16[connection->characteristic_index],
connection->characteristics[connection->characteristic_index].value_handle);
#endif
connection->state = GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_DESCRIPTORS_RESULT;
characteristic.value_handle = connection->characteristics[connection->characteristic_index].value_handle;
characteristic.properties = connection->characteristics[connection->characteristic_index].properties;
characteristic.end_handle = connection->characteristics[connection->characteristic_index].end_handle;
(void) gatt_client_discover_characteristic_descriptors_with_context(
&gatt_service_client_gatt_packet_handler,
connection->con_handle,
&characteristic,
client->service_id,
connection->cid);
break;
case GATT_SERVICE_CLIENT_STATE_W2_REGISTER_NOTIFICATION:
#ifdef ENABLE_TESTING_SUPPORT
if ((connection->characteristics[connection->characteristic_index].properties & ATT_PROPERTY_NOTIFY) != 0u){
printf("Register notification for characteristic");
} else {
printf("Register indication for characteristic");
}
printf("[%u, uuid16 0x%04x, ccd handle 0x%04x]\n",
connection->characteristic_index,
client->characteristics_desc16[connection->characteristic_index],
connection->characteristics[connection->characteristic_index].client_configuration_handle);
#endif
connection->state = GATT_SERVICE_CLIENT_STATE_W4_NOTIFICATION_REGISTERED;
status = gatt_service_client_register_notification(client, connection);
connection->characteristic_index++;
#ifdef ENABLE_TESTING_SUPPORT
if (status != ERROR_CODE_SUCCESS) {
printf("Notification not supported, status 0%02X\n.", status);
}
#else
UNUSED(status);
#endif
return;
case GATT_SERVICE_CLIENT_STATE_CONNECTED:
// TODO
break;
default:
break;
}
if (status != ATT_ERROR_SUCCESS){
gatt_service_client_emit_connected(client->packet_handler, connection->con_handle, connection->cid, gatt_service_client_att_status_to_error_code(status));
gatt_service_client_finalize_connection(client, connection);
}
}
// @return true if client valid / run function should be called
static bool gatt_service_client_handle_query_complete(gatt_service_client_t *client,
gatt_service_client_connection_t *connection,
uint8_t status) {
btstack_assert(client != NULL);
btstack_assert(connection != NULL);
if (status != ATT_ERROR_SUCCESS){
switch (connection->state){
case GATT_SERVICE_CLIENT_STATE_W4_SERVICE_RESULT:
case GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_RESULT:
case GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_DESCRIPTORS_RESULT:
case GATT_SERVICE_CLIENT_STATE_W4_NOTIFICATION_REGISTERED:
gatt_service_client_emit_connected(client->packet_handler, connection->con_handle, connection->cid, gatt_service_client_att_status_to_error_code(status));
gatt_service_client_finalize_connection(client, connection);
return false;
case GATT_SERVICE_CLIENT_STATE_CONNECTED:
break;
default:
btstack_unreachable();
break;
}
}
switch (connection->state){
case GATT_SERVICE_CLIENT_STATE_W4_SERVICE_RESULT:
if (connection->service_instances_num == 0){
gatt_service_client_emit_connected(client->packet_handler, connection->con_handle, connection->cid, ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE);
gatt_service_client_finalize_connection(client, connection);
return false;
}
connection->state = GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTICS;
connection->characteristic_index = 0;
break;
case GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_RESULT:
connection->state = GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTIC_DESCRIPTORS;
connection->characteristic_index = 0;
break;
case GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_DESCRIPTORS_RESULT:
if (gatt_service_client_more_descriptor_queries(client, connection)){
connection->state = GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTIC_DESCRIPTORS;
break;
}
connection->characteristic_index = 0;
if (gatt_service_client_have_more_notifications_to_enable(client, connection)){
connection->state = GATT_SERVICE_CLIENT_STATE_W2_REGISTER_NOTIFICATION;
} else {
connection->characteristic_index = 0;
connection->state = GATT_SERVICE_CLIENT_STATE_CONNECTED;
gatt_service_client_emit_connected(client->packet_handler, connection->con_handle, connection->cid, ERROR_CODE_SUCCESS);
}
break;
case GATT_SERVICE_CLIENT_STATE_W4_NOTIFICATION_REGISTERED:
if (gatt_service_client_have_more_notifications_to_enable(client, connection)){
connection->state = GATT_SERVICE_CLIENT_STATE_W2_REGISTER_NOTIFICATION;
} else {
// all notifications registered, start listening
gatt_client_service_t service;
service.start_group_handle = connection->start_handle;
service.end_group_handle = connection->end_handle;
gatt_client_listen_for_service_characteristic_value_updates(&connection->notification_listener, client->packet_handler,
connection->con_handle, &service, client->service_id, connection->cid);
connection->characteristic_index = 0;
connection->state = GATT_SERVICE_CLIENT_STATE_CONNECTED;
gatt_service_client_emit_connected(client->packet_handler, connection->con_handle, connection->cid, ERROR_CODE_SUCCESS);
}
break;
default:
break;
}
// TODO run_for_client
return true;
}
static uint8_t gatt_service_client_get_uninitialized_characteristic_index_for_uuid16(
gatt_service_client_t * client,
gatt_service_client_connection_t * connection,
uint16_t uuid16){
uint8_t index = 0xff;
uint8_t i;
for (i = 0; i < client->characteristics_desc16_num; i++){
if (client->characteristics_desc16[i] == uuid16){
// allow for more then one instance of the same characteristic (as in OTS client)
if (connection->characteristics[i].value_handle != 0){
continue;
}
index = i;
break;
}
}
return index;
}
static void gatt_service_client_handle_disconnect(hci_con_handle_t con_handle){
btstack_linked_list_iterator_t service_it;
btstack_linked_list_iterator_init(&service_it, &gatt_service_clients);
while (btstack_linked_list_iterator_has_next(&service_it)){
gatt_service_client_t * client = (gatt_service_client_t *)btstack_linked_list_iterator_next(&service_it);
btstack_linked_list_iterator_t connection_it;
btstack_linked_list_iterator_init(&connection_it, &client->connections);
while (btstack_linked_list_iterator_has_next(&connection_it)){
gatt_service_client_connection_t * connection = (gatt_service_client_connection_t *)btstack_linked_list_iterator_next(&connection_it);
if (connection->con_handle == con_handle) {
gatt_service_client_emit_disconnected(client->packet_handler, connection->con_handle, connection->cid);
gatt_service_client_finalize_connection(client, connection);
}
}
}
}
static void
gatt_service_client_gatt_packet_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) {
UNUSED(channel);
UNUSED(size);
if (packet_type != HCI_EVENT_PACKET) return;
gatt_service_client_t * client;
gatt_service_client_connection_t * connection;
gatt_client_service_t service;
gatt_client_characteristic_t characteristic;
gatt_client_characteristic_descriptor_t characteristic_descriptor;
uint8_t characteristic_index;
bool call_run = true;
switch (hci_event_packet_get_type(packet)){
case GATT_EVENT_SERVICE_QUERY_RESULT:
client = gatt_service_client_get_service_client_for_id(gatt_event_service_query_result_get_service_id(packet));
btstack_assert(client != NULL);
connection = gatt_service_client_get_connection_for_cid(client, gatt_event_service_query_result_get_connection_id(packet));
btstack_assert(connection != NULL);
if (connection->service_instances_num < 1){
gatt_event_service_query_result_get_service(packet, &service);
connection->start_handle = service.start_group_handle;
connection->end_handle = service.end_group_handle;
#ifdef ENABLE_TESTING_SUPPORT
printf("Service: start handle 0x%04X, end handle 0x%04X\n", connection->start_handle, connection->end_handle);
#endif
connection->service_instances_num++;
} else {
log_info("Found more then one Service instance.");
}
break;
case GATT_EVENT_CHARACTERISTIC_QUERY_RESULT:
client = gatt_service_client_get_service_client_for_id(gatt_event_characteristic_query_result_get_service_id(packet));
btstack_assert(client != NULL);
connection = gatt_service_client_get_connection_for_cid(client, gatt_event_characteristic_query_result_get_connection_id(packet));
btstack_assert(connection != NULL);
gatt_event_characteristic_query_result_get_characteristic(packet, &characteristic);
characteristic_index = gatt_service_client_get_uninitialized_characteristic_index_for_uuid16(client, connection, characteristic.uuid16);
if (characteristic_index < client->characteristics_desc16_num){
connection->characteristics[characteristic_index].value_handle = characteristic.value_handle;
connection->characteristics[characteristic_index].properties = characteristic.properties;
connection->characteristics[characteristic_index].end_handle = characteristic.end_handle;
#ifdef ENABLE_TESTING_SUPPORT
printf(" [%u] Attribute Handle 0x%04X, Properties 0x%02X, Value Handle 0x%04X, UUID 0x%04X\n",
characteristic_index, characteristic.start_handle,
characteristic.properties, characteristic.value_handle, characteristic.uuid16);
#endif
}
break;
case GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT:
client = gatt_service_client_get_service_client_for_id(gatt_event_all_characteristic_descriptors_query_result_get_service_id(packet));
btstack_assert(client != NULL);
connection = gatt_service_client_get_connection_for_cid(client, gatt_event_all_characteristic_descriptors_query_result_get_connection_id(packet));
btstack_assert(connection != NULL);
gatt_event_all_characteristic_descriptors_query_result_get_characteristic_descriptor(packet, &characteristic_descriptor);
if (characteristic_descriptor.uuid16 != ORG_BLUETOOTH_DESCRIPTOR_GATT_CLIENT_CHARACTERISTIC_CONFIGURATION){
break;
}
btstack_assert(connection->state == GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_DESCRIPTORS_RESULT);
if ( ((connection->characteristics[connection->characteristic_index].properties & ATT_PROPERTY_NOTIFY) != 0u) ||
((connection->characteristics[connection->characteristic_index].properties & ATT_PROPERTY_INDICATE) != 0u)
){
connection->characteristics[connection->characteristic_index].client_configuration_handle = characteristic_descriptor.handle;
} else {
connection->characteristics[connection->characteristic_index].client_configuration_handle = 0;
}
connection->characteristic_index++;
#ifdef ENABLE_TESTING_SUPPORT
printf(" Characteristic Configuration Descriptor: Handle 0x%04X, UUID 0x%04X\n",
characteristic_descriptor.handle,
characteristic_descriptor.uuid16);
#endif
break;
case GATT_EVENT_QUERY_COMPLETE:
client = gatt_service_client_get_service_client_for_id(gatt_event_query_complete_get_service_id(packet));
btstack_assert(client != NULL);
connection = gatt_service_client_get_connection_for_cid(client, gatt_event_query_complete_get_connection_id(packet));
btstack_assert(connection != NULL);
call_run = gatt_service_client_handle_query_complete(client, connection, gatt_event_query_complete_get_att_status(packet));
break;
default:
call_run = false;
break;
}
if (call_run){
gatt_service_client_run_for_client(client, connection);
}
}
static void gatt_service_client_hci_event_handler(uint8_t packet_type, uint16_t channel, uint8_t *packet, uint16_t size) {
UNUSED(channel);
UNUSED(size);
UNUSED(packet);
UNUSED(size);
if (packet_type != HCI_EVENT_PACKET) return;
hci_con_handle_t con_handle;
switch (hci_event_packet_get_type(packet)) {
case HCI_EVENT_DISCONNECTION_COMPLETE:
con_handle = hci_event_disconnection_complete_get_connection_handle(packet);
gatt_service_client_handle_disconnect(con_handle);
break;
default:
break;
}
}
/* API */
void gatt_service_client_init(void){
if (false == gatt_service_client_intitialized){
gatt_service_client_hci_callback_registration.callback = gatt_service_client_hci_event_handler;
hci_add_event_handler(&gatt_service_client_hci_callback_registration);
gatt_service_client_intitialized = true;
}
}
void gatt_service_client_register_client(gatt_service_client_t *client, btstack_packet_handler_t packet_handler,
const uint16_t *characteristic_uuid16s, uint16_t characteristic_uuid16s_num) {
btstack_assert(gatt_service_client_intitialized);
gatt_service_client_service_cid = btstack_next_cid_ignoring_zero(gatt_service_client_service_cid);
client->service_id =gatt_service_client_service_cid;
client->cid_counter = 0;
client->characteristics_desc16_num = 0;
client->packet_handler = packet_handler;
btstack_linked_list_add(&gatt_service_clients, &client->item);
}
uint8_t
gatt_service_client_connect_primary_service_with_uuid16(hci_con_handle_t con_handle, gatt_service_client_t *client,
gatt_service_client_connection_t *connection,
uint16_t service_uuid16, uint8_t service_index,
gatt_service_client_characteristic_t *characteristics,
uint8_t characteristics_num) {
btstack_assert(client != NULL);
btstack_assert(connection != NULL);
btstack_assert(characteristics != NULL);
if (gatt_service_client_get_connection_for_con_handle_and_service_index(client, con_handle, service_index) != NULL){
return ERROR_CODE_COMMAND_DISALLOWED;
}
if (characteristics_num < client->characteristics_desc16_num){
log_info("At least %u characteristics needed", client->characteristics_desc16_num);
return ERROR_CODE_MEMORY_CAPACITY_EXCEEDED;
}
connection->state = GATT_SERVICE_CLIENT_STATE_W2_QUERY_PRIMARY_SERVICE;
connection->client = client;
connection->cid = gatt_service_client_get_next_cid(client);
connection->con_handle = con_handle;
connection->service_uuid16 = service_uuid16;
connection->service_index = service_index;
connection->characteristics = characteristics;
btstack_linked_list_add(&client->connections, (btstack_linked_item_t *) connection);
gatt_service_client_run_for_client(client, connection);
return ERROR_CODE_SUCCESS;
}
uint8_t
gatt_service_client_connect_secondary_service_with_uuid16(hci_con_handle_t con_handle, gatt_service_client_t *client,
gatt_service_client_connection_t *connection,
uint16_t service_uuid16, uint8_t service_index,
uint16_t service_start_handle, uint16_t service_end_handle,
gatt_service_client_characteristic_t *characteristics,
uint8_t characteristics_num) {
btstack_assert(client != NULL);
btstack_assert(connection != NULL);
btstack_assert(characteristics != NULL);
btstack_assert(characteristics_num >= client->characteristics_desc16_num);
if (gatt_service_client_get_connection_for_con_handle_and_service_index(client, con_handle, service_index) != NULL){
return ERROR_CODE_COMMAND_DISALLOWED;
}
uint16_t cid = gatt_service_client_get_next_cid(client);
connection->state = GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTICS;
connection->client = client;
connection->cid = cid;
connection->con_handle = con_handle;
connection->service_uuid16 = service_uuid16;
connection->service_index = service_index;
connection->start_handle = service_start_handle;
connection->end_handle = service_end_handle;
connection->characteristics = characteristics;
btstack_linked_list_add(&client->connections, (btstack_linked_item_t *) connection);
gatt_service_client_run_for_client(client, connection);
return ERROR_CODE_SUCCESS;
}
uint8_t
gatt_service_client_can_query_characteristic(const gatt_service_client_connection_t *connection,
uint8_t characteristic_index) {
if (connection->state != GATT_SERVICE_CLIENT_STATE_CONNECTED){
return ERROR_CODE_COMMAND_DISALLOWED;
}
if (connection->characteristics[characteristic_index].value_handle == 0){
return ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE;
}
return ERROR_CODE_SUCCESS;
}
uint8_t gatt_service_client_disconnect(gatt_service_client_connection_t *connection) {
// finalize connections
gatt_service_client_emit_disconnected(connection->client->packet_handler, connection->con_handle, connection->cid);
gatt_service_client_finalize_connection(connection->client, connection);
return ERROR_CODE_SUCCESS;
}
void gatt_service_client_unregister_client(gatt_service_client_t * client){
btstack_assert(client != NULL);
client->packet_handler = NULL;
client->cid_counter = 0;
client->characteristics_desc16_num = 0;
btstack_linked_list_iterator_t it;
btstack_linked_list_iterator_init(&it, (btstack_linked_list_t *) &client->connections);
while (btstack_linked_list_iterator_has_next(&it)){
gatt_service_client_connection_t * connection = (gatt_service_client_connection_t *)btstack_linked_list_iterator_next(&it);
gatt_service_client_finalize_connection(client, connection);
}
btstack_linked_list_remove(&gatt_service_clients, &client->item);
}
void gatt_service_client_dump_characteristic_value_handles(const gatt_service_client_connection_t *connection,
const char **characteristic_names) {
#ifdef ENABLE_TESTING_SUPPORT
uint8_t i;
for (i = 0; i < connection->client->characteristics_desc16_num; i++) {
printf("0x%04X %s\n", connection->characteristics[i].value_handle, characteristic_names[i]);
}
#else
UNUSED(connection);
UNUSED(characteristic_names);
#endif
}
void gatt_service_client_deinit(void){
gatt_service_client_service_cid = 0;
gatt_service_clients = NULL;
gatt_service_client_intitialized = false;
}

View File

@ -0,0 +1,297 @@
/*
* Copyright (C) 2023 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 BLUEKITCHEN
* GMBH 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
*
*/
/**
* @title GATT Service Client
*
*/
#ifndef GATT_SERVICE_CLIENT_H
#define GATT_SERVICE_CLIENT_H
#include <stdint.h>
#include "btstack_defines.h"
#include "bluetooth.h"
#include "btstack_linked_list.h"
#include "ble/gatt_client.h"
#if defined __cplusplus
extern "C" {
#endif
/**
* @text A generic GATT Service Client
*/
#define GATT_SERVICE_CLIENT_INVALID_INDEX 0xff
typedef enum {
GATT_SERVICE_CLIENT_STATE_W2_QUERY_PRIMARY_SERVICE,
GATT_SERVICE_CLIENT_STATE_W4_SERVICE_RESULT,
GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTICS,
GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_RESULT,
GATT_SERVICE_CLIENT_STATE_W2_QUERY_CHARACTERISTIC_DESCRIPTORS,
GATT_SERVICE_CLIENT_STATE_W4_CHARACTERISTIC_DESCRIPTORS_RESULT,
GATT_SERVICE_CLIENT_STATE_W2_REGISTER_NOTIFICATION,
GATT_SERVICE_CLIENT_STATE_W4_NOTIFICATION_REGISTERED,
GATT_SERVICE_CLIENT_STATE_CONNECTED
} gatt_service_client_state_t;
typedef struct {
uint16_t value_handle;
uint16_t client_configuration_handle;
uint16_t properties;
uint16_t end_handle;
} gatt_service_client_characteristic_t;
struct gatt_service_client;
typedef struct {
btstack_linked_item_t item;
struct gatt_service_client * client;
hci_con_handle_t con_handle;
uint16_t cid;
gatt_service_client_state_t state;
// service
uint16_t service_uuid16;
uint8_t service_index;
uint16_t service_instances_num;
uint16_t start_handle;
uint16_t end_handle;
uint8_t characteristic_index;
gatt_service_client_characteristic_t * characteristics;
gatt_client_service_notification_t notification_listener;
} gatt_service_client_connection_t;
typedef struct gatt_service_client {
btstack_linked_item_t item;
btstack_linked_list_t connections;
uint16_t service_id;
uint16_t cid_counter;
// characteristics
uint8_t characteristics_desc16_num; // uuid16s_num
const uint16_t * characteristics_desc16; // uuid16s
btstack_packet_handler_t packet_handler;
} gatt_service_client_t;
/* API_START */
/**
* @brief Initialize GATT Service Client infrastructure
*/
void gatt_service_client_init(void);
/**
* @brief Register new GATT Service Client with list of Characteristic UUID16s
* @param client
* @param characteristic_uuid16s
* @param characteristic_uuid16s_num
* @param trampoline_packet_handler packet handler that calls gatt_service_client_trampoline_packet_handler with client
*/
void gatt_service_client_register_client(gatt_service_client_t *client, btstack_packet_handler_t packet_handler,
const uint16_t *characteristic_uuid16s, uint16_t characteristic_uuid16s_num);
/**
* @brief Get Characteristic UUID16 for given Characteristic index
*
* @param client
* @param characteristic_index
* @return uuid16 or 0 if index out of range
*/
uint16_t gatt_service_client_characteristic_uuid16_for_index(const gatt_service_client_t * client, uint8_t characteristic_index);
/**
* @bbreif Unregister GATT Service Client
* @param client
*/
void gatt_service_client_unregister_client(gatt_service_client_t * client);
/**
* @brief Connect to the n-th instance of Primary GATT Service with UUID16
*
* @param con_handle
* @param client
* @param connection
* @param service_uuid16
* @param service_index
* @param characteristics
* @param characteristics_num
* @return
*/
uint8_t
gatt_service_client_connect_primary_service_with_uuid16(hci_con_handle_t con_handle, gatt_service_client_t *client,
gatt_service_client_connection_t *connection,
uint16_t service_uuid16, uint8_t service_index,
gatt_service_client_characteristic_t *characteristics,
uint8_t characteristics_num);
/**
* @brief Connect to the Secondary GATT Service with given handle range
*
* UUID16 and Service Index are stored for GATT Service Client user only
*
* @param con_handle
* @param client
* @param connection
* @param service_uuid16
* @param service_start_handle
* @param service_end_handle
* @param service_index
* @param characteristics
* @param characteristics_num
* @return
*/
uint8_t
gatt_service_client_connect_secondary_service_with_uuid16(hci_con_handle_t con_handle, gatt_service_client_t *client,
gatt_service_client_connection_t *connection,
uint16_t service_uuid16, uint8_t service_index,
uint16_t service_start_handle, uint16_t service_end_handle,
gatt_service_client_characteristic_t *characteristics,
uint8_t characteristics_num);
/**
* @brief Disconnect service client
* @param client
* @param connection
* @return
*/
uint8_t gatt_service_client_disconnect(gatt_service_client_connection_t *connection);
/**
* @brief Check if Characteristic is available and can be queried
* @param client
* @param connection
* @param characteristic_index
* @return ERROR_CODE_SUCCESS if ready, ERROR_CODE_COMMAND_DISALLOWED or ERROR_CODE_UNSUPPORTED_FEATURE_OR_PARAMETER_VALUE otherwise
*/
uint8_t
gatt_service_client_can_query_characteristic(const gatt_service_client_connection_t *connection,
uint8_t characteristic_index);
/**
* @brief Get Characteristic Value Handle for given Characteristic index
* *
* @param connection
* @param characteristic_index
* @return
*/
uint16_t gatt_service_client_characteristic_value_handle_for_index(const gatt_service_client_connection_t *connection,
uint8_t characteristic_index);
/**
* @brief Get Characteristic index Handle for given Characteristic Value Handle
* *
* @param connection
* @param value_handle
* @return index of characteristic in initial list or GATT_SERVICE_CLIENT_INVALID_INDEX
*/
uint8_t gatt_service_client_characteristic_index_for_value_handle(const gatt_service_client_connection_t *connection,
uint16_t value_handle);
/**
* @brief Get connection id
* @param client
* @param connection
* @returns connection_id
*/
uint16_t gatt_service_client_get_connection_id(const gatt_service_client_connection_t * connection);
/**
* @brief Get connection handle
* @param client
* @param connection
* @returns con_handle
*/
hci_con_handle_t gatt_service_client_get_con_handle(const gatt_service_client_connection_t * connection);
/**
* @brief Get service index provided in connect call
* @param client
* @param connection
* @returns connection_id
*/
uint8_t gatt_service_client_get_service_index(const gatt_service_client_connection_t * connection);
/**
* @brief Get remote MTU
* @param client
* @param connection
* @returns MTU or 0 in case of error
*/
uint16_t gatt_service_client_get_mtu(const gatt_service_client_connection_t *connection);
/**
* @brief Dump characteristic value handles
* @param client
* @param connection
* @param characteristic_names
*/
void gatt_service_client_dump_characteristic_value_handles(const gatt_service_client_connection_t *connection,
const char **characteristic_names);
/**
* @brief De-Init
* @param client
*/
void gatt_service_client_deinit(void);
/**
* @brief Map ATT Error Code to (extended) Error Codes
* @param att_error_code
* @return
*/
uint8_t gatt_service_client_att_status_to_error_code(uint8_t att_error_code);
/* API_END */
#if defined __cplusplus
}
#endif
#endif

View File

@ -90,6 +90,7 @@
#include "ble/gatt-service/cycling_speed_and_cadence_service_server.h"
#include "ble/gatt-service/device_information_service_client.h"
#include "ble/gatt-service/device_information_service_server.h"
#include "ble/gatt_service_client.h"
#include "ble/gatt-service/heart_rate_service_server.h"
#include "ble/gatt-service/hids_client.h"
#include "ble/gatt-service/hids_device.h"