usbdi_util.c revision 1.71 1 1.71 msaitoh /* $NetBSD: usbdi_util.c,v 1.71 2018/07/24 03:58:36 msaitoh Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.57 mrg * Copyright (c) 1998, 2012 The NetBSD Foundation, Inc.
5 1.1 augustss * All rights reserved.
6 1.1 augustss *
7 1.5 augustss * This code is derived from software contributed to The NetBSD Foundation
8 1.30 augustss * by Lennart Augustsson (lennart (at) augustsson.net) at
9 1.57 mrg * Carlstedt Research & Technology and Matthew R. Green (mrg (at) eterna.com.au).
10 1.1 augustss *
11 1.1 augustss * Redistribution and use in source and binary forms, with or without
12 1.1 augustss * modification, are permitted provided that the following conditions
13 1.1 augustss * are met:
14 1.1 augustss * 1. Redistributions of source code must retain the above copyright
15 1.1 augustss * notice, this list of conditions and the following disclaimer.
16 1.1 augustss * 2. Redistributions in binary form must reproduce the above copyright
17 1.1 augustss * notice, this list of conditions and the following disclaimer in the
18 1.1 augustss * documentation and/or other materials provided with the distribution.
19 1.1 augustss *
20 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
21 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
22 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
23 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
24 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
25 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
26 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
27 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
28 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
29 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
30 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
31 1.1 augustss */
32 1.36 lukem
33 1.36 lukem #include <sys/cdefs.h>
34 1.71 msaitoh __KERNEL_RCSID(0, "$NetBSD: usbdi_util.c,v 1.71 2018/07/24 03:58:36 msaitoh Exp $");
35 1.63 skrll
36 1.63 skrll #ifdef _KERNEL_OPT
37 1.63 skrll #include "opt_usb.h"
38 1.63 skrll #endif
39 1.1 augustss
40 1.1 augustss #include <sys/param.h>
41 1.1 augustss #include <sys/systm.h>
42 1.1 augustss #include <sys/kernel.h>
43 1.65 skrll #include <sys/kmem.h>
44 1.1 augustss #include <sys/proc.h>
45 1.14 augustss #include <sys/device.h>
46 1.57 mrg #include <sys/bus.h>
47 1.1 augustss
48 1.1 augustss #include <dev/usb/usb.h>
49 1.1 augustss #include <dev/usb/usbhid.h>
50 1.1 augustss #include <dev/usb/usbdi.h>
51 1.57 mrg #include <dev/usb/usbdivar.h>
52 1.1 augustss #include <dev/usb/usbdi_util.h>
53 1.63 skrll #include <dev/usb/usbhist.h>
54 1.1 augustss
55 1.65 skrll #define DPRINTF(FMT,A,B,C,D) USBHIST_LOGN(usbdebug,1,FMT,A,B,C,D)
56 1.65 skrll #define DPRINTFN(N,FMT,A,B,C,D) USBHIST_LOGN(usbdebug,N,FMT,A,B,C,D)
57 1.1 augustss
58 1.1 augustss usbd_status
59 1.65 skrll usbd_get_desc(struct usbd_device *dev, int type, int index, int len, void *desc)
60 1.1 augustss {
61 1.1 augustss usb_device_request_t req;
62 1.1 augustss
63 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
64 1.65 skrll
65 1.70 pgoyette DPRINTFN(3,"type=%jd, index=%jd, len=%jd", type, index, len, 0);
66 1.26 augustss
67 1.1 augustss req.bmRequestType = UT_READ_DEVICE;
68 1.1 augustss req.bRequest = UR_GET_DESCRIPTOR;
69 1.1 augustss USETW2(req.wValue, type, index);
70 1.1 augustss USETW(req.wIndex, 0);
71 1.1 augustss USETW(req.wLength, len);
72 1.65 skrll return usbd_do_request(dev, &req, desc);
73 1.1 augustss }
74 1.1 augustss
75 1.1 augustss usbd_status
76 1.65 skrll usbd_get_config_desc(struct usbd_device *dev, int confidx,
77 1.31 augustss usb_config_descriptor_t *d)
78 1.1 augustss {
79 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
80 1.23 augustss usbd_status err;
81 1.9 augustss
82 1.70 pgoyette DPRINTFN(3, "confidx=%jd", confidx, 0, 0, 0);
83 1.40 augustss err = usbd_get_desc(dev, UDESC_CONFIG, confidx,
84 1.26 augustss USB_CONFIG_DESCRIPTOR_SIZE, d);
85 1.23 augustss if (err)
86 1.65 skrll return err;
87 1.9 augustss if (d->bDescriptorType != UDESC_CONFIG) {
88 1.70 pgoyette DPRINTFN(1, "confidx=%jd, bad desc len=%d type=%d",
89 1.65 skrll confidx, d->bLength, d->bDescriptorType, 0);
90 1.65 skrll return USBD_INVAL;
91 1.9 augustss }
92 1.65 skrll return USBD_NORMAL_COMPLETION;
93 1.1 augustss }
94 1.1 augustss
95 1.1 augustss usbd_status
96 1.65 skrll usbd_get_config_desc_full(struct usbd_device *dev, int conf, void *d, int size)
97 1.4 augustss {
98 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
99 1.65 skrll
100 1.70 pgoyette DPRINTFN(3, "conf=%jd", conf, 0, 0, 0);
101 1.65 skrll return usbd_get_desc(dev, UDESC_CONFIG, conf, size, d);
102 1.4 augustss }
103 1.4 augustss
104 1.4 augustss usbd_status
105 1.65 skrll usbd_get_bos_desc(struct usbd_device *dev, int confidx,
106 1.64 skrll usb_bos_descriptor_t *d)
107 1.64 skrll {
108 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
109 1.64 skrll usbd_status err;
110 1.64 skrll
111 1.70 pgoyette DPRINTFN(3, "confidx=%jd", confidx, 0, 0, 0);
112 1.64 skrll err = usbd_get_desc(dev, UDESC_BOS, confidx,
113 1.64 skrll USB_BOS_DESCRIPTOR_SIZE, d);
114 1.64 skrll if (err)
115 1.69 skrll return err;
116 1.64 skrll if (d->bDescriptorType != UDESC_BOS) {
117 1.70 pgoyette DPRINTFN(1, "confidx=%jd, bad desc len=%d type=%d",
118 1.65 skrll confidx, d->bLength, d->bDescriptorType, 0);
119 1.65 skrll return USBD_INVAL;
120 1.64 skrll }
121 1.65 skrll return USBD_NORMAL_COMPLETION;
122 1.64 skrll }
123 1.64 skrll
124 1.64 skrll usbd_status
125 1.65 skrll usbd_get_bos_desc_full(struct usbd_device *dev, int conf, void *d, int size)
126 1.64 skrll {
127 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
128 1.65 skrll
129 1.70 pgoyette DPRINTFN(3, "conf=%jd", conf, 0, 0, 0);
130 1.65 skrll return usbd_get_desc(dev, UDESC_BOS, conf, size, d);
131 1.64 skrll }
132 1.64 skrll
133 1.64 skrll usbd_status
134 1.65 skrll usbd_get_device_desc(struct usbd_device *dev, usb_device_descriptor_t *d)
135 1.1 augustss {
136 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
137 1.65 skrll
138 1.69 skrll return usbd_get_desc(dev, UDESC_DEVICE,
139 1.69 skrll 0, USB_DEVICE_DESCRIPTOR_SIZE, d);
140 1.1 augustss }
141 1.1 augustss
142 1.1 augustss usbd_status
143 1.65 skrll usbd_get_device_status(struct usbd_device *dev, usb_status_t *st)
144 1.1 augustss {
145 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
146 1.1 augustss usb_device_request_t req;
147 1.1 augustss
148 1.1 augustss req.bmRequestType = UT_READ_DEVICE;
149 1.1 augustss req.bRequest = UR_GET_STATUS;
150 1.1 augustss USETW(req.wValue, 0);
151 1.1 augustss USETW(req.wIndex, 0);
152 1.1 augustss USETW(req.wLength, sizeof(usb_status_t));
153 1.65 skrll return usbd_do_request(dev, &req, st);
154 1.40 augustss }
155 1.1 augustss
156 1.1 augustss usbd_status
157 1.65 skrll usbd_get_hub_status(struct usbd_device *dev, usb_hub_status_t *st)
158 1.1 augustss {
159 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
160 1.1 augustss usb_device_request_t req;
161 1.1 augustss
162 1.70 pgoyette DPRINTF("dev %#jx", (uintptr_t)dev, 0, 0, 0);
163 1.1 augustss req.bmRequestType = UT_READ_CLASS_DEVICE;
164 1.1 augustss req.bRequest = UR_GET_STATUS;
165 1.1 augustss USETW(req.wValue, 0);
166 1.1 augustss USETW(req.wIndex, 0);
167 1.1 augustss USETW(req.wLength, sizeof(usb_hub_status_t));
168 1.65 skrll return usbd_do_request(dev, &req, st);
169 1.40 augustss }
170 1.1 augustss
171 1.1 augustss usbd_status
172 1.65 skrll usbd_set_address(struct usbd_device *dev, int addr)
173 1.1 augustss {
174 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
175 1.1 augustss usb_device_request_t req;
176 1.1 augustss
177 1.70 pgoyette DPRINTF("dev %#jx addr %jd", (uintptr_t)dev, addr, 0, 0);
178 1.1 augustss req.bmRequestType = UT_WRITE_DEVICE;
179 1.1 augustss req.bRequest = UR_SET_ADDRESS;
180 1.1 augustss USETW(req.wValue, addr);
181 1.1 augustss USETW(req.wIndex, 0);
182 1.1 augustss USETW(req.wLength, 0);
183 1.1 augustss return usbd_do_request(dev, &req, 0);
184 1.1 augustss }
185 1.1 augustss
186 1.1 augustss usbd_status
187 1.65 skrll usbd_get_port_status(struct usbd_device *dev, int port, usb_port_status_t *ps)
188 1.1 augustss {
189 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
190 1.1 augustss usb_device_request_t req;
191 1.1 augustss
192 1.70 pgoyette DPRINTF("dev %#jx port %jd", (uintptr_t)dev, port, 0, 0);
193 1.1 augustss req.bmRequestType = UT_READ_CLASS_OTHER;
194 1.1 augustss req.bRequest = UR_GET_STATUS;
195 1.1 augustss USETW(req.wValue, 0);
196 1.1 augustss USETW(req.wIndex, port);
197 1.65 skrll USETW(req.wLength, sizeof(*ps));
198 1.65 skrll return usbd_do_request(dev, &req, ps);
199 1.65 skrll }
200 1.65 skrll
201 1.65 skrll /* USB 3.1 10.16.2.6, 10.16.2.6.3 */
202 1.65 skrll usbd_status
203 1.65 skrll usbd_get_port_status_ext(struct usbd_device *dev, int port,
204 1.65 skrll usb_port_status_ext_t *pse)
205 1.65 skrll {
206 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
207 1.65 skrll usb_device_request_t req;
208 1.65 skrll
209 1.70 pgoyette DPRINTF("dev %#jx port %jd", (uintptr_t)dev, port, 0, 0);
210 1.65 skrll req.bmRequestType = UT_READ_CLASS_OTHER;
211 1.65 skrll req.bRequest = UR_GET_STATUS;
212 1.65 skrll USETW2(req.wValue, 0, UR_PST_EXT_PORT_STATUS);
213 1.65 skrll USETW(req.wIndex, port);
214 1.65 skrll USETW(req.wLength, sizeof(*pse));
215 1.69 skrll return usbd_do_request(dev, &req, pse);
216 1.16 augustss }
217 1.16 augustss
218 1.16 augustss usbd_status
219 1.65 skrll usbd_clear_hub_feature(struct usbd_device *dev, int sel)
220 1.16 augustss {
221 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
222 1.16 augustss usb_device_request_t req;
223 1.16 augustss
224 1.70 pgoyette DPRINTF("dev %#jx sel %jd", (uintptr_t)dev, sel, 0, 0);
225 1.16 augustss req.bmRequestType = UT_WRITE_CLASS_DEVICE;
226 1.16 augustss req.bRequest = UR_CLEAR_FEATURE;
227 1.16 augustss USETW(req.wValue, sel);
228 1.16 augustss USETW(req.wIndex, 0);
229 1.16 augustss USETW(req.wLength, 0);
230 1.65 skrll return usbd_do_request(dev, &req, 0);
231 1.16 augustss }
232 1.16 augustss
233 1.16 augustss usbd_status
234 1.65 skrll usbd_set_hub_feature(struct usbd_device *dev, int sel)
235 1.16 augustss {
236 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
237 1.16 augustss usb_device_request_t req;
238 1.16 augustss
239 1.70 pgoyette DPRINTF("dev %#jx sel %jd", (uintptr_t)dev, sel, 0, 0);
240 1.16 augustss req.bmRequestType = UT_WRITE_CLASS_DEVICE;
241 1.16 augustss req.bRequest = UR_SET_FEATURE;
242 1.16 augustss USETW(req.wValue, sel);
243 1.16 augustss USETW(req.wIndex, 0);
244 1.16 augustss USETW(req.wLength, 0);
245 1.65 skrll return usbd_do_request(dev, &req, 0);
246 1.1 augustss }
247 1.1 augustss
248 1.1 augustss usbd_status
249 1.65 skrll usbd_clear_port_feature(struct usbd_device *dev, int port, int sel)
250 1.1 augustss {
251 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
252 1.1 augustss usb_device_request_t req;
253 1.1 augustss
254 1.70 pgoyette DPRINTF("dev %#jx port %jd sel %jd", (uintptr_t)dev, port, sel, 0);
255 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_OTHER;
256 1.1 augustss req.bRequest = UR_CLEAR_FEATURE;
257 1.1 augustss USETW(req.wValue, sel);
258 1.1 augustss USETW(req.wIndex, port);
259 1.1 augustss USETW(req.wLength, 0);
260 1.65 skrll return usbd_do_request(dev, &req, 0);
261 1.1 augustss }
262 1.1 augustss
263 1.1 augustss usbd_status
264 1.65 skrll usbd_set_port_feature(struct usbd_device *dev, int port, int sel)
265 1.1 augustss {
266 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
267 1.1 augustss usb_device_request_t req;
268 1.1 augustss
269 1.70 pgoyette DPRINTF("dev %#jx port %jd sel %.d", (uintptr_t)dev, sel, 0, 0);
270 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_OTHER;
271 1.1 augustss req.bRequest = UR_SET_FEATURE;
272 1.1 augustss USETW(req.wValue, sel);
273 1.1 augustss USETW(req.wIndex, port);
274 1.1 augustss USETW(req.wLength, 0);
275 1.65 skrll return usbd_do_request(dev, &req, 0);
276 1.1 augustss }
277 1.1 augustss
278 1.39 augustss usbd_status
279 1.65 skrll usbd_set_port_u1_timeout(struct usbd_device *dev, int port, int timeout)
280 1.65 skrll {
281 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
282 1.65 skrll usb_device_request_t req;
283 1.65 skrll
284 1.70 pgoyette DPRINTF("dev %#jx port %jd timeout %.d", (uintptr_t)dev, port,
285 1.70 pgoyette timeout, 0);
286 1.65 skrll req.bmRequestType = UT_WRITE_CLASS_OTHER;
287 1.65 skrll req.bRequest = UR_SET_FEATURE;
288 1.65 skrll USETW(req.wValue, UHF_PORT_U1_TIMEOUT);
289 1.65 skrll USETW2(req.wIndex, timeout, port);
290 1.65 skrll USETW(req.wLength, 0);
291 1.65 skrll return usbd_do_request(dev, &req, 0);
292 1.65 skrll }
293 1.65 skrll
294 1.65 skrll usbd_status
295 1.65 skrll usbd_set_port_u2_timeout(struct usbd_device *dev, int port, int timeout)
296 1.65 skrll {
297 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
298 1.65 skrll usb_device_request_t req;
299 1.65 skrll
300 1.70 pgoyette DPRINTF("dev %#jx port %jd timeout %jd", (uintptr_t)dev, port,
301 1.70 pgoyette timeout, 0);
302 1.65 skrll req.bmRequestType = UT_WRITE_CLASS_OTHER;
303 1.65 skrll req.bRequest = UR_SET_FEATURE;
304 1.65 skrll USETW(req.wValue, UHF_PORT_U2_TIMEOUT);
305 1.65 skrll USETW2(req.wIndex, timeout, port);
306 1.65 skrll USETW(req.wLength, 0);
307 1.65 skrll return usbd_do_request(dev, &req, 0);
308 1.65 skrll }
309 1.65 skrll
310 1.65 skrll usbd_status
311 1.65 skrll usbd_get_protocol(struct usbd_interface *iface, uint8_t *report)
312 1.39 augustss {
313 1.39 augustss usb_interface_descriptor_t *id = usbd_get_interface_descriptor(iface);
314 1.65 skrll struct usbd_device *dev;
315 1.39 augustss usb_device_request_t req;
316 1.39 augustss
317 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
318 1.65 skrll
319 1.39 augustss if (id == NULL)
320 1.65 skrll return USBD_IOERROR;
321 1.70 pgoyette DPRINTFN(4, "iface=%#jx, endpt=%jd", (uintptr_t)iface,
322 1.70 pgoyette id->bInterfaceNumber, 0, 0);
323 1.68 maya
324 1.39 augustss usbd_interface2device_handle(iface, &dev);
325 1.39 augustss req.bmRequestType = UT_READ_CLASS_INTERFACE;
326 1.39 augustss req.bRequest = UR_GET_PROTOCOL;
327 1.39 augustss USETW(req.wValue, 0);
328 1.39 augustss USETW(req.wIndex, id->bInterfaceNumber);
329 1.39 augustss USETW(req.wLength, 1);
330 1.65 skrll return usbd_do_request(dev, &req, report);
331 1.39 augustss }
332 1.1 augustss
333 1.1 augustss usbd_status
334 1.65 skrll usbd_set_protocol(struct usbd_interface *iface, int report)
335 1.1 augustss {
336 1.1 augustss usb_interface_descriptor_t *id = usbd_get_interface_descriptor(iface);
337 1.65 skrll struct usbd_device *dev;
338 1.1 augustss usb_device_request_t req;
339 1.1 augustss
340 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
341 1.65 skrll
342 1.67 maya if (id == NULL)
343 1.67 maya return USBD_IOERROR;
344 1.70 pgoyette DPRINTFN(4, "iface=%#jx, report=%jd, endpt=%jd", (uintptr_t)iface,
345 1.70 pgoyette report, id->bInterfaceNumber, 0);
346 1.67 maya
347 1.37 augustss usbd_interface2device_handle(iface, &dev);
348 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
349 1.1 augustss req.bRequest = UR_SET_PROTOCOL;
350 1.1 augustss USETW(req.wValue, report);
351 1.1 augustss USETW(req.wIndex, id->bInterfaceNumber);
352 1.1 augustss USETW(req.wLength, 0);
353 1.65 skrll return usbd_do_request(dev, &req, 0);
354 1.1 augustss }
355 1.1 augustss
356 1.1 augustss usbd_status
357 1.65 skrll usbd_set_report(struct usbd_interface *iface, int type, int id, void *data,
358 1.31 augustss int len)
359 1.1 augustss {
360 1.1 augustss usb_interface_descriptor_t *ifd = usbd_get_interface_descriptor(iface);
361 1.65 skrll struct usbd_device *dev;
362 1.1 augustss usb_device_request_t req;
363 1.1 augustss
364 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
365 1.65 skrll
366 1.70 pgoyette DPRINTFN(4, "len=%jd", len, 0, 0, 0);
367 1.23 augustss if (ifd == NULL)
368 1.65 skrll return USBD_IOERROR;
369 1.37 augustss usbd_interface2device_handle(iface, &dev);
370 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
371 1.1 augustss req.bRequest = UR_SET_REPORT;
372 1.2 augustss USETW2(req.wValue, type, id);
373 1.2 augustss USETW(req.wIndex, ifd->bInterfaceNumber);
374 1.2 augustss USETW(req.wLength, len);
375 1.65 skrll return usbd_do_request(dev, &req, data);
376 1.3 augustss }
377 1.3 augustss
378 1.3 augustss usbd_status
379 1.65 skrll usbd_get_report(struct usbd_interface *iface, int type, int id, void *data,
380 1.31 augustss int len)
381 1.2 augustss {
382 1.2 augustss usb_interface_descriptor_t *ifd = usbd_get_interface_descriptor(iface);
383 1.65 skrll struct usbd_device *dev;
384 1.2 augustss usb_device_request_t req;
385 1.2 augustss
386 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
387 1.65 skrll
388 1.70 pgoyette DPRINTFN(4, "len=%jd", len, 0, 0, 0);
389 1.28 augustss if (ifd == NULL)
390 1.65 skrll return USBD_IOERROR;
391 1.37 augustss usbd_interface2device_handle(iface, &dev);
392 1.2 augustss req.bmRequestType = UT_READ_CLASS_INTERFACE;
393 1.2 augustss req.bRequest = UR_GET_REPORT;
394 1.1 augustss USETW2(req.wValue, type, id);
395 1.1 augustss USETW(req.wIndex, ifd->bInterfaceNumber);
396 1.1 augustss USETW(req.wLength, len);
397 1.65 skrll return usbd_do_request(dev, &req, data);
398 1.1 augustss }
399 1.1 augustss
400 1.1 augustss usbd_status
401 1.65 skrll usbd_set_idle(struct usbd_interface *iface, int duration, int id)
402 1.1 augustss {
403 1.1 augustss usb_interface_descriptor_t *ifd = usbd_get_interface_descriptor(iface);
404 1.65 skrll struct usbd_device *dev;
405 1.1 augustss usb_device_request_t req;
406 1.1 augustss
407 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
408 1.65 skrll
409 1.70 pgoyette DPRINTFN(4, "duration %jd id %jd", duration, id, 0, 0);
410 1.23 augustss if (ifd == NULL)
411 1.65 skrll return USBD_IOERROR;
412 1.37 augustss usbd_interface2device_handle(iface, &dev);
413 1.1 augustss req.bmRequestType = UT_WRITE_CLASS_INTERFACE;
414 1.1 augustss req.bRequest = UR_SET_IDLE;
415 1.1 augustss USETW2(req.wValue, duration, id);
416 1.1 augustss USETW(req.wIndex, ifd->bInterfaceNumber);
417 1.1 augustss USETW(req.wLength, 0);
418 1.65 skrll return usbd_do_request(dev, &req, 0);
419 1.1 augustss }
420 1.1 augustss
421 1.1 augustss usbd_status
422 1.65 skrll usbd_get_report_descriptor(struct usbd_device *dev, int ifcno,
423 1.31 augustss int size, void *d)
424 1.1 augustss {
425 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
426 1.1 augustss usb_device_request_t req;
427 1.1 augustss
428 1.70 pgoyette DPRINTF("dev %#jx ifcno %jd size %jd", (uintptr_t)dev, ifcno, size, 0);
429 1.1 augustss req.bmRequestType = UT_READ_INTERFACE;
430 1.1 augustss req.bRequest = UR_GET_DESCRIPTOR;
431 1.35 augustss USETW2(req.wValue, UDESC_REPORT, 0); /* report id should be 0 */
432 1.6 augustss USETW(req.wIndex, ifcno);
433 1.1 augustss USETW(req.wLength, size);
434 1.65 skrll return usbd_do_request(dev, &req, d);
435 1.1 augustss }
436 1.1 augustss
437 1.1 augustss usb_hid_descriptor_t *
438 1.65 skrll usbd_get_hid_descriptor(struct usbd_interface *ifc)
439 1.1 augustss {
440 1.1 augustss usb_interface_descriptor_t *idesc = usbd_get_interface_descriptor(ifc);
441 1.65 skrll struct usbd_device *dev;
442 1.1 augustss usb_config_descriptor_t *cdesc;
443 1.1 augustss usb_hid_descriptor_t *hd;
444 1.1 augustss char *p, *end;
445 1.1 augustss
446 1.23 augustss if (idesc == NULL)
447 1.65 skrll return NULL;
448 1.41 augustss usbd_interface2device_handle(ifc, &dev);
449 1.1 augustss cdesc = usbd_get_config_descriptor(dev);
450 1.1 augustss
451 1.1 augustss p = (char *)idesc + idesc->bLength;
452 1.1 augustss end = (char *)cdesc + UGETW(cdesc->wTotalLength);
453 1.1 augustss
454 1.1 augustss for (; p < end; p += hd->bLength) {
455 1.1 augustss hd = (usb_hid_descriptor_t *)p;
456 1.1 augustss if (p + hd->bLength <= end && hd->bDescriptorType == UDESC_HID)
457 1.65 skrll return hd;
458 1.1 augustss if (hd->bDescriptorType == UDESC_INTERFACE)
459 1.1 augustss break;
460 1.1 augustss }
461 1.65 skrll return NULL;
462 1.1 augustss }
463 1.1 augustss
464 1.1 augustss usbd_status
465 1.65 skrll usbd_read_report_desc(struct usbd_interface *ifc, void **descp, int *sizep)
466 1.1 augustss {
467 1.6 augustss usb_interface_descriptor_t *id;
468 1.1 augustss usb_hid_descriptor_t *hid;
469 1.65 skrll struct usbd_device *dev;
470 1.23 augustss usbd_status err;
471 1.1 augustss
472 1.37 augustss usbd_interface2device_handle(ifc, &dev);
473 1.6 augustss id = usbd_get_interface_descriptor(ifc);
474 1.23 augustss if (id == NULL)
475 1.65 skrll return USBD_INVAL;
476 1.1 augustss hid = usbd_get_hid_descriptor(ifc);
477 1.25 augustss if (hid == NULL)
478 1.65 skrll return USBD_IOERROR;
479 1.1 augustss *sizep = UGETW(hid->descrs[0].wDescriptorLength);
480 1.65 skrll *descp = kmem_alloc(*sizep, KM_SLEEP);
481 1.35 augustss err = usbd_get_report_descriptor(dev, id->bInterfaceNumber,
482 1.35 augustss *sizep, *descp);
483 1.23 augustss if (err) {
484 1.65 skrll kmem_free(*descp, *sizep);
485 1.34 augustss *descp = NULL;
486 1.65 skrll return err;
487 1.1 augustss }
488 1.65 skrll return USBD_NORMAL_COMPLETION;
489 1.7 augustss }
490 1.7 augustss
491 1.40 augustss usbd_status
492 1.65 skrll usbd_get_config(struct usbd_device *dev, uint8_t *conf)
493 1.7 augustss {
494 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
495 1.7 augustss usb_device_request_t req;
496 1.7 augustss
497 1.70 pgoyette DPRINTF("dev %#jx", (uintptr_t)dev, 0, 0, 0);
498 1.7 augustss req.bmRequestType = UT_READ_DEVICE;
499 1.7 augustss req.bRequest = UR_GET_CONFIG;
500 1.7 augustss USETW(req.wValue, 0);
501 1.7 augustss USETW(req.wIndex, 0);
502 1.7 augustss USETW(req.wLength, 1);
503 1.65 skrll return usbd_do_request(dev, &req, conf);
504 1.1 augustss }
505 1.10 augustss
506 1.10 augustss usbd_status
507 1.65 skrll usbd_bulk_transfer(struct usbd_xfer *xfer, struct usbd_pipe *pipe,
508 1.65 skrll uint16_t flags, uint32_t timeout, void *buf, uint32_t *size)
509 1.10 augustss {
510 1.23 augustss usbd_status err;
511 1.10 augustss
512 1.63 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
513 1.63 skrll
514 1.65 skrll usbd_setup_xfer(xfer, 0, buf, *size, flags, timeout, NULL);
515 1.70 pgoyette DPRINTFN(1, "start transfer %jd bytes", *size, 0, 0, 0);
516 1.61 skrll err = usbd_sync_transfer_sig(xfer);
517 1.57 mrg
518 1.57 mrg usbd_get_xfer_status(xfer, NULL, NULL, size, NULL);
519 1.70 pgoyette DPRINTFN(1, "transferred %jd", *size, 0, 0, 0);
520 1.23 augustss if (err) {
521 1.10 augustss usbd_clear_endpoint_stall(pipe);
522 1.10 augustss }
523 1.70 pgoyette USBHIST_LOG(usbdebug, "<- done xfer %#jx err %d", (uintptr_t)xfer,
524 1.70 pgoyette err, 0, 0);
525 1.61 skrll
526 1.65 skrll return err;
527 1.10 augustss }
528 1.10 augustss
529 1.42 augustss usbd_status
530 1.65 skrll usbd_intr_transfer(struct usbd_xfer *xfer, struct usbd_pipe *pipe,
531 1.65 skrll uint16_t flags, uint32_t timeout, void *buf, uint32_t *size)
532 1.42 augustss {
533 1.42 augustss usbd_status err;
534 1.42 augustss
535 1.63 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
536 1.63 skrll
537 1.65 skrll usbd_setup_xfer(xfer, 0, buf, *size, flags, timeout, NULL);
538 1.61 skrll
539 1.70 pgoyette DPRINTFN(1, "start transfer %jd bytes", *size, 0, 0, 0);
540 1.57 mrg err = usbd_sync_transfer_sig(xfer);
541 1.61 skrll
542 1.57 mrg usbd_get_xfer_status(xfer, NULL, NULL, size, NULL);
543 1.61 skrll
544 1.70 pgoyette DPRINTFN(1, "transferred %jd", *size, 0, 0, 0);
545 1.42 augustss if (err) {
546 1.42 augustss usbd_clear_endpoint_stall(pipe);
547 1.42 augustss }
548 1.70 pgoyette USBHIST_LOG(usbdebug, "<- done xfer %#jx err %jd", (uintptr_t)xfer,
549 1.70 pgoyette err, 0, 0);
550 1.63 skrll
551 1.65 skrll return err;
552 1.42 augustss }
553 1.42 augustss
554 1.14 augustss void
555 1.57 mrg usb_detach_wait(device_t dv, kcondvar_t *cv, kmutex_t *lock)
556 1.57 mrg {
557 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
558 1.65 skrll
559 1.70 pgoyette DPRINTFN(1, "waiting for dv %#jx", (uintptr_t)dv, 0, 0, 0);
560 1.57 mrg if (cv_timedwait(cv, lock, hz * 60)) // dv, PZERO, "usbdet", hz * 60
561 1.71 msaitoh aprint_error_dev(dv, "usb_detach_wait: didn't detach\n");
562 1.65 skrll DPRINTFN(1, "done", 0, 0, 0, 0);
563 1.57 mrg }
564 1.57 mrg
565 1.57 mrg void
566 1.57 mrg usb_detach_broadcast(device_t dv, kcondvar_t *cv)
567 1.57 mrg {
568 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
569 1.65 skrll
570 1.70 pgoyette DPRINTFN(1, "for dv %#jx", (uintptr_t)dv, 0, 0, 0);
571 1.57 mrg cv_broadcast(cv);
572 1.57 mrg }
573 1.57 mrg
574 1.57 mrg void
575 1.56 mrg usb_detach_waitold(device_t dv)
576 1.14 augustss {
577 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
578 1.65 skrll
579 1.70 pgoyette DPRINTFN(1, "waiting for dv %#jx", (uintptr_t)dv, 0, 0, 0);
580 1.57 mrg if (tsleep(dv, PZERO, "usbdet", hz * 60)) /* XXXSMP ok */
581 1.71 msaitoh aprint_error_dev(dv, "usb_detach_waitold: didn't detach\n");
582 1.65 skrll DPRINTFN(1, "done", 0, 0, 0, 0);
583 1.40 augustss }
584 1.14 augustss
585 1.14 augustss void
586 1.56 mrg usb_detach_wakeupold(device_t dv)
587 1.14 augustss {
588 1.65 skrll USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
589 1.65 skrll
590 1.70 pgoyette DPRINTFN(1, "for dv %#jx", (uintptr_t)dv, 0, 0, 0);
591 1.57 mrg wakeup(dv); /* XXXSMP ok */
592 1.40 augustss }
593 1.38 augustss
594 1.48 drochner const usb_cdc_descriptor_t *
595 1.65 skrll usb_find_desc(struct usbd_device *dev, int type, int subtype)
596 1.38 augustss {
597 1.41 augustss usbd_desc_iter_t iter;
598 1.48 drochner const usb_cdc_descriptor_t *desc;
599 1.41 augustss
600 1.41 augustss usb_desc_iter_init(dev, &iter);
601 1.41 augustss for (;;) {
602 1.48 drochner desc = (const usb_cdc_descriptor_t *)usb_desc_iter_next(&iter);
603 1.41 augustss if (!desc || (desc->bDescriptorType == type &&
604 1.48 drochner (subtype == USBD_CDCSUBTYPE_ANY ||
605 1.41 augustss subtype == desc->bDescriptorSubtype)))
606 1.41 augustss break;
607 1.38 augustss }
608 1.41 augustss return desc;
609 1.38 augustss }
610 1.43 itohy
611 1.43 itohy /* same as usb_find_desc(), but searches only in the specified interface. */
612 1.48 drochner const usb_cdc_descriptor_t *
613 1.65 skrll usb_find_desc_if(struct usbd_device *dev, int type, int subtype,
614 1.43 itohy usb_interface_descriptor_t *id)
615 1.43 itohy {
616 1.43 itohy usbd_desc_iter_t iter;
617 1.48 drochner const usb_cdc_descriptor_t *desc;
618 1.43 itohy
619 1.54 christos if (id == NULL)
620 1.54 christos return usb_find_desc(dev, type, subtype);
621 1.54 christos
622 1.43 itohy usb_desc_iter_init(dev, &iter);
623 1.43 itohy
624 1.43 itohy iter.cur = (void *)id; /* start from the interface desc */
625 1.43 itohy usb_desc_iter_next(&iter); /* and skip it */
626 1.43 itohy
627 1.48 drochner while ((desc = (const usb_cdc_descriptor_t *)usb_desc_iter_next(&iter))
628 1.48 drochner != NULL) {
629 1.43 itohy if (desc->bDescriptorType == UDESC_INTERFACE) {
630 1.43 itohy /* we ran into the next interface --- not found */
631 1.43 itohy return NULL;
632 1.43 itohy }
633 1.43 itohy if (desc->bDescriptorType == type &&
634 1.48 drochner (subtype == USBD_CDCSUBTYPE_ANY ||
635 1.43 itohy subtype == desc->bDescriptorSubtype))
636 1.43 itohy break;
637 1.43 itohy }
638 1.43 itohy return desc;
639 1.43 itohy }
640