a18871e01582152724a8a80f29fa400c9df6ef5d
[pandora-kernel.git] / net / bluetooth / hci_sysfs.c
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 %d %u\n",
117                                 batostr(&bdaddr),
118                                 data->pscan_rep_mode, data->pscan_period_mode,
119                                 data->pscan_mode, data->dev_class[2],
120                                 data->dev_class[1], data->dev_class[0],
121                                 __le16_to_cpu(data->clock_offset),
122                                 data->rssi, data->ssp_mode, e->timestamp);
123         }
124
125         hci_dev_unlock_bh(hdev);
126         return n;
127 }
128
129 static ssize_t show_idle_timeout(struct device *dev, struct device_attribute *attr, char *buf)
130 {
131         struct hci_dev *hdev = dev_get_drvdata(dev);
132         return sprintf(buf, "%d\n", hdev->idle_timeout);
133 }
134
135 static ssize_t store_idle_timeout(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
136 {
137         struct hci_dev *hdev = dev_get_drvdata(dev);
138         char *ptr;
139         __u32 val;
140
141         val = simple_strtoul(buf, &ptr, 10);
142         if (ptr == buf)
143                 return -EINVAL;
144
145         if (val != 0 && (val < 500 || val > 3600000))
146                 return -EINVAL;
147
148         hdev->idle_timeout = val;
149
150         return count;
151 }
152
153 static ssize_t show_sniff_max_interval(struct device *dev, struct device_attribute *attr, char *buf)
154 {
155         struct hci_dev *hdev = dev_get_drvdata(dev);
156         return sprintf(buf, "%d\n", hdev->sniff_max_interval);
157 }
158
159 static ssize_t store_sniff_max_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
160 {
161         struct hci_dev *hdev = dev_get_drvdata(dev);
162         char *ptr;
163         __u16 val;
164
165         val = simple_strtoul(buf, &ptr, 10);
166         if (ptr == buf)
167                 return -EINVAL;
168
169         if (val < 0x0002 || val > 0xFFFE || val % 2)
170                 return -EINVAL;
171
172         if (val < hdev->sniff_min_interval)
173                 return -EINVAL;
174
175         hdev->sniff_max_interval = val;
176
177         return count;
178 }
179
180 static ssize_t show_sniff_min_interval(struct device *dev, struct device_attribute *attr, char *buf)
181 {
182         struct hci_dev *hdev = dev_get_drvdata(dev);
183         return sprintf(buf, "%d\n", hdev->sniff_min_interval);
184 }
185
186 static ssize_t store_sniff_min_interval(struct device *dev, struct device_attribute *attr, const char *buf, size_t count)
187 {
188         struct hci_dev *hdev = dev_get_drvdata(dev);
189         char *ptr;
190         __u16 val;
191
192         val = simple_strtoul(buf, &ptr, 10);
193         if (ptr == buf)
194                 return -EINVAL;
195
196         if (val < 0x0002 || val > 0xFFFE || val % 2)
197                 return -EINVAL;
198
199         if (val > hdev->sniff_max_interval)
200                 return -EINVAL;
201
202         hdev->sniff_min_interval = val;
203
204         return count;
205 }
206
207 static DEVICE_ATTR(type, S_IRUGO, show_type, NULL);
208 static DEVICE_ATTR(name, S_IRUGO, show_name, NULL);
209 static DEVICE_ATTR(class, S_IRUGO, show_class, NULL);
210 static DEVICE_ATTR(address, S_IRUGO, show_address, NULL);
211 static DEVICE_ATTR(features, S_IRUGO, show_features, NULL);
212 static DEVICE_ATTR(manufacturer, S_IRUGO, show_manufacturer, NULL);
213 static DEVICE_ATTR(hci_version, S_IRUGO, show_hci_version, NULL);
214 static DEVICE_ATTR(hci_revision, S_IRUGO, show_hci_revision, NULL);
215 static DEVICE_ATTR(inquiry_cache, S_IRUGO, show_inquiry_cache, NULL);
216
217 static DEVICE_ATTR(idle_timeout, S_IRUGO | S_IWUSR,
218                                 show_idle_timeout, store_idle_timeout);
219 static DEVICE_ATTR(sniff_max_interval, S_IRUGO | S_IWUSR,
220                                 show_sniff_max_interval, store_sniff_max_interval);
221 static DEVICE_ATTR(sniff_min_interval, S_IRUGO | S_IWUSR,
222                                 show_sniff_min_interval, store_sniff_min_interval);
223
224 static struct device_attribute *bt_attrs[] = {
225         &dev_attr_type,
226         &dev_attr_name,
227         &dev_attr_class,
228         &dev_attr_address,
229         &dev_attr_features,
230         &dev_attr_manufacturer,
231         &dev_attr_hci_version,
232         &dev_attr_hci_revision,
233         &dev_attr_inquiry_cache,
234         &dev_attr_idle_timeout,
235         &dev_attr_sniff_max_interval,
236         &dev_attr_sniff_min_interval,
237         NULL
238 };
239
240 static ssize_t show_conn_type(struct device *dev, struct device_attribute *attr, char *buf)
241 {
242         struct hci_conn *conn = dev_get_drvdata(dev);
243         return sprintf(buf, "%s\n", conn->type == ACL_LINK ? "ACL" : "SCO");
244 }
245
246 static ssize_t show_conn_address(struct device *dev, struct device_attribute *attr, char *buf)
247 {
248         struct hci_conn *conn = dev_get_drvdata(dev);
249         bdaddr_t bdaddr;
250         baswap(&bdaddr, &conn->dst);
251         return sprintf(buf, "%s\n", batostr(&bdaddr));
252 }
253
254 static ssize_t show_conn_features(struct device *dev, struct device_attribute *attr, char *buf)
255 {
256         struct hci_conn *conn = dev_get_drvdata(dev);
257
258         return sprintf(buf, "0x%02x%02x%02x%02x%02x%02x%02x%02x\n",
259                                 conn->features[0], conn->features[1],
260                                 conn->features[2], conn->features[3],
261                                 conn->features[4], conn->features[5],
262                                 conn->features[6], conn->features[7]);
263 }
264
265 #define CONN_ATTR(_name,_mode,_show,_store) \
266 struct device_attribute conn_attr_##_name = __ATTR(_name,_mode,_show,_store)
267
268 static CONN_ATTR(type, S_IRUGO, show_conn_type, NULL);
269 static CONN_ATTR(address, S_IRUGO, show_conn_address, NULL);
270 static CONN_ATTR(features, S_IRUGO, show_conn_features, NULL);
271
272 static struct device_attribute *conn_attrs[] = {
273         &conn_attr_type,
274         &conn_attr_address,
275         &conn_attr_features,
276         NULL
277 };
278
279 struct class *bt_class = NULL;
280 EXPORT_SYMBOL_GPL(bt_class);
281
282 static struct bus_type bt_bus = {
283         .name   = "bluetooth",
284 };
285
286 static struct platform_device *bt_platform;
287
288 static void bt_release(struct device *dev)
289 {
290         void *data = dev_get_drvdata(dev);
291         kfree(data);
292 }
293
294 static void add_conn(struct work_struct *work)
295 {
296         struct hci_conn *conn = container_of(work, struct hci_conn, work);
297         int i;
298
299         flush_workqueue(btdelconn);
300
301         if (device_add(&conn->dev) < 0) {
302                 BT_ERR("Failed to register connection device");
303                 return;
304         }
305
306         for (i = 0; conn_attrs[i]; i++)
307                 if (device_create_file(&conn->dev, conn_attrs[i]) < 0)
308                         BT_ERR("Failed to create connection attribute");
309 }
310
311 void hci_conn_add_sysfs(struct hci_conn *conn)
312 {
313         struct hci_dev *hdev = conn->hdev;
314         bdaddr_t *ba = &conn->dst;
315
316         BT_DBG("conn %p", conn);
317
318         conn->dev.bus = &bt_bus;
319         conn->dev.parent = &hdev->dev;
320
321         conn->dev.release = bt_release;
322
323         snprintf(conn->dev.bus_id, BUS_ID_SIZE,
324                         "%s%2.2X%2.2X%2.2X%2.2X%2.2X%2.2X",
325                         conn->type == ACL_LINK ? "acl" : "sco",
326                         ba->b[5], ba->b[4], ba->b[3],
327                         ba->b[2], ba->b[1], ba->b[0]);
328
329         dev_set_drvdata(&conn->dev, conn);
330
331         device_initialize(&conn->dev);
332
333         INIT_WORK(&conn->work, add_conn);
334
335         queue_work(btaddconn, &conn->work);
336 }
337
338 /*
339  * The rfcomm tty device will possibly retain even when conn
340  * is down, and sysfs doesn't support move zombie device,
341  * so we should move the device before conn device is destroyed.
342  */
343 static int __match_tty(struct device *dev, void *data)
344 {
345         return !strncmp(dev->bus_id, "rfcomm", 6);
346 }
347
348 static void del_conn(struct work_struct *work)
349 {
350         struct hci_conn *conn = container_of(work, struct hci_conn, work);
351         struct hci_dev *hdev = conn->hdev;
352
353         while (1) {
354                 struct device *dev;
355
356                 dev = device_find_child(&conn->dev, NULL, __match_tty);
357                 if (!dev)
358                         break;
359                 device_move(dev, NULL);
360                 put_device(dev);
361         }
362
363         device_del(&conn->dev);
364         put_device(&conn->dev);
365         hci_dev_put(hdev);
366 }
367
368 void hci_conn_del_sysfs(struct hci_conn *conn)
369 {
370         BT_DBG("conn %p", conn);
371
372         if (!device_is_registered(&conn->dev))
373                 return;
374
375         INIT_WORK(&conn->work, del_conn);
376
377         queue_work(btdelconn, &conn->work);
378 }
379
380 int hci_register_sysfs(struct hci_dev *hdev)
381 {
382         struct device *dev = &hdev->dev;
383         unsigned int i;
384         int err;
385
386         BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type);
387
388         dev->bus = &bt_bus;
389         dev->parent = hdev->parent;
390
391         strlcpy(dev->bus_id, hdev->name, BUS_ID_SIZE);
392
393         dev->release = bt_release;
394
395         dev_set_drvdata(dev, hdev);
396
397         err = device_register(dev);
398         if (err < 0)
399                 return err;
400
401         for (i = 0; bt_attrs[i]; i++)
402                 if (device_create_file(dev, bt_attrs[i]) < 0)
403                         BT_ERR("Failed to create device attribute");
404
405         if (sysfs_create_link(&bt_class->subsys.kobj,
406                                 &dev->kobj, kobject_name(&dev->kobj)) < 0)
407                 BT_ERR("Failed to create class symlink");
408
409         return 0;
410 }
411
412 void hci_unregister_sysfs(struct hci_dev *hdev)
413 {
414         BT_DBG("%p name %s type %d", hdev, hdev->name, hdev->type);
415
416         sysfs_remove_link(&bt_class->subsys.kobj,
417                                         kobject_name(&hdev->dev.kobj));
418
419         device_del(&hdev->dev);
420 }
421
422 int __init bt_sysfs_init(void)
423 {
424         int err;
425
426         btaddconn = create_singlethread_workqueue("btaddconn");
427         if (!btaddconn) {
428                 err = -ENOMEM;
429                 goto out;
430         }
431
432         btdelconn = create_singlethread_workqueue("btdelconn");
433         if (!btdelconn) {
434                 err = -ENOMEM;
435                 goto out_del;
436         }
437
438         bt_platform = platform_device_register_simple("bluetooth", -1, NULL, 0);
439         if (IS_ERR(bt_platform)) {
440                 err = PTR_ERR(bt_platform);
441                 goto out_platform;
442         }
443
444         err = bus_register(&bt_bus);
445         if (err < 0)
446                 goto out_bus;
447
448         bt_class = class_create(THIS_MODULE, "bluetooth");
449         if (IS_ERR(bt_class)) {
450                 err = PTR_ERR(bt_class);
451                 goto out_class;
452         }
453
454         return 0;
455
456 out_class:
457         bus_unregister(&bt_bus);
458 out_bus:
459         platform_device_unregister(bt_platform);
460 out_platform:
461         destroy_workqueue(btdelconn);
462 out_del:
463         destroy_workqueue(btaddconn);
464 out:
465         return err;
466 }
467
468 void bt_sysfs_cleanup(void)
469 {
470         destroy_workqueue(btaddconn);
471
472         destroy_workqueue(btdelconn);
473
474         class_destroy(bt_class);
475
476         bus_unregister(&bt_bus);
477
478         platform_device_unregister(bt_platform);
479 }