10f7fd6c1SMilanka Ringwald #include <stdint.h> 20f7fd6c1SMilanka Ringwald #include <stdio.h> 30f7fd6c1SMilanka Ringwald #include <string.h> 40f7fd6c1SMilanka Ringwald 5af770404SMilanka Ringwald #include "btstack_debug.h" 60f7fd6c1SMilanka Ringwald #include "mock_gatt_client.h" 70f7fd6c1SMilanka Ringwald 80f7fd6c1SMilanka Ringwald #include "CppUTest/TestHarness.h" 90f7fd6c1SMilanka Ringwald #include "CppUTestExt/MockSupport.h" 100f7fd6c1SMilanka Ringwald 11af770404SMilanka Ringwald static enum { 12af770404SMilanka Ringwald MOCK_QUERY_IDLE = 0, 13d41a8f51SMilanka Ringwald MOCK_QUERY_DISCOVER_PRIMARY_SERVICES_BY_UUID16, 14d41a8f51SMilanka Ringwald MOCK_QUERY_DISCOVER_CHARACTERISTICS_BY_UUID16, 1576cdba3eSMilanka Ringwald MOCK_QUERY_DISCOVER_CHARACTERISTIC_DESCRIPTORS, 1676cdba3eSMilanka Ringwald MOCK_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION, 1776cdba3eSMilanka Ringwald MOCK_READ_VALUE_OF_CHARACTERISTIC_USING_VALUE_HANDLE 18af770404SMilanka Ringwald } mock_gatt_client_state; 19af770404SMilanka Ringwald 2076cdba3eSMilanka Ringwald static uint16_t mock_gatt_client_att_handle_generator; 2176cdba3eSMilanka Ringwald 22af770404SMilanka Ringwald static uint8_t mock_gatt_client_att_error; 23af770404SMilanka Ringwald static uint16_t mock_gatt_client_uuid; 2476cdba3eSMilanka Ringwald static uint16_t mock_gatt_client_value_handle; 2576cdba3eSMilanka Ringwald static uint16_t mock_gatt_client_start_handle; 2676cdba3eSMilanka Ringwald static uint16_t mock_gatt_client_end_handle; 2776cdba3eSMilanka Ringwald 28af770404SMilanka Ringwald static gatt_client_t gatt_client; 290f7fd6c1SMilanka Ringwald 307da2c1baSMilanka Ringwald static btstack_linked_list_t mock_gatt_client_services; 317da2c1baSMilanka Ringwald 327da2c1baSMilanka Ringwald static mock_gatt_client_service_t * mock_gatt_client_last_service; 337da2c1baSMilanka Ringwald static mock_gatt_client_characteristic_t * mock_gatt_client_last_characteristic; 347da2c1baSMilanka Ringwald 350f7fd6c1SMilanka Ringwald void mock_gatt_client_reset(void){ 36af770404SMilanka Ringwald mock_gatt_client_att_error = 0; 37af770404SMilanka Ringwald mock_gatt_client_state = MOCK_QUERY_IDLE; 3876cdba3eSMilanka Ringwald mock_gatt_client_att_handle_generator = 0; 3976cdba3eSMilanka Ringwald mock_gatt_client_last_service = NULL; 407da2c1baSMilanka Ringwald 417da2c1baSMilanka Ringwald btstack_linked_list_iterator_t service_it; 427da2c1baSMilanka Ringwald btstack_linked_list_iterator_init(&service_it, &mock_gatt_client_services); 437da2c1baSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&service_it)){ 447da2c1baSMilanka Ringwald mock_gatt_client_service_t * service = (mock_gatt_client_service_t *) btstack_linked_list_iterator_next(&service_it); 457da2c1baSMilanka Ringwald btstack_linked_list_remove(&mock_gatt_client_services, (btstack_linked_item_t *) service); 467da2c1baSMilanka Ringwald 477da2c1baSMilanka Ringwald btstack_linked_list_iterator_t characteristic_it; 487da2c1baSMilanka Ringwald btstack_linked_list_iterator_init(&characteristic_it, &service->characteristics); 497da2c1baSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&characteristic_it)){ 507da2c1baSMilanka Ringwald mock_gatt_client_characteristic_t * characteristic = (mock_gatt_client_characteristic_t *) btstack_linked_list_iterator_next(&characteristic_it); 517da2c1baSMilanka Ringwald btstack_linked_list_remove(&service->characteristics, (btstack_linked_item_t *) characteristic); 527da2c1baSMilanka Ringwald 537da2c1baSMilanka Ringwald btstack_linked_list_iterator_t desc_it; 547da2c1baSMilanka Ringwald btstack_linked_list_iterator_init(&desc_it, &characteristic->descriptors); 557da2c1baSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&desc_it)){ 567da2c1baSMilanka Ringwald mock_gatt_client_characteristic_descriptor_t * desc = (mock_gatt_client_characteristic_descriptor_t *) btstack_linked_list_iterator_next(&desc_it); 577da2c1baSMilanka Ringwald btstack_linked_list_remove(&characteristic->descriptors, (btstack_linked_item_t *) desc); 587da2c1baSMilanka Ringwald free(desc); 597da2c1baSMilanka Ringwald } 607da2c1baSMilanka Ringwald free(characteristic); 617da2c1baSMilanka Ringwald } 627da2c1baSMilanka Ringwald free(service); 637da2c1baSMilanka Ringwald } 640f7fd6c1SMilanka Ringwald } 65af770404SMilanka Ringwald 6676cdba3eSMilanka Ringwald void mock_gatt_client_dump_services(void){ 6776cdba3eSMilanka Ringwald btstack_linked_list_iterator_t service_it; 6876cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&service_it, &mock_gatt_client_services); 6976cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&service_it)){ 7076cdba3eSMilanka Ringwald mock_gatt_client_service_t * service = (mock_gatt_client_service_t *) btstack_linked_list_iterator_next(&service_it); 7176cdba3eSMilanka Ringwald printf("0x%02x: START SERVICE 0%02x\n", service->start_group_handle, service->uuid16); 7276cdba3eSMilanka Ringwald 7376cdba3eSMilanka Ringwald btstack_linked_list_iterator_t characteristic_it; 7476cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&characteristic_it, &service->characteristics); 7576cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&characteristic_it)){ 7676cdba3eSMilanka Ringwald mock_gatt_client_characteristic_t * characteristic = (mock_gatt_client_characteristic_t *) btstack_linked_list_iterator_next(&characteristic_it); 7776cdba3eSMilanka Ringwald printf("0x%02x: START CHR 0%02x\n", characteristic->start_handle, characteristic->uuid16); 7876cdba3eSMilanka Ringwald printf("0x%02x: VALUE HANDLE CHR 0%02x\n", characteristic->value_handle, characteristic->uuid16); 7976cdba3eSMilanka Ringwald 8076cdba3eSMilanka Ringwald btstack_linked_list_iterator_t desc_it; 8176cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&desc_it, &characteristic->descriptors); 8276cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&desc_it)){ 8376cdba3eSMilanka Ringwald mock_gatt_client_characteristic_descriptor_t * desc = (mock_gatt_client_characteristic_descriptor_t *) btstack_linked_list_iterator_next(&desc_it); 8476cdba3eSMilanka Ringwald printf("0x%02x: DESC 0x%02x\n", desc->handle, desc->uuid16); 8576cdba3eSMilanka Ringwald } 8676cdba3eSMilanka Ringwald 8776cdba3eSMilanka Ringwald printf("0x%02x: END CHR 0%02x\n", characteristic->end_handle, characteristic->uuid16); 8876cdba3eSMilanka Ringwald 8976cdba3eSMilanka Ringwald } 9076cdba3eSMilanka Ringwald printf("0x%02x: END SERVICE 0%02x\n", service->end_group_handle, service->uuid16); 9176cdba3eSMilanka Ringwald 9276cdba3eSMilanka Ringwald } 9376cdba3eSMilanka Ringwald } 9476cdba3eSMilanka Ringwald 9576cdba3eSMilanka Ringwald mock_gatt_client_service_t * mock_gatt_client_add_primary_service_uuid16(uint16_t service_uuid){ 9676cdba3eSMilanka Ringwald // set lsat group handle 9776cdba3eSMilanka Ringwald // create new service 987da2c1baSMilanka Ringwald mock_gatt_client_last_service = (mock_gatt_client_service_t * )malloc(sizeof(mock_gatt_client_service_t)); 997da2c1baSMilanka Ringwald memset(mock_gatt_client_last_service, 0, sizeof(mock_gatt_client_service_t)); 1007da2c1baSMilanka Ringwald mock_gatt_client_last_service->uuid16 = service_uuid; 10176cdba3eSMilanka Ringwald mock_gatt_client_last_service->start_group_handle = mock_gatt_client_att_handle_generator++; 10276cdba3eSMilanka Ringwald mock_gatt_client_last_service->end_group_handle = 0xffff; 1037da2c1baSMilanka Ringwald btstack_linked_list_add(&mock_gatt_client_services, (btstack_linked_item_t*)mock_gatt_client_last_service); 10476cdba3eSMilanka Ringwald mock_gatt_client_last_characteristic = NULL; 10576cdba3eSMilanka Ringwald return mock_gatt_client_last_service; 1060f7fd6c1SMilanka Ringwald } 107af770404SMilanka Ringwald 10876cdba3eSMilanka Ringwald mock_gatt_client_characteristic_t * mock_gatt_client_add_characteristic_uuid16(uint16_t characteristic_uuid, uint16_t properties){ 1097da2c1baSMilanka Ringwald btstack_assert(mock_gatt_client_last_service != NULL); 1107da2c1baSMilanka Ringwald mock_gatt_client_last_characteristic = (mock_gatt_client_characteristic_t * )malloc(sizeof(mock_gatt_client_characteristic_t)); 1117da2c1baSMilanka Ringwald memset(mock_gatt_client_last_characteristic, 0, sizeof(mock_gatt_client_characteristic_t)); 1127da2c1baSMilanka Ringwald mock_gatt_client_last_characteristic->uuid16 = characteristic_uuid; 11376cdba3eSMilanka Ringwald mock_gatt_client_last_characteristic->properties = properties; 11476cdba3eSMilanka Ringwald mock_gatt_client_last_characteristic->start_handle = mock_gatt_client_att_handle_generator++; 11576cdba3eSMilanka Ringwald mock_gatt_client_last_characteristic->value_handle = mock_gatt_client_att_handle_generator++; 11676cdba3eSMilanka Ringwald mock_gatt_client_last_characteristic->end_handle = mock_gatt_client_last_characteristic->value_handle; 1177da2c1baSMilanka Ringwald btstack_linked_list_add(&mock_gatt_client_last_service->characteristics, (btstack_linked_item_t*)mock_gatt_client_last_characteristic); 11876cdba3eSMilanka Ringwald mock_gatt_client_last_service->end_group_handle = mock_gatt_client_att_handle_generator - 1; 11976cdba3eSMilanka Ringwald return mock_gatt_client_last_characteristic; 1200f7fd6c1SMilanka Ringwald } 121af770404SMilanka Ringwald 12276cdba3eSMilanka Ringwald mock_gatt_client_characteristic_descriptor_t * mock_gatt_client_add_characteristic_descriptor_uuid16(uint16_t descriptor_uuid){ 12376cdba3eSMilanka Ringwald btstack_assert(mock_gatt_client_last_characteristic != NULL); 1247da2c1baSMilanka Ringwald mock_gatt_client_characteristic_descriptor_t * desc = (mock_gatt_client_characteristic_descriptor_t * )malloc(sizeof(mock_gatt_client_characteristic_descriptor_t)); 1257da2c1baSMilanka Ringwald memset(desc, 0, sizeof(mock_gatt_client_characteristic_descriptor_t)); 1267da2c1baSMilanka Ringwald desc->uuid16 = descriptor_uuid; 12776cdba3eSMilanka Ringwald desc->handle = mock_gatt_client_att_handle_generator++; 1287da2c1baSMilanka Ringwald btstack_linked_list_add(&mock_gatt_client_last_characteristic->descriptors, (btstack_linked_item_t*)desc); 12976cdba3eSMilanka Ringwald mock_gatt_client_last_characteristic->end_handle = mock_gatt_client_att_handle_generator - 1; 13076cdba3eSMilanka Ringwald mock_gatt_client_last_service->end_group_handle = mock_gatt_client_att_handle_generator - 1; 13176cdba3eSMilanka Ringwald return desc; 1320f7fd6c1SMilanka Ringwald } 1330f7fd6c1SMilanka Ringwald 13476cdba3eSMilanka Ringwald static mock_gatt_client_characteristic_t * mock_gatt_client_get_characteristic_for_value_handle(uint16_t value_handle){ 13576cdba3eSMilanka Ringwald btstack_linked_list_iterator_t service_it; 13676cdba3eSMilanka Ringwald btstack_linked_list_iterator_t characteristic_it; 13776cdba3eSMilanka Ringwald 13876cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&service_it, &mock_gatt_client_services); 13976cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&service_it)){ 14076cdba3eSMilanka Ringwald mock_gatt_client_service_t * service = (mock_gatt_client_service_t *) btstack_linked_list_iterator_next(&service_it); 14176cdba3eSMilanka Ringwald 14276cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&characteristic_it, &service->characteristics); 14376cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&characteristic_it)){ 14476cdba3eSMilanka Ringwald mock_gatt_client_characteristic_t * characteristic = (mock_gatt_client_characteristic_t *) btstack_linked_list_iterator_next(&characteristic_it); 14576cdba3eSMilanka Ringwald if (characteristic->value_handle != value_handle) continue; 14676cdba3eSMilanka Ringwald return characteristic; 14776cdba3eSMilanka Ringwald } 14876cdba3eSMilanka Ringwald } 14976cdba3eSMilanka Ringwald return NULL; 15076cdba3eSMilanka Ringwald } 15176cdba3eSMilanka Ringwald 15276cdba3eSMilanka Ringwald static mock_gatt_client_characteristic_descriptor_t * mock_gatt_client_get_characteristic_descriptor_for_handle(uint16_t handle){ 15376cdba3eSMilanka Ringwald btstack_linked_list_iterator_t service_it; 15476cdba3eSMilanka Ringwald btstack_linked_list_iterator_t characteristic_it; 15576cdba3eSMilanka Ringwald 15676cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&service_it, &mock_gatt_client_services); 15776cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&service_it)){ 15876cdba3eSMilanka Ringwald mock_gatt_client_service_t * service = (mock_gatt_client_service_t *) btstack_linked_list_iterator_next(&service_it); 15976cdba3eSMilanka Ringwald 16076cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&characteristic_it, &service->characteristics); 16176cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&characteristic_it)){ 16276cdba3eSMilanka Ringwald mock_gatt_client_characteristic_t * characteristic = (mock_gatt_client_characteristic_t *) btstack_linked_list_iterator_next(&characteristic_it); 16376cdba3eSMilanka Ringwald 16476cdba3eSMilanka Ringwald btstack_linked_list_iterator_t desc_it; 16576cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&desc_it, &characteristic->descriptors); 16676cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&desc_it)){ 16776cdba3eSMilanka Ringwald mock_gatt_client_characteristic_descriptor_t * desc = (mock_gatt_client_characteristic_descriptor_t *) btstack_linked_list_iterator_next(&desc_it); 16876cdba3eSMilanka Ringwald if (desc->handle != handle) continue; 16976cdba3eSMilanka Ringwald return desc; 17076cdba3eSMilanka Ringwald } 17176cdba3eSMilanka Ringwald } 17276cdba3eSMilanka Ringwald } 17376cdba3eSMilanka Ringwald return NULL; 17476cdba3eSMilanka Ringwald } 17576cdba3eSMilanka Ringwald 17676cdba3eSMilanka Ringwald 17776cdba3eSMilanka Ringwald void mock_gatt_client_set_characteristic_value(mock_gatt_client_characteristic_descriptor_t * descriptor, uint8_t * value_buffer, uint16_t value_len){ 17876cdba3eSMilanka Ringwald btstack_assert(descriptor != NULL); 17976cdba3eSMilanka Ringwald descriptor->value_buffer = value_buffer; 18076cdba3eSMilanka Ringwald descriptor->value_len = value_len; 18176cdba3eSMilanka Ringwald } 1827da2c1baSMilanka Ringwald 183af770404SMilanka Ringwald // simulate erro 184af770404SMilanka Ringwald void mock_gatt_client_simulate_att_error(uint8_t att_error){ 185af770404SMilanka Ringwald mock_gatt_client_att_error = att_error; 1860f7fd6c1SMilanka Ringwald } 1870f7fd6c1SMilanka Ringwald 1880f7fd6c1SMilanka Ringwald uint8_t gatt_client_discover_primary_services_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t uuid16){ 189d41a8f51SMilanka Ringwald mock_gatt_client_state = MOCK_QUERY_DISCOVER_PRIMARY_SERVICES_BY_UUID16; 190af770404SMilanka Ringwald mock_gatt_client_uuid = uuid16; 191af770404SMilanka Ringwald 192af770404SMilanka Ringwald gatt_client.callback = callback; 193af770404SMilanka Ringwald gatt_client.con_handle = con_handle; 1940f7fd6c1SMilanka Ringwald return ERROR_CODE_SUCCESS; 1950f7fd6c1SMilanka Ringwald } 1960f7fd6c1SMilanka Ringwald 1970f7fd6c1SMilanka Ringwald uint8_t gatt_client_discover_characteristics_for_handle_range_by_uuid16(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t start_handle, uint16_t end_handle, uint16_t uuid16){ 198d41a8f51SMilanka Ringwald mock_gatt_client_state = MOCK_QUERY_DISCOVER_CHARACTERISTICS_BY_UUID16; 1997da2c1baSMilanka Ringwald mock_gatt_client_uuid = uuid16; 20076cdba3eSMilanka Ringwald mock_gatt_client_start_handle = start_handle; 20176cdba3eSMilanka Ringwald mock_gatt_client_end_handle = end_handle; 2027da2c1baSMilanka Ringwald 2037da2c1baSMilanka Ringwald gatt_client.callback = callback; 2047da2c1baSMilanka Ringwald gatt_client.con_handle = con_handle; 2050f7fd6c1SMilanka Ringwald return ERROR_CODE_SUCCESS; 2060f7fd6c1SMilanka Ringwald } 2070f7fd6c1SMilanka Ringwald 2080f7fd6c1SMilanka Ringwald uint8_t gatt_client_discover_characteristic_descriptors(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 20976cdba3eSMilanka Ringwald mock_gatt_client_state = MOCK_QUERY_DISCOVER_CHARACTERISTIC_DESCRIPTORS; 21076cdba3eSMilanka Ringwald mock_gatt_client_value_handle = characteristic->value_handle; 21176cdba3eSMilanka Ringwald 21276cdba3eSMilanka Ringwald gatt_client.callback = callback; 21376cdba3eSMilanka Ringwald gatt_client.con_handle = con_handle; 21476cdba3eSMilanka Ringwald return ERROR_CODE_SUCCESS; 21576cdba3eSMilanka Ringwald } 21676cdba3eSMilanka Ringwald 21776cdba3eSMilanka Ringwald uint8_t gatt_client_write_client_characteristic_configuration(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic, uint16_t configuration){ 21876cdba3eSMilanka Ringwald mock_gatt_client_state = MOCK_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION; 21976cdba3eSMilanka Ringwald mock_gatt_client_uuid = characteristic->uuid16; 22076cdba3eSMilanka Ringwald 22176cdba3eSMilanka Ringwald gatt_client.callback = callback; 22276cdba3eSMilanka Ringwald gatt_client.con_handle = con_handle; 22376cdba3eSMilanka Ringwald return ERROR_CODE_SUCCESS; 22476cdba3eSMilanka Ringwald } 22576cdba3eSMilanka Ringwald 22676cdba3eSMilanka Ringwald void gatt_client_listen_for_characteristic_value_updates(gatt_client_notification_t * notification, btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 22776cdba3eSMilanka Ringwald notification->callback = callback; 22876cdba3eSMilanka Ringwald notification->con_handle = con_handle; 22976cdba3eSMilanka Ringwald 23076cdba3eSMilanka Ringwald if (characteristic == NULL){ 23176cdba3eSMilanka Ringwald // 'all characteristics': not used yet 232af770404SMilanka Ringwald btstack_assert(false); 23376cdba3eSMilanka Ringwald } else { 23476cdba3eSMilanka Ringwald notification->attribute_handle = characteristic->value_handle; 23576cdba3eSMilanka Ringwald } 23676cdba3eSMilanka Ringwald 23776cdba3eSMilanka Ringwald // finc our characteristic and set point to notification 23876cdba3eSMilanka Ringwald } 23976cdba3eSMilanka Ringwald 24076cdba3eSMilanka Ringwald 24176cdba3eSMilanka Ringwald uint8_t gatt_client_read_value_of_characteristic_using_value_handle(btstack_packet_handler_t callback, hci_con_handle_t con_handle, uint16_t value_handle){ 24276cdba3eSMilanka Ringwald mock_gatt_client_state = MOCK_READ_VALUE_OF_CHARACTERISTIC_USING_VALUE_HANDLE; 24376cdba3eSMilanka Ringwald mock_gatt_client_value_handle = value_handle; 244af770404SMilanka Ringwald return ERROR_CODE_SUCCESS; 245af770404SMilanka Ringwald } 246af770404SMilanka Ringwald 247af770404SMilanka Ringwald uint8_t gatt_client_read_value_of_characteristic(btstack_packet_handler_t callback, hci_con_handle_t con_handle, gatt_client_characteristic_t * characteristic){ 248*24152f08SMilanka Ringwald btstack_assert(characteristic != NULL); 249*24152f08SMilanka Ringwald mock_gatt_client_state = MOCK_READ_VALUE_OF_CHARACTERISTIC_USING_VALUE_HANDLE; 250*24152f08SMilanka Ringwald mock_gatt_client_characteristic_t * mock_characteristic = mock_gatt_client_get_characteristic_for_value_handle(characteristic->value_handle); 251*24152f08SMilanka Ringwald 252*24152f08SMilanka Ringwald btstack_assert(mock_characteristic != NULL); 253*24152f08SMilanka Ringwald 254*24152f08SMilanka Ringwald mock_gatt_client_value_handle = mock_characteristic->value_handle; 2550f7fd6c1SMilanka Ringwald return ERROR_CODE_SUCCESS; 2560f7fd6c1SMilanka Ringwald } 2570f7fd6c1SMilanka Ringwald 258af770404SMilanka Ringwald void gatt_client_stop_listening_for_characteristic_value_updates(gatt_client_notification_t * notification){ 259af770404SMilanka Ringwald } 260af770404SMilanka Ringwald 261af770404SMilanka Ringwald /** 262af770404SMilanka Ringwald * copied from gatt_client.c - START 263af770404SMilanka Ringwald */ 2640f7fd6c1SMilanka Ringwald void gatt_client_deserialize_service(const uint8_t *packet, int offset, gatt_client_service_t * service){ 2650f7fd6c1SMilanka Ringwald service->start_group_handle = little_endian_read_16(packet, offset); 2660f7fd6c1SMilanka Ringwald service->end_group_handle = little_endian_read_16(packet, offset + 2); 2670f7fd6c1SMilanka Ringwald reverse_128(&packet[offset + 4], service->uuid128); 2680f7fd6c1SMilanka Ringwald if (uuid_has_bluetooth_prefix(service->uuid128)){ 2690f7fd6c1SMilanka Ringwald service->uuid16 = big_endian_read_32(service->uuid128, 0); 2700f7fd6c1SMilanka Ringwald } else { 2710f7fd6c1SMilanka Ringwald service->uuid16 = 0; 2720f7fd6c1SMilanka Ringwald } 2730f7fd6c1SMilanka Ringwald } 2740f7fd6c1SMilanka Ringwald 2750f7fd6c1SMilanka Ringwald void gatt_client_deserialize_characteristic(const uint8_t * packet, int offset, gatt_client_characteristic_t * characteristic){ 2760f7fd6c1SMilanka Ringwald characteristic->start_handle = little_endian_read_16(packet, offset); 2770f7fd6c1SMilanka Ringwald characteristic->value_handle = little_endian_read_16(packet, offset + 2); 2780f7fd6c1SMilanka Ringwald characteristic->end_handle = little_endian_read_16(packet, offset + 4); 2790f7fd6c1SMilanka Ringwald characteristic->properties = little_endian_read_16(packet, offset + 6); 2800f7fd6c1SMilanka Ringwald reverse_128(&packet[offset+8], characteristic->uuid128); 2810f7fd6c1SMilanka Ringwald if (uuid_has_bluetooth_prefix(characteristic->uuid128)){ 2820f7fd6c1SMilanka Ringwald characteristic->uuid16 = big_endian_read_32(characteristic->uuid128, 0); 2830f7fd6c1SMilanka Ringwald } else { 2840f7fd6c1SMilanka Ringwald characteristic->uuid16 = 0; 2850f7fd6c1SMilanka Ringwald } 2860f7fd6c1SMilanka Ringwald } 2870f7fd6c1SMilanka Ringwald 2880f7fd6c1SMilanka Ringwald void gatt_client_deserialize_characteristic_descriptor(const uint8_t * packet, int offset, gatt_client_characteristic_descriptor_t * descriptor){ 2890f7fd6c1SMilanka Ringwald descriptor->handle = little_endian_read_16(packet, offset); 2900f7fd6c1SMilanka Ringwald reverse_128(&packet[offset+2], descriptor->uuid128); 2910f7fd6c1SMilanka Ringwald if (uuid_has_bluetooth_prefix(descriptor->uuid128)){ 2920f7fd6c1SMilanka Ringwald descriptor->uuid16 = big_endian_read_32(descriptor->uuid128, 0); 2930f7fd6c1SMilanka Ringwald } else { 2940f7fd6c1SMilanka Ringwald descriptor->uuid16 = 0; 2950f7fd6c1SMilanka Ringwald } 2960f7fd6c1SMilanka Ringwald } 2970f7fd6c1SMilanka Ringwald 298af770404SMilanka Ringwald static void emit_event_new(btstack_packet_handler_t callback, uint8_t * packet, uint16_t size){ 299af770404SMilanka Ringwald if (!callback) return; 300af770404SMilanka Ringwald (*callback)(HCI_EVENT_PACKET, 0, packet, size); 3010f7fd6c1SMilanka Ringwald } 3020f7fd6c1SMilanka Ringwald 303af770404SMilanka Ringwald static void emit_gatt_complete_event(gatt_client_t * gatt_client, uint8_t att_status){ 304af770404SMilanka Ringwald // @format H1 305af770404SMilanka Ringwald uint8_t packet[5]; 306af770404SMilanka Ringwald packet[0] = GATT_EVENT_QUERY_COMPLETE; 307af770404SMilanka Ringwald packet[1] = 3; 308af770404SMilanka Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 309af770404SMilanka Ringwald packet[4] = att_status; 310af770404SMilanka Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 3110f7fd6c1SMilanka Ringwald } 3120f7fd6c1SMilanka Ringwald 3137da2c1baSMilanka Ringwald static void emit_gatt_service_query_result_event(gatt_client_t * gatt_client, uint16_t start_group_handle, uint16_t end_group_handle, const uint8_t * uuid128){ 3147da2c1baSMilanka Ringwald // @format HX 3157da2c1baSMilanka Ringwald uint8_t packet[24]; 3167da2c1baSMilanka Ringwald packet[0] = GATT_EVENT_SERVICE_QUERY_RESULT; 3177da2c1baSMilanka Ringwald packet[1] = sizeof(packet) - 2u; 3187da2c1baSMilanka Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 3197da2c1baSMilanka Ringwald /// 3207da2c1baSMilanka Ringwald little_endian_store_16(packet, 4, start_group_handle); 3217da2c1baSMilanka Ringwald little_endian_store_16(packet, 6, end_group_handle); 3227da2c1baSMilanka Ringwald reverse_128(uuid128, &packet[8]); 3237da2c1baSMilanka Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 3247da2c1baSMilanka Ringwald } 3257da2c1baSMilanka Ringwald 3267da2c1baSMilanka Ringwald static void emit_gatt_characteristic_query_result_event(gatt_client_t * gatt_client, uint16_t start_handle, uint16_t value_handle, uint16_t end_handle, 3277da2c1baSMilanka Ringwald uint16_t properties, const uint8_t * uuid128){ 3287da2c1baSMilanka Ringwald // @format HY 3297da2c1baSMilanka Ringwald uint8_t packet[28]; 3307da2c1baSMilanka Ringwald packet[0] = GATT_EVENT_CHARACTERISTIC_QUERY_RESULT; 3317da2c1baSMilanka Ringwald packet[1] = sizeof(packet) - 2u; 3327da2c1baSMilanka Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 3337da2c1baSMilanka Ringwald /// 3347da2c1baSMilanka Ringwald little_endian_store_16(packet, 4, start_handle); 3357da2c1baSMilanka Ringwald little_endian_store_16(packet, 6, value_handle); 3367da2c1baSMilanka Ringwald little_endian_store_16(packet, 8, end_handle); 3377da2c1baSMilanka Ringwald little_endian_store_16(packet, 10, properties); 3387da2c1baSMilanka Ringwald reverse_128(uuid128, &packet[12]); 3397da2c1baSMilanka Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 3407da2c1baSMilanka Ringwald } 3417da2c1baSMilanka Ringwald 34276cdba3eSMilanka Ringwald static void emit_gatt_all_characteristic_descriptors_result_event( 34376cdba3eSMilanka Ringwald gatt_client_t * gatt_client, uint16_t descriptor_handle, const uint8_t * uuid128){ 34476cdba3eSMilanka Ringwald // @format HZ 34576cdba3eSMilanka Ringwald uint8_t packet[22]; 34676cdba3eSMilanka Ringwald packet[0] = GATT_EVENT_ALL_CHARACTERISTIC_DESCRIPTORS_QUERY_RESULT; 34776cdba3eSMilanka Ringwald packet[1] = sizeof(packet) - 2u; 34876cdba3eSMilanka Ringwald little_endian_store_16(packet, 2, gatt_client->con_handle); 34976cdba3eSMilanka Ringwald /// 35076cdba3eSMilanka Ringwald little_endian_store_16(packet, 4, descriptor_handle); 35176cdba3eSMilanka Ringwald reverse_128(uuid128, &packet[6]); 35276cdba3eSMilanka Ringwald emit_event_new(gatt_client->callback, packet, sizeof(packet)); 35376cdba3eSMilanka Ringwald } 35476cdba3eSMilanka Ringwald 35576cdba3eSMilanka Ringwald 35676cdba3eSMilanka Ringwald static const int characteristic_value_event_header_size = 8; 35776cdba3eSMilanka Ringwald static uint8_t * setup_characteristic_value_packet(uint8_t type, hci_con_handle_t con_handle, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 35876cdba3eSMilanka Ringwald // before the value inside the ATT PDU 35976cdba3eSMilanka Ringwald uint8_t * packet = value - characteristic_value_event_header_size; 36076cdba3eSMilanka Ringwald packet[0] = type; 36176cdba3eSMilanka Ringwald packet[1] = characteristic_value_event_header_size - 2 + length; 36276cdba3eSMilanka Ringwald little_endian_store_16(packet, 2, con_handle); 36376cdba3eSMilanka Ringwald little_endian_store_16(packet, 4, attribute_handle); 36476cdba3eSMilanka Ringwald little_endian_store_16(packet, 6, length); 36576cdba3eSMilanka Ringwald return packet; 36676cdba3eSMilanka Ringwald } 36776cdba3eSMilanka Ringwald 36876cdba3eSMilanka Ringwald // @note assume that value is part of an l2cap buffer - overwrite parts of the HCI/L2CAP/ATT packet (4/4/3) bytes 36976cdba3eSMilanka Ringwald static void report_gatt_characteristic_value(gatt_client_t * gatt_client, uint16_t attribute_handle, uint8_t * value, uint16_t length){ 37076cdba3eSMilanka Ringwald uint8_t * packet = setup_characteristic_value_packet(GATT_EVENT_CHARACTERISTIC_VALUE_QUERY_RESULT, gatt_client->con_handle, attribute_handle, value, length); 37176cdba3eSMilanka Ringwald emit_event_new(gatt_client->callback, packet, characteristic_value_event_header_size + length); 37276cdba3eSMilanka Ringwald } 37376cdba3eSMilanka Ringwald 374af770404SMilanka Ringwald /** 375af770404SMilanka Ringwald * copied from gatt_client.c - END 376af770404SMilanka Ringwald */ 3770f7fd6c1SMilanka Ringwald 3787da2c1baSMilanka Ringwald static void mock_gatt_client_emit_complete(uint8_t status){ 3797da2c1baSMilanka Ringwald mock_gatt_client_state = MOCK_QUERY_IDLE; 3807da2c1baSMilanka Ringwald emit_gatt_complete_event(&gatt_client, status); 3817da2c1baSMilanka Ringwald } 3820f7fd6c1SMilanka Ringwald 383af770404SMilanka Ringwald void mock_gatt_client_run(void){ 384af770404SMilanka Ringwald btstack_assert(mock_gatt_client_state != MOCK_QUERY_IDLE); 38576cdba3eSMilanka Ringwald mock_gatt_client_characteristic_t * characteristic; 38676cdba3eSMilanka Ringwald mock_gatt_client_characteristic_descriptor_t * descriptor; 38776cdba3eSMilanka Ringwald 3887da2c1baSMilanka Ringwald btstack_linked_list_iterator_t service_it; 3897da2c1baSMilanka Ringwald btstack_linked_list_iterator_t characteristic_it; 39076cdba3eSMilanka Ringwald btstack_linked_list_iterator_t descriptor_it; 39176cdba3eSMilanka Ringwald 3927da2c1baSMilanka Ringwald uint8_t uuid128[16]; 3937da2c1baSMilanka Ringwald 3947da2c1baSMilanka Ringwald while (mock_gatt_client_state != MOCK_QUERY_IDLE){ 395af770404SMilanka Ringwald switch (mock_gatt_client_state){ 396d41a8f51SMilanka Ringwald case MOCK_QUERY_DISCOVER_PRIMARY_SERVICES_BY_UUID16: 397af770404SMilanka Ringwald // emit GATT_EVENT_SERVICE_QUERY_RESULT for each matching service 3987da2c1baSMilanka Ringwald btstack_linked_list_iterator_init(&service_it, &mock_gatt_client_services); 3997da2c1baSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&service_it)){ 4007da2c1baSMilanka Ringwald mock_gatt_client_service_t * service = (mock_gatt_client_service_t *) btstack_linked_list_iterator_next(&service_it); 4017da2c1baSMilanka Ringwald if (service->uuid16 != mock_gatt_client_uuid) continue; 4027da2c1baSMilanka Ringwald mock_gatt_client_last_service = service; 4037da2c1baSMilanka Ringwald uuid_add_bluetooth_prefix(uuid128, service->uuid16); 40476cdba3eSMilanka Ringwald emit_gatt_service_query_result_event(&gatt_client, service->start_group_handle, service->end_group_handle, uuid128); 4057da2c1baSMilanka Ringwald } 4067da2c1baSMilanka Ringwald // emit GATT_EVENT_QUERY_COMPLETE 4077da2c1baSMilanka Ringwald mock_gatt_client_emit_complete(ATT_ERROR_SUCCESS); 4087da2c1baSMilanka Ringwald break; 4097da2c1baSMilanka Ringwald 410d41a8f51SMilanka Ringwald case MOCK_QUERY_DISCOVER_CHARACTERISTICS_BY_UUID16: 4117da2c1baSMilanka Ringwald // emit GATT_EVENT_CHARACTERISTIC_QUERY_RESULT for each matching characteristic 4127da2c1baSMilanka Ringwald btstack_linked_list_iterator_init(&service_it, &mock_gatt_client_services); 4137da2c1baSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&service_it)){ 4147da2c1baSMilanka Ringwald mock_gatt_client_service_t * service = (mock_gatt_client_service_t *) btstack_linked_list_iterator_next(&service_it); 4157da2c1baSMilanka Ringwald 4167da2c1baSMilanka Ringwald btstack_linked_list_iterator_init(&characteristic_it, &service->characteristics); 4177da2c1baSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&characteristic_it)){ 4187da2c1baSMilanka Ringwald mock_gatt_client_characteristic_t * characteristic = (mock_gatt_client_characteristic_t *) btstack_linked_list_iterator_next(&characteristic_it); 4197da2c1baSMilanka Ringwald if (characteristic->uuid16 != mock_gatt_client_uuid) continue; 42076cdba3eSMilanka Ringwald if (characteristic->start_handle < mock_gatt_client_start_handle) continue; 42176cdba3eSMilanka Ringwald if (characteristic->end_handle > mock_gatt_client_end_handle) continue; 42276cdba3eSMilanka Ringwald 4237da2c1baSMilanka Ringwald uuid_add_bluetooth_prefix(uuid128, characteristic->uuid16); 42476cdba3eSMilanka Ringwald emit_gatt_characteristic_query_result_event(&gatt_client, 42576cdba3eSMilanka Ringwald characteristic->start_handle, characteristic->value_handle, characteristic->end_handle, 42676cdba3eSMilanka Ringwald characteristic->properties, uuid128); 4277da2c1baSMilanka Ringwald } 4287da2c1baSMilanka Ringwald } 4297da2c1baSMilanka Ringwald 4307da2c1baSMilanka Ringwald // emit GATT_EVENT_QUERY_COMPLETE 4317da2c1baSMilanka Ringwald mock_gatt_client_emit_complete(ERROR_CODE_SUCCESS); 432af770404SMilanka Ringwald break; 43376cdba3eSMilanka Ringwald 43476cdba3eSMilanka Ringwald case MOCK_QUERY_DISCOVER_CHARACTERISTIC_DESCRIPTORS: 43576cdba3eSMilanka Ringwald characteristic = mock_gatt_client_get_characteristic_for_value_handle(mock_gatt_client_value_handle); 43676cdba3eSMilanka Ringwald btstack_assert(characteristic != NULL); 43776cdba3eSMilanka Ringwald 43876cdba3eSMilanka Ringwald btstack_linked_list_iterator_init(&descriptor_it, &characteristic->descriptors); 43976cdba3eSMilanka Ringwald while (btstack_linked_list_iterator_has_next(&descriptor_it)){ 44076cdba3eSMilanka Ringwald mock_gatt_client_characteristic_descriptor_t * desc = (mock_gatt_client_characteristic_descriptor_t *) btstack_linked_list_iterator_next(&descriptor_it); 44176cdba3eSMilanka Ringwald 44276cdba3eSMilanka Ringwald uuid_add_bluetooth_prefix(uuid128, desc->uuid16); 44376cdba3eSMilanka Ringwald emit_gatt_all_characteristic_descriptors_result_event(&gatt_client, desc->handle, uuid128); 44476cdba3eSMilanka Ringwald } 44576cdba3eSMilanka Ringwald 44676cdba3eSMilanka Ringwald // emit GATT_EVENT_QUERY_COMPLETE 44776cdba3eSMilanka Ringwald mock_gatt_client_emit_complete(ERROR_CODE_SUCCESS); 44876cdba3eSMilanka Ringwald break; 44976cdba3eSMilanka Ringwald 45076cdba3eSMilanka Ringwald case MOCK_WRITE_CLIENT_CHARACTERISTIC_CONFIGURATION: 45176cdba3eSMilanka Ringwald mock_gatt_client_emit_complete(ERROR_CODE_SUCCESS); 45276cdba3eSMilanka Ringwald break; 45376cdba3eSMilanka Ringwald 45476cdba3eSMilanka Ringwald case MOCK_READ_VALUE_OF_CHARACTERISTIC_USING_VALUE_HANDLE: 45576cdba3eSMilanka Ringwald descriptor = mock_gatt_client_get_characteristic_descriptor_for_handle(mock_gatt_client_value_handle); 45676cdba3eSMilanka Ringwald btstack_assert(descriptor != NULL); 45776cdba3eSMilanka Ringwald btstack_assert(descriptor->value_buffer != NULL); 45876cdba3eSMilanka Ringwald 45976cdba3eSMilanka Ringwald report_gatt_characteristic_value(&gatt_client, descriptor->handle, descriptor->value_buffer, descriptor->value_len); 46076cdba3eSMilanka Ringwald mock_gatt_client_emit_complete(ERROR_CODE_SUCCESS); 46176cdba3eSMilanka Ringwald break; 46276cdba3eSMilanka Ringwald 463af770404SMilanka Ringwald default: 464af770404SMilanka Ringwald btstack_assert(false); 465af770404SMilanka Ringwald break; 4660f7fd6c1SMilanka Ringwald } 4677da2c1baSMilanka Ringwald } 4687da2c1baSMilanka Ringwald mock_gatt_client_att_error = ERROR_CODE_SUCCESS; 469af770404SMilanka Ringwald mock_gatt_client_state = MOCK_QUERY_IDLE; 4700f7fd6c1SMilanka Ringwald }