3 * BlueZ - Bluetooth protocol stack for Linux
5 * Copyright (C) 2003-2010 Marcel Holtmann <marcel@holtmann.org>
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA
35 #include <sys/socket.h>
37 #include <bluetooth/bluetooth.h>
38 #include <bluetooth/l2cap.h>
39 #include <bluetooth/sdp.h>
40 #include <bluetooth/sdp_lib.h>
41 #include <bluetooth/hidp.h>
42 #include <bluetooth/bnep.h>
47 static sdp_record_t *record = NULL;
48 static sdp_session_t *session = NULL;
50 static void add_lang_attr(sdp_record_t *r)
52 sdp_lang_attr_t base_lang;
53 sdp_list_t *langs = 0;
55 /* UTF-8 MIBenum (http://www.iana.org/assignments/character-sets) */
56 base_lang.code_ISO639 = (0x65 << 8) | 0x6e;
57 base_lang.encoding = 106;
58 base_lang.base_offset = SDP_PRIMARY_LANG_BASE;
59 langs = sdp_list_append(0, &base_lang);
60 sdp_set_lang_attr(r, langs);
61 sdp_list_free(langs, 0);
64 static void epox_endian_quirk(unsigned char *data, int size)
66 /* USAGE_PAGE (Keyboard) 05 07
67 * USAGE_MINIMUM (0) 19 00
68 * USAGE_MAXIMUM (65280) 2A 00 FF <= must be FF 00
69 * LOGICAL_MINIMUM (0) 15 00
70 * LOGICAL_MAXIMUM (65280) 26 00 FF <= must be FF 00
72 unsigned char pattern[] = { 0x05, 0x07, 0x19, 0x00, 0x2a, 0x00, 0xff,
73 0x15, 0x00, 0x26, 0x00, 0xff };
79 for (i = 0; i < size - sizeof(pattern); i++) {
80 if (!memcmp(data + i, pattern, sizeof(pattern))) {
89 static int store_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req)
91 char filename[PATH_MAX + 1], addr[18], *str, *desc;
95 create_name(filename, PATH_MAX, STORAGEDIR, addr, "hidd");
97 size = 15 + 3 + 3 + 5 + (req->rd_size * 2) + 1 + 9 + strlen(req->name) + 2;
102 desc = malloc((req->rd_size * 2) + 1);
108 memset(desc, 0, (req->rd_size * 2) + 1);
109 for (i = 0; i < req->rd_size; i++)
110 sprintf(desc + (i * 2), "%2.2X", req->rd_data[i]);
112 snprintf(str, size - 1, "%04X:%04X:%04X %02X %02X %04X %s %08X %s",
113 req->vendor, req->product, req->version,
114 req->subclass, req->country, req->parser, desc,
115 req->flags, req->name);
119 create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH);
122 err = textfile_put(filename, addr, str);
129 int get_stored_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req)
131 char filename[PATH_MAX + 1], addr[18], tmp[3], *str, *desc;
132 unsigned int vendor, product, version, subclass, country, parser, pos;
139 memset(desc, 0, 4096);
142 create_name(filename, PATH_MAX, STORAGEDIR, addr, "hidd");
145 str = textfile_get(filename, addr);
151 sscanf(str, "%04X:%04X:%04X %02X %02X %04X %4095s %08X %n",
152 &vendor, &product, &version, &subclass, &country,
153 &parser, desc, &req->flags, &pos);
156 req->vendor = vendor;
157 req->product = product;
158 req->version = version;
159 req->subclass = subclass;
160 req->country = country;
161 req->parser = parser;
163 snprintf(req->name, 128, "%s", str + pos);
166 req->rd_size = strlen(desc) / 2;
167 req->rd_data = malloc(req->rd_size);
173 memset(tmp, 0, sizeof(tmp));
174 for (i = 0; i < req->rd_size; i++) {
175 memcpy(tmp, desc + (i * 2), 2);
176 req->rd_data[i] = (uint8_t) strtol(tmp, NULL, 16);
184 int get_sdp_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req)
186 struct sockaddr_l2 addr;
189 uint32_t range = 0x0000ffff;
191 sdp_list_t *search, *attrid, *pnp_rsp, *hid_rsp;
193 sdp_data_t *pdlist, *pdlist2;
197 s = sdp_connect(src, dst, SDP_RETRY_IF_BUSY | SDP_WAIT_ON_CLOSE);
201 sdp_uuid16_create(&svclass, PNP_INFO_SVCLASS_ID);
202 search = sdp_list_append(NULL, &svclass);
203 attrid = sdp_list_append(NULL, &range);
205 err = sdp_service_search_attr_req(s, search,
206 SDP_ATTR_REQ_RANGE, attrid, &pnp_rsp);
208 sdp_list_free(search, NULL);
209 sdp_list_free(attrid, NULL);
211 sdp_uuid16_create(&svclass, HID_SVCLASS_ID);
212 search = sdp_list_append(NULL, &svclass);
213 attrid = sdp_list_append(NULL, &range);
215 err = sdp_service_search_attr_req(s, search,
216 SDP_ATTR_REQ_RANGE, attrid, &hid_rsp);
218 sdp_list_free(search, NULL);
219 sdp_list_free(attrid, NULL);
221 memset(&addr, 0, sizeof(addr));
222 addrlen = sizeof(addr);
224 if (getsockname(s->sock, (struct sockaddr *) &addr, &addrlen) < 0)
227 bacpy(&bdaddr, &addr.l2_bdaddr);
235 rec = (sdp_record_t *) pnp_rsp->data;
237 pdlist = sdp_data_get(rec, 0x0201);
238 req->vendor = pdlist ? pdlist->val.uint16 : 0x0000;
240 pdlist = sdp_data_get(rec, 0x0202);
241 req->product = pdlist ? pdlist->val.uint16 : 0x0000;
243 pdlist = sdp_data_get(rec, 0x0203);
244 req->version = pdlist ? pdlist->val.uint16 : 0x0000;
246 sdp_record_free(rec);
249 rec = (sdp_record_t *) hid_rsp->data;
251 pdlist2 = sdp_data_get(rec, 0x0100);
253 strncpy(req->name, pdlist2->val.str, sizeof(req->name) - 1);
255 pdlist = sdp_data_get(rec, 0x0101);
256 pdlist2 = sdp_data_get(rec, 0x0102);
259 if (strncmp(pdlist->val.str, pdlist2->val.str, 5)) {
260 strncpy(req->name, pdlist2->val.str, sizeof(req->name) - 1);
261 strcat(req->name, " ");
263 strncat(req->name, pdlist->val.str,
264 sizeof(req->name) - strlen(req->name));
266 strncpy(req->name, pdlist->val.str, sizeof(req->name) - 1);
270 pdlist = sdp_data_get(rec, 0x0201);
271 req->parser = pdlist ? pdlist->val.uint16 : 0x0100;
273 pdlist = sdp_data_get(rec, 0x0202);
274 req->subclass = pdlist ? pdlist->val.uint8 : 0;
276 pdlist = sdp_data_get(rec, 0x0203);
277 req->country = pdlist ? pdlist->val.uint8 : 0;
279 pdlist = sdp_data_get(rec, 0x0206);
281 pdlist = pdlist->val.dataseq;
282 pdlist = pdlist->val.dataseq;
283 pdlist = pdlist->next;
285 req->rd_data = malloc(pdlist->unitSize);
287 memcpy(req->rd_data, (unsigned char *) pdlist->val.str, pdlist->unitSize);
288 req->rd_size = pdlist->unitSize;
289 epox_endian_quirk(req->rd_data, req->rd_size);
293 sdp_record_free(rec);
295 if (bacmp(&bdaddr, BDADDR_ANY))
296 store_device_info(&bdaddr, dst, req);
301 int get_alternate_device_info(const bdaddr_t *src, const bdaddr_t *dst, uint16_t *uuid, uint8_t *channel, char *name, size_t len)
303 uint16_t attr1 = SDP_ATTR_PROTO_DESC_LIST;
304 uint16_t attr2 = SDP_ATTR_SVCNAME_PRIMARY;
306 sdp_list_t *search, *attrid, *rsp;
310 s = sdp_connect(src, dst, SDP_RETRY_IF_BUSY | SDP_WAIT_ON_CLOSE);
314 sdp_uuid16_create(&svclass, HEADSET_SVCLASS_ID);
315 search = sdp_list_append(NULL, &svclass);
316 attrid = sdp_list_append(NULL, &attr1);
317 attrid = sdp_list_append(attrid, &attr2);
319 err = sdp_service_search_attr_req(s, search,
320 SDP_ATTR_REQ_INDIVIDUAL, attrid, &rsp);
322 sdp_list_free(search, NULL);
323 sdp_list_free(attrid, NULL);
326 sdp_uuid16_create(&svclass, SERIAL_PORT_SVCLASS_ID);
327 search = sdp_list_append(NULL, &svclass);
328 attrid = sdp_list_append(NULL, &attr1);
329 attrid = sdp_list_append(attrid, &attr2);
331 err = sdp_service_search_attr_req(s, search,
332 SDP_ATTR_REQ_INDIVIDUAL, attrid, &rsp);
334 sdp_list_free(search, NULL);
335 sdp_list_free(attrid, NULL);
343 *uuid = SERIAL_PORT_SVCLASS_ID;
346 *uuid = HEADSET_SVCLASS_ID;
351 for (; rsp; rsp = rsp->next) {
352 sdp_record_t *rec = (sdp_record_t *) rsp->data;
355 sdp_get_service_name(rec, name, len);
357 if (!sdp_get_access_protos(rec, &protos)) {
358 uint8_t ch = sdp_get_proto_port(protos, RFCOMM_UUID);
366 sdp_record_free(rec);
372 void bnep_sdp_unregister(void)
374 if (record && sdp_record_unregister(session, record))
375 syslog(LOG_ERR, "Service record unregistration failed.");
380 int bnep_sdp_register(bdaddr_t *device, uint16_t role)
382 sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto;
383 uuid_t root_uuid, pan, l2cap, bnep;
384 sdp_profile_desc_t profile[1];
385 sdp_list_t *proto[2];
387 uint16_t psm = 15, version = 0x0100;
388 uint16_t security_desc = 0;
389 uint16_t net_access_type = 0xfffe;
390 uint32_t max_net_access_rate = 0;
391 char *name = "BlueZ PAN";
392 char *desc = "BlueZ PAN Service";
395 session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0);
397 syslog(LOG_ERR, "Failed to connect to the local SDP server. %s(%d)",
398 strerror(errno), errno);
402 record = sdp_record_alloc();
404 syslog(LOG_ERR, "Failed to allocate service record %s(%d)",
405 strerror(errno), errno);
410 sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
411 root = sdp_list_append(NULL, &root_uuid);
412 sdp_set_browse_groups(record, root);
413 sdp_list_free(root, 0);
415 sdp_uuid16_create(&l2cap, L2CAP_UUID);
416 proto[0] = sdp_list_append(NULL, &l2cap);
417 p = sdp_data_alloc(SDP_UINT16, &psm);
418 proto[0] = sdp_list_append(proto[0], p);
419 apseq = sdp_list_append(NULL, proto[0]);
421 sdp_uuid16_create(&bnep, BNEP_UUID);
422 proto[1] = sdp_list_append(NULL, &bnep);
423 v = sdp_data_alloc(SDP_UINT16, &version);
424 proto[1] = sdp_list_append(proto[1], v);
426 /* Supported protocols */
428 uint16_t ptype[4] = {
432 sdp_data_t *head, *pseq;
435 for (p = 0, head = NULL; p < 2; p++) {
436 sdp_data_t *data = sdp_data_alloc(SDP_UINT16, &ptype[p]);
438 sdp_seq_append(head, data);
442 pseq = sdp_data_alloc(SDP_SEQ16, head);
443 proto[1] = sdp_list_append(proto[1], pseq);
446 apseq = sdp_list_append(apseq, proto[1]);
448 aproto = sdp_list_append(NULL, apseq);
449 sdp_set_access_protos(record, aproto);
451 add_lang_attr(record);
453 sdp_list_free(proto[0], NULL);
454 sdp_list_free(proto[1], NULL);
455 sdp_list_free(apseq, NULL);
456 sdp_list_free(aproto, NULL);
459 sdp_attr_add_new(record, SDP_ATTR_SECURITY_DESC, SDP_UINT16, &security_desc);
463 sdp_uuid16_create(&pan, NAP_SVCLASS_ID);
464 svclass = sdp_list_append(NULL, &pan);
465 sdp_set_service_classes(record, svclass);
467 sdp_uuid16_create(&profile[0].uuid, NAP_PROFILE_ID);
468 profile[0].version = 0x0100;
469 pfseq = sdp_list_append(NULL, &profile[0]);
470 sdp_set_profile_descs(record, pfseq);
472 sdp_set_info_attr(record, "Network Access Point", name, desc);
474 sdp_attr_add_new(record, SDP_ATTR_NET_ACCESS_TYPE, SDP_UINT16, &net_access_type);
475 sdp_attr_add_new(record, SDP_ATTR_MAX_NET_ACCESSRATE, SDP_UINT32, &max_net_access_rate);
479 sdp_uuid16_create(&pan, GN_SVCLASS_ID);
480 svclass = sdp_list_append(NULL, &pan);
481 sdp_set_service_classes(record, svclass);
483 sdp_uuid16_create(&profile[0].uuid, GN_PROFILE_ID);
484 profile[0].version = 0x0100;
485 pfseq = sdp_list_append(NULL, &profile[0]);
486 sdp_set_profile_descs(record, pfseq);
488 sdp_set_info_attr(record, "Group Network Service", name, desc);
492 sdp_uuid16_create(&pan, PANU_SVCLASS_ID);
493 svclass = sdp_list_append(NULL, &pan);
494 sdp_set_service_classes(record, svclass);
495 sdp_list_free(svclass, 0);
497 sdp_uuid16_create(&profile[0].uuid, PANU_PROFILE_ID);
498 profile[0].version = 0x0100;
499 pfseq = sdp_list_append(NULL, &profile[0]);
500 sdp_set_profile_descs(record, pfseq);
501 sdp_list_free(pfseq, 0);
503 sdp_set_info_attr(record, "PAN User", name, desc);
507 status = sdp_device_record_register(session, device, record, 0);
509 syslog(LOG_ERR, "SDP registration failed.");
510 sdp_record_free(record); record = NULL;
518 /* Search for PAN service.
519 * Returns 1 if service is found and 0 otherwise. */
520 int bnep_sdp_search(bdaddr_t *src, bdaddr_t *dst, uint16_t service)
522 sdp_list_t *srch, *rsp = NULL;
529 sdp_uuid16_create(&svclass, PANU_SVCLASS_ID);
532 sdp_uuid16_create(&svclass, NAP_SVCLASS_ID);
535 sdp_uuid16_create(&svclass, GN_SVCLASS_ID);
539 srch = sdp_list_append(NULL, &svclass);
541 s = sdp_connect(src, dst, 0);
543 syslog(LOG_ERR, "Failed to connect to the SDP server. %s(%d)",
544 strerror(errno), errno);
548 err = sdp_service_search_req(s, srch, 1, &rsp);
551 /* Assume that search is successeful
552 * if at least one record is found */
553 if (!err && sdp_list_len(rsp))
559 static unsigned char async_uuid[] = { 0x03, 0x50, 0x27, 0x8F, 0x3D, 0xCA, 0x4E, 0x62,
560 0x83, 0x1D, 0xA4, 0x11, 0x65, 0xFF, 0x90, 0x6C };
562 void dun_sdp_unregister(void)
564 if (record && sdp_record_unregister(session, record))
565 syslog(LOG_ERR, "Service record unregistration failed.");
569 int dun_sdp_register(bdaddr_t *device, uint8_t channel, int type)
571 sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto;
572 uuid_t root_uuid, l2cap, rfcomm, dun;
573 sdp_profile_desc_t profile[1];
574 sdp_list_t *proto[2];
577 session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0);
579 syslog(LOG_ERR, "Failed to connect to the local SDP server. %s(%d)",
580 strerror(errno), errno);
584 record = sdp_record_alloc();
586 syslog(LOG_ERR, "Failed to alloc service record");
590 sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP);
591 root = sdp_list_append(NULL, &root_uuid);
592 sdp_set_browse_groups(record, root);
594 sdp_uuid16_create(&l2cap, L2CAP_UUID);
595 proto[0] = sdp_list_append(NULL, &l2cap);
596 apseq = sdp_list_append(NULL, proto[0]);
598 sdp_uuid16_create(&rfcomm, RFCOMM_UUID);
599 proto[1] = sdp_list_append(NULL, &rfcomm);
600 proto[1] = sdp_list_append(proto[1], sdp_data_alloc(SDP_UINT8, &channel));
601 apseq = sdp_list_append(apseq, proto[1]);
603 aproto = sdp_list_append(NULL, apseq);
604 sdp_set_access_protos(record, aproto);
608 sdp_uuid16_create(&dun, SERIAL_PORT_SVCLASS_ID);
611 sdp_uuid128_create(&dun, (void *) async_uuid);
614 sdp_uuid16_create(&dun, DIALUP_NET_SVCLASS_ID);
617 sdp_uuid16_create(&dun, LAN_ACCESS_SVCLASS_ID);
621 svclass = sdp_list_append(NULL, &dun);
622 sdp_set_service_classes(record, svclass);
626 sdp_uuid16_create(&profile[0].uuid, LAN_ACCESS_PROFILE_ID);
627 profile[0].version = 0x0100;
628 pfseq = sdp_list_append(NULL, &profile[0]);
629 sdp_set_profile_descs(record, pfseq);
632 sdp_uuid16_create(&profile[0].uuid, DIALUP_NET_PROFILE_ID);
633 profile[0].version = 0x0100;
634 pfseq = sdp_list_append(NULL, &profile[0]);
635 sdp_set_profile_descs(record, pfseq);
641 sdp_set_info_attr(record, "mRouter", NULL, NULL);
644 sdp_set_info_attr(record, "ActiveSync", NULL, NULL);
647 sdp_set_info_attr(record, "Dialup Networking", NULL, NULL);
650 sdp_set_info_attr(record, "LAN Access Point", NULL, NULL);
654 status = sdp_device_record_register(session, device, record, 0);
656 syslog(LOG_ERR, "SDP registration failed.");
657 sdp_record_free(record);
664 int dun_sdp_search(bdaddr_t *src, bdaddr_t *dst, int *channel, int type)
667 sdp_list_t *srch, *attrs, *rsp;
672 s = sdp_connect(src, dst, 0);
674 syslog(LOG_ERR, "Failed to connect to the SDP server. %s(%d)",
675 strerror(errno), errno);
681 sdp_uuid16_create(&svclass, SERIAL_PORT_SVCLASS_ID);
684 sdp_uuid128_create(&svclass, (void *) async_uuid);
687 sdp_uuid16_create(&svclass, DIALUP_NET_SVCLASS_ID);
690 sdp_uuid16_create(&svclass, LAN_ACCESS_SVCLASS_ID);
694 srch = sdp_list_append(NULL, &svclass);
696 attr = SDP_ATTR_PROTO_DESC_LIST;
697 attrs = sdp_list_append(NULL, &attr);
699 err = sdp_service_search_attr_req(s, srch, SDP_ATTR_REQ_INDIVIDUAL, attrs, &rsp);
706 for(; rsp; rsp = rsp->next) {
707 sdp_record_t *rec = (sdp_record_t *) rsp->data;
710 if (!sdp_get_access_protos(rec, &protos)) {
711 int ch = sdp_get_proto_port(protos, RFCOMM_UUID);