blob: e7809a1490bc68a8eeedee37fbbfaf503703c4df [file] [log] [blame]
/******************************************************************************
*
* Copyright 2008-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 server functions
*
******************************************************************************/
#include <base/logging.h>
#include <bluetooth/log.h>
#include <string.h>
#include <algorithm>
#include "gatt_int.h"
#include "hardware/bt_gatt_types.h"
#include "internal_include/bt_target.h"
#include "internal_include/bt_trace.h"
#include "l2c_api.h"
#include "os/log.h"
#include "osi/include/allocator.h"
#include "osi/include/osi.h"
#include "stack/arbiter/acl_arbiter.h"
#include "stack/eatt/eatt.h"
#include "stack/include/bt_hdr.h"
#include "stack/include/bt_types.h"
#include "types/bluetooth/uuid.h"
#define GATT_MTU_REQ_MIN_LEN 2
#define L2CAP_PKT_OVERHEAD 4
using bluetooth::Uuid;
using bluetooth::eatt::EattExtension;
using bluetooth::eatt::EattChannel;
using namespace bluetooth;
/*******************************************************************************
*
* Function gatt_sr_enqueue_cmd
*
* Description This function enqueue the request from client which needs a
* application response, and update the transaction ID.
*
* Returns void
*
******************************************************************************/
uint32_t gatt_sr_enqueue_cmd(tGATT_TCB& tcb, uint16_t cid, uint8_t op_code,
uint16_t handle) {
tGATT_SR_CMD* p_cmd;
if (cid == tcb.att_lcid) {
p_cmd = &tcb.sr_cmd;
} else {
EattChannel* channel =
EattExtension::GetInstance()->FindEattChannelByCid(tcb.peer_bda, cid);
if (channel == nullptr) {
log::warn("{}, cid 0x{:02x} already disconnected",
ADDRESS_TO_LOGGABLE_CSTR(tcb.peer_bda), cid);
return 0;
}
p_cmd = &channel->server_outstanding_cmd_;
}
uint32_t trans_id = 0;
p_cmd->cid = cid;
if ((p_cmd->op_code == 0) ||
(op_code == GATT_HANDLE_VALUE_CONF)) /* no pending request */
{
if (op_code == GATT_CMD_WRITE || op_code == GATT_SIGN_CMD_WRITE ||
op_code == GATT_REQ_MTU || op_code == GATT_HANDLE_VALUE_CONF) {
trans_id = ++tcb.trans_id;
} else {
p_cmd->trans_id = ++tcb.trans_id;
p_cmd->op_code = op_code;
p_cmd->handle = handle;
p_cmd->status = GATT_NOT_FOUND;
tcb.trans_id %= GATT_TRANS_ID_MAX;
trans_id = p_cmd->trans_id;
}
}
return trans_id;
}
/*******************************************************************************
*
* Function gatt_sr_cmd_empty
*
* Description This function checks if the server command queue is empty.
*
* Returns true if empty, false if there is pending command.
*
******************************************************************************/
bool gatt_sr_cmd_empty(tGATT_TCB& tcb, uint16_t cid) {
if (cid == tcb.att_lcid) return (tcb.sr_cmd.op_code == 0);
EattChannel* channel =
EattExtension::GetInstance()->FindEattChannelByCid(tcb.peer_bda, cid);
if (channel == nullptr) {
log::warn("{}, cid 0x{:02x} already disconnected",
ADDRESS_TO_LOGGABLE_CSTR(tcb.peer_bda), cid);
return false;
}
return (channel->server_outstanding_cmd_.op_code == 0);
}
/*******************************************************************************
*
* Function gatt_dequeue_sr_cmd
*
* Description This function dequeue the request from command queue.
*
* Returns void
*
******************************************************************************/
void gatt_dequeue_sr_cmd(tGATT_TCB& tcb, uint16_t cid) {
tGATT_SR_CMD* p_cmd;
if (cid == tcb.att_lcid) {
p_cmd = &tcb.sr_cmd;
} else {
EattChannel* channel =
EattExtension::GetInstance()->FindEattChannelByCid(tcb.peer_bda, cid);
if (channel == nullptr) {
log::warn("{}, cid 0x{:02x} already disconnected",
ADDRESS_TO_LOGGABLE_CSTR(tcb.peer_bda), cid);
return;
}
p_cmd = &channel->server_outstanding_cmd_;
}
/* Double check in case any buffers are queued */
log::verbose("gatt_dequeue_sr_cmd cid: {}", loghex(cid));
if (p_cmd->p_rsp_msg)
log::error("free tcb.sr_cmd.p_rsp_msg = {}", fmt::ptr(p_cmd->p_rsp_msg));
osi_free_and_reset((void**)&p_cmd->p_rsp_msg);
while (!fixed_queue_is_empty(p_cmd->multi_rsp_q))
osi_free(fixed_queue_try_dequeue(p_cmd->multi_rsp_q));
fixed_queue_free(p_cmd->multi_rsp_q, NULL);
memset(p_cmd, 0, sizeof(tGATT_SR_CMD));
}
static void build_read_multi_rsp(tGATT_SR_CMD* p_cmd, uint16_t mtu) {
uint16_t ii;
size_t total_len, len;
uint8_t* p;
bool is_overflow = false;
len = sizeof(BT_HDR) + L2CAP_MIN_OFFSET + mtu;
BT_HDR* p_buf = (BT_HDR*)osi_calloc(len);
p_buf->offset = L2CAP_MIN_OFFSET;
p = (uint8_t*)(p_buf + 1) + p_buf->offset;
/* First byte in the response is the opcode */
if (p_cmd->multi_req.variable_len)
*p++ = GATT_RSP_READ_MULTI_VAR;
else
*p++ = GATT_RSP_READ_MULTI;
p_buf->len = 1;
/* Now walk through the buffers putting the data into the response in order
*/
list_t* list = NULL;
const list_node_t* node = NULL;
if (!fixed_queue_is_empty(p_cmd->multi_rsp_q))
list = fixed_queue_get_list(p_cmd->multi_rsp_q);
for (ii = 0; ii < p_cmd->multi_req.num_handles; ii++) {
tGATTS_RSP* p_rsp = NULL;
if (list != NULL) {
if (ii == 0)
node = list_begin(list);
else
node = list_next(node);
if (node != list_end(list)) p_rsp = (tGATTS_RSP*)list_node(node);
}
if (p_rsp != NULL) {
total_len = p_buf->len;
if (p_cmd->multi_req.variable_len) {
total_len += 2;
}
if (total_len > mtu) {
log::verbose("Buffer space not enough for this data item, skipping");
break;
}
len = std::min((size_t) p_rsp->attr_value.len, mtu - total_len);
if (len == 0) {
log::verbose("Buffer space not enough for this data item, skipping");
break;
}
if (len < p_rsp->attr_value.len) {
is_overflow = true;
log::verbose("multi read overflow available len={} val_len={}", len,
p_rsp->attr_value.len);
}
if (p_cmd->multi_req.variable_len) {
UINT16_TO_STREAM(p, (uint16_t) len);
p_buf->len += 2;
}
if (p_rsp->attr_value.handle == p_cmd->multi_req.handles[ii]) {
ARRAY_TO_STREAM(p, p_rsp->attr_value.value, (uint16_t) len);
p_buf->len += (uint16_t) len;
} else {
p_cmd->status = GATT_NOT_FOUND;
break;
}
if (is_overflow) break;
} else {
p_cmd->status = GATT_NOT_FOUND;
break;
}
} /* loop through all handles*/
/* Sanity check on the buffer length */
if (p_buf->len == 0) {
log::error("nothing found!!");
p_cmd->status = GATT_NOT_FOUND;
osi_free(p_buf);
log::verbose("osi_free(p_buf)");
} else if (p_cmd->p_rsp_msg != NULL) {
osi_free(p_buf);
} else {
p_cmd->p_rsp_msg = p_buf;
}
}
/*******************************************************************************
*
* Function process_read_multi_rsp
*
* Description This function check the read multiple response.
*
* Returns bool if all replies have been received
*
******************************************************************************/
static bool process_read_multi_rsp(tGATT_SR_CMD* p_cmd, tGATT_STATUS status,
tGATTS_RSP* p_msg, uint16_t mtu) {
log::verbose("status={} mtu={}", status, mtu);
if (p_cmd->multi_rsp_q == NULL)
p_cmd->multi_rsp_q = fixed_queue_new(SIZE_MAX);
/* Enqueue the response */
BT_HDR* p_buf = (BT_HDR*)osi_malloc(sizeof(tGATTS_RSP));
memcpy((void*)p_buf, (const void*)p_msg, sizeof(tGATTS_RSP));
fixed_queue_enqueue(p_cmd->multi_rsp_q, p_buf);
p_cmd->status = status;
if (status == GATT_SUCCESS) {
log::verbose("Multi read count={} num_hdls={} variable={}",
fixed_queue_length(p_cmd->multi_rsp_q),
p_cmd->multi_req.num_handles, p_cmd->multi_req.variable_len);
/* Wait till we get all the responses */
if (fixed_queue_length(p_cmd->multi_rsp_q) ==
p_cmd->multi_req.num_handles) {
build_read_multi_rsp(p_cmd, mtu);
return (true);
}
} else /* any handle read exception occurs, return error */
{
return (true);
}
/* If here, still waiting */
return (false);
}
/*******************************************************************************
*
* Function gatt_sr_process_app_rsp
*
* Description This function checks whether the response message from
* application matches any pending request.
*
* Returns void
*
******************************************************************************/
tGATT_STATUS gatt_sr_process_app_rsp(tGATT_TCB& tcb, tGATT_IF gatt_if,
UNUSED_ATTR uint32_t trans_id,
uint8_t op_code, tGATT_STATUS status,
tGATTS_RSP* p_msg,
tGATT_SR_CMD* sr_res_p) {
tGATT_STATUS ret_code = GATT_SUCCESS;
uint16_t payload_size = gatt_tcb_get_payload_size(tcb, sr_res_p->cid);
log::verbose("gatt_if={}", gatt_if);
gatt_sr_update_cback_cnt(tcb, sr_res_p->cid, gatt_if, false, false);
if ((op_code == GATT_REQ_READ_MULTI) ||
(op_code == GATT_REQ_READ_MULTI_VAR)) {
/* If no error and still waiting, just return */
if (!process_read_multi_rsp(sr_res_p, status, p_msg, payload_size))
return (GATT_SUCCESS);
} else {
if (op_code == GATT_REQ_PREPARE_WRITE && status == GATT_SUCCESS)
gatt_sr_update_prep_cnt(tcb, gatt_if, true, false);
if (op_code == GATT_REQ_EXEC_WRITE && status != GATT_SUCCESS)
gatt_sr_reset_cback_cnt(tcb, sr_res_p->cid);
sr_res_p->status = status;
if (gatt_sr_is_cback_cnt_zero(tcb) && status == GATT_SUCCESS) {
if (sr_res_p->p_rsp_msg == NULL) {
sr_res_p->p_rsp_msg = attp_build_sr_msg(
tcb, (uint8_t)(op_code + 1), (tGATT_SR_MSG*)p_msg, payload_size);
} else {
log::error("Exception!!! already has respond message");
}
}
}
if (gatt_sr_is_cback_cnt_zero(tcb)) {
if ((sr_res_p->status == GATT_SUCCESS) && (sr_res_p->p_rsp_msg)) {
ret_code = attp_send_sr_msg(tcb, sr_res_p->cid, sr_res_p->p_rsp_msg);
sr_res_p->p_rsp_msg = NULL;
} else {
ret_code = gatt_send_error_rsp(tcb, sr_res_p->cid, status, op_code,
sr_res_p->handle, false);
}
gatt_dequeue_sr_cmd(tcb, sr_res_p->cid);
}
log::verbose("ret_code={}", ret_code);
return ret_code;
}
/*******************************************************************************
*
* Function gatt_process_exec_write_req
*
* Description This function is called to process the execute write request
* from client.
*
* Returns void
*
******************************************************************************/
void gatt_process_exec_write_req(tGATT_TCB& tcb, uint16_t cid, uint8_t op_code,
uint16_t len, uint8_t* p_data) {
uint8_t *p = p_data, flag, i = 0;
uint32_t trans_id = 0;
tGATT_IF gatt_if;
uint16_t conn_id;
#if (GATT_CONFORMANCE_TESTING == TRUE)
if (gatt_cb.enable_err_rsp && gatt_cb.req_op_code == op_code) {
log::verbose(
"Conformance tst: forced err rspv for Execute Write: error status={}",
gatt_cb.err_status);
gatt_send_error_rsp(tcb, cid, gatt_cb.err_status, gatt_cb.req_op_code,
gatt_cb.handle, false);
return;
}
#endif
if (len < sizeof(flag)) {
log::error("invalid length");
gatt_send_error_rsp(tcb, cid, GATT_INVALID_PDU, GATT_REQ_EXEC_WRITE, 0,
false);
return;
}
STREAM_TO_UINT8(flag, p);
/* mask the flag */
flag &= GATT_PREP_WRITE_EXEC;
/* no prep write is queued */
if (!gatt_sr_is_prep_cnt_zero(tcb)) {
trans_id = gatt_sr_enqueue_cmd(tcb, cid, op_code, 0);
gatt_sr_copy_prep_cnt_to_cback_cnt(tcb);
for (i = 0; i < GATT_MAX_APPS; i++) {
if (tcb.prep_cnt[i]) {
gatt_if = (tGATT_IF)(i + 1);
conn_id = GATT_CREATE_CONN_ID(tcb.tcb_idx, gatt_if);
tGATTS_DATA gatts_data;
gatts_data.exec_write = flag;
gatt_sr_send_req_callback(conn_id, trans_id, GATTS_REQ_TYPE_WRITE_EXEC,
&gatts_data);
tcb.prep_cnt[i] = 0;
}
}
} else /* nothing needs to be executed , send response now */
{
log::error("gatt_process_exec_write_req: no prepare write pending");
gatt_send_error_rsp(tcb, cid, GATT_ERROR, GATT_REQ_EXEC_WRITE, 0, false);
}
}
/*******************************************************************************
*
* Function gatt_process_read_multi_req
*
* Description This function is called to process the read multiple request
* from client.
*
* Returns void
*
******************************************************************************/
void gatt_process_read_multi_req(tGATT_TCB& tcb, uint16_t cid, uint8_t op_code,
uint16_t len, uint8_t* p_data) {
uint32_t trans_id;
uint16_t handle = 0, ll = len;
uint8_t* p = p_data;
tGATT_STATUS err = GATT_SUCCESS;
tGATT_SEC_FLAG sec_flag;
uint8_t key_size;
log::verbose("");
tGATT_READ_MULTI* multi_req = gatt_sr_get_read_multi(tcb, cid);
if (multi_req == nullptr) {
log::error("Could not proceed request. {}, 0x{:02x}",
ADDRESS_TO_LOGGABLE_CSTR(tcb.peer_bda), cid);
return;
}
multi_req->num_handles = 0;
multi_req->variable_len = (op_code == GATT_REQ_READ_MULTI_VAR);
gatt_sr_get_sec_info(tcb.peer_bda, tcb.transport, &sec_flag, &key_size);
#if (GATT_CONFORMANCE_TESTING == TRUE)
if (gatt_cb.enable_err_rsp && gatt_cb.req_op_code == op_code) {
log::verbose(
"Conformance tst: forced err rspvofr ReadMultiple: error status={}",
gatt_cb.err_status);
STREAM_TO_UINT16(handle, p);
gatt_send_error_rsp(tcb, cid, gatt_cb.err_status, gatt_cb.req_op_code,
handle, false);
return;
}
#endif
while (ll >= 2 && multi_req->num_handles < GATT_MAX_READ_MULTI_HANDLES) {
STREAM_TO_UINT16(handle, p);
auto it = gatt_sr_find_i_rcb_by_handle(handle);
if (it != gatt_cb.srv_list_info->end()) {
multi_req->handles[multi_req->num_handles++] = handle;
/* check read permission */
err = gatts_read_attr_perm_check(it->p_db, false, handle, sec_flag,
key_size);
if (err != GATT_SUCCESS) {
log::verbose("read permission denied : 0x{:02x}", err);
break;
}
} else {
/* invalid handle */
err = GATT_INVALID_HANDLE;
break;
}
ll -= 2;
}
if (ll != 0) {
log::error("max attribute handle reached in ReadMultiple Request.");
}
if (multi_req->num_handles == 0) err = GATT_INVALID_HANDLE;
if (err == GATT_SUCCESS) {
trans_id = gatt_sr_enqueue_cmd(tcb, cid, op_code, multi_req->handles[0]);
if (trans_id != 0) {
tGATT_SR_CMD* sr_cmd_p = gatt_sr_get_cmd_by_cid(tcb, cid);
if (sr_cmd_p == nullptr) {
log::error(
"Could not send response on CID were request arrived. {}, 0x{:02x}",
ADDRESS_TO_LOGGABLE_CSTR(tcb.peer_bda), cid);
return;
}
gatt_sr_reset_cback_cnt(tcb,
cid); /* read multiple use multi_rsp_q's count*/
for (ll = 0; ll < multi_req->num_handles; ll++) {
tGATTS_RSP* p_msg = (tGATTS_RSP*)osi_calloc(sizeof(tGATTS_RSP));
handle = multi_req->handles[ll];
auto it = gatt_sr_find_i_rcb_by_handle(handle);
p_msg->attr_value.handle = handle;
err = gatts_read_attr_value_by_handle(
tcb, cid, it->p_db, op_code, handle, 0, p_msg->attr_value.value,
&p_msg->attr_value.len, GATT_MAX_ATTR_LEN, sec_flag, key_size,
trans_id);
if (err == GATT_SUCCESS) {
gatt_sr_process_app_rsp(tcb, it->gatt_if, trans_id, op_code,
GATT_SUCCESS, p_msg, sr_cmd_p);
}
/* either not using or done using the buffer, release it now */
osi_free(p_msg);
}
} else
err = GATT_NO_RESOURCES;
}
/* in theroy BUSY is not possible(should already been checked), protected
* check */
if (err != GATT_SUCCESS && err != GATT_PENDING && err != GATT_BUSY)
gatt_send_error_rsp(tcb, cid, err, op_code, handle, false);
}
/*******************************************************************************
*
* Function gatt_build_primary_service_rsp
*
* Description Primamry service request processed internally. Theretically
* only deal with ReadByTypeVAlue and ReadByGroupType.
*
* Returns void
*
******************************************************************************/
static tGATT_STATUS gatt_build_primary_service_rsp(
BT_HDR* p_msg, tGATT_TCB& tcb, uint16_t cid, uint8_t op_code,
uint16_t s_hdl, uint16_t e_hdl, UNUSED_ATTR uint8_t* p_data,
const Uuid& value) {
tGATT_STATUS status = GATT_NOT_FOUND;
uint8_t handle_len = 4;
uint8_t* p = (uint8_t*)(p_msg + 1) + L2CAP_MIN_OFFSET;
uint16_t payload_size = gatt_tcb_get_payload_size(tcb, cid);
for (tGATT_SRV_LIST_ELEM& el : *gatt_cb.srv_list_info) {
if (el.s_hdl < s_hdl || el.s_hdl > e_hdl ||
el.type != GATT_UUID_PRI_SERVICE) {
continue;
}
Uuid* p_uuid = gatts_get_service_uuid(el.p_db);
if (!p_uuid) continue;
if (op_code == GATT_REQ_READ_BY_GRP_TYPE)
handle_len = 4 + gatt_build_uuid_to_stream_len(*p_uuid);
/* get the length byte in the repsonse */
if (p_msg->offset == 0) {
*p++ = op_code + 1;
p_msg->len++;
p_msg->offset = handle_len;
if (op_code == GATT_REQ_READ_BY_GRP_TYPE) {
*p++ = (uint8_t)p_msg->offset; /* length byte */
p_msg->len++;
}
}
if (p_msg->len + p_msg->offset > payload_size ||
handle_len != p_msg->offset) {
break;
}
if (op_code == GATT_REQ_FIND_TYPE_VALUE && value != *p_uuid) continue;
UINT16_TO_STREAM(p, el.s_hdl);
if (gatt_cb.last_service_handle &&
gatt_cb.last_service_handle == el.s_hdl) {
log::verbose("Use 0xFFFF for the last primary attribute");
/* see GATT ERRATA 4065, 4063, ATT ERRATA 4062 */
UINT16_TO_STREAM(p, 0xFFFF);
} else {
UINT16_TO_STREAM(p, el.e_hdl);
}
if (op_code == GATT_REQ_READ_BY_GRP_TYPE)
gatt_build_uuid_to_stream(&p, *p_uuid);
status = GATT_SUCCESS;
p_msg->len += p_msg->offset;
}
p_msg->offset = L2CAP_MIN_OFFSET;
return status;
}
/**
* fill the find information response information in the given buffer.
*
* Returns true: if data filled sucessfully.
* false: packet full, or format mismatch.
*/
static tGATT_STATUS gatt_build_find_info_rsp(tGATT_SRV_LIST_ELEM& el,
BT_HDR* p_msg, uint16_t& len,
uint16_t s_hdl, uint16_t e_hdl) {
uint8_t info_pair_len[2] = {4, 18};
if (!el.p_db) return GATT_NOT_FOUND;
/* check the attribute database */
uint8_t* p = (uint8_t*)(p_msg + 1) + L2CAP_MIN_OFFSET + p_msg->len;
for (auto& attr : el.p_db->attr_list) {
if (attr.handle > e_hdl) break;
if (attr.handle < s_hdl) continue;
uint8_t uuid_len = attr.uuid.GetShortestRepresentationSize();
if (p_msg->offset == 0)
p_msg->offset = (uuid_len == Uuid::kNumBytes16) ? GATT_INFO_TYPE_PAIR_16
: GATT_INFO_TYPE_PAIR_128;
if (len < info_pair_len[p_msg->offset - 1]) return GATT_NO_RESOURCES;
if (p_msg->offset == GATT_INFO_TYPE_PAIR_16 &&
uuid_len == Uuid::kNumBytes16) {
UINT16_TO_STREAM(p, attr.handle);
UINT16_TO_STREAM(p, attr.uuid.As16Bit());
} else if (p_msg->offset == GATT_INFO_TYPE_PAIR_128 &&
uuid_len == Uuid::kNumBytes128) {
UINT16_TO_STREAM(p, attr.handle);
ARRAY_TO_STREAM(p, attr.uuid.To128BitLE(), (int)Uuid::kNumBytes128);
} else if (p_msg->offset == GATT_INFO_TYPE_PAIR_128 &&
uuid_len == Uuid::kNumBytes32) {
UINT16_TO_STREAM(p, attr.handle);
ARRAY_TO_STREAM(p, attr.uuid.To128BitLE(), (int)Uuid::kNumBytes128);
} else {
log::error("format mismatch");
return GATT_NO_RESOURCES;
/* format mismatch */
}
p_msg->len += info_pair_len[p_msg->offset - 1];
len -= info_pair_len[p_msg->offset - 1];
return GATT_SUCCESS;
}
return GATT_NOT_FOUND;
}
static tGATT_STATUS read_handles(uint16_t& len, uint8_t*& p, uint16_t& s_hdl,
uint16_t& e_hdl) {
if (len < 4) return GATT_INVALID_PDU;
/* obtain starting handle, and ending handle */
STREAM_TO_UINT16(s_hdl, p);
STREAM_TO_UINT16(e_hdl, p);
len -= 4;
if (s_hdl > e_hdl || !GATT_HANDLE_IS_VALID(s_hdl) ||
!GATT_HANDLE_IS_VALID(e_hdl)) {
return GATT_INVALID_HANDLE;
}
return GATT_SUCCESS;
}
static tGATT_STATUS gatts_validate_packet_format(uint8_t op_code, uint16_t& len,
uint8_t*& p, Uuid* p_uuid,
uint16_t& s_hdl,
uint16_t& e_hdl) {
tGATT_STATUS ret = read_handles(len, p, s_hdl, e_hdl);
if (ret != GATT_SUCCESS) return ret;
if (len < 2) return GATT_INVALID_PDU;
/* parse uuid now */
CHECK(p_uuid);
uint16_t uuid_len = (op_code == GATT_REQ_FIND_TYPE_VALUE) ? 2 : len;
if (!gatt_parse_uuid_from_cmd(p_uuid, uuid_len, &p)) {
log::verbose("Bad UUID");
return GATT_INVALID_PDU;
}
len -= uuid_len;
return GATT_SUCCESS;
}
/*******************************************************************************
*
* Function gatts_process_primary_service_req
*
* Description Process ReadByGroupType/ReadByTypeValue request, for
* discovering all primary services or discover primary service
* by UUID request.
*
* Returns void
*
******************************************************************************/
void gatts_process_primary_service_req(tGATT_TCB& tcb, uint16_t cid,
uint8_t op_code, uint16_t len,
uint8_t* p_data) {
uint16_t s_hdl = 0, e_hdl = 0;
Uuid uuid = Uuid::kEmpty;
uint8_t reason =
gatts_validate_packet_format(op_code, len, p_data, &uuid, s_hdl, e_hdl);
if (reason != GATT_SUCCESS) {
gatt_send_error_rsp(tcb, cid, reason, op_code, s_hdl, false);
return;
}
if (uuid != Uuid::From16Bit(GATT_UUID_PRI_SERVICE)) {
if (op_code == GATT_REQ_READ_BY_GRP_TYPE) {
gatt_send_error_rsp(tcb, cid, GATT_UNSUPPORT_GRP_TYPE, op_code, s_hdl,
false);
log::verbose("unexpected ReadByGrpType Group: {}", uuid.ToString());
return;
}
// we do not support ReadByTypeValue with any non-primamry_service type
gatt_send_error_rsp(tcb, cid, GATT_NOT_FOUND, op_code, s_hdl, false);
log::verbose("unexpected ReadByTypeValue type: {}", uuid.ToString());
return;
}
// TODO: we assume theh value is UUID, there is no such requirement in spec
Uuid value = Uuid::kEmpty;
if (op_code == GATT_REQ_FIND_TYPE_VALUE) {
if (!gatt_parse_uuid_from_cmd(&value, len, &p_data)) {
gatt_send_error_rsp(tcb, cid, GATT_INVALID_PDU, op_code, s_hdl, false);
}
}
uint16_t payload_size = gatt_tcb_get_payload_size(tcb, cid);
uint16_t msg_len =
(uint16_t)(sizeof(BT_HDR) + payload_size + L2CAP_MIN_OFFSET);
BT_HDR* p_msg = (BT_HDR*)osi_calloc(msg_len);
reason = gatt_build_primary_service_rsp(p_msg, tcb, cid, op_code, s_hdl,
e_hdl, p_data, value);
if (reason != GATT_SUCCESS) {
osi_free(p_msg);
gatt_send_error_rsp(tcb, cid, reason, op_code, s_hdl, false);
return;
}
attp_send_sr_msg(tcb, cid, p_msg);
}
/*******************************************************************************
*
* Function gatts_process_find_info
*
* Description process find information request, for discover character
* descriptors.
*
* Returns void
*
******************************************************************************/
static void gatts_process_find_info(tGATT_TCB& tcb, uint16_t cid,
uint8_t op_code, uint16_t len,
uint8_t* p_data) {
uint16_t s_hdl = 0, e_hdl = 0;
uint8_t reason = read_handles(len, p_data, s_hdl, e_hdl);
if (reason != GATT_SUCCESS) {
gatt_send_error_rsp(tcb, cid, reason, op_code, s_hdl, false);
return;
}
uint16_t payload_size = gatt_tcb_get_payload_size(tcb, cid);
uint16_t buf_len =
(uint16_t)(sizeof(BT_HDR) + payload_size + L2CAP_MIN_OFFSET);
BT_HDR* p_msg = (BT_HDR*)osi_calloc(buf_len);
reason = GATT_NOT_FOUND;
uint8_t* p = (uint8_t*)(p_msg + 1) + L2CAP_MIN_OFFSET;
*p++ = op_code + 1;
p_msg->len = 2;
buf_len = payload_size - 2;
for (tGATT_SRV_LIST_ELEM& el : *gatt_cb.srv_list_info) {
if (el.s_hdl <= e_hdl && el.e_hdl >= s_hdl) {
reason = gatt_build_find_info_rsp(el, p_msg, buf_len, s_hdl, e_hdl);
if (reason == GATT_NO_RESOURCES) {
reason = GATT_SUCCESS;
break;
}
}
}
*p = (uint8_t)p_msg->offset;
p_msg->offset = L2CAP_MIN_OFFSET;
if (reason != GATT_SUCCESS) {
osi_free(p_msg);
gatt_send_error_rsp(tcb, cid, reason, op_code, s_hdl, false);
} else
attp_send_sr_msg(tcb, cid, p_msg);
}
/*******************************************************************************
*
* Function gatts_process_mtu_req
*
* Description This function is called to process excahnge MTU request.
* Only used on LE.
*
* Returns void
*
******************************************************************************/
static void gatts_process_mtu_req(tGATT_TCB& tcb, uint16_t cid, uint16_t len,
uint8_t* p_data) {
/* BR/EDR conenction, send error response */
if (cid != L2CAP_ATT_CID) {
gatt_send_error_rsp(tcb, cid, GATT_REQ_NOT_SUPPORTED, GATT_REQ_MTU, 0,
false);
return;
}
if (len < GATT_MTU_REQ_MIN_LEN) {
log::error("invalid MTU request PDU received.");
gatt_send_error_rsp(tcb, cid, GATT_INVALID_PDU, GATT_REQ_MTU, 0, false);
return;
}
tGATT_SR_MSG gatt_sr_msg;
uint16_t mtu = 0;
uint8_t* p = p_data;
STREAM_TO_UINT16(mtu, p);
/* mtu must be greater than default MTU which is 23/48 */
if (mtu < GATT_DEF_BLE_MTU_SIZE) {
tcb.payload_size = GATT_DEF_BLE_MTU_SIZE;
} else {
tcb.payload_size = std::min(mtu, (uint16_t)(gatt_get_local_mtu()));
}
/* Always say to remote our default MTU. */
gatt_sr_msg.mtu = gatt_get_local_mtu();
log::info("MTU {} request from remote ({}), resulted MTU {}", mtu,
tcb.peer_bda.ToString(), tcb.payload_size);
BTM_SetBleDataLength(tcb.peer_bda, tcb.payload_size + L2CAP_PKT_OVERHEAD);
BT_HDR* p_buf =
attp_build_sr_msg(tcb, GATT_RSP_MTU, &gatt_sr_msg, GATT_DEF_BLE_MTU_SIZE);
attp_send_sr_msg(tcb, cid, p_buf);
bluetooth::shim::arbiter::GetArbiter().OnIncomingMtuReq(tcb.tcb_idx,
tcb.payload_size);
tGATTS_DATA gatts_data;
gatts_data.mtu = tcb.payload_size;
/* Notify all registered applicaiton with new MTU size. Us a transaction ID */
/* of 0, as no response is allowed from applcations */
for (int i = 0; i < GATT_MAX_APPS; i++) {
if (gatt_cb.cl_rcb[i].in_use) {
uint16_t conn_id =
GATT_CREATE_CONN_ID(tcb.tcb_idx, gatt_cb.cl_rcb[i].gatt_if);
gatt_sr_send_req_callback(conn_id, 0, GATTS_REQ_TYPE_MTU, &gatts_data);
}
}
}
/*******************************************************************************
*
* Function gatts_process_read_by_type_req
*
* Description process Read By type request.
* This PDU can be used to perform:
* - read characteristic value
* - read characteristic descriptor value
* - discover characteristic
* - discover characteristic by UUID
* - relationship discovery
*
* Returns void
*
******************************************************************************/
static void gatts_process_read_by_type_req(tGATT_TCB& tcb, uint16_t cid,
uint8_t op_code, uint16_t len,
uint8_t* p_data) {
Uuid uuid = Uuid::kEmpty;
uint16_t s_hdl = 0, e_hdl = 0, err_hdl = 0;
tGATT_STATUS reason =
gatts_validate_packet_format(op_code, len, p_data, &uuid, s_hdl, e_hdl);
#if (GATT_CONFORMANCE_TESTING == TRUE)
if (gatt_cb.enable_err_rsp && gatt_cb.req_op_code == op_code) {
log::verbose(
"Conformance tst: forced err rsp for ReadByType: error status={}",
gatt_cb.err_status);
gatt_send_error_rsp(tcb, cid, gatt_cb.err_status, gatt_cb.req_op_code,
s_hdl, false);
return;
}
#endif
if (reason != GATT_SUCCESS) {
gatt_send_error_rsp(tcb, cid, reason, op_code, s_hdl, false);
return;
}
uint16_t payload_size = gatt_tcb_get_payload_size(tcb, cid);
size_t msg_len = sizeof(BT_HDR) + payload_size + L2CAP_MIN_OFFSET;
BT_HDR* p_msg = (BT_HDR*)osi_calloc(msg_len);
uint8_t* p = (uint8_t*)(p_msg + 1) + L2CAP_MIN_OFFSET;
*p++ = op_code + 1;
/* reserve length byte */
p_msg->len = 2;
uint16_t buf_len = payload_size - 2;
reason = GATT_NOT_FOUND;
for (tGATT_SRV_LIST_ELEM& el : *gatt_cb.srv_list_info) {
if (el.s_hdl <= e_hdl && el.e_hdl >= s_hdl) {
tGATT_SEC_FLAG sec_flag;
uint8_t key_size;
gatt_sr_get_sec_info(tcb.peer_bda, tcb.transport, &sec_flag, &key_size);
tGATT_STATUS ret = gatts_db_read_attr_value_by_type(
tcb, cid, el.p_db, op_code, p_msg, s_hdl, e_hdl, uuid, &buf_len,
sec_flag, key_size, 0, &err_hdl);
if (ret != GATT_NOT_FOUND) {
reason = ret;
if (ret == GATT_NO_RESOURCES) reason = GATT_SUCCESS;
}
if (ret != GATT_SUCCESS && ret != GATT_NOT_FOUND) {
s_hdl = err_hdl;
break;
}
}
}
*p = (uint8_t)p_msg->offset;
p_msg->offset = L2CAP_MIN_OFFSET;
if (reason != GATT_SUCCESS) {
osi_free(p_msg);
/* in theroy BUSY is not possible(should already been checked), protected
* check */
if (reason != GATT_PENDING && reason != GATT_BUSY)
gatt_send_error_rsp(tcb, cid, reason, op_code, s_hdl, false);
return;
}
attp_send_sr_msg(tcb, cid, p_msg);
}
/**
* This function is called to process the write request from client.
*/
static void gatts_process_write_req(tGATT_TCB& tcb, uint16_t cid,
tGATT_SRV_LIST_ELEM& el, uint16_t handle,
uint8_t op_code, uint16_t len,
uint8_t* p_data,
bt_gatt_db_attribute_type_t gatt_type) {
tGATTS_DATA sr_data;
uint32_t trans_id;
tGATT_STATUS status;
tGATT_SEC_FLAG sec_flag;
uint8_t key_size, *p = p_data;
uint16_t conn_id;
memset(&sr_data, 0, sizeof(tGATTS_DATA));
switch (op_code) {
case GATT_REQ_PREPARE_WRITE:
if (len < 2 || p == nullptr) {
log::error(
"Prepare write request was invalid - missing offset, sending error "
"response");
gatt_send_error_rsp(tcb, cid, GATT_INVALID_PDU, op_code, handle, false);
return;
}
sr_data.write_req.is_prep = true;
STREAM_TO_UINT16(sr_data.write_req.offset, p);
len -= 2;
FALLTHROUGH_INTENDED; /* FALLTHROUGH */
case GATT_SIGN_CMD_WRITE:
if (op_code == GATT_SIGN_CMD_WRITE) {
log::verbose("Write CMD with data sigining");
len -= GATT_AUTH_SIGN_LEN;
}
FALLTHROUGH_INTENDED; /* FALLTHROUGH */
case GATT_CMD_WRITE:
case GATT_REQ_WRITE:
if (op_code == GATT_REQ_WRITE || op_code == GATT_REQ_PREPARE_WRITE)
sr_data.write_req.need_rsp = true;
sr_data.write_req.handle = handle;
if (len > GATT_MAX_ATTR_LEN) len = GATT_MAX_ATTR_LEN;
sr_data.write_req.len = len;
if (len != 0 && p != nullptr) {
memcpy(sr_data.write_req.value, p, len);
}
break;
}
gatt_sr_get_sec_info(tcb.peer_bda, tcb.transport, &sec_flag, &key_size);
status = gatts_write_attr_perm_check(el.p_db, op_code, handle,
sr_data.write_req.offset, p, len,
sec_flag, key_size);
if (status == GATT_SUCCESS) {
trans_id = gatt_sr_enqueue_cmd(tcb, cid, op_code, handle);
if (trans_id != 0) {
conn_id = GATT_CREATE_CONN_ID(tcb.tcb_idx, el.gatt_if);
uint8_t opcode = 0;
if (gatt_type == BTGATT_DB_DESCRIPTOR) {
opcode = GATTS_REQ_TYPE_WRITE_DESCRIPTOR;
} else if (gatt_type == BTGATT_DB_CHARACTERISTIC) {
opcode = GATTS_REQ_TYPE_WRITE_CHARACTERISTIC;
} else {
log::error(
"Attempt to write attribute that's not tied with "
"characteristic or descriptor value.");
status = GATT_ERROR;
}
if (opcode) {
gatt_sr_send_req_callback(conn_id, trans_id, opcode, &sr_data);
status = GATT_PENDING;
}
} else {
log::error("max pending command, send error");
status = GATT_BUSY; /* max pending command, application error */
}
}
/* in theroy BUSY is not possible(should already been checked), protected
* check */
if (status != GATT_PENDING && status != GATT_BUSY &&
(op_code == GATT_REQ_PREPARE_WRITE || op_code == GATT_REQ_WRITE)) {
gatt_send_error_rsp(tcb, cid, status, op_code, handle, false);
}
return;
}
/**
* This function is called to process the read request from client.
*/
static void gatts_process_read_req(tGATT_TCB& tcb, uint16_t cid,
tGATT_SRV_LIST_ELEM& el, uint8_t op_code,
uint16_t handle, uint16_t len,
uint8_t* p_data) {
uint16_t payload_size = gatt_tcb_get_payload_size(tcb, cid);
size_t buf_len = sizeof(BT_HDR) + payload_size + L2CAP_MIN_OFFSET;
uint16_t offset = 0;
if (op_code == GATT_REQ_READ_BLOB && len < sizeof(uint16_t)) {
/* Error: packet length is too short */
log::error("packet length={} too short. min={}", len, sizeof(uint16_t));
gatt_send_error_rsp(tcb, cid, GATT_INVALID_PDU, op_code, 0, false);
return;
}
BT_HDR* p_msg = (BT_HDR*)osi_calloc(buf_len);
if (op_code == GATT_REQ_READ_BLOB) STREAM_TO_UINT16(offset, p_data);
uint8_t* p = (uint8_t*)(p_msg + 1) + L2CAP_MIN_OFFSET;
*p++ = op_code + 1;
p_msg->len = 1;
buf_len = payload_size - 1;
tGATT_SEC_FLAG sec_flag;
uint8_t key_size;
gatt_sr_get_sec_info(tcb.peer_bda, tcb.transport, &sec_flag, &key_size);
uint16_t value_len = 0;
tGATT_STATUS reason = gatts_read_attr_value_by_handle(
tcb, cid, el.p_db, op_code, handle, offset, p, &value_len,
(uint16_t)buf_len, sec_flag, key_size, 0);
p_msg->len += value_len;
if (reason != GATT_SUCCESS) {
osi_free(p_msg);
/* in theory BUSY is not possible(should already been checked), protected
* check */
if (reason != GATT_PENDING && reason != GATT_BUSY)
gatt_send_error_rsp(tcb, cid, reason, op_code, handle, false);
return;
}
attp_send_sr_msg(tcb, cid, p_msg);
}
/*******************************************************************************
*
* Function gatts_process_attribute_req
*
* Description This function is called to process the per attribute handle
* request from client.
*
* Returns void
*
******************************************************************************/
void gatts_process_attribute_req(tGATT_TCB& tcb, uint16_t cid, uint8_t op_code,
uint16_t len, uint8_t* p_data) {
uint16_t handle = 0;
uint8_t* p = p_data;
tGATT_STATUS status = GATT_INVALID_HANDLE;
if (len < 2) {
log::error("Illegal PDU length, discard request");
status = GATT_INVALID_PDU;
} else {
STREAM_TO_UINT16(handle, p);
len -= 2;
}
#if (GATT_CONFORMANCE_TESTING == TRUE)
gatt_cb.handle = handle;
if (gatt_cb.enable_err_rsp && gatt_cb.req_op_code == op_code) {
log::verbose("Conformance tst: forced err rsp: error status={}",
gatt_cb.err_status);
gatt_send_error_rsp(tcb, cid, gatt_cb.err_status, cid, gatt_cb.req_op_code,
handle, false);
return;
}
#endif
if (GATT_HANDLE_IS_VALID(handle)) {
for (auto& el : *gatt_cb.srv_list_info) {
if (el.s_hdl <= handle && el.e_hdl >= handle) {
for (const auto& attr : el.p_db->attr_list) {
if (attr.handle == handle) {
switch (op_code) {
case GATT_REQ_READ: /* read char/char descriptor value */
case GATT_REQ_READ_BLOB:
gatts_process_read_req(tcb, cid, el, op_code, handle, len, p);
break;
case GATT_REQ_WRITE: /* write char/char descriptor value */
case GATT_CMD_WRITE:
case GATT_SIGN_CMD_WRITE:
case GATT_REQ_PREPARE_WRITE:
gatts_process_write_req(tcb, cid, el, handle, op_code, len, p,
attr.gatt_type);
break;
default:
break;
}
status = GATT_SUCCESS;
break;
}
}
break;
}
}
}
if (status != GATT_SUCCESS && op_code != GATT_CMD_WRITE &&
op_code != GATT_SIGN_CMD_WRITE)
gatt_send_error_rsp(tcb, cid, status, op_code, handle, false);
}
/*******************************************************************************
*
* Function gatts_proc_srv_chg_ind_ack
*
* Description This function process the service changed indicaiton ACK
*
* Returns void
*
******************************************************************************/
void gatts_proc_srv_chg_ind_ack(tGATT_TCB tcb) {
tGATTS_SRV_CHG_REQ req;
tGATTS_SRV_CHG* p_buf = NULL;
log::verbose("");
p_buf = gatt_is_bda_in_the_srv_chg_clt_list(tcb.peer_bda);
if (p_buf != NULL) {
log::verbose("NV update set srv chg = false");
p_buf->srv_changed = false;
memcpy(&req.srv_chg, p_buf, sizeof(tGATTS_SRV_CHG));
if (gatt_cb.cb_info.p_srv_chg_callback)
(*gatt_cb.cb_info.p_srv_chg_callback)(GATTS_SRV_CHG_CMD_UPDATE_CLIENT,
&req, NULL);
}
}
/*******************************************************************************
*
* Function gatts_chk_pending_ind
*
* Description This function check any pending indication needs to be sent
* if there is a pending indication then sent the indication
*
* Returns void
*
******************************************************************************/
static void gatts_chk_pending_ind(tGATT_TCB& tcb) {
log::verbose("");
tGATT_VALUE* p_buf =
(tGATT_VALUE*)fixed_queue_try_peek_first(tcb.pending_ind_q);
if (p_buf != NULL) {
GATTS_HandleValueIndication(p_buf->conn_id, p_buf->handle, p_buf->len,
p_buf->value);
osi_free(fixed_queue_try_remove_from_queue(tcb.pending_ind_q, p_buf));
}
}
/*******************************************************************************
*
* Function gatts_proc_ind_ack
*
* Description This function processes the Indication ack
*
* Returns true continue to process the indication ack by the
* application if the ACK is not a Service Changed Indication
*
******************************************************************************/
static bool gatts_proc_ind_ack(tGATT_TCB& tcb, uint16_t ack_handle) {
bool continue_processing = true;
log::verbose("ack handle={}", ack_handle);
if (ack_handle == gatt_cb.handle_of_h_r) {
gatts_proc_srv_chg_ind_ack(tcb);
/* there is no need to inform the application since srv chg is handled
* internally by GATT */
continue_processing = false;
// After receiving ack of svc_chg_ind, reset client status
gatt_sr_update_cl_status(tcb, /* chg_aware= */ true);
}
gatts_chk_pending_ind(tcb);
return continue_processing;
}
/*******************************************************************************
*
* Function gatts_process_value_conf
*
* Description This function is called to process the handle value
* confirmation.
*
* Returns void
*
******************************************************************************/
void gatts_process_value_conf(tGATT_TCB& tcb, uint16_t cid, uint8_t op_code) {
uint16_t handle;
if (!gatt_tcb_find_indicate_handle(tcb, cid, &handle)) {
log::error("unexpected handle value confirmation");
return;
}
gatt_stop_conf_timer(tcb, cid);
bool continue_processing = gatts_proc_ind_ack(tcb, handle);
if (continue_processing) {
tGATTS_DATA gatts_data;
gatts_data.handle = handle;
for (auto& el : *gatt_cb.srv_list_info) {
if (el.s_hdl <= handle && el.e_hdl >= handle) {
uint32_t trans_id = gatt_sr_enqueue_cmd(tcb, cid, op_code, handle);
uint16_t conn_id = GATT_CREATE_CONN_ID(tcb.tcb_idx, el.gatt_if);
gatt_sr_send_req_callback(conn_id, trans_id, GATTS_REQ_TYPE_CONF,
&gatts_data);
}
}
}
}
static bool gatts_process_db_out_of_sync(tGATT_TCB& tcb, uint16_t cid,
uint8_t op_code, uint16_t len,
uint8_t* p_data) {
if (gatt_sr_is_cl_change_aware(tcb)) return false;
// default value
bool should_ignore = true;
bool should_rsp = true;
switch (op_code) {
case GATT_REQ_READ_BY_TYPE: {
// Check if read database hash by UUID
Uuid uuid = Uuid::kEmpty;
uint16_t s_hdl = 0, e_hdl = 0;
uint16_t db_hash_handle = gatt_cb.handle_of_database_hash;
tGATT_STATUS reason = gatts_validate_packet_format(op_code, len, p_data,
&uuid, s_hdl, e_hdl);
if (reason == GATT_SUCCESS &&
(s_hdl <= db_hash_handle && db_hash_handle <= e_hdl) &&
(uuid == Uuid::From16Bit(GATT_UUID_DATABASE_HASH)))
should_ignore = false;
} break;
case GATT_REQ_READ: {
// Check if read database hash by handle
uint16_t handle = 0;
uint8_t* p = p_data;
tGATT_STATUS status = GATT_SUCCESS;
if (len < 2) {
status = GATT_INVALID_PDU;
} else {
STREAM_TO_UINT16(handle, p);
len -= 2;
}
if (status == GATT_SUCCESS && handle == gatt_cb.handle_of_database_hash)
should_ignore = false;
} break;
case GATT_REQ_READ_BY_GRP_TYPE: /* discover primary services */
case GATT_REQ_FIND_TYPE_VALUE: /* discover service by UUID */
case GATT_REQ_FIND_INFO: /* discover char descrptor */
case GATT_REQ_READ_BLOB: /* read long char */
case GATT_REQ_READ_MULTI: /* read multi char*/
case GATT_REQ_WRITE: /* write char/char descriptor value */
case GATT_REQ_PREPARE_WRITE: /* write long char */
// Use default value
break;
case GATT_CMD_WRITE: /* cmd */
case GATT_SIGN_CMD_WRITE: /* sign cmd */
should_rsp = false;
break;
case GATT_REQ_MTU: /* configure mtu */
case GATT_REQ_EXEC_WRITE: /* execute write */
case GATT_HANDLE_VALUE_CONF: /* confirm for indication */
default:
should_ignore = false;
}
if (should_ignore) {
if (should_rsp) {
gatt_send_error_rsp(tcb, cid, GATT_DATABASE_OUT_OF_SYNC, op_code, 0x0000,
false);
}
log::info("database out of sync, device={}, op_code={}, should_rsp={}",
ADDRESS_TO_LOGGABLE_STR(tcb.peer_bda), loghex((uint16_t)op_code),
should_rsp);
gatt_sr_update_cl_status(tcb, /* chg_aware= */ should_rsp);
}
return should_ignore;
}
/** This function is called to handle the client requests to server */
void gatt_server_handle_client_req(tGATT_TCB& tcb, uint16_t cid,
uint8_t op_code, uint16_t len,
uint8_t* p_data) {
/* there is pending command, discard this one */
if (!gatt_sr_cmd_empty(tcb, cid) && op_code != GATT_HANDLE_VALUE_CONF) return;
/* the size of the message may not be bigger than the local max PDU size*/
/* The message has to be smaller than the agreed MTU, len does not include op
* code */
uint16_t payload_size = gatt_tcb_get_payload_size(tcb, cid);
if (len >= payload_size) {
log::error("server receive invalid PDU size:{} pdu size:{}", len + 1,
payload_size);
/* for invalid request expecting response, send it now */
if (op_code != GATT_CMD_WRITE && op_code != GATT_SIGN_CMD_WRITE &&
op_code != GATT_HANDLE_VALUE_CONF) {
gatt_send_error_rsp(tcb, cid, GATT_INVALID_PDU, op_code, 0, false);
}
/* otherwise, ignore the pkt */
} else {
// handle database out of sync
if (gatts_process_db_out_of_sync(tcb, cid, op_code, len, p_data)) return;
switch (op_code) {
case GATT_REQ_READ_BY_GRP_TYPE: /* discover primary services */
case GATT_REQ_FIND_TYPE_VALUE: /* discover service by UUID */
gatts_process_primary_service_req(tcb, cid, op_code, len, p_data);
break;
case GATT_REQ_FIND_INFO: /* discover char descrptor */
gatts_process_find_info(tcb, cid, op_code, len, p_data);
break;
case GATT_REQ_READ_BY_TYPE: /* read characteristic value, char descriptor
value */
/* discover characteristic, discover char by UUID */
gatts_process_read_by_type_req(tcb, cid, op_code, len, p_data);
break;
case GATT_REQ_READ: /* read char/char descriptor value */
case GATT_REQ_READ_BLOB:
case GATT_REQ_WRITE: /* write char/char descriptor value */
case GATT_CMD_WRITE:
case GATT_SIGN_CMD_WRITE:
case GATT_REQ_PREPARE_WRITE:
gatts_process_attribute_req(tcb, cid, op_code, len, p_data);
break;
case GATT_HANDLE_VALUE_CONF:
gatts_process_value_conf(tcb, cid, op_code);
break;
case GATT_REQ_MTU:
gatts_process_mtu_req(tcb, cid, len, p_data);
break;
case GATT_REQ_EXEC_WRITE:
gatt_process_exec_write_req(tcb, cid, op_code, len, p_data);
break;
case GATT_REQ_READ_MULTI:
case GATT_REQ_READ_MULTI_VAR:
gatt_process_read_multi_req(tcb, cid, op_code, len, p_data);
break;
default:
break;
}
}
}