void create_ext_inquiry_response(const char *name,
int8_t tx_power, uint8_t *data)
{
sdp_list_t *list = sdp_get_record_list();
uint8_t *ptr = data;
uint16_t uuid[24];
int i, index = 0;
if (name) {
int len = strlen(name);
if (len > 48) {
len = 48;
ptr[1] = 0x08;
} else
ptr[1] = 0x09;
ptr[0] = len + 1;
memcpy(ptr + 2, name, len);
ptr += len + 2;
}
if (tx_power != 0) {
*ptr++ = 2;
*ptr++ = 0x0a;
*ptr++ = (uint8_t) tx_power;
}
if (did_vendor != 0x0000) {
uint16_t source = 0x0002;
*ptr++ = 9;
*ptr++ = 0x10;
*ptr++ = (source & 0x00ff);
*ptr++ = (source & 0xff00) >> 8;
*ptr++ = (did_vendor & 0x00ff);
*ptr++ = (did_vendor & 0xff00) >> 8;
*ptr++ = (did_product & 0x00ff);
*ptr++ = (did_product & 0xff00) >> 8;
*ptr++ = (did_version & 0x00ff);
*ptr++ = (did_version & 0xff00) >> 8;
}
static void update_svclass_list(const bdaddr_t *src)
{
sdp_list_t *list = sdp_get_record_list();
uint8_t val = 0;
for (; list; list = list->next) {
sdp_record_t *rec = (sdp_record_t *) list->data;
if (rec->svclass.type != SDP_UUID16)
continue;
switch (rec->svclass.value.uuid16) {
case DIALUP_NET_SVCLASS_ID:
case CIP_SVCLASS_ID:
val |= 0x42; /* Telephony & Networking */
break;
case IRMC_SYNC_SVCLASS_ID:
case OBEX_OBJPUSH_SVCLASS_ID:
case OBEX_FILETRANS_SVCLASS_ID:
case IRMC_SYNC_CMD_SVCLASS_ID:
case PBAP_PSE_SVCLASS_ID:
val |= 0x10; /* Object Transfer */
break;
case HEADSET_SVCLASS_ID:
case HANDSFREE_SVCLASS_ID:
val |= 0x20; /* Audio */
break;
case CORDLESS_TELEPHONY_SVCLASS_ID:
case INTERCOM_SVCLASS_ID:
case FAX_SVCLASS_ID:
case SAP_SVCLASS_ID:
/*
* Setting the telephony bit for the handsfree audio gateway
* role is not required by the HFP specification, but the
* Nokia 616 carkit is just plain broken! It will refuse
* pairing without this bit set.
*/
case HANDSFREE_AGW_SVCLASS_ID:
val |= 0x40; /* Telephony */
break;
case AUDIO_SOURCE_SVCLASS_ID:
case VIDEO_SOURCE_SVCLASS_ID:
val |= 0x08; /* Capturing */
break;
case AUDIO_SINK_SVCLASS_ID:
case VIDEO_SINK_SVCLASS_ID:
val |= 0x04; /* Rendering */
break;
case PANU_SVCLASS_ID:
case NAP_SVCLASS_ID:
case GN_SVCLASS_ID:
val |= 0x02; /* Networking */
break;
}
}
SDPDBG("Service classes 0x%02x", val);
service_classes = val;
manager_update_svc(src, val);
}
/*
* Service search request PDU. This method extracts the search pattern
* (a sequence of UUIDs) and calls the matching function
* to find matching services
*/
static int service_search_req(sdp_req_t *req, sdp_buf_t *buf)
{
int status = 0, i, plen, mlen, mtu, scanned;
sdp_list_t *pattern = NULL;
uint16_t expected, actual, rsp_count = 0;
uint8_t dtd;
sdp_cont_state_t *cstate = NULL;
uint8_t *pCacheBuffer = NULL;
int handleSize = 0;
uint32_t cStateId = 0;
short *pTotalRecordCount, *pCurrentRecordCount;
uint8_t *pdata = req->buf + sizeof(sdp_pdu_hdr_t);
size_t data_left = req->len - sizeof(sdp_pdu_hdr_t);
scanned = extract_des(pdata, data_left, &pattern, &dtd, SDP_TYPE_UUID);
if (scanned == -1) {
status = SDP_INVALID_SYNTAX;
goto done;
}
pdata += scanned;
data_left -= scanned;
plen = ntohs(((sdp_pdu_hdr_t *)(req->buf))->plen);
mlen = scanned + sizeof(uint16_t) + 1;
// ensure we don't read past buffer
if (plen < mlen || plen != mlen + *(uint8_t *)(pdata+sizeof(uint16_t))) {
status = SDP_INVALID_SYNTAX;
goto done;
}
if (data_left < sizeof(uint16_t)) {
status = SDP_INVALID_SYNTAX;
goto done;
}
expected = ntohs(bt_get_unaligned((uint16_t *)pdata));
SDPDBG("Expected count: %d", expected);
SDPDBG("Bytes scanned : %d", scanned);
pdata += sizeof(uint16_t);
data_left -= sizeof(uint16_t);
/*
* Check if continuation state exists, if yes attempt
* to get rsp remainder from cache, else send error
*/
if (sdp_cstate_get(pdata, data_left, &cstate) < 0) {
status = SDP_INVALID_SYNTAX;
goto done;
}
mtu = req->mtu - sizeof(sdp_pdu_hdr_t) - sizeof(uint16_t) - sizeof(uint16_t) - SDP_CONT_STATE_SIZE;
actual = MIN(expected, mtu >> 2);
/* make space in the rsp buffer for total and current record counts */
pdata = buf->data;
/* total service record count = 0 */
pTotalRecordCount = (short *)pdata;
bt_put_unaligned(0, (uint16_t *)pdata);
pdata += sizeof(uint16_t);
buf->data_size += sizeof(uint16_t);
/* current service record count = 0 */
pCurrentRecordCount = (short *)pdata;
bt_put_unaligned(0, (uint16_t *)pdata);
pdata += sizeof(uint16_t);
buf->data_size += sizeof(uint16_t);
if (cstate == NULL) {
/* for every record in the DB, do a pattern search */
sdp_list_t *list = sdp_get_record_list();
handleSize = 0;
for (; list && rsp_count < expected; list = list->next) {
sdp_record_t *rec = (sdp_record_t *) list->data;
SDPDBG("Checking svcRec : 0x%x", rec->handle);
if (sdp_match_uuid(pattern, rec->pattern) > 0 &&
sdp_check_access(rec->handle, &req->device)) {
rsp_count++;
bt_put_unaligned(htonl(rec->handle), (uint32_t *)pdata);
pdata += sizeof(uint32_t);
handleSize += sizeof(uint32_t);
}
}
SDPDBG("Match count: %d", rsp_count);
buf->data_size += handleSize;
bt_put_unaligned(htons(rsp_count), (uint16_t *)pTotalRecordCount);
bt_put_unaligned(htons(rsp_count), (uint16_t *)pCurrentRecordCount);
if (rsp_count > actual) {
/* cache the rsp and generate a continuation state */
cStateId = sdp_cstate_alloc_buf(buf);
/*
* subtract handleSize since we now send only
* a subset of handles
*/
buf->data_size -= handleSize;
} else {
/* NULL continuation state */
sdp_set_cstate_pdu(buf, NULL);
}
}
/* under both the conditions below, the rsp buffer is not built yet */
if (cstate || cStateId > 0) {
short lastIndex = 0;
if (cstate) {
/*
* Get the previous sdp_cont_state_t and obtain
* the cached rsp
*/
sdp_buf_t *pCache = sdp_get_cached_rsp(cstate);
if (pCache) {
pCacheBuffer = pCache->data;
/* get the rsp_count from the cached buffer */
rsp_count = ntohs(bt_get_unaligned((uint16_t *)pCacheBuffer));
/* get index of the last sdp_record_t sent */
lastIndex = cstate->cStateValue.lastIndexSent;
} else {
status = SDP_INVALID_CSTATE;
goto done;
}
} else {
pCacheBuffer = buf->data;
lastIndex = 0;
}
/*
* Set the local buffer pointer to after the
* current record count and increment the cached
* buffer pointer to beyond the counters
*/
pdata = (uint8_t *) pCurrentRecordCount + sizeof(uint16_t);
/* increment beyond the totalCount and the currentCount */
pCacheBuffer += 2 * sizeof(uint16_t);
if (cstate) {
handleSize = 0;
for (i = lastIndex; (i - lastIndex) < actual && i < rsp_count; i++) {
bt_put_unaligned(bt_get_unaligned((uint32_t *)(pCacheBuffer + i * sizeof(uint32_t))), (uint32_t *)pdata);
pdata += sizeof(uint32_t);
handleSize += sizeof(uint32_t);
}
} else {
handleSize = actual << 2;
i = actual;
}
buf->data_size += handleSize;
bt_put_unaligned(htons(rsp_count), (uint16_t *)pTotalRecordCount);
bt_put_unaligned(htons(i - lastIndex), (uint16_t *)pCurrentRecordCount);
if (i == rsp_count) {
/* set "null" continuationState */
sdp_set_cstate_pdu(buf, NULL);
} else {
/*
* there's more: set lastIndexSent to
* the new value and move on
*/
sdp_cont_state_t newState;
SDPDBG("Setting non-NULL sdp_cstate_t");
if (cstate)
memcpy(&newState, cstate, sizeof(sdp_cont_state_t));
else {
memset(&newState, 0, sizeof(sdp_cont_state_t));
newState.timestamp = cStateId;
}
newState.cStateValue.lastIndexSent = i;
sdp_set_cstate_pdu(buf, &newState);
}
}
done:
free(cstate);
if (pattern)
sdp_list_free(pattern, free);
return status;
}
