/****************************************************************************** * * Copyright (C) 2003-2012 Broadcom Corporation * * Licensed under the Apache License, Version 2.0 (the "License"); * you may not use this file except in compliance with the License. * You may obtain a copy of the License at: * * http://www.apache.org/licenses/LICENSE-2.0 * * Unless required by applicable law or agreed to in writing, software * distributed under the License is distributed on an "AS IS" BASIS, * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied. * See the License for the specific language governing permissions and * limitations under the License. * ******************************************************************************/ /****************************************************************************** * * This file contains the GATT client discovery procedures and cache * related functions. * ******************************************************************************/ #include "bt_target.h" #if defined(BTA_GATT_INCLUDED) && (BTA_GATT_INCLUDED == TRUE) #include <string.h> #include "utl.h" #include "gki.h" #include "bta_sys.h" #include "sdp_api.h" #include "sdpdefs.h" #include "bta_gattc_int.h" #include "btm_api.h" #include "btm_ble_api.h" static void bta_gattc_char_dscpt_disc_cmpl(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb); static tBTA_GATT_STATUS bta_gattc_sdp_service_disc(UINT16 conn_id, tBTA_GATTC_SERV *p_server_cb); #define BTA_GATT_SDP_DB_SIZE 4096 /***************************************************************************** ** Constants *****************************************************************************/ #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) static char *bta_gattc_attr_type[] = { "I", /* Included Service */ "C", /* Characteristic */ "D" /* Characteristic Descriptor */ }; /* utility functions */ /******************************************************************************* ** ** Function bta_gattc_display_cache_server ** ** Description debug function to display the server cache. ** ** Returns none. ** *******************************************************************************/ static void bta_gattc_display_cache_server(tBTA_GATTC_CACHE *p_cache) { UINT8 i = 0, j; tBTA_GATTC_CACHE *p_cur_srvc = p_cache; tBTA_GATTC_CACHE_ATTR *p_attr; APPL_TRACE_ERROR("<================Start Server Cache =============>"); while (p_cur_srvc) { APPL_TRACE_ERROR("Service[%d]: handle[%d ~ %d] %s[0x%04x] inst[%d]", i, p_cur_srvc->s_handle, p_cur_srvc->e_handle, ((p_cur_srvc->service_uuid.id.uuid.len == 2) ? "uuid16" : "uuid128"), p_cur_srvc->service_uuid.id.uuid.uu.uuid16, p_cur_srvc->service_uuid.id.inst_id); i ++; p_attr = p_cur_srvc->p_attr; for (j = 0; p_attr; j ++ ) { APPL_TRACE_ERROR("\t Attr[0x%04x] handle[%d] uuid[0x%04x] inst[%d] type[%s] prop[0x%1x]", j + 1, p_attr->attr_handle, p_attr->p_uuid->uuid16, p_attr->inst_id, bta_gattc_attr_type[p_attr->attr_type], p_attr->property); p_attr = p_attr->p_next; } p_cur_srvc = p_cur_srvc->p_next; } APPL_TRACE_ERROR("<================End Server Cache =============>"); APPL_TRACE_ERROR(" "); } /******************************************************************************* ** ** Function bta_gattc_display_explore_record ** ** Description debug function to display the exploration list ** ** Returns none. ** *******************************************************************************/ static void bta_gattc_display_explore_record(tBTA_GATTC_ATTR_REC *p_rec, UINT8 num_rec) { UINT8 i; tBTA_GATTC_ATTR_REC *pp = p_rec; APPL_TRACE_ERROR("<================Start Explore Queue =============>"); for (i = 0; i < num_rec; i ++, pp ++) { APPL_TRACE_ERROR("\t rec[%d] uuid[0x%04x] s_handle[%d] e_handle[%d] is_primary[%d]", i + 1, pp->uuid.uu.uuid16, pp->s_handle, pp->e_handle, pp->is_primary); } APPL_TRACE_ERROR("<================ End Explore Queue =============>"); APPL_TRACE_ERROR(" "); } #endif /* BTA_GATT_DEBUG == TRUE */ /******************************************************************************* ** ** Function bta_gattc_alloc_cache_buf ** ** Description Allocate a GKI buffer for database cache. ** ** Returns status ** *******************************************************************************/ BT_HDR *bta_gattc_alloc_cache_buf(tBTA_GATTC_SERV *p_srvc_cb) { BT_HDR *p_buf; if ((p_buf = (BT_HDR *)GKI_getpoolbuf(GATT_DB_POOL_ID)) == NULL) { APPL_TRACE_DEBUG("No resources: GKI buffer allocation failed."); utl_freebuf((void **)&p_srvc_cb->p_srvc_list); p_srvc_cb->free_byte = 0; } else { memset(p_buf, 0, GKI_get_buf_size(p_buf)); p_srvc_cb->p_free = (UINT8 *) p_buf; p_srvc_cb->free_byte = GKI_get_buf_size(p_buf); /* link into buffer queue */ GKI_enqueue(&p_srvc_cb->cache_buffer, p_buf); } #if BTA_GATT_DEBUG== TRUE APPL_TRACE_DEBUG("allocating new buffer: free byte = %d", p_srvc_cb->free_byte); #endif return p_buf; } /******************************************************************************* ** ** Function bta_gattc_init_cache ** ** Description Initialize the database cache and discovery related resources. ** ** Returns status ** *******************************************************************************/ tBTA_GATT_STATUS bta_gattc_init_cache(tBTA_GATTC_SERV *p_srvc_cb) { tBTA_GATT_STATUS status = BTA_GATT_OK; while (p_srvc_cb->cache_buffer.p_first) GKI_freebuf (GKI_dequeue (&p_srvc_cb->cache_buffer)); utl_freebuf((void **)&p_srvc_cb->p_srvc_list); if ((p_srvc_cb->p_srvc_list = (tBTA_GATTC_ATTR_REC*)GKI_getbuf(BTA_GATTC_ATTR_LIST_SIZE)) == NULL) { APPL_TRACE_DEBUG("No resources: GKI buffer allocation failed."); status = GATT_NO_RESOURCES; } else { p_srvc_cb->total_srvc = 0; p_srvc_cb->cur_srvc_idx = p_srvc_cb->cur_char_idx = p_srvc_cb->next_avail_idx = 0; if (bta_gattc_alloc_cache_buf(p_srvc_cb) == NULL) { status = GATT_NO_RESOURCES; } else { p_srvc_cb->p_cur_srvc = p_srvc_cb->p_srvc_cache = NULL; } } return status; } /******************************************************************************* ** ** Function bta_gattc_get_srvc_inst_id ** ** Description get service instance number ** ** Returns instance ID of the service. ** *******************************************************************************/ static UINT8 bta_gattc_get_srvc_inst_id(tBTA_GATTC_SERV *p_srvc_cb, tBT_UUID uuid) { UINT8 i = 0, inst = 0; tBTA_GATTC_ATTR_REC *p_srvc_rec; for (i = 0; i < p_srvc_cb->total_srvc; i ++) /* for (; i < p_srvc_cb->cur_srvc_idx; i ++)*/ { p_srvc_rec = p_srvc_cb->p_srvc_list + i; if (bta_gattc_uuid_compare(&p_srvc_rec->uuid, &uuid, TRUE)) inst ++; } return inst ; } /******************************************************************************* ** ** Function bta_gattc_get_char_inst_id ** ** Description get characteristic instance number ** ** Returns characteristic instance ID. ** *******************************************************************************/ static UINT8 bta_gattc_get_char_inst_id(tBTA_GATTC_CACHE *p_service_cache, tBT_UUID *p_uuid) { UINT8 inst = 0; tBTA_GATTC_CACHE_ATTR *p_attr; tBT_UUID attr_uuid; p_attr = p_service_cache->p_attr; while (p_attr) { bta_gattc_pack_attr_uuid(p_attr, &attr_uuid); if (bta_gattc_uuid_compare(&attr_uuid, p_uuid, TRUE)) inst ++; p_attr = p_attr->p_next; } return inst ; } /******************************************************************************* ** ** Function bta_gattc_get_char_descr_inst_id ** ** Description get characteristic descriptor instance number ** ** Returns characteristic instance ID. ** *******************************************************************************/ static UINT8 bta_gattc_get_char_descr_inst_id(tBTA_GATTC_CACHE_ATTR *p_char_attr, tBT_UUID *p_uuid) { UINT8 inst = 0; tBT_UUID attr_uuid; if (p_char_attr != NULL) p_char_attr = p_char_attr->p_next; while (p_char_attr) { bta_gattc_pack_attr_uuid(p_char_attr, &attr_uuid); if (bta_gattc_uuid_compare(&attr_uuid, p_uuid, TRUE)) inst ++; p_char_attr = p_char_attr->p_next; } return inst ; } /******************************************************************************* ** ** Function bta_gattc_add_srvc_to_cache ** ** Description Add a service into database cache. ** ** Returns status ** *******************************************************************************/ static tBTA_GATT_STATUS bta_gattc_add_srvc_to_cache(tBTA_GATTC_SERV *p_srvc_cb, UINT16 s_handle, UINT16 e_handle, tBT_UUID *p_uuid, BOOLEAN is_primary, UINT8 srvc_inst) { tBTA_GATTC_CACHE *p_new_srvc = NULL; tBTA_GATT_STATUS status = BTA_GATT_OK; #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("Add a service into Service"); APPL_TRACE_DEBUG("free byte = %d, req %d bytes.", p_srvc_cb->free_byte, sizeof(tBTA_GATTC_CACHE)) #endif if (p_srvc_cb->free_byte < sizeof(tBTA_GATTC_CACHE)) { if (bta_gattc_alloc_cache_buf(p_srvc_cb) == NULL) return GATT_NO_RESOURCES; } p_new_srvc = (tBTA_GATTC_CACHE *)p_srvc_cb->p_free; /* update service information */ p_new_srvc->s_handle = s_handle; p_new_srvc->e_handle = e_handle; p_new_srvc->service_uuid.is_primary = is_primary; memcpy(&p_new_srvc->service_uuid.id.uuid, p_uuid, sizeof(tBT_UUID)); p_new_srvc->service_uuid.id.inst_id = srvc_inst; p_new_srvc->p_next = NULL; if (p_srvc_cb->p_cur_srvc != NULL) p_srvc_cb->p_cur_srvc->p_next = p_new_srvc; p_srvc_cb->p_cur_srvc = p_new_srvc; p_srvc_cb->p_cur_srvc->p_cur_char = NULL; /* first service */ if (p_srvc_cb->p_srvc_cache == NULL) p_srvc_cb->p_srvc_cache = p_new_srvc; /* update buffer managament info */ p_srvc_cb->p_free += sizeof(tBTA_GATTC_CACHE); p_srvc_cb->free_byte -= sizeof(tBTA_GATTC_CACHE); return status; } /******************************************************************************* ** ** Function bta_gattc_add_attr_to_cache ** ** Description Add an attribute into database cache buffer. ** ** Returns status ** *******************************************************************************/ static tBTA_GATT_STATUS bta_gattc_add_attr_to_cache(tBTA_GATTC_SERV *p_srvc_cb, UINT16 handle, tBT_UUID *p_uuid, UINT8 property, tBTA_GATTC_ATTR_TYPE type) { tBTA_GATTC_CACHE_ATTR *p_attr; tBTA_GATT_STATUS status = BTA_GATT_OK; UINT16 len = sizeof(tBTA_GATTC_CACHE_ATTR) + p_uuid->len; UINT8 *pp; #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("bta_gattc_add_attr_to_cache: Add a [%s] into Service", bta_gattc_attr_type[type]); APPL_TRACE_DEBUG("handle=%d uuid16=0x%x property=0x%x type=%d", handle, p_uuid->uu.uuid16, property, type); APPL_TRACE_DEBUG("free byte = %d, req %d bytes.", p_srvc_cb->free_byte, len); #endif if (p_srvc_cb->p_cur_srvc == NULL) { APPL_TRACE_ERROR("Illegal action to add char/descr/incl srvc before adding a service!"); return GATT_WRONG_STATE; } if (p_srvc_cb->free_byte < len) { if (bta_gattc_alloc_cache_buf(p_srvc_cb) == NULL) return GATT_NO_RESOURCES; } p_attr = (tBTA_GATTC_CACHE_ATTR *)p_srvc_cb->p_free; p_attr->attr_handle = handle; p_attr->attr_type = type; p_attr->property = property; p_attr->uuid_len = p_uuid->len; p_attr->p_uuid = (tBTA_GATTC_UUID *)(p_attr + 1); p_attr->p_next = NULL; pp = (UINT8 *)p_attr->p_uuid; if (p_uuid->len == LEN_UUID_16) { UINT16_TO_STREAM(pp, p_uuid->uu.uuid16); } else if (p_uuid->len == LEN_UUID_128) { memcpy(pp, p_uuid->uu.uuid128, LEN_UUID_128); } if (type == BTA_GATTC_ATTR_TYPE_CHAR) { p_attr->inst_id = bta_gattc_get_char_inst_id(p_srvc_cb->p_cur_srvc, p_uuid); p_srvc_cb->p_cur_srvc->p_cur_char = p_attr; } else if (type == BTA_GATTC_ATTR_TYPE_CHAR_DESCR) p_attr->inst_id = bta_gattc_get_char_descr_inst_id(p_srvc_cb->p_cur_srvc->p_cur_char, p_uuid); else /* TODO: --->> temp treat included service as single instance */ p_attr->inst_id = 0; /* update service information */ p_srvc_cb->p_free += len; p_srvc_cb->free_byte -= len; /* first attribute within the service, update the attribute pointer */ if (p_srvc_cb->p_cur_srvc->p_attr == NULL) { p_srvc_cb->p_cur_srvc->p_attr = p_attr; } if (p_srvc_cb->p_cur_srvc->p_last_attr != NULL) p_srvc_cb->p_cur_srvc->p_last_attr->p_next = p_attr; p_srvc_cb->p_cur_srvc->p_last_attr = p_attr; return status; } /******************************************************************************* ** ** Function bta_gattc_get_disc_range ** ** Description get discovery stating and ending handle range. ** ** Returns None. ** *******************************************************************************/ void bta_gattc_get_disc_range(tBTA_GATTC_SERV *p_srvc_cb, UINT16 *p_s_hdl, UINT16 *p_e_hdl, BOOLEAN is_srvc) { tBTA_GATTC_ATTR_REC *p_rec = NULL; if (is_srvc) { p_rec = p_srvc_cb->p_srvc_list + p_srvc_cb->cur_srvc_idx; *p_s_hdl = p_rec->s_handle; } else { p_rec = p_srvc_cb->p_srvc_list + p_srvc_cb->cur_char_idx; *p_s_hdl = p_rec->s_handle + 1; } *p_e_hdl = p_rec->e_handle; #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("discover range [%d ~ %d]",p_rec->s_handle, p_rec->e_handle); #endif return; } /******************************************************************************* ** ** Function bta_gattc_discover_pri_service ** ** Description Start primary service discovery ** ** Returns status of the operation. ** *******************************************************************************/ tBTA_GATT_STATUS bta_gattc_discover_pri_service(UINT16 conn_id, tBTA_GATTC_SERV *p_server_cb, UINT8 disc_type) { tBTA_GATTC_CLCB *p_clcb = bta_gattc_find_clcb_by_conn_id(conn_id); tBTA_GATT_STATUS status = BTA_GATT_ERROR; if (p_clcb) { if (p_clcb->transport == BTA_TRANSPORT_LE) status = bta_gattc_discover_procedure(conn_id, p_server_cb, disc_type); else status = bta_gattc_sdp_service_disc(conn_id, p_server_cb); } return status; } /******************************************************************************* ** ** Function bta_gattc_discover_procedure ** ** Description Start a particular type of discovery procedure on server. ** ** Returns status of the operation. ** *******************************************************************************/ tBTA_GATT_STATUS bta_gattc_discover_procedure(UINT16 conn_id, tBTA_GATTC_SERV *p_server_cb, UINT8 disc_type) { tGATT_DISC_PARAM param; BOOLEAN is_service = TRUE; memset(¶m, 0, sizeof(tGATT_DISC_PARAM)); if (disc_type == GATT_DISC_SRVC_ALL || disc_type == GATT_DISC_SRVC_BY_UUID) { param.s_handle = 1; param.e_handle = 0xFFFF; } else { if (disc_type == GATT_DISC_CHAR_DSCPT) is_service = FALSE; bta_gattc_get_disc_range(p_server_cb, ¶m.s_handle, ¶m.e_handle, is_service); if (param.s_handle > param.e_handle) { return GATT_ERROR; } } return GATTC_Discover (conn_id, disc_type, ¶m); } /******************************************************************************* ** ** Function bta_gattc_start_disc_include_srvc ** ** Description Start discovery for included service ** ** Returns status of the operation. ** *******************************************************************************/ tBTA_GATT_STATUS bta_gattc_start_disc_include_srvc(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb) { return bta_gattc_discover_procedure(conn_id, p_srvc_cb, GATT_DISC_INC_SRVC); } /******************************************************************************* ** ** Function bta_gattc_start_disc_char ** ** Description Start discovery for characteristic ** ** Returns status of the operation. ** *******************************************************************************/ tBTA_GATT_STATUS bta_gattc_start_disc_char(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb) { p_srvc_cb->total_char = 0; return bta_gattc_discover_procedure(conn_id, p_srvc_cb, GATT_DISC_CHAR); } /******************************************************************************* ** ** Function bta_gattc_start_disc_char_dscp ** ** Description Start discovery for characteristic descriptor ** ** Returns none. ** *******************************************************************************/ void bta_gattc_start_disc_char_dscp(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb) { APPL_TRACE_DEBUG("starting discover characteristics descriptor"); if (bta_gattc_discover_procedure(conn_id, p_srvc_cb, GATT_DISC_CHAR_DSCPT) != 0) bta_gattc_char_dscpt_disc_cmpl(conn_id, p_srvc_cb); } /******************************************************************************* ** ** Function bta_gattc_explore_srvc ** ** Description process the service discovery complete event ** ** Returns status ** *******************************************************************************/ static void bta_gattc_explore_srvc(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb) { tBTA_GATTC_ATTR_REC *p_rec = p_srvc_cb->p_srvc_list + p_srvc_cb->cur_srvc_idx; tBTA_GATTC_CLCB *p_clcb = bta_gattc_find_clcb_by_conn_id(conn_id); APPL_TRACE_DEBUG("Start service discovery: srvc_idx = %d", p_srvc_cb->cur_srvc_idx); p_srvc_cb->cur_char_idx = p_srvc_cb->next_avail_idx = p_srvc_cb->total_srvc; if (p_clcb == NULL) { APPL_TRACE_ERROR("unknown connection ID"); return; } /* start expore a service if there is service not been explored */ if (p_srvc_cb->cur_srvc_idx < p_srvc_cb->total_srvc) { /* add the first service into cache */ if (bta_gattc_add_srvc_to_cache (p_srvc_cb, p_rec->s_handle, p_rec->e_handle, &p_rec->uuid, p_rec->is_primary, p_rec->srvc_inst_id) == 0) { /* start discovering included services */ bta_gattc_start_disc_include_srvc(conn_id, p_srvc_cb); return; } } /* no service found at all, the end of server discovery*/ APPL_TRACE_ERROR("No More Service found"); #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) bta_gattc_display_cache_server(p_srvc_cb->p_srvc_cache); #endif /* save cache to NV */ p_clcb->p_srcb->state = BTA_GATTC_SERV_SAVE; bta_gattc_co_cache_open(p_srvc_cb->server_bda, BTA_GATTC_CI_CACHE_OPEN_EVT, conn_id, TRUE); } /******************************************************************************* ** ** Function bta_gattc_incl_srvc_disc_cmpl ** ** Description process the relationship discovery complete event ** ** Returns status ** *******************************************************************************/ static void bta_gattc_incl_srvc_disc_cmpl(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb) { p_srvc_cb->cur_char_idx = p_srvc_cb->total_srvc; /* start discoverying characteristic */ bta_gattc_start_disc_char(conn_id, p_srvc_cb); } /******************************************************************************* ** ** Function bta_gattc_char_disc_cmpl ** ** Description process the characteristic discovery complete event ** ** Returns status ** *******************************************************************************/ static void bta_gattc_char_disc_cmpl(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb) { tBTA_GATTC_ATTR_REC *p_rec = p_srvc_cb->p_srvc_list + p_srvc_cb->cur_char_idx; /* if there are characteristic needs to be explored */ if (p_srvc_cb->total_char > 0) { /* add the first characteristic into cache */ bta_gattc_add_attr_to_cache (p_srvc_cb, p_rec->s_handle, &p_rec->uuid, p_rec->property, BTA_GATTC_ATTR_TYPE_CHAR); /* start discoverying characteristic descriptor , if failed, disc for next char*/ bta_gattc_start_disc_char_dscp(conn_id, p_srvc_cb); } else /* otherwise start with next service */ { p_srvc_cb->cur_srvc_idx ++; bta_gattc_explore_srvc (conn_id, p_srvc_cb); } } /******************************************************************************* ** ** Function bta_gattc_char_dscpt_disc_cmpl ** ** Description process the char descriptor discovery complete event ** ** Returns status ** *******************************************************************************/ static void bta_gattc_char_dscpt_disc_cmpl(UINT16 conn_id, tBTA_GATTC_SERV *p_srvc_cb) { tBTA_GATTC_ATTR_REC *p_rec = NULL; if (-- p_srvc_cb->total_char > 0) { p_rec = p_srvc_cb->p_srvc_list + (++ p_srvc_cb->cur_char_idx); /* add the next characteristic into cache */ bta_gattc_add_attr_to_cache (p_srvc_cb, p_rec->s_handle, &p_rec->uuid, p_rec->property, BTA_GATTC_ATTR_TYPE_CHAR); /* start discoverying next characteristic for char descriptor */ bta_gattc_start_disc_char_dscp(conn_id, p_srvc_cb); } else /* all characteristic has been explored, start with next service if any */ { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_ERROR("all char has been explored"); #endif p_srvc_cb->cur_srvc_idx ++; bta_gattc_explore_srvc (conn_id, p_srvc_cb); } } static BOOLEAN bta_gattc_srvc_in_list(tBTA_GATTC_SERV *p_srvc_cb, UINT16 s_handle, UINT16 e_handle, tBT_UUID uuid) { tBTA_GATTC_ATTR_REC *p_rec = NULL; UINT8 i; BOOLEAN exist_srvc = FALSE; UNUSED(uuid); if (!GATT_HANDLE_IS_VALID(s_handle) || !GATT_HANDLE_IS_VALID(e_handle)) { APPL_TRACE_ERROR("invalid included service handle: [0x%04x ~ 0x%04x]", s_handle, e_handle); exist_srvc = TRUE; } else { for (i = 0; i < p_srvc_cb->next_avail_idx; i ++) { p_rec = p_srvc_cb->p_srvc_list + i; /* a new service should not have any overlap with other service handle range */ if (p_rec->s_handle == s_handle || p_rec->e_handle == e_handle) { exist_srvc = TRUE; break; } } } return exist_srvc; } /******************************************************************************* ** ** Function bta_gattc_add_srvc_to_list ** ** Description Add a service into explore pending list ** ** Returns status ** *******************************************************************************/ static tBTA_GATT_STATUS bta_gattc_add_srvc_to_list(tBTA_GATTC_SERV *p_srvc_cb, UINT16 s_handle, UINT16 e_handle, tBT_UUID uuid, BOOLEAN is_primary) { tBTA_GATTC_ATTR_REC *p_rec = NULL; tBTA_GATT_STATUS status = BTA_GATT_OK; if (p_srvc_cb->p_srvc_list && p_srvc_cb->next_avail_idx < BTA_GATTC_MAX_CACHE_CHAR) { p_rec = p_srvc_cb->p_srvc_list + p_srvc_cb->next_avail_idx; p_srvc_cb->total_srvc ++; APPL_TRACE_DEBUG("bta_gattc_add_srvc_to_list handle = %d, service type = 0x%04x", s_handle, uuid.uu.uuid16); p_rec->s_handle = s_handle; p_rec->e_handle = e_handle; p_rec->is_primary = is_primary; p_rec->srvc_inst_id = bta_gattc_get_srvc_inst_id(p_srvc_cb, uuid); memcpy(&p_rec->uuid, &uuid, sizeof(tBT_UUID)); p_srvc_cb->next_avail_idx ++; } else { /* allocate bigger buffer ?? */ status = GATT_DB_FULL; APPL_TRACE_ERROR("service not added, no resources or wrong state"); } return status; } /******************************************************************************* ** ** Function bta_gattc_add_char_to_list ** ** Description Add a characteristic into explore pending list ** ** Returns status ** *******************************************************************************/ static tBTA_GATT_STATUS bta_gattc_add_char_to_list(tBTA_GATTC_SERV *p_srvc_cb, UINT16 decl_handle, UINT16 value_handle, tBT_UUID uuid, UINT8 property) { tBTA_GATTC_ATTR_REC *p_rec = NULL; tBTA_GATT_STATUS status = BTA_GATT_OK; if (p_srvc_cb->p_srvc_list == NULL) { APPL_TRACE_ERROR("No service available, unexpected char discovery result"); status = BTA_GATT_INTERNAL_ERROR; } else if (p_srvc_cb->next_avail_idx < BTA_GATTC_MAX_CACHE_CHAR) { p_rec = p_srvc_cb->p_srvc_list + p_srvc_cb->next_avail_idx; p_srvc_cb->total_char ++; p_rec->s_handle = value_handle; p_rec->property = property; p_rec->e_handle = (p_srvc_cb->p_srvc_list + p_srvc_cb->cur_srvc_idx)->e_handle; memcpy(&p_rec->uuid, &uuid, sizeof(tBT_UUID)); /* update the endind handle of pervious characteristic if available */ if (p_srvc_cb->total_char > 1) { p_rec -= 1; p_rec->e_handle = decl_handle - 1; } p_srvc_cb->next_avail_idx ++; } else { APPL_TRACE_ERROR("char not added, no resources"); /* allocate bigger buffer ?? */ status = BTA_GATT_DB_FULL; } return status; } /******************************************************************************* ** ** Function bta_gattc_sdp_callback ** ** Description Process the discovery result from sdp ** ** Returns void ** *******************************************************************************/ void bta_gattc_sdp_callback (UINT16 sdp_status) { tSDP_DISC_REC *p_sdp_rec = NULL; tBT_UUID service_uuid; tSDP_PROTOCOL_ELEM pe; UINT16 start_handle = 0, end_handle = 0; tBTA_GATTC_SERV *p_srvc_cb = bta_gattc_find_scb_by_cid(bta_gattc_cb.sdp_conn_id); if(((sdp_status == SDP_SUCCESS) || (sdp_status == SDP_DB_FULL)) && p_srvc_cb != NULL) { do { /* find a service record, report it */ p_sdp_rec = SDP_FindServiceInDb(bta_gattc_cb.p_sdp_db, 0, p_sdp_rec); if (p_sdp_rec) { if (SDP_FindServiceUUIDInRec(p_sdp_rec, &service_uuid)) { if (SDP_FindProtocolListElemInRec(p_sdp_rec, UUID_PROTOCOL_ATT, &pe)) { start_handle = (UINT16) pe.params[0]; end_handle = (UINT16) pe.params[1]; #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_EVENT("Found ATT service [0x%04x] handle[0x%04x ~ 0x%04x]", service_uuid.uu.uuid16, start_handle, end_handle); #endif if (GATT_HANDLE_IS_VALID(start_handle) && GATT_HANDLE_IS_VALID(end_handle)&& p_srvc_cb != NULL) { /* discover services result, add services into a service list */ bta_gattc_add_srvc_to_list(p_srvc_cb, start_handle, end_handle, service_uuid, TRUE); } else { APPL_TRACE_ERROR("invalid start_handle = %d end_handle = %d", start_handle, end_handle); } } } } } while (p_sdp_rec); } if ( p_srvc_cb != NULL) /* start discover primary service */ bta_gattc_explore_srvc(bta_gattc_cb.sdp_conn_id, p_srvc_cb); else { APPL_TRACE_ERROR("GATT service discovery is done on unknown connection"); } GKI_freebuf(bta_gattc_cb.p_sdp_db); bta_gattc_cb.p_sdp_db = NULL; bta_gattc_cb.sdp_conn_id = 0; } /******************************************************************************* ** ** Function bta_gattc_sdp_service_disc ** ** Description Start DSP Service Discovert ** ** Returns void ** *******************************************************************************/ static tBTA_GATT_STATUS bta_gattc_sdp_service_disc(UINT16 conn_id, tBTA_GATTC_SERV *p_server_cb) { tSDP_UUID uuid; UINT16 num_attrs = 2; UINT16 attr_list[2]; tBTA_GATT_STATUS status = BTA_GATT_ERROR; memset (&uuid, 0, sizeof(tSDP_UUID)); uuid.len = LEN_UUID_16; uuid.uu.uuid16 = UUID_PROTOCOL_ATT; if((bta_gattc_cb.p_sdp_db = (tSDP_DISCOVERY_DB *)GKI_getbuf(BTA_GATT_SDP_DB_SIZE)) != NULL) { attr_list[0] = ATTR_ID_SERVICE_CLASS_ID_LIST; attr_list[1] = ATTR_ID_PROTOCOL_DESC_LIST; SDP_InitDiscoveryDb (bta_gattc_cb.p_sdp_db, BTA_GATT_SDP_DB_SIZE, 1, &uuid, num_attrs, attr_list); if(!SDP_ServiceSearchAttributeRequest (p_server_cb->server_bda, bta_gattc_cb.p_sdp_db, &bta_gattc_sdp_callback)) { GKI_freebuf(bta_gattc_cb.p_sdp_db); bta_gattc_cb.p_sdp_db = NULL; } else { bta_gattc_cb.sdp_conn_id = conn_id; status = BTA_GATT_OK; } } return status; } /******************************************************************************* ** ** Function bta_gattc_disc_res_cback ** bta_gattc_disc_cmpl_cback ** ** Description callback functions to GATT client stack. ** ** Returns void ** *******************************************************************************/ void bta_gattc_disc_res_cback (UINT16 conn_id, tGATT_DISC_TYPE disc_type, tGATT_DISC_RES *p_data) { tBTA_GATTC_SERV * p_srvc_cb = NULL; BOOLEAN pri_srvc; tBTA_GATTC_CLCB *p_clcb = bta_gattc_find_clcb_by_conn_id(conn_id); p_srvc_cb = bta_gattc_find_scb_by_cid(conn_id); if (p_srvc_cb != NULL && p_clcb != NULL && p_clcb->state == BTA_GATTC_DISCOVER_ST) { switch (disc_type) { case GATT_DISC_SRVC_ALL: /* discover services result, add services into a service list */ bta_gattc_add_srvc_to_list(p_srvc_cb, p_data->handle, p_data->value.group_value.e_handle, p_data->value.group_value.service_type, TRUE); break; case GATT_DISC_SRVC_BY_UUID: bta_gattc_add_srvc_to_list(p_srvc_cb, p_data->handle, p_data->value.group_value.e_handle, p_data->value.group_value.service_type, TRUE); break; case GATT_DISC_INC_SRVC: /* add included service into service list if it's secondary or it never showed up in the primary service search */ pri_srvc = bta_gattc_srvc_in_list(p_srvc_cb, p_data->value.incl_service.s_handle, p_data->value.incl_service.e_handle, p_data->value.incl_service.service_type); if (!pri_srvc) bta_gattc_add_srvc_to_list(p_srvc_cb, p_data->value.incl_service.s_handle, p_data->value.incl_service.e_handle, p_data->value.incl_service.service_type, FALSE); /* add into database */ bta_gattc_add_attr_to_cache(p_srvc_cb, p_data->handle, &p_data->value.incl_service.service_type, pri_srvc, BTA_GATTC_ATTR_TYPE_INCL_SRVC); break; case GATT_DISC_CHAR: /* add char value into database */ bta_gattc_add_char_to_list(p_srvc_cb, p_data->handle, p_data->value.dclr_value.val_handle, p_data->value.dclr_value.char_uuid, p_data->value.dclr_value.char_prop); break; case GATT_DISC_CHAR_DSCPT: bta_gattc_add_attr_to_cache(p_srvc_cb, p_data->handle, &p_data->type, 0, BTA_GATTC_ATTR_TYPE_CHAR_DESCR); break; } } } void bta_gattc_disc_cmpl_cback (UINT16 conn_id, tGATT_DISC_TYPE disc_type, tGATT_STATUS status) { tBTA_GATTC_SERV * p_srvc_cb; tBTA_GATTC_CLCB *p_clcb = bta_gattc_find_clcb_by_conn_id(conn_id); if ( p_clcb && (status != GATT_SUCCESS || p_clcb->status != GATT_SUCCESS) ) { if (p_clcb->status == GATT_SUCCESS) p_clcb->status = status; bta_gattc_sm_execute(p_clcb, BTA_GATTC_DISCOVER_CMPL_EVT, NULL); return; } p_srvc_cb = bta_gattc_find_scb_by_cid(conn_id); if (p_srvc_cb != NULL) { switch (disc_type) { case GATT_DISC_SRVC_ALL: case GATT_DISC_SRVC_BY_UUID: #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) bta_gattc_display_explore_record(p_srvc_cb->p_srvc_list, p_srvc_cb->next_avail_idx); #endif bta_gattc_explore_srvc(conn_id, p_srvc_cb); break; case GATT_DISC_INC_SRVC: bta_gattc_incl_srvc_disc_cmpl(conn_id, p_srvc_cb); break; case GATT_DISC_CHAR: #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) bta_gattc_display_explore_record(p_srvc_cb->p_srvc_list, p_srvc_cb->next_avail_idx); #endif bta_gattc_char_disc_cmpl(conn_id, p_srvc_cb); break; case GATT_DISC_CHAR_DSCPT: bta_gattc_char_dscpt_disc_cmpl(conn_id, p_srvc_cb); break; } } } /******************************************************************************* ** ** Function bta_gattc_id2handle ** ** Description map GATT ID to handle in a given cache. ** ** Returns the handle mapped. 0 if not found. ** *******************************************************************************/ UINT16 bta_gattc_id2handle(tBTA_GATTC_SERV *p_srcb, tBTA_GATT_SRVC_ID *p_service_id, tBTA_GATT_ID *p_char_id, tBTA_GATT_ID *p_descr_uuid) { tBTA_GATTC_CACHE *p_cache = p_srcb->p_srvc_cache; tBTA_GATTC_CACHE_ATTR *p_attr; UINT8 j; UINT16 handle = 0; tBT_UUID attr_uuid; BOOLEAN char_map = FALSE, done = FALSE; while (p_service_id && p_cache && !done) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("Service: handle[%d] uuid[0x%04x] inst[%d]", p_cache->s_handle, p_cache->service_uuid.id.uuid.uu.uuid16, p_cache->service_uuid.id.inst_id); #endif p_attr = p_cache->p_attr; if (bta_gattc_srvcid_compare(p_service_id, &p_cache->service_uuid)) { for (j = 0; p_attr; j ++) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("\t Attr[0x%04x] handle[0x%04x] uuid[0x%04x] inst[%d] type[%d]", j + 1, p_attr->attr_handle, p_attr->p_uuid->uuid16, p_attr->inst_id, p_attr->attr_type); #endif bta_gattc_pack_attr_uuid(p_attr, &attr_uuid); if (bta_gattc_uuid_compare(&p_char_id->uuid, &attr_uuid, TRUE) && p_char_id->inst_id == p_attr->inst_id) { if (p_descr_uuid == NULL) { handle = p_attr->attr_handle; done = TRUE; break; } else { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("found matching characteristic for the descriptor"); #endif char_map = TRUE; } } else if (char_map == TRUE) { if (p_attr->attr_type == BTA_GATTC_ATTR_TYPE_CHAR_DESCR) { if (p_descr_uuid != NULL && bta_gattc_uuid_compare(&p_descr_uuid->uuid, &attr_uuid, TRUE) && p_descr_uuid->inst_id == p_attr->inst_id) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("found descriptor!!"); #endif handle = p_attr->attr_handle; done = TRUE; break; } else { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("descriptor UUID not matching"); #endif } } else /* another char */ { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("no matching descptr found!!start of next characteristic"); #endif char_map = FALSE; done = TRUE; break; } } p_attr = p_attr->p_next; } } p_cache = p_cache->p_next; } return handle; } /******************************************************************************* ** ** Function bta_gattc_handle2id ** ** Description map a handle to GATT ID in a given cache. ** ** Returns FALSE if map can not be found. ** *******************************************************************************/ BOOLEAN bta_gattc_handle2id(tBTA_GATTC_SERV *p_srcb, UINT16 handle, tBTA_GATT_SRVC_ID *p_service_id, tBTA_GATT_ID *p_char_id, tBTA_GATT_ID *p_descr_type) { tBTA_GATTC_CACHE *p_cache = p_srcb->p_srvc_cache; tBTA_GATTC_CACHE_ATTR *p_attr, *p_char = NULL; UINT8 j; memset(p_service_id, 0, sizeof(tBTA_GATT_SRVC_ID)); memset(p_char_id, 0, sizeof(tBTA_GATT_ID)); memset(p_descr_type, 0, sizeof(tBTA_GATT_ID)); while (p_cache) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("Service: handle[%d] uuid[0x%04x] inst[%d]", p_cache->s_handle, p_cache->service_uuid.id.uuid.uu.uuid16, p_cache->service_uuid.id.inst_id); #endif /* a service found */ if (p_cache->s_handle == handle) { memcpy(p_service_id, &p_cache->service_uuid, sizeof(tBTA_GATT_SRVC_ID)); return TRUE; } else /* start looking for attributes within the service */ { p_attr = p_cache->p_attr; for (j = 0; p_attr; j ++) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("\t Attr[0x%04x] handle[0x%04x] uuid[0x%04x] inst[%d] type[%d]", j + 1, p_attr->attr_handle, p_attr->p_uuid->uuid16, p_attr->inst_id, p_attr->attr_type); #endif if (p_attr->attr_type == BTA_GATTC_ATTR_TYPE_CHAR) p_char = p_attr; if (handle == p_attr->attr_handle) { memcpy(p_service_id, &p_cache->service_uuid, sizeof(tBTA_GATT_SRVC_ID)); if (p_attr->attr_type == BTA_GATTC_ATTR_TYPE_CHAR_DESCR) { bta_gattc_pack_attr_uuid(p_attr, &p_descr_type->uuid); p_descr_type->inst_id = p_attr->inst_id; if (p_char != NULL) { bta_gattc_pack_attr_uuid(p_char, &p_char_id->uuid); p_char_id->inst_id = p_char->inst_id; } else { APPL_TRACE_ERROR("descptr does not belong to any chracteristic"); } } else /* is a characterisitc value or included service */ { bta_gattc_pack_attr_uuid(p_attr, &p_char_id->uuid); p_char_id->inst_id =p_attr->inst_id; } return TRUE; } p_attr = p_attr->p_next; } } p_cache = p_cache->p_next; } return FALSE; } /******************************************************************************* ** ** Function bta_gattc_search_service ** ** Description search local cache for matching service record. ** ** Returns FALSE if map can not be found. ** *******************************************************************************/ void bta_gattc_search_service(tBTA_GATTC_CLCB *p_clcb, tBT_UUID *p_uuid) { tBTA_GATTC_SERV *p_srcb = p_clcb->p_srcb; tBTA_GATTC_CACHE *p_cache = p_srcb->p_srvc_cache; tBTA_GATTC cb_data; while (p_cache) { if (bta_gattc_uuid_compare(p_uuid, &p_cache->service_uuid.id.uuid, FALSE)) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("found service [0x%04x], inst[%d] handle [%d]", p_cache->service_uuid.id.uuid.uu.uuid16, p_cache->service_uuid.id.inst_id, p_cache->s_handle); #endif if (p_clcb->p_rcb->p_cback) { memset(&cb_data, 0, sizeof(tBTA_GATTC)); cb_data.srvc_res.conn_id = p_clcb->bta_conn_id; memcpy(&cb_data.srvc_res.service_uuid, &p_cache->service_uuid, sizeof(tBTA_GATT_SRVC_ID)); (* p_clcb->p_rcb->p_cback)(BTA_GATTC_SEARCH_RES_EVT, &cb_data); } } p_cache = p_cache->p_next; } } /******************************************************************************* ** ** Function bta_gattc_find_record ** ** Description search local cache for matching attribute record. ** ** Parameter p_result: output parameter to store the characteristic/ ** included service GATT ID. ** ** Returns GATT_ERROR is no recording found. BTA_GATT_OK if record found. ** *******************************************************************************/ static tBTA_GATT_STATUS bta_gattc_find_record(tBTA_GATTC_SERV *p_srcb, tBTA_GATTC_ATTR_TYPE attr_type, tBTA_GATT_SRVC_ID *p_service_id, tBTA_GATT_ID *p_start_rec, tBT_UUID * p_uuid_cond, tBTA_GATT_ID *p_result, void *p_param) { tBTA_GATTC_CACHE *p_cache = p_srcb->p_srvc_cache; tBTA_GATT_STATUS status = BTA_GATT_ERROR; UINT8 i, j; tBTA_GATTC_CACHE_ATTR *p_attr; BOOLEAN char_found = FALSE, descr_found = FALSE; tBTA_GATT_ID *p_descr_id = (tBTA_GATT_ID *)p_param;; for (i = 0; p_cache && status != BTA_GATT_OK; i ++) { if (bta_gattc_srvcid_compare(p_service_id, &p_cache->service_uuid)) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("found matching service [0x%04x], inst[%d]", p_cache->service_uuid.id.uuid.uu.uuid16, p_cache->service_uuid.id.inst_id); #endif p_attr = p_cache->p_attr; for (j = 0; p_attr; j ++) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("\t Attr[%d] handle[0x%04x] uuid[0x%04x] inst[%d] type[%d]", j + 1, p_attr->attr_handle, p_attr->p_uuid->uuid16, p_attr->inst_id, p_attr->attr_type); #endif bta_gattc_pack_attr_uuid(p_attr, &p_result->uuid); if (p_start_rec != NULL && char_found == FALSE) { /* find the starting record first */ if (bta_gattc_uuid_compare(&p_start_rec->uuid, &p_result->uuid, FALSE) && p_start_rec->inst_id == p_attr->inst_id && (attr_type == p_attr->attr_type || /* find descriptor would look for characteristic first */ (attr_type == BTA_GATTC_ATTR_TYPE_CHAR_DESCR && p_attr->attr_type == BTA_GATTC_ATTR_TYPE_CHAR))) { char_found = TRUE; } } else { /* if looking for descriptor, here is the where the descrptor to be found */ if (attr_type == BTA_GATTC_ATTR_TYPE_CHAR_DESCR) { /* next characeteristic already, return error */ if (p_attr->attr_type != BTA_GATTC_ATTR_TYPE_CHAR_DESCR) { break; } else { /* find starting descriptor */ if (p_descr_id != NULL && !descr_found) { if (bta_gattc_uuid_compare(&p_descr_id->uuid, &p_result->uuid, TRUE) && p_descr_id->inst_id == p_attr->inst_id) { descr_found = TRUE; } } else { /* with matching descriptor */ if (bta_gattc_uuid_compare(p_uuid_cond, &p_result->uuid, FALSE)) { p_result->inst_id = p_attr->inst_id; status = BTA_GATT_OK; break; } } } } else { if (bta_gattc_uuid_compare(p_uuid_cond, &p_result->uuid, FALSE) && attr_type == p_attr->attr_type) { #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) APPL_TRACE_DEBUG("found char handle mapping characteristic"); #endif p_result->inst_id = p_attr->inst_id; if (p_param != NULL) { if (attr_type == BTA_GATTC_ATTR_TYPE_CHAR || attr_type == BTA_GATTC_ATTR_TYPE_INCL_SRVC) { *(tBTA_GATT_CHAR_PROP *)p_param = p_attr->property; } } status = BTA_GATT_OK; break; } } } p_attr = p_attr->p_next; } #if (defined BTA_GATT_DEBUG && BTA_GATT_DEBUG == TRUE) if (status) { APPL_TRACE_ERROR("In the given service, can not find matching record"); } #endif break; } p_cache = p_cache->p_next; } return status; } /******************************************************************************* ** ** Function bta_gattc_query_cache ** ** Description search local cache for matching attribute record. ** ** Parameters conn_id: connection ID which identify the server. ** p_srvc_id: the service ID of which the characteristic is belonged to. ** *p_start_rec: start the search from the next record ** after the one identified by *p_start_rec. ** p_uuid_cond: UUID, if NULL find the first available ** characteristic/included service. ** p_output: output parameter which will store the GATT ID ** of the characteristic /included service found. ** ** Returns BTA_GATT_ERROR is no recording found. BTA_GATT_OK if record found. ** *******************************************************************************/ tBTA_GATT_STATUS bta_gattc_query_cache(UINT16 conn_id, tBTA_GATTC_ATTR_TYPE query_type, tBTA_GATT_SRVC_ID *p_srvc_id, tBTA_GATT_ID *p_start_rec, tBT_UUID *p_uuid_cond, tBTA_GATT_ID *p_output, void *p_param) { tBTA_GATTC_CLCB *p_clcb = bta_gattc_find_clcb_by_conn_id(conn_id); tBTA_GATT_STATUS status = BTA_GATT_ILLEGAL_PARAMETER; if (p_clcb != NULL ) { if (p_clcb->state == BTA_GATTC_CONN_ST) { if (p_clcb->p_srcb && !p_clcb->p_srcb->p_srvc_list && /* no active discovery */ p_clcb->p_srcb->p_srvc_cache) { status = bta_gattc_find_record(p_clcb->p_srcb, query_type, p_srvc_id, p_start_rec, p_uuid_cond, p_output, p_param); } else { status = BTA_GATT_ERROR; APPL_TRACE_ERROR("No server cache available"); } } else { APPL_TRACE_ERROR("server cache not available, CLCB state = %d", p_clcb->state); status = (p_clcb->state == BTA_GATTC_DISCOVER_ST) ? BTA_GATT_BUSY : BTA_GATT_ERROR; } } else { APPL_TRACE_ERROR("Unknown conn ID: %d", conn_id); } return status; } /******************************************************************************* ** ** Function bta_gattc_rebuild_cache ** ** Description rebuild server cache from NV cache. ** ** Parameters ** ** Returns None. ** *******************************************************************************/ void bta_gattc_rebuild_cache(tBTA_GATTC_SERV *p_srvc_cb, UINT16 num_attr, tBTA_GATTC_NV_ATTR *p_attr, UINT16 attr_index) { /* first attribute loading, initialize buffer */ APPL_TRACE_ERROR("bta_gattc_rebuild_cache"); if (attr_index == 0) { while (p_srvc_cb->cache_buffer.p_first) GKI_freebuf (GKI_dequeue (&p_srvc_cb->cache_buffer)); if (bta_gattc_alloc_cache_buf(p_srvc_cb) == NULL) { APPL_TRACE_ERROR("allocate cache buffer failed, no resources"); } else { p_srvc_cb->p_cur_srvc = p_srvc_cb->p_srvc_cache = NULL; } } while (num_attr > 0 && p_attr != NULL) { switch (p_attr->attr_type) { case BTA_GATTC_ATTR_TYPE_SRVC: bta_gattc_add_srvc_to_cache(p_srvc_cb, p_attr->s_handle, p_attr->e_handle, &p_attr->uuid, p_attr->is_primary, p_attr->id); break; case BTA_GATTC_ATTR_TYPE_CHAR: case BTA_GATTC_ATTR_TYPE_CHAR_DESCR: case BTA_GATTC_ATTR_TYPE_INCL_SRVC: bta_gattc_add_attr_to_cache(p_srvc_cb, p_attr->s_handle, &p_attr->uuid, p_attr->prop, p_attr->attr_type); break; } p_attr ++; num_attr --; } } /******************************************************************************* ** ** Function bta_gattc_fill_nv_attr ** ** Description fill a NV attribute entry value ** ** Returns None. ** *******************************************************************************/ void bta_gattc_fill_nv_attr(tBTA_GATTC_NV_ATTR *p_attr, UINT8 type, UINT16 s_handle, UINT16 e_handle, UINT8 id, tBT_UUID uuid, UINT8 prop, BOOLEAN is_primary) { p_attr->s_handle = s_handle; p_attr->e_handle = e_handle; p_attr->attr_type = type; p_attr->is_primary = is_primary; p_attr->id = id; p_attr->prop = prop; memcpy(&p_attr->uuid, &uuid, sizeof(tBT_UUID)); } /******************************************************************************* ** ** Function bta_gattc_cache_save ** ** Description save the server cache into NV ** ** Returns None. ** *******************************************************************************/ BOOLEAN bta_gattc_cache_save(tBTA_GATTC_SERV *p_srvc_cb, UINT16 conn_id) { tBTA_GATTC_CACHE *p_cur_srvc = p_srvc_cb->p_srvc_cache; UINT8 i = 0; UINT16 offset = 0; tBTA_GATTC_NV_ATTR nv_attr[BTA_GATTC_NV_LOAD_MAX]; tBTA_GATTC_CACHE_ATTR *p_attr; tBT_UUID uuid; while (p_cur_srvc && i < BTA_GATTC_NV_LOAD_MAX) { if (offset ++ >= p_srvc_cb->attr_index) { bta_gattc_fill_nv_attr(&nv_attr[i++], BTA_GATTC_ATTR_TYPE_SRVC, p_cur_srvc->s_handle, p_cur_srvc->e_handle, p_cur_srvc->service_uuid.id.inst_id, p_cur_srvc->service_uuid.id.uuid, 0, p_cur_srvc->service_uuid.is_primary); } p_attr = p_cur_srvc->p_attr; for (; p_attr && i < BTA_GATTC_NV_LOAD_MAX ; offset ++, p_attr = p_attr->p_next) { if (offset >= p_srvc_cb->attr_index) { if ((uuid.len = p_attr->uuid_len) == LEN_UUID_16) { uuid.uu.uuid16 = p_attr->p_uuid->uuid16; } else { memcpy(uuid.uu.uuid128, p_attr->p_uuid->uuid128, LEN_UUID_128); } bta_gattc_fill_nv_attr(&nv_attr[i++], p_attr->attr_type, p_attr->attr_handle, 0, p_attr->inst_id, uuid, p_attr->property, FALSE); } } p_cur_srvc = p_cur_srvc->p_next; } if (i > 0) { bta_gattc_co_cache_save(p_srvc_cb->server_bda, BTA_GATTC_CI_CACHE_SAVE_EVT, i, nv_attr, p_srvc_cb->attr_index, conn_id); p_srvc_cb->attr_index += i; return TRUE; } else { return FALSE; } } #endif /* BTA_GATT_INCLUDED */