| /****************************************************************************** |
| * |
| * Copyright (C) 1999-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 GATT interface functions |
| * |
| ******************************************************************************/ |
| #include "bt_target.h" |
| |
| |
| #if defined(BTA_GATT_INCLUDED) && (BTA_GATT_INCLUDED == TRUE) |
| |
| #include "gki.h" |
| #include <stdio.h> |
| #include <string.h> |
| #include "gatt_api.h" |
| #include "gatt_int.h" |
| #include "l2c_api.h" |
| #include "btm_int.h" |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_SetTraceLevel |
| ** |
| ** Description This function sets the trace level. If called with |
| ** a value of 0xFF, it simply returns the current trace level. |
| ** |
| ** Input Parameters: |
| ** level: The level to set the GATT tracing to: |
| ** 0xff-returns the current setting. |
| ** 0-turns off tracing. |
| ** >= 1-Errors. |
| ** >= 2-Warnings. |
| ** >= 3-APIs. |
| ** >= 4-Events. |
| ** >= 5-Debug. |
| ** |
| ** Returns The new or current trace level |
| ** |
| *******************************************************************************/ |
| UINT8 GATT_SetTraceLevel (UINT8 new_level) |
| { |
| if (new_level != 0xFF) |
| gatt_cb.trace_level = new_level; |
| |
| return(gatt_cb.trace_level); |
| } |
| |
| /***************************************************************************** |
| ** |
| ** GATT SERVER API |
| ** |
| ******************************************************************************/ |
| /******************************************************************************* |
| ** |
| ** Function GATTS_AddHandleRange |
| ** |
| ** Description This function add the allocated handles range for the specifed |
| ** application UUID, service UUID and service instance |
| ** |
| ** Parameter p_hndl_range: pointer to allocated handles information |
| ** |
| ** Returns TRUE if handle range is added sucessfully; otherwise FALSE. |
| ** |
| *******************************************************************************/ |
| |
| BOOLEAN GATTS_AddHandleRange(tGATTS_HNDL_RANGE *p_hndl_range) |
| { |
| tGATT_HDL_LIST_ELEM *p_buf; |
| BOOLEAN status= FALSE; |
| |
| if ((p_buf = gatt_alloc_hdl_buffer()) != NULL) |
| { |
| p_buf->asgn_range = *p_hndl_range; |
| status = gatt_add_an_item_to_list(&gatt_cb.hdl_list_info, p_buf); |
| } |
| return status; |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTS_NVRegister |
| ** |
| ** Description Application manager calls this function to register for |
| ** NV save callback function. There can be one and only one |
| ** NV save callback function. |
| ** |
| ** Parameter p_cb_info : callback informaiton |
| ** |
| ** Returns TRUE if registered OK, else FALSE |
| ** |
| *******************************************************************************/ |
| BOOLEAN GATTS_NVRegister (tGATT_APPL_INFO *p_cb_info) |
| { |
| BOOLEAN status= FALSE; |
| if (p_cb_info) |
| { |
| gatt_cb.cb_info = *p_cb_info; |
| status = TRUE; |
| gatt_init_srv_chg(); |
| } |
| |
| return status; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTS_CreateService |
| ** |
| ** Description This function is called to reserve a block of handles for a service. |
| ** |
| ** *** It should be called only once per service instance *** |
| ** |
| ** Parameter gatt_if : application if |
| ** p_svc_uuid : service UUID |
| ** svc_inst : instance of the service inside the application |
| ** num_handles : number of handles needed by the service. |
| ** is_pri : is a primary service or not. |
| ** |
| ** Returns service handle if sucessful, otherwise 0. |
| ** |
| *******************************************************************************/ |
| UINT16 GATTS_CreateService (tGATT_IF gatt_if, tBT_UUID *p_svc_uuid, |
| UINT16 svc_inst, UINT16 num_handles, BOOLEAN is_pri) |
| { |
| |
| tGATT_HDL_LIST_INFO *p_list_info= &gatt_cb.hdl_list_info; |
| tGATT_HDL_LIST_ELEM *p_list=NULL; |
| UINT16 s_hdl=0; |
| BOOLEAN save_hdl=FALSE; |
| tGATTS_PENDING_NEW_SRV_START *p_buf=NULL; |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| tBT_UUID *p_app_uuid128; |
| |
| |
| GATT_TRACE_API0 ("GATTS_CreateService" ); |
| |
| if (p_reg == NULL) |
| { |
| GATT_TRACE_ERROR1 ("Inavlid gatt_if=%d", gatt_if); |
| return(0); |
| } |
| |
| p_app_uuid128 = &p_reg->app_uuid128; |
| |
| if ((p_list = gatt_find_hdl_buffer_by_app_id(p_app_uuid128, p_svc_uuid, svc_inst)) != NULL) |
| { |
| s_hdl = p_list->asgn_range.s_handle; |
| GATT_TRACE_DEBUG0 ("Service already been created!!"); |
| } |
| else |
| { |
| if ( (p_svc_uuid->len == LEN_UUID_16) && (p_svc_uuid->uu.uuid16 == UUID_SERVCLASS_GATT_SERVER)) |
| { |
| s_hdl= gatt_cb.hdl_cfg.gatt_start_hdl; |
| } |
| else if ((p_svc_uuid->len == LEN_UUID_16) && (p_svc_uuid->uu.uuid16 == UUID_SERVCLASS_GAP_SERVER)) |
| { |
| s_hdl= gatt_cb.hdl_cfg.gap_start_hdl; |
| } |
| else |
| { |
| p_list = p_list_info->p_first; |
| |
| if (p_list) |
| { |
| s_hdl = p_list->asgn_range.e_handle + 1; |
| } |
| |
| if (s_hdl < gatt_cb.hdl_cfg.app_start_hdl) |
| { |
| |
| s_hdl= gatt_cb.hdl_cfg.app_start_hdl; |
| } |
| save_hdl = TRUE; |
| } |
| |
| /* check for space */ |
| if (num_handles > (0xFFFF - s_hdl + 1)) |
| { |
| GATT_TRACE_ERROR2 ("GATTS_ReserveHandles: no handles, s_hdl: %u needed: %u", s_hdl, num_handles); |
| return(0); |
| } |
| |
| if ( (p_list = gatt_alloc_hdl_buffer()) == NULL) |
| { |
| /* No free entry */ |
| GATT_TRACE_ERROR0 ("GATTS_ReserveHandles: no free handle blocks"); |
| return(0); |
| } |
| |
| p_list->asgn_range.app_uuid128 = *p_app_uuid128; |
| p_list->asgn_range.svc_uuid = *p_svc_uuid; |
| p_list->asgn_range.svc_inst = svc_inst; |
| p_list->asgn_range.s_handle = s_hdl; |
| p_list->asgn_range.e_handle = s_hdl+num_handles-1; |
| p_list->asgn_range.is_primary = is_pri; |
| |
| gatt_add_an_item_to_list(p_list_info, p_list); |
| |
| if (save_hdl) |
| { |
| if (gatt_cb.cb_info.p_nv_save_callback) |
| (*gatt_cb.cb_info.p_nv_save_callback)(TRUE, &p_list->asgn_range); |
| /* add a pending new service change item to the list */ |
| if ( (p_buf = gatt_add_pending_new_srv_start(&p_list->asgn_range)) == NULL) |
| { |
| /* No free entry */ |
| GATT_TRACE_ERROR0 ("gatt_add_pending_new_srv_start: no free blocks"); |
| |
| if (p_list) |
| { |
| gatt_remove_an_item_from_list(p_list_info, p_list); |
| gatt_free_hdl_buffer(p_list); |
| } |
| return(0); |
| } |
| |
| GATT_TRACE_DEBUG0 ("Add a new srv chg item"); |
| } |
| } |
| |
| if (!gatts_init_service_db(&p_list->svc_db, *p_svc_uuid, is_pri, s_hdl , num_handles)) |
| { |
| GATT_TRACE_ERROR0 ("GATTS_ReserveHandles: service DB initialization failed"); |
| if (p_list) |
| { |
| gatt_remove_an_item_from_list(p_list_info, p_list); |
| gatt_free_hdl_buffer(p_list); |
| } |
| |
| if (p_buf) |
| GKI_freebuf (GKI_remove_from_queue (&gatt_cb.pending_new_srv_start_q, p_buf)); |
| return(0); |
| } |
| |
| GATT_TRACE_DEBUG6 ("GATTS_CreateService(success): handles needed:%u s_hdl=%u e_hdl=%u %s[%x] is_primary=%d", |
| num_handles, p_list->asgn_range.s_handle , p_list->asgn_range.e_handle, |
| ((p_list->asgn_range.svc_uuid.len == 2) ? "uuid16": "uuid128" ), |
| p_list->asgn_range.svc_uuid.uu.uuid16, |
| p_list->asgn_range.is_primary); |
| |
| return(s_hdl); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTS_AddIncludeService |
| ** |
| ** Description This function is called to add an included service. |
| ** |
| ** Parameter service_handle : To which service this included service is added to. |
| ** include_svc_handle : included service handle. |
| ** |
| ** Returns included service attribute handle. If 0, add included service |
| ** fail. |
| ** |
| *******************************************************************************/ |
| UINT16 GATTS_AddIncludeService (UINT16 service_handle, UINT16 include_svc_handle) |
| |
| { |
| tGATT_HDL_LIST_ELEM *p_decl, *p_incl_decl; |
| |
| if ((p_decl = gatt_find_hdl_buffer_by_handle(service_handle)) == NULL) |
| { |
| GATT_TRACE_DEBUG0("Service not created"); |
| return 0; |
| } |
| if ((p_incl_decl = gatt_find_hdl_buffer_by_handle(include_svc_handle)) == NULL) |
| { |
| GATT_TRACE_DEBUG0("Included Service not created"); |
| return 0; |
| } |
| |
| return gatts_add_included_service(&p_decl->svc_db, |
| p_incl_decl->asgn_range.s_handle, |
| p_incl_decl->asgn_range.e_handle, |
| p_incl_decl->asgn_range.svc_uuid); |
| } |
| /******************************************************************************* |
| ** |
| ** Function GATTS_AddCharacteristic |
| ** |
| ** Description This function is called to add a characteristic into a service. |
| ** It will add a characteristic declaration and characteristic |
| ** value declaration into the service database identified by the |
| ** service handle. |
| ** |
| ** Parameter service_handle : To which service this included service is added to. |
| ** char_uuid : Characteristic UUID. |
| ** perm : Characteristic value declaration attribute permission. |
| ** property : Characteristic Properties |
| ** |
| ** Returns Characteristic value declaration attribute handle. 0 if failed. |
| ** |
| *******************************************************************************/ |
| UINT16 GATTS_AddCharacteristic (UINT16 service_handle, tBT_UUID *p_char_uuid, |
| tGATT_PERM perm,tGATT_CHAR_PROP property) |
| { |
| tGATT_HDL_LIST_ELEM *p_decl; |
| |
| if ((p_decl = gatt_find_hdl_buffer_by_handle(service_handle)) == NULL) |
| { |
| GATT_TRACE_DEBUG0("Service not created"); |
| return 0; |
| } |
| /* data validity checking */ |
| if ( ((property & GATT_CHAR_PROP_BIT_AUTH) && !(perm & GATT_WRITE_SIGNED_PERM)) || |
| ((perm & GATT_WRITE_SIGNED_PERM) && !(property & GATT_CHAR_PROP_BIT_AUTH)) ) |
| { |
| GATT_TRACE_DEBUG2("Invalid configuration property=0x%x perm=0x%x ", property, perm); |
| return 0; |
| } |
| |
| return gatts_add_characteristic(&p_decl->svc_db, |
| perm, |
| property, |
| p_char_uuid); |
| } |
| /******************************************************************************* |
| ** |
| ** Function GATTS_AddCharDescriptor |
| ** |
| ** Description This function is called to add a characteristic descriptor |
| ** into a service database. Add descriptor should follow add char |
| ** to which it belongs, and next add char should be done only |
| ** after all add descriptors for the previous char. |
| ** |
| ** Parameter service_handle : To which service this characteristic descriptor |
| ** is added to. |
| ** perm : Characteristic value declaration attribute |
| ** permission. |
| ** p_descr_uuid : Characteristic descriptor UUID |
| ** |
| ** Returns Characteristic descriptor attribute handle. 0 if add |
| ** characteristic descriptor failed. |
| ** |
| *******************************************************************************/ |
| UINT16 GATTS_AddCharDescriptor (UINT16 service_handle, |
| tGATT_PERM perm, |
| tBT_UUID * p_descr_uuid) |
| { |
| tGATT_HDL_LIST_ELEM *p_decl; |
| |
| if ((p_decl = gatt_find_hdl_buffer_by_handle(service_handle)) == NULL) |
| { |
| GATT_TRACE_DEBUG0("Service not created"); |
| return 0; |
| } |
| if (p_descr_uuid == NULL || |
| (p_descr_uuid->len != LEN_UUID_128 && p_descr_uuid->len != LEN_UUID_16)) |
| { |
| GATT_TRACE_DEBUG0("Illegal parameter"); |
| return 0; |
| } |
| |
| return gatts_add_char_descr(&p_decl->svc_db, |
| perm, |
| p_descr_uuid); |
| |
| } |
| /******************************************************************************* |
| ** |
| ** Function GATTS_DeleteService |
| ** |
| ** Description This function is called to delete a service. |
| ** |
| ** Parameter gatt_if : application interface |
| ** p_svc_uuid : service UUID |
| ** svc_inst : instance of the service inside the application |
| ** |
| ** Returns TRUE if operation succeed, FALSE if handle block was not found. |
| ** |
| *******************************************************************************/ |
| BOOLEAN GATTS_DeleteService (tGATT_IF gatt_if, tBT_UUID *p_svc_uuid, UINT16 svc_inst) |
| { |
| |
| tGATT_HDL_LIST_INFO *p_list_info= &gatt_cb.hdl_list_info; |
| tGATT_HDL_LIST_ELEM *p_list=NULL; |
| UINT8 i_sreg; |
| tGATTS_PENDING_NEW_SRV_START *p_buf; |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| tBT_UUID *p_app_uuid128; |
| |
| GATT_TRACE_DEBUG0 ("GATTS_DeleteService"); |
| |
| if (p_reg == NULL) |
| { |
| GATT_TRACE_ERROR0 ("Applicaiton not foud"); |
| return(FALSE); |
| } |
| p_app_uuid128 = &p_reg->app_uuid128; |
| |
| if ((p_list = gatt_find_hdl_buffer_by_app_id(p_app_uuid128, p_svc_uuid, svc_inst)) == NULL) |
| { |
| GATT_TRACE_ERROR0 ("No Service found"); |
| return(FALSE); |
| } |
| |
| if ( (p_buf = gatt_sr_is_new_srv_chg(&p_list->asgn_range.app_uuid128, |
| &p_list->asgn_range.svc_uuid, |
| p_list->asgn_range.svc_inst)) != NULL) |
| { |
| GATT_TRACE_DEBUG0 ("Delete a new service changed item - the service has not yet started"); |
| GKI_freebuf (GKI_remove_from_queue (&gatt_cb.pending_new_srv_start_q, p_buf)); |
| } |
| else |
| { |
| gatt_proc_srv_chg(); |
| } |
| |
| if ((i_sreg = gatt_sr_find_i_rcb_by_app_id (p_app_uuid128, |
| p_svc_uuid, |
| svc_inst)) != GATT_MAX_SR_PROFILES) |
| { |
| GATTS_StopService(gatt_cb.sr_reg[i_sreg].s_hdl); |
| } |
| |
| GATT_TRACE_DEBUG2 ("released handles s_hdl=%u e_hdl=%u", |
| p_list->asgn_range.s_handle , p_list->asgn_range.e_handle ); |
| |
| if ( (p_list->asgn_range.s_handle >= gatt_cb.hdl_cfg.app_start_hdl) |
| && gatt_cb.cb_info.p_nv_save_callback) |
| (*gatt_cb.cb_info.p_nv_save_callback)(FALSE, &p_list->asgn_range); |
| |
| gatt_remove_an_item_from_list(p_list_info, p_list); |
| gatt_free_hdl_buffer(p_list); |
| |
| return(TRUE); |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTS_StartService |
| ** |
| ** Description This function is called to start a service with GATT |
| ** |
| ** Parameter gatt_if : service handle. |
| ** p_cback : application service callback functions. |
| ** sup_transport : supported transport(s) for this primary service |
| ** |
| ** return GATT_SUCCESS if sucessfully started; otherwise error code. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTS_StartService (tGATT_IF gatt_if, UINT16 service_handle, |
| tGATT_TRANSPORT sup_transport) |
| { |
| tGATT_SR_REG *p_sreg; |
| tGATT_HDL_LIST_ELEM *p_list=NULL; |
| UINT8 i_sreg; |
| tBT_UUID *p_uuid; |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| |
| tGATTS_PENDING_NEW_SRV_START *p_buf; |
| |
| GATT_TRACE_API0 ("GATTS_StartService"); |
| |
| if (p_reg == NULL) |
| { |
| /* Not found */ |
| GATT_TRACE_ERROR0 ("Applicaiton not found "); |
| return GATT_NOT_FOUND; |
| } |
| |
| if ((p_list = gatt_find_hdl_buffer_by_handle(service_handle)) == NULL) |
| { |
| /* Not found */ |
| GATT_TRACE_ERROR0 ("no service found"); |
| return GATT_NOT_FOUND; |
| } |
| |
| if (gatt_sr_find_i_rcb_by_app_id (&p_list->asgn_range.app_uuid128, |
| &p_list->asgn_range.svc_uuid, |
| p_list->asgn_range.svc_inst) != GATT_MAX_SR_PROFILES) |
| { |
| GATT_TRACE_ERROR0 ("Duplicate Service start - Service already started"); |
| return GATT_SERVICE_STARTED; |
| } |
| |
| /*this is a new application servoce start */ |
| if ((i_sreg = gatt_sr_alloc_rcb(p_list)) == GATT_MAX_SR_PROFILES) |
| { |
| GATT_TRACE_ERROR0 ("GATTS_StartService: no free server registration block"); |
| return GATT_NO_RESOURCES; |
| } |
| |
| p_sreg = &gatt_cb.sr_reg[i_sreg]; |
| p_sreg->gatt_if = gatt_if; |
| |
| switch (sup_transport) |
| { |
| case GATT_TRANSPORT_BR_EDR: |
| case GATT_TRANSPORT_LE_BR_EDR: |
| if (p_sreg->type == GATT_UUID_PRI_SERVICE) |
| { |
| p_uuid = gatts_get_service_uuid (p_sreg->p_db); |
| |
| p_sreg->sdp_handle = gatt_add_sdp_record(p_uuid, p_sreg->s_hdl, p_sreg->e_hdl); |
| } |
| break; |
| default: |
| break; |
| } |
| |
| gatts_update_srv_list_elem(i_sreg, p_sreg->s_hdl, |
| p_list->asgn_range.is_primary); |
| |
| gatt_add_a_srv_to_list(&gatt_cb.srv_list_info, &gatt_cb.srv_list[i_sreg]); |
| |
| GATT_TRACE_DEBUG1 ("allocated i_sreg=%d ",i_sreg); |
| |
| GATT_TRACE_DEBUG5 ("s_hdl=%d e_hdl=%d type=0x%x svc_inst=%d sdp_hdl=0x%x", |
| p_sreg->s_hdl,p_sreg->e_hdl, |
| p_sreg->type, p_sreg->service_instance, |
| p_sreg->sdp_handle); |
| |
| |
| if ( (p_buf = gatt_sr_is_new_srv_chg(&p_list->asgn_range.app_uuid128, |
| &p_list->asgn_range.svc_uuid, |
| p_list->asgn_range.svc_inst)) != NULL) |
| { |
| gatt_proc_srv_chg(); |
| /* remove the new service element after the srv changed processing is completed*/ |
| |
| GKI_freebuf (GKI_remove_from_queue (&gatt_cb.pending_new_srv_start_q, p_buf)); |
| } |
| return GATT_SUCCESS; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTS_StopService |
| ** |
| ** Description This function is called to stop a service |
| ** |
| ** Parameter service_handle : this is the start handle of a service |
| ** |
| ** Returns None. |
| ** |
| *******************************************************************************/ |
| void GATTS_StopService (UINT16 service_handle) |
| { |
| UINT8 ii = gatt_sr_find_i_rcb_by_handle(service_handle); |
| |
| GATT_TRACE_API1("GATTS_StopService %u", service_handle); |
| |
| /* Index 0 is reserved for GATT, and is never stopped */ |
| if ( (ii > 0) && (ii < GATT_MAX_SR_PROFILES) && (gatt_cb.sr_reg[ii].in_use) ) |
| { |
| if (gatt_cb.sr_reg[ii].sdp_handle) |
| { |
| SDP_DeleteRecord(gatt_cb.sr_reg[ii].sdp_handle); |
| } |
| gatt_remove_a_srv_from_list(&gatt_cb.srv_list_info, &gatt_cb.srv_list[ii]); |
| gatt_cb.srv_list[ii].in_use = FALSE; |
| memset (&gatt_cb.sr_reg[ii], 0, sizeof(tGATT_SR_REG)); |
| } |
| else |
| { |
| GATT_TRACE_ERROR1("GATTS_StopService service_handle: %u is not in use", service_handle); |
| } |
| } |
| /******************************************************************************* |
| ** |
| ** Function GATTs_HandleValueIndication |
| ** |
| ** Description This function sends a handle value indication to a client. |
| ** |
| ** Parameter conn_id: connection identifier. |
| ** attr_handle: Attribute handle of this handle value indication. |
| ** val_len: Length of the indicated attribute value. |
| ** p_val: Pointer to the indicated attribute value data. |
| ** |
| ** Returns GATT_SUCCESS if sucessfully sent or queued; otherwise error code. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTS_HandleValueIndication (UINT16 conn_id, UINT16 attr_handle, UINT16 val_len, UINT8 *p_val) |
| { |
| tGATT_STATUS cmd_status = GATT_ILLEGAL_PARAMETER; |
| |
| tGATT_VALUE indication; |
| BT_HDR *p_msg; |
| tGATT_VALUE *p_buf; |
| tGATT_IF gatt_if = GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| |
| |
| GATT_TRACE_API0 ("GATTS_HandleValueIndication"); |
| if ( (p_reg == NULL) || (p_tcb == NULL)) |
| { |
| GATT_TRACE_ERROR1 ("GATTS_HandleValueIndication Unknown conn_id: %u ", conn_id); |
| return(tGATT_STATUS) GATT_INVALID_CONN_ID; |
| } |
| indication.conn_id = conn_id; |
| indication.handle = attr_handle; |
| indication.len = val_len; |
| memcpy (indication.value, p_val, val_len); |
| indication.auth_req = GATT_AUTH_REQ_NONE; |
| |
| if (GATT_HANDLE_IS_VALID (attr_handle) ) |
| { |
| if (GATT_HANDLE_IS_VALID(p_tcb->indicate_handle)) |
| { |
| GATT_TRACE_DEBUG0 ("Add a pending indication"); |
| if ((p_buf = gatt_add_pending_ind(p_tcb, &indication)) !=NULL) |
| { |
| cmd_status = GATT_SUCCESS; |
| } |
| else |
| { |
| cmd_status = GATT_NO_RESOURCES; |
| } |
| } |
| else |
| { |
| |
| if ( (p_msg = attp_build_sr_msg (p_tcb, GATT_HANDLE_VALUE_IND, (tGATT_SR_MSG *)&indication)) != NULL) |
| { |
| cmd_status = attp_send_sr_msg (p_tcb, p_msg); |
| |
| if (cmd_status == GATT_SUCCESS) |
| { |
| p_tcb->indicate_handle = indication.handle; |
| gatt_start_conf_timer(p_tcb); |
| } |
| } |
| } |
| } |
| return cmd_status; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTS_HandleValueNotification |
| ** |
| ** Description This function sends a handle value notification to a client. |
| ** |
| ** Parameter conn_id: connection identifier. |
| ** attr_handle: Attribute handle of this handle value indication. |
| ** val_len: Length of the indicated attribute value. |
| ** p_val: Pointer to the indicated attribute value data. |
| ** |
| ** Returns GATT_SUCCESS if sucessfully sent; otherwise error code. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTS_HandleValueNotification (UINT16 conn_id, UINT16 attr_handle, |
| UINT16 val_len, UINT8 *p_val) |
| { |
| tGATT_STATUS cmd_sent = GATT_ILLEGAL_PARAMETER; |
| BT_HDR *p_buf; |
| tGATT_VALUE notif; |
| tGATT_IF gatt_if = GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| |
| GATT_TRACE_API0 ("GATTS_HandleValueNotification"); |
| |
| if ( (p_reg == NULL) || (p_tcb == NULL)) |
| { |
| GATT_TRACE_ERROR1 ("GATTS_HandleValueNotification Unknown conn_id: %u ", conn_id); |
| return(tGATT_STATUS) GATT_INVALID_CONN_ID; |
| } |
| |
| if (GATT_HANDLE_IS_VALID (attr_handle)) |
| { |
| notif.handle = attr_handle; |
| notif.len = val_len; |
| memcpy (notif.value, p_val, val_len); |
| notif.auth_req = GATT_AUTH_REQ_NONE;; |
| |
| p_buf = attp_build_sr_msg (p_tcb, GATT_HANDLE_VALUE_NOTIF, (tGATT_SR_MSG *)¬if); |
| cmd_sent = attp_send_sr_msg (p_tcb, p_buf); |
| } |
| return cmd_sent; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTS_SendRsp |
| ** |
| ** Description This function sends the server response to client. |
| ** |
| ** Parameter conn_id: connection identifier. |
| ** trans_id: transaction id |
| ** status: response status |
| ** p_msg: pointer to message parameters structure. |
| ** |
| ** Returns GATT_SUCCESS if sucessfully sent; otherwise error code. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTS_SendRsp (UINT16 conn_id, UINT32 trans_id, |
| tGATT_STATUS status, tGATTS_RSP *p_msg) |
| { |
| tGATT_STATUS cmd_sent = GATT_ILLEGAL_PARAMETER; |
| tGATT_IF gatt_if = GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| |
| GATT_TRACE_API3 ("GATTS_SendRsp: conn_id: %u trans_id: %u Status: 0x%04x", |
| conn_id, trans_id, status); |
| |
| if ( (p_reg == NULL) || (p_tcb == NULL)) |
| { |
| GATT_TRACE_ERROR1 ("GATTS_SendRsp Unknown conn_id: %u ", conn_id); |
| return(tGATT_STATUS) GATT_INVALID_CONN_ID; |
| } |
| |
| if (p_tcb->sr_cmd.trans_id != trans_id) |
| { |
| GATT_TRACE_ERROR2 ("GATTS_SendRsp conn_id: %u waiting for op_code = %02x", |
| conn_id, p_tcb->sr_cmd.op_code); |
| |
| return(GATT_WRONG_STATE); |
| } |
| /* Process App response */ |
| cmd_sent = gatt_sr_process_app_rsp (p_tcb, gatt_if, trans_id, p_tcb->sr_cmd.op_code, status, p_msg); |
| |
| return cmd_sent; |
| } |
| |
| /*******************************************************************************/ |
| /* GATT Profile Srvr Functions */ |
| /*******************************************************************************/ |
| |
| /*******************************************************************************/ |
| /* */ |
| /* GATT CLIENT APIs */ |
| /* */ |
| /*******************************************************************************/ |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTC_ConfigureMTU |
| ** |
| ** Description This function is called to configure the ATT MTU size. |
| ** |
| ** Parameters conn_id: connection identifier. |
| ** mtu - attribute MTU size.. |
| ** |
| ** Returns GATT_SUCCESS if command started successfully. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTC_ConfigureMTU (UINT16 conn_id, UINT16 mtu) |
| { |
| UINT8 ret = GATT_NO_RESOURCES; |
| tGATT_IF gatt_if=GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| |
| tGATT_CLCB *p_clcb; |
| |
| GATT_TRACE_API2 ("GATTC_ConfigureMTU conn_id=%d mtu=%d", conn_id, mtu ); |
| |
| // Validate that the link is BLE, not BR/EDR |
| // ???? |
| |
| if ( (p_tcb == NULL) || (p_reg==NULL) || (mtu < GATT_DEF_BLE_MTU_SIZE) || (mtu > GATT_MAX_MTU_SIZE)) |
| { |
| return GATT_ILLEGAL_PARAMETER; |
| } |
| |
| if (gatt_is_clcb_allocated(conn_id)) |
| { |
| GATT_TRACE_ERROR1("GATTC_ConfigureMTU GATT_BUSY conn_id = %d", conn_id); |
| return GATT_BUSY; |
| } |
| |
| if ((p_clcb = gatt_clcb_alloc(conn_id)) != NULL) |
| { |
| p_clcb->p_tcb->payload_size = mtu; |
| p_clcb->operation = GATTC_OPTYPE_CONFIG; |
| |
| ret = attp_send_cl_msg (p_clcb->p_tcb, p_clcb->clcb_idx, GATT_REQ_MTU, (tGATT_CL_MSG *)&mtu); |
| } |
| |
| return ret; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTC_Discover |
| ** |
| ** Description This function is called to do a discovery procedure on ATT server. |
| ** |
| ** Parameters conn_id: connection identifier. |
| ** disc_type:discovery type. |
| ** p_param: parameters of discovery requirement. |
| ** |
| ** Returns GATT_SUCCESS if command received/sent successfully. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTC_Discover (UINT16 conn_id, tGATT_DISC_TYPE disc_type, |
| tGATT_DISC_PARAM *p_param) |
| { |
| tGATT_STATUS status = GATT_SUCCESS; |
| tGATT_CLCB *p_clcb; |
| tGATT_IF gatt_if=GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| |
| |
| GATT_TRACE_API2 ("GATTC_Discover conn_id=%d disc_type=%d",conn_id, disc_type); |
| |
| if ( (p_tcb == NULL) || (p_reg==NULL) ||(p_param == NULL) || |
| (disc_type >= GATT_DISC_MAX)) |
| { |
| GATT_TRACE_ERROR2("GATTC_Discover Illegal param: disc_type %d conn_id = %d", disc_type, conn_id); |
| return GATT_ILLEGAL_PARAMETER; |
| } |
| |
| |
| if (gatt_is_clcb_allocated(conn_id)) |
| { |
| GATT_TRACE_ERROR1("GATTC_Discover GATT_BUSY conn_id = %d", conn_id); |
| return GATT_BUSY; |
| } |
| |
| |
| if ((p_clcb = gatt_clcb_alloc(conn_id)) != NULL ) |
| { |
| if (!GATT_HANDLE_IS_VALID(p_param->s_handle) || |
| !GATT_HANDLE_IS_VALID(p_param->e_handle) || |
| /* search by type does not have a valid UUID param */ |
| (disc_type == GATT_DISC_SRVC_BY_UUID && |
| p_param->service.len == 0)) |
| { |
| gatt_clcb_dealloc(p_clcb); |
| return GATT_ILLEGAL_PARAMETER; |
| } |
| |
| p_clcb->operation = GATTC_OPTYPE_DISCOVERY; |
| p_clcb->op_subtype = disc_type; |
| p_clcb->s_handle = p_param->s_handle; |
| p_clcb->e_handle = p_param->e_handle; |
| p_clcb->uuid = p_param->service; |
| |
| gatt_act_discovery(p_clcb); |
| } |
| else |
| { |
| status = GATT_NO_RESOURCES; |
| } |
| return status; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTC_Read |
| ** |
| ** Description This function is called to read the value of an attribute from |
| ** the server. |
| ** |
| ** Parameters conn_id: connection identifier. |
| ** type - attribute read type. |
| ** p_read - read operation parameters. |
| ** |
| ** Returns GATT_SUCCESS if command started successfully. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTC_Read (UINT16 conn_id, tGATT_READ_TYPE type, tGATT_READ_PARAM *p_read) |
| { |
| tGATT_STATUS status = GATT_SUCCESS; |
| tGATT_CLCB *p_clcb; |
| tGATT_READ_MULTI *p_read_multi; |
| tGATT_IF gatt_if=GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| |
| |
| GATT_TRACE_API2 ("GATTC_Read conn_id=%d type=%d", conn_id, type); |
| |
| if ( (p_tcb == NULL) || (p_reg==NULL) || (p_read == NULL) || ((type >= GATT_READ_MAX) || (type == 0))) |
| { |
| GATT_TRACE_ERROR2("GATT_Read Illegal param: conn_id %d, type 0%d,", conn_id, type); |
| return GATT_ILLEGAL_PARAMETER; |
| } |
| |
| if (gatt_is_clcb_allocated(conn_id)) |
| { |
| GATT_TRACE_ERROR1("GATTC_Read GATT_BUSY conn_id = %d", conn_id); |
| return GATT_BUSY; |
| } |
| |
| if ( (p_clcb = gatt_clcb_alloc(conn_id)) != NULL ) |
| { |
| p_clcb->operation = GATTC_OPTYPE_READ; |
| p_clcb->op_subtype = type; |
| p_clcb->auth_req = p_read->by_handle.auth_req; |
| p_clcb->counter = 0; |
| |
| switch (type) |
| { |
| case GATT_READ_BY_TYPE: |
| case GATT_READ_CHAR_VALUE: |
| p_clcb->s_handle = p_read->service.s_handle; |
| p_clcb->e_handle = p_read->service.e_handle; |
| memcpy(&p_clcb->uuid, &p_read->service.uuid, sizeof(tBT_UUID)); |
| break; |
| case GATT_READ_MULTIPLE: |
| p_clcb->s_handle = 0; |
| /* copy multiple handles in CB */ |
| p_read_multi = (tGATT_READ_MULTI *)GKI_getbuf(sizeof(tGATT_READ_MULTI)); |
| p_clcb->p_attr_buf = (UINT8*)p_read_multi; |
| memcpy (p_read_multi, &p_read->read_multiple, sizeof(tGATT_READ_MULTI)); |
| case GATT_READ_BY_HANDLE: |
| case GATT_READ_PARTIAL: |
| memset(&p_clcb->uuid, 0, sizeof(tBT_UUID)); |
| p_clcb->s_handle = p_read->by_handle.handle; |
| |
| if (type == GATT_READ_PARTIAL) |
| { |
| p_clcb->counter = p_read->partial.offset; |
| } |
| |
| break; |
| default: |
| break; |
| } |
| /* start security check */ |
| if (gatt_security_check_start(p_clcb) == FALSE) |
| { |
| status = GATT_NO_RESOURCES; |
| gatt_clcb_dealloc(p_clcb); |
| } |
| } |
| else |
| { |
| status = GATT_NO_RESOURCES; |
| } |
| return status; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTC_Write |
| ** |
| ** Description This function is called to write the value of an attribute to |
| ** the server. |
| ** |
| ** Parameters conn_id: connection identifier. |
| ** type - attribute write type. |
| ** p_write - write operation parameters. |
| ** |
| ** Returns GATT_SUCCESS if command started successfully. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTC_Write (UINT16 conn_id, tGATT_WRITE_TYPE type, tGATT_VALUE *p_write) |
| { |
| tGATT_STATUS status = GATT_SUCCESS; |
| tGATT_CLCB *p_clcb; |
| tGATT_VALUE *p; |
| tGATT_IF gatt_if=GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| |
| if ( (p_tcb == NULL) || (p_reg==NULL) || (p_write == NULL) || |
| ((type != GATT_WRITE) && (type != GATT_WRITE_PREPARE) && (type != GATT_WRITE_NO_RSP)) ) |
| { |
| GATT_TRACE_ERROR2("GATT_Write Illegal param: conn_id %d, type 0%d,", conn_id, type); |
| return GATT_ILLEGAL_PARAMETER; |
| } |
| |
| if (gatt_is_clcb_allocated(conn_id)) |
| { |
| GATT_TRACE_ERROR1("GATTC_Write GATT_BUSY conn_id = %d", conn_id); |
| return GATT_BUSY; |
| } |
| |
| if ((p_clcb = gatt_clcb_alloc(conn_id)) != NULL ) |
| { |
| p_clcb->operation = GATTC_OPTYPE_WRITE; |
| p_clcb->op_subtype = type; |
| p_clcb->auth_req = p_write->auth_req; |
| |
| if (( p_clcb->p_attr_buf = (UINT8 *)GKI_getbuf((UINT16)sizeof(tGATT_VALUE))) != NULL) |
| { |
| memcpy(p_clcb->p_attr_buf, (void *)p_write, sizeof(tGATT_VALUE)); |
| |
| p = (tGATT_VALUE *)p_clcb->p_attr_buf; |
| if (type == GATT_WRITE_PREPARE) |
| { |
| p_clcb->start_offset = p_write->offset; |
| p->offset = 0; |
| } |
| |
| if (gatt_security_check_start(p_clcb) == FALSE) |
| { |
| status = GATT_NO_RESOURCES; |
| } |
| } |
| else |
| { |
| status = GATT_NO_RESOURCES; |
| } |
| |
| if (status == GATT_NO_RESOURCES) |
| gatt_clcb_dealloc(p_clcb); |
| } |
| else |
| { |
| status = GATT_NO_RESOURCES; |
| } |
| return status; |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTC_ExecuteWrite |
| ** |
| ** Description This function is called to send an Execute write request to |
| ** the server. |
| ** |
| ** Parameters conn_id: connection identifier. |
| ** is_execute - to execute or cancel the prepare write requet(s) |
| ** |
| ** Returns GATT_SUCCESS if command started successfully. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTC_ExecuteWrite (UINT16 conn_id, BOOLEAN is_execute) |
| { |
| tGATT_STATUS status = GATT_SUCCESS; |
| tGATT_CLCB *p_clcb; |
| tGATT_EXEC_FLAG flag; |
| tGATT_IF gatt_if=GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_TCB *p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| |
| GATT_TRACE_API2 ("GATTC_ExecuteWrite conn_id=%d is_execute=%d", conn_id, is_execute); |
| |
| if ( (p_tcb == NULL) || (p_reg==NULL) ) |
| { |
| GATT_TRACE_ERROR1("GATTC_ExecuteWrite Illegal param: conn_id %d", conn_id); |
| return GATT_ILLEGAL_PARAMETER; |
| } |
| |
| if (gatt_is_clcb_allocated(conn_id)) |
| { |
| GATT_TRACE_ERROR1("GATTC_Write GATT_BUSY conn_id = %d", conn_id); |
| return GATT_BUSY; |
| } |
| |
| if ((p_clcb = gatt_clcb_alloc(conn_id)) != NULL) |
| { |
| p_clcb->operation = GATTC_OPTYPE_EXE_WRITE; |
| flag = is_execute ? GATT_PREP_WRITE_EXEC : GATT_PREP_WRITE_CANCEL; |
| gatt_send_queue_write_cancel (p_clcb->p_tcb, p_clcb, flag); |
| } |
| else |
| { |
| GATT_TRACE_ERROR1("Unable to allocate client CB for conn_id %d ", conn_id); |
| status = GATT_NO_RESOURCES; |
| } |
| return status; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATTC_SendHandleValueConfirm |
| ** |
| ** Description This function is called to send a handle value confirmation |
| ** as response to a handle value notification from server. |
| ** |
| ** Parameters conn_id: connection identifier. |
| ** handle: the handle of the attribute confirmation. |
| ** |
| ** Returns GATT_SUCCESS if command started successfully. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATTC_SendHandleValueConfirm (UINT16 conn_id, UINT16 handle) |
| { |
| tGATT_STATUS ret = GATT_ILLEGAL_PARAMETER; |
| tGATT_TCB *p_tcb=gatt_get_tcb_by_idx(GATT_GET_TCB_IDX(conn_id)); |
| |
| GATT_TRACE_API2 ("GATTC_SendHandleValueConfirm conn_id=%d handle=0x%x", conn_id, handle); |
| |
| if (p_tcb) |
| { |
| if (p_tcb->ind_count > 0 ) |
| { |
| btu_stop_timer (&p_tcb->ind_ack_timer_ent); |
| |
| GATT_TRACE_DEBUG1 ("notif_count=%d ", p_tcb->ind_count); |
| /* send confirmation now */ |
| ret = attp_send_cl_msg(p_tcb, 0, GATT_HANDLE_VALUE_CONF, (tGATT_CL_MSG *)&handle); |
| |
| p_tcb->ind_count = 0; |
| |
| } |
| else |
| { |
| GATT_TRACE_DEBUG1 ("GATTC_SendHandleValueConfirm - conn_id: %u - ignored not waiting for indicaiton ack", conn_id); |
| ret = GATT_SUCCESS; |
| } |
| } |
| else |
| { |
| GATT_TRACE_ERROR1 ("GATTC_SendHandleValueConfirm - Unknown conn_id: %u", conn_id); |
| } |
| return ret; |
| } |
| |
| |
| /*******************************************************************************/ |
| /* */ |
| /* GATT APIs */ |
| /* */ |
| /*******************************************************************************/ |
| /******************************************************************************* |
| ** |
| ** Function GATT_SetIdleTimeout |
| ** |
| ** Description This function (common to both client and server) sets the idle |
| ** timeout for a tansport connection |
| ** |
| ** Parameter bd_addr: target device bd address. |
| ** idle_tout: timeout value in seconds. |
| ** |
| ** Returns void |
| ** |
| *******************************************************************************/ |
| void GATT_SetIdleTimeout (BD_ADDR bd_addr, UINT16 idle_tout) |
| { |
| tGATT_TCB *p_tcb; |
| BOOLEAN status = FALSE; |
| |
| if ((p_tcb = gatt_find_tcb_by_addr (bd_addr)) != NULL) |
| { |
| if (p_tcb->att_lcid == L2CAP_ATT_CID) |
| { |
| status = L2CA_SetFixedChannelTout (bd_addr, L2CAP_ATT_CID, idle_tout); |
| } |
| else |
| { |
| status = L2CA_SetIdleTimeout (p_tcb->att_lcid, idle_tout, FALSE); |
| } |
| } |
| |
| GATT_TRACE_API2 ("GATT_SetIdleTimeout idle_tout=%d status=%d(1-OK 0-not performed)", |
| idle_tout, status); |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_Register |
| ** |
| ** Description This function is called to register an application |
| ** with GATT |
| ** |
| ** Parameter p_app_uuid128: Application UUID |
| ** p_cb_info: callback functions. |
| ** |
| ** Returns 0 for error, otherwise the index of the client registered with GATT |
| ** |
| *******************************************************************************/ |
| tGATT_IF GATT_Register (tBT_UUID *p_app_uuid128, tGATT_CBACK *p_cb_info) |
| { |
| tGATT_REG *p_reg; |
| UINT8 i_gatt_if=0; |
| tGATT_IF gatt_if=0; |
| |
| GATT_TRACE_API0 ("GATT_Register"); |
| gatt_dbg_display_uuid(*p_app_uuid128); |
| |
| for (i_gatt_if = 0, p_reg = gatt_cb.cl_rcb; i_gatt_if < GATT_MAX_APPS; i_gatt_if++, p_reg++) |
| { |
| if (p_reg->in_use && !memcmp(p_app_uuid128->uu.uuid128, p_reg->app_uuid128.uu.uuid128, LEN_UUID_128)) |
| { |
| GATT_TRACE_ERROR0("application already registered."); |
| return 0; |
| } |
| } |
| |
| for (i_gatt_if = 0, p_reg = gatt_cb.cl_rcb; i_gatt_if < GATT_MAX_APPS; i_gatt_if++, p_reg++) |
| { |
| if (!p_reg->in_use) |
| { |
| memset(p_reg, 0 , sizeof(tGATT_REG)); |
| i_gatt_if++; /* one based number */ |
| p_reg->app_uuid128 = *p_app_uuid128; |
| gatt_if = |
| p_reg->gatt_if = (tGATT_IF)i_gatt_if; |
| p_reg->app_cb = *p_cb_info; |
| p_reg->in_use = TRUE; |
| |
| break; |
| } |
| } |
| GATT_TRACE_API1 ("allocated gatt_if=%d", gatt_if); |
| return gatt_if; |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_Deregister |
| ** |
| ** Description This function deregistered the application from GATT. |
| ** |
| ** Parameters gatt_if: applicaiton interface. |
| ** |
| ** Returns None. |
| ** |
| *******************************************************************************/ |
| void GATT_Deregister (tGATT_IF gatt_if) |
| { |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| tGATT_TCB *p_tcb; |
| tGATT_CLCB *p_clcb; |
| UINT8 i, ii, j; |
| tGATT_SR_REG *p_sreg; |
| |
| GATT_TRACE_API1 ("GATT_Deregister gatt_if=%d", gatt_if); |
| /* Index 0 is GAP and is never deregistered */ |
| if ( (gatt_if == 0) || (p_reg == NULL) ) |
| { |
| GATT_TRACE_ERROR1 ("GATT_Deregister with invalid gatt_if: %u", gatt_if); |
| return; |
| } |
| |
| /* stop all services */ |
| /* todo an applcaiton can not be deregistered if its services is also used by other application |
| deregisteration need to bed performed in an orderly fashion |
| no check for now */ |
| |
| for (ii = 0, p_sreg = gatt_cb.sr_reg; ii < GATT_MAX_SR_PROFILES; ii++, p_sreg++) |
| { |
| if (p_sreg->in_use && (p_sreg->gatt_if == gatt_if)) |
| { |
| GATTS_StopService(p_sreg->s_hdl); |
| } |
| } |
| |
| /* free all services db buffers if owned by this application */ |
| gatt_free_srvc_db_buffer_app_id(&p_reg->app_uuid128); |
| |
| /* When an application deregisters, check remove the link associated with the app */ |
| |
| for (i=0, p_tcb = gatt_cb.tcb; i < GATT_MAX_PHY_CHANNEL; i++, p_tcb++) |
| { |
| if (p_tcb->in_use) |
| { |
| if (gatt_get_ch_state(p_tcb) != GATT_CH_CLOSE) |
| { |
| gatt_update_app_use_link_flag(gatt_if, p_tcb, FALSE, FALSE); |
| if (!gatt_num_apps_hold_link(p_tcb)) |
| { |
| /* this will disconnect the link or cancel the pending connect request at lower layer*/ |
| gatt_disconnect(p_tcb->peer_bda); |
| } |
| } |
| |
| for (j = 0, p_clcb= &gatt_cb.clcb[j]; j < GATT_CL_MAX_LCB; j++, p_clcb++) |
| { |
| if (p_clcb->in_use && |
| (p_clcb->p_reg->gatt_if == gatt_if) && |
| (p_clcb->p_tcb->tcb_idx == p_tcb->tcb_idx)) |
| { |
| btu_stop_timer(&p_clcb->rsp_timer_ent); |
| gatt_clcb_dealloc (p_clcb); |
| break; |
| } |
| } |
| } |
| } |
| |
| gatt_deregister_bgdev_list(gatt_if); |
| /* update the listen mode */ |
| #if (defined(BLE_PERIPHERAL_MODE_SUPPORT) && (BLE_PERIPHERAL_MODE_SUPPORT == TRUE)) |
| GATT_Listen(gatt_if, FALSE, NULL); |
| #endif |
| |
| memset (p_reg, 0, sizeof(tGATT_REG)); |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_StartIf |
| ** |
| ** Description This function is called after registration to start receiving |
| ** callbacks for registered interface. Function may call back |
| ** with connection status and queued notifications |
| ** |
| ** Parameter gatt_if: applicaiton interface. |
| ** |
| ** Returns 0 for error, otherwise the index of the client registered with GATT |
| ** |
| *******************************************************************************/ |
| void GATT_StartIf (tGATT_IF gatt_if) |
| { |
| tGATT_REG *p_reg; |
| tGATT_TCB *p_tcb; |
| BD_ADDR bda; |
| UINT8 start_idx, found_idx; |
| UINT16 conn_id; |
| |
| GATT_TRACE_API1 ("GATT_StartIf gatt_if=%d", gatt_if); |
| if ((p_reg = gatt_get_regcb(gatt_if)) != NULL) |
| { |
| p_reg = &gatt_cb.cl_rcb[gatt_if - 1]; |
| start_idx = 0; |
| while (gatt_find_the_connected_bda(start_idx, bda, &found_idx)) |
| { |
| p_tcb = gatt_find_tcb_by_addr(bda); |
| if (p_reg->app_cb.p_conn_cb && p_tcb) |
| { |
| conn_id = GATT_CREATE_CONN_ID(p_tcb->tcb_idx, gatt_if); |
| (*p_reg->app_cb.p_conn_cb)(gatt_if, bda, conn_id, TRUE, 0); |
| } |
| start_idx = ++found_idx; |
| } |
| } |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_Connect |
| ** |
| ** Description This function initiate a connecttion to a remote device on GATT |
| ** channel. |
| ** |
| ** Parameters gatt_if: applicaiton interface |
| ** bd_addr: peer device address. |
| ** is_direct: is a direct conenection or a background auto connection |
| ** |
| ** Returns TRUE if connection started; FALSE if connection start failure. |
| ** |
| *******************************************************************************/ |
| BOOLEAN GATT_Connect (tGATT_IF gatt_if, BD_ADDR bd_addr, BOOLEAN is_direct){ |
| tGATT_REG *p_reg; |
| BOOLEAN status; |
| |
| GATT_TRACE_API1 ("GATT_Connect gatt_if=%d", gatt_if); |
| |
| /* Make sure app is registered */ |
| if ((p_reg = gatt_get_regcb(gatt_if)) == NULL) |
| { |
| GATT_TRACE_ERROR1("GATT_Connect - gatt_if =%d is not registered", gatt_if); |
| return(FALSE); |
| } |
| |
| if (is_direct) |
| status = gatt_act_connect (p_reg, bd_addr); |
| else |
| status = gatt_update_auto_connect_dev(gatt_if,TRUE, bd_addr, TRUE); |
| |
| return status; |
| |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_CancelConnect |
| ** |
| ** Description This function terminate the connection initaition to a remote |
| ** device on GATT channel. |
| ** |
| ** Parameters gatt_if: client interface. If 0 used as unconditionally disconnect, |
| ** typically used for direct connection cancellation. |
| ** bd_addr: peer device address. |
| ** |
| ** Returns TRUE if connection started; FALSE if connection start failure. |
| ** |
| *******************************************************************************/ |
| BOOLEAN GATT_CancelConnect (tGATT_IF gatt_if, BD_ADDR bd_addr, BOOLEAN is_direct){ |
| tGATT_REG *p_reg; |
| tGATT_TCB *p_tcb; |
| BOOLEAN status = TRUE; |
| tGATT_IF temp_gatt_if; |
| UINT8 start_idx, found_idx; |
| |
| GATT_TRACE_API1 ("GATT_CancelConnect gatt_if=%d", gatt_if); |
| |
| if ((gatt_if != 0) && ((p_reg = gatt_get_regcb(gatt_if)) == NULL)) |
| { |
| GATT_TRACE_ERROR1("GATT_CancelConnect - gatt_if =%d is not registered", gatt_if); |
| return(FALSE); |
| } |
| |
| if (is_direct) |
| { |
| if (!gatt_if) |
| { |
| GATT_TRACE_DEBUG0("GATT_CancelConnect - unconditional"); |
| start_idx = 0; |
| p_tcb = gatt_find_tcb_by_addr(bd_addr); |
| if (p_tcb && gatt_num_apps_hold_link(p_tcb)) |
| { |
| while (status && gatt_find_app_hold_link(p_tcb, start_idx, &found_idx, &temp_gatt_if)) |
| { |
| status = gatt_cancel_open(temp_gatt_if, bd_addr); |
| start_idx = ++found_idx; |
| } |
| } |
| else |
| { |
| GATT_TRACE_ERROR0("GATT_CancelConnect - no app found"); |
| status = FALSE; |
| } |
| } |
| else |
| { |
| status = gatt_cancel_open(gatt_if, bd_addr); |
| } |
| } |
| else |
| { |
| if (!gatt_if) |
| { |
| if (gatt_get_num_apps_for_bg_dev(bd_addr)) |
| { |
| while (gatt_find_app_for_bg_dev(bd_addr, &temp_gatt_if)) |
| gatt_remove_bg_dev_for_app(temp_gatt_if, bd_addr); |
| } |
| else |
| { |
| GATT_TRACE_ERROR0("GATT_CancelConnect -no app associated with the bg device for unconditional removal"); |
| status = FALSE; |
| } |
| } |
| else |
| { |
| status = gatt_remove_bg_dev_for_app(gatt_if, bd_addr); |
| } |
| } |
| |
| return status; |
| } |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_Disconnect |
| ** |
| ** Description This function disconnect the GATT channel for this registered |
| ** application. |
| ** |
| ** Parameters conn_id: connection identifier. |
| ** |
| ** Returns GATT_SUCCESS if disconnected. |
| ** |
| *******************************************************************************/ |
| tGATT_STATUS GATT_Disconnect (UINT16 conn_id) |
| { |
| tGATT_STATUS ret = GATT_ILLEGAL_PARAMETER; |
| tGATT_TCB *p_tcb=NULL; |
| tGATT_IF gatt_if=GATT_GET_GATT_IF(conn_id); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| |
| GATT_TRACE_API1 ("GATT_Disconnect conn_id=%d ", conn_id); |
| |
| p_tcb = gatt_get_tcb_by_idx(tcb_idx); |
| |
| if (p_tcb) |
| { |
| gatt_update_app_use_link_flag(gatt_if, p_tcb, FALSE, FALSE); |
| if (!gatt_num_apps_hold_link(p_tcb)) |
| { |
| gatt_disconnect(p_tcb->peer_bda); |
| } |
| ret = GATT_SUCCESS; |
| } |
| return ret; |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_GetConnectionInfor |
| ** |
| ** Description This function use conn_id to find its associated BD address and applciation |
| ** interface |
| ** |
| ** Parameters conn_id: connection id (input) |
| ** p_gatt_if: applicaiton interface (output) |
| ** bd_addr: peer device address. (output) |
| ** |
| ** Returns TRUE the ligical link information is found for conn_id |
| ** |
| *******************************************************************************/ |
| BOOLEAN GATT_GetConnectionInfor(UINT16 conn_id, tGATT_IF *p_gatt_if, BD_ADDR bd_addr) |
| { |
| |
| tGATT_IF gatt_if = GATT_GET_GATT_IF(conn_id); |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| UINT8 tcb_idx = GATT_GET_TCB_IDX(conn_id); |
| tGATT_TCB *p_tcb= gatt_get_tcb_by_idx(tcb_idx); |
| BOOLEAN status=FALSE; |
| |
| GATT_TRACE_API1 ("GATT_GetConnectionInfor conn_id=%d", conn_id); |
| |
| if (p_tcb && p_reg ) |
| { |
| memcpy(bd_addr, p_tcb->peer_bda, BD_ADDR_LEN); |
| *p_gatt_if = gatt_if; |
| status = TRUE; |
| } |
| return status; |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_GetConnIdIfConnected |
| ** |
| ** Description This function find the conn_id if the logical link for BD address |
| ** and applciation interface is connected |
| ** |
| ** Parameters gatt_if: applicaiton interface (input) |
| ** bd_addr: peer device address. (input) |
| ** p_conn_id: connection id (output) |
| ** |
| ** Returns TRUE the logical link is connected |
| ** |
| *******************************************************************************/ |
| BOOLEAN GATT_GetConnIdIfConnected(tGATT_IF gatt_if, BD_ADDR bd_addr, UINT16 *p_conn_id) |
| { |
| tGATT_REG *p_reg = gatt_get_regcb(gatt_if); |
| tGATT_TCB *p_tcb= gatt_find_tcb_by_addr(bd_addr); |
| BOOLEAN status=FALSE; |
| |
| if (p_reg && p_tcb && (gatt_get_ch_state(p_tcb) == GATT_CH_OPEN) ) |
| { |
| *p_conn_id = GATT_CREATE_CONN_ID(p_tcb->tcb_idx, gatt_if); |
| status = TRUE; |
| } |
| |
| GATT_TRACE_API1 ("GATT_GetConnIdIfConnected status=%d", status); |
| return status; |
| } |
| |
| |
| /******************************************************************************* |
| ** |
| ** Function GATT_Listen |
| ** |
| ** Description This function start or stop LE advertisement and listen for |
| ** connection. |
| ** |
| ** Parameters gatt_if: applicaiton interface |
| ** p_bd_addr: listen for specific address connection, or NULL for |
| ** listen to all device connection. |
| ** start: start or stop listening. |
| ** |
| ** Returns TRUE if advertisement is started; FALSE if adv start failure. |
| ** |
| *******************************************************************************/ |
| BOOLEAN GATT_Listen (tGATT_IF gatt_if, BOOLEAN start, BD_ADDR_PTR bd_addr) |
| { |
| tGATT_REG *p_reg; |
| BOOLEAN status = TRUE; |
| |
| GATT_TRACE_API1 ("GATT_Listen gatt_if=%d", gatt_if); |
| |
| /* Make sure app is registered */ |
| if ((p_reg = gatt_get_regcb(gatt_if)) == NULL) |
| { |
| GATT_TRACE_ERROR1("GATT_Listen - gatt_if =%d is not registered", gatt_if); |
| return(FALSE); |
| } |
| |
| if (bd_addr != NULL) |
| { |
| status = gatt_update_auto_connect_dev(gatt_if,start, bd_addr, FALSE); |
| } |
| else |
| { |
| p_reg->listening = start ? GATT_LISTEN_TO_ALL : GATT_LISTEN_TO_NONE; |
| } |
| |
| gatt_update_listen_mode(); |
| |
| return status; |
| |
| } |
| |
| #endif |
| |