JNIEXPORT jbyteArray JNICALL Java_com_intel_bluetooth_BluetoothStackBlueZNativeTests_testServiceRecordConvert
(JNIEnv *env, jclass peer, jbyteArray record) {
int length = (*env)->GetArrayLength(env, record);
jbyte *bytes = (*env)->GetByteArrayElements(env, record, 0);
int length_scanned = length;
sdp_record_t *rec = bluecove_sdp_extract_pdu(env, bytes, length, &length_scanned);
if(!rec) {
return NULL;
}
debug("pdu scanned %i -> %i", length, length_scanned);
if (rec == NULL) {
throwServiceRegistrationException(env, "Can not convert SDP record. [%d] %s", errno, strerror(errno));
(*env)->ReleaseByteArrayElements(env, record, bytes, 0);
return NULL;
}
debugServiceRecord(env, rec);
sdp_buf_t pdu;
sdp_gen_record_pdu(rec, &pdu);
debug("pdu.data_size %i -> %i", length, pdu.data_size);
// construct byte array to hold pdu
jbyteArray result = (*env)->NewByteArray(env, pdu.data_size);
jbyte *result_bytes = (*env)->GetByteArrayElements(env, result, 0);
memcpy(result_bytes, pdu.data, pdu.data_size);
(*env)->ReleaseByteArrayElements(env, result, result_bytes, 0);
free(pdu.data);
(*env)->ReleaseByteArrayElements(env, record, bytes, 0);
return result;
}
/*
* Extract attribute identifiers from the request PDU.
* Clients could request a subset of attributes (by id)
* from a service record, instead of the whole set. The
* requested identifiers are present in the PDU form of
* the request
*/
static int extract_attrs(sdp_record_t *rec, sdp_list_t *seq, sdp_buf_t *buf)
{
sdp_buf_t pdu;
if (!rec)
return SDP_INVALID_RECORD_HANDLE;
if (seq) {
SDPDBG("Entries in attr seq : %d", sdp_list_len(seq));
} else {
SDPDBG("NULL attribute descriptor");
}
if (seq == NULL) {
SDPDBG("Attribute sequence is NULL");
return 0;
}
sdp_gen_record_pdu(rec, &pdu);
for (; seq; seq = seq->next) {
struct attrid *aid = seq->data;
SDPDBG("AttrDataType : %d", aid->dtd);
if (aid->dtd == SDP_UINT16) {
uint16_t attr = bt_get_unaligned((uint16_t *)&aid->uint16);
sdp_data_t *a = (sdp_data_t *)sdp_data_get(rec, attr);
if (a)
sdp_append_to_pdu(buf, a);
} else if (aid->dtd == SDP_UINT32) {
uint32_t range = bt_get_unaligned((uint32_t *)&aid->uint32);
uint16_t attr;
uint16_t low = (0xffff0000 & range) >> 16;
uint16_t high = 0x0000ffff & range;
sdp_data_t *data;
SDPDBG("attr range : 0x%x", range);
SDPDBG("Low id : 0x%x", low);
SDPDBG("High id : 0x%x", high);
if (low == 0x0000 && high == 0xffff && pdu.data_size <= buf->buf_size) {
/* copy it */
memcpy(buf->data, pdu.data, pdu.data_size);
buf->data_size = pdu.data_size;
break;
}
/* (else) sub-range of attributes */
for (attr = low; attr < high; attr++) {
data = sdp_data_get(rec, attr);
if (data)
sdp_append_to_pdu(buf, data);
}
data = sdp_data_get(rec, high);
if (data)
sdp_append_to_pdu(buf, data);
} else {
/*
* Extract attribute identifiers from the request PDU.
* Clients could request a subset of attributes (by id)
* from a service record, instead of the whole set. The
* requested identifiers are present in the PDU form of
* the request
*/
static int extract_attrs(sdp_record_t *rec, sdp_list_t *seq, uint8_t dtd, sdp_buf_t *buf)
{
if (!rec)
return SDP_INVALID_RECORD_HANDLE;
#ifdef SDP_DEBUG
if (seq)
SDPDBG("Entries in attr seq : %d\n", sdp_list_len(seq));
else
SDPDBG("NULL attribute descriptor\n");
SDPDBG("AttrDataType : %d\n", dtd);
#endif
if (seq == NULL) {
SDPDBG("Attribute sequence is NULL\n");
return 0;
}
if (dtd == SDP_UINT16)
for (; seq; seq = seq->next) {
uint16_t attr = sdp_get_unaligned((uint16_t *)seq->data);
sdp_data_t *a = (sdp_data_t *)sdp_data_get(rec, attr);
if (a)
sdp_append_to_pdu(buf, a);
}
else if (dtd == SDP_UINT32) {
sdp_buf_t pdu;
sdp_gen_record_pdu(rec, &pdu);
for (; seq; seq = seq->next) {
uint32_t range = sdp_get_unaligned((uint32_t *)seq->data);
uint16_t attr;
uint16_t low = (0xffff0000 & range) >> 16;
uint16_t high = 0x0000ffff & range;
SDPDBG("attr range : 0x%x\n", range);
SDPDBG("Low id : 0x%x\n", low);
SDPDBG("High id : 0x%x\n", high);
if (low == 0x0000 && high == 0xffff && pdu.data_size <= buf->buf_size) {
/* copy it */
memcpy(buf->data, pdu.data, pdu.data_size);
buf->data_size = pdu.data_size;
break;
}
/* (else) sub-range of attributes */
for (attr = low; attr <= high; attr++) {
sdp_data_t *a = (sdp_data_t *)sdp_data_get(rec, attr);
if (a)
sdp_append_to_pdu(buf, a);
}
}
free(pdu.data);
} else {
