diff options
author | Marcel Holtmann <marcel@holtmann.org> | 2008-08-04 20:58:34 +0200 |
---|---|---|
committer | Marcel Holtmann <marcel@holtmann.org> | 2008-08-04 20:58:34 +0200 |
commit | 40372f9dc3ab115870a10343124216a041e55d17 (patch) | |
tree | ef5bfa80e3f560cf6856fd7a0d5c27c75c2cefe0 | |
parent | 295eb0c879802eacff46cf3c962646363d81f6d3 (diff) |
Move hidd pand and dund into compat directory
-rw-r--r-- | Makefile.am | 8 | ||||
-rw-r--r-- | compat/Makefile.am | 47 | ||||
-rw-r--r-- | compat/bnep.c (renamed from pand/bnep.c) | 0 | ||||
-rw-r--r-- | compat/dun.c (renamed from dund/dun.c) | 0 | ||||
-rw-r--r-- | compat/dund.1 (renamed from dund/dund.1) | 0 | ||||
-rw-r--r-- | compat/dund.c (renamed from dund/main.c) | 4 | ||||
-rw-r--r-- | compat/dund.h (renamed from dund/dund.h) | 13 | ||||
-rw-r--r-- | compat/fakehid.c (renamed from hidd/fakehid.c) | 0 | ||||
-rw-r--r-- | compat/fakehid.txt (renamed from hidd/fakehid.txt) | 0 | ||||
-rw-r--r-- | compat/hidd.1 (renamed from hidd/hidd.1) | 0 | ||||
-rw-r--r-- | compat/hidd.c (renamed from hidd/main.c) | 1 | ||||
-rw-r--r-- | compat/hidd.h (renamed from hidd/hidd.h) | 4 | ||||
-rw-r--r-- | compat/lib.h (renamed from dund/lib.h) | 2 | ||||
-rw-r--r-- | compat/msdun.c (renamed from dund/msdun.c) | 0 | ||||
-rw-r--r-- | compat/pand.1 (renamed from pand/pand.1) | 0 | ||||
-rw-r--r-- | compat/pand.c (renamed from pand/main.c) | 2 | ||||
-rw-r--r-- | compat/pand.h (renamed from pand/pand.h) | 6 | ||||
-rw-r--r-- | compat/sdp.c | 718 | ||||
-rw-r--r-- | compat/sdp.h | 39 | ||||
-rw-r--r-- | configure.ac | 4 | ||||
-rw-r--r-- | dund/Makefile.am | 20 | ||||
-rw-r--r-- | dund/sdp.c | 208 | ||||
-rw-r--r-- | hidd/Makefile.am | 22 | ||||
-rw-r--r-- | hidd/sdp.c | 352 | ||||
-rw-r--r-- | pand/Makefile.am | 22 | ||||
-rw-r--r-- | pand/sdp.c | 247 |
26 files changed, 815 insertions, 904 deletions
diff --git a/Makefile.am b/Makefile.am index f372db02..064da054 100644 --- a/Makefile.am +++ b/Makefile.am @@ -1,9 +1,7 @@ -SUBDIRS = include lib doc \ - sbc gdbus common src plugins \ - network serial input audio \ - tools rfcomm dund pand hidd \ - cups test scripts +SUBDIRS = include lib doc sbc gdbus common src \ + plugins network serial input audio \ + tools rfcomm compat cups test scripts aclocaldir = $(datadir)/aclocal diff --git a/compat/Makefile.am b/compat/Makefile.am new file mode 100644 index 00000000..4054b3e7 --- /dev/null +++ b/compat/Makefile.am @@ -0,0 +1,47 @@ + +bin_PROGRAMS = +man_MANS = + +if HIDD +bin_PROGRAMS += hidd + +hidd_SOURCES = hidd.c hidd.h sdp.c fakehid.c + +hidd_LDADD = $(top_builddir)/common/libhelper.a @BLUEZ_LIBS@ -lm + +if MANPAGES +man_MANS += hidd.1 +endif +endif + +if PAND +bin_PROGRAMS += pand + +pand_SOURCES = pand.c pand.h bnep.c sdp.c + +pand_LDADD = $(top_builddir)/common/libhelper.a @BLUEZ_LIBS@ +endif + +if MANPAGES +man_MANS += pand.1 +endif + +if DUND +bin_PROGRAMS += dund + +dund_SOURCES = dund.c dund.h lib.h sdp.c dun.c msdun.c + +dund_LDADD = $(top_builddir)/common/libhelper.a @BLUEZ_LIBS@ +endif + +if MANPAGES +man_MANS += dund.1 +endif + +AM_CFLAGS = @BLUEZ_CFLAGS@ + +INCLUDES = -I$(top_srcdir)/common + +EXTRA_DIST = fakehid.txt hidd.1 pand.1 dund.1 + +MAINTAINERCLEANFILES = Makefile.in diff --git a/pand/bnep.c b/compat/bnep.c index 604ed552..604ed552 100644 --- a/pand/bnep.c +++ b/compat/bnep.c diff --git a/dund/dun.c b/compat/dun.c index de437cf4..de437cf4 100644 --- a/dund/dun.c +++ b/compat/dun.c diff --git a/dund/dund.1 b/compat/dund.1 index 09fb7f75..09fb7f75 100644 --- a/dund/dund.1 +++ b/compat/dund.1 diff --git a/dund/main.c b/compat/dund.c index b14adce0..dea945d2 100644 --- a/dund/main.c +++ b/compat/dund.c @@ -42,14 +42,16 @@ #include <bluetooth/hci.h> #include <bluetooth/hci_lib.h> #include <bluetooth/rfcomm.h> +#include <bluetooth/hidp.h> +#include "sdp.h" #include "dund.h" #include "lib.h" volatile sig_atomic_t __io_canceled; /* MS dialup networking support (i.e. CLIENT / CLIENTSERVER thing) */ -static int msdun = 0; +static int msdun = 0; static char *pppd = "/usr/sbin/pppd"; static char *pppd_opts[DUN_MAX_PPP_OPTS] = diff --git a/dund/dund.h b/compat/dund.h index 00008578..c3308e1e 100644 --- a/dund/dund.h +++ b/compat/dund.h @@ -22,20 +22,12 @@ * */ -/* DUN scripts & commands */ #define DUN_CONFIG_DIR "/etc/bluetooth/dun" #define DUN_DEFAULT_CHANNEL 1 #define DUN_MAX_PPP_OPTS 40 -/* DUN types */ -#define LANACCESS 0 -#define MROUTER 1 -#define ACTIVESYNC 2 -#define DIALUP 3 - -/* DUN functions */ int dun_init(void); int dun_cleanup(void); @@ -45,7 +37,4 @@ int dun_kill_all_connections(void); int dun_open_connection(int sk, char *pppd, char **pppd_opts, int wait); -/* SDP functions */ -int dun_sdp_register(bdaddr_t *device, uint8_t channel, int type); -void dun_sdp_unregister(void); -int dun_sdp_search(bdaddr_t *src, bdaddr_t *dst, int *channel, int type); +int ms_dun(int fd, int server, int timeo); diff --git a/hidd/fakehid.c b/compat/fakehid.c index feefe2a6..feefe2a6 100644 --- a/hidd/fakehid.c +++ b/compat/fakehid.c diff --git a/hidd/fakehid.txt b/compat/fakehid.txt index 000d0ee2..000d0ee2 100644 --- a/hidd/fakehid.txt +++ b/compat/fakehid.txt diff --git a/hidd/hidd.1 b/compat/hidd.1 index b186ac24..b186ac24 100644 --- a/hidd/hidd.1 +++ b/compat/hidd.1 diff --git a/hidd/main.c b/compat/hidd.c index d0883b36..6a0058c4 100644 --- a/hidd/main.c +++ b/compat/hidd.c @@ -46,6 +46,7 @@ #include <bluetooth/sdp.h> #include <bluetooth/hidp.h> +#include "sdp.h" #include "hidd.h" #ifdef NEED_PPOLL diff --git a/hidd/hidd.h b/compat/hidd.h index 63e0cbbe..ba94bcf4 100644 --- a/hidd/hidd.h +++ b/compat/hidd.h @@ -24,10 +24,6 @@ #define L2CAP_PSM_HIDP_CTRL 0x11 #define L2CAP_PSM_HIDP_INTR 0x13 -int get_stored_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req); -int get_sdp_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req); -int get_alternate_device_info(const bdaddr_t *src, const bdaddr_t *dst, uint16_t *uuid, uint8_t *channel, char *name, size_t len); - int epox_presenter(const bdaddr_t *src, const bdaddr_t *dst, uint8_t channel); int headset_presenter(const bdaddr_t *src, const bdaddr_t *dst, uint8_t channel); int jthree_keyboard(const bdaddr_t *src, const bdaddr_t *dst, uint8_t channel); diff --git a/dund/lib.h b/compat/lib.h index e4b6e401..b070ee40 100644 --- a/dund/lib.h +++ b/compat/lib.h @@ -84,5 +84,3 @@ static inline int write_n(int fd, char *buf, int len) return t; } - -int ms_dun(int fd, int server, int timeo); diff --git a/dund/msdun.c b/compat/msdun.c index 1ef559f1..1ef559f1 100644 --- a/dund/msdun.c +++ b/compat/msdun.c diff --git a/pand/pand.1 b/compat/pand.1 index 4603b8bf..4603b8bf 100644 --- a/pand/pand.1 +++ b/compat/pand.1 diff --git a/pand/main.c b/compat/pand.c index ce3b8ebb..ed80c7a5 100644 --- a/pand/main.c +++ b/compat/pand.c @@ -46,7 +46,9 @@ #include <bluetooth/hci_lib.h> #include <bluetooth/l2cap.h> #include <bluetooth/bnep.h> +#include <bluetooth/hidp.h> +#include "sdp.h" #include "pand.h" #ifdef NEED_PPOLL diff --git a/pand/pand.h b/compat/pand.h index 3e91f82d..90f26ed6 100644 --- a/pand/pand.h +++ b/compat/pand.h @@ -22,7 +22,6 @@ * */ -/* BNEP functions */ int bnep_init(void); int bnep_cleanup(void); @@ -35,8 +34,3 @@ int bnep_kill_all_connections(void); int bnep_accept_connection(int sk, uint16_t role, char *dev); int bnep_create_connection(int sk, uint16_t role, uint16_t svc, char *dev); - -/* SDP functions */ -int bnep_sdp_register(bdaddr_t *device, uint16_t role); -void bnep_sdp_unregister(void); -int bnep_sdp_search(bdaddr_t *src, bdaddr_t *dst, uint16_t service); diff --git a/compat/sdp.c b/compat/sdp.c new file mode 100644 index 00000000..a08ace90 --- /dev/null +++ b/compat/sdp.c @@ -0,0 +1,718 @@ +/* + * + * BlueZ - Bluetooth protocol stack for Linux + * + * Copyright (C) 2003-2008 Marcel Holtmann <marcel@holtmann.org> + * + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + * + */ + +#ifdef HAVE_CONFIG_H +#include <config.h> +#endif + +#include <stdio.h> +#include <errno.h> +#include <stdlib.h> +#include <string.h> +#include <syslog.h> +#include <sys/stat.h> +#include <sys/socket.h> + +#include <bluetooth/bluetooth.h> +#include <bluetooth/l2cap.h> +#include <bluetooth/sdp.h> +#include <bluetooth/sdp_lib.h> +#include <bluetooth/hidp.h> +#include <bluetooth/bnep.h> + +#include "textfile.h" +#include "sdp.h" + +static sdp_record_t *record = NULL; +static sdp_session_t *session = NULL; + +static void add_lang_attr(sdp_record_t *r) +{ + sdp_lang_attr_t base_lang; + sdp_list_t *langs = 0; + + /* UTF-8 MIBenum (http://www.iana.org/assignments/character-sets) */ + base_lang.code_ISO639 = (0x65 << 8) | 0x6e; + base_lang.encoding = 106; + base_lang.base_offset = SDP_PRIMARY_LANG_BASE; + langs = sdp_list_append(0, &base_lang); + sdp_set_lang_attr(r, langs); + sdp_list_free(langs, 0); +} + +static void epox_endian_quirk(unsigned char *data, int size) +{ + /* USAGE_PAGE (Keyboard) 05 07 + * USAGE_MINIMUM (0) 19 00 + * USAGE_MAXIMUM (65280) 2A 00 FF <= must be FF 00 + * LOGICAL_MINIMUM (0) 15 00 + * LOGICAL_MAXIMUM (65280) 26 00 FF <= must be FF 00 + */ + unsigned char pattern[] = { 0x05, 0x07, 0x19, 0x00, 0x2a, 0x00, 0xff, + 0x15, 0x00, 0x26, 0x00, 0xff }; + int i; + + if (!data) + return; + + for (i = 0; i < size - sizeof(pattern); i++) { + if (!memcmp(data + i, pattern, sizeof(pattern))) { + data[i + 5] = 0xff; + data[i + 6] = 0x00; + data[i + 10] = 0xff; + data[i + 11] = 0x00; + } + } +} + +static int store_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req) +{ + char filename[PATH_MAX + 1], addr[18], *str, *desc; + int i, err, size; + + ba2str(src, addr); + create_name(filename, PATH_MAX, STORAGEDIR, addr, "hidd"); + + size = 15 + 3 + 3 + 5 + (req->rd_size * 2) + 1 + 9 + strlen(req->name) + 2; + str = malloc(size); + if (!str) + return -ENOMEM; + + desc = malloc((req->rd_size * 2) + 1); + if (!desc) { + free(str); + return -ENOMEM; + } + + memset(desc, 0, (req->rd_size * 2) + 1); + for (i = 0; i < req->rd_size; i++) + sprintf(desc + (i * 2), "%2.2X", req->rd_data[i]); + + snprintf(str, size - 1, "%04X:%04X:%04X %02X %02X %04X %s %08X %s", + req->vendor, req->product, req->version, + req->subclass, req->country, req->parser, desc, + req->flags, req->name); + + free(desc); + + create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); + + ba2str(dst, addr); + err = textfile_put(filename, addr, str); + + free(str); + + return err; +} + +int get_stored_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req) +{ + char filename[PATH_MAX + 1], addr[18], tmp[3], *str, *desc; + unsigned int vendor, product, version, subclass, country, parser, pos; + int i; + + desc = malloc(4096); + if (!desc) + return -ENOMEM; + + memset(desc, 0, 4096); + + ba2str(src, addr); + create_name(filename, PATH_MAX, STORAGEDIR, addr, "hidd"); + + ba2str(dst, addr); + str = textfile_get(filename, addr); + if (!str) { + free(desc); + return -EIO; + } + + sscanf(str, "%04X:%04X:%04X %02X %02X %04X %4095s %08X %n", + &vendor, &product, &version, &subclass, &country, + &parser, desc, &req->flags, &pos); + + free(str); + + req->vendor = vendor; + req->product = product; + req->version = version; + req->subclass = subclass; + req->country = country; + req->parser = parser; + + snprintf(req->name, 128, str + pos); + + req->rd_size = strlen(desc) / 2; + req->rd_data = malloc(req->rd_size); + if (!req->rd_data) { + free(desc); + return -ENOMEM; + } + + memset(tmp, 0, sizeof(tmp)); + for (i = 0; i < req->rd_size; i++) { + memcpy(tmp, desc + (i * 2), 2); + req->rd_data[i] = (uint8_t) strtol(tmp, NULL, 16); + } + + free(desc); + + return 0; +} + +int get_sdp_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req) +{ + struct sockaddr_l2 addr; + socklen_t addrlen; + bdaddr_t bdaddr; + uint32_t range = 0x0000ffff; + sdp_session_t *s; + sdp_list_t *search, *attrid, *pnp_rsp, *hid_rsp; + sdp_record_t *rec; + sdp_data_t *pdlist, *pdlist2; + uuid_t svclass; + int err; + + s = sdp_connect(src, dst, SDP_RETRY_IF_BUSY | SDP_WAIT_ON_CLOSE); + if (!s) + return -1; + + sdp_uuid16_create(&svclass, PNP_INFO_SVCLASS_ID); + search = sdp_list_append(NULL, &svclass); + attrid = sdp_list_append(NULL, &range); + + err = sdp_service_search_attr_req(s, search, + SDP_ATTR_REQ_RANGE, attrid, &pnp_rsp); + + sdp_list_free(search, NULL); + sdp_list_free(attrid, NULL); + + sdp_uuid16_create(&svclass, HID_SVCLASS_ID); + search = sdp_list_append(NULL, &svclass); + attrid = sdp_list_append(NULL, &range); + + err = sdp_service_search_attr_req(s, search, + SDP_ATTR_REQ_RANGE, attrid, &hid_rsp); + + sdp_list_free(search, NULL); + sdp_list_free(attrid, NULL); + + memset(&addr, 0, sizeof(addr)); + addrlen = sizeof(addr); + + if (getsockname(s->sock, (struct sockaddr *) &addr, &addrlen) < 0) + bacpy(&bdaddr, src); + else + bacpy(&bdaddr, &addr.l2_bdaddr); + + sdp_close(s); + + if (err || !hid_rsp) + return -1; + + if (pnp_rsp) { + rec = (sdp_record_t *) pnp_rsp->data; + + pdlist = sdp_data_get(rec, 0x0201); + req->vendor = pdlist ? pdlist->val.uint16 : 0x0000; + + pdlist = sdp_data_get(rec, 0x0202); + req->product = pdlist ? pdlist->val.uint16 : 0x0000; + + pdlist = sdp_data_get(rec, 0x0203); + req->version = pdlist ? pdlist->val.uint16 : 0x0000; + + sdp_record_free(rec); + } + + rec = (sdp_record_t *) hid_rsp->data; + + pdlist = sdp_data_get(rec, 0x0101); + pdlist2 = sdp_data_get(rec, 0x0102); + if (pdlist) { + if (pdlist2) { + if (strncmp(pdlist->val.str, pdlist2->val.str, 5)) { + strncpy(req->name, pdlist2->val.str, sizeof(req->name) - 1); + strcat(req->name, " "); + } + strncat(req->name, pdlist->val.str, + sizeof(req->name) - strlen(req->name)); + } else + strncpy(req->name, pdlist->val.str, sizeof(req->name)); + } else { + pdlist2 = sdp_data_get(rec, 0x0100); + if (pdlist2) + strncpy(req->name, pdlist2->val.str, sizeof(req->name)); + } + + pdlist = sdp_data_get(rec, 0x0201); + req->parser = pdlist ? pdlist->val.uint16 : 0x0100; + + pdlist = sdp_data_get(rec, 0x0202); + req->subclass = pdlist ? pdlist->val.uint8 : 0; + + pdlist = sdp_data_get(rec, 0x0203); + req->country = pdlist ? pdlist->val.uint8 : 0; + + pdlist = sdp_data_get(rec, 0x0206); + if (pdlist) { + pdlist = pdlist->val.dataseq; + pdlist = pdlist->val.dataseq; + pdlist = pdlist->next; + + req->rd_data = malloc(pdlist->unitSize); + if (req->rd_data) { + memcpy(req->rd_data, (unsigned char *) pdlist->val.str, pdlist->unitSize); + req->rd_size = pdlist->unitSize; + epox_endian_quirk(req->rd_data, req->rd_size); + } + } + + sdp_record_free(rec); + + if (bacmp(&bdaddr, BDADDR_ANY)) + store_device_info(&bdaddr, dst, req); + + return 0; +} + +int get_alternate_device_info(const bdaddr_t *src, const bdaddr_t *dst, uint16_t *uuid, uint8_t *channel, char *name, size_t len) +{ + uint16_t attr1 = SDP_ATTR_PROTO_DESC_LIST; + uint16_t attr2 = SDP_ATTR_SVCNAME_PRIMARY; + sdp_session_t *s; + sdp_list_t *search, *attrid, *rsp; + uuid_t svclass; + int err; + + s = sdp_connect(src, dst, SDP_RETRY_IF_BUSY | SDP_WAIT_ON_CLOSE); + if (!s) + return -1; + + sdp_uuid16_create(&svclass, HEADSET_SVCLASS_ID); + search = sdp_list_append(NULL, &svclass); + attrid = sdp_list_append(NULL, &attr1); + attrid = sdp_list_append(attrid, &attr2); + + err = sdp_service_search_attr_req(s, search, + SDP_ATTR_REQ_INDIVIDUAL, attrid, &rsp); + + sdp_list_free(search, NULL); + sdp_list_free(attrid, NULL); + + if (err <= 0) { + sdp_uuid16_create(&svclass, SERIAL_PORT_SVCLASS_ID); + search = sdp_list_append(NULL, &svclass); + attrid = sdp_list_append(NULL, &attr1); + attrid = sdp_list_append(attrid, &attr2); + + err = sdp_service_search_attr_req(s, search, + SDP_ATTR_REQ_INDIVIDUAL, attrid, &rsp); + + sdp_list_free(search, NULL); + sdp_list_free(attrid, NULL); + + if (err < 0) { + sdp_close(s); + return err; + } + + if (uuid) + *uuid = SERIAL_PORT_SVCLASS_ID; + } else { + if (uuid) + *uuid = HEADSET_SVCLASS_ID; + } + + sdp_close(s); + + for (; rsp; rsp = rsp->next) { + sdp_record_t *rec = (sdp_record_t *) rsp->data; + sdp_list_t *protos; + + sdp_get_service_name(rec, name, len); + + if (!sdp_get_access_protos(rec, &protos)) { + uint8_t ch = sdp_get_proto_port(protos, RFCOMM_UUID); + if (ch > 0) { + if (channel) + *channel = ch; + return 0; + } + } + + sdp_record_free(rec); + } + + return -EIO; +} + +void bnep_sdp_unregister(void) +{ + if (record && sdp_record_unregister(session, record)) + syslog(LOG_ERR, "Service record unregistration failed."); + + sdp_close(session); +} + +int bnep_sdp_register(bdaddr_t *device, uint16_t role) +{ + sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto; + uuid_t root_uuid, pan, l2cap, bnep; + sdp_profile_desc_t profile[1]; + sdp_list_t *proto[2]; + sdp_data_t *v, *p; + uint16_t psm = 15, version = 0x0100; + uint16_t security_desc = 0; + uint16_t net_access_type = 0xfffe; + uint32_t max_net_access_rate = 0; + char *name = "BlueZ PAN"; + char *desc = "BlueZ PAN Service"; + int status; + + session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0); + if (!session) { + syslog(LOG_ERR, "Failed to connect to the local SDP server. %s(%d)", + strerror(errno), errno); + return -1; + } + + record = sdp_record_alloc(); + if (!record) { + syslog(LOG_ERR, "Failed to allocate service record %s(%d)", + strerror(errno), errno); + sdp_close(session); + return -1; + } + + sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP); + root = sdp_list_append(NULL, &root_uuid); + sdp_set_browse_groups(record, root); + sdp_list_free(root, 0); + + sdp_uuid16_create(&l2cap, L2CAP_UUID); + proto[0] = sdp_list_append(NULL, &l2cap); + p = sdp_data_alloc(SDP_UINT16, &psm); + proto[0] = sdp_list_append(proto[0], p); + apseq = sdp_list_append(NULL, proto[0]); + + sdp_uuid16_create(&bnep, BNEP_UUID); + proto[1] = sdp_list_append(NULL, &bnep); + v = sdp_data_alloc(SDP_UINT16, &version); + proto[1] = sdp_list_append(proto[1], v); + + /* Supported protocols */ + { + uint16_t ptype[4] = { + 0x0800, /* IPv4 */ + 0x0806, /* ARP */ + }; + sdp_data_t *head, *pseq; + int p; + + for (p = 0, head = NULL; p < 2; p++) { + sdp_data_t *data = sdp_data_alloc(SDP_UINT16, &ptype[p]); + if (head) + sdp_seq_append(head, data); + else + head = data; + } + pseq = sdp_data_alloc(SDP_SEQ16, head); + proto[1] = sdp_list_append(proto[1], pseq); + } + + apseq = sdp_list_append(apseq, proto[1]); + + aproto = sdp_list_append(NULL, apseq); + sdp_set_access_protos(record, aproto); + + add_lang_attr(record); + + sdp_list_free(proto[0], NULL); + sdp_list_free(proto[1], NULL); + sdp_list_free(apseq, NULL); + sdp_list_free(aproto, NULL); + sdp_data_free(p); + sdp_data_free(v); + sdp_attr_add_new(record, SDP_ATTR_SECURITY_DESC, SDP_UINT16, &security_desc); + + switch (role) { + case BNEP_SVC_NAP: + sdp_uuid16_create(&pan, NAP_SVCLASS_ID); + svclass = sdp_list_append(NULL, &pan); + sdp_set_service_classes(record, svclass); + + sdp_uuid16_create(&profile[0].uuid, NAP_PROFILE_ID); + profile[0].version = 0x0100; + pfseq = sdp_list_append(NULL, &profile[0]); + sdp_set_profile_descs(record, pfseq); + + sdp_set_info_attr(record, "Network Access Point", name, desc); + + sdp_attr_add_new(record, SDP_ATTR_NET_ACCESS_TYPE, SDP_UINT16, &net_access_type); + sdp_attr_add_new(record, SDP_ATTR_MAX_NET_ACCESSRATE, SDP_UINT32, &max_net_access_rate); + break; + + case BNEP_SVC_GN: + sdp_uuid16_create(&pan, GN_SVCLASS_ID); + svclass = sdp_list_append(NULL, &pan); + sdp_set_service_classes(record, svclass); + + sdp_uuid16_create(&profile[0].uuid, GN_PROFILE_ID); + profile[0].version = 0x0100; + pfseq = sdp_list_append(NULL, &profile[0]); + sdp_set_profile_descs(record, pfseq); + + sdp_set_info_attr(record, "Group Network Service", name, desc); + break; + + case BNEP_SVC_PANU: + sdp_uuid16_create(&pan, PANU_SVCLASS_ID); + svclass = sdp_list_append(NULL, &pan); + sdp_set_service_classes(record, svclass); + sdp_list_free(svclass, 0); + + sdp_uuid16_create(&profile[0].uuid, PANU_PROFILE_ID); + profile[0].version = 0x0100; + pfseq = sdp_list_append(NULL, &profile[0]); + sdp_set_profile_descs(record, pfseq); + sdp_list_free(pfseq, 0); + + sdp_set_info_attr(record, "PAN User", name, desc); + break; + } + + status = sdp_device_record_register(session, device, record, 0); + if (status) { + syslog(LOG_ERR, "SDP registration failed."); + sdp_record_free(record); record = NULL; + sdp_close(session); + return -1; + } + + return 0; +} + +/* Search for PAN service. + * Returns 1 if service is found and 0 otherwise. */ +int bnep_sdp_search(bdaddr_t *src, bdaddr_t *dst, uint16_t service) +{ + sdp_list_t *srch, *rsp = NULL; + sdp_session_t *s; + uuid_t svclass; + int err; + + switch (service) { + case BNEP_SVC_PANU: + sdp_uuid16_create(&svclass, PANU_SVCLASS_ID); + break; + case BNEP_SVC_NAP: + sdp_uuid16_create(&svclass, NAP_SVCLASS_ID); + break; + case BNEP_SVC_GN: + sdp_uuid16_create(&svclass, GN_SVCLASS_ID); + break; + } + + srch = sdp_list_append(NULL, &svclass); + + s = sdp_connect(src, dst, 0); + if (!s) { + syslog(LOG_ERR, "Failed to connect to the SDP server. %s(%d)", + strerror(errno), errno); + return 0; + } + + err = sdp_service_search_req(s, srch, 1, &rsp); + sdp_close(s); + + /* Assume that search is successeful + * if at least one record is found */ + if (!err && sdp_list_len(rsp)) + return 1; + + return 0; +} + +static unsigned char async_uuid[] = { 0x03, 0x50, 0x27, 0x8F, 0x3D, 0xCA, 0x4E, 0x62, + 0x83, 0x1D, 0xA4, 0x11, 0x65, 0xFF, 0x90, 0x6C }; + +void dun_sdp_unregister(void) +{ + if (record && sdp_record_unregister(session, record)) + syslog(LOG_ERR, "Service record unregistration failed."); + sdp_close(session); +} + +int dun_sdp_register(bdaddr_t *device, uint8_t channel, int type) +{ + sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto; + uuid_t root_uuid, l2cap, rfcomm, dun; + sdp_profile_desc_t profile[1]; + sdp_list_t *proto[2]; + int status; + + session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0); + if (!session) { + syslog(LOG_ERR, "Failed to connect to the local SDP server. %s(%d)", + strerror(errno), errno); + return -1; + } + + record = sdp_record_alloc(); + if (!record) { + syslog(LOG_ERR, "Failed to alloc service record"); + return -1; + } + + sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP); + root = sdp_list_append(NULL, &root_uuid); + sdp_set_browse_groups(record, root); + + sdp_uuid16_create(&l2cap, L2CAP_UUID); + proto[0] = sdp_list_append(NULL, &l2cap); + apseq = sdp_list_append(NULL, proto[0]); + + sdp_uuid16_create(&rfcomm, RFCOMM_UUID); + proto[1] = sdp_list_append(NULL, &rfcomm); + proto[1] = sdp_list_append(proto[1], sdp_data_alloc(SDP_UINT8, &channel)); + apseq = sdp_list_append(apseq, proto[1]); + + aproto = sdp_list_append(NULL, apseq); + sdp_set_access_protos(record, aproto); + + switch (type) { + case MROUTER: + sdp_uuid16_create(&dun, SERIAL_PORT_SVCLASS_ID); + break; + case ACTIVESYNC: + sdp_uuid128_create(&dun, (void *) async_uuid); + break; + case DIALUP: + sdp_uuid16_create(&dun, DIALUP_NET_SVCLASS_ID); + break; + default: + sdp_uuid16_create(&dun, LAN_ACCESS_SVCLASS_ID); + break; + } + + svclass = sdp_list_append(NULL, &dun); + sdp_set_service_classes(record, svclass); + + switch (type) { + case LANACCESS: + sdp_uuid16_create(&profile[0].uuid, LAN_ACCESS_PROFILE_ID); + profile[0].version = 0x0100; + pfseq = sdp_list_append(NULL, &profile[0]); + sdp_set_profile_descs(record, pfseq); + break; + case DIALUP: + sdp_uuid16_create(&profile[0].uuid, DIALUP_NET_PROFILE_ID); + profile[0].version = 0x0100; + pfseq = sdp_list_append(NULL, &profile[0]); + sdp_set_profile_descs(record, pfseq); + break; + } + + switch (type) { + case MROUTER: + sdp_set_info_attr(record, "mRouter", NULL, NULL); + break; + case ACTIVESYNC: + sdp_set_info_attr(record, "ActiveSync", NULL, NULL); + break; + case DIALUP: + sdp_set_info_attr(record, "Dialup Networking", NULL, NULL); + break; + default: + sdp_set_info_attr(record, "LAN Access Point", NULL, NULL); + break; + } + + status = sdp_device_record_register(session, device, record, 0); + if (status) { + syslog(LOG_ERR, "SDP registration failed."); + sdp_record_free(record); + record = NULL; + return -1; + } + return 0; +} + +int dun_sdp_search(bdaddr_t *src, bdaddr_t *dst, int *channel, int type) +{ + sdp_session_t *s; + sdp_list_t *srch, *attrs, *rsp; + uuid_t svclass; + uint16_t attr; + int err; + + s = sdp_connect(src, dst, 0); + if (!s) { + syslog(LOG_ERR, "Failed to connect to the SDP server. %s(%d)", + strerror(errno), errno); + return -1; + } + + switch (type) { + case MROUTER: + sdp_uuid16_create(&svclass, SERIAL_PORT_SVCLASS_ID); + break; + case ACTIVESYNC: + sdp_uuid128_create(&svclass, (void *) async_uuid); + break; + case DIALUP: + sdp_uuid16_create(&svclass, DIALUP_NET_SVCLASS_ID); + break; + default: + sdp_uuid16_create(&svclass, LAN_ACCESS_SVCLASS_ID); + break; + } + + srch = sdp_list_append(NULL, &svclass); + + attr = SDP_ATTR_PROTO_DESC_LIST; + attrs = sdp_list_append(NULL, &attr); + + err = sdp_service_search_attr_req(s, srch, SDP_ATTR_REQ_INDIVIDUAL, attrs, &rsp); + + sdp_close(s); + + if (err) + return 0; + + for(; rsp; rsp = rsp->next) { + sdp_record_t *rec = (sdp_record_t *) rsp->data; + sdp_list_t *protos; + + if (!sdp_get_access_protos(rec, &protos)) { + int ch = sdp_get_proto_port(protos, RFCOMM_UUID); + if (ch > 0) { + *channel = ch; + return 1; + } + } + } + + return 0; +} diff --git a/compat/sdp.h b/compat/sdp.h new file mode 100644 index 00000000..7ff75d68 --- /dev/null +++ b/compat/sdp.h @@ -0,0 +1,39 @@ +/* + * + * BlueZ - Bluetooth protocol stack for Linux + * + * Copyright (C) 2003-2008 Marcel Holtmann <marcel@holtmann.org> + * + * + * This program is free software; you can redistribute it and/or modify + * it under the terms of the GNU General Public License as published by + * the Free Software Foundation; either version 2 of the License, or + * (at your option) any later version. + * + * This program is distributed in the hope that it will be useful, + * but WITHOUT ANY WARRANTY; without even the implied warranty of + * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the + * GNU General Public License for more details. + * + * You should have received a copy of the GNU General Public License + * along with this program; if not, write to the Free Software + * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA + * + */ + +#define LANACCESS 0 +#define MROUTER 1 +#define ACTIVESYNC 2 +#define DIALUP 3 + +int get_stored_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req); +int get_sdp_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req); +int get_alternate_device_info(const bdaddr_t *src, const bdaddr_t *dst, uint16_t *uuid, uint8_t *channel, char *name, size_t len); + +int bnep_sdp_search(bdaddr_t *src, bdaddr_t *dst, uint16_t service); +int bnep_sdp_register(bdaddr_t *device, uint16_t role); +void bnep_sdp_unregister(void); + +int dun_sdp_search(bdaddr_t *src, bdaddr_t *dst, int *channel, int type); +int dun_sdp_register(bdaddr_t *device, uint8_t channel, int type); +void dun_sdp_unregister(void); diff --git a/configure.ac b/configure.ac index 9e77f144..f28f113b 100644 --- a/configure.ac +++ b/configure.ac @@ -51,9 +51,7 @@ AC_OUTPUT([ audio/Makefile tools/Makefile rfcomm/Makefile - dund/Makefile - pand/Makefile - hidd/Makefile + compat/Makefile cups/Makefile test/Makefile scripts/Makefile diff --git a/dund/Makefile.am b/dund/Makefile.am deleted file mode 100644 index 260698ab..00000000 --- a/dund/Makefile.am +++ /dev/null @@ -1,20 +0,0 @@ - -if DUND -bin_PROGRAMS = dund - -dund_SOURCES = main.c dun.c dund.h sdp.c lib.h msdun.c - -dund_LDADD = @BLUEZ_LIBS@ -endif - -AM_CFLAGS = @BLUEZ_CFLAGS@ - -if DUND -if MANPAGES -man_MANS = dund.1 -endif -endif - -EXTRA_DIST = dund.1 - -MAINTAINERCLEANFILES = Makefile.in diff --git a/dund/sdp.c b/dund/sdp.c deleted file mode 100644 index f2c42c5a..00000000 --- a/dund/sdp.c +++ /dev/null @@ -1,208 +0,0 @@ -/* - * - * BlueZ - Bluetooth protocol stack for Linux - * - * Copyright (C) 2002-2003 Maxim Krasnyansky <maxk@qualcomm.com> - * Copyright (C) 2002-2008 Marcel Holtmann <marcel@holtmann.org> - * - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA - * - */ - -#ifdef HAVE_CONFIG_H -#include <config.h> -#endif - -#include <stdio.h> -#include <errno.h> -#include <unistd.h> -#include <stdlib.h> -#include <string.h> -#include <syslog.h> -#include <sys/types.h> -#include <sys/socket.h> - -#include <bluetooth/bluetooth.h> -#include <bluetooth/sdp.h> -#include <bluetooth/sdp_lib.h> - -#include "dund.h" - -static unsigned char async_uuid[] = { 0x03, 0x50, 0x27, 0x8F, 0x3D, 0xCA, 0x4E, 0x62, - 0x83, 0x1D, 0xA4, 0x11, 0x65, 0xFF, 0x90, 0x6C }; - -static sdp_record_t *record; -static sdp_session_t *session; - -void dun_sdp_unregister(void) -{ - if (record && sdp_record_unregister(session, record)) - syslog(LOG_ERR, "Service record unregistration failed."); - sdp_close(session); -} - -int dun_sdp_register(bdaddr_t *device, uint8_t channel, int type) -{ - sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto; - uuid_t root_uuid, l2cap, rfcomm, dun; - sdp_profile_desc_t profile[1]; - sdp_list_t *proto[2]; - int status; - - session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0); - if (!session) { - syslog(LOG_ERR, "Failed to connect to the local SDP server. %s(%d)", - strerror(errno), errno); - return -1; - } - - record = sdp_record_alloc(); - if (!record) { - syslog(LOG_ERR, "Failed to alloc service record"); - return -1; - } - - sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP); - root = sdp_list_append(NULL, &root_uuid); - sdp_set_browse_groups(record, root); - - sdp_uuid16_create(&l2cap, L2CAP_UUID); - proto[0] = sdp_list_append(NULL, &l2cap); - apseq = sdp_list_append(NULL, proto[0]); - - sdp_uuid16_create(&rfcomm, RFCOMM_UUID); - proto[1] = sdp_list_append(NULL, &rfcomm); - proto[1] = sdp_list_append(proto[1], sdp_data_alloc(SDP_UINT8, &channel)); - apseq = sdp_list_append(apseq, proto[1]); - - aproto = sdp_list_append(NULL, apseq); - sdp_set_access_protos(record, aproto); - - switch (type) { - case MROUTER: - sdp_uuid16_create(&dun, SERIAL_PORT_SVCLASS_ID); - break; - case ACTIVESYNC: - sdp_uuid128_create(&dun, (void *) async_uuid); - break; - case DIALUP: - sdp_uuid16_create(&dun, DIALUP_NET_SVCLASS_ID); - break; - default: - sdp_uuid16_create(&dun, LAN_ACCESS_SVCLASS_ID); - break; - } - - svclass = sdp_list_append(NULL, &dun); - sdp_set_service_classes(record, svclass); - - switch (type) { - case LANACCESS: - sdp_uuid16_create(&profile[0].uuid, LAN_ACCESS_PROFILE_ID); - profile[0].version = 0x0100; - pfseq = sdp_list_append(NULL, &profile[0]); - sdp_set_profile_descs(record, pfseq); - break; - case DIALUP: - sdp_uuid16_create(&profile[0].uuid, DIALUP_NET_PROFILE_ID); - profile[0].version = 0x0100; - pfseq = sdp_list_append(NULL, &profile[0]); - sdp_set_profile_descs(record, pfseq); - break; - } - - switch (type) { - case MROUTER: - sdp_set_info_attr(record, "mRouter", NULL, NULL); - break; - case ACTIVESYNC: - sdp_set_info_attr(record, "ActiveSync", NULL, NULL); - break; - case DIALUP: - sdp_set_info_attr(record, "Dialup Networking", NULL, NULL); - break; - default: - sdp_set_info_attr(record, "LAN Access Point", NULL, NULL); - break; - } - - status = sdp_device_record_register(session, device, record, 0); - if (status) { - syslog(LOG_ERR, "SDP registration failed."); - sdp_record_free(record); - record = NULL; - return -1; - } - return 0; -} - -int dun_sdp_search(bdaddr_t *src, bdaddr_t *dst, int *channel, int type) -{ - sdp_session_t *s; - sdp_list_t *srch, *attrs, *rsp; - uuid_t svclass; - uint16_t attr; - int err; - - s = sdp_connect(src, dst, 0); - if (!s) { - syslog(LOG_ERR, "Failed to connect to the SDP server. %s(%d)", - strerror(errno), errno); - return -1; - } - - switch (type) { - case MROUTER: - sdp_uuid16_create(&svclass, SERIAL_PORT_SVCLASS_ID); - break; - case ACTIVESYNC: - sdp_uuid128_create(&svclass, (void *) async_uuid); - break; - case DIALUP: - sdp_uuid16_create(&svclass, DIALUP_NET_SVCLASS_ID); - break; - default: - sdp_uuid16_create(&svclass, LAN_ACCESS_SVCLASS_ID); - break; - } - - srch = sdp_list_append(NULL, &svclass); - - attr = SDP_ATTR_PROTO_DESC_LIST; - attrs = sdp_list_append(NULL, &attr); - - err = sdp_service_search_attr_req(s, srch, SDP_ATTR_REQ_INDIVIDUAL, attrs, &rsp); - - sdp_close(s); - - if (err) - return 0; - - for(; rsp; rsp = rsp->next) { - sdp_record_t *rec = (sdp_record_t *) rsp->data; - sdp_list_t *protos; - - if (!sdp_get_access_protos(rec, &protos)) { - int ch = sdp_get_proto_port(protos, RFCOMM_UUID); - if (ch > 0) { - *channel = ch; - return 1; - } - } - } - - return 0; -} diff --git a/hidd/Makefile.am b/hidd/Makefile.am deleted file mode 100644 index 508372b4..00000000 --- a/hidd/Makefile.am +++ /dev/null @@ -1,22 +0,0 @@ - -if HIDD -bin_PROGRAMS = hidd - -hidd_SOURCES = main.c hidd.h sdp.c fakehid.c - -hidd_LDADD = @BLUEZ_LIBS@ -lm $(top_builddir)/common/libhelper.a -endif - -AM_CFLAGS = @BLUEZ_CFLAGS@ - -INCLUDES = -I$(top_srcdir)/common - -if HIDD -if MANPAGES -man_MANS = hidd.1 -endif -endif - -EXTRA_DIST = hidd.1 fakehid.txt - -MAINTAINERCLEANFILES = Makefile.in diff --git a/hidd/sdp.c b/hidd/sdp.c deleted file mode 100644 index eaf8c136..00000000 --- a/hidd/sdp.c +++ /dev/null @@ -1,352 +0,0 @@ -/* - * - * BlueZ - Bluetooth protocol stack for Linux - * - * Copyright (C) 2003-2008 Marcel Holtmann <marcel@holtmann.org> - * - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA - * - */ - -#ifdef HAVE_CONFIG_H -#include <config.h> -#endif - -#include <stdio.h> -#include <errno.h> -#include <fcntl.h> -#include <unistd.h> -#include <stdlib.h> -#include <string.h> -#include <sys/stat.h> -#include <sys/param.h> -#include <sys/socket.h> - -#include <bluetooth/bluetooth.h> -#include <bluetooth/l2cap.h> -#include <bluetooth/sdp.h> -#include <bluetooth/sdp_lib.h> -#include <bluetooth/hidp.h> - -#include "textfile.h" -#include "hidd.h" - -static void epox_endian_quirk(unsigned char *data, int size) -{ - /* USAGE_PAGE (Keyboard) 05 07 - * USAGE_MINIMUM (0) 19 00 - * USAGE_MAXIMUM (65280) 2A 00 FF <= must be FF 00 - * LOGICAL_MINIMUM (0) 15 00 - * LOGICAL_MAXIMUM (65280) 26 00 FF <= must be FF 00 - */ - unsigned char pattern[] = { 0x05, 0x07, 0x19, 0x00, 0x2a, 0x00, 0xff, - 0x15, 0x00, 0x26, 0x00, 0xff }; - int i; - - if (!data) - return; - - for (i = 0; i < size - sizeof(pattern); i++) { - if (!memcmp(data + i, pattern, sizeof(pattern))) { - data[i + 5] = 0xff; - data[i + 6] = 0x00; - data[i + 10] = 0xff; - data[i + 11] = 0x00; - } - } -} - -static int store_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req) -{ - char filename[PATH_MAX + 1], addr[18], *str, *desc; - int i, err, size; - - ba2str(src, addr); - create_name(filename, PATH_MAX, STORAGEDIR, addr, "hidd"); - - size = 15 + 3 + 3 + 5 + (req->rd_size * 2) + 1 + 9 + strlen(req->name) + 2; - str = malloc(size); - if (!str) - return -ENOMEM; - - desc = malloc((req->rd_size * 2) + 1); - if (!desc) { - free(str); - return -ENOMEM; - } - - memset(desc, 0, (req->rd_size * 2) + 1); - for (i = 0; i < req->rd_size; i++) - sprintf(desc + (i * 2), "%2.2X", req->rd_data[i]); - - snprintf(str, size - 1, "%04X:%04X:%04X %02X %02X %04X %s %08X %s", - req->vendor, req->product, req->version, - req->subclass, req->country, req->parser, desc, - req->flags, req->name); - - free(desc); - - create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); - - ba2str(dst, addr); - err = textfile_put(filename, addr, str); - - free(str); - - return err; -} - -int get_stored_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req) -{ - char filename[PATH_MAX + 1], addr[18], tmp[3], *str, *desc; - unsigned int vendor, product, version, subclass, country, parser, pos; - int i; - - desc = malloc(4096); - if (!desc) - return -ENOMEM; - - memset(desc, 0, 4096); - - ba2str(src, addr); - create_name(filename, PATH_MAX, STORAGEDIR, addr, "hidd"); - - ba2str(dst, addr); - str = textfile_get(filename, addr); - if (!str) { - free(desc); - return -EIO; - } - - sscanf(str, "%04X:%04X:%04X %02X %02X %04X %4095s %08X %n", - &vendor, &product, &version, &subclass, &country, - &parser, desc, &req->flags, &pos); - - free(str); - - req->vendor = vendor; - req->product = product; - req->version = version; - req->subclass = subclass; - req->country = country; - req->parser = parser; - - snprintf(req->name, 128, str + pos); - - req->rd_size = strlen(desc) / 2; - req->rd_data = malloc(req->rd_size); - if (!req->rd_data) { - free(desc); - return -ENOMEM; - } - - memset(tmp, 0, sizeof(tmp)); - for (i = 0; i < req->rd_size; i++) { - memcpy(tmp, desc + (i * 2), 2); - req->rd_data[i] = (uint8_t) strtol(tmp, NULL, 16); - } - - free(desc); - - return 0; -} - -int get_sdp_device_info(const bdaddr_t *src, const bdaddr_t *dst, struct hidp_connadd_req *req) -{ - struct sockaddr_l2 addr; - socklen_t addrlen; - bdaddr_t bdaddr; - uint32_t range = 0x0000ffff; - sdp_session_t *s; - sdp_list_t *search, *attrid, *pnp_rsp, *hid_rsp; - sdp_record_t *rec; - sdp_data_t *pdlist, *pdlist2; - uuid_t svclass; - int err; - - s = sdp_connect(src, dst, SDP_RETRY_IF_BUSY | SDP_WAIT_ON_CLOSE); - if (!s) - return -1; - - sdp_uuid16_create(&svclass, PNP_INFO_SVCLASS_ID); - search = sdp_list_append(NULL, &svclass); - attrid = sdp_list_append(NULL, &range); - - err = sdp_service_search_attr_req(s, search, - SDP_ATTR_REQ_RANGE, attrid, &pnp_rsp); - - sdp_list_free(search, NULL); - sdp_list_free(attrid, NULL); - - sdp_uuid16_create(&svclass, HID_SVCLASS_ID); - search = sdp_list_append(NULL, &svclass); - attrid = sdp_list_append(NULL, &range); - - err = sdp_service_search_attr_req(s, search, - SDP_ATTR_REQ_RANGE, attrid, &hid_rsp); - - sdp_list_free(search, NULL); - sdp_list_free(attrid, NULL); - - memset(&addr, 0, sizeof(addr)); - addrlen = sizeof(addr); - - if (getsockname(s->sock, (struct sockaddr *) &addr, &addrlen) < 0) - bacpy(&bdaddr, src); - else - bacpy(&bdaddr, &addr.l2_bdaddr); - - sdp_close(s); - - if (err || !hid_rsp) - return -1; - - if (pnp_rsp) { - rec = (sdp_record_t *) pnp_rsp->data; - - pdlist = sdp_data_get(rec, 0x0201); - req->vendor = pdlist ? pdlist->val.uint16 : 0x0000; - - pdlist = sdp_data_get(rec, 0x0202); - req->product = pdlist ? pdlist->val.uint16 : 0x0000; - - pdlist = sdp_data_get(rec, 0x0203); - req->version = pdlist ? pdlist->val.uint16 : 0x0000; - - sdp_record_free(rec); - } - - rec = (sdp_record_t *) hid_rsp->data; - - pdlist = sdp_data_get(rec, 0x0101); - pdlist2 = sdp_data_get(rec, 0x0102); - if (pdlist) { - if (pdlist2) { - if (strncmp(pdlist->val.str, pdlist2->val.str, 5)) { - strncpy(req->name, pdlist2->val.str, sizeof(req->name) - 1); - strcat(req->name, " "); - } - strncat(req->name, pdlist->val.str, - sizeof(req->name) - strlen(req->name)); - } else - strncpy(req->name, pdlist->val.str, sizeof(req->name)); - } else { - pdlist2 = sdp_data_get(rec, 0x0100); - if (pdlist2) - strncpy(req->name, pdlist2->val.str, sizeof(req->name)); - } - - pdlist = sdp_data_get(rec, 0x0201); - req->parser = pdlist ? pdlist->val.uint16 : 0x0100; - - pdlist = sdp_data_get(rec, 0x0202); - req->subclass = pdlist ? pdlist->val.uint8 : 0; - - pdlist = sdp_data_get(rec, 0x0203); - req->country = pdlist ? pdlist->val.uint8 : 0; - - pdlist = sdp_data_get(rec, 0x0206); - if (pdlist) { - pdlist = pdlist->val.dataseq; - pdlist = pdlist->val.dataseq; - pdlist = pdlist->next; - - req->rd_data = malloc(pdlist->unitSize); - if (req->rd_data) { - memcpy(req->rd_data, (unsigned char *) pdlist->val.str, pdlist->unitSize); - req->rd_size = pdlist->unitSize; - epox_endian_quirk(req->rd_data, req->rd_size); - } - } - - sdp_record_free(rec); - - if (bacmp(&bdaddr, BDADDR_ANY)) - store_device_info(&bdaddr, dst, req); - - return 0; -} - -int get_alternate_device_info(const bdaddr_t *src, const bdaddr_t *dst, uint16_t *uuid, uint8_t *channel, char *name, size_t len) -{ - uint16_t attr1 = SDP_ATTR_PROTO_DESC_LIST; - uint16_t attr2 = SDP_ATTR_SVCNAME_PRIMARY; - sdp_session_t *s; - sdp_list_t *search, *attrid, *rsp; - uuid_t svclass; - int err; - - s = sdp_connect(src, dst, SDP_RETRY_IF_BUSY | SDP_WAIT_ON_CLOSE); - if (!s) - return -1; - - sdp_uuid16_create(&svclass, HEADSET_SVCLASS_ID); - search = sdp_list_append(NULL, &svclass); - attrid = sdp_list_append(NULL, &attr1); - attrid = sdp_list_append(attrid, &attr2); - - err = sdp_service_search_attr_req(s, search, - SDP_ATTR_REQ_INDIVIDUAL, attrid, &rsp); - - sdp_list_free(search, NULL); - sdp_list_free(attrid, NULL); - - if (err <= 0) { - sdp_uuid16_create(&svclass, SERIAL_PORT_SVCLASS_ID); - search = sdp_list_append(NULL, &svclass); - attrid = sdp_list_append(NULL, &attr1); - attrid = sdp_list_append(attrid, &attr2); - - err = sdp_service_search_attr_req(s, search, - SDP_ATTR_REQ_INDIVIDUAL, attrid, &rsp); - - sdp_list_free(search, NULL); - sdp_list_free(attrid, NULL); - - if (err < 0) { - sdp_close(s); - return err; - } - - if (uuid) - *uuid = SERIAL_PORT_SVCLASS_ID; - } else { - if (uuid) - *uuid = HEADSET_SVCLASS_ID; - } - - sdp_close(s); - - for (; rsp; rsp = rsp->next) { - sdp_record_t *rec = (sdp_record_t *) rsp->data; - sdp_list_t *protos; - - sdp_get_service_name(rec, name, len); - - if (!sdp_get_access_protos(rec, &protos)) { - uint8_t ch = sdp_get_proto_port(protos, RFCOMM_UUID); - if (ch > 0) { - if (channel) - *channel = ch; - return 0; - } - } - - sdp_record_free(rec); - } - - return -EIO; -} diff --git a/pand/Makefile.am b/pand/Makefile.am deleted file mode 100644 index 85d70542..00000000 --- a/pand/Makefile.am +++ /dev/null @@ -1,22 +0,0 @@ - -if PAND -bin_PROGRAMS = pand - -pand_SOURCES = main.c pand.h bnep.c sdp.c - -pand_LDADD = @BLUEZ_LIBS@ -endif - -AM_CFLAGS = @BLUEZ_CFLAGS@ - -INCLUDES = -I$(top_srcdir)/common - -if PAND -if MANPAGES -man_MANS = pand.1 -endif -endif - -EXTRA_DIST = pand.1 - -MAINTAINERCLEANFILES = Makefile.in diff --git a/pand/sdp.c b/pand/sdp.c deleted file mode 100644 index 05e2e182..00000000 --- a/pand/sdp.c +++ /dev/null @@ -1,247 +0,0 @@ -/* - * - * BlueZ - Bluetooth protocol stack for Linux - * - * Copyright (C) 2002-2003 Maxim Krasnyansky <maxk@qualcomm.com> - * Copyright (C) 2002-2008 Marcel Holtmann <marcel@holtmann.org> - * - * - * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License as published by - * the Free Software Foundation; either version 2 of the License, or - * (at your option) any later version. - * - * This program is distributed in the hope that it will be useful, - * but WITHOUT ANY WARRANTY; without even the implied warranty of - * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the - * GNU General Public License for more details. - * - * You should have received a copy of the GNU General Public License - * along with this program; if not, write to the Free Software - * Foundation, Inc., 51 Franklin St, Fifth Floor, Boston, MA 02110-1301 USA - * - */ - -#ifdef HAVE_CONFIG_H -#include <config.h> -#endif - -#include <stdio.h> -#include <errno.h> -#include <unistd.h> -#include <stdlib.h> -#include <string.h> -#include <syslog.h> -#include <sys/types.h> -#include <sys/socket.h> - -#include <bluetooth/bluetooth.h> -#include <bluetooth/sdp.h> -#include <bluetooth/sdp_lib.h> -#include <bluetooth/bnep.h> - -#include "pand.h" - -static sdp_record_t *record; -static sdp_session_t *session; - -void bnep_sdp_unregister(void) -{ - if (record && sdp_record_unregister(session, record)) - syslog(LOG_ERR, "Service record unregistration failed."); - - sdp_close(session); -} - -static void add_lang_attr(sdp_record_t *r) -{ - sdp_lang_attr_t base_lang; - sdp_list_t *langs = 0; - - /* UTF-8 MIBenum (http://www.iana.org/assignments/character-sets) */ - base_lang.code_ISO639 = (0x65 << 8) | 0x6e; - base_lang.encoding = 106; - base_lang.base_offset = SDP_PRIMARY_LANG_BASE; - langs = sdp_list_append(0, &base_lang); - sdp_set_lang_attr(r, langs); - sdp_list_free(langs, 0); -} - -int bnep_sdp_register(bdaddr_t *device, uint16_t role) -{ - sdp_list_t *svclass, *pfseq, *apseq, *root, *aproto; - uuid_t root_uuid, pan, l2cap, bnep; - sdp_profile_desc_t profile[1]; - sdp_list_t *proto[2]; - sdp_data_t *v, *p; - uint16_t psm = 15, version = 0x0100; - uint16_t security_desc = 0; - uint16_t net_access_type = 0xfffe; - uint32_t max_net_access_rate = 0; - char *name = "BlueZ PAN"; - char *desc = "BlueZ PAN Service"; - int status; - - session = sdp_connect(BDADDR_ANY, BDADDR_LOCAL, 0); - if (!session) { - syslog(LOG_ERR, "Failed to connect to the local SDP server. %s(%d)", - strerror(errno), errno); - return -1; - } - - record = sdp_record_alloc(); - if (!record) { - syslog(LOG_ERR, "Failed to allocate service record %s(%d)", - strerror(errno), errno); - sdp_close(session); - return -1; - } - - sdp_uuid16_create(&root_uuid, PUBLIC_BROWSE_GROUP); - root = sdp_list_append(NULL, &root_uuid); - sdp_set_browse_groups(record, root); - sdp_list_free(root, 0); - - sdp_uuid16_create(&l2cap, L2CAP_UUID); - proto[0] = sdp_list_append(NULL, &l2cap); - p = sdp_data_alloc(SDP_UINT16, &psm); - proto[0] = sdp_list_append(proto[0], p); - apseq = sdp_list_append(NULL, proto[0]); - - sdp_uuid16_create(&bnep, BNEP_UUID); - proto[1] = sdp_list_append(NULL, &bnep); - v = sdp_data_alloc(SDP_UINT16, &version); - proto[1] = sdp_list_append(proto[1], v); - - /* Supported protocols */ - { - uint16_t ptype[4] = { - 0x0800, /* IPv4 */ - 0x0806, /* ARP */ - }; - sdp_data_t *head, *pseq; - int p; - - for (p = 0, head = NULL; p < 2; p++) { - sdp_data_t *data = sdp_data_alloc(SDP_UINT16, &ptype[p]); - if (head) - sdp_seq_append(head, data); - else - head = data; - } - pseq = sdp_data_alloc(SDP_SEQ16, head); - proto[1] = sdp_list_append(proto[1], pseq); - } - - apseq = sdp_list_append(apseq, proto[1]); - - aproto = sdp_list_append(NULL, apseq); - sdp_set_access_protos(record, aproto); - - add_lang_attr(record); - - sdp_list_free(proto[0], NULL); - sdp_list_free(proto[1], NULL); - sdp_list_free(apseq, NULL); - sdp_list_free(aproto, NULL); - sdp_data_free(p); - sdp_data_free(v); - sdp_attr_add_new(record, SDP_ATTR_SECURITY_DESC, SDP_UINT16, &security_desc); - - switch (role) { - case BNEP_SVC_NAP: - sdp_uuid16_create(&pan, NAP_SVCLASS_ID); - svclass = sdp_list_append(NULL, &pan); - sdp_set_service_classes(record, svclass); - - sdp_uuid16_create(&profile[0].uuid, NAP_PROFILE_ID); - profile[0].version = 0x0100; - pfseq = sdp_list_append(NULL, &profile[0]); - sdp_set_profile_descs(record, pfseq); - - sdp_set_info_attr(record, "Network Access Point", name, desc); - - sdp_attr_add_new(record, SDP_ATTR_NET_ACCESS_TYPE, SDP_UINT16, &net_access_type); - sdp_attr_add_new(record, SDP_ATTR_MAX_NET_ACCESSRATE, SDP_UINT32, &max_net_access_rate); - break; - - case BNEP_SVC_GN: - sdp_uuid16_create(&pan, GN_SVCLASS_ID); - svclass = sdp_list_append(NULL, &pan); - sdp_set_service_classes(record, svclass); - - sdp_uuid16_create(&profile[0].uuid, GN_PROFILE_ID); - profile[0].version = 0x0100; - pfseq = sdp_list_append(NULL, &profile[0]); - sdp_set_profile_descs(record, pfseq); - - sdp_set_info_attr(record, "Group Network Service", name, desc); - break; - - case BNEP_SVC_PANU: - sdp_uuid16_create(&pan, PANU_SVCLASS_ID); - svclass = sdp_list_append(NULL, &pan); - sdp_set_service_classes(record, svclass); - sdp_list_free(svclass, 0); - - sdp_uuid16_create(&profile[0].uuid, PANU_PROFILE_ID); - profile[0].version = 0x0100; - pfseq = sdp_list_append(NULL, &profile[0]); - sdp_set_profile_descs(record, pfseq); - sdp_list_free(pfseq, 0); - - sdp_set_info_attr(record, "PAN User", name, desc); - break; - } - - status = sdp_device_record_register(session, device, record, 0); - if (status) { - syslog(LOG_ERR, "SDP registration failed."); - sdp_record_free(record); record = NULL; - sdp_close(session); - return -1; - } - - return 0; -} - -/* Search for PAN service. - * Returns 1 if service is found and 0 otherwise. */ -int bnep_sdp_search(bdaddr_t *src, bdaddr_t *dst, uint16_t service) -{ - sdp_list_t *srch, *rsp = NULL; - sdp_session_t *s; - uuid_t svclass; - int err; - - switch (service) { - case BNEP_SVC_PANU: - sdp_uuid16_create(&svclass, PANU_SVCLASS_ID); - break; - case BNEP_SVC_NAP: - sdp_uuid16_create(&svclass, NAP_SVCLASS_ID); - break; - case BNEP_SVC_GN: - sdp_uuid16_create(&svclass, GN_SVCLASS_ID); - break; - } - - srch = sdp_list_append(NULL, &svclass); - - s = sdp_connect(src, dst, 0); - if (!s) { - syslog(LOG_ERR, "Failed to connect to the SDP server. %s(%d)", - strerror(errno), errno); - return 0; - } - - err = sdp_service_search_req(s, srch, 1, &rsp); - sdp_close(s); - - /* Assume that search is successeful - * if at least one record is found */ - if (!err && sdp_list_len(rsp)) - return 1; - - return 0; -} |