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