1 /* Bluetooth HCI driver model support. */ 2 3 #include <linux/kernel.h> 4 #include <linux/init.h> 5 6 #include <linux/platform_device.h> 7 8 #include <net/bluetooth/bluetooth.h> 9 #include <net/bluetooth/hci_core.h> 10 11 #ifndef CONFIG_BT_HCI_CORE_DEBUG 12 #undef BT_DBG 13 #define BT_DBG(D...) 14 #endif 15 static struct workqueue_struct *btaddconn; 16 static struct workqueue_struct *btdelconn; 17 18 static inline char *typetostr(int type) 19 { 20 switch (type) { 21 case HCI_VIRTUAL: 22 return "VIRTUAL"; 23 case HCI_USB: 24 return "USB"; 25 case HCI_PCCARD: 26 return "PCCARD"; 27 case HCI_UART: 28 return "UART"; 29 case HCI_RS232: 30 return "RS232"; 31 case HCI_PCI: 32 return "PCI"; 33 case HCI_SDIO: 34 return "SDIO"; 35 default: 36 return "UNKNOWN"; 37 } 38 } 39 40 static ssize_t show_type(struct device *dev, struct device_attribute *attr, char *buf) 41 { 42 struct hci_dev *hdev = dev_get_drvdata(dev); 43 return sprintf(buf, "%s\n", typetostr(hdev->type)); 44 } 45 46 static ssize_t show_name(struct device *dev, struct device_attribute *attr, char *buf) 47 { 48 struct hci_dev *hdev = dev_get_drvdata(dev); 49 char name[249]; 50 int i; 51 52 for (i = 0; i < 248; i++) 53 name[i] = hdev->dev_name[i]; 54 55 name[248] = '\0'; 56 return sprintf(buf, "%s\n", name); 57 } 58 59 static ssize_t show_class(struct device *dev, struct device_attribute *attr, char *buf) 60 { 61 struct hci_dev *hdev = dev_get_drvdata(dev); 62 return sprintf(buf, "0x%.2x%.2x%.2x\n", 63 hdev->dev_class[2], hdev->dev_class[1], hdev->dev_class[0]); 64 } 65 66 static ssize_t show_address(struct device *dev, struct device_attribute *attr, char *buf) 67 { 68 struct hci_dev *hdev = dev_get_drvdata(dev); 69 bdaddr_t bdaddr; 70 baswap(&bdaddr, &hdev->bdaddr); 71 return sprintf(buf, "%s\n", batostr(&bdaddr)); 72 } 73 74 static ssize_t show_features(struct device *dev, struct device_attribute *attr, char *buf) 75 { 76 struct hci_dev *hdev = dev_get_drvdata(dev); 77 78 return sprintf(buf, "0x%02x%02x%02x%02x%02x%02x%02x%02x\n", 79 hdev->features[0], hdev->features[1], 80 hdev->features[2], hdev->features[3], 81 hdev->features[4], hdev->features[5], 82 hdev->features[6], hdev->features[7]); 83 } 84 85 static ssize_t show_manufacturer(struct device *dev, struct device_attribute *attr, char *buf) 86 { 87 struct hci_dev *hdev = dev_get_drvdata(dev); 88 return sprintf(buf, "%d\n", hdev->manufacturer); 89 } 90 91 static ssize_t show_hci_version(struct device *dev, struct device_attribute *attr, char *buf) 92 { 93 struct hci_dev *hdev = dev_get_drvdata(dev); 94 return sprintf(buf, "%d\n", hdev->hci_ver); 95 } 96 97 static ssize_t show_hci_revision(struct device *dev, struct device_attribute *attr, char *buf) 98 { 99 struct hci_dev *hdev = dev_get_drvdata(dev); 100 return sprintf(buf, "%d\n", hdev->hci_rev); 101 } 102 103 static ssize_t show_inquiry_cache(struct device *dev, struct device_attribute *attr, char *buf) 104 { 105 struct hci_dev *hdev = dev_get_drvdata(dev); 106 struct inquiry_cache *cache = &hdev->inq_cache; 107 struct inquiry_entry *e; 108 int n = 0; 109 110 hci_dev_lock_bh(hdev); 111 112 for (e = cache->list; e; e = e->next) { 113 struct inquiry_data *data = &e->data; 114 bdaddr_t bdaddr; 115 baswap(&bdaddr, &data->bdaddr); 116 n += sprintf(buf + n, "%s %d %d %d 0x%.2x%.2x%.2x 0x%.4x %d %u\n", 117 batostr(&bdaddr), 118 data->pscan_rep_mode, data->pscan_period_mode, data->pscan_mode, 119 data->dev_class[2], data->dev_class[1], data->dev_class[0], 120 __le16_to_cpu(data->clock_offset), data->rssi, e->timestamp); 121 } 122 123 hci_dev_unlock_bh(hdev); 124 return n; 125 } 126 127 static ssize_t show_idle_timeout(struct device *dev, struct device_attribute *attr, char *buf) 128 { 129 struct hci_dev *hdev = dev_get_drvdata(dev); 130 return sprintf(buf, "%d\n", hdev->idle_timeout); 131 } 132 133 static ssize_t store_idle_timeout(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) 134 { 135 struct hci_dev *hdev = dev_get_drvdata(dev); 136 char *ptr; 137 __u32 val; 138 139 val = simple_strtoul(buf, &ptr, 10); 140 if (ptr == buf) 141 return -EINVAL; 142 143 if (val != 0 && (val < 500 || val > 3600000)) 144 return -EINVAL; 145 146 hdev->idle_timeout = val; 147 148 return count; 149 } 150 151 static ssize_t show_sniff_max_interval(struct device *dev, struct device_attribute *attr, char *buf) 152 { 153 struct hci_dev *hdev = dev_get_drvdata(dev); 154 return sprintf(buf, "%d\n", hdev->sniff_max_interval); 155 } 156 157 static ssize_t store_sniff_max_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) 158 { 159 struct hci_dev *hdev = dev_get_drvdata(dev); 160 char *ptr; 161 __u16 val; 162 163 val = simple_strtoul(buf, &ptr, 10); 164 if (ptr == buf) 165 return -EINVAL; 166 167 if (val < 0x0002 || val > 0xFFFE || val % 2) 168 return -EINVAL; 169 170 if (val < hdev->sniff_min_interval) 171 return -EINVAL; 172 173 hdev->sniff_max_interval = val; 174 175 return count; 176 } 177 178 static ssize_t show_sniff_min_interval(struct device *dev, struct device_attribute *attr, char *buf) 179 { 180 struct hci_dev *hdev = dev_get_drvdata(dev); 181 return sprintf(buf, "%d\n", hdev->sniff_min_interval); 182 } 183 184 static ssize_t store_sniff_min_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count) 185 { 186 struct hci_dev *hdev = dev_get_drvdata(dev); 187 char *ptr; 188 __u16 val; 189 190 val = simple_strtoul(buf, &ptr, 10); 191 if (ptr == buf) 192 return -EINVAL; 193 194 if (val < 0x0002 || val > 0xFFFE || val % 2) 195 return -EINVAL; 196 197 if (val > hdev->sniff_max_interval) 198 return -EINVAL; 199 200 hdev->sniff_min_interval = val; 201 202 return count; 203 } 204 205 static DEVICE_ATTR(type, S_IRUGO, show_type, NULL); 206 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL); 207 static DEVICE_ATTR(class, S_IRUGO, show_class, NULL); 208 static DEVICE_ATTR(address, S_IRUGO, show_address, NULL); 209 static DEVICE_ATTR(features, S_IRUGO, show_features, NULL); 210 static DEVICE_ATTR(manufacturer, S_IRUGO, show_manufacturer, NULL); 211 static DEVICE_ATTR(hci_version, S_IRUGO, show_hci_version, NULL); 212 static DEVICE_ATTR(hci_revision, S_IRUGO, show_hci_revision, NULL); 213 static DEVICE_ATTR(inquiry_cache, S_IRUGO, show_inquiry_cache, NULL); 214 215 static DEVICE_ATTR(idle_timeout, S_IRUGO | S_IWUSR, 216 show_idle_timeout, store_idle_timeout); 217 static DEVICE_ATTR(sniff_max_interval, S_IRUGO | S_IWUSR, 218 show_sniff_max_interval, store_sniff_max_interval); 219 static DEVICE_ATTR(sniff_min_interval, S_IRUGO | S_IWUSR, 220 show_sniff_min_interval, store_sniff_min_interval); 221 222 static struct device_attribute *bt_attrs[] = { 223 &dev_attr_type, 224 &dev_attr_name, 225 &dev_attr_class, 226 &dev_attr_address, 227 &dev_attr_features, 228 &dev_attr_manufacturer, 229 &dev_attr_hci_version, 230 &dev_attr_hci_revision, 231 &dev_attr_inquiry_cache, 232 &dev_attr_idle_timeout, 233 &dev_attr_sniff_max_interval, 234 &dev_attr_sniff_min_interval, 235 NULL 236 }; 237 238 static ssize_t show_conn_type(struct device *dev, struct device_attribute *attr, char *buf) 239 { 240 struct hci_conn *conn = dev_get_drvdata(dev); 241 return sprintf(buf, "%s\n", conn->type == ACL_LINK ? "ACL" : "SCO"); 242 } 243 244 static ssize_t show_conn_address(struct device *dev, struct device_attribute *attr, char *buf) 245 { 246 struct hci_conn *conn = dev_get_drvdata(dev); 247 bdaddr_t bdaddr; 248 baswap(&bdaddr, &conn->dst); 249 return sprintf(buf, "%s\n", batostr(&bdaddr)); 250 } 251 252 #define CONN_ATTR(_name,_mode,_show,_store) \ 253 struct device_attribute conn_attr_##_name = __ATTR(_name,_mode,_show,_store) 254 255 static CONN_ATTR(type, S_IRUGO, show_conn_type, NULL); 256 static CONN_ATTR(address, S_IRUGO, show_conn_address, NULL); 257 258 static struct device_attribute *conn_attrs[] = { 259 &conn_attr_type, 260 &conn_attr_address, 261 NULL 262 }; 263 264 struct class *bt_class = NULL; 265 EXPORT_SYMBOL_GPL(bt_class); 266 267 static struct bus_type bt_bus = { 268 .name = "bluetooth", 269 }; 270 271 static struct platform_device *bt_platform; 272 273 static void bt_release(struct device *dev) 274 { 275 void *data = dev_get_drvdata(dev); 276 kfree(data); 277 } 278 279 static void add_conn(struct work_struct *work) 280 { 281 struct hci_conn *conn = container_of(work, struct hci_conn, work); 282 int i; 283 284 flush_workqueue(btdelconn); 285 286 if (device_add(&conn->dev) < 0) { 287 BT_ERR("Failed to register connection device"); 288 return; 289 } 290 291 for (i = 0; conn_attrs[i]; i++) 292 if (device_create_file(&conn->dev, conn_attrs[i]) < 0) 293 BT_ERR("Failed to create connection attribute"); 294 } 295 296 void hci_conn_add_sysfs(struct hci_conn *conn) 297 { 298 struct hci_dev *hdev = conn->hdev; 299 bdaddr_t *ba = &conn->dst; 300 301 BT_DBG("conn %p", conn); 302 303 conn->dev.bus = &bt_bus; 304 conn->dev.parent = &hdev->dev; 305 306 conn->dev.release = bt_release; 307 308 snprintf(conn->dev.bus_id, BUS_ID_SIZE, 309 "%s%2.2X%2.2X%2.2X%2.2X%2.2X%2.2X", 310 conn->type == ACL_LINK ? "acl" : "sco", 311 ba->b[5], ba->b[4], ba->b[3], 312 ba->b[2], ba->b[1], ba->b[0]); 313 314 dev_set_drvdata(&conn->dev, conn); 315 316 device_initialize(&conn->dev); 317 318 INIT_WORK(&conn->work, add_conn); 319 320 queue_work(btaddconn, &conn->work); 321 } 322 323 /* 324 * The rfcomm tty device will possibly retain even when conn 325 * is down, and sysfs doesn't support move zombie device, 326 * so we should move the device before conn device is destroyed. 327 */ 328 static int __match_tty(struct device *dev, void *data) 329 { 330 return !strncmp(dev->bus_id, "rfcomm", 6); 331 } 332 333 static void del_conn(struct work_struct *work) 334 { 335 struct hci_conn *conn = container_of(work, struct hci_conn, work); 336 struct hci_dev *hdev = conn->hdev; 337 338 while (1) { 339 struct device *dev; 340 341 dev = device_find_child(&conn->dev, NULL, __match_tty); 342 if (!dev) 343 break; 344 device_move(dev, NULL); 345 put_device(dev); 346 } 347 348 device_del(&conn->dev); 349 put_device(&conn->dev); 350 hci_dev_put(hdev); 351 } 352 353 void hci_conn_del_sysfs(struct hci_conn *conn) 354 { 355 BT_DBG("conn %p", conn); 356 357 if (!device_is_registered(&conn->dev)) 358 return; 359 360 INIT_WORK(&conn->work, del_conn); 361 362 queue_work(btdelconn, &conn->work); 363 } 364 365 int hci_register_sysfs(struct hci_dev *hdev) 366 { 367 struct device *dev = &hdev->dev; 368 unsigned int i; 369 int err; 370 371 BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type); 372 373 dev->bus = &bt_bus; 374 dev->parent = hdev->parent; 375 376 strlcpy(dev->bus_id, hdev->name, BUS_ID_SIZE); 377 378 dev->release = bt_release; 379 380 dev_set_drvdata(dev, hdev); 381 382 err = device_register(dev); 383 if (err < 0) 384 return err; 385 386 for (i = 0; bt_attrs[i]; i++) 387 if (device_create_file(dev, bt_attrs[i]) < 0) 388 BT_ERR("Failed to create device attribute"); 389 390 if (sysfs_create_link(&bt_class->subsys.kobj, 391 &dev->kobj, kobject_name(&dev->kobj)) < 0) 392 BT_ERR("Failed to create class symlink"); 393 394 return 0; 395 } 396 397 void hci_unregister_sysfs(struct hci_dev *hdev) 398 { 399 BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type); 400 401 sysfs_remove_link(&bt_class->subsys.kobj, 402 kobject_name(&hdev->dev.kobj)); 403 404 device_del(&hdev->dev); 405 } 406 407 int __init bt_sysfs_init(void) 408 { 409 int err; 410 411 btaddconn = create_singlethread_workqueue("btaddconn"); 412 if (!btaddconn) { 413 err = -ENOMEM; 414 goto out; 415 } 416 417 btdelconn = create_singlethread_workqueue("btdelconn"); 418 if (!btdelconn) { 419 err = -ENOMEM; 420 goto out_del; 421 } 422 423 bt_platform = platform_device_register_simple("bluetooth", -1, NULL, 0); 424 if (IS_ERR(bt_platform)) { 425 err = PTR_ERR(bt_platform); 426 goto out_platform; 427 } 428 429 err = bus_register(&bt_bus); 430 if (err < 0) 431 goto out_bus; 432 433 bt_class = class_create(THIS_MODULE, "bluetooth"); 434 if (IS_ERR(bt_class)) { 435 err = PTR_ERR(bt_class); 436 goto out_class; 437 } 438 439 return 0; 440 441 out_class: 442 bus_unregister(&bt_bus); 443 out_bus: 444 platform_device_unregister(bt_platform); 445 out_platform: 446 destroy_workqueue(btdelconn); 447 out_del: 448 destroy_workqueue(btaddconn); 449 out: 450 return err; 451 } 452 453 void bt_sysfs_cleanup(void) 454 { 455 destroy_workqueue(btaddconn); 456 457 destroy_workqueue(btdelconn); 458 459 class_destroy(bt_class); 460 461 bus_unregister(&bt_bus); 462 463 platform_device_unregister(bt_platform); 464 } 465