rjw | 1f88458 | 2022-01-06 17:20:42 +0800 | [diff] [blame^] | 1 | // SPDX-License-Identifier: GPL-2.0 |
| 2 | /* Bluetooth HCI driver model support. */ |
| 3 | |
| 4 | #include <linux/module.h> |
| 5 | |
| 6 | #include <net/bluetooth/bluetooth.h> |
| 7 | #include <net/bluetooth/hci_core.h> |
| 8 | |
| 9 | static struct class *bt_class; |
| 10 | |
| 11 | static void bt_link_release(struct device *dev) |
| 12 | { |
| 13 | struct hci_conn *conn = to_hci_conn(dev); |
| 14 | kfree(conn); |
| 15 | } |
| 16 | |
| 17 | static const struct device_type bt_link = { |
| 18 | .name = "link", |
| 19 | .release = bt_link_release, |
| 20 | }; |
| 21 | |
| 22 | /* |
| 23 | * The rfcomm tty device will possibly retain even when conn |
| 24 | * is down, and sysfs doesn't support move zombie device, |
| 25 | * so we should move the device before conn device is destroyed. |
| 26 | */ |
| 27 | static int __match_tty(struct device *dev, void *data) |
| 28 | { |
| 29 | return !strncmp(dev_name(dev), "rfcomm", 6); |
| 30 | } |
| 31 | |
| 32 | void hci_conn_init_sysfs(struct hci_conn *conn) |
| 33 | { |
| 34 | struct hci_dev *hdev = conn->hdev; |
| 35 | |
| 36 | BT_DBG("conn %p", conn); |
| 37 | |
| 38 | conn->dev.type = &bt_link; |
| 39 | conn->dev.class = bt_class; |
| 40 | conn->dev.parent = &hdev->dev; |
| 41 | |
| 42 | device_initialize(&conn->dev); |
| 43 | } |
| 44 | |
| 45 | void hci_conn_add_sysfs(struct hci_conn *conn) |
| 46 | { |
| 47 | struct hci_dev *hdev = conn->hdev; |
| 48 | |
| 49 | BT_DBG("conn %p", conn); |
| 50 | |
| 51 | dev_set_name(&conn->dev, "%s:%d", hdev->name, conn->handle); |
| 52 | |
| 53 | if (device_add(&conn->dev) < 0) { |
| 54 | BT_ERR("Failed to register connection device"); |
| 55 | return; |
| 56 | } |
| 57 | |
| 58 | hci_dev_hold(hdev); |
| 59 | } |
| 60 | |
| 61 | void hci_conn_del_sysfs(struct hci_conn *conn) |
| 62 | { |
| 63 | struct hci_dev *hdev = conn->hdev; |
| 64 | |
| 65 | if (!device_is_registered(&conn->dev)) |
| 66 | return; |
| 67 | |
| 68 | while (1) { |
| 69 | struct device *dev; |
| 70 | |
| 71 | dev = device_find_child(&conn->dev, NULL, __match_tty); |
| 72 | if (!dev) |
| 73 | break; |
| 74 | device_move(dev, NULL, DPM_ORDER_DEV_LAST); |
| 75 | put_device(dev); |
| 76 | } |
| 77 | |
| 78 | device_del(&conn->dev); |
| 79 | |
| 80 | hci_dev_put(hdev); |
| 81 | } |
| 82 | |
| 83 | static void bt_host_release(struct device *dev) |
| 84 | { |
| 85 | struct hci_dev *hdev = to_hci_dev(dev); |
| 86 | kfree(hdev); |
| 87 | module_put(THIS_MODULE); |
| 88 | } |
| 89 | |
| 90 | static const struct device_type bt_host = { |
| 91 | .name = "host", |
| 92 | .release = bt_host_release, |
| 93 | }; |
| 94 | |
| 95 | void hci_init_sysfs(struct hci_dev *hdev) |
| 96 | { |
| 97 | struct device *dev = &hdev->dev; |
| 98 | |
| 99 | dev->type = &bt_host; |
| 100 | dev->class = bt_class; |
| 101 | |
| 102 | __module_get(THIS_MODULE); |
| 103 | device_initialize(dev); |
| 104 | } |
| 105 | |
| 106 | int __init bt_sysfs_init(void) |
| 107 | { |
| 108 | bt_class = class_create(THIS_MODULE, "bluetooth"); |
| 109 | |
| 110 | return PTR_ERR_OR_ZERO(bt_class); |
| 111 | } |
| 112 | |
| 113 | void bt_sysfs_cleanup(void) |
| 114 | { |
| 115 | class_destroy(bt_class); |
| 116 | } |