xref: /btstack/src/ble/gatt_service_client.c (revision 41c443219031bee53db470de84d5ebf4c808d432)

/*
 * 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
 * [email protected]
 *
 */

#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;
    client->characteristics_desc16 = characteristic_uuid16s;
    client->characteristics_desc16_num = characteristic_uuid16s_num;
    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;
}