diff options
author | Luiz Augusto von Dentz <luiz.dentz@indt.org.br> | 2008-07-09 11:28:03 -0300 |
---|---|---|
committer | Luiz Augusto von Dentz <luiz.dentz@indt.org.br> | 2008-07-28 10:33:35 -0300 |
commit | 4e63689794eaa0d5a3567efa8d150110aa648504 (patch) | |
tree | eb5ad3530315ecf0a2f1401ca8a5ce93f460f2d1 | |
parent | 670eacd442dd0d7fbaecd552cfb5ca32eaccea0e (diff) |
Cleanup device.c and move adapter initialization to manager.c.
-rw-r--r-- | hcid/dbus-hci.c | 3 | ||||
-rw-r--r-- | hcid/device.c | 690 | ||||
-rw-r--r-- | hcid/manager.c | 666 |
3 files changed, 678 insertions, 681 deletions
diff --git a/hcid/dbus-hci.c b/hcid/dbus-hci.c index 3f7178d6..ccab4077 100644 --- a/hcid/dbus-hci.c +++ b/hcid/dbus-hci.c @@ -630,8 +630,7 @@ int hcid_dbus_start_device(uint16_t id) if (manager_get_default_adapter() < 0) manager_set_default_adapter(id); - if (hcid_dbus_use_experimental()) - register_devices(&di.bdaddr, adapter); + register_devices(&di.bdaddr, adapter); failed: if (dd >= 0) diff --git a/hcid/device.c b/hcid/device.c index c9160d58..07c294d4 100644 --- a/hcid/device.c +++ b/hcid/device.c @@ -52,7 +52,6 @@ #include "logging.h" #include "textfile.h" -#include "oui.h" #include "adapter.h" #include "device.h" @@ -65,7 +64,6 @@ #include "sdp-xml.h" #define DEFAULT_XML_BUF_SIZE 1024 -#define MAX_DEVICES 16 #define DISCONNECT_TIMER 2 #define DEVICE_INTERFACE "org.bluez.Device" @@ -80,53 +78,6 @@ struct browse_req { gboolean browse; }; -struct hci_peer { - struct timeval lastseen; - struct timeval lastused; - - bdaddr_t bdaddr; - uint32_t class; - int8_t rssi; - uint8_t data[240]; - uint8_t name[248]; - - uint8_t pscan_rep_mode; - uint8_t pscan_period_mode; - uint8_t pscan_mode; - uint16_t clock_offset; - - struct hci_peer *next; -}; - -struct hci_conn { - bdaddr_t bdaddr; - uint16_t handle; - - struct hci_conn *next; -}; - -struct hci_dev { - int ignore; - - bdaddr_t bdaddr; - uint8_t features[8]; - uint8_t lmp_ver; - uint16_t lmp_subver; - uint16_t hci_rev; - uint16_t manufacturer; - - uint8_t ssp_mode; - uint8_t name[248]; - uint8_t class[3]; - - struct hci_peer *peers; - struct hci_conn *conns; -}; - -static struct hci_dev devices[MAX_DEVICES]; - -#define ASSERT_DEV_ID { if (dev_id >= MAX_DEVICES) return -ERANGE; } - static GSList *drivers = NULL; static uint16_t uuid_list[] = { @@ -138,635 +89,6 @@ static uint16_t uuid_list[] = { 0 }; -void init_adapters(void) -{ - int i; - - for (i = 0; i < MAX_DEVICES; i++) - memset(devices + i, 0, sizeof(struct hci_dev)); -} - -static int device_read_bdaddr(uint16_t dev_id, bdaddr_t *bdaddr) -{ - int dd, err; - - dd = hci_open_dev(dev_id); - if (dd < 0) { - err = errno; - error("Can't open device hci%d: %s (%d)", - dev_id, strerror(err), err); - return -err; - } - - if (hci_read_bd_addr(dd, bdaddr, 2000) < 0) { - err = errno; - error("Can't read address for hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - hci_close_dev(dd); - - return 0; -} - -int add_adapter(uint16_t dev_id) -{ - struct hci_dev *dev; - struct hci_dev_info di; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - if (hci_devinfo(dev_id, &di) < 0) { - dev->ignore = 1; - return -errno; - } - - if (hci_test_bit(HCI_RAW, &di.flags)) { - info("Device hci%d is using raw mode", dev_id); - dev->ignore = 1; - } - - if (bacmp(&di.bdaddr, BDADDR_ANY)) - bacpy(&dev->bdaddr, &di.bdaddr); - else { - int err = device_read_bdaddr(dev_id, &dev->bdaddr); - if (err < 0) - return err; - } - memcpy(dev->features, di.features, 8); - - info("Device hci%d has been added", dev_id); - - return 0; -} - -int remove_adapter(uint16_t dev_id) -{ - struct hci_dev *dev; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - memset(dev, 0, sizeof(struct hci_dev)); - - info("Device hci%d has been removed", dev_id); - - return 0; -} - -static inline uint8_t get_inquiry_mode(struct hci_dev *dev) -{ - if (dev->features[6] & LMP_EXT_INQ) - return 2; - - if (dev->features[3] & LMP_RSSI_INQ) - return 1; - - if (dev->manufacturer == 11 && - dev->hci_rev == 0x00 && dev->lmp_subver == 0x0757) - return 1; - - if (dev->manufacturer == 15) { - if (dev->hci_rev == 0x03 && dev->lmp_subver == 0x6963) - return 1; - if (dev->hci_rev == 0x09 && dev->lmp_subver == 0x6963) - return 1; - if (dev->hci_rev == 0x00 && dev->lmp_subver == 0x6965) - return 1; - } - - if (dev->manufacturer == 31 && - dev->hci_rev == 0x2005 && dev->lmp_subver == 0x1805) - return 1; - - return 0; -} - -static void update_ext_inquiry_response(int dd, struct hci_dev *dev) -{ - uint8_t fec = 0, data[240]; - - if (!(dev->features[6] & LMP_EXT_INQ)) - return; - - memset(data, 0, sizeof(data)); - - if (dev->ssp_mode > 0) - create_ext_inquiry_response((char *) dev->name, data); - - if (hci_write_ext_inquiry_response(dd, fec, data, 2000) < 0) - error("Can't write extended inquiry response: %s (%d)", - strerror(errno), errno); -} - -int start_adapter(uint16_t dev_id) -{ - struct hci_dev *dev; - struct hci_version ver; - uint8_t features[8], inqmode; - uint8_t events[8] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0x1f, 0x00, 0x00 }; - char name[249]; - int dd, err; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - if (dev->ignore) - return 0; - - dd = hci_open_dev(dev_id); - if (dd < 0) { - err = errno; - error("Can't open device hci%d: %s (%d)", - dev_id, strerror(err), err); - return -err; - } - - if (hci_read_local_version(dd, &ver, 1000) < 0) { - err = errno; - error("Can't read version info for hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - dev->hci_rev = ver.hci_rev; - dev->lmp_ver = ver.lmp_ver; - dev->lmp_subver = ver.lmp_subver; - dev->manufacturer = ver.manufacturer; - - if (hci_read_local_features(dd, features, 1000) < 0) { - err = errno; - error("Can't read features for hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - memcpy(dev->features, features, 8); - - if (hci_read_class_of_dev(dd, dev->class, 1000) < 0) { - err = errno; - error("Can't read class of device on hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - if (hci_read_local_name(dd, sizeof(name), name, 2000) < 0) { - err = errno; - error("Can't read local name on hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - memcpy(dev->name, name, 248); - - if (!(features[6] & LMP_SIMPLE_PAIR)) - goto setup; - - if (hcid_dbus_use_experimental()) { - if (ioctl(dd, HCIGETAUTHINFO, NULL) < 0 && errno != EINVAL) - hci_write_simple_pairing_mode(dd, 0x01, 2000); - } - - if (hci_read_simple_pairing_mode(dd, &dev->ssp_mode, 1000) < 0) { - err = errno; - error("Can't read simple pairing mode on hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - -setup: - if (ver.hci_rev > 1) { - if (features[5] & LMP_SNIFF_SUBR) - events[5] |= 0x20; - - if (features[5] & LMP_PAUSE_ENC) - events[5] |= 0x80; - - if (features[6] & LMP_EXT_INQ) - events[5] |= 0x40; - - if (features[6] & LMP_NFLUSH_PKTS) - events[7] |= 0x01; - - if (features[7] & LMP_LSTO) - events[6] |= 0x80; - - if (features[6] & LMP_SIMPLE_PAIR) { - events[6] |= 0x01; /* IO Capability Request */ - events[6] |= 0x02; /* IO Capability Response */ - events[6] |= 0x04; /* User Confirmation Request */ - events[6] |= 0x08; /* User Passkey Request */ - events[6] |= 0x10; /* Remote OOB Data Request */ - events[6] |= 0x20; /* Simple Pairing Complete */ - events[7] |= 0x04; /* User Passkey Notification */ - events[7] |= 0x08; /* Keypress Notification */ - events[7] |= 0x10; /* Remote Host Supported Features Notification */ - } - - hci_send_cmd(dd, OGF_HOST_CTL, OCF_SET_EVENT_MASK, - sizeof(events), events); - } - - if (read_local_name(&dev->bdaddr, name) == 0) { - memcpy(dev->name, name, 248); - hci_write_local_name(dd, name, 5000); - } - - update_ext_inquiry_response(dd, dev); - - inqmode = get_inquiry_mode(dev); - if (inqmode < 1) - goto done; - - if (hci_write_inquiry_mode(dd, inqmode, 2000) < 0) { - err = errno; - error("Can't write inquiry mode for hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - -done: - hci_close_dev(dd); - - info("Device hci%d has been activated", dev_id); - - return 0; -} - -int stop_adapter(uint16_t dev_id) -{ - ASSERT_DEV_ID; - - info("Device hci%d has been disabled", dev_id); - - return 0; -} - -int update_adapter(uint16_t dev_id) -{ - struct hci_dev *dev; - int dd; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - if (dev->ignore) - return 0; - - dd = hci_open_dev(dev_id); - if (dd < 0) { - int err = errno; - error("Can't open device hci%d: %s (%d)", - dev_id, strerror(err), err); - return -err; - } - - update_ext_inquiry_response(dd, dev); - - hci_close_dev(dd); - - return 0; -} - -int get_device_address(uint16_t dev_id, char *address, size_t size) -{ - struct hci_dev *dev; - - ASSERT_DEV_ID; - - if (size < 18) - return -ENOBUFS; - - dev = &devices[dev_id]; - - return ba2str(&dev->bdaddr, address); -} - -int get_device_class(uint16_t dev_id, uint8_t *cls) -{ - struct hci_dev *dev; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - memcpy(cls, dev->class, 3); - - return 0; -} - -int set_device_class(uint16_t dev_id, uint8_t *cls) -{ - struct hci_dev *dev; - - ASSERT_DEV_ID; - dev = &devices[dev_id]; - memcpy(dev->class, cls, 3); - - return 0; -} - -int get_device_version(uint16_t dev_id, char *version, size_t size) -{ - struct hci_dev *dev; - char edr[7], *tmp; - int err; - - ASSERT_DEV_ID; - - if (size < 14) - return -ENOBUFS; - - dev = &devices[dev_id]; - - if ((dev->lmp_ver == 0x03 || dev->lmp_ver == 0x04) && - (dev->features[3] & (LMP_EDR_ACL_2M | LMP_EDR_ACL_3M))) - sprintf(edr, " + EDR"); - else - edr[0] = '\0'; - - tmp = lmp_vertostr(dev->lmp_ver); - - if (strlen(tmp) == 0) - err = snprintf(version, size, "not assigned"); - else - err = snprintf(version, size, "Bluetooth %s%s", tmp, edr); - - bt_free(tmp); - - return err; -} - -static int digi_revision(uint16_t dev_id, char *revision, size_t size) -{ - struct hci_request rq; - unsigned char req[] = { 0x07 }; - unsigned char buf[102]; - int dd, err; - - dd = hci_open_dev(dev_id); - if (dd < 0) { - err = errno; - error("Can't open device hci%d: %s (%d)", - dev_id, strerror(err), err); - return -err; - } - - memset(&rq, 0, sizeof(rq)); - rq.ogf = OGF_VENDOR_CMD; - rq.ocf = 0x000e; - rq.cparam = req; - rq.clen = sizeof(req); - rq.rparam = &buf; - rq.rlen = sizeof(buf); - - if (hci_send_req(dd, &rq, 2000) < 0) { - err = errno; - error("Can't read revision for hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - hci_close_dev(dd); - - return snprintf(revision, size, "%s", buf + 1); -} - -int get_device_revision(uint16_t dev_id, char *revision, size_t size) -{ - struct hci_dev *dev; - int err; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - switch (dev->manufacturer) { - case 10: - err = snprintf(revision, size, "Build %d", dev->lmp_subver); - break; - case 12: - err = digi_revision(dev_id, revision, size); - break; - case 15: - err = snprintf(revision, size, "%d.%d / %d", - dev->hci_rev & 0xff, - dev->lmp_subver >> 8, dev->lmp_subver & 0xff); - break; - default: - err = snprintf(revision, size, "0x%02x", dev->lmp_subver); - break; - } - - return err; -} - -int get_device_manufacturer(uint16_t dev_id, char *manufacturer, size_t size) -{ - char *tmp; - - ASSERT_DEV_ID; - - tmp = bt_compidtostr(devices[dev_id].manufacturer); - - return snprintf(manufacturer, size, "%s", tmp); -} - -int get_device_company(uint16_t dev_id, char *company, size_t size) -{ - char *tmp, oui[9]; - int err; - - ASSERT_DEV_ID; - - ba2oui(&devices[dev_id].bdaddr, oui); - tmp = ouitocomp(oui); - - err = snprintf(company, size, "%s", tmp); - - free(tmp); - - return err; -} - -int set_simple_pairing_mode(uint16_t dev_id, uint8_t mode) -{ - struct hci_dev *dev; - int dd; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - dev->ssp_mode = mode; - - dd = hci_open_dev(dev_id); - if (dd < 0) { - int err = errno; - error("Can't open device hci%d: %s (%d)", - dev_id, strerror(err), err); - return -err; - } - - update_ext_inquiry_response(dd, dev); - - hci_close_dev(dd); - - return 0; -} - -int get_device_name(uint16_t dev_id, char *name, size_t size) -{ - char tmp[249]; - int dd, err; - - ASSERT_DEV_ID; - - memset(tmp, 0, sizeof(tmp)); - - dd = hci_open_dev(dev_id); - if (dd < 0) { - err = errno; - error("Can't open device hci%d: %s (%d)", - dev_id, strerror(err), err); - return -err; - } - - if (hci_read_local_name(dd, sizeof(tmp), tmp, 2000) < 0) { - err = errno; - error("Can't read name for hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - hci_close_dev(dd); - - memcpy(devices[dev_id].name, tmp, 248); - - return snprintf(name, size, "%s", tmp); -} - -int set_device_name(uint16_t dev_id, const char *name) -{ - struct hci_dev *dev; - int dd, err; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - dd = hci_open_dev(dev_id); - if (dd < 0) { - err = errno; - error("Can't open device hci%d: %s (%d)", - dev_id, strerror(err), err); - return -err; - } - - if (hci_write_local_name(dd, name, 5000) < 0) { - err = errno; - error("Can't write name for hci%d: %s (%d)", - dev_id, strerror(err), err); - hci_close_dev(dd); - return -err; - } - - strncpy((char *) dev->name, name, 248); - - update_ext_inquiry_response(dd, dev); - - hci_close_dev(dd); - - return 0; -} - -int get_device_alias(uint16_t dev_id, const bdaddr_t *bdaddr, char *alias, size_t size) -{ - char filename[PATH_MAX + 1], addr[18], *tmp; - int err; - - ASSERT_DEV_ID; - - ba2str(&devices[dev_id].bdaddr, addr); - create_name(filename, PATH_MAX, STORAGEDIR, addr, "aliases"); - - ba2str(bdaddr, addr); - - tmp = textfile_get(filename, addr); - if (!tmp) - return -ENXIO; - - err = snprintf(alias, size, "%s", tmp); - - free(tmp); - - return err; -} - -int set_device_alias(uint16_t dev_id, const bdaddr_t *bdaddr, const char *alias) -{ - char filename[PATH_MAX + 1], addr[18]; - - ASSERT_DEV_ID; - - ba2str(&devices[dev_id].bdaddr, addr); - create_name(filename, PATH_MAX, STORAGEDIR, addr, "aliases"); - - create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); - - ba2str(bdaddr, addr); - - return textfile_put(filename, addr, alias); -} - -int remove_device_alias(uint16_t dev_id, const bdaddr_t *bdaddr) -{ - char filename[PATH_MAX + 1], addr[18]; - - ASSERT_DEV_ID; - - ba2str(&devices[dev_id].bdaddr, addr); - create_name(filename, PATH_MAX, STORAGEDIR, addr, "aliases"); - - create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); - - ba2str(bdaddr, addr); - - return textfile_del(filename, addr); -} - -int get_encryption_key_size(uint16_t dev_id, const bdaddr_t *baddr) -{ - struct hci_dev *dev; - int size; - - ASSERT_DEV_ID; - - dev = &devices[dev_id]; - - switch (dev->manufacturer) { - default: - size = -ENOENT; - break; - } - - return size; -} - static void device_free(gpointer user_data) { struct device *device = user_data; @@ -908,6 +230,16 @@ static DBusMessage *get_properties(DBusConnection *conn, return reply; } +static int remove_device_alias(const char *source, const char *destination) +{ + char filename[PATH_MAX + 1]; + + create_name(filename, PATH_MAX, STORAGEDIR, source, "aliases"); + create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); + + return textfile_del(filename, destination); +} + static DBusMessage *set_alias(DBusConnection *conn, DBusMessage *msg, const char *alias, void *data) { @@ -924,7 +256,7 @@ static DBusMessage *set_alias(DBusConnection *conn, DBusMessage *msg, create_name(filename, PATH_MAX, STORAGEDIR, adapter->address, "names"); str = textfile_caseget(filename, device->address); - ecode = remove_device_alias(adapter->dev_id, &bdaddr); + ecode = remove_device_alias(adapter->address, device->address); } else { str = g_strdup(alias); ecode = set_device_alias(adapter->dev_id, &bdaddr, alias); diff --git a/hcid/manager.c b/hcid/manager.c index ef357e7f..de80c5e6 100644 --- a/hcid/manager.c +++ b/hcid/manager.c @@ -32,6 +32,7 @@ #include <unistd.h> #include <sys/ioctl.h> #include <sys/socket.h> +#include <sys/stat.h> #include <bluetooth/bluetooth.h> #include <bluetooth/hci.h> @@ -45,6 +46,8 @@ #include <gdbus.h> +#include "logging.h" +#include "textfile.h" #include "hcid.h" #include "sdpd.h" #include "adapter.h" @@ -53,13 +56,676 @@ #include "dbus-hci.h" #include "dbus-database.h" #include "sdp-xml.h" +#include "oui.h" #include "manager.h" +#define MAX_DEVICES 16 + static DBusConnection *connection = NULL; static int default_adapter_id = -1; static GSList *adapters = NULL; +struct hci_peer { + struct timeval lastseen; + struct timeval lastused; + + bdaddr_t bdaddr; + uint32_t class; + int8_t rssi; + uint8_t data[240]; + uint8_t name[248]; + + uint8_t pscan_rep_mode; + uint8_t pscan_period_mode; + uint8_t pscan_mode; + uint16_t clock_offset; + + struct hci_peer *next; +}; + +struct hci_conn { + bdaddr_t bdaddr; + uint16_t handle; + + struct hci_conn *next; +}; + +struct hci_dev { + int ignore; + + bdaddr_t bdaddr; + uint8_t features[8]; + uint8_t lmp_ver; + uint16_t lmp_subver; + uint16_t hci_rev; + uint16_t manufacturer; + + uint8_t ssp_mode; + uint8_t name[248]; + uint8_t class[3]; + + struct hci_peer *peers; + struct hci_conn *conns; +}; + +static struct hci_dev devices[MAX_DEVICES]; + +#define ASSERT_DEV_ID { if (dev_id >= MAX_DEVICES) return -ERANGE; } + +void init_adapters(void) +{ + int i; + + for (i = 0; i < MAX_DEVICES; i++) + memset(devices + i, 0, sizeof(struct hci_dev)); +} + +static int device_read_bdaddr(uint16_t dev_id, bdaddr_t *bdaddr) +{ + int dd, err; + + dd = hci_open_dev(dev_id); + if (dd < 0) { + err = errno; + error("Can't open device hci%d: %s (%d)", + dev_id, strerror(err), err); + return -err; + } + + if (hci_read_bd_addr(dd, bdaddr, 2000) < 0) { + err = errno; + error("Can't read address for hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + hci_close_dev(dd); + + return 0; +} + +int add_adapter(uint16_t dev_id) +{ + struct hci_dev *dev; + struct hci_dev_info di; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + if (hci_devinfo(dev_id, &di) < 0) { + dev->ignore = 1; + return -errno; + } + + if (hci_test_bit(HCI_RAW, &di.flags)) { + info("Device hci%d is using raw mode", dev_id); + dev->ignore = 1; + } + + if (bacmp(&di.bdaddr, BDADDR_ANY)) + bacpy(&dev->bdaddr, &di.bdaddr); + else { + int err = device_read_bdaddr(dev_id, &dev->bdaddr); + if (err < 0) + return err; + } + memcpy(dev->features, di.features, 8); + + info("Device hci%d has been added", dev_id); + + return 0; +} + +int remove_adapter(uint16_t dev_id) +{ + struct hci_dev *dev; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + memset(dev, 0, sizeof(struct hci_dev)); + + info("Device hci%d has been removed", dev_id); + + return 0; +} + +static inline uint8_t get_inquiry_mode(struct hci_dev *dev) +{ + if (dev->features[6] & LMP_EXT_INQ) + return 2; + + if (dev->features[3] & LMP_RSSI_INQ) + return 1; + + if (dev->manufacturer == 11 && + dev->hci_rev == 0x00 && dev->lmp_subver == 0x0757) + return 1; + + if (dev->manufacturer == 15) { + if (dev->hci_rev == 0x03 && dev->lmp_subver == 0x6963) + return 1; + if (dev->hci_rev == 0x09 && dev->lmp_subver == 0x6963) + return 1; + if (dev->hci_rev == 0x00 && dev->lmp_subver == 0x6965) + return 1; + } + + if (dev->manufacturer == 31 && + dev->hci_rev == 0x2005 && dev->lmp_subver == 0x1805) + return 1; + + return 0; +} + +static void update_ext_inquiry_response(int dd, struct hci_dev *dev) +{ + uint8_t fec = 0, data[240]; + + if (!(dev->features[6] & LMP_EXT_INQ)) + return; + + memset(data, 0, sizeof(data)); + + if (dev->ssp_mode > 0) + create_ext_inquiry_response((char *) dev->name, data); + + if (hci_write_ext_inquiry_response(dd, fec, data, 2000) < 0) + error("Can't write extended inquiry response: %s (%d)", + strerror(errno), errno); +} + +int start_adapter(uint16_t dev_id) +{ + struct hci_dev *dev; + struct hci_version ver; + uint8_t features[8], inqmode; + uint8_t events[8] = { 0xff, 0xff, 0xff, 0xff, 0xff, 0x1f, 0x00, 0x00 }; + char name[249]; + int dd, err; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + if (dev->ignore) + return 0; + + dd = hci_open_dev(dev_id); + if (dd < 0) { + err = errno; + error("Can't open device hci%d: %s (%d)", + dev_id, strerror(err), err); + return -err; + } + + if (hci_read_local_version(dd, &ver, 1000) < 0) { + err = errno; + error("Can't read version info for hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + dev->hci_rev = ver.hci_rev; + dev->lmp_ver = ver.lmp_ver; + dev->lmp_subver = ver.lmp_subver; + dev->manufacturer = ver.manufacturer; + + if (hci_read_local_features(dd, features, 1000) < 0) { + err = errno; + error("Can't read features for hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + memcpy(dev->features, features, 8); + + if (hci_read_class_of_dev(dd, dev->class, 1000) < 0) { + err = errno; + error("Can't read class of device on hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + if (hci_read_local_name(dd, sizeof(name), name, 2000) < 0) { + err = errno; + error("Can't read local name on hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + memcpy(dev->name, name, 248); + + if (!(features[6] & LMP_SIMPLE_PAIR)) + goto setup; + + if (hcid_dbus_use_experimental()) { + if (ioctl(dd, HCIGETAUTHINFO, NULL) < 0 && errno != EINVAL) + hci_write_simple_pairing_mode(dd, 0x01, 2000); + } + + if (hci_read_simple_pairing_mode(dd, &dev->ssp_mode, 1000) < 0) { + err = errno; + error("Can't read simple pairing mode on hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + +setup: + if (ver.hci_rev > 1) { + if (features[5] & LMP_SNIFF_SUBR) + events[5] |= 0x20; + + if (features[5] & LMP_PAUSE_ENC) + events[5] |= 0x80; + + if (features[6] & LMP_EXT_INQ) + events[5] |= 0x40; + + if (features[6] & LMP_NFLUSH_PKTS) + events[7] |= 0x01; + + if (features[7] & LMP_LSTO) + events[6] |= 0x80; + + if (features[6] & LMP_SIMPLE_PAIR) { + events[6] |= 0x01; /* IO Capability Request */ + events[6] |= 0x02; /* IO Capability Response */ + events[6] |= 0x04; /* User Confirmation Request */ + events[6] |= 0x08; /* User Passkey Request */ + events[6] |= 0x10; /* Remote OOB Data Request */ + events[6] |= 0x20; /* Simple Pairing Complete */ + events[7] |= 0x04; /* User Passkey Notification */ + events[7] |= 0x08; /* Keypress Notification */ + events[7] |= 0x10; /* Remote Host Supported Features Notification */ + } + + hci_send_cmd(dd, OGF_HOST_CTL, OCF_SET_EVENT_MASK, + sizeof(events), events); + } + + if (read_local_name(&dev->bdaddr, name) == 0) { + memcpy(dev->name, name, 248); + hci_write_local_name(dd, name, 5000); + } + + update_ext_inquiry_response(dd, dev); + + inqmode = get_inquiry_mode(dev); + if (inqmode < 1) + goto done; + + if (hci_write_inquiry_mode(dd, inqmode, 2000) < 0) { + err = errno; + error("Can't write inquiry mode for hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + +done: + hci_close_dev(dd); + + info("Device hci%d has been activated", dev_id); + + return 0; +} + +int stop_adapter(uint16_t dev_id) +{ + ASSERT_DEV_ID; + + info("Device hci%d has been disabled", dev_id); + + return 0; +} + +int update_adapter(uint16_t dev_id) +{ + struct hci_dev *dev; + int dd; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + if (dev->ignore) + return 0; + + dd = hci_open_dev(dev_id); + if (dd < 0) { + int err = errno; + error("Can't open device hci%d: %s (%d)", + dev_id, strerror(err), err); + return -err; + } + + update_ext_inquiry_response(dd, dev); + + hci_close_dev(dd); + + return 0; +} + +int get_device_address(uint16_t dev_id, char *address, size_t size) +{ + struct hci_dev *dev; + + ASSERT_DEV_ID; + + if (size < 18) + return -ENOBUFS; + + dev = &devices[dev_id]; + + return ba2str(&dev->bdaddr, address); +} + +int get_device_class(uint16_t dev_id, uint8_t *cls) +{ + struct hci_dev *dev; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + memcpy(cls, dev->class, 3); + + return 0; +} + +int set_device_class(uint16_t dev_id, uint8_t *cls) +{ + struct hci_dev *dev; + + ASSERT_DEV_ID; + dev = &devices[dev_id]; + memcpy(dev->class, cls, 3); + + return 0; +} + +int get_device_version(uint16_t dev_id, char *version, size_t size) +{ + struct hci_dev *dev; + char edr[7], *tmp; + int err; + + ASSERT_DEV_ID; + + if (size < 14) + return -ENOBUFS; + + dev = &devices[dev_id]; + + if ((dev->lmp_ver == 0x03 || dev->lmp_ver == 0x04) && + (dev->features[3] & (LMP_EDR_ACL_2M | LMP_EDR_ACL_3M))) + sprintf(edr, " + EDR"); + else + edr[0] = '\0'; + + tmp = lmp_vertostr(dev->lmp_ver); + + if (strlen(tmp) == 0) + err = snprintf(version, size, "not assigned"); + else + err = snprintf(version, size, "Bluetooth %s%s", tmp, edr); + + bt_free(tmp); + + return err; +} + +static int digi_revision(uint16_t dev_id, char *revision, size_t size) +{ + struct hci_request rq; + unsigned char req[] = { 0x07 }; + unsigned char buf[102]; + int dd, err; + + dd = hci_open_dev(dev_id); + if (dd < 0) { + err = errno; + error("Can't open device hci%d: %s (%d)", + dev_id, strerror(err), err); + return -err; + } + + memset(&rq, 0, sizeof(rq)); + rq.ogf = OGF_VENDOR_CMD; + rq.ocf = 0x000e; + rq.cparam = req; + rq.clen = sizeof(req); + rq.rparam = &buf; + rq.rlen = sizeof(buf); + + if (hci_send_req(dd, &rq, 2000) < 0) { + err = errno; + error("Can't read revision for hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + hci_close_dev(dd); + + return snprintf(revision, size, "%s", buf + 1); +} + +int get_device_revision(uint16_t dev_id, char *revision, size_t size) +{ + struct hci_dev *dev; + int err; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + switch (dev->manufacturer) { + case 10: + err = snprintf(revision, size, "Build %d", dev->lmp_subver); + break; + case 12: + err = digi_revision(dev_id, revision, size); + break; + case 15: + err = snprintf(revision, size, "%d.%d / %d", + dev->hci_rev & 0xff, + dev->lmp_subver >> 8, dev->lmp_subver & 0xff); + break; + default: + err = snprintf(revision, size, "0x%02x", dev->lmp_subver); + break; + } + + return err; +} + +int get_device_manufacturer(uint16_t dev_id, char *manufacturer, size_t size) +{ + char *tmp; + + ASSERT_DEV_ID; + + tmp = bt_compidtostr(devices[dev_id].manufacturer); + + return snprintf(manufacturer, size, "%s", tmp); +} + +int get_device_company(uint16_t dev_id, char *company, size_t size) +{ + char *tmp, oui[9]; + int err; + + ASSERT_DEV_ID; + + ba2oui(&devices[dev_id].bdaddr, oui); + tmp = ouitocomp(oui); + + err = snprintf(company, size, "%s", tmp); + + free(tmp); + + return err; +} + +int set_simple_pairing_mode(uint16_t dev_id, uint8_t mode) +{ + struct hci_dev *dev; + int dd; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + dev->ssp_mode = mode; + + dd = hci_open_dev(dev_id); + if (dd < 0) { + int err = errno; + error("Can't open device hci%d: %s (%d)", + dev_id, strerror(err), err); + return -err; + } + + update_ext_inquiry_response(dd, dev); + + hci_close_dev(dd); + + return 0; +} + +int get_device_name(uint16_t dev_id, char *name, size_t size) +{ + char tmp[249]; + int dd, err; + + ASSERT_DEV_ID; + + memset(tmp, 0, sizeof(tmp)); + + dd = hci_open_dev(dev_id); + if (dd < 0) { + err = errno; + error("Can't open device hci%d: %s (%d)", + dev_id, strerror(err), err); + return -err; + } + + if (hci_read_local_name(dd, sizeof(tmp), tmp, 2000) < 0) { + err = errno; + error("Can't read name for hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + hci_close_dev(dd); + + memcpy(devices[dev_id].name, tmp, 248); + + return snprintf(name, size, "%s", tmp); +} + +int set_device_name(uint16_t dev_id, const char *name) +{ + struct hci_dev *dev; + int dd, err; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + dd = hci_open_dev(dev_id); + if (dd < 0) { + err = errno; + error("Can't open device hci%d: %s (%d)", + dev_id, strerror(err), err); + return -err; + } + + if (hci_write_local_name(dd, name, 5000) < 0) { + err = errno; + error("Can't write name for hci%d: %s (%d)", + dev_id, strerror(err), err); + hci_close_dev(dd); + return -err; + } + + strncpy((char *) dev->name, name, 248); + + update_ext_inquiry_response(dd, dev); + + hci_close_dev(dd); + + return 0; +} + +int get_device_alias(uint16_t dev_id, const bdaddr_t *bdaddr, char *alias, size_t size) +{ + char filename[PATH_MAX + 1], addr[18], *tmp; + int err; + + ASSERT_DEV_ID; + + ba2str(&devices[dev_id].bdaddr, addr); + create_name(filename, PATH_MAX, STORAGEDIR, addr, "aliases"); + + ba2str(bdaddr, addr); + + tmp = textfile_get(filename, addr); + if (!tmp) + return -ENXIO; + + err = snprintf(alias, size, "%s", tmp); + + free(tmp); + + return err; +} + +int set_device_alias(uint16_t dev_id, const bdaddr_t *bdaddr, const char *alias) +{ + char filename[PATH_MAX + 1], addr[18]; + + ASSERT_DEV_ID; + + ba2str(&devices[dev_id].bdaddr, addr); + create_name(filename, PATH_MAX, STORAGEDIR, addr, "aliases"); + + create_file(filename, S_IRUSR | S_IWUSR | S_IRGRP | S_IROTH); + + ba2str(bdaddr, addr); + + return textfile_put(filename, addr, alias); +} + +int get_encryption_key_size(uint16_t dev_id, const bdaddr_t *baddr) +{ + struct hci_dev *dev; + int size; + + ASSERT_DEV_ID; + + dev = &devices[dev_id]; + + switch (dev->manufacturer) { + default: + size = -ENOENT; + break; + } + + return size; +} + static inline DBusMessage *invalid_args(DBusMessage *msg) { return g_dbus_create_error(msg, |