2016-09-26 09:37:39 -04:00
|
|
|
/******************************************************************************
|
|
|
|
*
|
|
|
|
* 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 SDP utility functions
|
|
|
|
*
|
|
|
|
******************************************************************************/
|
|
|
|
|
|
|
|
#include <stdlib.h>
|
|
|
|
#include <string.h>
|
2017-08-17 09:13:45 -04:00
|
|
|
|
2018-04-08 00:10:50 -04:00
|
|
|
#include "osi/allocator.h"
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2018-04-08 00:10:50 -04:00
|
|
|
#include "common/bt_defs.h"
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2018-04-08 00:10:50 -04:00
|
|
|
#include "stack/bt_types.h"
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2018-04-08 00:10:50 -04:00
|
|
|
#include "stack/l2cdefs.h"
|
|
|
|
#include "stack/hcidefs.h"
|
|
|
|
#include "stack/hcimsgs.h"
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2018-04-08 00:10:50 -04:00
|
|
|
#include "stack/sdp_api.h"
|
2016-09-26 09:37:39 -04:00
|
|
|
#include "sdpint.h"
|
|
|
|
|
2018-04-08 00:10:50 -04:00
|
|
|
#include "stack/btu.h"
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2017-04-17 22:53:43 -04:00
|
|
|
#if (SDP_INCLUDED == TRUE)
|
2016-09-26 09:37:39 -04:00
|
|
|
static const UINT8 sdp_base_uuid[] = {0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x10, 0x00,
|
2016-11-24 13:10:15 -05:00
|
|
|
0x80, 0x00, 0x00, 0x80, 0x5F, 0x9B, 0x34, 0xFB
|
|
|
|
};
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_find_ccb_by_cid
|
|
|
|
**
|
|
|
|
** Description This function searches the CCB table for an entry with the
|
|
|
|
** passed CID.
|
|
|
|
**
|
|
|
|
** Returns the CCB address, or NULL if not found.
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
tCONN_CB *sdpu_find_ccb_by_cid (UINT16 cid)
|
|
|
|
{
|
|
|
|
UINT16 xx;
|
|
|
|
tCONN_CB *p_ccb;
|
|
|
|
|
|
|
|
/* Look through each connection control block */
|
2016-11-24 13:10:15 -05:00
|
|
|
for (xx = 0, p_ccb = sdp_cb.ccb; xx < SDP_MAX_CONNECTIONS; xx++, p_ccb++) {
|
|
|
|
if ((p_ccb->con_state != SDP_STATE_IDLE) && (p_ccb->connection_id == cid)) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (p_ccb);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
/* If here, not found */
|
|
|
|
return (NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_find_ccb_by_db
|
|
|
|
**
|
|
|
|
** Description This function searches the CCB table for an entry with the
|
|
|
|
** passed discovery db.
|
|
|
|
**
|
|
|
|
** Returns the CCB address, or NULL if not found.
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
tCONN_CB *sdpu_find_ccb_by_db (tSDP_DISCOVERY_DB *p_db)
|
|
|
|
{
|
|
|
|
#if SDP_CLIENT_ENABLED == TRUE
|
|
|
|
UINT16 xx;
|
|
|
|
tCONN_CB *p_ccb;
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_db) {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* Look through each connection control block */
|
2016-11-24 13:10:15 -05:00
|
|
|
for (xx = 0, p_ccb = sdp_cb.ccb; xx < SDP_MAX_CONNECTIONS; xx++, p_ccb++) {
|
|
|
|
if ((p_ccb->con_state != SDP_STATE_IDLE) && (p_ccb->p_db == p_db)) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (p_ccb);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
#endif
|
|
|
|
/* If here, not found */
|
|
|
|
return (NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_allocate_ccb
|
|
|
|
**
|
|
|
|
** Description This function allocates a new CCB.
|
|
|
|
**
|
|
|
|
** Returns CCB address, or NULL if none available.
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
tCONN_CB *sdpu_allocate_ccb (void)
|
|
|
|
{
|
|
|
|
UINT16 xx;
|
|
|
|
tCONN_CB *p_ccb;
|
|
|
|
|
|
|
|
/* Look through each connection control block for a free one */
|
2016-11-24 13:10:15 -05:00
|
|
|
for (xx = 0, p_ccb = sdp_cb.ccb; xx < SDP_MAX_CONNECTIONS; xx++, p_ccb++) {
|
|
|
|
if (p_ccb->con_state == SDP_STATE_IDLE) {
|
2018-01-27 06:03:06 -05:00
|
|
|
btu_free_timer(&p_ccb->timer_entry);
|
2016-09-26 09:37:39 -04:00
|
|
|
memset (p_ccb, 0, sizeof (tCONN_CB));
|
|
|
|
|
|
|
|
p_ccb->timer_entry.param = (UINT32) p_ccb;
|
|
|
|
|
|
|
|
return (p_ccb);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
/* If here, no free CCB found */
|
|
|
|
return (NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_release_ccb
|
|
|
|
**
|
|
|
|
** Description This function releases a CCB.
|
|
|
|
**
|
|
|
|
** Returns void
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
void sdpu_release_ccb (tCONN_CB *p_ccb)
|
|
|
|
{
|
2018-01-27 06:03:06 -05:00
|
|
|
/* Ensure timer is stopped and released */
|
|
|
|
btu_free_timer(&p_ccb->timer_entry);
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/* Drop any response pointer we may be holding */
|
|
|
|
p_ccb->con_state = SDP_STATE_IDLE;
|
|
|
|
#if SDP_CLIENT_ENABLED == TRUE
|
|
|
|
p_ccb->is_attr_search = FALSE;
|
|
|
|
#endif
|
|
|
|
|
|
|
|
/* Free the response buffer */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_ccb->rsp_list) {
|
|
|
|
SDP_TRACE_DEBUG("releasing SDP rsp_list\n");
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2017-08-17 09:13:45 -04:00
|
|
|
osi_free(p_ccb->rsp_list);
|
2016-09-26 09:37:39 -04:00
|
|
|
p_ccb->rsp_list = NULL;
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_build_attrib_seq
|
|
|
|
**
|
|
|
|
** Description This function builds an attribute sequence from the list of
|
|
|
|
** passed attributes. It is also passed the address of the output
|
|
|
|
** buffer.
|
|
|
|
**
|
|
|
|
** Returns Pointer to next byte in the output buffer.
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT8 *sdpu_build_attrib_seq (UINT8 *p_out, UINT16 *p_attr, UINT16 num_attrs)
|
|
|
|
{
|
|
|
|
UINT16 xx;
|
|
|
|
|
|
|
|
/* First thing is the data element header. See if the length fits 1 byte */
|
|
|
|
/* If no attributes, assume a 4-byte wildcard */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (!p_attr) {
|
2016-09-26 09:37:39 -04:00
|
|
|
xx = 5;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
xx = num_attrs * 3;
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (xx > 255) {
|
2016-09-26 09:37:39 -04:00
|
|
|
UINT8_TO_BE_STREAM (p_out, (DATA_ELE_SEQ_DESC_TYPE << 3) | SIZE_IN_NEXT_WORD);
|
|
|
|
UINT16_TO_BE_STREAM (p_out, xx);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
UINT8_TO_BE_STREAM (p_out, (DATA_ELE_SEQ_DESC_TYPE << 3) | SIZE_IN_NEXT_BYTE);
|
|
|
|
UINT8_TO_BE_STREAM (p_out, xx);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* If there are no attributes specified, assume caller wants wildcard */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (!p_attr) {
|
2016-09-26 09:37:39 -04:00
|
|
|
UINT8_TO_BE_STREAM (p_out, (UINT_DESC_TYPE << 3) | SIZE_FOUR_BYTES);
|
|
|
|
UINT16_TO_BE_STREAM (p_out, 0);
|
|
|
|
UINT16_TO_BE_STREAM (p_out, 0xFFFF);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* Loop through and put in all the attributes(s) */
|
2016-11-24 13:10:15 -05:00
|
|
|
for (xx = 0; xx < num_attrs; xx++, p_attr++) {
|
2016-09-26 09:37:39 -04:00
|
|
|
UINT8_TO_BE_STREAM (p_out, (UINT_DESC_TYPE << 3) | SIZE_TWO_BYTES);
|
|
|
|
UINT16_TO_BE_STREAM (p_out, *p_attr);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
return (p_out);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_build_attrib_entry
|
|
|
|
**
|
|
|
|
** Description This function builds an attribute entry from the passed
|
|
|
|
** attribute record. It is also passed the address of the output
|
|
|
|
** buffer.
|
|
|
|
**
|
|
|
|
** Returns Pointer to next byte in the output buffer.
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT8 *sdpu_build_attrib_entry (UINT8 *p_out, tSDP_ATTRIBUTE *p_attr)
|
|
|
|
{
|
|
|
|
/* First, store the attribute ID. Goes as a UINT */
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (UINT_DESC_TYPE << 3) | SIZE_TWO_BYTES);
|
|
|
|
UINT16_TO_BE_STREAM (p_out, p_attr->id);
|
|
|
|
|
|
|
|
/* the attribute is in the db record.
|
|
|
|
* assuming the attribute len is less than SDP_MAX_ATTR_LEN */
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (p_attr->type) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case TEXT_STR_DESC_TYPE: /* 4 */
|
|
|
|
case DATA_ELE_SEQ_DESC_TYPE:/* 6 */
|
|
|
|
case DATA_ELE_ALT_DESC_TYPE:/* 7 */
|
|
|
|
case URL_DESC_TYPE: /* 8 */
|
|
|
|
#if (SDP_MAX_ATTR_LEN > 0xFFFF)
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_attr->len > 0xFFFF) {
|
2016-09-26 09:37:39 -04:00
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_IN_NEXT_LONG);
|
|
|
|
UINT32_TO_BE_STREAM (p_out, p_attr->len);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
#endif /* 0xFFFF - 0xFF */
|
2019-03-26 02:46:36 -04:00
|
|
|
{
|
2016-09-26 09:37:39 -04:00
|
|
|
#if (SDP_MAX_ATTR_LEN > 0xFF)
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_attr->len > 0xFF) {
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_IN_NEXT_WORD);
|
|
|
|
UINT16_TO_BE_STREAM (p_out, p_attr->len);
|
|
|
|
} else
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
#endif /* 0xFF and less*/
|
2016-11-24 13:10:15 -05:00
|
|
|
{
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_IN_NEXT_BYTE);
|
|
|
|
UINT8_TO_BE_STREAM (p_out, p_attr->len);
|
|
|
|
}
|
2019-03-26 02:46:36 -04:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
if (p_attr->value_ptr != NULL) {
|
|
|
|
ARRAY_TO_BE_STREAM (p_out, p_attr->value_ptr, (int)p_attr->len);
|
|
|
|
}
|
|
|
|
|
|
|
|
return (p_out);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Now, store the attribute value */
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (p_attr->len) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case 1:
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_ONE_BYTE);
|
|
|
|
break;
|
|
|
|
case 2:
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_TWO_BYTES);
|
|
|
|
break;
|
|
|
|
case 4:
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_FOUR_BYTES);
|
|
|
|
break;
|
|
|
|
case 8:
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_EIGHT_BYTES);
|
|
|
|
break;
|
|
|
|
case 16:
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_SIXTEEN_BYTES);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
UINT8_TO_BE_STREAM (p_out, (p_attr->type << 3) | SIZE_IN_NEXT_BYTE);
|
|
|
|
UINT8_TO_BE_STREAM (p_out, p_attr->len);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
if (p_attr->value_ptr != NULL) {
|
|
|
|
ARRAY_TO_BE_STREAM (p_out, p_attr->value_ptr, (int)p_attr->len);
|
|
|
|
}
|
|
|
|
|
|
|
|
return (p_out);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_build_n_send_error
|
|
|
|
**
|
|
|
|
** Description This function builds and sends an error packet.
|
|
|
|
**
|
|
|
|
** Returns void
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
void sdpu_build_n_send_error (tCONN_CB *p_ccb, UINT16 trans_num, UINT16 error_code, char *p_error_text)
|
|
|
|
{
|
|
|
|
UINT8 *p_rsp, *p_rsp_start, *p_rsp_param_len;
|
|
|
|
UINT16 rsp_param_len;
|
|
|
|
BT_HDR *p_buf;
|
|
|
|
|
|
|
|
|
2016-10-31 00:34:11 -04:00
|
|
|
SDP_TRACE_WARNING ("SDP - sdpu_build_n_send_error code: 0x%x CID: 0x%x\n",
|
2016-11-24 13:10:15 -05:00
|
|
|
error_code, p_ccb->connection_id);
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/* Get a buffer to use to build and send the packet to L2CAP */
|
2017-08-17 09:13:45 -04:00
|
|
|
if ((p_buf = (BT_HDR *)osi_malloc(SDP_DATA_BUF_SIZE)) == NULL) {
|
2016-10-31 00:34:11 -04:00
|
|
|
SDP_TRACE_ERROR ("SDP - no buf for err msg\n");
|
2016-09-26 09:37:39 -04:00
|
|
|
return;
|
|
|
|
}
|
|
|
|
p_buf->offset = L2CAP_MIN_OFFSET;
|
|
|
|
p_rsp = p_rsp_start = (UINT8 *)(p_buf + 1) + L2CAP_MIN_OFFSET;
|
|
|
|
|
|
|
|
UINT8_TO_BE_STREAM (p_rsp, SDP_PDU_ERROR_RESPONSE);
|
|
|
|
UINT16_TO_BE_STREAM (p_rsp, trans_num);
|
|
|
|
|
|
|
|
/* Skip the parameter length, we need to add it at the end */
|
|
|
|
p_rsp_param_len = p_rsp;
|
|
|
|
p_rsp += 2;
|
|
|
|
|
|
|
|
UINT16_TO_BE_STREAM (p_rsp, error_code);
|
|
|
|
|
|
|
|
/* Unplugfest example traces do not have any error text */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_error_text) {
|
2016-09-26 09:37:39 -04:00
|
|
|
ARRAY_TO_BE_STREAM (p_rsp, p_error_text, (int) strlen (p_error_text));
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/* Go back and put the parameter length into the buffer */
|
|
|
|
rsp_param_len = p_rsp - p_rsp_param_len - 2;
|
|
|
|
UINT16_TO_BE_STREAM (p_rsp_param_len, rsp_param_len);
|
|
|
|
|
|
|
|
/* Set the length of the SDP data in the buffer */
|
|
|
|
p_buf->len = p_rsp - p_rsp_start;
|
|
|
|
|
|
|
|
|
|
|
|
/* Send the buffer through L2CAP */
|
|
|
|
L2CA_DataWrite (p_ccb->connection_id, p_buf);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_extract_uid_seq
|
|
|
|
**
|
|
|
|
** Description This function extracts a UUID sequence from the passed input
|
|
|
|
** buffer, and puts it into the passed output list.
|
|
|
|
**
|
|
|
|
** Returns Pointer to next byte in the input buffer after the sequence.
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT8 *sdpu_extract_uid_seq (UINT8 *p, UINT16 param_len, tSDP_UUID_SEQ *p_seq)
|
|
|
|
{
|
|
|
|
UINT8 *p_seq_end;
|
|
|
|
UINT8 descr, type, size;
|
|
|
|
UINT32 seq_len, uuid_len;
|
|
|
|
|
|
|
|
/* Assume none found */
|
|
|
|
p_seq->num_uids = 0;
|
|
|
|
|
|
|
|
/* A UID sequence is composed of a bunch of UIDs. */
|
|
|
|
|
|
|
|
BE_STREAM_TO_UINT8 (descr, p);
|
|
|
|
type = descr >> 3;
|
|
|
|
size = descr & 7;
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (type != DATA_ELE_SEQ_DESC_TYPE) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (size) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case SIZE_TWO_BYTES:
|
|
|
|
seq_len = 2;
|
|
|
|
break;
|
|
|
|
case SIZE_FOUR_BYTES:
|
|
|
|
seq_len = 4;
|
|
|
|
break;
|
|
|
|
case SIZE_SIXTEEN_BYTES:
|
|
|
|
seq_len = 16;
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_BYTE:
|
|
|
|
BE_STREAM_TO_UINT8 (seq_len, p);
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_WORD:
|
|
|
|
BE_STREAM_TO_UINT16 (seq_len, p);
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_LONG:
|
|
|
|
BE_STREAM_TO_UINT32 (seq_len, p);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return (NULL);
|
|
|
|
}
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (seq_len >= param_len) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
p_seq_end = p + seq_len;
|
|
|
|
|
|
|
|
/* Loop through, extracting the UIDs */
|
2016-11-24 13:10:15 -05:00
|
|
|
for ( ; p < p_seq_end ; ) {
|
2016-09-26 09:37:39 -04:00
|
|
|
BE_STREAM_TO_UINT8 (descr, p);
|
|
|
|
type = descr >> 3;
|
|
|
|
size = descr & 7;
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (type != UUID_DESC_TYPE) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (size) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case SIZE_TWO_BYTES:
|
|
|
|
uuid_len = 2;
|
|
|
|
break;
|
|
|
|
case SIZE_FOUR_BYTES:
|
|
|
|
uuid_len = 4;
|
|
|
|
break;
|
|
|
|
case SIZE_SIXTEEN_BYTES:
|
|
|
|
uuid_len = 16;
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_BYTE:
|
|
|
|
BE_STREAM_TO_UINT8 (uuid_len, p);
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_WORD:
|
|
|
|
BE_STREAM_TO_UINT16 (uuid_len, p);
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_LONG:
|
|
|
|
BE_STREAM_TO_UINT32 (uuid_len, p);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return (NULL);
|
|
|
|
}
|
|
|
|
|
|
|
|
/* If UUID length is valid, copy it across */
|
2016-11-24 13:10:15 -05:00
|
|
|
if ((uuid_len == 2) || (uuid_len == 4) || (uuid_len == 16)) {
|
2016-09-26 09:37:39 -04:00
|
|
|
p_seq->uuid_entry[p_seq->num_uids].len = (UINT16) uuid_len;
|
|
|
|
BE_STREAM_TO_ARRAY (p, p_seq->uuid_entry[p_seq->num_uids].value, (int)uuid_len);
|
|
|
|
p_seq->num_uids++;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/* We can only do so many */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_seq->num_uids >= MAX_UUIDS_PER_SEQ) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p != p_seq_end) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
return (p);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_extract_attr_seq
|
|
|
|
**
|
|
|
|
** Description This function extracts an attribute sequence from the passed
|
|
|
|
** input buffer, and puts it into the passed output list.
|
|
|
|
**
|
|
|
|
** Returns Pointer to next byte in the input buffer after the sequence.
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT8 *sdpu_extract_attr_seq (UINT8 *p, UINT16 param_len, tSDP_ATTR_SEQ *p_seq)
|
|
|
|
{
|
|
|
|
UINT8 *p_end_list;
|
|
|
|
UINT8 descr, type, size;
|
|
|
|
UINT32 list_len, attr_len;
|
|
|
|
|
|
|
|
/* Assume none found */
|
|
|
|
p_seq->num_attr = 0;
|
|
|
|
|
|
|
|
/* Get attribute sequence info */
|
|
|
|
BE_STREAM_TO_UINT8 (descr, p);
|
|
|
|
type = descr >> 3;
|
|
|
|
size = descr & 7;
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (type != DATA_ELE_SEQ_DESC_TYPE) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (p);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (size) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case SIZE_IN_NEXT_BYTE:
|
|
|
|
BE_STREAM_TO_UINT8 (list_len, p);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case SIZE_IN_NEXT_WORD:
|
|
|
|
BE_STREAM_TO_UINT16 (list_len, p);
|
|
|
|
break;
|
|
|
|
|
|
|
|
case SIZE_IN_NEXT_LONG:
|
|
|
|
BE_STREAM_TO_UINT32 (list_len, p);
|
|
|
|
break;
|
|
|
|
|
|
|
|
default:
|
|
|
|
return (p);
|
|
|
|
}
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (list_len > param_len) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (p);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
p_end_list = p + list_len;
|
|
|
|
|
|
|
|
/* Loop through, extracting the attribute IDs */
|
2016-11-24 13:10:15 -05:00
|
|
|
for ( ; p < p_end_list ; ) {
|
2016-09-26 09:37:39 -04:00
|
|
|
BE_STREAM_TO_UINT8 (descr, p);
|
|
|
|
type = descr >> 3;
|
|
|
|
size = descr & 7;
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (type != UINT_DESC_TYPE) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (p);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (size) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case SIZE_TWO_BYTES:
|
|
|
|
attr_len = 2;
|
|
|
|
break;
|
|
|
|
case SIZE_FOUR_BYTES:
|
|
|
|
attr_len = 4;
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_BYTE:
|
|
|
|
BE_STREAM_TO_UINT8 (attr_len, p);
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_WORD:
|
|
|
|
BE_STREAM_TO_UINT16 (attr_len, p);
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_LONG:
|
|
|
|
BE_STREAM_TO_UINT32 (attr_len, p);
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
return (NULL);
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* Attribute length must be 2-bytes or 4-bytes for a paired entry. */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (attr_len == 2) {
|
2016-09-26 09:37:39 -04:00
|
|
|
BE_STREAM_TO_UINT16 (p_seq->attr_entry[p_seq->num_attr].start, p);
|
|
|
|
p_seq->attr_entry[p_seq->num_attr].end = p_seq->attr_entry[p_seq->num_attr].start;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else if (attr_len == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
BE_STREAM_TO_UINT16 (p_seq->attr_entry[p_seq->num_attr].start, p);
|
|
|
|
BE_STREAM_TO_UINT16 (p_seq->attr_entry[p_seq->num_attr].end, p);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/* We can only do so many */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (++p_seq->num_attr >= MAX_ATTR_PER_SEQ) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (NULL);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
return (p);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_get_len_from_type
|
|
|
|
**
|
|
|
|
** Description This function gets the length
|
|
|
|
**
|
|
|
|
** Returns void
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT8 *sdpu_get_len_from_type (UINT8 *p, UINT8 type, UINT32 *p_len)
|
|
|
|
{
|
|
|
|
UINT8 u8;
|
|
|
|
UINT16 u16;
|
|
|
|
UINT32 u32;
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (type & 7) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case SIZE_ONE_BYTE:
|
|
|
|
*p_len = 1;
|
|
|
|
break;
|
|
|
|
case SIZE_TWO_BYTES:
|
|
|
|
*p_len = 2;
|
|
|
|
break;
|
|
|
|
case SIZE_FOUR_BYTES:
|
|
|
|
*p_len = 4;
|
|
|
|
break;
|
|
|
|
case SIZE_EIGHT_BYTES:
|
|
|
|
*p_len = 8;
|
|
|
|
break;
|
|
|
|
case SIZE_SIXTEEN_BYTES:
|
|
|
|
*p_len = 16;
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_BYTE:
|
|
|
|
BE_STREAM_TO_UINT8 (u8, p);
|
|
|
|
*p_len = u8;
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_WORD:
|
|
|
|
BE_STREAM_TO_UINT16 (u16, p);
|
|
|
|
*p_len = u16;
|
|
|
|
break;
|
|
|
|
case SIZE_IN_NEXT_LONG:
|
|
|
|
BE_STREAM_TO_UINT32 (u32, p);
|
|
|
|
*p_len = (UINT16) u32;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
return (p);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_is_base_uuid
|
|
|
|
**
|
|
|
|
** Description This function checks a 128-bit UUID with the base to see if
|
|
|
|
** it matches. Only the last 12 bytes are compared.
|
|
|
|
**
|
|
|
|
** Returns TRUE if matched, else FALSE
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
BOOLEAN sdpu_is_base_uuid (UINT8 *p_uuid)
|
|
|
|
{
|
|
|
|
UINT16 xx;
|
|
|
|
|
|
|
|
for (xx = 4; xx < MAX_UUID_SIZE; xx++)
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_uuid[xx] != sdp_base_uuid[xx]) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (FALSE);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/* If here, matched */
|
|
|
|
return (TRUE);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_compare_uuid_arrays
|
|
|
|
**
|
|
|
|
** Description This function compares 2 BE UUIDs. If needed, they are expanded
|
|
|
|
** to 128-bit UUIDs, then compared.
|
|
|
|
**
|
|
|
|
** NOTE it is assumed that the arrays are in Big Endian format
|
|
|
|
**
|
|
|
|
** Returns TRUE if matched, else FALSE
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
BOOLEAN sdpu_compare_uuid_arrays (UINT8 *p_uuid1, UINT32 len1, UINT8 *p_uuid2, UINT16 len2)
|
|
|
|
{
|
|
|
|
UINT8 nu1[MAX_UUID_SIZE];
|
|
|
|
UINT8 nu2[MAX_UUID_SIZE];
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if ( ((len1 != 2) && (len1 != 4) && (len1 != 16)) ||
|
|
|
|
((len2 != 2) && (len2 != 4) && (len2 != 16)) ) {
|
2016-10-31 00:34:11 -04:00
|
|
|
SDP_TRACE_ERROR("%s: invalid length\n", __func__);
|
2016-09-26 09:37:39 -04:00
|
|
|
return FALSE;
|
|
|
|
}
|
|
|
|
|
|
|
|
/* If lengths match, do a straight compare */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (len1 == len2) {
|
|
|
|
if (len1 == 2) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return ((p_uuid1[0] == p_uuid2[0]) && (p_uuid1[1] == p_uuid2[1]));
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2019-03-26 02:46:36 -04:00
|
|
|
if (len1 == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return ( (p_uuid1[0] == p_uuid2[0]) && (p_uuid1[1] == p_uuid2[1])
|
2016-11-24 13:10:15 -05:00
|
|
|
&& (p_uuid1[2] == p_uuid2[2]) && (p_uuid1[3] == p_uuid2[3]) );
|
2019-03-26 02:46:36 -04:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (memcmp (p_uuid1, p_uuid2, (size_t)len1) == 0);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
|
|
|
} else if (len1 > len2) {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* If the len1 was 4-byte, (so len2 is 2-byte), compare on the fly */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (len1 == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return ( (p_uuid1[0] == 0) && (p_uuid1[1] == 0)
|
2016-11-24 13:10:15 -05:00
|
|
|
&& (p_uuid1[2] == p_uuid2[0]) && (p_uuid1[3] == p_uuid2[1]) );
|
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* Normalize UUIDs to 16-byte form, then compare. Len1 must be 16 */
|
|
|
|
memcpy (nu1, p_uuid1, MAX_UUID_SIZE);
|
|
|
|
memcpy (nu2, sdp_base_uuid, MAX_UUID_SIZE);
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (len2 == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
memcpy (nu2, p_uuid2, len2);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else if (len2 == 2) {
|
2016-09-26 09:37:39 -04:00
|
|
|
memcpy (nu2 + 2, p_uuid2, len2);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
return (memcmp (nu1, nu2, MAX_UUID_SIZE) == 0);
|
|
|
|
}
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* len2 is greater than len1 */
|
|
|
|
/* If the len2 was 4-byte, (so len1 is 2-byte), compare on the fly */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (len2 == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return ( (p_uuid2[0] == 0) && (p_uuid2[1] == 0)
|
2016-11-24 13:10:15 -05:00
|
|
|
&& (p_uuid2[2] == p_uuid1[0]) && (p_uuid2[3] == p_uuid1[1]) );
|
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* Normalize UUIDs to 16-byte form, then compare. Len1 must be 16 */
|
|
|
|
memcpy (nu2, p_uuid2, MAX_UUID_SIZE);
|
|
|
|
memcpy (nu1, sdp_base_uuid, MAX_UUID_SIZE);
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (len1 == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
memcpy (nu1, p_uuid1, (size_t)len1);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else if (len1 == 2) {
|
2016-09-26 09:37:39 -04:00
|
|
|
memcpy (nu1 + 2, p_uuid1, (size_t)len1);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
return (memcmp (nu1, nu2, MAX_UUID_SIZE) == 0);
|
|
|
|
}
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_compare_bt_uuids
|
|
|
|
**
|
|
|
|
** Description This function compares 2 BT UUID structures.
|
|
|
|
**
|
|
|
|
** NOTE it is assumed that BT UUID structures are compressed to the
|
|
|
|
** smallest possible UUIDs (by removing the base SDP UUID)
|
|
|
|
**
|
|
|
|
** Returns TRUE if matched, else FALSE
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
BOOLEAN sdpu_compare_bt_uuids (tBT_UUID *p_uuid1, tBT_UUID *p_uuid2)
|
|
|
|
{
|
|
|
|
/* Lengths must match for BT UUIDs to match */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_uuid1->len == p_uuid2->len) {
|
|
|
|
if (p_uuid1->len == 2) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (p_uuid1->uu.uuid16 == p_uuid2->uu.uuid16);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else if (p_uuid1->len == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (p_uuid1->uu.uuid32 == p_uuid2->uu.uuid32);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else if (!memcmp (p_uuid1->uu.uuid128, p_uuid2->uu.uuid128, 16)) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (TRUE);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
|
|
|
|
return (FALSE);
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_compare_uuid_with_attr
|
|
|
|
**
|
|
|
|
** Description This function compares a BT UUID structure with the UUID in an
|
|
|
|
** SDP attribute record. If needed, they are expanded to 128-bit
|
|
|
|
** UUIDs, then compared.
|
|
|
|
**
|
|
|
|
** NOTE - it is assumed that BT UUID structures are compressed to the
|
|
|
|
** smallest possible UUIDs (by removing the base SDP UUID).
|
|
|
|
** - it is also assumed that the discovery atribute is compressed
|
|
|
|
** to the smallest possible
|
|
|
|
**
|
|
|
|
** Returns TRUE if matched, else FALSE
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
BOOLEAN sdpu_compare_uuid_with_attr (tBT_UUID *p_btuuid, tSDP_DISC_ATTR *p_attr)
|
|
|
|
{
|
|
|
|
UINT16 attr_len = SDP_DISC_ATTR_LEN (p_attr->attr_len_type);
|
|
|
|
|
|
|
|
/* Since both UUIDs are compressed, lengths must match */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_btuuid->len != attr_len) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (FALSE);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_btuuid->len == 2) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (BOOLEAN)(p_btuuid->uu.uuid16 == p_attr->attr_value.v.u16);
|
2016-11-24 13:10:15 -05:00
|
|
|
} else if (p_btuuid->len == 4) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (BOOLEAN)(p_btuuid->uu.uuid32 == p_attr->attr_value.v.u32);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
/* coverity[overrun-buffer-arg] */
|
|
|
|
/*
|
|
|
|
Event overrun-buffer-arg: Overrun of static array "&p_attr->attr_value.v.array" of size 4 bytes by passing it to a function which indexes it with argument "16U" at byte position 15
|
|
|
|
FALSE-POSITIVE error from Coverity test tool. Please do NOT remove following comment.
|
|
|
|
False-positive: SDP uses scratch buffer to hold the attribute value.
|
|
|
|
The actual size of tSDP_DISC_ATVAL does not matter.
|
|
|
|
If the array size in tSDP_DISC_ATVAL is increase, we would increase the system RAM usage unnecessarily
|
|
|
|
*/
|
2016-11-24 13:10:15 -05:00
|
|
|
else if (!memcmp (p_btuuid->uu.uuid128, (void *) p_attr->attr_value.v.array, MAX_UUID_SIZE)) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return (TRUE);
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
return (FALSE);
|
|
|
|
}
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_sort_attr_list
|
|
|
|
**
|
|
|
|
** Description sorts a list of attributes in numeric order from lowest to
|
|
|
|
** highest to conform to SDP specification
|
|
|
|
**
|
|
|
|
** Returns void
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
void sdpu_sort_attr_list( UINT16 num_attr, tSDP_DISCOVERY_DB *p_db )
|
|
|
|
{
|
|
|
|
UINT16 i;
|
|
|
|
UINT16 x;
|
|
|
|
|
|
|
|
/* Done if no attributes to sort */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (num_attr <= 1) {
|
2016-09-26 09:37:39 -04:00
|
|
|
return;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else if (num_attr > SDP_MAX_ATTR_FILTERS) {
|
2016-09-26 09:37:39 -04:00
|
|
|
num_attr = SDP_MAX_ATTR_FILTERS;
|
|
|
|
}
|
|
|
|
|
|
|
|
num_attr--; /* for the for-loop */
|
2016-11-24 13:10:15 -05:00
|
|
|
for ( i = 0; i < num_attr; ) {
|
|
|
|
if ( p_db->attr_filters[i] > p_db->attr_filters[i + 1] ) {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* swap the attribute IDs and start from the beginning */
|
|
|
|
x = p_db->attr_filters[i];
|
2016-11-24 13:10:15 -05:00
|
|
|
p_db->attr_filters[i] = p_db->attr_filters[i + 1];
|
|
|
|
p_db->attr_filters[i + 1] = x;
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
i = 0;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
i++;
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_get_list_len
|
|
|
|
**
|
|
|
|
** Description gets the total list length in the sdp database for a given
|
|
|
|
** uid sequence and attr sequence
|
|
|
|
**
|
|
|
|
** Returns void
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT16 sdpu_get_list_len(tSDP_UUID_SEQ *uid_seq, tSDP_ATTR_SEQ *attr_seq)
|
|
|
|
{
|
|
|
|
tSDP_RECORD *p_rec;
|
|
|
|
UINT16 len = 0;
|
|
|
|
UINT16 len1;
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
for (p_rec = sdp_db_service_search (NULL, uid_seq); p_rec; p_rec = sdp_db_service_search (p_rec, uid_seq)) {
|
2016-09-26 09:37:39 -04:00
|
|
|
len += 3;
|
|
|
|
|
|
|
|
len1 = sdpu_get_attrib_seq_len(p_rec, attr_seq );
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
if (len1 != 0) {
|
2016-09-26 09:37:39 -04:00
|
|
|
len += len1;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
len -= 3;
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_get_attrib_seq_len
|
|
|
|
**
|
|
|
|
** Description gets the length of the specific attributes in a given
|
|
|
|
** sdp record
|
|
|
|
**
|
|
|
|
** Returns void
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT16 sdpu_get_attrib_seq_len(tSDP_RECORD *p_rec, tSDP_ATTR_SEQ *attr_seq)
|
|
|
|
{
|
|
|
|
tSDP_ATTRIBUTE *p_attr;
|
|
|
|
UINT16 len1 = 0;
|
|
|
|
UINT16 xx;
|
|
|
|
BOOLEAN is_range = FALSE;
|
2016-11-24 13:10:15 -05:00
|
|
|
UINT16 start_id = 0, end_id = 0;
|
2016-09-26 09:37:39 -04:00
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
for (xx = 0; xx < attr_seq->num_attr; xx++) {
|
|
|
|
if (is_range == FALSE) {
|
2016-09-26 09:37:39 -04:00
|
|
|
start_id = attr_seq->attr_entry[xx].start;
|
|
|
|
end_id = attr_seq->attr_entry[xx].end;
|
|
|
|
}
|
|
|
|
p_attr = sdp_db_find_attr_in_rec (p_rec,
|
|
|
|
start_id,
|
|
|
|
end_id);
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_attr) {
|
2016-09-26 09:37:39 -04:00
|
|
|
len1 += sdpu_get_attrib_entry_len (p_attr);
|
|
|
|
|
|
|
|
/* If doing a range, stick with this one till no more attributes found */
|
2016-11-24 13:10:15 -05:00
|
|
|
if (start_id != end_id) {
|
2016-09-26 09:37:39 -04:00
|
|
|
/* Update for next time through */
|
|
|
|
start_id = p_attr->id + 1;
|
|
|
|
xx--;
|
|
|
|
is_range = TRUE;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
is_range = FALSE;
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
|
|
|
} else {
|
2016-09-26 09:37:39 -04:00
|
|
|
is_range = FALSE;
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
|
|
|
return len1;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_get_attrib_entry_len
|
|
|
|
**
|
|
|
|
** Description gets the length of a specific attribute
|
|
|
|
**
|
|
|
|
** Returns void
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT16 sdpu_get_attrib_entry_len(tSDP_ATTRIBUTE *p_attr)
|
|
|
|
{
|
|
|
|
UINT16 len = 3;
|
|
|
|
|
|
|
|
/* the attribute is in the db record.
|
|
|
|
* assuming the attribute len is less than SDP_MAX_ATTR_LEN */
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (p_attr->type) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case TEXT_STR_DESC_TYPE: /* 4 */
|
|
|
|
case DATA_ELE_SEQ_DESC_TYPE:/* 6 */
|
|
|
|
case DATA_ELE_ALT_DESC_TYPE:/* 7 */
|
|
|
|
case URL_DESC_TYPE: /* 8 */
|
|
|
|
#if (SDP_MAX_ATTR_LEN > 0xFFFF)
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_attr->len > 0xFFFF) {
|
2016-09-26 09:37:39 -04:00
|
|
|
len += 5;
|
2016-11-24 13:10:15 -05:00
|
|
|
} else
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
#endif/* 0xFFFF - 0xFF */
|
2019-03-26 02:46:36 -04:00
|
|
|
{
|
2016-09-26 09:37:39 -04:00
|
|
|
#if (SDP_MAX_ATTR_LEN > 0xFF)
|
2016-11-24 13:10:15 -05:00
|
|
|
if (p_attr->len > 0xFF) {
|
|
|
|
len += 3;
|
|
|
|
} else
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
#endif /* 0xFF and less*/
|
2016-11-24 13:10:15 -05:00
|
|
|
{
|
|
|
|
len += 2;
|
|
|
|
}
|
2019-03-26 02:46:36 -04:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
len += p_attr->len;
|
|
|
|
return len;
|
2016-11-24 13:10:15 -05:00
|
|
|
}
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
/* Now, the attribute value */
|
2016-11-24 13:10:15 -05:00
|
|
|
switch (p_attr->len) {
|
2016-09-26 09:37:39 -04:00
|
|
|
case 1:
|
|
|
|
case 2:
|
|
|
|
case 4:
|
|
|
|
case 8:
|
|
|
|
case 16:
|
|
|
|
len += 1;
|
|
|
|
break;
|
|
|
|
default:
|
|
|
|
len += 2;
|
|
|
|
break;
|
|
|
|
}
|
|
|
|
|
|
|
|
len += p_attr->len;
|
|
|
|
return len;
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_build_partial_attrib_entry
|
|
|
|
**
|
|
|
|
** Description This function fills a buffer with partial attribute. It is
|
|
|
|
** assumed that the maximum size of any attribute is 256 bytes.
|
|
|
|
**
|
|
|
|
** p_out: output buffer
|
|
|
|
** p_attr: attribute to be copied partially into p_out
|
|
|
|
** rem_len: num bytes to copy into p_out
|
|
|
|
** offset: current start offset within the attr that needs to be copied
|
|
|
|
**
|
|
|
|
** Returns Pointer to next byte in the output buffer.
|
|
|
|
** offset is also updated
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
UINT8 *sdpu_build_partial_attrib_entry (UINT8 *p_out, tSDP_ATTRIBUTE *p_attr, UINT16 len, UINT16 *offset)
|
|
|
|
{
|
|
|
|
UINT8 *p_attr_buff;
|
|
|
|
UINT8 *p_tmp_attr;
|
|
|
|
size_t len_to_copy;
|
|
|
|
UINT16 attr_len;
|
|
|
|
|
2017-08-17 09:13:45 -04:00
|
|
|
if ((p_attr_buff = (UINT8 *) osi_malloc(sizeof(UINT8) * SDP_MAX_ATTR_LEN )) == NULL) {
|
2016-10-31 00:34:11 -04:00
|
|
|
SDP_TRACE_ERROR("sdpu_build_partial_attrib_entry cannot get a buffer!\n");
|
2016-09-26 09:37:39 -04:00
|
|
|
return NULL;
|
|
|
|
}
|
|
|
|
p_tmp_attr = p_attr_buff;
|
|
|
|
|
|
|
|
sdpu_build_attrib_entry(p_tmp_attr, p_attr);
|
|
|
|
attr_len = sdpu_get_attrib_entry_len(p_attr);
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
len_to_copy = ((attr_len - *offset) < len) ? (attr_len - *offset) : len;
|
2016-09-26 09:37:39 -04:00
|
|
|
|
|
|
|
memcpy(p_out, &p_attr_buff[*offset], len_to_copy);
|
|
|
|
|
|
|
|
p_out = &p_out[len_to_copy];
|
|
|
|
*offset += len_to_copy;
|
|
|
|
|
2017-08-17 09:13:45 -04:00
|
|
|
osi_free(p_attr_buff);
|
2016-09-26 09:37:39 -04:00
|
|
|
return p_out;
|
|
|
|
}
|
|
|
|
|
|
|
|
/*******************************************************************************
|
|
|
|
**
|
|
|
|
** Function sdpu_uuid16_to_uuid128
|
|
|
|
**
|
|
|
|
** Description This function converts UUID-16 to UUID-128 by including the base UUID
|
|
|
|
**
|
|
|
|
** uuid16: 2-byte UUID
|
|
|
|
** p_uuid128: Expanded 128-bit UUID
|
|
|
|
**
|
|
|
|
** Returns None
|
|
|
|
**
|
|
|
|
*******************************************************************************/
|
|
|
|
|
2016-11-24 13:10:15 -05:00
|
|
|
void sdpu_uuid16_to_uuid128(UINT16 uuid16, UINT8 *p_uuid128)
|
2016-09-26 09:37:39 -04:00
|
|
|
{
|
|
|
|
UINT16 uuid16_bo;
|
|
|
|
memset(p_uuid128, 0, 16);
|
|
|
|
|
|
|
|
memcpy(p_uuid128, sdp_base_uuid, MAX_UUID_SIZE);
|
|
|
|
uuid16_bo = ntohs(uuid16);
|
2016-11-24 13:10:15 -05:00
|
|
|
memcpy(p_uuid128 + 2, &uuid16_bo, sizeof(uint16_t));
|
2016-09-26 09:37:39 -04:00
|
|
|
}
|
2017-04-17 22:53:43 -04:00
|
|
|
|
2017-08-17 09:13:45 -04:00
|
|
|
#endif ///SDP_INCLUDED == TRUE
|