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