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