usb.c revision 1.94 1 1.94 ad /* $NetBSD: usb.c,v 1.94 2007/02/09 21:55:29 ad Exp $ */
2 1.1 augustss
3 1.1 augustss /*
4 1.62 augustss * Copyright (c) 1998, 2002 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.44 augustss * by Lennart Augustsson (lennart (at) augustsson.net) at
9 1.5 augustss * Carlstedt Research & Technology.
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 * 3. All advertising materials mentioning features or use of this software
20 1.1 augustss * must display the following acknowledgement:
21 1.1 augustss * This product includes software developed by the NetBSD
22 1.1 augustss * Foundation, Inc. and its contributors.
23 1.1 augustss * 4. Neither the name of The NetBSD Foundation nor the names of its
24 1.1 augustss * contributors may be used to endorse or promote products derived
25 1.1 augustss * from this software without specific prior written permission.
26 1.1 augustss *
27 1.1 augustss * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
28 1.1 augustss * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
29 1.1 augustss * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
30 1.1 augustss * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
31 1.1 augustss * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
32 1.1 augustss * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
33 1.1 augustss * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
34 1.1 augustss * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
35 1.1 augustss * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
36 1.1 augustss * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
37 1.1 augustss * POSSIBILITY OF SUCH DAMAGE.
38 1.1 augustss */
39 1.1 augustss
40 1.1 augustss /*
41 1.8 augustss * USB specifications and other documentation can be found at
42 1.80 wiz * http://www.usb.org/developers/docs/ and
43 1.80 wiz * http://www.usb.org/developers/devclass_docs/
44 1.1 augustss */
45 1.55 lukem
46 1.55 lukem #include <sys/cdefs.h>
47 1.94 ad __KERNEL_RCSID(0, "$NetBSD: usb.c,v 1.94 2007/02/09 21:55:29 ad Exp $");
48 1.92 pavel
49 1.92 pavel #include "opt_compat_netbsd.h"
50 1.76 dsainty
51 1.76 dsainty #include "ohci.h"
52 1.76 dsainty #include "uhci.h"
53 1.1 augustss
54 1.1 augustss #include <sys/param.h>
55 1.1 augustss #include <sys/systm.h>
56 1.1 augustss #include <sys/kernel.h>
57 1.1 augustss #include <sys/malloc.h>
58 1.1 augustss #include <sys/device.h>
59 1.13 augustss #include <sys/kthread.h>
60 1.30 augustss #include <sys/proc.h>
61 1.22 augustss #include <sys/conf.h>
62 1.69 augustss #include <sys/fcntl.h>
63 1.1 augustss #include <sys/poll.h>
64 1.1 augustss #include <sys/select.h>
65 1.26 augustss #include <sys/vnode.h>
66 1.26 augustss #include <sys/signalvar.h>
67 1.1 augustss
68 1.1 augustss #include <dev/usb/usb.h>
69 1.13 augustss #include <dev/usb/usbdi.h>
70 1.13 augustss #include <dev/usb/usbdi_util.h>
71 1.1 augustss
72 1.26 augustss #define USB_DEV_MINOR 255
73 1.26 augustss
74 1.20 augustss #include <machine/bus.h>
75 1.7 augustss
76 1.1 augustss #include <dev/usb/usbdivar.h>
77 1.1 augustss #include <dev/usb/usb_quirks.h>
78 1.1 augustss
79 1.1 augustss #ifdef USB_DEBUG
80 1.16 augustss #define DPRINTF(x) if (usbdebug) logprintf x
81 1.16 augustss #define DPRINTFN(n,x) if (usbdebug>(n)) logprintf x
82 1.1 augustss int usbdebug = 0;
83 1.76 dsainty #if defined(UHCI_DEBUG) && NUHCI > 0
84 1.76 dsainty extern int uhcidebug;
85 1.30 augustss #endif
86 1.76 dsainty #if defined(OHCI_DEBUG) && NOHCI > 0
87 1.76 dsainty extern int ohcidebug;
88 1.30 augustss #endif
89 1.66 augustss /*
90 1.34 augustss * 0 - do usual exploration
91 1.34 augustss * 1 - do not use timeout exploration
92 1.34 augustss * >1 - do no exploration
93 1.34 augustss */
94 1.21 augustss int usb_noexplore = 0;
95 1.1 augustss #else
96 1.1 augustss #define DPRINTF(x)
97 1.1 augustss #define DPRINTFN(n,x)
98 1.1 augustss #endif
99 1.1 augustss
100 1.1 augustss struct usb_softc {
101 1.22 augustss USBBASEDEVICE sc_dev; /* base device */
102 1.1 augustss usbd_bus_handle sc_bus; /* USB controller */
103 1.1 augustss struct usbd_port sc_port; /* dummy port for root hub */
104 1.25 augustss
105 1.64 augustss struct proc *sc_event_thread;
106 1.25 augustss
107 1.25 augustss char sc_dying;
108 1.1 augustss };
109 1.1 augustss
110 1.90 joerg struct usb_taskq {
111 1.90 joerg TAILQ_HEAD(, usb_task) tasks;
112 1.90 joerg struct proc *task_thread_proc;
113 1.90 joerg const char *name;
114 1.90 joerg int taskcreated; /* task thread exists. */
115 1.90 joerg };
116 1.90 joerg
117 1.90 joerg static struct usb_taskq usb_taskq[USB_NUM_TASKQS];
118 1.58 augustss
119 1.72 gehenna dev_type_open(usbopen);
120 1.72 gehenna dev_type_close(usbclose);
121 1.72 gehenna dev_type_read(usbread);
122 1.72 gehenna dev_type_ioctl(usbioctl);
123 1.72 gehenna dev_type_poll(usbpoll);
124 1.74 jdolecek dev_type_kqfilter(usbkqfilter);
125 1.72 gehenna
126 1.72 gehenna const struct cdevsw usb_cdevsw = {
127 1.72 gehenna usbopen, usbclose, usbread, nowrite, usbioctl,
128 1.88 christos nostop, notty, usbpoll, nommap, usbkqfilter, D_OTHER,
129 1.72 gehenna };
130 1.7 augustss
131 1.51 augustss Static void usb_discover(void *);
132 1.45 augustss Static void usb_create_event_thread(void *);
133 1.45 augustss Static void usb_event_thread(void *);
134 1.58 augustss Static void usb_task_thread(void *);
135 1.1 augustss
136 1.41 augustss #define USB_MAX_EVENTS 100
137 1.26 augustss struct usb_event_q {
138 1.26 augustss struct usb_event ue;
139 1.26 augustss SIMPLEQ_ENTRY(usb_event_q) next;
140 1.26 augustss };
141 1.66 augustss Static SIMPLEQ_HEAD(, usb_event_q) usb_events =
142 1.29 augustss SIMPLEQ_HEAD_INITIALIZER(usb_events);
143 1.42 augustss Static int usb_nevents = 0;
144 1.42 augustss Static struct selinfo usb_selevent;
145 1.60 augustss Static usb_proc_ptr usb_async_proc; /* process that wants USB SIGIO */
146 1.42 augustss Static int usb_dev_open = 0;
147 1.87 christos Static struct usb_event *usb_alloc_event(void);
148 1.87 christos Static void usb_free_event(struct usb_event *);
149 1.45 augustss Static void usb_add_event(int, struct usb_event *);
150 1.26 augustss
151 1.45 augustss Static int usb_get_next_event(struct usb_event *);
152 1.23 augustss
153 1.92 pavel #ifdef COMPAT_30
154 1.92 pavel Static void usb_copy_old_devinfo(struct usb_device_info_old *, const struct usb_device_info *);
155 1.92 pavel #endif
156 1.92 pavel
157 1.42 augustss Static const char *usbrev_str[] = USBREV_STR;
158 1.31 augustss
159 1.28 augustss USB_DECLARE_DRIVER(usb);
160 1.1 augustss
161 1.7 augustss USB_MATCH(usb)
162 1.1 augustss {
163 1.1 augustss DPRINTF(("usbd_match\n"));
164 1.7 augustss return (UMATCH_GENERIC);
165 1.1 augustss }
166 1.1 augustss
167 1.7 augustss USB_ATTACH(usb)
168 1.1 augustss {
169 1.1 augustss struct usb_softc *sc = (struct usb_softc *)self;
170 1.1 augustss usbd_device_handle dev;
171 1.29 augustss usbd_status err;
172 1.31 augustss int usbrev;
173 1.57 augustss int speed;
174 1.87 christos struct usb_event *ue;
175 1.66 augustss
176 1.1 augustss DPRINTF(("usbd_attach\n"));
177 1.31 augustss
178 1.4 augustss usbd_init();
179 1.1 augustss sc->sc_bus = aux;
180 1.1 augustss sc->sc_bus->usbctl = sc;
181 1.1 augustss sc->sc_port.power = USB_MAX_POWER;
182 1.31 augustss
183 1.31 augustss usbrev = sc->sc_bus->usbrev;
184 1.32 augustss printf(": USB revision %s", usbrev_str[usbrev]);
185 1.57 augustss switch (usbrev) {
186 1.57 augustss case USBREV_1_0:
187 1.57 augustss case USBREV_1_1:
188 1.57 augustss speed = USB_SPEED_FULL;
189 1.57 augustss break;
190 1.57 augustss case USBREV_2_0:
191 1.57 augustss speed = USB_SPEED_HIGH;
192 1.57 augustss break;
193 1.57 augustss default:
194 1.31 augustss printf(", not supported\n");
195 1.57 augustss sc->sc_dying = 1;
196 1.31 augustss USB_ATTACH_ERROR_RETURN;
197 1.32 augustss }
198 1.32 augustss printf("\n");
199 1.31 augustss
200 1.35 augustss /* Make sure not to use tsleep() if we are cold booting. */
201 1.35 augustss if (cold)
202 1.35 augustss sc->sc_bus->use_polling++;
203 1.35 augustss
204 1.87 christos ue = usb_alloc_event();
205 1.87 christos ue->u.ue_ctrlr.ue_bus = USBDEVUNIT(sc->sc_dev);
206 1.87 christos usb_add_event(USB_EVENT_CTRLR_ATTACH, ue);
207 1.38 augustss
208 1.49 augustss #ifdef USB_USE_SOFTINTR
209 1.49 augustss #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
210 1.49 augustss /* XXX we should have our own level */
211 1.66 augustss sc->sc_bus->soft = softintr_establish(IPL_SOFTNET,
212 1.49 augustss sc->sc_bus->methods->soft_intr, sc->sc_bus);
213 1.49 augustss if (sc->sc_bus->soft == NULL) {
214 1.49 augustss printf("%s: can't register softintr\n", USBDEVNAME(sc->sc_dev));
215 1.49 augustss sc->sc_dying = 1;
216 1.57 augustss USB_ATTACH_ERROR_RETURN;
217 1.49 augustss }
218 1.49 augustss #else
219 1.70 augustss usb_callout_init(sc->sc_bus->softi);
220 1.49 augustss #endif
221 1.49 augustss #endif
222 1.49 augustss
223 1.57 augustss err = usbd_new_device(USBDEV(sc->sc_dev), sc->sc_bus, 0, speed, 0,
224 1.29 augustss &sc->sc_port);
225 1.29 augustss if (!err) {
226 1.1 augustss dev = sc->sc_port.device;
227 1.29 augustss if (dev->hub == NULL) {
228 1.22 augustss sc->sc_dying = 1;
229 1.66 augustss printf("%s: root device is not a hub\n",
230 1.7 augustss USBDEVNAME(sc->sc_dev));
231 1.7 augustss USB_ATTACH_ERROR_RETURN;
232 1.1 augustss }
233 1.1 augustss sc->sc_bus->root_hub = dev;
234 1.24 augustss #if 1
235 1.66 augustss /*
236 1.24 augustss * Turning this code off will delay attachment of USB devices
237 1.24 augustss * until the USB event thread is running, which means that
238 1.24 augustss * the keyboard will not work until after cold boot.
239 1.24 augustss */
240 1.86 thorpej if (cold && (device_cfdata(&sc->sc_dev)->cf_flags & 1))
241 1.24 augustss dev->hub->explore(sc->sc_bus->root_hub);
242 1.24 augustss #endif
243 1.1 augustss } else {
244 1.66 augustss printf("%s: root hub problem, error=%d\n",
245 1.66 augustss USBDEVNAME(sc->sc_dev), err);
246 1.22 augustss sc->sc_dying = 1;
247 1.1 augustss }
248 1.35 augustss if (cold)
249 1.35 augustss sc->sc_bus->use_polling--;
250 1.7 augustss
251 1.37 thorpej config_pending_incr();
252 1.43 augustss usb_kthread_create(usb_create_event_thread, sc);
253 1.28 augustss
254 1.7 augustss USB_ATTACH_SUCCESS_RETURN;
255 1.1 augustss }
256 1.1 augustss
257 1.90 joerg static const char *taskq_names[] = USB_TASKQ_NAMES;
258 1.90 joerg
259 1.28 augustss #if defined(__NetBSD__) || defined(__OpenBSD__)
260 1.13 augustss void
261 1.45 augustss usb_create_event_thread(void *arg)
262 1.13 augustss {
263 1.13 augustss struct usb_softc *sc = arg;
264 1.90 joerg struct usb_taskq *taskq;
265 1.90 joerg int i;
266 1.13 augustss
267 1.43 augustss if (usb_kthread_create1(usb_event_thread, sc, &sc->sc_event_thread,
268 1.13 augustss "%s", sc->sc_dev.dv_xname)) {
269 1.13 augustss printf("%s: unable to create event thread for\n",
270 1.13 augustss sc->sc_dev.dv_xname);
271 1.13 augustss panic("usb_create_event_thread");
272 1.13 augustss }
273 1.90 joerg for (i = 0; i < USB_NUM_TASKQS; i++) {
274 1.90 joerg taskq = &usb_taskq[i];
275 1.90 joerg
276 1.90 joerg if (taskq->taskcreated)
277 1.90 joerg continue;
278 1.90 joerg
279 1.90 joerg TAILQ_INIT(&taskq->tasks);
280 1.90 joerg taskq->taskcreated = 1;
281 1.90 joerg taskq->name = taskq_names[i];
282 1.90 joerg if (usb_kthread_create1(usb_task_thread, taskq,
283 1.90 joerg &taskq->task_thread_proc, taskq->name)) {
284 1.90 joerg printf("unable to create task thread: %s\n", taskq->name);
285 1.58 augustss panic("usb_create_event_thread task");
286 1.58 augustss }
287 1.58 augustss }
288 1.13 augustss }
289 1.13 augustss
290 1.52 augustss /*
291 1.62 augustss * Add a task to be performed by the task thread. This function can be
292 1.52 augustss * called from any context and the task will be executed in a process
293 1.52 augustss * context ASAP.
294 1.52 augustss */
295 1.13 augustss void
296 1.91 christos usb_add_task(usbd_device_handle dev, struct usb_task *task, int queue)
297 1.51 augustss {
298 1.90 joerg struct usb_taskq *taskq;
299 1.51 augustss int s;
300 1.51 augustss
301 1.90 joerg taskq = &usb_taskq[queue];
302 1.51 augustss s = splusb();
303 1.90 joerg if (task->queue == -1) {
304 1.58 augustss DPRINTFN(2,("usb_add_task: task=%p\n", task));
305 1.90 joerg TAILQ_INSERT_TAIL(&taskq->tasks, task, next);
306 1.90 joerg task->queue = queue;
307 1.62 augustss } else {
308 1.58 augustss DPRINTFN(3,("usb_add_task: task=%p on q\n", task));
309 1.62 augustss }
310 1.90 joerg wakeup(&taskq->tasks);
311 1.51 augustss splx(s);
312 1.51 augustss }
313 1.51 augustss
314 1.51 augustss void
315 1.91 christos usb_rem_task(usbd_device_handle dev, struct usb_task *task)
316 1.53 augustss {
317 1.90 joerg struct usb_taskq *taskq;
318 1.53 augustss int s;
319 1.53 augustss
320 1.90 joerg taskq = &usb_taskq[task->queue];
321 1.53 augustss s = splusb();
322 1.90 joerg if (task->queue != -1) {
323 1.90 joerg TAILQ_REMOVE(&taskq->tasks, task, next);
324 1.90 joerg task->queue = -1;
325 1.53 augustss }
326 1.53 augustss splx(s);
327 1.53 augustss }
328 1.53 augustss
329 1.53 augustss void
330 1.45 augustss usb_event_thread(void *arg)
331 1.13 augustss {
332 1.13 augustss struct usb_softc *sc = arg;
333 1.13 augustss
334 1.27 augustss DPRINTF(("usb_event_thread: start\n"));
335 1.40 augustss
336 1.60 augustss /*
337 1.60 augustss * In case this controller is a companion controller to an
338 1.60 augustss * EHCI controller we need to wait until the EHCI controller
339 1.60 augustss * has grabbed the port.
340 1.64 augustss * XXX It would be nicer to do this with a tsleep(), but I don't
341 1.64 augustss * know how to synchronize the creation of the threads so it
342 1.64 augustss * will work.
343 1.60 augustss */
344 1.61 augustss usb_delay_ms(sc->sc_bus, 500);
345 1.60 augustss
346 1.40 augustss /* Make sure first discover does something. */
347 1.40 augustss sc->sc_bus->needs_explore = 1;
348 1.51 augustss usb_discover(sc);
349 1.51 augustss config_pending_decr();
350 1.27 augustss
351 1.22 augustss while (!sc->sc_dying) {
352 1.58 augustss #ifdef USB_DEBUG
353 1.58 augustss if (usb_noexplore < 2)
354 1.58 augustss #endif
355 1.58 augustss usb_discover(sc);
356 1.58 augustss #ifdef USB_DEBUG
357 1.58 augustss (void)tsleep(&sc->sc_bus->needs_explore, PWAIT, "usbevt",
358 1.58 augustss usb_noexplore ? 0 : hz * 60);
359 1.58 augustss #else
360 1.58 augustss (void)tsleep(&sc->sc_bus->needs_explore, PWAIT, "usbevt",
361 1.58 augustss hz * 60);
362 1.58 augustss #endif
363 1.58 augustss DPRINTFN(2,("usb_event_thread: woke up\n"));
364 1.13 augustss }
365 1.50 augustss sc->sc_event_thread = NULL;
366 1.13 augustss
367 1.13 augustss /* In case parent is waiting for us to exit. */
368 1.13 augustss wakeup(sc);
369 1.13 augustss
370 1.27 augustss DPRINTF(("usb_event_thread: exit\n"));
371 1.13 augustss kthread_exit(0);
372 1.13 augustss }
373 1.13 augustss
374 1.58 augustss void
375 1.90 joerg usb_task_thread(void *arg)
376 1.58 augustss {
377 1.58 augustss struct usb_task *task;
378 1.90 joerg struct usb_taskq *taskq;
379 1.58 augustss int s;
380 1.58 augustss
381 1.90 joerg taskq = arg;
382 1.90 joerg DPRINTF(("usb_task_thread: start taskq %s\n", taskq->name));
383 1.58 augustss
384 1.58 augustss s = splusb();
385 1.58 augustss for (;;) {
386 1.90 joerg task = TAILQ_FIRST(&taskq->tasks);
387 1.58 augustss if (task == NULL) {
388 1.90 joerg tsleep(&taskq->tasks, PWAIT, "usbtsk", 0);
389 1.90 joerg task = TAILQ_FIRST(&taskq->tasks);
390 1.58 augustss }
391 1.58 augustss DPRINTFN(2,("usb_task_thread: woke up task=%p\n", task));
392 1.58 augustss if (task != NULL) {
393 1.90 joerg TAILQ_REMOVE(&taskq->tasks, task, next);
394 1.90 joerg task->queue = -1;
395 1.58 augustss splx(s);
396 1.58 augustss task->fun(task->arg);
397 1.58 augustss s = splusb();
398 1.58 augustss }
399 1.58 augustss }
400 1.58 augustss }
401 1.58 augustss
402 1.1 augustss int
403 1.91 christos usbctlprint(void *aux, const char *pnp)
404 1.1 augustss {
405 1.1 augustss /* only "usb"es can attach to host controllers */
406 1.1 augustss if (pnp)
407 1.77 thorpej aprint_normal("usb at %s", pnp);
408 1.1 augustss
409 1.1 augustss return (UNCONF);
410 1.1 augustss }
411 1.28 augustss #endif /* defined(__NetBSD__) || defined(__OpenBSD__) */
412 1.7 augustss
413 1.1 augustss int
414 1.91 christos usbopen(dev_t dev, int flag, int mode, struct lwp *l)
415 1.1 augustss {
416 1.26 augustss int unit = minor(dev);
417 1.26 augustss struct usb_softc *sc;
418 1.26 augustss
419 1.26 augustss if (unit == USB_DEV_MINOR) {
420 1.26 augustss if (usb_dev_open)
421 1.26 augustss return (EBUSY);
422 1.26 augustss usb_dev_open = 1;
423 1.26 augustss usb_async_proc = 0;
424 1.26 augustss return (0);
425 1.26 augustss }
426 1.26 augustss
427 1.26 augustss USB_GET_SC_OPEN(usb, unit, sc);
428 1.1 augustss
429 1.22 augustss if (sc->sc_dying)
430 1.22 augustss return (EIO);
431 1.1 augustss
432 1.1 augustss return (0);
433 1.1 augustss }
434 1.1 augustss
435 1.1 augustss int
436 1.45 augustss usbread(dev_t dev, struct uio *uio, int flag)
437 1.26 augustss {
438 1.92 pavel struct usb_event *ue;
439 1.92 pavel #ifdef COMPAT_30
440 1.93 christos struct usb_event_old *ueo = NULL; /* XXXGCC */
441 1.92 pavel #endif
442 1.92 pavel int s, error, n, useold;
443 1.26 augustss
444 1.26 augustss if (minor(dev) != USB_DEV_MINOR)
445 1.26 augustss return (ENXIO);
446 1.26 augustss
447 1.92 pavel useold = 0;
448 1.92 pavel switch (uio->uio_resid) {
449 1.92 pavel #ifdef COMPAT_30
450 1.92 pavel case sizeof(struct usb_event_old):
451 1.92 pavel ueo = malloc(sizeof(struct usb_event_old), M_USBDEV,
452 1.92 pavel M_WAITOK|M_ZERO);
453 1.92 pavel useold = 1;
454 1.92 pavel /* FALLTHRU */
455 1.92 pavel #endif
456 1.92 pavel case sizeof(struct usb_event):
457 1.92 pavel ue = usb_alloc_event();
458 1.92 pavel break;
459 1.92 pavel default:
460 1.26 augustss return (EINVAL);
461 1.92 pavel }
462 1.26 augustss
463 1.26 augustss error = 0;
464 1.26 augustss s = splusb();
465 1.26 augustss for (;;) {
466 1.87 christos n = usb_get_next_event(ue);
467 1.26 augustss if (n != 0)
468 1.26 augustss break;
469 1.26 augustss if (flag & IO_NDELAY) {
470 1.26 augustss error = EWOULDBLOCK;
471 1.26 augustss break;
472 1.26 augustss }
473 1.26 augustss error = tsleep(&usb_events, PZERO | PCATCH, "usbrea", 0);
474 1.26 augustss if (error)
475 1.26 augustss break;
476 1.26 augustss }
477 1.26 augustss splx(s);
478 1.92 pavel if (!error) {
479 1.92 pavel #ifdef COMPAT_30
480 1.92 pavel if (useold) { /* copy fields to old struct */
481 1.92 pavel ueo->ue_type = ue->ue_type;
482 1.92 pavel memcpy(&ueo->ue_time, &ue->ue_time,
483 1.92 pavel sizeof(struct timespec));
484 1.92 pavel switch (ue->ue_type) {
485 1.92 pavel case USB_EVENT_DEVICE_ATTACH:
486 1.92 pavel case USB_EVENT_DEVICE_DETACH:
487 1.92 pavel usb_copy_old_devinfo(&ueo->u.ue_device, &ue->u.ue_device);
488 1.92 pavel break;
489 1.92 pavel
490 1.92 pavel case USB_EVENT_CTRLR_ATTACH:
491 1.92 pavel case USB_EVENT_CTRLR_DETACH:
492 1.92 pavel ueo->u.ue_ctrlr.ue_bus=ue->u.ue_ctrlr.ue_bus;
493 1.92 pavel break;
494 1.92 pavel
495 1.92 pavel case USB_EVENT_DRIVER_ATTACH:
496 1.92 pavel case USB_EVENT_DRIVER_DETACH:
497 1.92 pavel ueo->u.ue_driver.ue_cookie=ue->u.ue_driver.ue_cookie;
498 1.92 pavel memcpy(ueo->u.ue_driver.ue_devname,
499 1.92 pavel ue->u.ue_driver.ue_devname,
500 1.92 pavel sizeof(ue->u.ue_driver.ue_devname));
501 1.92 pavel break;
502 1.92 pavel default:
503 1.92 pavel ;
504 1.92 pavel }
505 1.92 pavel
506 1.92 pavel error = uiomove((void *)ueo, uio->uio_resid, uio);
507 1.92 pavel } else
508 1.92 pavel #endif
509 1.92 pavel error = uiomove((void *)ue, uio->uio_resid, uio);
510 1.92 pavel }
511 1.87 christos usb_free_event(ue);
512 1.92 pavel #ifdef COMPAT_30
513 1.92 pavel if (useold)
514 1.92 pavel free(ueo, M_USBDEV);
515 1.92 pavel #endif
516 1.26 augustss
517 1.26 augustss return (error);
518 1.26 augustss }
519 1.26 augustss
520 1.26 augustss int
521 1.91 christos usbclose(dev_t dev, int flag, int mode,
522 1.91 christos struct lwp *l)
523 1.1 augustss {
524 1.26 augustss int unit = minor(dev);
525 1.26 augustss
526 1.26 augustss if (unit == USB_DEV_MINOR) {
527 1.26 augustss usb_async_proc = 0;
528 1.26 augustss usb_dev_open = 0;
529 1.26 augustss }
530 1.26 augustss
531 1.1 augustss return (0);
532 1.1 augustss }
533 1.1 augustss
534 1.1 augustss int
535 1.84 christos usbioctl(dev_t devt, u_long cmd, caddr_t data, int flag, struct lwp *l)
536 1.1 augustss {
537 1.26 augustss struct usb_softc *sc;
538 1.28 augustss int unit = minor(devt);
539 1.26 augustss
540 1.26 augustss if (unit == USB_DEV_MINOR) {
541 1.26 augustss switch (cmd) {
542 1.26 augustss case FIONBIO:
543 1.26 augustss /* All handled in the upper FS layer. */
544 1.26 augustss return (0);
545 1.66 augustss
546 1.26 augustss case FIOASYNC:
547 1.26 augustss if (*(int *)data)
548 1.84 christos usb_async_proc = l->l_proc;
549 1.26 augustss else
550 1.26 augustss usb_async_proc = 0;
551 1.26 augustss return (0);
552 1.26 augustss
553 1.26 augustss default:
554 1.26 augustss return (EINVAL);
555 1.26 augustss }
556 1.26 augustss }
557 1.26 augustss
558 1.26 augustss USB_GET_SC(usb, unit, sc);
559 1.1 augustss
560 1.22 augustss if (sc->sc_dying)
561 1.22 augustss return (EIO);
562 1.22 augustss
563 1.1 augustss switch (cmd) {
564 1.1 augustss #ifdef USB_DEBUG
565 1.1 augustss case USB_SETDEBUG:
566 1.69 augustss if (!(flag & FWRITE))
567 1.69 augustss return (EBADF);
568 1.30 augustss usbdebug = ((*(int *)data) & 0x000000ff);
569 1.76 dsainty #if defined(UHCI_DEBUG) && NUHCI > 0
570 1.30 augustss uhcidebug = ((*(int *)data) & 0x0000ff00) >> 8;
571 1.30 augustss #endif
572 1.76 dsainty #if defined(OHCI_DEBUG) && NOHCI > 0
573 1.30 augustss ohcidebug = ((*(int *)data) & 0x00ff0000) >> 16;
574 1.30 augustss #endif
575 1.1 augustss break;
576 1.56 augustss #endif /* USB_DEBUG */
577 1.1 augustss case USB_REQUEST:
578 1.1 augustss {
579 1.1 augustss struct usb_ctl_request *ur = (void *)data;
580 1.68 christos int len = UGETW(ur->ucr_request.wLength);
581 1.1 augustss struct iovec iov;
582 1.1 augustss struct uio uio;
583 1.1 augustss void *ptr = 0;
584 1.68 christos int addr = ur->ucr_addr;
585 1.29 augustss usbd_status err;
586 1.1 augustss int error = 0;
587 1.69 augustss
588 1.69 augustss if (!(flag & FWRITE))
589 1.69 augustss return (EBADF);
590 1.1 augustss
591 1.9 augustss DPRINTF(("usbioctl: USB_REQUEST addr=%d len=%d\n", addr, len));
592 1.1 augustss if (len < 0 || len > 32768)
593 1.9 augustss return (EINVAL);
594 1.66 augustss if (addr < 0 || addr >= USB_MAX_DEVICES ||
595 1.1 augustss sc->sc_bus->devices[addr] == 0)
596 1.9 augustss return (EINVAL);
597 1.1 augustss if (len != 0) {
598 1.68 christos iov.iov_base = (caddr_t)ur->ucr_data;
599 1.1 augustss iov.iov_len = len;
600 1.1 augustss uio.uio_iov = &iov;
601 1.1 augustss uio.uio_iovcnt = 1;
602 1.1 augustss uio.uio_resid = len;
603 1.1 augustss uio.uio_offset = 0;
604 1.1 augustss uio.uio_rw =
605 1.68 christos ur->ucr_request.bmRequestType & UT_READ ?
606 1.1 augustss UIO_READ : UIO_WRITE;
607 1.85 yamt uio.uio_vmspace = l->l_proc->p_vmspace;
608 1.1 augustss ptr = malloc(len, M_TEMP, M_WAITOK);
609 1.1 augustss if (uio.uio_rw == UIO_WRITE) {
610 1.1 augustss error = uiomove(ptr, len, &uio);
611 1.1 augustss if (error)
612 1.1 augustss goto ret;
613 1.1 augustss }
614 1.1 augustss }
615 1.29 augustss err = usbd_do_request_flags(sc->sc_bus->devices[addr],
616 1.68 christos &ur->ucr_request, ptr, ur->ucr_flags, &ur->ucr_actlen,
617 1.67 augustss USBD_DEFAULT_TIMEOUT);
618 1.29 augustss if (err) {
619 1.1 augustss error = EIO;
620 1.1 augustss goto ret;
621 1.1 augustss }
622 1.1 augustss if (len != 0) {
623 1.1 augustss if (uio.uio_rw == UIO_READ) {
624 1.1 augustss error = uiomove(ptr, len, &uio);
625 1.1 augustss if (error)
626 1.1 augustss goto ret;
627 1.1 augustss }
628 1.1 augustss }
629 1.1 augustss ret:
630 1.1 augustss if (ptr)
631 1.1 augustss free(ptr, M_TEMP);
632 1.1 augustss return (error);
633 1.1 augustss }
634 1.1 augustss
635 1.1 augustss case USB_DEVICEINFO:
636 1.93 christos {
637 1.93 christos usbd_device_handle dev;
638 1.93 christos struct usb_device_info *di = (void *)data;
639 1.93 christos int addr = di->udi_addr;
640 1.93 christos
641 1.93 christos if (addr < 1 || addr >= USB_MAX_DEVICES)
642 1.93 christos return EINVAL;
643 1.93 christos if ((dev = sc->sc_bus->devices[addr]) == NULL)
644 1.93 christos return ENXIO;
645 1.93 christos usbd_fill_deviceinfo(dev, di, 1);
646 1.93 christos break;
647 1.93 christos }
648 1.93 christos
649 1.92 pavel #ifdef COMPAT_30
650 1.92 pavel case USB_DEVICEINFO_OLD:
651 1.1 augustss {
652 1.30 augustss usbd_device_handle dev;
653 1.93 christos struct usb_device_info_old *di = (void *)data;
654 1.93 christos int addr = di->udi_addr;
655 1.1 augustss
656 1.1 augustss if (addr < 1 || addr >= USB_MAX_DEVICES)
657 1.93 christos return EINVAL;
658 1.93 christos if ((dev = sc->sc_bus->devices[addr]) == NULL)
659 1.93 christos return ENXIO;
660 1.93 christos usbd_fill_deviceinfo_old(dev, di, 1);
661 1.1 augustss break;
662 1.1 augustss }
663 1.93 christos #endif
664 1.2 augustss
665 1.2 augustss case USB_DEVICESTATS:
666 1.2 augustss *(struct usb_device_stats *)data = sc->sc_bus->stats;
667 1.2 augustss break;
668 1.1 augustss
669 1.1 augustss default:
670 1.26 augustss return (EINVAL);
671 1.1 augustss }
672 1.1 augustss return (0);
673 1.1 augustss }
674 1.1 augustss
675 1.1 augustss int
676 1.84 christos usbpoll(dev_t dev, int events, struct lwp *l)
677 1.1 augustss {
678 1.26 augustss int revents, mask, s;
679 1.1 augustss
680 1.30 augustss if (minor(dev) == USB_DEV_MINOR) {
681 1.30 augustss revents = 0;
682 1.30 augustss mask = POLLIN | POLLRDNORM;
683 1.66 augustss
684 1.30 augustss s = splusb();
685 1.30 augustss if (events & mask && usb_nevents > 0)
686 1.30 augustss revents |= events & mask;
687 1.30 augustss if (revents == 0 && events & mask)
688 1.84 christos selrecord(l, &usb_selevent);
689 1.30 augustss splx(s);
690 1.66 augustss
691 1.30 augustss return (revents);
692 1.30 augustss } else {
693 1.82 ws return (0);
694 1.1 augustss }
695 1.1 augustss }
696 1.1 augustss
697 1.74 jdolecek static void
698 1.74 jdolecek filt_usbrdetach(struct knote *kn)
699 1.74 jdolecek {
700 1.74 jdolecek int s;
701 1.74 jdolecek
702 1.74 jdolecek s = splusb();
703 1.75 christos SLIST_REMOVE(&usb_selevent.sel_klist, kn, knote, kn_selnext);
704 1.74 jdolecek splx(s);
705 1.74 jdolecek }
706 1.74 jdolecek
707 1.74 jdolecek static int
708 1.91 christos filt_usbread(struct knote *kn, long hint)
709 1.74 jdolecek {
710 1.74 jdolecek
711 1.74 jdolecek if (usb_nevents == 0)
712 1.74 jdolecek return (0);
713 1.74 jdolecek
714 1.74 jdolecek kn->kn_data = sizeof(struct usb_event);
715 1.74 jdolecek return (1);
716 1.74 jdolecek }
717 1.74 jdolecek
718 1.74 jdolecek static const struct filterops usbread_filtops =
719 1.74 jdolecek { 1, NULL, filt_usbrdetach, filt_usbread };
720 1.74 jdolecek
721 1.74 jdolecek int
722 1.74 jdolecek usbkqfilter(dev_t dev, struct knote *kn)
723 1.74 jdolecek {
724 1.74 jdolecek struct klist *klist;
725 1.74 jdolecek int s;
726 1.74 jdolecek
727 1.74 jdolecek switch (kn->kn_filter) {
728 1.74 jdolecek case EVFILT_READ:
729 1.74 jdolecek if (minor(dev) != USB_DEV_MINOR)
730 1.74 jdolecek return (1);
731 1.75 christos klist = &usb_selevent.sel_klist;
732 1.74 jdolecek kn->kn_fop = &usbread_filtops;
733 1.74 jdolecek break;
734 1.74 jdolecek
735 1.74 jdolecek default:
736 1.74 jdolecek return (1);
737 1.74 jdolecek }
738 1.74 jdolecek
739 1.74 jdolecek kn->kn_hook = NULL;
740 1.74 jdolecek
741 1.74 jdolecek s = splusb();
742 1.74 jdolecek SLIST_INSERT_HEAD(klist, kn, kn_selnext);
743 1.74 jdolecek splx(s);
744 1.74 jdolecek
745 1.74 jdolecek return (0);
746 1.74 jdolecek }
747 1.74 jdolecek
748 1.25 augustss /* Explore device tree from the root. */
749 1.51 augustss Static void
750 1.51 augustss usb_discover(void *v)
751 1.1 augustss {
752 1.51 augustss struct usb_softc *sc = v;
753 1.51 augustss
754 1.51 augustss DPRINTFN(2,("usb_discover\n"));
755 1.51 augustss #ifdef USB_DEBUG
756 1.51 augustss if (usb_noexplore > 1)
757 1.51 augustss return;
758 1.51 augustss #endif
759 1.66 augustss /*
760 1.25 augustss * We need mutual exclusion while traversing the device tree,
761 1.25 augustss * but this is guaranteed since this function is only called
762 1.25 augustss * from the event thread for the controller.
763 1.25 augustss */
764 1.30 augustss while (sc->sc_bus->needs_explore && !sc->sc_dying) {
765 1.13 augustss sc->sc_bus->needs_explore = 0;
766 1.13 augustss sc->sc_bus->root_hub->hub->explore(sc->sc_bus->root_hub);
767 1.30 augustss }
768 1.1 augustss }
769 1.1 augustss
770 1.1 augustss void
771 1.51 augustss usb_needs_explore(usbd_device_handle dev)
772 1.1 augustss {
773 1.51 augustss DPRINTFN(2,("usb_needs_explore\n"));
774 1.51 augustss dev->bus->needs_explore = 1;
775 1.58 augustss wakeup(&dev->bus->needs_explore);
776 1.1 augustss }
777 1.7 augustss
778 1.81 joff void
779 1.81 joff usb_needs_reattach(usbd_device_handle dev)
780 1.81 joff {
781 1.81 joff DPRINTFN(2,("usb_needs_reattach\n"));
782 1.81 joff dev->powersrc->reattach = 1;
783 1.81 joff dev->bus->needs_explore = 1;
784 1.81 joff wakeup(&dev->bus->needs_explore);
785 1.81 joff }
786 1.81 joff
787 1.26 augustss /* Called at splusb() */
788 1.26 augustss int
789 1.45 augustss usb_get_next_event(struct usb_event *ue)
790 1.26 augustss {
791 1.26 augustss struct usb_event_q *ueq;
792 1.26 augustss
793 1.26 augustss if (usb_nevents <= 0)
794 1.26 augustss return (0);
795 1.26 augustss ueq = SIMPLEQ_FIRST(&usb_events);
796 1.65 augustss #ifdef DIAGNOSTIC
797 1.65 augustss if (ueq == NULL) {
798 1.65 augustss printf("usb: usb_nevents got out of sync! %d\n", usb_nevents);
799 1.65 augustss usb_nevents = 0;
800 1.65 augustss return (0);
801 1.65 augustss }
802 1.65 augustss #endif
803 1.83 drochner if (ue)
804 1.83 drochner *ue = ueq->ue;
805 1.71 lukem SIMPLEQ_REMOVE_HEAD(&usb_events, next);
806 1.87 christos usb_free_event((struct usb_event *)(void *)ueq);
807 1.26 augustss usb_nevents--;
808 1.26 augustss return (1);
809 1.26 augustss }
810 1.26 augustss
811 1.26 augustss void
812 1.45 augustss usbd_add_dev_event(int type, usbd_device_handle udev)
813 1.38 augustss {
814 1.87 christos struct usb_event *ue = usb_alloc_event();
815 1.38 augustss
816 1.87 christos usbd_fill_deviceinfo(udev, &ue->u.ue_device, USB_EVENT_IS_ATTACH(type));
817 1.87 christos usb_add_event(type, ue);
818 1.38 augustss }
819 1.38 augustss
820 1.38 augustss void
821 1.45 augustss usbd_add_drv_event(int type, usbd_device_handle udev, device_ptr_t dev)
822 1.38 augustss {
823 1.87 christos struct usb_event *ue = usb_alloc_event();
824 1.87 christos
825 1.87 christos ue->u.ue_driver.ue_cookie = udev->cookie;
826 1.87 christos strncpy(ue->u.ue_driver.ue_devname, USBDEVPTRNAME(dev),
827 1.87 christos sizeof ue->u.ue_driver.ue_devname);
828 1.87 christos usb_add_event(type, ue);
829 1.87 christos }
830 1.87 christos
831 1.87 christos Static struct usb_event *
832 1.87 christos usb_alloc_event(void)
833 1.87 christos {
834 1.87 christos /* Yes, this is right; we allocate enough so that we can use it later */
835 1.87 christos return malloc(sizeof(struct usb_event_q), M_USBDEV, M_WAITOK|M_ZERO);
836 1.87 christos }
837 1.38 augustss
838 1.87 christos Static void
839 1.87 christos usb_free_event(struct usb_event *uep)
840 1.87 christos {
841 1.87 christos free(uep, M_USBDEV);
842 1.38 augustss }
843 1.38 augustss
844 1.42 augustss Static void
845 1.45 augustss usb_add_event(int type, struct usb_event *uep)
846 1.26 augustss {
847 1.26 augustss struct usb_event_q *ueq;
848 1.26 augustss struct timeval thetime;
849 1.26 augustss int s;
850 1.26 augustss
851 1.38 augustss microtime(&thetime);
852 1.38 augustss /* Don't want to wait here inside splusb() */
853 1.87 christos ueq = (struct usb_event_q *)(void *)uep;
854 1.38 augustss ueq->ue = *uep;
855 1.38 augustss ueq->ue.ue_type = type;
856 1.38 augustss TIMEVAL_TO_TIMESPEC(&thetime, &ueq->ue.ue_time);
857 1.38 augustss
858 1.26 augustss s = splusb();
859 1.26 augustss if (++usb_nevents >= USB_MAX_EVENTS) {
860 1.26 augustss /* Too many queued events, drop an old one. */
861 1.26 augustss DPRINTFN(-1,("usb: event dropped\n"));
862 1.83 drochner (void)usb_get_next_event(0);
863 1.26 augustss }
864 1.26 augustss SIMPLEQ_INSERT_TAIL(&usb_events, ueq, next);
865 1.26 augustss wakeup(&usb_events);
866 1.74 jdolecek selnotify(&usb_selevent, 0);
867 1.94 ad if (usb_async_proc != NULL) {
868 1.94 ad mutex_enter(&proclist_mutex);
869 1.26 augustss psignal(usb_async_proc, SIGIO);
870 1.94 ad mutex_exit(&proclist_mutex);
871 1.94 ad }
872 1.26 augustss splx(s);
873 1.39 augustss }
874 1.60 augustss
875 1.39 augustss void
876 1.49 augustss usb_schedsoftintr(usbd_bus_handle bus)
877 1.39 augustss {
878 1.54 augustss DPRINTFN(10,("usb_schedsoftintr: polling=%d\n", bus->use_polling));
879 1.49 augustss #ifdef USB_USE_SOFTINTR
880 1.49 augustss if (bus->use_polling) {
881 1.49 augustss bus->methods->soft_intr(bus);
882 1.49 augustss } else {
883 1.49 augustss #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
884 1.49 augustss softintr_schedule(bus->soft);
885 1.49 augustss #else
886 1.49 augustss if (!callout_pending(&bus->softi))
887 1.49 augustss callout_reset(&bus->softi, 0, bus->methods->soft_intr,
888 1.49 augustss bus);
889 1.49 augustss #endif /* __HAVE_GENERIC_SOFT_INTERRUPTS */
890 1.49 augustss }
891 1.49 augustss #else
892 1.39 augustss bus->methods->soft_intr(bus);
893 1.56 augustss #endif /* USB_USE_SOFTINTR */
894 1.26 augustss }
895 1.26 augustss
896 1.7 augustss int
897 1.45 augustss usb_activate(device_ptr_t self, enum devact act)
898 1.7 augustss {
899 1.22 augustss struct usb_softc *sc = (struct usb_softc *)self;
900 1.25 augustss usbd_device_handle dev = sc->sc_port.device;
901 1.25 augustss int i, rv = 0;
902 1.22 augustss
903 1.22 augustss switch (act) {
904 1.22 augustss case DVACT_ACTIVATE:
905 1.22 augustss return (EOPNOTSUPP);
906 1.22 augustss
907 1.22 augustss case DVACT_DEACTIVATE:
908 1.22 augustss sc->sc_dying = 1;
909 1.62 augustss if (dev != NULL && dev->cdesc != NULL && dev->subdevs != NULL) {
910 1.25 augustss for (i = 0; dev->subdevs[i]; i++)
911 1.25 augustss rv |= config_deactivate(dev->subdevs[i]);
912 1.25 augustss }
913 1.22 augustss break;
914 1.22 augustss }
915 1.22 augustss return (rv);
916 1.13 augustss }
917 1.7 augustss
918 1.13 augustss int
919 1.91 christos usb_detach(device_ptr_t self, int flags)
920 1.13 augustss {
921 1.22 augustss struct usb_softc *sc = (struct usb_softc *)self;
922 1.87 christos struct usb_event *ue;
923 1.22 augustss
924 1.27 augustss DPRINTF(("usb_detach: start\n"));
925 1.27 augustss
926 1.22 augustss sc->sc_dying = 1;
927 1.22 augustss
928 1.22 augustss /* Make all devices disconnect. */
929 1.62 augustss if (sc->sc_port.device != NULL)
930 1.27 augustss usb_disconnect_port(&sc->sc_port, self);
931 1.22 augustss
932 1.22 augustss /* Kill off event thread. */
933 1.62 augustss if (sc->sc_event_thread != NULL) {
934 1.58 augustss wakeup(&sc->sc_bus->needs_explore);
935 1.22 augustss if (tsleep(sc, PWAIT, "usbdet", hz * 60))
936 1.22 augustss printf("%s: event thread didn't die\n",
937 1.22 augustss USBDEVNAME(sc->sc_dev));
938 1.27 augustss DPRINTF(("usb_detach: event thread dead\n"));
939 1.22 augustss }
940 1.22 augustss
941 1.26 augustss usbd_finish();
942 1.49 augustss
943 1.49 augustss #ifdef USB_USE_SOFTINTR
944 1.49 augustss #ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
945 1.49 augustss if (sc->sc_bus->soft != NULL) {
946 1.49 augustss softintr_disestablish(sc->sc_bus->soft);
947 1.49 augustss sc->sc_bus->soft = NULL;
948 1.49 augustss }
949 1.49 augustss #else
950 1.49 augustss callout_stop(&sc->sc_bus->softi);
951 1.49 augustss #endif
952 1.49 augustss #endif
953 1.38 augustss
954 1.87 christos ue = usb_alloc_event();
955 1.87 christos ue->u.ue_ctrlr.ue_bus = USBDEVUNIT(sc->sc_dev);
956 1.87 christos usb_add_event(USB_EVENT_CTRLR_DETACH, ue);
957 1.38 augustss
958 1.7 augustss return (0);
959 1.7 augustss }
960 1.92 pavel
961 1.92 pavel #ifdef COMPAT_30
962 1.92 pavel Static void
963 1.92 pavel usb_copy_old_devinfo(struct usb_device_info_old *uo,
964 1.92 pavel const struct usb_device_info *ue)
965 1.92 pavel {
966 1.92 pavel const unsigned char *p;
967 1.92 pavel unsigned char *q;
968 1.92 pavel int i, n;
969 1.92 pavel
970 1.92 pavel uo->udi_bus = ue->udi_bus;
971 1.92 pavel uo->udi_addr = ue->udi_addr;
972 1.92 pavel uo->udi_cookie = ue->udi_cookie;
973 1.92 pavel for (i = 0, p = (const unsigned char *)ue->udi_product,
974 1.92 pavel q = (unsigned char *)uo->udi_product;
975 1.92 pavel *p && i < USB_MAX_STRING_LEN - 1; p++) {
976 1.92 pavel if (*p < 0x80)
977 1.92 pavel q[i++] = *p;
978 1.92 pavel else {
979 1.92 pavel q[i++] = '?';
980 1.92 pavel if ((*p & 0xe0) == 0xe0)
981 1.92 pavel p++;
982 1.92 pavel p++;
983 1.92 pavel }
984 1.92 pavel }
985 1.92 pavel q[i] = 0;
986 1.92 pavel
987 1.92 pavel for (i = 0, p = ue->udi_vendor, q = uo->udi_vendor;
988 1.92 pavel *p && i < USB_MAX_STRING_LEN - 1; p++) {
989 1.92 pavel if (* p < 0x80)
990 1.92 pavel q[i++] = *p;
991 1.92 pavel else {
992 1.92 pavel q[i++] = '?';
993 1.92 pavel p++;
994 1.92 pavel if ((*p & 0xe0) == 0xe0)
995 1.92 pavel p++;
996 1.92 pavel }
997 1.92 pavel }
998 1.92 pavel q[i] = 0;
999 1.92 pavel
1000 1.92 pavel memcpy(uo->udi_release, ue->udi_release, sizeof(uo->udi_release));
1001 1.92 pavel
1002 1.92 pavel uo->udi_productNo = ue->udi_productNo;
1003 1.92 pavel uo->udi_vendorNo = ue->udi_vendorNo;
1004 1.92 pavel uo->udi_releaseNo = ue->udi_releaseNo;
1005 1.92 pavel uo->udi_class = ue->udi_class;
1006 1.92 pavel uo->udi_subclass = ue->udi_subclass;
1007 1.92 pavel uo->udi_protocol = ue->udi_protocol;
1008 1.92 pavel uo->udi_config = ue->udi_config;
1009 1.92 pavel uo->udi_speed = ue->udi_speed;
1010 1.92 pavel uo->udi_power = ue->udi_power;
1011 1.92 pavel uo->udi_nports = ue->udi_nports;
1012 1.92 pavel
1013 1.92 pavel for (n=0; n<USB_MAX_DEVNAMES; n++)
1014 1.92 pavel memcpy(uo->udi_devnames[n],
1015 1.92 pavel ue->udi_devnames[n], USB_MAX_DEVNAMELEN);
1016 1.92 pavel memcpy(uo->udi_ports, ue->udi_ports, sizeof(uo->udi_ports));
1017 1.92 pavel }
1018 1.92 pavel #endif
1019