| /* Bluetooth HCI driver model support. */ |
| |
| #include <linux/kernel.h> |
| #include <linux/init.h> |
| |
| #include <linux/platform_device.h> |
| |
| #include <net/bluetooth/bluetooth.h> |
| #include <net/bluetooth/hci_core.h> |
| |
| #ifndef CONFIG_BT_HCI_CORE_DEBUG |
| #undef BT_DBG |
| #define BT_DBG(D...) |
| #endif |
| static struct workqueue_struct *btaddconn; |
| static struct workqueue_struct *btdelconn; |
| |
| static inline char *typetostr(int type) |
| { |
| switch (type) { |
| case HCI_VIRTUAL: |
| return "VIRTUAL"; |
| case HCI_USB: |
| return "USB"; |
| case HCI_PCCARD: |
| return "PCCARD"; |
| case HCI_UART: |
| return "UART"; |
| case HCI_RS232: |
| return "RS232"; |
| case HCI_PCI: |
| return "PCI"; |
| case HCI_SDIO: |
| return "SDIO"; |
| default: |
| return "UNKNOWN"; |
| } |
| } |
| |
| static ssize_t show_type(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "%s\n", typetostr(hdev->type)); |
| } |
| |
| static ssize_t show_name(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| char name[249]; |
| int i; |
| |
| for (i = 0; i < 248; i++) |
| name[i] = hdev->dev_name[i]; |
| |
| name[248] = '\0'; |
| return sprintf(buf, "%s\n", name); |
| } |
| |
| static ssize_t show_class(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "0x%.2x%.2x%.2x\n", |
| hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]); |
| } |
| |
| static ssize_t show_address(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| bdaddr_t bdaddr; |
| baswap(&bdaddr, &hdev->bdaddr); |
| return sprintf(buf, "%s\n", batostr(&bdaddr)); |
| } |
| |
| static ssize_t show_features(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| |
| return sprintf(buf, "0x%02x%02x%02x%02x%02x%02x%02x%02x\n", |
| hdev->features[0], hdev->features[1], |
| hdev->features[2], hdev->features[3], |
| hdev->features[4], hdev->features[5], |
| hdev->features[6], hdev->features[7]); |
| } |
| |
| static ssize_t show_manufacturer(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "%d\n", hdev->manufacturer); |
| } |
| |
| static ssize_t show_hci_version(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "%d\n", hdev->hci_ver); |
| } |
| |
| static ssize_t show_hci_revision(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "%d\n", hdev->hci_rev); |
| } |
| |
| static ssize_t show_inquiry_cache(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| struct inquiry_cache *cache = &hdev->inq_cache; |
| struct inquiry_entry *e; |
| int n = 0; |
| |
| hci_dev_lock_bh(hdev); |
| |
| for (e = cache->list; e; e = e->next) { |
| struct inquiry_data *data = &e->data; |
| bdaddr_t bdaddr; |
| baswap(&bdaddr, &data->bdaddr); |
| n += sprintf(buf + n, "%s %d %d %d 0x%.2x%.2x%.2x 0x%.4x %d %d %u\n", |
| batostr(&bdaddr), |
| data->pscan_rep_mode, data->pscan_period_mode, |
| data->pscan_mode, data->dev_class[2], |
| data->dev_class[1], data->dev_class[0], |
| __le16_to_cpu(data->clock_offset), |
| data->rssi, data->ssp_mode, e->timestamp); |
| } |
| |
| hci_dev_unlock_bh(hdev); |
| return n; |
| } |
| |
| static ssize_t show_idle_timeout(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "%d\n", hdev->idle_timeout); |
| } |
| |
| static ssize_t store_idle_timeout(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| char *ptr; |
| __u32 val; |
| |
| val = simple_strtoul(buf, &ptr, 10); |
| if (ptr == buf) |
| return -EINVAL; |
| |
| if (val != 0 && (val < 500 || val > 3600000)) |
| return -EINVAL; |
| |
| hdev->idle_timeout = val; |
| |
| return count; |
| } |
| |
| static ssize_t show_sniff_max_interval(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "%d\n", hdev->sniff_max_interval); |
| } |
| |
| static ssize_t store_sniff_max_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| char *ptr; |
| __u16 val; |
| |
| val = simple_strtoul(buf, &ptr, 10); |
| if (ptr == buf) |
| return -EINVAL; |
| |
| if (val < 0x0002 || val > 0xFFFE || val % 2) |
| return -EINVAL; |
| |
| if (val < hdev->sniff_min_interval) |
| return -EINVAL; |
| |
| hdev->sniff_max_interval = val; |
| |
| return count; |
| } |
| |
| static ssize_t show_sniff_min_interval(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| return sprintf(buf, "%d\n", hdev->sniff_min_interval); |
| } |
| |
| static ssize_t store_sniff_min_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) |
| { |
| struct hci_dev *hdev = dev_get_drvdata(dev); |
| char *ptr; |
| __u16 val; |
| |
| val = simple_strtoul(buf, &ptr, 10); |
| if (ptr == buf) |
| return -EINVAL; |
| |
| if (val < 0x0002 || val > 0xFFFE || val % 2) |
| return -EINVAL; |
| |
| if (val > hdev->sniff_max_interval) |
| return -EINVAL; |
| |
| hdev->sniff_min_interval = val; |
| |
| return count; |
| } |
| |
| static DEVICE_ATTR(type, S_IRUGO, show_type, NULL); |
| static DEVICE_ATTR(name, S_IRUGO, show_name, NULL); |
| static DEVICE_ATTR(class, S_IRUGO, show_class, NULL); |
| static DEVICE_ATTR(address, S_IRUGO, show_address, NULL); |
| static DEVICE_ATTR(features, S_IRUGO, show_features, NULL); |
| static DEVICE_ATTR(manufacturer, S_IRUGO, show_manufacturer, NULL); |
| static DEVICE_ATTR(hci_version, S_IRUGO, show_hci_version, NULL); |
| static DEVICE_ATTR(hci_revision, S_IRUGO, show_hci_revision, NULL); |
| static DEVICE_ATTR(inquiry_cache, S_IRUGO, show_inquiry_cache, NULL); |
| |
| static DEVICE_ATTR(idle_timeout, S_IRUGO | S_IWUSR, |
| show_idle_timeout, store_idle_timeout); |
| static DEVICE_ATTR(sniff_max_interval, S_IRUGO | S_IWUSR, |
| show_sniff_max_interval, store_sniff_max_interval); |
| static DEVICE_ATTR(sniff_min_interval, S_IRUGO | S_IWUSR, |
| show_sniff_min_interval, store_sniff_min_interval); |
| |
| static struct device_attribute *bt_attrs[] = { |
| &dev_attr_type, |
| &dev_attr_name, |
| &dev_attr_class, |
| &dev_attr_address, |
| &dev_attr_features, |
| &dev_attr_manufacturer, |
| &dev_attr_hci_version, |
| &dev_attr_hci_revision, |
| &dev_attr_inquiry_cache, |
| &dev_attr_idle_timeout, |
| &dev_attr_sniff_max_interval, |
| &dev_attr_sniff_min_interval, |
| NULL |
| }; |
| |
| static ssize_t show_conn_type(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_conn *conn = dev_get_drvdata(dev); |
| return sprintf(buf, "%s\n", conn->type == ACL_LINK ? "ACL" : "SCO"); |
| } |
| |
| static ssize_t show_conn_address(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_conn *conn = dev_get_drvdata(dev); |
| bdaddr_t bdaddr; |
| baswap(&bdaddr, &conn->dst); |
| return sprintf(buf, "%s\n", batostr(&bdaddr)); |
| } |
| |
| static ssize_t show_conn_features(struct device *dev, struct device_attribute *attr, char *buf) |
| { |
| struct hci_conn *conn = dev_get_drvdata(dev); |
| |
| return sprintf(buf, "0x%02x%02x%02x%02x%02x%02x%02x%02x\n", |
| conn->features[0], conn->features[1], |
| conn->features[2], conn->features[3], |
| conn->features[4], conn->features[5], |
| conn->features[6], conn->features[7]); |
| } |
| |
| #define CONN_ATTR(_name,_mode,_show,_store) \ |
| struct device_attribute conn_attr_##_name = __ATTR(_name,_mode,_show,_store) |
| |
| static CONN_ATTR(type, S_IRUGO, show_conn_type, NULL); |
| static CONN_ATTR(address, S_IRUGO, show_conn_address, NULL); |
| static CONN_ATTR(features, S_IRUGO, show_conn_features, NULL); |
| |
| static struct device_attribute *conn_attrs[] = { |
| &conn_attr_type, |
| &conn_attr_address, |
| &conn_attr_features, |
| NULL |
| }; |
| |
| struct class *bt_class = NULL; |
| EXPORT_SYMBOL_GPL(bt_class); |
| |
| static struct bus_type bt_bus = { |
| .name = "bluetooth", |
| }; |
| |
| static struct platform_device *bt_platform; |
| |
| static void bt_release(struct device *dev) |
| { |
| void *data = dev_get_drvdata(dev); |
| kfree(data); |
| } |
| |
| static void add_conn(struct work_struct *work) |
| { |
| struct hci_conn *conn = container_of(work, struct hci_conn, work); |
| int i; |
| |
| flush_workqueue(btdelconn); |
| |
| if (device_add(&conn->dev) < 0) { |
| BT_ERR("Failed to register connection device"); |
| return; |
| } |
| |
| for (i = 0; conn_attrs[i]; i++) |
| if (device_create_file(&conn->dev, conn_attrs[i]) < 0) |
| BT_ERR("Failed to create connection attribute"); |
| } |
| |
| void hci_conn_add_sysfs(struct hci_conn *conn) |
| { |
| struct hci_dev *hdev = conn->hdev; |
| bdaddr_t *ba = &conn->dst; |
| |
| BT_DBG("conn %p", conn); |
| |
| conn->dev.bus = &bt_bus; |
| conn->dev.parent = &hdev->dev; |
| |
| conn->dev.release = bt_release; |
| |
| snprintf(conn->dev.bus_id, BUS_ID_SIZE, |
| "%s%2.2X%2.2X%2.2X%2.2X%2.2X%2.2X", |
| conn->type == ACL_LINK ? "acl" : "sco", |
| ba->b[5], ba->b[4], ba->b[3], |
| ba->b[2], ba->b[1], ba->b[0]); |
| |
| dev_set_drvdata(&conn->dev, conn); |
| |
| device_initialize(&conn->dev); |
| |
| INIT_WORK(&conn->work, add_conn); |
| |
| queue_work(btaddconn, &conn->work); |
| } |
| |
| /* |
| * The rfcomm tty device will possibly retain even when conn |
| * is down, and sysfs doesn't support move zombie device, |
| * so we should move the device before conn device is destroyed. |
| */ |
| static int __match_tty(struct device *dev, void *data) |
| { |
| return !strncmp(dev->bus_id, "rfcomm", 6); |
| } |
| |
| static void del_conn(struct work_struct *work) |
| { |
| struct hci_conn *conn = container_of(work, struct hci_conn, work); |
| struct hci_dev *hdev = conn->hdev; |
| |
| while (1) { |
| struct device *dev; |
| |
| dev = device_find_child(&conn->dev, NULL, __match_tty); |
| if (!dev) |
| break; |
| device_move(dev, NULL); |
| put_device(dev); |
| } |
| |
| device_del(&conn->dev); |
| put_device(&conn->dev); |
| hci_dev_put(hdev); |
| } |
| |
| void hci_conn_del_sysfs(struct hci_conn *conn) |
| { |
| BT_DBG("conn %p", conn); |
| |
| if (!device_is_registered(&conn->dev)) |
| return; |
| |
| INIT_WORK(&conn->work, del_conn); |
| |
| queue_work(btdelconn, &conn->work); |
| } |
| |
| int hci_register_sysfs(struct hci_dev *hdev) |
| { |
| struct device *dev = &hdev->dev; |
| unsigned int i; |
| int err; |
| |
| BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type); |
| |
| dev->bus = &bt_bus; |
| dev->parent = hdev->parent; |
| |
| strlcpy(dev->bus_id, hdev->name, BUS_ID_SIZE); |
| |
| dev->release = bt_release; |
| |
| dev_set_drvdata(dev, hdev); |
| |
| err = device_register(dev); |
| if (err < 0) |
| return err; |
| |
| for (i = 0; bt_attrs[i]; i++) |
| if (device_create_file(dev, bt_attrs[i]) < 0) |
| BT_ERR("Failed to create device attribute"); |
| |
| if (sysfs_create_link(&bt_class->subsys.kobj, |
| &dev->kobj, kobject_name(&dev->kobj)) < 0) |
| BT_ERR("Failed to create class symlink"); |
| |
| return 0; |
| } |
| |
| void hci_unregister_sysfs(struct hci_dev *hdev) |
| { |
| BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type); |
| |
| sysfs_remove_link(&bt_class->subsys.kobj, |
| kobject_name(&hdev->dev.kobj)); |
| |
| device_del(&hdev->dev); |
| } |
| |
| int __init bt_sysfs_init(void) |
| { |
| int err; |
| |
| btaddconn = create_singlethread_workqueue("btaddconn"); |
| if (!btaddconn) { |
| err = -ENOMEM; |
| goto out; |
| } |
| |
| btdelconn = create_singlethread_workqueue("btdelconn"); |
| if (!btdelconn) { |
| err = -ENOMEM; |
| goto out_del; |
| } |
| |
| bt_platform = platform_device_register_simple("bluetooth", -1, NULL, 0); |
| if (IS_ERR(bt_platform)) { |
| err = PTR_ERR(bt_platform); |
| goto out_platform; |
| } |
| |
| err = bus_register(&bt_bus); |
| if (err < 0) |
| goto out_bus; |
| |
| bt_class = class_create(THIS_MODULE, "bluetooth"); |
| if (IS_ERR(bt_class)) { |
| err = PTR_ERR(bt_class); |
| goto out_class; |
| } |
| |
| return 0; |
| |
| out_class: |
| bus_unregister(&bt_bus); |
| out_bus: |
| platform_device_unregister(bt_platform); |
| out_platform: |
| destroy_workqueue(btdelconn); |
| out_del: |
| destroy_workqueue(btaddconn); |
| out: |
| return err; |
| } |
| |
| void bt_sysfs_cleanup(void) |
| { |
| destroy_workqueue(btaddconn); |
| |
| destroy_workqueue(btdelconn); |
| |
| class_destroy(bt_class); |
| |
| bus_unregister(&bt_bus); |
| |
| platform_device_unregister(bt_platform); |
| } |