Home | History | Annotate | Line # | Download | only in usb
usb.c revision 1.172
      1  1.172       mrg /*	$NetBSD: usb.c,v 1.172 2018/09/16 20:21:56 mrg Exp $	*/
      2    1.1  augustss 
      3    1.1  augustss /*
      4  1.129       mrg  * Copyright (c) 1998, 2002, 2008, 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.44  augustss  * by Lennart Augustsson (lennart (at) augustsson.net) at
      9  1.129       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.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.172       mrg __KERNEL_RCSID(0, "$NetBSD: usb.c,v 1.172 2018/09/16 20:21:56 mrg Exp $");
     41   1.92     pavel 
     42  1.137  christos #ifdef _KERNEL_OPT
     43  1.156     skrll #include "opt_usb.h"
     44   1.92     pavel #include "opt_compat_netbsd.h"
     45  1.137  christos #endif
     46   1.76   dsainty 
     47    1.1  augustss #include <sys/param.h>
     48    1.1  augustss #include <sys/systm.h>
     49    1.1  augustss #include <sys/kernel.h>
     50  1.162     skrll #include <sys/kmem.h>
     51    1.1  augustss #include <sys/device.h>
     52   1.13  augustss #include <sys/kthread.h>
     53   1.30  augustss #include <sys/proc.h>
     54   1.22  augustss #include <sys/conf.h>
     55   1.69  augustss #include <sys/fcntl.h>
     56    1.1  augustss #include <sys/poll.h>
     57    1.1  augustss #include <sys/select.h>
     58   1.26  augustss #include <sys/vnode.h>
     59   1.26  augustss #include <sys/signalvar.h>
     60  1.100        ad #include <sys/intr.h>
     61  1.121  pgoyette #include <sys/module.h>
     62  1.130       mrg #include <sys/mutex.h>
     63  1.130       mrg #include <sys/bus.h>
     64  1.130       mrg #include <sys/once.h>
     65  1.152  riastrad #include <sys/atomic.h>
     66  1.156     skrll #include <sys/sysctl.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.130       mrg #include <dev/usb/usbdivar.h>
     72  1.121  pgoyette #include <dev/usb/usb_verbose.h>
     73  1.130       mrg #include <dev/usb/usb_quirks.h>
     74  1.156     skrll #include <dev/usb/usbhist.h>
     75  1.156     skrll 
     76  1.160       mrg #if defined(USB_DEBUG)
     77  1.156     skrll 
     78  1.156     skrll #ifndef USBHIST_SIZE
     79  1.156     skrll #define USBHIST_SIZE 50000
     80  1.156     skrll #endif
     81  1.156     skrll 
     82  1.157     skrll static struct kern_history_ent usbhistbuf[USBHIST_SIZE];
     83  1.157     skrll USBHIST_DEFINE(usbhist) = KERNHIST_INITIALIZER(usbhist, usbhistbuf);
     84  1.157     skrll 
     85  1.156     skrll #endif
     86    1.1  augustss 
     87   1.26  augustss #define USB_DEV_MINOR 255
     88   1.26  augustss 
     89    1.1  augustss #ifdef USB_DEBUG
     90   1.66  augustss /*
     91   1.34  augustss  * 0  - do usual exploration
     92   1.34  augustss  * 1  - do not use timeout exploration
     93   1.34  augustss  * >1 - do no exploration
     94   1.34  augustss  */
     95   1.21  augustss int	usb_noexplore = 0;
     96  1.156     skrll 
     97  1.162     skrll int	usbdebug = 0;
     98  1.156     skrll SYSCTL_SETUP(sysctl_hw_usb_setup, "sysctl hw.usb setup")
     99  1.156     skrll {
    100  1.156     skrll 	int err;
    101  1.156     skrll 	const struct sysctlnode *rnode;
    102  1.156     skrll 	const struct sysctlnode *cnode;
    103  1.156     skrll 
    104  1.156     skrll 	err = sysctl_createv(clog, 0, NULL, &rnode,
    105  1.156     skrll 	    CTLFLAG_PERMANENT, CTLTYPE_NODE, "usb",
    106  1.156     skrll 	    SYSCTL_DESCR("usb global controls"),
    107  1.156     skrll 	    NULL, 0, NULL, 0, CTL_HW, CTL_CREATE, CTL_EOL);
    108  1.156     skrll 
    109  1.156     skrll 	if (err)
    110  1.156     skrll 		goto fail;
    111  1.156     skrll 
    112  1.156     skrll 	/* control debugging printfs */
    113  1.156     skrll 	err = sysctl_createv(clog, 0, &rnode, &cnode,
    114  1.156     skrll 	    CTLFLAG_PERMANENT|CTLFLAG_READWRITE, CTLTYPE_INT,
    115  1.156     skrll 	    "debug", SYSCTL_DESCR("Enable debugging output"),
    116  1.156     skrll 	    NULL, 0, &usbdebug, sizeof(usbdebug), CTL_CREATE, CTL_EOL);
    117  1.156     skrll 	if (err)
    118  1.156     skrll 		goto fail;
    119  1.156     skrll 
    120  1.156     skrll 	return;
    121  1.156     skrll fail:
    122  1.156     skrll 	aprint_error("%s: sysctl_createv failed (err = %d)\n", __func__, err);
    123  1.156     skrll }
    124    1.1  augustss #else
    125  1.130       mrg #define	usb_noexplore 0
    126    1.1  augustss #endif
    127    1.1  augustss 
    128  1.162     skrll #define	DPRINTF(FMT,A,B,C,D)	USBHIST_LOG(usbdebug,FMT,A,B,C,D)
    129  1.162     skrll #define	DPRINTFN(N,FMT,A,B,C,D)	USBHIST_LOGN(usbdebug,N,FMT,A,B,C,D)
    130  1.162     skrll 
    131    1.1  augustss struct usb_softc {
    132  1.109  drochner #if 0
    133  1.123    dyoung 	device_t	sc_dev;		/* base device */
    134  1.109  drochner #endif
    135  1.162     skrll 	struct usbd_bus *sc_bus;		/* USB controller */
    136    1.1  augustss 	struct usbd_port sc_port;	/* dummy port for root hub */
    137   1.25  augustss 
    138   1.97        ad 	struct lwp	*sc_event_thread;
    139   1.25  augustss 
    140   1.25  augustss 	char		sc_dying;
    141    1.1  augustss };
    142    1.1  augustss 
    143   1.90     joerg struct usb_taskq {
    144   1.90     joerg 	TAILQ_HEAD(, usb_task) tasks;
    145  1.130       mrg 	kmutex_t lock;
    146  1.130       mrg 	kcondvar_t cv;
    147   1.97        ad 	struct lwp *task_thread_lwp;
    148   1.90     joerg 	const char *name;
    149  1.170  riastrad 	struct usb_task *current_task;
    150   1.90     joerg };
    151   1.90     joerg 
    152   1.90     joerg static struct usb_taskq usb_taskq[USB_NUM_TASKQS];
    153   1.58  augustss 
    154   1.72   gehenna dev_type_open(usbopen);
    155   1.72   gehenna dev_type_close(usbclose);
    156   1.72   gehenna dev_type_read(usbread);
    157   1.72   gehenna dev_type_ioctl(usbioctl);
    158   1.72   gehenna dev_type_poll(usbpoll);
    159   1.74  jdolecek dev_type_kqfilter(usbkqfilter);
    160   1.72   gehenna 
    161   1.72   gehenna const struct cdevsw usb_cdevsw = {
    162  1.149  dholland 	.d_open = usbopen,
    163  1.149  dholland 	.d_close = usbclose,
    164  1.149  dholland 	.d_read = usbread,
    165  1.149  dholland 	.d_write = nowrite,
    166  1.149  dholland 	.d_ioctl = usbioctl,
    167  1.149  dholland 	.d_stop = nostop,
    168  1.149  dholland 	.d_tty = notty,
    169  1.149  dholland 	.d_poll = usbpoll,
    170  1.149  dholland 	.d_mmap = nommap,
    171  1.149  dholland 	.d_kqfilter = usbkqfilter,
    172  1.154  dholland 	.d_discard = nodiscard,
    173  1.149  dholland 	.d_flag = D_OTHER
    174   1.72   gehenna };
    175    1.7  augustss 
    176  1.109  drochner Static void	usb_discover(struct usb_softc *);
    177  1.109  drochner Static void	usb_create_event_thread(device_t);
    178   1.45  augustss Static void	usb_event_thread(void *);
    179   1.58  augustss Static void	usb_task_thread(void *);
    180    1.1  augustss 
    181   1.41  augustss #define USB_MAX_EVENTS 100
    182   1.26  augustss struct usb_event_q {
    183   1.26  augustss 	struct usb_event ue;
    184   1.26  augustss 	SIMPLEQ_ENTRY(usb_event_q) next;
    185   1.26  augustss };
    186   1.66  augustss Static SIMPLEQ_HEAD(, usb_event_q) usb_events =
    187   1.29  augustss 	SIMPLEQ_HEAD_INITIALIZER(usb_events);
    188   1.42  augustss Static int usb_nevents = 0;
    189   1.42  augustss Static struct selinfo usb_selevent;
    190  1.130       mrg Static kmutex_t usb_event_lock;
    191  1.130       mrg Static kcondvar_t usb_event_cv;
    192  1.123    dyoung Static proc_t *usb_async_proc;  /* process that wants USB SIGIO */
    193  1.112        ad Static void *usb_async_sih;
    194   1.42  augustss Static int usb_dev_open = 0;
    195   1.87  christos Static struct usb_event *usb_alloc_event(void);
    196   1.87  christos Static void usb_free_event(struct usb_event *);
    197   1.45  augustss Static void usb_add_event(int, struct usb_event *);
    198   1.45  augustss Static int usb_get_next_event(struct usb_event *);
    199  1.112        ad Static void usb_async_intr(void *);
    200  1.130       mrg Static void usb_soft_intr(void *);
    201   1.23  augustss 
    202   1.92     pavel #ifdef COMPAT_30
    203   1.92     pavel Static void usb_copy_old_devinfo(struct usb_device_info_old *, const struct usb_device_info *);
    204   1.92     pavel #endif
    205   1.92     pavel 
    206   1.42  augustss Static const char *usbrev_str[] = USBREV_STR;
    207   1.31  augustss 
    208  1.117    cegger static int usb_match(device_t, cfdata_t, void *);
    209  1.106    dyoung static void usb_attach(device_t, device_t, void *);
    210  1.106    dyoung static int usb_detach(device_t, int);
    211  1.106    dyoung static int usb_activate(device_t, enum devact);
    212  1.106    dyoung static void usb_childdet(device_t, device_t);
    213  1.130       mrg static int usb_once_init(void);
    214  1.110        ad static void usb_doattach(device_t);
    215  1.106    dyoung 
    216  1.106    dyoung extern struct cfdriver usb_cd;
    217  1.106    dyoung 
    218  1.116    dyoung CFATTACH_DECL3_NEW(usb, sizeof(struct usb_softc),
    219  1.116    dyoung     usb_match, usb_attach, usb_detach, usb_activate, NULL, usb_childdet,
    220  1.116    dyoung     DVF_DETACH_SHUTDOWN);
    221    1.1  augustss 
    222  1.134       mrg static const char *taskq_names[] = USB_TASKQ_NAMES;
    223  1.134       mrg 
    224  1.118    dyoung int
    225  1.118    dyoung usb_match(device_t parent, cfdata_t match, void *aux)
    226    1.1  augustss {
    227  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    228  1.162     skrll 
    229  1.162     skrll 	return UMATCH_GENERIC;
    230    1.1  augustss }
    231    1.1  augustss 
    232  1.118    dyoung void
    233  1.118    dyoung usb_attach(device_t parent, device_t self, void *aux)
    234    1.1  augustss {
    235  1.130       mrg 	static ONCE_DECL(init_control);
    236  1.110        ad 	struct usb_softc *sc = device_private(self);
    237  1.110        ad 	int usbrev;
    238  1.110        ad 
    239  1.110        ad 	sc->sc_bus = aux;
    240  1.162     skrll 	usbrev = sc->sc_bus->ub_revision;
    241  1.110        ad 
    242  1.110        ad 	aprint_naive("\n");
    243  1.110        ad 	aprint_normal(": USB revision %s", usbrev_str[usbrev]);
    244  1.110        ad 	switch (usbrev) {
    245  1.110        ad 	case USBREV_1_0:
    246  1.110        ad 	case USBREV_1_1:
    247  1.110        ad 	case USBREV_2_0:
    248  1.155     skrll 	case USBREV_3_0:
    249  1.169   msaitoh 	case USBREV_3_1:
    250  1.110        ad 		break;
    251  1.110        ad 	default:
    252  1.110        ad 		aprint_error(", not supported\n");
    253  1.110        ad 		sc->sc_dying = 1;
    254  1.123    dyoung 		return;
    255  1.110        ad 	}
    256  1.110        ad 	aprint_normal("\n");
    257  1.110        ad 
    258  1.143  jakllsch 	/* XXX we should have our own level */
    259  1.164     skrll 	sc->sc_bus->ub_soft = softint_establish(SOFTINT_USB | SOFTINT_MPSAFE,
    260  1.143  jakllsch 	    usb_soft_intr, sc->sc_bus);
    261  1.162     skrll 	if (sc->sc_bus->ub_soft == NULL) {
    262  1.143  jakllsch 		aprint_error("%s: can't register softintr\n",
    263  1.143  jakllsch 			     device_xname(self));
    264  1.143  jakllsch 		sc->sc_dying = 1;
    265  1.143  jakllsch 		return;
    266  1.143  jakllsch 	}
    267  1.143  jakllsch 
    268  1.162     skrll 	sc->sc_bus->ub_methods->ubm_getlock(sc->sc_bus, &sc->sc_bus->ub_lock);
    269  1.162     skrll 	KASSERT(sc->sc_bus->ub_lock != NULL);
    270  1.134       mrg 
    271  1.130       mrg 	RUN_ONCE(&init_control, usb_once_init);
    272  1.110        ad 	config_interrupts(self, usb_doattach);
    273  1.110        ad }
    274  1.110        ad 
    275  1.130       mrg static int
    276  1.130       mrg usb_once_init(void)
    277  1.130       mrg {
    278  1.134       mrg 	struct usb_taskq *taskq;
    279  1.134       mrg 	int i;
    280  1.130       mrg 
    281  1.159     skrll 	USBHIST_LINK_STATIC(usbhist);
    282  1.158     skrll 
    283  1.130       mrg 	selinit(&usb_selevent);
    284  1.130       mrg 	mutex_init(&usb_event_lock, MUTEX_DEFAULT, IPL_NONE);
    285  1.130       mrg 	cv_init(&usb_event_cv, "usbrea");
    286  1.134       mrg 
    287  1.134       mrg 	for (i = 0; i < USB_NUM_TASKQS; i++) {
    288  1.134       mrg 		taskq = &usb_taskq[i];
    289  1.134       mrg 
    290  1.134       mrg 		TAILQ_INIT(&taskq->tasks);
    291  1.136       mrg 		/*
    292  1.139     skrll 		 * Since USB task methods usb_{add,rem}_task are callable
    293  1.139     skrll 		 * from any context, we have to make this lock a spinlock.
    294  1.136       mrg 		 */
    295  1.136       mrg 		mutex_init(&taskq->lock, MUTEX_DEFAULT, IPL_USB);
    296  1.134       mrg 		cv_init(&taskq->cv, "usbtsk");
    297  1.134       mrg 		taskq->name = taskq_names[i];
    298  1.170  riastrad 		taskq->current_task = NULL;
    299  1.134       mrg 		if (kthread_create(PRI_NONE, KTHREAD_MPSAFE, NULL,
    300  1.134       mrg 		    usb_task_thread, taskq, &taskq->task_thread_lwp,
    301  1.134       mrg 		    "%s", taskq->name)) {
    302  1.134       mrg 			printf("unable to create task thread: %s\n", taskq->name);
    303  1.134       mrg 			panic("usb_create_event_thread task");
    304  1.134       mrg 		}
    305  1.134       mrg 		/*
    306  1.134       mrg 		 * XXX we should make sure these threads are alive before
    307  1.134       mrg 		 * end up using them in usb_doattach().
    308  1.134       mrg 		 */
    309  1.134       mrg 	}
    310  1.130       mrg 	return 0;
    311  1.130       mrg }
    312  1.130       mrg 
    313  1.110        ad static void
    314  1.110        ad usb_doattach(device_t self)
    315  1.110        ad {
    316  1.109  drochner 	struct usb_softc *sc = device_private(self);
    317  1.162     skrll 	struct usbd_device *dev;
    318   1.29  augustss 	usbd_status err;
    319   1.57  augustss 	int speed;
    320   1.87  christos 	struct usb_event *ue;
    321   1.66  augustss 
    322  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    323   1.31  augustss 
    324  1.162     skrll 	sc->sc_bus->ub_usbctl = self;
    325  1.162     skrll 	sc->sc_port.up_power = USB_MAX_POWER;
    326   1.31  augustss 
    327  1.162     skrll 	switch (sc->sc_bus->ub_revision) {
    328   1.57  augustss 	case USBREV_1_0:
    329   1.57  augustss 	case USBREV_1_1:
    330   1.57  augustss 		speed = USB_SPEED_FULL;
    331   1.57  augustss 		break;
    332   1.57  augustss 	case USBREV_2_0:
    333   1.57  augustss 		speed = USB_SPEED_HIGH;
    334   1.57  augustss 		break;
    335  1.155     skrll 	case USBREV_3_0:
    336  1.155     skrll 		speed = USB_SPEED_SUPER;
    337  1.155     skrll 		break;
    338  1.169   msaitoh 	case USBREV_3_1:
    339  1.169   msaitoh 		speed = USB_SPEED_SUPER_PLUS;
    340  1.169   msaitoh 		break;
    341   1.57  augustss 	default:
    342  1.110        ad 		panic("usb_doattach");
    343   1.32  augustss 	}
    344   1.35  augustss 
    345  1.162     skrll 	cv_init(&sc->sc_bus->ub_needsexplore_cv, "usbevt");
    346  1.130       mrg 
    347   1.87  christos 	ue = usb_alloc_event();
    348  1.109  drochner 	ue->u.ue_ctrlr.ue_bus = device_unit(self);
    349   1.87  christos 	usb_add_event(USB_EVENT_CTRLR_ATTACH, ue);
    350   1.38  augustss 
    351  1.109  drochner 	err = usbd_new_device(self, sc->sc_bus, 0, speed, 0,
    352   1.29  augustss 		  &sc->sc_port);
    353   1.29  augustss 	if (!err) {
    354  1.162     skrll 		dev = sc->sc_port.up_dev;
    355  1.162     skrll 		if (dev->ud_hub == NULL) {
    356   1.22  augustss 			sc->sc_dying = 1;
    357  1.102  jmcneill 			aprint_error("%s: root device is not a hub\n",
    358  1.109  drochner 				     device_xname(self));
    359  1.123    dyoung 			return;
    360    1.1  augustss 		}
    361  1.162     skrll 		sc->sc_bus->ub_roothub = dev;
    362  1.135       mrg 		usb_create_event_thread(self);
    363   1.24  augustss #if 1
    364   1.66  augustss 		/*
    365   1.24  augustss 		 * Turning this code off will delay attachment of USB devices
    366   1.24  augustss 		 * until the USB event thread is running, which means that
    367   1.24  augustss 		 * the keyboard will not work until after cold boot.
    368   1.24  augustss 		 */
    369  1.109  drochner 		if (cold && (device_cfdata(self)->cf_flags & 1))
    370  1.162     skrll 			dev->ud_hub->uh_explore(sc->sc_bus->ub_roothub);
    371   1.24  augustss #endif
    372    1.1  augustss 	} else {
    373  1.142  jakllsch 		aprint_error("%s: root hub problem, error=%s\n",
    374  1.142  jakllsch 			     device_xname(self), usbd_errstr(err));
    375   1.22  augustss 		sc->sc_dying = 1;
    376    1.1  augustss 	}
    377    1.7  augustss 
    378  1.172       mrg 	/*
    379  1.172       mrg 	 * Drop this reference after the first set of attachments in the
    380  1.172       mrg 	 * event thread.
    381  1.172       mrg 	 */
    382  1.145  christos 	config_pending_incr(self);
    383   1.28  augustss 
    384  1.104  jmcneill 	if (!pmf_device_register(self, NULL, NULL))
    385  1.104  jmcneill 		aprint_error_dev(self, "couldn't establish power handler\n");
    386  1.104  jmcneill 
    387  1.112        ad 	usb_async_sih = softint_establish(SOFTINT_CLOCK | SOFTINT_MPSAFE,
    388  1.112        ad 	   usb_async_intr, NULL);
    389  1.112        ad 
    390  1.123    dyoung 	return;
    391    1.1  augustss }
    392    1.1  augustss 
    393   1.13  augustss void
    394  1.109  drochner usb_create_event_thread(device_t self)
    395   1.13  augustss {
    396  1.109  drochner 	struct usb_softc *sc = device_private(self);
    397   1.13  augustss 
    398  1.148     skrll 	if (kthread_create(PRI_NONE, KTHREAD_MPSAFE, NULL,
    399  1.130       mrg 	    usb_event_thread, sc, &sc->sc_event_thread,
    400  1.130       mrg 	    "%s", device_xname(self))) {
    401   1.13  augustss 		printf("%s: unable to create event thread for\n",
    402  1.109  drochner 		       device_xname(self));
    403   1.13  augustss 		panic("usb_create_event_thread");
    404   1.13  augustss 	}
    405   1.13  augustss }
    406   1.13  augustss 
    407   1.52  augustss /*
    408   1.62  augustss  * Add a task to be performed by the task thread.  This function can be
    409   1.52  augustss  * called from any context and the task will be executed in a process
    410   1.52  augustss  * context ASAP.
    411   1.52  augustss  */
    412   1.13  augustss void
    413  1.162     skrll usb_add_task(struct usbd_device *dev, struct usb_task *task, int queue)
    414   1.51  augustss {
    415   1.90     joerg 	struct usb_taskq *taskq;
    416   1.51  augustss 
    417  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    418  1.162     skrll 
    419  1.150  riastrad 	KASSERT(0 <= queue);
    420  1.150  riastrad 	KASSERT(queue < USB_NUM_TASKQS);
    421   1.90     joerg 	taskq = &usb_taskq[queue];
    422  1.130       mrg 	mutex_enter(&taskq->lock);
    423  1.150  riastrad 	if (atomic_cas_uint(&task->queue, USB_NUM_TASKQS, queue) ==
    424  1.150  riastrad 	    USB_NUM_TASKQS) {
    425  1.168  pgoyette 		DPRINTFN(2, "task=%#jx", (uintptr_t)task, 0, 0, 0);
    426   1.90     joerg 		TAILQ_INSERT_TAIL(&taskq->tasks, task, next);
    427  1.150  riastrad 		cv_signal(&taskq->cv);
    428   1.62  augustss 	} else {
    429  1.168  pgoyette 		DPRINTFN(2, "task=%#jx on q", (uintptr_t)task, 0, 0, 0);
    430   1.62  augustss 	}
    431  1.130       mrg 	mutex_exit(&taskq->lock);
    432   1.51  augustss }
    433   1.51  augustss 
    434  1.150  riastrad /*
    435  1.170  riastrad  * usb_rem_task(dev, task)
    436  1.170  riastrad  *
    437  1.170  riastrad  *	If task is queued to run, remove it from the queue.
    438  1.170  riastrad  *
    439  1.170  riastrad  *	Caller is _not_ guaranteed that the task is not running when
    440  1.170  riastrad  *	this is done.
    441  1.170  riastrad  *
    442  1.170  riastrad  *	Never sleeps.
    443  1.150  riastrad  */
    444   1.51  augustss void
    445  1.162     skrll usb_rem_task(struct usbd_device *dev, struct usb_task *task)
    446   1.53  augustss {
    447  1.150  riastrad 	unsigned queue;
    448   1.53  augustss 
    449  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    450  1.162     skrll 
    451  1.150  riastrad 	while ((queue = task->queue) != USB_NUM_TASKQS) {
    452  1.150  riastrad 		struct usb_taskq *taskq = &usb_taskq[queue];
    453  1.133  christos 		mutex_enter(&taskq->lock);
    454  1.150  riastrad 		if (__predict_true(task->queue == queue)) {
    455  1.150  riastrad 			TAILQ_REMOVE(&taskq->tasks, task, next);
    456  1.150  riastrad 			task->queue = USB_NUM_TASKQS;
    457  1.150  riastrad 			mutex_exit(&taskq->lock);
    458  1.150  riastrad 			break;
    459  1.150  riastrad 		}
    460  1.133  christos 		mutex_exit(&taskq->lock);
    461  1.132    cegger 	}
    462   1.53  augustss }
    463   1.53  augustss 
    464  1.170  riastrad /*
    465  1.171  riastrad  * usb_rem_task_wait(dev, task, queue, interlock)
    466  1.170  riastrad  *
    467  1.170  riastrad  *	If task is scheduled to run, remove it from the queue.  If it
    468  1.171  riastrad  *	may have already begun to run, drop interlock if not null, wait
    469  1.171  riastrad  *	for it to complete, and reacquire interlock if not null.
    470  1.171  riastrad  *	Return true if it successfully removed the task from the queue,
    471  1.171  riastrad  *	false if not.
    472  1.170  riastrad  *
    473  1.170  riastrad  *	Caller MUST guarantee that task will not be scheduled on a
    474  1.170  riastrad  *	_different_ queue, at least until after this returns.
    475  1.170  riastrad  *
    476  1.170  riastrad  *	If caller guarantees that task will not be scheduled on the
    477  1.170  riastrad  *	same queue before this returns, then caller is guaranteed that
    478  1.170  riastrad  *	the task is not running at all when this returns.
    479  1.170  riastrad  *
    480  1.170  riastrad  *	May sleep.
    481  1.170  riastrad  */
    482  1.171  riastrad bool
    483  1.171  riastrad usb_rem_task_wait(struct usbd_device *dev, struct usb_task *task, int queue,
    484  1.171  riastrad     kmutex_t *interlock)
    485  1.170  riastrad {
    486  1.170  riastrad 	struct usb_taskq *taskq;
    487  1.170  riastrad 	int queue1;
    488  1.171  riastrad 	bool removed;
    489  1.170  riastrad 
    490  1.170  riastrad 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    491  1.170  riastrad 	ASSERT_SLEEPABLE();
    492  1.170  riastrad 	KASSERT(0 <= queue);
    493  1.170  riastrad 	KASSERT(queue < USB_NUM_TASKQS);
    494  1.170  riastrad 
    495  1.170  riastrad 	taskq = &usb_taskq[queue];
    496  1.171  riastrad 	mutex_enter(&taskq->lock);
    497  1.171  riastrad 	queue1 = task->queue;
    498  1.171  riastrad 	if (queue1 == USB_NUM_TASKQS) {
    499  1.170  riastrad 		/*
    500  1.171  riastrad 		 * It is not on the queue.  It may be about to run, or
    501  1.171  riastrad 		 * it may have already finished running -- there is no
    502  1.171  riastrad 		 * stopping it now.  Wait for it if it is running.
    503  1.170  riastrad 		 */
    504  1.171  riastrad 		if (interlock)
    505  1.171  riastrad 			mutex_exit(interlock);
    506  1.171  riastrad 		while (taskq->current_task == task)
    507  1.171  riastrad 			cv_wait(&taskq->cv, &taskq->lock);
    508  1.171  riastrad 		removed = false;
    509  1.170  riastrad 	} else {
    510  1.170  riastrad 		/*
    511  1.171  riastrad 		 * It is still on the queue.  We can stop it before the
    512  1.171  riastrad 		 * task thread will run it.
    513  1.170  riastrad 		 */
    514  1.171  riastrad 		KASSERTMSG(queue1 == queue, "task %p on q%d expected on q%d",
    515  1.171  riastrad 		    task, queue1, queue);
    516  1.171  riastrad 		TAILQ_REMOVE(&taskq->tasks, task, next);
    517  1.171  riastrad 		task->queue = USB_NUM_TASKQS;
    518  1.171  riastrad 		removed = true;
    519  1.170  riastrad 	}
    520  1.171  riastrad 	mutex_exit(&taskq->lock);
    521  1.171  riastrad 
    522  1.171  riastrad 	/*
    523  1.171  riastrad 	 * If there's an interlock, and we dropped it to wait,
    524  1.171  riastrad 	 * reacquire it.
    525  1.171  riastrad 	 */
    526  1.171  riastrad 	if (interlock && !removed)
    527  1.171  riastrad 		mutex_enter(interlock);
    528  1.171  riastrad 
    529  1.171  riastrad 	return removed;
    530  1.170  riastrad }
    531  1.170  riastrad 
    532   1.53  augustss void
    533   1.45  augustss usb_event_thread(void *arg)
    534   1.13  augustss {
    535   1.13  augustss 	struct usb_softc *sc = arg;
    536  1.172       mrg 	struct usbd_bus *bus = sc->sc_bus;
    537   1.13  augustss 
    538  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    539   1.40  augustss 
    540   1.60  augustss 	/*
    541   1.60  augustss 	 * In case this controller is a companion controller to an
    542   1.60  augustss 	 * EHCI controller we need to wait until the EHCI controller
    543   1.60  augustss 	 * has grabbed the port.
    544   1.64  augustss 	 * XXX It would be nicer to do this with a tsleep(), but I don't
    545   1.64  augustss 	 * know how to synchronize the creation of the threads so it
    546   1.64  augustss 	 * will work.
    547   1.60  augustss 	 */
    548  1.172       mrg 	usb_delay_ms(bus, 500);
    549   1.60  augustss 
    550   1.40  augustss 	/* Make sure first discover does something. */
    551  1.172       mrg 	mutex_enter(bus->ub_lock);
    552  1.162     skrll 	sc->sc_bus->ub_needsexplore = 1;
    553   1.51  augustss 	usb_discover(sc);
    554  1.172       mrg 	mutex_exit(bus->ub_lock);
    555  1.172       mrg 
    556  1.172       mrg 	/* Drop the config_pending reference from attach. */
    557  1.172       mrg 	config_pending_decr(bus->ub_usbctl);
    558   1.27  augustss 
    559  1.172       mrg 	mutex_enter(bus->ub_lock);
    560   1.22  augustss 	while (!sc->sc_dying) {
    561  1.172       mrg #if 0 /* not yet */
    562  1.172       mrg 		while (sc->sc_bus->ub_usepolling)
    563  1.172       mrg 			kpause("usbpoll", true, hz, bus->ub_lock);
    564  1.172       mrg #endif
    565  1.172       mrg 
    566   1.58  augustss 		if (usb_noexplore < 2)
    567  1.130       mrg 			usb_discover(sc);
    568  1.130       mrg 
    569  1.172       mrg 		cv_timedwait(&bus->ub_needsexplore_cv,
    570  1.172       mrg 		    bus->ub_lock, usb_noexplore ? 0 : hz * 60);
    571  1.147     skrll 
    572  1.168  pgoyette 		DPRINTFN(2, "sc %#jx woke up", (uintptr_t)sc, 0, 0, 0);
    573   1.13  augustss 	}
    574   1.50  augustss 	sc->sc_event_thread = NULL;
    575   1.13  augustss 
    576   1.13  augustss 	/* In case parent is waiting for us to exit. */
    577  1.172       mrg 	cv_signal(&bus->ub_needsexplore_cv);
    578  1.172       mrg 	mutex_exit(bus->ub_lock);
    579   1.13  augustss 
    580  1.168  pgoyette 	DPRINTF("sc %#jx exit", (uintptr_t)sc, 0, 0, 0);
    581   1.13  augustss 	kthread_exit(0);
    582   1.13  augustss }
    583   1.13  augustss 
    584   1.58  augustss void
    585   1.90     joerg usb_task_thread(void *arg)
    586   1.58  augustss {
    587   1.58  augustss 	struct usb_task *task;
    588   1.90     joerg 	struct usb_taskq *taskq;
    589  1.151  riastrad 	bool mpsafe;
    590   1.58  augustss 
    591  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    592  1.162     skrll 
    593   1.90     joerg 	taskq = arg;
    594  1.168  pgoyette 	DPRINTF("start taskq %#jx", (uintptr_t)taskq, 0, 0, 0);
    595   1.58  augustss 
    596  1.130       mrg 	mutex_enter(&taskq->lock);
    597   1.58  augustss 	for (;;) {
    598   1.90     joerg 		task = TAILQ_FIRST(&taskq->tasks);
    599   1.58  augustss 		if (task == NULL) {
    600  1.130       mrg 			cv_wait(&taskq->cv, &taskq->lock);
    601   1.90     joerg 			task = TAILQ_FIRST(&taskq->tasks);
    602   1.58  augustss 		}
    603  1.168  pgoyette 		DPRINTFN(2, "woke up task=%#jx", (uintptr_t)task, 0, 0, 0);
    604   1.58  augustss 		if (task != NULL) {
    605  1.151  riastrad 			mpsafe = ISSET(task->flags, USB_TASKQ_MPSAFE);
    606   1.90     joerg 			TAILQ_REMOVE(&taskq->tasks, task, next);
    607  1.150  riastrad 			task->queue = USB_NUM_TASKQS;
    608  1.170  riastrad 			taskq->current_task = task;
    609  1.130       mrg 			mutex_exit(&taskq->lock);
    610  1.140  jmcneill 
    611  1.151  riastrad 			if (!mpsafe)
    612  1.140  jmcneill 				KERNEL_LOCK(1, curlwp);
    613   1.58  augustss 			task->fun(task->arg);
    614  1.151  riastrad 			/* Can't dereference task after this point.  */
    615  1.151  riastrad 			if (!mpsafe)
    616  1.140  jmcneill 				KERNEL_UNLOCK_ONE(curlwp);
    617  1.140  jmcneill 
    618  1.130       mrg 			mutex_enter(&taskq->lock);
    619  1.170  riastrad 			KASSERTMSG(taskq->current_task == task,
    620  1.170  riastrad 			    "somebody scribbled on usb taskq %p", taskq);
    621  1.170  riastrad 			taskq->current_task = NULL;
    622  1.170  riastrad 			cv_broadcast(&taskq->cv);
    623   1.58  augustss 		}
    624   1.58  augustss 	}
    625  1.130       mrg 	mutex_exit(&taskq->lock);
    626   1.58  augustss }
    627   1.58  augustss 
    628    1.1  augustss int
    629   1.91  christos usbctlprint(void *aux, const char *pnp)
    630    1.1  augustss {
    631    1.1  augustss 	/* only "usb"es can attach to host controllers */
    632    1.1  augustss 	if (pnp)
    633   1.77   thorpej 		aprint_normal("usb at %s", pnp);
    634    1.1  augustss 
    635  1.162     skrll 	return UNCONF;
    636    1.1  augustss }
    637    1.7  augustss 
    638    1.1  augustss int
    639   1.91  christos usbopen(dev_t dev, int flag, int mode, struct lwp *l)
    640    1.1  augustss {
    641   1.26  augustss 	int unit = minor(dev);
    642   1.26  augustss 	struct usb_softc *sc;
    643   1.26  augustss 
    644   1.26  augustss 	if (unit == USB_DEV_MINOR) {
    645   1.26  augustss 		if (usb_dev_open)
    646  1.162     skrll 			return EBUSY;
    647   1.26  augustss 		usb_dev_open = 1;
    648  1.112        ad 		mutex_enter(proc_lock);
    649   1.26  augustss 		usb_async_proc = 0;
    650  1.112        ad 		mutex_exit(proc_lock);
    651  1.162     skrll 		return 0;
    652   1.26  augustss 	}
    653   1.26  augustss 
    654  1.109  drochner 	sc = device_lookup_private(&usb_cd, unit);
    655  1.111  drochner 	if (!sc)
    656  1.162     skrll 		return ENXIO;
    657    1.1  augustss 
    658   1.22  augustss 	if (sc->sc_dying)
    659  1.162     skrll 		return EIO;
    660    1.1  augustss 
    661  1.162     skrll 	return 0;
    662    1.1  augustss }
    663    1.1  augustss 
    664    1.1  augustss int
    665   1.45  augustss usbread(dev_t dev, struct uio *uio, int flag)
    666   1.26  augustss {
    667   1.92     pavel 	struct usb_event *ue;
    668   1.92     pavel #ifdef COMPAT_30
    669   1.93  christos 	struct usb_event_old *ueo = NULL;	/* XXXGCC */
    670  1.146  christos 	int useold = 0;
    671   1.92     pavel #endif
    672  1.146  christos 	int error, n;
    673   1.26  augustss 
    674   1.26  augustss 	if (minor(dev) != USB_DEV_MINOR)
    675  1.162     skrll 		return ENXIO;
    676   1.26  augustss 
    677   1.92     pavel 	switch (uio->uio_resid) {
    678   1.92     pavel #ifdef COMPAT_30
    679   1.92     pavel 	case sizeof(struct usb_event_old):
    680  1.162     skrll 		ueo = kmem_zalloc(sizeof(struct usb_event_old), KM_SLEEP);
    681   1.92     pavel 		useold = 1;
    682   1.92     pavel 		/* FALLTHRU */
    683   1.92     pavel #endif
    684   1.92     pavel 	case sizeof(struct usb_event):
    685   1.92     pavel 		ue = usb_alloc_event();
    686   1.92     pavel 		break;
    687   1.92     pavel 	default:
    688  1.162     skrll 		return EINVAL;
    689   1.92     pavel 	}
    690   1.26  augustss 
    691   1.26  augustss 	error = 0;
    692  1.130       mrg 	mutex_enter(&usb_event_lock);
    693   1.26  augustss 	for (;;) {
    694   1.87  christos 		n = usb_get_next_event(ue);
    695   1.26  augustss 		if (n != 0)
    696   1.26  augustss 			break;
    697   1.26  augustss 		if (flag & IO_NDELAY) {
    698   1.26  augustss 			error = EWOULDBLOCK;
    699   1.26  augustss 			break;
    700   1.26  augustss 		}
    701  1.130       mrg 		error = cv_wait_sig(&usb_event_cv, &usb_event_lock);
    702   1.26  augustss 		if (error)
    703   1.26  augustss 			break;
    704   1.26  augustss 	}
    705  1.130       mrg 	mutex_exit(&usb_event_lock);
    706   1.92     pavel 	if (!error) {
    707   1.92     pavel #ifdef COMPAT_30
    708   1.92     pavel 		if (useold) { /* copy fields to old struct */
    709   1.92     pavel 			ueo->ue_type = ue->ue_type;
    710   1.92     pavel 			memcpy(&ueo->ue_time, &ue->ue_time,
    711   1.92     pavel 			      sizeof(struct timespec));
    712   1.92     pavel 			switch (ue->ue_type) {
    713   1.92     pavel 				case USB_EVENT_DEVICE_ATTACH:
    714   1.92     pavel 				case USB_EVENT_DEVICE_DETACH:
    715   1.92     pavel 					usb_copy_old_devinfo(&ueo->u.ue_device, &ue->u.ue_device);
    716   1.92     pavel 					break;
    717   1.92     pavel 
    718   1.92     pavel 				case USB_EVENT_CTRLR_ATTACH:
    719   1.92     pavel 				case USB_EVENT_CTRLR_DETACH:
    720   1.92     pavel 					ueo->u.ue_ctrlr.ue_bus=ue->u.ue_ctrlr.ue_bus;
    721   1.92     pavel 					break;
    722   1.92     pavel 
    723   1.92     pavel 				case USB_EVENT_DRIVER_ATTACH:
    724   1.92     pavel 				case USB_EVENT_DRIVER_DETACH:
    725   1.92     pavel 					ueo->u.ue_driver.ue_cookie=ue->u.ue_driver.ue_cookie;
    726   1.92     pavel 					memcpy(ueo->u.ue_driver.ue_devname,
    727  1.137  christos 					       ue->u.ue_driver.ue_devname,
    728   1.92     pavel 					       sizeof(ue->u.ue_driver.ue_devname));
    729   1.92     pavel 					break;
    730   1.92     pavel 				default:
    731   1.92     pavel 					;
    732   1.92     pavel 			}
    733   1.92     pavel 
    734  1.162     skrll 			error = uiomove((void *)ueo, sizeof(*ueo), uio);
    735   1.92     pavel 		} else
    736   1.92     pavel #endif
    737  1.162     skrll 			error = uiomove((void *)ue, sizeof(*ue), uio);
    738   1.92     pavel 	}
    739   1.87  christos 	usb_free_event(ue);
    740   1.92     pavel #ifdef COMPAT_30
    741   1.92     pavel 	if (useold)
    742  1.162     skrll 		kmem_free(ueo, sizeof(struct usb_event_old));
    743   1.92     pavel #endif
    744   1.26  augustss 
    745  1.162     skrll 	return error;
    746   1.26  augustss }
    747   1.26  augustss 
    748   1.26  augustss int
    749   1.91  christos usbclose(dev_t dev, int flag, int mode,
    750   1.91  christos     struct lwp *l)
    751    1.1  augustss {
    752   1.26  augustss 	int unit = minor(dev);
    753   1.26  augustss 
    754   1.26  augustss 	if (unit == USB_DEV_MINOR) {
    755  1.112        ad 		mutex_enter(proc_lock);
    756   1.26  augustss 		usb_async_proc = 0;
    757  1.112        ad 		mutex_exit(proc_lock);
    758   1.26  augustss 		usb_dev_open = 0;
    759   1.26  augustss 	}
    760   1.26  augustss 
    761  1.162     skrll 	return 0;
    762    1.1  augustss }
    763    1.1  augustss 
    764    1.1  augustss int
    765   1.96  christos usbioctl(dev_t devt, u_long cmd, void *data, int flag, struct lwp *l)
    766    1.1  augustss {
    767   1.26  augustss 	struct usb_softc *sc;
    768   1.28  augustss 	int unit = minor(devt);
    769   1.26  augustss 
    770  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
    771  1.162     skrll 
    772   1.26  augustss 	if (unit == USB_DEV_MINOR) {
    773   1.26  augustss 		switch (cmd) {
    774   1.26  augustss 		case FIONBIO:
    775   1.26  augustss 			/* All handled in the upper FS layer. */
    776  1.162     skrll 			return 0;
    777   1.66  augustss 
    778   1.26  augustss 		case FIOASYNC:
    779  1.112        ad 			mutex_enter(proc_lock);
    780   1.26  augustss 			if (*(int *)data)
    781   1.84  christos 				usb_async_proc = l->l_proc;
    782   1.26  augustss 			else
    783   1.26  augustss 				usb_async_proc = 0;
    784  1.112        ad 			mutex_exit(proc_lock);
    785  1.162     skrll 			return 0;
    786   1.26  augustss 
    787   1.26  augustss 		default:
    788  1.162     skrll 			return EINVAL;
    789   1.26  augustss 		}
    790   1.26  augustss 	}
    791   1.26  augustss 
    792  1.109  drochner 	sc = device_lookup_private(&usb_cd, unit);
    793    1.1  augustss 
    794   1.22  augustss 	if (sc->sc_dying)
    795  1.162     skrll 		return EIO;
    796   1.22  augustss 
    797  1.163     skrll 	int error = 0;
    798  1.168  pgoyette 	DPRINTF("cmd %#jx", cmd, 0, 0, 0);
    799    1.1  augustss 	switch (cmd) {
    800    1.1  augustss #ifdef USB_DEBUG
    801    1.1  augustss 	case USB_SETDEBUG:
    802   1.69  augustss 		if (!(flag & FWRITE))
    803  1.162     skrll 			return EBADF;
    804   1.30  augustss 		usbdebug  = ((*(int *)data) & 0x000000ff);
    805    1.1  augustss 		break;
    806   1.56  augustss #endif /* USB_DEBUG */
    807    1.1  augustss 	case USB_REQUEST:
    808    1.1  augustss 	{
    809    1.1  augustss 		struct usb_ctl_request *ur = (void *)data;
    810   1.68  christos 		int len = UGETW(ur->ucr_request.wLength);
    811    1.1  augustss 		struct iovec iov;
    812    1.1  augustss 		struct uio uio;
    813    1.1  augustss 		void *ptr = 0;
    814   1.68  christos 		int addr = ur->ucr_addr;
    815   1.29  augustss 		usbd_status err;
    816   1.69  augustss 
    817  1.163     skrll 		if (!(flag & FWRITE)) {
    818  1.163     skrll 			error = EBADF;
    819  1.163     skrll 			goto fail;
    820  1.163     skrll 		}
    821    1.1  augustss 
    822  1.168  pgoyette 		DPRINTF("USB_REQUEST addr=%jd len=%jd", addr, len, 0, 0);
    823  1.163     skrll 		if (len < 0 || len > 32768) {
    824  1.163     skrll 			error = EINVAL;
    825  1.163     skrll 			goto fail;
    826  1.163     skrll 		}
    827  1.165     skrll 		if (addr < 0 || addr >= USB_MAX_DEVICES) {
    828  1.165     skrll 			error = EINVAL;
    829  1.165     skrll 			goto fail;
    830  1.165     skrll 		}
    831  1.165     skrll 		size_t dindex = usb_addr2dindex(addr);
    832  1.165     skrll 		if (sc->sc_bus->ub_devices[dindex] == NULL) {
    833  1.163     skrll 			error = EINVAL;
    834  1.163     skrll 			goto fail;
    835  1.163     skrll 		}
    836    1.1  augustss 		if (len != 0) {
    837   1.96  christos 			iov.iov_base = (void *)ur->ucr_data;
    838    1.1  augustss 			iov.iov_len = len;
    839    1.1  augustss 			uio.uio_iov = &iov;
    840    1.1  augustss 			uio.uio_iovcnt = 1;
    841    1.1  augustss 			uio.uio_resid = len;
    842    1.1  augustss 			uio.uio_offset = 0;
    843    1.1  augustss 			uio.uio_rw =
    844   1.68  christos 				ur->ucr_request.bmRequestType & UT_READ ?
    845    1.1  augustss 				UIO_READ : UIO_WRITE;
    846   1.85      yamt 			uio.uio_vmspace = l->l_proc->p_vmspace;
    847  1.162     skrll 			ptr = kmem_alloc(len, KM_SLEEP);
    848    1.1  augustss 			if (uio.uio_rw == UIO_WRITE) {
    849    1.1  augustss 				error = uiomove(ptr, len, &uio);
    850    1.1  augustss 				if (error)
    851    1.1  augustss 					goto ret;
    852    1.1  augustss 			}
    853    1.1  augustss 		}
    854  1.165     skrll 		err = usbd_do_request_flags(sc->sc_bus->ub_devices[dindex],
    855   1.68  christos 			  &ur->ucr_request, ptr, ur->ucr_flags, &ur->ucr_actlen,
    856   1.67  augustss 			  USBD_DEFAULT_TIMEOUT);
    857   1.29  augustss 		if (err) {
    858    1.1  augustss 			error = EIO;
    859    1.1  augustss 			goto ret;
    860    1.1  augustss 		}
    861  1.108        ws 		if (len > ur->ucr_actlen)
    862  1.108        ws 			len = ur->ucr_actlen;
    863    1.1  augustss 		if (len != 0) {
    864    1.1  augustss 			if (uio.uio_rw == UIO_READ) {
    865    1.1  augustss 				error = uiomove(ptr, len, &uio);
    866    1.1  augustss 				if (error)
    867    1.1  augustss 					goto ret;
    868    1.1  augustss 			}
    869    1.1  augustss 		}
    870    1.1  augustss 	ret:
    871  1.162     skrll 		if (ptr) {
    872  1.162     skrll 			len = UGETW(ur->ucr_request.wLength);
    873  1.162     skrll 			kmem_free(ptr, len);
    874  1.162     skrll 		}
    875  1.166     skrll 		break;
    876    1.1  augustss 	}
    877    1.1  augustss 
    878    1.1  augustss 	case USB_DEVICEINFO:
    879   1.93  christos 	{
    880  1.162     skrll 		struct usbd_device *dev;
    881   1.93  christos 		struct usb_device_info *di = (void *)data;
    882   1.93  christos 		int addr = di->udi_addr;
    883   1.93  christos 
    884  1.163     skrll 		if (addr < 0 || addr >= USB_MAX_DEVICES) {
    885  1.163     skrll 			error = EINVAL;
    886  1.163     skrll 			goto fail;
    887  1.163     skrll 		}
    888  1.165     skrll 		size_t dindex = usb_addr2dindex(addr);
    889  1.165     skrll 		if ((dev = sc->sc_bus->ub_devices[dindex]) == NULL) {
    890  1.163     skrll 			error = ENXIO;
    891  1.163     skrll 			goto fail;
    892  1.163     skrll 		}
    893   1.93  christos 		usbd_fill_deviceinfo(dev, di, 1);
    894   1.93  christos 		break;
    895   1.93  christos 	}
    896   1.93  christos 
    897   1.92     pavel #ifdef COMPAT_30
    898   1.92     pavel 	case USB_DEVICEINFO_OLD:
    899    1.1  augustss 	{
    900  1.162     skrll 		struct usbd_device *dev;
    901   1.93  christos 		struct usb_device_info_old *di = (void *)data;
    902   1.93  christos 		int addr = di->udi_addr;
    903    1.1  augustss 
    904  1.163     skrll 		if (addr < 1 || addr >= USB_MAX_DEVICES) {
    905  1.163     skrll 			error = EINVAL;
    906  1.163     skrll 			goto fail;
    907  1.163     skrll 		}
    908  1.165     skrll 		size_t dindex = usb_addr2dindex(addr);
    909  1.165     skrll 		if ((dev = sc->sc_bus->ub_devices[dindex]) == NULL) {
    910  1.163     skrll 			error = ENXIO;
    911  1.163     skrll 			goto fail;
    912  1.163     skrll 		}
    913   1.93  christos 		usbd_fill_deviceinfo_old(dev, di, 1);
    914    1.1  augustss 		break;
    915    1.1  augustss 	}
    916   1.93  christos #endif
    917    1.2  augustss 
    918    1.2  augustss 	case USB_DEVICESTATS:
    919  1.162     skrll 		*(struct usb_device_stats *)data = sc->sc_bus->ub_stats;
    920    1.2  augustss 		break;
    921    1.1  augustss 
    922    1.1  augustss 	default:
    923  1.163     skrll 		error = EINVAL;
    924    1.1  augustss 	}
    925  1.163     skrll 
    926  1.163     skrll fail:
    927  1.163     skrll 
    928  1.168  pgoyette 	DPRINTF("... done (error = %jd)", error, 0, 0, 0);
    929  1.163     skrll 
    930  1.163     skrll 	return error;
    931    1.1  augustss }
    932    1.1  augustss 
    933    1.1  augustss int
    934   1.84  christos usbpoll(dev_t dev, int events, struct lwp *l)
    935    1.1  augustss {
    936  1.130       mrg 	int revents, mask;
    937    1.1  augustss 
    938   1.30  augustss 	if (minor(dev) == USB_DEV_MINOR) {
    939   1.30  augustss 		revents = 0;
    940   1.30  augustss 		mask = POLLIN | POLLRDNORM;
    941   1.66  augustss 
    942  1.130       mrg 		mutex_enter(&usb_event_lock);
    943   1.30  augustss 		if (events & mask && usb_nevents > 0)
    944   1.30  augustss 			revents |= events & mask;
    945   1.30  augustss 		if (revents == 0 && events & mask)
    946   1.84  christos 			selrecord(l, &usb_selevent);
    947  1.130       mrg 		mutex_exit(&usb_event_lock);
    948   1.66  augustss 
    949  1.162     skrll 		return revents;
    950   1.30  augustss 	} else {
    951  1.162     skrll 		return 0;
    952    1.1  augustss 	}
    953    1.1  augustss }
    954    1.1  augustss 
    955   1.74  jdolecek static void
    956   1.74  jdolecek filt_usbrdetach(struct knote *kn)
    957   1.74  jdolecek {
    958   1.74  jdolecek 
    959  1.130       mrg 	mutex_enter(&usb_event_lock);
    960   1.75  christos 	SLIST_REMOVE(&usb_selevent.sel_klist, kn, knote, kn_selnext);
    961  1.130       mrg 	mutex_exit(&usb_event_lock);
    962   1.74  jdolecek }
    963   1.74  jdolecek 
    964   1.74  jdolecek static int
    965   1.91  christos filt_usbread(struct knote *kn, long hint)
    966   1.74  jdolecek {
    967   1.74  jdolecek 
    968   1.74  jdolecek 	if (usb_nevents == 0)
    969  1.162     skrll 		return 0;
    970   1.74  jdolecek 
    971   1.74  jdolecek 	kn->kn_data = sizeof(struct usb_event);
    972  1.162     skrll 	return 1;
    973   1.74  jdolecek }
    974   1.74  jdolecek 
    975  1.167      maya static const struct filterops usbread_filtops = {
    976  1.167      maya 	.f_isfd = 1,
    977  1.167      maya 	.f_attach = NULL,
    978  1.167      maya 	.f_detach = filt_usbrdetach,
    979  1.167      maya 	.f_event = filt_usbread,
    980  1.167      maya };
    981   1.74  jdolecek 
    982   1.74  jdolecek int
    983   1.74  jdolecek usbkqfilter(dev_t dev, struct knote *kn)
    984   1.74  jdolecek {
    985   1.74  jdolecek 	struct klist *klist;
    986   1.74  jdolecek 
    987   1.74  jdolecek 	switch (kn->kn_filter) {
    988   1.74  jdolecek 	case EVFILT_READ:
    989   1.74  jdolecek 		if (minor(dev) != USB_DEV_MINOR)
    990  1.162     skrll 			return 1;
    991   1.75  christos 		klist = &usb_selevent.sel_klist;
    992   1.74  jdolecek 		kn->kn_fop = &usbread_filtops;
    993   1.74  jdolecek 		break;
    994   1.74  jdolecek 
    995   1.74  jdolecek 	default:
    996  1.162     skrll 		return EINVAL;
    997   1.74  jdolecek 	}
    998   1.74  jdolecek 
    999   1.74  jdolecek 	kn->kn_hook = NULL;
   1000   1.74  jdolecek 
   1001  1.130       mrg 	mutex_enter(&usb_event_lock);
   1002   1.74  jdolecek 	SLIST_INSERT_HEAD(klist, kn, kn_selnext);
   1003  1.130       mrg 	mutex_exit(&usb_event_lock);
   1004   1.74  jdolecek 
   1005  1.162     skrll 	return 0;
   1006   1.74  jdolecek }
   1007   1.74  jdolecek 
   1008   1.25  augustss /* Explore device tree from the root. */
   1009   1.51  augustss Static void
   1010  1.109  drochner usb_discover(struct usb_softc *sc)
   1011    1.1  augustss {
   1012  1.172       mrg 	struct usbd_bus *bus = sc->sc_bus;
   1013   1.51  augustss 
   1014  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
   1015  1.162     skrll 
   1016  1.172       mrg 	KASSERT(mutex_owned(bus->ub_lock));
   1017  1.130       mrg 
   1018   1.51  augustss 	if (usb_noexplore > 1)
   1019   1.51  augustss 		return;
   1020  1.172       mrg 
   1021   1.66  augustss 	/*
   1022   1.25  augustss 	 * We need mutual exclusion while traversing the device tree,
   1023   1.25  augustss 	 * but this is guaranteed since this function is only called
   1024   1.25  augustss 	 * from the event thread for the controller.
   1025  1.130       mrg 	 *
   1026  1.172       mrg 	 * Also, we now have bus->ub_lock held, and in combination
   1027  1.172       mrg 	 * with ub_exploring, avoids interferring with polling.
   1028   1.25  augustss 	 */
   1029  1.172       mrg 	while (bus->ub_needsexplore && !sc->sc_dying) {
   1030  1.172       mrg 		bus->ub_needsexplore = 0;
   1031  1.162     skrll 		mutex_exit(sc->sc_bus->ub_lock);
   1032  1.172       mrg 		bus->ub_roothub->ud_hub->uh_explore(bus->ub_roothub);
   1033  1.172       mrg 		mutex_enter(bus->ub_lock);
   1034   1.30  augustss 	}
   1035    1.1  augustss }
   1036    1.1  augustss 
   1037    1.1  augustss void
   1038  1.162     skrll usb_needs_explore(struct usbd_device *dev)
   1039    1.1  augustss {
   1040  1.162     skrll 
   1041  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
   1042  1.162     skrll 
   1043  1.162     skrll 	mutex_enter(dev->ud_bus->ub_lock);
   1044  1.162     skrll 	dev->ud_bus->ub_needsexplore = 1;
   1045  1.162     skrll 	cv_signal(&dev->ud_bus->ub_needsexplore_cv);
   1046  1.162     skrll 	mutex_exit(dev->ud_bus->ub_lock);
   1047    1.1  augustss }
   1048    1.7  augustss 
   1049   1.81      joff void
   1050  1.162     skrll usb_needs_reattach(struct usbd_device *dev)
   1051   1.81      joff {
   1052  1.162     skrll 
   1053  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
   1054  1.162     skrll 
   1055  1.162     skrll 	mutex_enter(dev->ud_bus->ub_lock);
   1056  1.162     skrll 	dev->ud_powersrc->up_reattach = 1;
   1057  1.162     skrll 	dev->ud_bus->ub_needsexplore = 1;
   1058  1.162     skrll 	cv_signal(&dev->ud_bus->ub_needsexplore_cv);
   1059  1.162     skrll 	mutex_exit(dev->ud_bus->ub_lock);
   1060   1.81      joff }
   1061   1.81      joff 
   1062  1.130       mrg /* Called at with usb_event_lock held. */
   1063   1.26  augustss int
   1064   1.45  augustss usb_get_next_event(struct usb_event *ue)
   1065   1.26  augustss {
   1066   1.26  augustss 	struct usb_event_q *ueq;
   1067   1.26  augustss 
   1068  1.130       mrg 	KASSERT(mutex_owned(&usb_event_lock));
   1069  1.130       mrg 
   1070   1.26  augustss 	if (usb_nevents <= 0)
   1071  1.162     skrll 		return 0;
   1072   1.26  augustss 	ueq = SIMPLEQ_FIRST(&usb_events);
   1073   1.65  augustss #ifdef DIAGNOSTIC
   1074   1.65  augustss 	if (ueq == NULL) {
   1075   1.65  augustss 		printf("usb: usb_nevents got out of sync! %d\n", usb_nevents);
   1076   1.65  augustss 		usb_nevents = 0;
   1077  1.162     skrll 		return 0;
   1078   1.65  augustss 	}
   1079   1.65  augustss #endif
   1080   1.83  drochner 	if (ue)
   1081   1.83  drochner 		*ue = ueq->ue;
   1082   1.71     lukem 	SIMPLEQ_REMOVE_HEAD(&usb_events, next);
   1083   1.87  christos 	usb_free_event((struct usb_event *)(void *)ueq);
   1084   1.26  augustss 	usb_nevents--;
   1085  1.162     skrll 	return 1;
   1086   1.26  augustss }
   1087   1.26  augustss 
   1088   1.26  augustss void
   1089  1.162     skrll usbd_add_dev_event(int type, struct usbd_device *udev)
   1090   1.38  augustss {
   1091   1.87  christos 	struct usb_event *ue = usb_alloc_event();
   1092   1.38  augustss 
   1093  1.161     skrll 	usbd_fill_deviceinfo(udev, &ue->u.ue_device, false);
   1094   1.87  christos 	usb_add_event(type, ue);
   1095   1.38  augustss }
   1096   1.38  augustss 
   1097   1.38  augustss void
   1098  1.162     skrll usbd_add_drv_event(int type, struct usbd_device *udev, device_t dev)
   1099   1.38  augustss {
   1100   1.87  christos 	struct usb_event *ue = usb_alloc_event();
   1101   1.87  christos 
   1102  1.162     skrll 	ue->u.ue_driver.ue_cookie = udev->ud_cookie;
   1103  1.123    dyoung 	strncpy(ue->u.ue_driver.ue_devname, device_xname(dev),
   1104  1.162     skrll 	    sizeof(ue->u.ue_driver.ue_devname));
   1105   1.87  christos 	usb_add_event(type, ue);
   1106   1.87  christos }
   1107   1.87  christos 
   1108   1.87  christos Static struct usb_event *
   1109   1.87  christos usb_alloc_event(void)
   1110   1.87  christos {
   1111   1.87  christos 	/* Yes, this is right; we allocate enough so that we can use it later */
   1112  1.162     skrll 	return kmem_zalloc(sizeof(struct usb_event_q), KM_SLEEP);
   1113   1.87  christos }
   1114   1.38  augustss 
   1115   1.87  christos Static void
   1116   1.87  christos usb_free_event(struct usb_event *uep)
   1117   1.87  christos {
   1118  1.162     skrll 	kmem_free(uep, sizeof(struct usb_event_q));
   1119   1.38  augustss }
   1120   1.38  augustss 
   1121   1.42  augustss Static void
   1122   1.45  augustss usb_add_event(int type, struct usb_event *uep)
   1123   1.26  augustss {
   1124   1.26  augustss 	struct usb_event_q *ueq;
   1125   1.26  augustss 	struct timeval thetime;
   1126   1.26  augustss 
   1127  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
   1128  1.162     skrll 
   1129   1.38  augustss 	microtime(&thetime);
   1130  1.130       mrg 	/* Don't want to wait here with usb_event_lock held */
   1131   1.87  christos 	ueq = (struct usb_event_q *)(void *)uep;
   1132   1.38  augustss 	ueq->ue = *uep;
   1133   1.38  augustss 	ueq->ue.ue_type = type;
   1134   1.38  augustss 	TIMEVAL_TO_TIMESPEC(&thetime, &ueq->ue.ue_time);
   1135   1.38  augustss 
   1136  1.130       mrg 	mutex_enter(&usb_event_lock);
   1137   1.26  augustss 	if (++usb_nevents >= USB_MAX_EVENTS) {
   1138   1.26  augustss 		/* Too many queued events, drop an old one. */
   1139  1.162     skrll 		DPRINTF("event dropped", 0, 0, 0, 0);
   1140   1.83  drochner 		(void)usb_get_next_event(0);
   1141   1.26  augustss 	}
   1142   1.26  augustss 	SIMPLEQ_INSERT_TAIL(&usb_events, ueq, next);
   1143  1.130       mrg 	cv_signal(&usb_event_cv);
   1144  1.107     rmind 	selnotify(&usb_selevent, 0, 0);
   1145   1.94        ad 	if (usb_async_proc != NULL) {
   1146  1.130       mrg 		kpreempt_disable();
   1147  1.112        ad 		softint_schedule(usb_async_sih);
   1148  1.130       mrg 		kpreempt_enable();
   1149   1.94        ad 	}
   1150  1.130       mrg 	mutex_exit(&usb_event_lock);
   1151   1.39  augustss }
   1152   1.60  augustss 
   1153  1.112        ad Static void
   1154  1.112        ad usb_async_intr(void *cookie)
   1155  1.112        ad {
   1156  1.112        ad 	proc_t *proc;
   1157  1.112        ad 
   1158  1.112        ad 	mutex_enter(proc_lock);
   1159  1.112        ad 	if ((proc = usb_async_proc) != NULL)
   1160  1.112        ad 		psignal(proc, SIGIO);
   1161  1.112        ad 	mutex_exit(proc_lock);
   1162  1.112        ad }
   1163  1.112        ad 
   1164  1.130       mrg Static void
   1165  1.130       mrg usb_soft_intr(void *arg)
   1166  1.130       mrg {
   1167  1.162     skrll 	struct usbd_bus *bus = arg;
   1168  1.130       mrg 
   1169  1.162     skrll 	mutex_enter(bus->ub_lock);
   1170  1.162     skrll 	bus->ub_methods->ubm_softint(bus);
   1171  1.162     skrll 	mutex_exit(bus->ub_lock);
   1172  1.130       mrg }
   1173  1.130       mrg 
   1174   1.39  augustss void
   1175  1.162     skrll usb_schedsoftintr(struct usbd_bus *bus)
   1176   1.39  augustss {
   1177  1.130       mrg 
   1178  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
   1179  1.162     skrll 
   1180  1.168  pgoyette 	DPRINTFN(10, "polling=%jd", bus->ub_usepolling, 0, 0, 0);
   1181  1.130       mrg 
   1182  1.162     skrll 	if (bus->ub_usepolling) {
   1183  1.162     skrll 		bus->ub_methods->ubm_softint(bus);
   1184   1.49  augustss 	} else {
   1185  1.130       mrg 		kpreempt_disable();
   1186  1.162     skrll 		softint_schedule(bus->ub_soft);
   1187  1.130       mrg 		kpreempt_enable();
   1188   1.49  augustss 	}
   1189   1.26  augustss }
   1190   1.26  augustss 
   1191    1.7  augustss int
   1192  1.106    dyoung usb_activate(device_t self, enum devact act)
   1193    1.7  augustss {
   1194  1.106    dyoung 	struct usb_softc *sc = device_private(self);
   1195   1.22  augustss 
   1196   1.22  augustss 	switch (act) {
   1197   1.22  augustss 	case DVACT_DEACTIVATE:
   1198   1.22  augustss 		sc->sc_dying = 1;
   1199  1.119    dyoung 		return 0;
   1200  1.119    dyoung 	default:
   1201  1.119    dyoung 		return EOPNOTSUPP;
   1202   1.22  augustss 	}
   1203   1.13  augustss }
   1204    1.7  augustss 
   1205  1.106    dyoung void
   1206  1.106    dyoung usb_childdet(device_t self, device_t child)
   1207  1.106    dyoung {
   1208  1.114  drochner 	int i;
   1209  1.106    dyoung 	struct usb_softc *sc = device_private(self);
   1210  1.106    dyoung 	struct usbd_device *dev;
   1211  1.106    dyoung 
   1212  1.162     skrll 	if ((dev = sc->sc_port.up_dev) == NULL || dev->ud_subdevlen == 0)
   1213  1.106    dyoung 		return;
   1214  1.106    dyoung 
   1215  1.162     skrll 	for (i = 0; i < dev->ud_subdevlen; i++)
   1216  1.162     skrll 		if (dev->ud_subdevs[i] == child)
   1217  1.162     skrll 			dev->ud_subdevs[i] = NULL;
   1218  1.106    dyoung }
   1219  1.106    dyoung 
   1220   1.13  augustss int
   1221  1.106    dyoung usb_detach(device_t self, int flags)
   1222   1.13  augustss {
   1223  1.106    dyoung 	struct usb_softc *sc = device_private(self);
   1224   1.87  christos 	struct usb_event *ue;
   1225  1.119    dyoung 	int rc;
   1226   1.22  augustss 
   1227  1.162     skrll 	USBHIST_FUNC(); USBHIST_CALLED(usbdebug);
   1228   1.27  augustss 
   1229  1.119    dyoung 	/* Make all devices disconnect. */
   1230  1.162     skrll 	if (sc->sc_port.up_dev != NULL &&
   1231  1.119    dyoung 	    (rc = usb_disconnect_port(&sc->sc_port, self, flags)) != 0)
   1232  1.119    dyoung 		return rc;
   1233  1.119    dyoung 
   1234  1.105       smb 	pmf_device_deregister(self);
   1235   1.99  kiyohara 	/* Kill off event thread. */
   1236  1.119    dyoung 	sc->sc_dying = 1;
   1237   1.99  kiyohara 	while (sc->sc_event_thread != NULL) {
   1238  1.162     skrll 		mutex_enter(sc->sc_bus->ub_lock);
   1239  1.162     skrll 		cv_signal(&sc->sc_bus->ub_needsexplore_cv);
   1240  1.162     skrll 		cv_timedwait(&sc->sc_bus->ub_needsexplore_cv,
   1241  1.162     skrll 		    sc->sc_bus->ub_lock, hz * 60);
   1242  1.162     skrll 		mutex_exit(sc->sc_bus->ub_lock);
   1243  1.162     skrll 	}
   1244  1.162     skrll 	DPRINTF("event thread dead", 0, 0, 0, 0);
   1245  1.162     skrll 
   1246  1.162     skrll 	if (sc->sc_bus->ub_soft != NULL) {
   1247  1.162     skrll 		softint_disestablish(sc->sc_bus->ub_soft);
   1248  1.162     skrll 		sc->sc_bus->ub_soft = NULL;
   1249   1.49  augustss 	}
   1250   1.38  augustss 
   1251   1.87  christos 	ue = usb_alloc_event();
   1252  1.109  drochner 	ue->u.ue_ctrlr.ue_bus = device_unit(self);
   1253   1.87  christos 	usb_add_event(USB_EVENT_CTRLR_DETACH, ue);
   1254   1.38  augustss 
   1255  1.162     skrll 	cv_destroy(&sc->sc_bus->ub_needsexplore_cv);
   1256  1.130       mrg 
   1257  1.162     skrll 	return 0;
   1258    1.7  augustss }
   1259   1.92     pavel 
   1260   1.92     pavel #ifdef COMPAT_30
   1261   1.92     pavel Static void
   1262   1.92     pavel usb_copy_old_devinfo(struct usb_device_info_old *uo,
   1263   1.92     pavel 		     const struct usb_device_info *ue)
   1264   1.92     pavel {
   1265   1.92     pavel 	const unsigned char *p;
   1266   1.92     pavel 	unsigned char *q;
   1267   1.92     pavel 	int i, n;
   1268   1.92     pavel 
   1269   1.92     pavel 	uo->udi_bus = ue->udi_bus;
   1270  1.137  christos 	uo->udi_addr = ue->udi_addr;
   1271   1.92     pavel 	uo->udi_cookie = ue->udi_cookie;
   1272   1.92     pavel 	for (i = 0, p = (const unsigned char *)ue->udi_product,
   1273   1.92     pavel 	     q = (unsigned char *)uo->udi_product;
   1274   1.92     pavel 	     *p && i < USB_MAX_STRING_LEN - 1; p++) {
   1275   1.92     pavel 		if (*p < 0x80)
   1276   1.92     pavel 			q[i++] = *p;
   1277   1.92     pavel 		else {
   1278   1.92     pavel 			q[i++] = '?';
   1279   1.92     pavel 			if ((*p & 0xe0) == 0xe0)
   1280   1.92     pavel 				p++;
   1281   1.92     pavel 			p++;
   1282   1.92     pavel 		}
   1283   1.92     pavel 	}
   1284   1.92     pavel 	q[i] = 0;
   1285   1.92     pavel 
   1286   1.92     pavel 	for (i = 0, p = ue->udi_vendor, q = uo->udi_vendor;
   1287   1.92     pavel 	     *p && i < USB_MAX_STRING_LEN - 1; p++) {
   1288   1.92     pavel 		if (* p < 0x80)
   1289   1.92     pavel 			q[i++] = *p;
   1290   1.92     pavel 		else {
   1291   1.92     pavel 			q[i++] = '?';
   1292   1.92     pavel 			p++;
   1293   1.92     pavel 			if ((*p & 0xe0) == 0xe0)
   1294   1.92     pavel 				p++;
   1295   1.92     pavel 		}
   1296   1.92     pavel 	}
   1297   1.92     pavel 	q[i] = 0;
   1298   1.92     pavel 
   1299   1.92     pavel 	memcpy(uo->udi_release, ue->udi_release, sizeof(uo->udi_release));
   1300   1.92     pavel 
   1301   1.92     pavel 	uo->udi_productNo = ue->udi_productNo;
   1302   1.92     pavel 	uo->udi_vendorNo = ue->udi_vendorNo;
   1303   1.92     pavel 	uo->udi_releaseNo = ue->udi_releaseNo;
   1304   1.92     pavel 	uo->udi_class = ue->udi_class;
   1305   1.92     pavel 	uo->udi_subclass = ue->udi_subclass;
   1306   1.92     pavel 	uo->udi_protocol = ue->udi_protocol;
   1307   1.92     pavel 	uo->udi_config = ue->udi_config;
   1308   1.92     pavel 	uo->udi_speed = ue->udi_speed;
   1309  1.137  christos 	uo->udi_power = ue->udi_power;
   1310   1.92     pavel 	uo->udi_nports = ue->udi_nports;
   1311   1.92     pavel 
   1312   1.92     pavel 	for (n=0; n<USB_MAX_DEVNAMES; n++)
   1313   1.92     pavel 		memcpy(uo->udi_devnames[n],
   1314   1.92     pavel 		       ue->udi_devnames[n], USB_MAX_DEVNAMELEN);
   1315   1.92     pavel 	memcpy(uo->udi_ports, ue->udi_ports, sizeof(uo->udi_ports));
   1316   1.92     pavel }
   1317   1.92     pavel #endif
   1318