/*******************************************************************************
**
** Function srvc_eng_s_request_cback
**
** Description GATT DIS attribute access request callback.
**
** Returns void.
**
*******************************************************************************/
static void srvc_eng_s_request_cback (UINT16 conn_id, UINT32 trans_id, tGATTS_REQ_TYPE type,
tGATTS_DATA *p_data)
{
UINT8 status = GATT_INVALID_PDU;
tGATTS_RSP rsp_msg ;
UINT8 act = SRVC_ACT_IGNORE;
UINT8 clcb_idx = srvc_eng_find_clcb_idx_by_conn_id(conn_id);
if( clcb_idx == SRVC_MAX_APPS)
{
GATT_TRACE_ERROR("srvc_eng_s_request_cback received for unknown connection");
return;
}
GATT_TRACE_EVENT("srvc_eng_s_request_cback : recv type (0x%02x)", type);
memset(&rsp_msg, 0, sizeof(tGATTS_RSP));
srvc_eng_cb.clcb[clcb_idx].trans_id = trans_id;
switch (type)
{
case GATTS_REQ_TYPE_READ:
act = srvc_eng_process_read_req(clcb_idx, &p_data->read_req, &rsp_msg, &status);
break;
case GATTS_REQ_TYPE_WRITE:
act = srvc_eng_process_write_req(clcb_idx, &p_data->write_req, &rsp_msg, &status);
if (!p_data->write_req.need_rsp)
act = SRVC_ACT_IGNORE;
break;
case GATTS_REQ_TYPE_WRITE_EXEC:
GATT_TRACE_EVENT("Ignore GATT_REQ_EXEC_WRITE/WRITE_CMD" );
break;
case GATTS_REQ_TYPE_MTU:
GATT_TRACE_EVENT("Get MTU exchange new mtu size: %d", p_data->mtu);
break;
default:
GATT_TRACE_EVENT("Unknown/unexpected LE GAP ATT request: 0x%02x", type);
break;
}
srvc_eng_cb.clcb[clcb_idx].trans_id = 0;
if (act == SRVC_ACT_RSP)
GATTS_SendRsp (conn_id, trans_id, status, &rsp_msg);
}
/*******************************************************************************
**
** Function attp_build_sr_msg
**
** Description Build ATT Server PDUs.
**
*******************************************************************************/
BT_HDR *attp_build_sr_msg(tGATT_TCB *p_tcb, UINT8 op_code, tGATT_SR_MSG *p_msg)
{
BT_HDR *p_cmd = NULL;
UINT16 offset = 0;
switch (op_code)
{
case GATT_RSP_READ_BLOB:
case GATT_RSP_PREPARE_WRITE:
GATT_TRACE_EVENT ("ATT_RSP_READ_BLOB/GATT_RSP_PREPARE_WRITE: len = %d offset = %d",
p_msg->attr_value.len, p_msg->attr_value.offset);
offset = p_msg->attr_value.offset;
/* Coverity: [FALSE-POSITIVE error] intended fall through */
/* Missing break statement between cases in switch statement */
/* fall through */
case GATT_RSP_READ_BY_TYPE:
case GATT_RSP_READ:
case GATT_HANDLE_VALUE_NOTIF:
case GATT_HANDLE_VALUE_IND:
p_cmd = attp_build_value_cmd(p_tcb->payload_size,
op_code,
p_msg->attr_value.handle,
offset,
p_msg->attr_value.len,
p_msg->attr_value.value);
break;
case GATT_RSP_WRITE:
p_cmd = attp_build_opcode_cmd(op_code);
break;
case GATT_RSP_ERROR:
p_cmd = attp_build_err_cmd(p_msg->error.cmd_code, p_msg->error.handle, p_msg->error.reason);
break;
case GATT_RSP_EXEC_WRITE:
p_cmd = attp_build_exec_write_cmd(op_code, 0);
break;
case GATT_RSP_MTU:
p_cmd = attp_build_mtu_cmd(op_code, p_msg->mtu);
break;
default:
GATT_TRACE_DEBUG("attp_build_sr_msg: unknown op code = %d", op_code);
break;
}
if (!p_cmd)
GATT_TRACE_ERROR("No resources");
return p_cmd;
}
/*******************************************************************************
**
** Function srvc_eng_c_cmpl_cback
**
** Description Client operation complete callback.
**
** Returns void
**
*******************************************************************************/
static void srvc_eng_c_cmpl_cback (UINT16 conn_id, tGATTC_OPTYPE op, tGATT_STATUS status,
tGATT_CL_COMPLETE *p_data)
{
tSRVC_CLCB *p_clcb = srvc_eng_find_clcb_by_conn_id(conn_id);
GATT_TRACE_EVENT ("srvc_eng_c_cmpl_cback() - op_code: 0x%02x status: 0x%02x ", op, status);
if (p_clcb == NULL)
{
GATT_TRACE_ERROR("srvc_eng_c_cmpl_cback received for unknown connection");
return;
}
if (p_clcb->cur_srvc_id != SRVC_ID_NONE &&
p_clcb->cur_srvc_id <= SRVC_ID_MAX)
srvc_eng_c_cmpl_act[p_clcb->cur_srvc_id - 1](p_clcb, op, status, p_data);
}
/*******************************************************************************
**
** Function DIS_ReadDISInfo
**
** Description Read remote device DIS information.
**
** Returns void
**
*******************************************************************************/
BOOLEAN DIS_ReadDISInfo(BD_ADDR peer_bda, tDIS_READ_CBACK *p_cback, tDIS_ATTR_MASK mask)
{
UINT16 conn_id;
/* Initialize the DIS client if it hasn't been initialized already. */
srvc_eng_init();
/* For now we only handle one at a time */
if (dis_cb.dis_read_uuid_idx != 0xff)
return(FALSE);
if (p_cback == NULL)
return(FALSE);
dis_cb.p_read_dis_cback = p_cback;
/* Mark currently active operation */
dis_cb.dis_read_uuid_idx = 0;
dis_cb.request_mask = mask;
GATT_TRACE_EVENT ("DIS_ReadDISInfo() - BDA: %08x%04x cl_read_uuid: 0x%04x",
(peer_bda[0]<<24)+(peer_bda[1]<<16)+(peer_bda[2]<<8)+peer_bda[3],
(peer_bda[4]<<8)+peer_bda[5], dis_attr_uuid[dis_cb.dis_read_uuid_idx]);
GATT_GetConnIdIfConnected(srvc_eng_cb.gatt_if, peer_bda, &conn_id, BT_TRANSPORT_LE);
/* need to enhance it as multiple service is needed */
srvc_eng_request_channel(peer_bda, SRVC_ID_DIS);
if (conn_id == GATT_INVALID_CONN_ID)
{
return GATT_Connect(srvc_eng_cb.gatt_if, peer_bda, TRUE, BT_TRANSPORT_LE);
}
return dis_gatt_c_read_dis_req(conn_id);
}
/*******************************************************************************
**
** Function srvc_eng_connect_cback
**
** Description Gatt profile connection callback.
**
** Returns void
**
*******************************************************************************/
static void srvc_eng_connect_cback (tGATT_IF gatt_if, BD_ADDR bda, UINT16 conn_id,
BOOLEAN connected, tGATT_DISCONN_REASON reason, tBT_TRANSPORT transport)
{
UNUSED(gatt_if);
UNUSED (transport);
GATT_TRACE_EVENT ("srvc_eng_connect_cback: from %08x%04x connected:%d conn_id=%d reason = 0x%04x",
(bda[0]<<24)+(bda[1]<<16)+(bda[2]<<8)+bda[3],
(bda[4]<<8)+bda[5], connected, conn_id, reason);
if (connected)
{
if (srvc_eng_clcb_alloc(conn_id, bda) == NULL)
{
GATT_TRACE_ERROR ("srvc_eng_connect_cback: no_resource");
return;
}
}
else
{
srvc_eng_clcb_dealloc(conn_id);
}
}
/*******************************************************************************
**
** Function dis_c_cmpl_cback
**
** Description Client operation complete callback.
**
** Returns void
**
*******************************************************************************/
void dis_c_cmpl_cback (tSRVC_CLCB *p_clcb, tGATTC_OPTYPE op,
tGATT_STATUS status, tGATT_CL_COMPLETE *p_data)
{
UINT16 read_type = dis_attr_uuid[dis_cb.dis_read_uuid_idx];
UINT8 *pp = NULL, *p_str;
UINT16 conn_id = p_clcb->conn_id;
GATT_TRACE_EVENT ("dis_c_cmpl_cback() - op_code: 0x%02x status: 0x%02x \
read_type: 0x%04x", op, status, read_type);
if (op != GATTC_OPTYPE_READ)
return;
if (p_data != NULL && status == GATT_SUCCESS)
{
pp = p_data->att_value.value;
switch (read_type)
{
case GATT_UUID_SYSTEM_ID:
GATT_TRACE_EVENT ("DIS_ATTR_SYS_ID_BIT");
if (p_data->att_value.len == DIS_SYSTEM_ID_SIZE)
{
p_clcb->dis_value.attr_mask |= DIS_ATTR_SYS_ID_BIT;
/* save system ID*/
STREAM_TO_UINT64 (p_clcb->dis_value.system_id, pp);
}
break;
case GATT_UUID_PNP_ID:
if (p_data->att_value.len == DIS_PNP_ID_SIZE)
{
p_clcb->dis_value.attr_mask |= DIS_ATTR_PNP_ID_BIT;
STREAM_TO_UINT8 (p_clcb->dis_value.pnp_id.vendor_id_src, pp);
STREAM_TO_UINT16 (p_clcb->dis_value.pnp_id.vendor_id, pp);
STREAM_TO_UINT16 (p_clcb->dis_value.pnp_id.product_id, pp);
STREAM_TO_UINT16 (p_clcb->dis_value.pnp_id.product_version, pp);
}
break;
case GATT_UUID_MODEL_NUMBER_STR:
case GATT_UUID_SERIAL_NUMBER_STR:
case GATT_UUID_FW_VERSION_STR:
case GATT_UUID_HW_VERSION_STR:
case GATT_UUID_SW_VERSION_STR:
case GATT_UUID_MANU_NAME:
case GATT_UUID_IEEE_DATA:
p_str = p_clcb->dis_value.data_string[read_type - GATT_UUID_MODEL_NUMBER_STR];
if (p_str != NULL)
GKI_freebuf(p_str);
if ((p_str = (UINT8 *)GKI_getbuf((UINT16)(p_data->att_value.len + 1))) != NULL)
{
p_clcb->dis_value.attr_mask |= dis_uuid_to_attr(read_type);
memcpy(p_str, p_data->att_value.value, p_data->att_value.len);
p_str[p_data->att_value.len] = 0;
p_clcb->dis_value.data_string[read_type - GATT_UUID_MODEL_NUMBER_STR] = p_str;
}
break;
default:
break;
break;
}/* end switch */
}/* end if */
dis_cb.dis_read_uuid_idx ++;
dis_gatt_c_read_dis_req(conn_id);
}
/*******************************************************************************
** DIS Attributes Database Server Request callback
*******************************************************************************/
UINT8 dis_read_attr_value (UINT8 clcb_idx, UINT16 handle, tGATT_VALUE *p_value,
BOOLEAN is_long, tGATT_STATUS *p_status)
{
tDIS_DB_ENTRY *p_db_attr = dis_cb.dis_attr;
UINT8 *p = p_value->value, i, *pp;
UINT16 offset = p_value->offset;
UINT8 act = SRVC_ACT_RSP;
tGATT_STATUS st = GATT_NOT_FOUND;
UNUSED(clcb_idx);
for (i = 0; i < DIS_MAX_CHAR_NUM; i ++, p_db_attr ++)
{
if (handle == p_db_attr->handle)
{
if ((p_db_attr->uuid == GATT_UUID_PNP_ID || p_db_attr->uuid == GATT_UUID_SYSTEM_ID)&&
is_long == TRUE)
{
st = GATT_NOT_LONG;
break;
}
st = GATT_SUCCESS;
switch (p_db_attr->uuid)
{
case GATT_UUID_MANU_NAME:
case GATT_UUID_MODEL_NUMBER_STR:
case GATT_UUID_SERIAL_NUMBER_STR:
case GATT_UUID_FW_VERSION_STR:
case GATT_UUID_HW_VERSION_STR:
case GATT_UUID_SW_VERSION_STR:
case GATT_UUID_IEEE_DATA:
pp = dis_cb.dis_value.data_string[p_db_attr->uuid - GATT_UUID_MODEL_NUMBER_STR];
if (pp != NULL)
{
if (strlen ((char *)pp) > GATT_MAX_ATTR_LEN)
p_value->len = GATT_MAX_ATTR_LEN;
else
p_value->len = (UINT16)strlen ((char *)pp);
}
else
p_value->len = 0;
if (offset > p_value->len)
{
st = GATT_INVALID_OFFSET;
break;
}
else
{
p_value->len -= offset;
pp += offset;
ARRAY_TO_STREAM(p, pp, p_value->len);
GATT_TRACE_EVENT("GATT_UUID_MANU_NAME len=0x%04x", p_value->len);
}
break;
case GATT_UUID_SYSTEM_ID:
UINT64_TO_STREAM(p, dis_cb.dis_value.system_id); /* int_min */
p_value->len = DIS_SYSTEM_ID_SIZE;
break;
case GATT_UUID_PNP_ID:
UINT8_TO_STREAM(p, dis_cb.dis_value.pnp_id.vendor_id_src);
UINT16_TO_STREAM(p, dis_cb.dis_value.pnp_id.vendor_id);
UINT16_TO_STREAM(p, dis_cb.dis_value.pnp_id.product_id);
UINT16_TO_STREAM(p, dis_cb.dis_value.pnp_id.product_version);
p_value->len = DIS_PNP_ID_SIZE;
break;
}
break;
}
}
*p_status = st;
return act;
}
