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
|
This page was automatically generated by the
LXR engine.
|