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