1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89#include <linux/module.h>
90#include <linux/ctype.h>
91#include <linux/usb.h>
92#include <linux/interrupt.h>
93#include <linux/delay.h>
94#include <linux/random.h>
95#include <linux/mutex.h>
96#include <linux/uwb.h>
97#include <linux/usb/wusb.h>
98#include <linux/usb/association.h>
99
100#define CBA_NAME_LEN 0x40
101
102
103struct cbaf {
104 struct usb_device *usb_dev;
105 struct usb_interface *usb_iface;
106 void *buffer;
107 size_t buffer_size;
108
109 struct wusb_ckhdid chid;
110 char host_name[CBA_NAME_LEN];
111 u16 host_band_groups;
112
113 struct wusb_ckhdid cdid;
114 char device_name[CBA_NAME_LEN];
115 u16 device_band_groups;
116
117 struct wusb_ckhdid ck;
118};
119
120
121
122
123
124
125
126
127
128
129
130
131static int cbaf_check(struct cbaf *cbaf)
132{
133 int result;
134 struct device *dev = &cbaf->usb_iface->dev;
135 struct wusb_cbaf_assoc_info *assoc_info;
136 struct wusb_cbaf_assoc_request *assoc_request;
137 size_t assoc_size;
138 void *itr, *top;
139 int ar_rhi = 0, ar_assoc = 0;
140
141 result = usb_control_msg(
142 cbaf->usb_dev, usb_rcvctrlpipe(cbaf->usb_dev, 0),
143 CBAF_REQ_GET_ASSOCIATION_INFORMATION,
144 USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
145 0, cbaf->usb_iface->cur_altsetting->desc.bInterfaceNumber,
146 cbaf->buffer, cbaf->buffer_size, 1000 );
147 if (result < 0) {
148 dev_err(dev, "Cannot get available association types: %d\n",
149 result);
150 return result;
151 }
152
153 assoc_info = cbaf->buffer;
154 if (result < sizeof(*assoc_info)) {
155 dev_err(dev, "Not enough data to decode association info "
156 "header (%zu vs %zu bytes required)\n",
157 (size_t)result, sizeof(*assoc_info));
158 return result;
159 }
160
161 assoc_size = le16_to_cpu(assoc_info->Length);
162 if (result < assoc_size) {
163 dev_err(dev, "Not enough data to decode association info "
164 "(%zu vs %zu bytes required)\n",
165 (size_t)assoc_size, sizeof(*assoc_info));
166 return result;
167 }
168
169
170
171
172
173 itr = cbaf->buffer + sizeof(*assoc_info);
174 top = cbaf->buffer + assoc_size;
175 dev_dbg(dev, "Found %u association requests (%zu bytes)\n",
176 assoc_info->NumAssociationRequests, assoc_size);
177
178 while (itr < top) {
179 u16 ar_type, ar_subtype;
180 u32 ar_size;
181 const char *ar_name;
182
183 assoc_request = itr;
184
185 if (top - itr < sizeof(*assoc_request)) {
186 dev_err(dev, "Not enough data to decode associaton "
187 "request (%zu vs %zu bytes needed)\n",
188 top - itr, sizeof(*assoc_request));
189 break;
190 }
191
192 ar_type = le16_to_cpu(assoc_request->AssociationTypeId);
193 ar_subtype = le16_to_cpu(assoc_request->AssociationSubTypeId);
194 ar_size = le32_to_cpu(assoc_request->AssociationTypeInfoSize);
195 ar_name = "unknown";
196
197 switch (ar_type) {
198 case AR_TYPE_WUSB:
199
200 switch (ar_subtype) {
201 case AR_TYPE_WUSB_RETRIEVE_HOST_INFO:
202 ar_name = "RETRIEVE_HOST_INFO";
203 ar_rhi = 1;
204 break;
205 case AR_TYPE_WUSB_ASSOCIATE:
206
207 ar_name = "ASSOCIATE";
208 ar_assoc = 1;
209 break;
210 };
211 break;
212 };
213
214 dev_dbg(dev, "Association request #%02u: 0x%04x/%04x "
215 "(%zu bytes): %s\n",
216 assoc_request->AssociationDataIndex, ar_type,
217 ar_subtype, (size_t)ar_size, ar_name);
218
219 itr += sizeof(*assoc_request);
220 }
221
222 if (!ar_rhi) {
223 dev_err(dev, "Missing RETRIEVE_HOST_INFO association "
224 "request\n");
225 return -EINVAL;
226 }
227 if (!ar_assoc) {
228 dev_err(dev, "Missing ASSOCIATE association request\n");
229 return -EINVAL;
230 }
231
232 return 0;
233}
234
235static const struct wusb_cbaf_host_info cbaf_host_info_defaults = {
236 .AssociationTypeId_hdr = WUSB_AR_AssociationTypeId,
237 .AssociationTypeId = cpu_to_le16(AR_TYPE_WUSB),
238 .AssociationSubTypeId_hdr = WUSB_AR_AssociationSubTypeId,
239 .AssociationSubTypeId = cpu_to_le16(AR_TYPE_WUSB_RETRIEVE_HOST_INFO),
240 .CHID_hdr = WUSB_AR_CHID,
241 .LangID_hdr = WUSB_AR_LangID,
242 .HostFriendlyName_hdr = WUSB_AR_HostFriendlyName,
243};
244
245
246static int cbaf_send_host_info(struct cbaf *cbaf)
247{
248 struct wusb_cbaf_host_info *hi;
249 size_t name_len;
250 size_t hi_size;
251
252 hi = cbaf->buffer;
253 memset(hi, 0, sizeof(*hi));
254 *hi = cbaf_host_info_defaults;
255 hi->CHID = cbaf->chid;
256 hi->LangID = 0;
257 strlcpy(hi->HostFriendlyName, cbaf->host_name, CBA_NAME_LEN);
258 name_len = strlen(cbaf->host_name);
259 hi->HostFriendlyName_hdr.len = cpu_to_le16(name_len);
260 hi_size = sizeof(*hi) + name_len;
261
262 return usb_control_msg(cbaf->usb_dev, usb_sndctrlpipe(cbaf->usb_dev, 0),
263 CBAF_REQ_SET_ASSOCIATION_RESPONSE,
264 USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
265 0x0101,
266 cbaf->usb_iface->cur_altsetting->desc.bInterfaceNumber,
267 hi, hi_size, 1000 );
268}
269
270
271
272
273
274
275
276
277static int cbaf_cdid_get(struct cbaf *cbaf)
278{
279 int result;
280 struct device *dev = &cbaf->usb_iface->dev;
281 struct wusb_cbaf_device_info *di;
282 size_t needed;
283
284 di = cbaf->buffer;
285 result = usb_control_msg(
286 cbaf->usb_dev, usb_rcvctrlpipe(cbaf->usb_dev, 0),
287 CBAF_REQ_GET_ASSOCIATION_REQUEST,
288 USB_DIR_IN | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
289 0x0200, cbaf->usb_iface->cur_altsetting->desc.bInterfaceNumber,
290 di, cbaf->buffer_size, 1000 );
291 if (result < 0) {
292 dev_err(dev, "Cannot request device information: %d\n", result);
293 return result;
294 }
295
296 needed = result < sizeof(*di) ? sizeof(*di) : le32_to_cpu(di->Length);
297 if (result < needed) {
298 dev_err(dev, "Not enough data in DEVICE_INFO reply (%zu vs "
299 "%zu bytes needed)\n", (size_t)result, needed);
300 return result;
301 }
302
303 strlcpy(cbaf->device_name, di->DeviceFriendlyName, CBA_NAME_LEN);
304 cbaf->cdid = di->CDID;
305 cbaf->device_band_groups = le16_to_cpu(di->BandGroups);
306
307 return 0;
308}
309
310static ssize_t cbaf_wusb_chid_show(struct device *dev,
311 struct device_attribute *attr,
312 char *buf)
313{
314 struct usb_interface *iface = to_usb_interface(dev);
315 struct cbaf *cbaf = usb_get_intfdata(iface);
316 char pr_chid[WUSB_CKHDID_STRSIZE];
317
318 ckhdid_printf(pr_chid, sizeof(pr_chid), &cbaf->chid);
319 return scnprintf(buf, PAGE_SIZE, "%s\n", pr_chid);
320}
321
322static ssize_t cbaf_wusb_chid_store(struct device *dev,
323 struct device_attribute *attr,
324 const char *buf, size_t size)
325{
326 ssize_t result;
327 struct usb_interface *iface = to_usb_interface(dev);
328 struct cbaf *cbaf = usb_get_intfdata(iface);
329
330 result = sscanf(buf,
331 "%02hhx %02hhx %02hhx %02hhx "
332 "%02hhx %02hhx %02hhx %02hhx "
333 "%02hhx %02hhx %02hhx %02hhx "
334 "%02hhx %02hhx %02hhx %02hhx",
335 &cbaf->chid.data[0] , &cbaf->chid.data[1],
336 &cbaf->chid.data[2] , &cbaf->chid.data[3],
337 &cbaf->chid.data[4] , &cbaf->chid.data[5],
338 &cbaf->chid.data[6] , &cbaf->chid.data[7],
339 &cbaf->chid.data[8] , &cbaf->chid.data[9],
340 &cbaf->chid.data[10], &cbaf->chid.data[11],
341 &cbaf->chid.data[12], &cbaf->chid.data[13],
342 &cbaf->chid.data[14], &cbaf->chid.data[15]);
343
344 if (result != 16)
345 return -EINVAL;
346
347 result = cbaf_send_host_info(cbaf);
348 if (result < 0)
349 return result;
350 result = cbaf_cdid_get(cbaf);
351 if (result < 0)
352 return -result;
353 return size;
354}
355static DEVICE_ATTR(wusb_chid, 0600, cbaf_wusb_chid_show, cbaf_wusb_chid_store);
356
357static ssize_t cbaf_wusb_host_name_show(struct device *dev,
358 struct device_attribute *attr,
359 char *buf)
360{
361 struct usb_interface *iface = to_usb_interface(dev);
362 struct cbaf *cbaf = usb_get_intfdata(iface);
363
364 return scnprintf(buf, PAGE_SIZE, "%s\n", cbaf->host_name);
365}
366
367static ssize_t cbaf_wusb_host_name_store(struct device *dev,
368 struct device_attribute *attr,
369 const char *buf, size_t size)
370{
371 ssize_t result;
372 struct usb_interface *iface = to_usb_interface(dev);
373 struct cbaf *cbaf = usb_get_intfdata(iface);
374
375 result = sscanf(buf, "%63s", cbaf->host_name);
376 if (result != 1)
377 return -EINVAL;
378
379 return size;
380}
381static DEVICE_ATTR(wusb_host_name, 0600, cbaf_wusb_host_name_show,
382 cbaf_wusb_host_name_store);
383
384static ssize_t cbaf_wusb_host_band_groups_show(struct device *dev,
385 struct device_attribute *attr,
386 char *buf)
387{
388 struct usb_interface *iface = to_usb_interface(dev);
389 struct cbaf *cbaf = usb_get_intfdata(iface);
390
391 return scnprintf(buf, PAGE_SIZE, "0x%04x\n", cbaf->host_band_groups);
392}
393
394static ssize_t cbaf_wusb_host_band_groups_store(struct device *dev,
395 struct device_attribute *attr,
396 const char *buf, size_t size)
397{
398 ssize_t result;
399 struct usb_interface *iface = to_usb_interface(dev);
400 struct cbaf *cbaf = usb_get_intfdata(iface);
401 u16 band_groups = 0;
402
403 result = sscanf(buf, "%04hx", &band_groups);
404 if (result != 1)
405 return -EINVAL;
406
407 cbaf->host_band_groups = band_groups;
408
409 return size;
410}
411
412static DEVICE_ATTR(wusb_host_band_groups, 0600,
413 cbaf_wusb_host_band_groups_show,
414 cbaf_wusb_host_band_groups_store);
415
416static const struct wusb_cbaf_device_info cbaf_device_info_defaults = {
417 .Length_hdr = WUSB_AR_Length,
418 .CDID_hdr = WUSB_AR_CDID,
419 .BandGroups_hdr = WUSB_AR_BandGroups,
420 .LangID_hdr = WUSB_AR_LangID,
421 .DeviceFriendlyName_hdr = WUSB_AR_DeviceFriendlyName,
422};
423
424static ssize_t cbaf_wusb_cdid_show(struct device *dev,
425 struct device_attribute *attr, char *buf)
426{
427 struct usb_interface *iface = to_usb_interface(dev);
428 struct cbaf *cbaf = usb_get_intfdata(iface);
429 char pr_cdid[WUSB_CKHDID_STRSIZE];
430
431 ckhdid_printf(pr_cdid, sizeof(pr_cdid), &cbaf->cdid);
432 return scnprintf(buf, PAGE_SIZE, "%s\n", pr_cdid);
433}
434
435static ssize_t cbaf_wusb_cdid_store(struct device *dev,
436 struct device_attribute *attr,
437 const char *buf, size_t size)
438{
439 ssize_t result;
440 struct usb_interface *iface = to_usb_interface(dev);
441 struct cbaf *cbaf = usb_get_intfdata(iface);
442 struct wusb_ckhdid cdid;
443
444 result = sscanf(buf,
445 "%02hhx %02hhx %02hhx %02hhx "
446 "%02hhx %02hhx %02hhx %02hhx "
447 "%02hhx %02hhx %02hhx %02hhx "
448 "%02hhx %02hhx %02hhx %02hhx",
449 &cdid.data[0] , &cdid.data[1],
450 &cdid.data[2] , &cdid.data[3],
451 &cdid.data[4] , &cdid.data[5],
452 &cdid.data[6] , &cdid.data[7],
453 &cdid.data[8] , &cdid.data[9],
454 &cdid.data[10], &cdid.data[11],
455 &cdid.data[12], &cdid.data[13],
456 &cdid.data[14], &cdid.data[15]);
457 if (result != 16)
458 return -EINVAL;
459
460 cbaf->cdid = cdid;
461
462 return size;
463}
464static DEVICE_ATTR(wusb_cdid, 0600, cbaf_wusb_cdid_show, cbaf_wusb_cdid_store);
465
466static ssize_t cbaf_wusb_device_band_groups_show(struct device *dev,
467 struct device_attribute *attr,
468 char *buf)
469{
470 struct usb_interface *iface = to_usb_interface(dev);
471 struct cbaf *cbaf = usb_get_intfdata(iface);
472
473 return scnprintf(buf, PAGE_SIZE, "0x%04x\n", cbaf->device_band_groups);
474}
475
476static DEVICE_ATTR(wusb_device_band_groups, 0600,
477 cbaf_wusb_device_band_groups_show,
478 NULL);
479
480static ssize_t cbaf_wusb_device_name_show(struct device *dev,
481 struct device_attribute *attr,
482 char *buf)
483{
484 struct usb_interface *iface = to_usb_interface(dev);
485 struct cbaf *cbaf = usb_get_intfdata(iface);
486
487 return scnprintf(buf, PAGE_SIZE, "%s\n", cbaf->device_name);
488}
489static DEVICE_ATTR(wusb_device_name, 0600, cbaf_wusb_device_name_show, NULL);
490
491static const struct wusb_cbaf_cc_data cbaf_cc_data_defaults = {
492 .AssociationTypeId_hdr = WUSB_AR_AssociationTypeId,
493 .AssociationTypeId = cpu_to_le16(AR_TYPE_WUSB),
494 .AssociationSubTypeId_hdr = WUSB_AR_AssociationSubTypeId,
495 .AssociationSubTypeId = cpu_to_le16(AR_TYPE_WUSB_ASSOCIATE),
496 .Length_hdr = WUSB_AR_Length,
497 .Length = cpu_to_le32(sizeof(struct wusb_cbaf_cc_data)),
498 .ConnectionContext_hdr = WUSB_AR_ConnectionContext,
499 .BandGroups_hdr = WUSB_AR_BandGroups,
500};
501
502static const struct wusb_cbaf_cc_data_fail cbaf_cc_data_fail_defaults = {
503 .AssociationTypeId_hdr = WUSB_AR_AssociationTypeId,
504 .AssociationSubTypeId_hdr = WUSB_AR_AssociationSubTypeId,
505 .Length_hdr = WUSB_AR_Length,
506 .AssociationStatus_hdr = WUSB_AR_AssociationStatus,
507};
508
509
510
511
512static int cbaf_cc_upload(struct cbaf *cbaf)
513{
514 int result;
515 struct device *dev = &cbaf->usb_iface->dev;
516 struct wusb_cbaf_cc_data *ccd;
517 char pr_cdid[WUSB_CKHDID_STRSIZE];
518
519 ccd = cbaf->buffer;
520 *ccd = cbaf_cc_data_defaults;
521 ccd->CHID = cbaf->chid;
522 ccd->CDID = cbaf->cdid;
523 ccd->CK = cbaf->ck;
524 ccd->BandGroups = cpu_to_le16(cbaf->host_band_groups);
525
526 dev_dbg(dev, "Trying to upload CC:\n");
527 ckhdid_printf(pr_cdid, sizeof(pr_cdid), &ccd->CHID);
528 dev_dbg(dev, " CHID %s\n", pr_cdid);
529 ckhdid_printf(pr_cdid, sizeof(pr_cdid), &ccd->CDID);
530 dev_dbg(dev, " CDID %s\n", pr_cdid);
531 dev_dbg(dev, " Bandgroups 0x%04x\n", cbaf->host_band_groups);
532
533 result = usb_control_msg(
534 cbaf->usb_dev, usb_sndctrlpipe(cbaf->usb_dev, 0),
535 CBAF_REQ_SET_ASSOCIATION_RESPONSE,
536 USB_DIR_OUT | USB_TYPE_CLASS | USB_RECIP_INTERFACE,
537 0x0201, cbaf->usb_iface->cur_altsetting->desc.bInterfaceNumber,
538 ccd, sizeof(*ccd), 1000 );
539
540 return result;
541}
542
543static ssize_t cbaf_wusb_ck_store(struct device *dev,
544 struct device_attribute *attr,
545 const char *buf, size_t size)
546{
547 ssize_t result;
548 struct usb_interface *iface = to_usb_interface(dev);
549 struct cbaf *cbaf = usb_get_intfdata(iface);
550
551 result = sscanf(buf,
552 "%02hhx %02hhx %02hhx %02hhx "
553 "%02hhx %02hhx %02hhx %02hhx "
554 "%02hhx %02hhx %02hhx %02hhx "
555 "%02hhx %02hhx %02hhx %02hhx",
556 &cbaf->ck.data[0] , &cbaf->ck.data[1],
557 &cbaf->ck.data[2] , &cbaf->ck.data[3],
558 &cbaf->ck.data[4] , &cbaf->ck.data[5],
559 &cbaf->ck.data[6] , &cbaf->ck.data[7],
560 &cbaf->ck.data[8] , &cbaf->ck.data[9],
561 &cbaf->ck.data[10], &cbaf->ck.data[11],
562 &cbaf->ck.data[12], &cbaf->ck.data[13],
563 &cbaf->ck.data[14], &cbaf->ck.data[15]);
564 if (result != 16)
565 return -EINVAL;
566
567 result = cbaf_cc_upload(cbaf);
568 if (result < 0)
569 return result;
570
571 return size;
572}
573static DEVICE_ATTR(wusb_ck, 0600, NULL, cbaf_wusb_ck_store);
574
575static struct attribute *cbaf_dev_attrs[] = {
576 &dev_attr_wusb_host_name.attr,
577 &dev_attr_wusb_host_band_groups.attr,
578 &dev_attr_wusb_chid.attr,
579 &dev_attr_wusb_cdid.attr,
580 &dev_attr_wusb_device_name.attr,
581 &dev_attr_wusb_device_band_groups.attr,
582 &dev_attr_wusb_ck.attr,
583 NULL,
584};
585
586static struct attribute_group cbaf_dev_attr_group = {
587 .name = NULL,
588 .attrs = cbaf_dev_attrs,
589};
590
591static int cbaf_probe(struct usb_interface *iface,
592 const struct usb_device_id *id)
593{
594 struct cbaf *cbaf;
595 struct device *dev = &iface->dev;
596 int result = -ENOMEM;
597
598 cbaf = kzalloc(sizeof(*cbaf), GFP_KERNEL);
599 if (cbaf == NULL)
600 goto error_kzalloc;
601 cbaf->buffer = kmalloc(512, GFP_KERNEL);
602 if (cbaf->buffer == NULL)
603 goto error_kmalloc_buffer;
604
605 cbaf->buffer_size = 512;
606 cbaf->usb_dev = usb_get_dev(interface_to_usbdev(iface));
607 cbaf->usb_iface = usb_get_intf(iface);
608 result = cbaf_check(cbaf);
609 if (result < 0) {
610 dev_err(dev, "This device is not WUSB-CBAF compliant"
611 "and is not supported yet.\n");
612 goto error_check;
613 }
614
615 result = sysfs_create_group(&dev->kobj, &cbaf_dev_attr_group);
616 if (result < 0) {
617 dev_err(dev, "Can't register sysfs attr group: %d\n", result);
618 goto error_create_group;
619 }
620 usb_set_intfdata(iface, cbaf);
621 return 0;
622
623error_create_group:
624error_check:
625 kfree(cbaf->buffer);
626error_kmalloc_buffer:
627 kfree(cbaf);
628error_kzalloc:
629 return result;
630}
631
632static void cbaf_disconnect(struct usb_interface *iface)
633{
634 struct cbaf *cbaf = usb_get_intfdata(iface);
635 struct device *dev = &iface->dev;
636 sysfs_remove_group(&dev->kobj, &cbaf_dev_attr_group);
637 usb_set_intfdata(iface, NULL);
638 usb_put_intf(iface);
639 kfree(cbaf->buffer);
640
641 kzfree(cbaf);
642}
643
644static struct usb_device_id cbaf_id_table[] = {
645 { USB_INTERFACE_INFO(0xef, 0x03, 0x01), },
646 { },
647};
648MODULE_DEVICE_TABLE(usb, cbaf_id_table);
649
650static struct usb_driver cbaf_driver = {
651 .name = "wusb-cbaf",
652 .id_table = cbaf_id_table,
653 .probe = cbaf_probe,
654 .disconnect = cbaf_disconnect,
655};
656
657static int __init cbaf_driver_init(void)
658{
659 return usb_register(&cbaf_driver);
660}
661module_init(cbaf_driver_init);
662
663static void __exit cbaf_driver_exit(void)
664{
665 usb_deregister(&cbaf_driver);
666}
667module_exit(cbaf_driver_exit);
668
669MODULE_AUTHOR("Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>");
670MODULE_DESCRIPTION("Wireless USB Cable Based Association");
671MODULE_LICENSE("GPL");
672