2 * WUSB Host Wire Adapter: Radio Control Interface (WUSB[8.6])
3 * Radio Control command/event transport
5 * Copyright (C) 2005-2006 Intel Corporation
6 * Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>
8 * This program is free software; you can redistribute it and/or
9 * modify it under the terms of the GNU General Public License version
10 * 2 as published by the Free Software Foundation.
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA
23 * Initialize the Radio Control interface Driver.
25 * For each device probed, creates an 'struct hwarc' which contains
26 * just the representation of the UWB Radio Controller, and the logic
27 * for reading notifications and passing them to the UWB Core.
29 * So we initialize all of those, register the UWB Radio Controller
30 * and setup the notification/event handle to pipe the notifications
31 * to the UWB management Daemon.
33 * Command and event filtering.
35 * This is the driver for the Radio Control Interface described in WUSB
36 * 1.0. The core UWB module assumes that all drivers are compliant to the
37 * WHCI 0.95 specification. We thus create a filter that parses all
38 * incoming messages from the (WUSB 1.0) device and manipulate them to
39 * conform to the WHCI 0.95 specification. Similarly, outgoing messages
40 * are parsed and manipulated to conform to the WUSB 1.0 compliant messages
41 * that the device expects. Only a few messages are affected:
44 * UWB_RC_EVT_BP_SLOT_CHANGE
45 * UWB_RC_EVT_DRP_AVAIL
49 * UWB_RC_CMD_SET_DRP_IE
54 #include <linux/init.h>
55 #include <linux/module.h>
56 #include <linux/slab.h>
57 #include <linux/usb.h>
58 #include <linux/usb/wusb.h>
59 #include <linux/usb/wusb-wa.h>
60 #include <linux/uwb.h>
62 #include "uwb-internal.h"
64 /* The device uses commands and events from the WHCI specification, although
65 * reporting itself as WUSB compliant. */
66 #define WUSB_QUIRK_WHCI_CMD_EVT 0x01
69 * Descriptor for an instance of the UWB Radio Control Driver that
70 * attaches to the RCI interface of the Host Wired Adapter.
72 * Unless there is a lock specific to the 'data members', all access
73 * is protected by uwb_rc->mutex.
75 * The NEEP (Notification/Event EndPoint) URB (@neep_urb) writes to
76 * @rd_buffer. Note there is no locking because it is perfectly (heh!)
77 * serialized--probe() submits an URB, callback is called, processes
78 * the data (synchronously), submits another URB, and so on. There is
79 * no concurrent access to the buffer.
82 struct usb_device
*usb_dev
;
83 struct usb_interface
*usb_iface
;
84 struct uwb_rc
*uwb_rc
; /* UWB host controller */
85 struct urb
*neep_urb
; /* Notification endpoint handling */
87 void *rd_buffer
; /* NEEP read buffer */
91 /* Beacon received notification (WUSB 1.0 [8.6.3.2]) */
92 struct uwb_rc_evt_beacon_WUSB_0100
{
98 __le16 wBeaconInfoLength
;
100 } __attribute__((packed
));
103 * Filter WUSB 1.0 BEACON RCV notification to be WHCI 0.95
105 * @header: the incoming event
106 * @buf_size: size of buffer containing incoming event
107 * @new_size: size of event after filtering completed
109 * The WHCI 0.95 spec has a "Beacon Type" field. This value is unknown at
110 * the time we receive the beacon from WUSB so we just set it to
111 * UWB_RC_BEACON_TYPE_NEIGHBOR as a default.
112 * The solution below allocates memory upon receipt of every beacon from a
113 * WUSB device. This will deteriorate performance. What is the right way to
117 int hwarc_filter_evt_beacon_WUSB_0100(struct uwb_rc
*rc
,
118 struct uwb_rceb
**header
,
119 const size_t buf_size
,
122 struct uwb_rc_evt_beacon_WUSB_0100
*be
;
123 struct uwb_rc_evt_beacon
*newbe
;
124 size_t bytes_left
, ielength
;
125 struct device
*dev
= &rc
->uwb_dev
.dev
;
127 be
= container_of(*header
, struct uwb_rc_evt_beacon_WUSB_0100
, rceb
);
128 bytes_left
= buf_size
;
129 if (bytes_left
< sizeof(*be
)) {
130 dev_err(dev
, "Beacon Received Notification: Not enough data "
131 "to decode for filtering (%zu vs %zu bytes needed)\n",
132 bytes_left
, sizeof(*be
));
135 bytes_left
-= sizeof(*be
);
136 ielength
= le16_to_cpu(be
->wBeaconInfoLength
);
137 if (bytes_left
< ielength
) {
138 dev_err(dev
, "Beacon Received Notification: Not enough data "
139 "to decode IEs (%zu vs %zu bytes needed)\n",
140 bytes_left
, ielength
);
143 newbe
= kzalloc(sizeof(*newbe
) + ielength
, GFP_ATOMIC
);
146 newbe
->rceb
= be
->rceb
;
147 newbe
->bChannelNumber
= be
->bChannelNumber
;
148 newbe
->bBeaconType
= UWB_RC_BEACON_TYPE_NEIGHBOR
;
149 newbe
->wBPSTOffset
= be
->wBPSTOffset
;
150 newbe
->bLQI
= be
->bLQI
;
151 newbe
->bRSSI
= be
->bRSSI
;
152 newbe
->wBeaconInfoLength
= be
->wBeaconInfoLength
;
153 memcpy(newbe
->BeaconInfo
, be
->BeaconInfo
, ielength
);
154 *header
= &newbe
->rceb
;
155 *new_size
= sizeof(*newbe
) + ielength
;
156 return 1; /* calling function will free memory */
160 /* DRP Availability change notification (WUSB 1.0 [8.6.3.8]) */
161 struct uwb_rc_evt_drp_avail_WUSB_0100
{
162 struct uwb_rceb rceb
;
165 } __attribute__((packed
));
168 * Filter WUSB 1.0 DRP AVAILABILITY CHANGE notification to be WHCI 0.95
170 * @header: the incoming event
171 * @buf_size: size of buffer containing incoming event
172 * @new_size: size of event after filtering completed
175 int hwarc_filter_evt_drp_avail_WUSB_0100(struct uwb_rc
*rc
,
176 struct uwb_rceb
**header
,
177 const size_t buf_size
,
180 struct uwb_rc_evt_drp_avail_WUSB_0100
*da
;
181 struct uwb_rc_evt_drp_avail
*newda
;
182 struct uwb_ie_hdr
*ie_hdr
;
183 size_t bytes_left
, ielength
;
184 struct device
*dev
= &rc
->uwb_dev
.dev
;
187 da
= container_of(*header
, struct uwb_rc_evt_drp_avail_WUSB_0100
, rceb
);
188 bytes_left
= buf_size
;
189 if (bytes_left
< sizeof(*da
)) {
190 dev_err(dev
, "Not enough data to decode DRP Avail "
191 "Notification for filtering. Expected %zu, "
192 "received %zu.\n", (size_t)sizeof(*da
), bytes_left
);
195 bytes_left
-= sizeof(*da
);
196 ielength
= le16_to_cpu(da
->wIELength
);
197 if (bytes_left
< ielength
) {
198 dev_err(dev
, "DRP Avail Notification filter: IE length "
199 "[%zu bytes] does not match actual length "
200 "[%zu bytes].\n", ielength
, bytes_left
);
203 if (ielength
< sizeof(*ie_hdr
)) {
204 dev_err(dev
, "DRP Avail Notification filter: Not enough "
205 "data to decode IE [%zu bytes, %zu needed]\n",
206 ielength
, sizeof(*ie_hdr
));
209 ie_hdr
= (void *) da
->IEData
;
210 if (ie_hdr
->length
> 32) {
211 dev_err(dev
, "DRP Availability Change event has unexpected "
212 "length for filtering. Expected < 32 bytes, "
213 "got %zu bytes.\n", (size_t)ie_hdr
->length
);
216 newda
= kzalloc(sizeof(*newda
), GFP_ATOMIC
);
219 newda
->rceb
= da
->rceb
;
220 memcpy(newda
->bmp
, (u8
*) ie_hdr
+ sizeof(*ie_hdr
), ie_hdr
->length
);
221 *header
= &newda
->rceb
;
222 *new_size
= sizeof(*newda
);
223 return 1; /* calling function will free memory */
227 /* DRP notification (WUSB 1.0 [8.6.3.9]) */
228 struct uwb_rc_evt_drp_WUSB_0100
{
229 struct uwb_rceb rceb
;
230 struct uwb_dev_addr wSrcAddr
;
234 } __attribute__((packed
));
237 * Filter WUSB 1.0 DRP Notification to be WHCI 0.95
239 * @header: the incoming event
240 * @buf_size: size of buffer containing incoming event
241 * @new_size: size of event after filtering completed
243 * It is hard to manage DRP reservations without having a Reason code.
244 * Unfortunately there is none in the WUSB spec. We just set the default to
246 * We do not currently use the bBeaconSlotNumber value, so we set this to
250 int hwarc_filter_evt_drp_WUSB_0100(struct uwb_rc
*rc
,
251 struct uwb_rceb
**header
,
252 const size_t buf_size
,
255 struct uwb_rc_evt_drp_WUSB_0100
*drpev
;
256 struct uwb_rc_evt_drp
*newdrpev
;
257 size_t bytes_left
, ielength
;
258 struct device
*dev
= &rc
->uwb_dev
.dev
;
260 drpev
= container_of(*header
, struct uwb_rc_evt_drp_WUSB_0100
, rceb
);
261 bytes_left
= buf_size
;
262 if (bytes_left
< sizeof(*drpev
)) {
263 dev_err(dev
, "Not enough data to decode DRP Notification "
264 "for filtering. Expected %zu, received %zu.\n",
265 (size_t)sizeof(*drpev
), bytes_left
);
268 ielength
= le16_to_cpu(drpev
->wIELength
);
269 bytes_left
-= sizeof(*drpev
);
270 if (bytes_left
< ielength
) {
271 dev_err(dev
, "DRP Notification filter: header length [%zu "
272 "bytes] does not match actual length [%zu "
273 "bytes].\n", ielength
, bytes_left
);
276 newdrpev
= kzalloc(sizeof(*newdrpev
) + ielength
, GFP_ATOMIC
);
277 if (newdrpev
== NULL
)
279 newdrpev
->rceb
= drpev
->rceb
;
280 newdrpev
->src_addr
= drpev
->wSrcAddr
;
281 newdrpev
->reason
= UWB_DRP_NOTIF_DRP_IE_RCVD
;
282 newdrpev
->beacon_slot_number
= 0;
283 newdrpev
->ie_length
= drpev
->wIELength
;
284 memcpy(newdrpev
->ie_data
, drpev
->IEData
, ielength
);
285 *header
= &newdrpev
->rceb
;
286 *new_size
= sizeof(*newdrpev
) + ielength
;
287 return 1; /* calling function will free memory */
291 /* Scan Command (WUSB 1.0 [8.6.2.5]) */
292 struct uwb_rc_cmd_scan_WUSB_0100
{
293 struct uwb_rccb rccb
;
296 } __attribute__((packed
));
299 * Filter WHCI 0.95 SCAN command to be WUSB 1.0 SCAN command
301 * @header: command sent to device (compliant to WHCI 0.95)
302 * @size: size of command sent to device
304 * We only reduce the size by two bytes because the WUSB 1.0 scan command
305 * does not have the last field (wStarttime). Also, make sure we don't send
306 * the device an unexpected scan type.
309 int hwarc_filter_cmd_scan_WUSB_0100(struct uwb_rc
*rc
,
310 struct uwb_rccb
**header
,
313 struct uwb_rc_cmd_scan
*sc
;
315 sc
= container_of(*header
, struct uwb_rc_cmd_scan
, rccb
);
317 if (sc
->bScanState
== UWB_SCAN_ONLY_STARTTIME
)
318 sc
->bScanState
= UWB_SCAN_ONLY
;
319 /* Don't send the last two bytes. */
325 /* SET DRP IE command (WUSB 1.0 [8.6.2.7]) */
326 struct uwb_rc_cmd_set_drp_ie_WUSB_0100
{
327 struct uwb_rccb rccb
;
330 struct uwb_ie_drp IEData
[];
331 } __attribute__((packed
));
334 * Filter WHCI 0.95 SET DRP IE command to be WUSB 1.0 SET DRP IE command
336 * @header: command sent to device (compliant to WHCI 0.95)
337 * @size: size of command sent to device
339 * WUSB has an extra bExplicit field - we assume always explicit
340 * negotiation so this field is set. The command expected by the device is
341 * thus larger than the one prepared by the driver so we need to
342 * reallocate memory to accommodate this.
343 * We trust the driver to send us the correct data so no checking is done
344 * on incoming data - evn though it is variable length.
347 int hwarc_filter_cmd_set_drp_ie_WUSB_0100(struct uwb_rc
*rc
,
348 struct uwb_rccb
**header
,
351 struct uwb_rc_cmd_set_drp_ie
*orgcmd
;
352 struct uwb_rc_cmd_set_drp_ie_WUSB_0100
*cmd
;
355 orgcmd
= container_of(*header
, struct uwb_rc_cmd_set_drp_ie
, rccb
);
356 ielength
= le16_to_cpu(orgcmd
->wIELength
);
357 cmd
= kzalloc(sizeof(*cmd
) + ielength
, GFP_KERNEL
);
360 cmd
->rccb
= orgcmd
->rccb
;
362 cmd
->wIELength
= orgcmd
->wIELength
;
363 memcpy(cmd
->IEData
, orgcmd
->IEData
, ielength
);
364 *header
= &cmd
->rccb
;
365 *size
= sizeof(*cmd
) + ielength
;
366 return 1; /* calling function will free memory */
371 * Filter data from WHCI driver to WUSB device
373 * @header: WHCI 0.95 compliant command from driver
374 * @size: length of command
376 * The routine managing commands to the device (uwb_rc_cmd()) will call the
377 * filtering function pointer (if it exists) before it passes any data to
378 * the device. At this time the command has been formatted according to
379 * WHCI 0.95 and is ready to be sent to the device.
381 * The filter function will be provided with the current command and its
382 * length. The function will manipulate the command if necessary and
383 * potentially reallocate memory for a command that needed more memory that
384 * the given command. If new memory was created the function will return 1
385 * to indicate to the calling function that the memory need to be freed
386 * when not needed any more. The size will contain the new length of the
388 * If memory has not been allocated we rely on the original mechanisms to
389 * free the memory of the command - even when we reduce the value of size.
392 int hwarc_filter_cmd_WUSB_0100(struct uwb_rc
*rc
, struct uwb_rccb
**header
,
396 struct uwb_rccb
*rccb
= *header
;
397 int cmd
= le16_to_cpu(rccb
->wCommand
);
399 case UWB_RC_CMD_SCAN
:
400 result
= hwarc_filter_cmd_scan_WUSB_0100(rc
, header
, size
);
402 case UWB_RC_CMD_SET_DRP_IE
:
403 result
= hwarc_filter_cmd_set_drp_ie_WUSB_0100(rc
, header
, size
);
414 * Filter data from WHCI driver to WUSB device
416 * @header: WHCI 0.95 compliant command from driver
417 * @size: length of command
419 * Filter commands based on which protocol the device supports. The WUSB
420 * errata should be the same as WHCI 0.95 so we do not filter that here -
424 int hwarc_filter_cmd(struct uwb_rc
*rc
, struct uwb_rccb
**header
,
427 int result
= -ENOANO
;
428 if (rc
->version
== 0x0100)
429 result
= hwarc_filter_cmd_WUSB_0100(rc
, header
, size
);
435 * Compute return value as sum of incoming value and value at given offset
437 * @rceb: event for which we compute the size, it contains a variable
439 * @core_size: size of the "non variable" part of the event
440 * @offset: place in event where the length of the variable part is stored
441 * @buf_size: total length of buffer in which event arrived - we need to make
442 * sure we read the offset in memory that is still part of the event
445 ssize_t
hwarc_get_event_size(struct uwb_rc
*rc
, const struct uwb_rceb
*rceb
,
446 size_t core_size
, size_t offset
,
447 const size_t buf_size
)
449 ssize_t size
= -ENOSPC
;
450 const void *ptr
= rceb
;
451 size_t type_size
= sizeof(__le16
);
452 struct device
*dev
= &rc
->uwb_dev
.dev
;
454 if (offset
+ type_size
>= buf_size
) {
455 dev_err(dev
, "Not enough data to read extra size of event "
456 "0x%02x/%04x/%02x, only got %zu bytes.\n",
457 rceb
->bEventType
, le16_to_cpu(rceb
->wEvent
),
458 rceb
->bEventContext
, buf_size
);
462 size
= core_size
+ le16_to_cpu(*(__le16
*)ptr
);
468 /* Beacon slot change notification (WUSB 1.0 [8.6.3.5]) */
469 struct uwb_rc_evt_bp_slot_change_WUSB_0100
{
470 struct uwb_rceb rceb
;
472 } __attribute__((packed
));
476 * Filter data from WUSB device to WHCI driver
478 * @header: incoming event
479 * @buf_size: size of buffer in which event arrived
480 * @_event_size: actual size of event in the buffer
481 * @new_size: size of event after filtered
483 * We don't know how the buffer is constructed - there may be more than one
484 * event in it so buffer length does not determine event length. We first
485 * determine the expected size of the incoming event. This value is passed
486 * back only if the actual filtering succeeded (so we know the computed
487 * expected size is correct). This value will be zero if
488 * the event did not need any filtering.
490 * WHCI interprets the BP Slot Change event's data differently than
491 * WUSB. The event sizes are exactly the same. The data field
492 * indicates the new beacon slot in which a RC is transmitting its
493 * beacon. The maximum value of this is 96 (wMacBPLength ECMA-368
494 * 17.16 (Table 117)). We thus know that the WUSB value will not set
495 * the bit bNoSlot, so we don't really do anything (placeholder).
498 int hwarc_filter_event_WUSB_0100(struct uwb_rc
*rc
, struct uwb_rceb
**header
,
499 const size_t buf_size
, size_t *_real_size
,
502 int result
= -ENOANO
;
503 struct uwb_rceb
*rceb
= *header
;
504 int event
= le16_to_cpu(rceb
->wEvent
);
506 size_t core_size
, offset
;
508 if (rceb
->bEventType
!= UWB_RC_CET_GENERAL
)
511 case UWB_RC_EVT_BEACON
:
512 core_size
= sizeof(struct uwb_rc_evt_beacon_WUSB_0100
);
513 offset
= offsetof(struct uwb_rc_evt_beacon_WUSB_0100
,
515 event_size
= hwarc_get_event_size(rc
, rceb
, core_size
,
519 *_real_size
= event_size
;
520 result
= hwarc_filter_evt_beacon_WUSB_0100(rc
, header
,
521 buf_size
, _new_size
);
523 case UWB_RC_EVT_BP_SLOT_CHANGE
:
524 *_new_size
= *_real_size
=
525 sizeof(struct uwb_rc_evt_bp_slot_change_WUSB_0100
);
529 case UWB_RC_EVT_DRP_AVAIL
:
530 core_size
= sizeof(struct uwb_rc_evt_drp_avail_WUSB_0100
);
531 offset
= offsetof(struct uwb_rc_evt_drp_avail_WUSB_0100
,
533 event_size
= hwarc_get_event_size(rc
, rceb
, core_size
,
537 *_real_size
= event_size
;
538 result
= hwarc_filter_evt_drp_avail_WUSB_0100(
539 rc
, header
, buf_size
, _new_size
);
543 core_size
= sizeof(struct uwb_rc_evt_drp_WUSB_0100
);
544 offset
= offsetof(struct uwb_rc_evt_drp_WUSB_0100
, wIELength
);
545 event_size
= hwarc_get_event_size(rc
, rceb
, core_size
,
549 *_real_size
= event_size
;
550 result
= hwarc_filter_evt_drp_WUSB_0100(rc
, header
,
551 buf_size
, _new_size
);
562 * Filter data from WUSB device to WHCI driver
564 * @header: incoming event
565 * @buf_size: size of buffer in which event arrived
566 * @_event_size: actual size of event in the buffer
567 * @_new_size: size of event after filtered
569 * Filter events based on which protocol the device supports. The WUSB
570 * errata should be the same as WHCI 0.95 so we do not filter that here -
573 * If we don't handle it, we return -ENOANO (why the weird error code?
574 * well, so if I get it, I can pinpoint in the code that raised
575 * it...after all, not too many places use the higher error codes).
578 int hwarc_filter_event(struct uwb_rc
*rc
, struct uwb_rceb
**header
,
579 const size_t buf_size
, size_t *_real_size
,
582 int result
= -ENOANO
;
583 if (rc
->version
== 0x0100)
584 result
= hwarc_filter_event_WUSB_0100(
585 rc
, header
, buf_size
, _real_size
, _new_size
);
591 * Execute an UWB RC command on HWA
593 * @rc: Instance of a Radio Controller that is a HWA
594 * @cmd: Buffer containing the RCCB and payload to execute
595 * @cmd_size: Size of the command buffer.
597 * NOTE: rc's mutex has to be locked
600 int hwarc_cmd(struct uwb_rc
*uwb_rc
, const struct uwb_rccb
*cmd
, size_t cmd_size
)
602 struct hwarc
*hwarc
= uwb_rc
->priv
;
603 return usb_control_msg(
604 hwarc
->usb_dev
, usb_sndctrlpipe(hwarc
->usb_dev
, 0),
605 WA_EXEC_RC_CMD
, USB_DIR_OUT
| USB_TYPE_CLASS
| USB_RECIP_INTERFACE
,
606 0, hwarc
->usb_iface
->cur_altsetting
->desc
.bInterfaceNumber
,
607 (void *) cmd
, cmd_size
, 100 /* FIXME: this is totally arbitrary */);
611 int hwarc_reset(struct uwb_rc
*uwb_rc
)
613 struct hwarc
*hwarc
= uwb_rc
->priv
;
614 return usb_reset_device(hwarc
->usb_dev
);
618 * Callback for the notification and event endpoint
620 * Check's that everything is fine and then passes the read data to
621 * the notification/event handling mechanism (neh).
624 void hwarc_neep_cb(struct urb
*urb
)
626 struct hwarc
*hwarc
= urb
->context
;
627 struct usb_interface
*usb_iface
= hwarc
->usb_iface
;
628 struct device
*dev
= &usb_iface
->dev
;
631 switch (result
= urb
->status
) {
633 uwb_rc_neh_grok(hwarc
->uwb_rc
, urb
->transfer_buffer
,
636 case -ECONNRESET
: /* Not an error, but a controlled situation; */
637 case -ENOENT
: /* (we killed the URB)...so, no broadcast */
639 case -ESHUTDOWN
: /* going away! */
641 default: /* On general errors, retry unless it gets ugly */
642 if (edc_inc(&hwarc
->neep_edc
, EDC_MAX_ERRORS
,
643 EDC_ERROR_TIMEFRAME
))
645 dev_err(dev
, "NEEP: URB error %d\n", urb
->status
);
647 result
= usb_submit_urb(urb
, GFP_ATOMIC
);
649 dev_err(dev
, "NEEP: Can't resubmit URB (%d) resetting device\n",
657 dev_err(dev
, "NEEP: URB max acceptable errors "
658 "exceeded, resetting device\n");
660 uwb_rc_neh_error(hwarc
->uwb_rc
, result
);
661 uwb_rc_reset_all(hwarc
->uwb_rc
);
665 static void hwarc_init(struct hwarc
*hwarc
)
667 edc_init(&hwarc
->neep_edc
);
671 * Initialize the notification/event endpoint stuff
673 * Note this is effectively a parallel thread; it knows that
674 * hwarc->uwb_rc always exists because the existence of a 'hwarc'
675 * means that there is a reverence on the hwarc->uwb_rc (see
676 * _probe()), and thus _neep_cb() can execute safely.
678 static int hwarc_neep_init(struct uwb_rc
*rc
)
680 struct hwarc
*hwarc
= rc
->priv
;
681 struct usb_interface
*iface
= hwarc
->usb_iface
;
682 struct usb_device
*usb_dev
= interface_to_usbdev(iface
);
683 struct device
*dev
= &iface
->dev
;
685 struct usb_endpoint_descriptor
*epd
;
687 epd
= &iface
->cur_altsetting
->endpoint
[0].desc
;
688 hwarc
->rd_buffer
= (void *) __get_free_page(GFP_KERNEL
);
689 if (hwarc
->rd_buffer
== NULL
) {
690 dev_err(dev
, "Unable to allocate notification's read buffer\n");
691 goto error_rd_buffer
;
693 hwarc
->neep_urb
= usb_alloc_urb(0, GFP_KERNEL
);
694 if (hwarc
->neep_urb
== NULL
) {
695 dev_err(dev
, "Unable to allocate notification URB\n");
696 goto error_urb_alloc
;
698 usb_fill_int_urb(hwarc
->neep_urb
, usb_dev
,
699 usb_rcvintpipe(usb_dev
, epd
->bEndpointAddress
),
700 hwarc
->rd_buffer
, PAGE_SIZE
,
701 hwarc_neep_cb
, hwarc
, epd
->bInterval
);
702 result
= usb_submit_urb(hwarc
->neep_urb
, GFP_ATOMIC
);
704 dev_err(dev
, "Cannot submit notification URB: %d\n", result
);
705 goto error_neep_submit
;
710 usb_free_urb(hwarc
->neep_urb
);
712 free_page((unsigned long)hwarc
->rd_buffer
);
718 /** Clean up all the notification endpoint resources */
719 static void hwarc_neep_release(struct uwb_rc
*rc
)
721 struct hwarc
*hwarc
= rc
->priv
;
723 usb_kill_urb(hwarc
->neep_urb
);
724 usb_free_urb(hwarc
->neep_urb
);
725 free_page((unsigned long)hwarc
->rd_buffer
);
729 * Get the version from class-specific descriptor
731 * NOTE: this descriptor comes with the big bundled configuration
732 * descriptor that includes the interfaces' and endpoints', so
733 * we just look for it in the cached copy kept by the USB stack.
735 * NOTE2: We convert LE fields to CPU order.
737 static int hwarc_get_version(struct uwb_rc
*rc
)
741 struct hwarc
*hwarc
= rc
->priv
;
742 struct uwb_rc_control_intf_class_desc
*descr
;
743 struct device
*dev
= &rc
->uwb_dev
.dev
;
744 struct usb_device
*usb_dev
= hwarc
->usb_dev
;
746 struct usb_descriptor_header
*hdr
;
747 size_t itr_size
, actconfig_idx
;
750 actconfig_idx
= (usb_dev
->actconfig
- usb_dev
->config
) /
751 sizeof(usb_dev
->config
[0]);
752 itr
= usb_dev
->rawdescriptors
[actconfig_idx
];
753 itr_size
= le16_to_cpu(usb_dev
->actconfig
->desc
.wTotalLength
);
754 while (itr_size
>= sizeof(*hdr
)) {
755 hdr
= (struct usb_descriptor_header
*) itr
;
756 dev_dbg(dev
, "Extra device descriptor: "
757 "type %02x/%u bytes @ %zu (%zu left)\n",
758 hdr
->bDescriptorType
, hdr
->bLength
,
759 (itr
- usb_dev
->rawdescriptors
[actconfig_idx
]),
761 if (hdr
->bDescriptorType
== USB_DT_CS_RADIO_CONTROL
)
764 itr_size
-= hdr
->bLength
;
766 dev_err(dev
, "cannot find Radio Control Interface Class descriptor\n");
771 if (hdr
->bLength
> itr_size
) { /* is it available? */
772 dev_err(dev
, "incomplete Radio Control Interface Class "
773 "descriptor (%zu bytes left, %u needed)\n",
774 itr_size
, hdr
->bLength
);
777 if (hdr
->bLength
< sizeof(*descr
)) {
778 dev_err(dev
, "short Radio Control Interface Class "
782 descr
= (struct uwb_rc_control_intf_class_desc
*) hdr
;
783 /* Make LE fields CPU order */
784 version
= __le16_to_cpu(descr
->bcdRCIVersion
);
785 if (version
!= 0x0100) {
786 dev_err(dev
, "Device reports protocol version 0x%04x. We "
787 "do not support that. \n", version
);
791 rc
->version
= version
;
792 dev_dbg(dev
, "Device supports WUSB protocol version 0x%04x \n", rc
->version
);
799 * By creating a 'uwb_rc', we have a reference on it -- that reference
800 * is the one we drop when we disconnect.
802 * No need to switch altsettings; according to WUSB1.0[8.6.1.1], there
803 * is only one altsetting allowed.
805 static int hwarc_probe(struct usb_interface
*iface
,
806 const struct usb_device_id
*id
)
809 struct uwb_rc
*uwb_rc
;
811 struct device
*dev
= &iface
->dev
;
814 uwb_rc
= uwb_rc_alloc();
815 if (uwb_rc
== NULL
) {
816 dev_err(dev
, "unable to allocate RC instance\n");
819 hwarc
= kzalloc(sizeof(*hwarc
), GFP_KERNEL
);
821 dev_err(dev
, "unable to allocate HWA RC instance\n");
825 hwarc
->usb_dev
= usb_get_dev(interface_to_usbdev(iface
));
826 hwarc
->usb_iface
= usb_get_intf(iface
);
827 hwarc
->uwb_rc
= uwb_rc
;
829 uwb_rc
->owner
= THIS_MODULE
;
830 uwb_rc
->start
= hwarc_neep_init
;
831 uwb_rc
->stop
= hwarc_neep_release
;
832 uwb_rc
->cmd
= hwarc_cmd
;
833 uwb_rc
->reset
= hwarc_reset
;
834 if (id
->driver_info
& WUSB_QUIRK_WHCI_CMD_EVT
) {
835 uwb_rc
->filter_cmd
= NULL
;
836 uwb_rc
->filter_event
= NULL
;
838 uwb_rc
->filter_cmd
= hwarc_filter_cmd
;
839 uwb_rc
->filter_event
= hwarc_filter_event
;
842 result
= uwb_rc_add(uwb_rc
, dev
, hwarc
);
845 result
= hwarc_get_version(uwb_rc
);
847 dev_err(dev
, "cannot retrieve version of RC \n");
848 goto error_get_version
;
850 usb_set_intfdata(iface
, hwarc
);
857 usb_put_dev(hwarc
->usb_dev
);
864 static void hwarc_disconnect(struct usb_interface
*iface
)
866 struct hwarc
*hwarc
= usb_get_intfdata(iface
);
867 struct uwb_rc
*uwb_rc
= hwarc
->uwb_rc
;
869 usb_set_intfdata(hwarc
->usb_iface
, NULL
);
871 usb_put_intf(hwarc
->usb_iface
);
872 usb_put_dev(hwarc
->usb_dev
);
874 uwb_rc_put(uwb_rc
); /* when creating the device, refcount = 1 */
877 static int hwarc_pre_reset(struct usb_interface
*iface
)
879 struct hwarc
*hwarc
= usb_get_intfdata(iface
);
880 struct uwb_rc
*uwb_rc
= hwarc
->uwb_rc
;
882 uwb_rc_pre_reset(uwb_rc
);
886 static int hwarc_post_reset(struct usb_interface
*iface
)
888 struct hwarc
*hwarc
= usb_get_intfdata(iface
);
889 struct uwb_rc
*uwb_rc
= hwarc
->uwb_rc
;
891 return uwb_rc_post_reset(uwb_rc
);
894 /** USB device ID's that we handle */
895 static const struct usb_device_id hwarc_id_table
[] = {
896 /* D-Link DUB-1210 */
897 { USB_DEVICE_AND_INTERFACE_INFO(0x07d1, 0x3d02, 0xe0, 0x01, 0x02),
898 .driver_info
= WUSB_QUIRK_WHCI_CMD_EVT
},
899 /* Intel i1480 (using firmware 1.3PA2-20070828) */
900 { USB_DEVICE_AND_INTERFACE_INFO(0x8086, 0x0c3b, 0xe0, 0x01, 0x02),
901 .driver_info
= WUSB_QUIRK_WHCI_CMD_EVT
},
902 /* Generic match for the Radio Control interface */
903 { USB_INTERFACE_INFO(0xe0, 0x01, 0x02), },
906 MODULE_DEVICE_TABLE(usb
, hwarc_id_table
);
908 static struct usb_driver hwarc_driver
= {
910 .id_table
= hwarc_id_table
,
911 .probe
= hwarc_probe
,
912 .disconnect
= hwarc_disconnect
,
913 .pre_reset
= hwarc_pre_reset
,
914 .post_reset
= hwarc_post_reset
,
917 module_usb_driver(hwarc_driver
);
919 MODULE_AUTHOR("Inaky Perez-Gonzalez <inaky.perez-gonzalez@intel.com>");
920 MODULE_DESCRIPTION("Host Wireless Adapter Radio Control Driver");
921 MODULE_LICENSE("GPL");