freebsd-nq/sys/dev/usb/usb.c
Ed Schouten 6bfa9a2d66 Replace all calls to minor() with dev2unit().
After I removed all the unit2minor()/minor2unit() calls from the kernel
yesterday, I realised calling minor() everywhere is quite confusing.
Character devices now only have the ability to store a unit number, not
a minor number. Remove the confusion by using dev2unit() everywhere.

This commit could also be considered as a bug fix. A lot of drivers call
minor(), while they should actually be calling dev2unit(). In -CURRENT
this isn't a problem, but it turns out we never had any problem reports
related to that issue in the past. I suspect not many people connect
more than 256 pieces of the same hardware.

Reviewed by:	kib
2008-09-27 08:51:18 +00:00

940 lines
22 KiB
C

/* $NetBSD: usb.c,v 1.68 2002/02/20 20:30:12 christos Exp $ */
/* Also already merged from NetBSD:
* $NetBSD: usb.c,v 1.70 2002/05/09 21:54:32 augustss Exp $
* $NetBSD: usb.c,v 1.71 2002/06/01 23:51:04 lukem Exp $
* $NetBSD: usb.c,v 1.73 2002/09/23 05:51:19 simonb Exp $
* $NetBSD: usb.c,v 1.80 2003/11/07 17:03:25 wiz Exp $
*/
#include <sys/cdefs.h>
__FBSDID("$FreeBSD$");
/*-
* Copyright (c) 1998 The NetBSD Foundation, Inc.
* All rights reserved.
*
* This code is derived from software contributed to The NetBSD Foundation
* by Lennart Augustsson (lennart@augustsson.net) at
* Carlstedt Research & Technology.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the NetBSD
* Foundation, Inc. and its contributors.
* 4. Neither the name of The NetBSD Foundation nor the names of its
* contributors may be used to endorse or promote products derived
* from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
* POSSIBILITY OF SUCH DAMAGE.
*/
/*
* USB specifications and other documentation can be found at
* http://www.usb.org/developers/docs/ and
* http://www.usb.org/developers/devclass_docs/
*/
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/lock.h>
#include <sys/malloc.h>
#include <sys/mutex.h>
#include <sys/unistd.h>
#include <sys/module.h>
#include <sys/bus.h>
#include <sys/fcntl.h>
#include <sys/filio.h>
#include <sys/uio.h>
#include <sys/kthread.h>
#include <sys/proc.h>
#include <sys/conf.h>
#include <sys/poll.h>
#include <sys/selinfo.h>
#include <sys/signalvar.h>
#include <sys/sysctl.h>
#include <sys/uio.h>
#include <dev/usb/usb.h>
#include <dev/usb/usbdi.h>
#include <dev/usb/usbdi_util.h>
#define USBUNIT(d) (dev2unit(d)) /* usb_discover device nodes, kthread */
#define USB_DEV_MINOR 255 /* event queue device */
MALLOC_DEFINE(M_USB, "USB", "USB");
MALLOC_DEFINE(M_USBDEV, "USBdev", "USB device");
MALLOC_DEFINE(M_USBHC, "USBHC", "USB host controller");
#include "usb_if.h"
#include <machine/bus.h>
#include <dev/usb/usbdivar.h>
#include <dev/usb/usb_quirks.h>
/* Define this unconditionally in case a kernel module is loaded that
* has been compiled with debugging options.
*/
SYSCTL_NODE(_hw, OID_AUTO, usb, CTLFLAG_RW, 0, "USB debugging");
#ifdef USB_DEBUG
#define DPRINTF(x) if (usbdebug) printf x
#define DPRINTFN(n,x) if (usbdebug>(n)) printf x
int usbdebug = 0;
SYSCTL_INT(_hw_usb, OID_AUTO, debug, CTLFLAG_RW,
&usbdebug, 0, "usb debug level");
/*
* 0 - do usual exploration
* 1 - do not use timeout exploration
* >1 - do no exploration
*/
int usb_noexplore = 0;
#else
#define DPRINTF(x)
#define DPRINTFN(n,x)
#endif
struct usb_softc {
device_t sc_dev; /* base device */
struct cdev *sc_usbdev; /* /dev/usbN device */
TAILQ_ENTRY(usb_softc) sc_coldexplist; /* cold needs-explore list */
usbd_bus_handle sc_bus; /* USB controller */
struct usbd_port sc_port; /* dummy port for root hub */
struct proc *sc_event_thread;
char sc_dying;
};
struct usb_taskq {
TAILQ_HEAD(, usb_task) tasks;
struct proc *task_thread_proc;
const char *name;
int taskcreated; /* task thread exists. */
};
static struct usb_taskq usb_taskq[USB_NUM_TASKQS];
d_open_t usbopen;
d_close_t usbclose;
d_read_t usbread;
d_ioctl_t usbioctl;
d_poll_t usbpoll;
struct cdevsw usb_cdevsw = {
.d_version = D_VERSION,
.d_flags = D_NEEDGIANT,
.d_open = usbopen,
.d_close = usbclose,
.d_read = usbread,
.d_ioctl = usbioctl,
.d_poll = usbpoll,
.d_name = "usb",
};
static void usb_discover(void *);
static void usb_create_event_thread(void *);
static void usb_event_thread(void *);
static void usb_task_thread(void *);
static struct cdev *usb_dev; /* The /dev/usb device. */
static int usb_ndevs; /* Number of /dev/usbN devices. */
/* Busses to explore at the end of boot-time device configuration. */
static TAILQ_HEAD(, usb_softc) usb_coldexplist =
TAILQ_HEAD_INITIALIZER(usb_coldexplist);
#define USB_MAX_EVENTS 100
struct usb_event_q {
struct usb_event ue;
TAILQ_ENTRY(usb_event_q) next;
};
static TAILQ_HEAD(, usb_event_q) usb_events =
TAILQ_HEAD_INITIALIZER(usb_events);
static int usb_nevents = 0;
static struct selinfo usb_selevent;
static struct proc *usb_async_proc; /* process that wants USB SIGIO */
static int usb_dev_open = 0;
static void usb_add_event(int, struct usb_event *);
static int usb_get_next_event(struct usb_event *);
static const char *usbrev_str[] = USBREV_STR;
static device_probe_t usb_match;
static device_attach_t usb_attach;
static device_detach_t usb_detach;
static bus_child_detached_t usb_child_detached;
static device_method_t usb_methods[] = {
/* Device interface */
DEVMETHOD(device_probe, usb_match),
DEVMETHOD(device_attach, usb_attach),
DEVMETHOD(device_detach, usb_detach),
DEVMETHOD(device_suspend, bus_generic_suspend),
DEVMETHOD(device_resume, bus_generic_resume),
DEVMETHOD(device_shutdown, bus_generic_shutdown),
/* Bus interface */
DEVMETHOD(bus_child_detached, usb_child_detached),
{ 0, 0 }
};
static driver_t usb_driver = {
"usb",
usb_methods,
sizeof(struct usb_softc)
};
static devclass_t usb_devclass;
DRIVER_MODULE(usb, ohci, usb_driver, usb_devclass, 0, 0);
DRIVER_MODULE(usb, uhci, usb_driver, usb_devclass, 0, 0);
DRIVER_MODULE(usb, ehci, usb_driver, usb_devclass, 0, 0);
DRIVER_MODULE(usb, slhci, usb_driver, usb_devclass, 0, 0);
MODULE_VERSION(usb, 1);
static int
usb_match(device_t self)
{
DPRINTF(("usbd_match\n"));
return (UMATCH_GENERIC);
}
static int
usb_attach(device_t self)
{
struct usb_softc *sc = device_get_softc(self);
void *aux = device_get_ivars(self);
usbd_device_handle dev;
usbd_status err;
int usbrev;
int speed;
struct usb_event ue;
sc->sc_dev = self;
DPRINTF(("usbd_attach\n"));
usbd_init();
sc->sc_bus = aux;
sc->sc_bus->usbctl = sc;
sc->sc_port.power = USB_MAX_POWER;
printf("%s", device_get_nameunit(sc->sc_dev));
usbrev = sc->sc_bus->usbrev;
printf(": USB revision %s", usbrev_str[usbrev]);
switch (usbrev) {
case USBREV_1_0:
case USBREV_1_1:
speed = USB_SPEED_FULL;
break;
case USBREV_2_0:
speed = USB_SPEED_HIGH;
break;
default:
printf(", not supported\n");
sc->sc_dying = 1;
return ENXIO;
}
printf("\n");
/* Make sure not to use tsleep() if we are cold booting. */
if (cold)
sc->sc_bus->use_polling++;
ue.u.ue_ctrlr.ue_bus = device_get_unit(sc->sc_dev);
usb_add_event(USB_EVENT_CTRLR_ATTACH, &ue);
#ifdef USB_USE_SOFTINTR
#ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
/* XXX we should have our own level */
sc->sc_bus->soft = softintr_establish(IPL_SOFTNET,
sc->sc_bus->methods->soft_intr, sc->sc_bus);
if (sc->sc_bus->soft == NULL) {
printf("%s: can't register softintr\n", device_get_nameunit(sc->sc_dev));
sc->sc_dying = 1;
return ENXIO;
}
#else
usb_callout_init(sc->sc_bus->softi);
#endif
#endif
err = usbd_new_device(sc->sc_dev, sc->sc_bus, 0, speed, 0,
&sc->sc_port);
if (!err) {
dev = sc->sc_port.device;
if (dev->hub == NULL) {
sc->sc_dying = 1;
printf("%s: root device is not a hub\n",
device_get_nameunit(sc->sc_dev));
return ENXIO;
}
sc->sc_bus->root_hub = dev;
#if 1
/*
* Turning this code off will delay attachment of USB devices
* until the USB event thread is running, which means that
* the keyboard will not work until after cold boot.
*/
if (cold) {
/* Explore high-speed busses before others. */
if (speed == USB_SPEED_HIGH)
dev->hub->explore(sc->sc_bus->root_hub);
else
TAILQ_INSERT_TAIL(&usb_coldexplist, sc,
sc_coldexplist);
}
#endif
} else {
printf("%s: root hub problem, error=%d\n",
device_get_nameunit(sc->sc_dev), err);
sc->sc_dying = 1;
}
if (cold)
sc->sc_bus->use_polling--;
/* XXX really do right config_pending_incr(); */
usb_create_event_thread(sc);
/* The per controller devices (used for usb_discover) */
/* XXX This is redundant now, but old usbd's will want it */
sc->sc_usbdev = make_dev(&usb_cdevsw, device_get_unit(self), UID_ROOT,
GID_OPERATOR, 0660, "usb%d", device_get_unit(self));
if (usb_ndevs++ == 0) {
/* The device spitting out events */
usb_dev = make_dev(&usb_cdevsw, USB_DEV_MINOR, UID_ROOT,
GID_OPERATOR, 0660, "usb");
}
return 0;
}
static const char *taskq_names[] = USB_TASKQ_NAMES;
void
usb_create_event_thread(void *arg)
{
struct usb_softc *sc = arg;
struct usb_taskq *taskq;
int i;
if (kproc_create(usb_event_thread, sc, &sc->sc_event_thread,
RFHIGHPID, 0, device_get_nameunit(sc->sc_dev))) {
printf("%s: unable to create event thread for\n",
device_get_nameunit(sc->sc_dev));
panic("usb_create_event_thread");
}
for (i = 0; i < USB_NUM_TASKQS; i++) {
taskq = &usb_taskq[i];
if (taskq->taskcreated == 0) {
taskq->taskcreated = 1;
taskq->name = taskq_names[i];
TAILQ_INIT(&taskq->tasks);
if (kproc_create(usb_task_thread, taskq,
&taskq->task_thread_proc, RFHIGHPID, 0,
taskq->name)) {
printf("unable to create task thread\n");
panic("usb_create_event_thread task");
}
}
}
}
/*
* Add a task to be performed by the task thread. This function can be
* called from any context and the task will be executed in a process
* context ASAP.
*/
void
usb_add_task(usbd_device_handle dev, struct usb_task *task, int queue)
{
struct usb_taskq *taskq;
int s;
s = splusb();
taskq = &usb_taskq[queue];
if (task->queue == -1) {
DPRINTFN(2,("usb_add_task: task=%p\n", task));
TAILQ_INSERT_TAIL(&taskq->tasks, task, next);
task->queue = queue;
} else {
DPRINTFN(3,("usb_add_task: task=%p on q\n", task));
}
wakeup(&taskq->tasks);
splx(s);
}
void
usb_rem_task(usbd_device_handle dev, struct usb_task *task)
{
struct usb_taskq *taskq;
int s;
s = splusb();
if (task->queue != -1) {
taskq = &usb_taskq[task->queue];
TAILQ_REMOVE(&taskq->tasks, task, next);
task->queue = -1;
}
splx(s);
}
void
usb_event_thread(void *arg)
{
static int newthread_wchan;
struct usb_softc *sc = arg;
mtx_lock(&Giant);
DPRINTF(("usb_event_thread: start\n"));
/*
* In case this controller is a companion controller to an
* EHCI controller we need to wait until the EHCI controller
* has grabbed the port. What we do here is wait until no new
* USB threads have been created in a while. XXX we actually
* just want to wait for the PCI slot to be fully scanned.
*
* Note that when you `kldload usb' it actually attaches the
* devices in order that the drivers appear in the kld, not the
* normal PCI order, since the addition of each driver within
* usb.ko (ohci, ehci etc.) causes a separate PCI bus re-scan.
*/
wakeup(&newthread_wchan);
for (;;) {
if (tsleep(&newthread_wchan , PWAIT, "usbets", hz * 4) != 0)
break;
}
/* Make sure first discover does something. */
sc->sc_bus->needs_explore = 1;
usb_discover(sc);
/* XXX really do right config_pending_decr(); */
while (!sc->sc_dying) {
#ifdef USB_DEBUG
if (usb_noexplore < 2)
#endif
usb_discover(sc);
#ifdef USB_DEBUG
(void)tsleep(&sc->sc_bus->needs_explore, PWAIT, "usbevt",
usb_noexplore ? 0 : hz * 60);
#else
(void)tsleep(&sc->sc_bus->needs_explore, PWAIT, "usbevt",
hz * 60);
#endif
DPRINTFN(2,("usb_event_thread: woke up\n"));
}
sc->sc_event_thread = NULL;
/* In case parent is waiting for us to exit. */
wakeup(sc);
DPRINTF(("usb_event_thread: exit\n"));
while (mtx_owned(&Giant))
mtx_unlock(&Giant);
kproc_exit(0);
}
void
usb_task_thread(void *arg)
{
struct usb_task *task;
struct usb_taskq *taskq;
int s;
mtx_lock(&Giant);
taskq = arg;
DPRINTF(("usb_task_thread: start taskq %s\n", taskq->name));
s = splusb();
while (usb_ndevs > 0) {
task = TAILQ_FIRST(&taskq->tasks);
if (task == NULL) {
tsleep(&taskq->tasks, PWAIT, "usbtsk", 0);
task = TAILQ_FIRST(&taskq->tasks);
}
DPRINTFN(2,("usb_task_thread: woke up task=%p\n", task));
if (task != NULL) {
TAILQ_REMOVE(&taskq->tasks, task, next);
task->queue = -1;
splx(s);
task->fun(task->arg);
s = splusb();
}
}
splx(s);
taskq->taskcreated = 0;
wakeup(&taskq->taskcreated);
DPRINTF(("usb_event_thread: exit\n"));
while (mtx_owned(&Giant))
mtx_unlock(&Giant);
kproc_exit(0);
}
int
usbopen(struct cdev *dev, int flag, int mode, struct thread *p)
{
int unit = USBUNIT(dev);
struct usb_softc *sc;
if (unit == USB_DEV_MINOR) {
if (usb_dev_open)
return (EBUSY);
usb_dev_open = 1;
usb_async_proc = 0;
return (0);
}
sc = devclass_get_softc(usb_devclass, unit);
if (sc == NULL)
return (ENXIO);
if (sc->sc_dying)
return (EIO);
return (0);
}
int
usbread(struct cdev *dev, struct uio *uio, int flag)
{
struct usb_event ue;
int unit = USBUNIT(dev);
int s, error, n;
if (unit != USB_DEV_MINOR)
return (ENODEV);
if (uio->uio_resid != sizeof(struct usb_event))
return (EINVAL);
error = 0;
s = splusb();
for (;;) {
n = usb_get_next_event(&ue);
if (n != 0)
break;
if (flag & O_NONBLOCK) {
error = EWOULDBLOCK;
break;
}
error = tsleep(&usb_events, PZERO | PCATCH, "usbrea", 0);
if (error)
break;
}
splx(s);
if (!error)
error = uiomove((void *)&ue, uio->uio_resid, uio);
return (error);
}
int
usbclose(struct cdev *dev, int flag, int mode, struct thread *p)
{
int unit = USBUNIT(dev);
if (unit == USB_DEV_MINOR) {
usb_async_proc = 0;
usb_dev_open = 0;
}
return (0);
}
int
usbioctl(struct cdev *devt, u_long cmd, caddr_t data, int flag, struct thread *p)
{
struct usb_softc *sc;
int unit = USBUNIT(devt);
if (unit == USB_DEV_MINOR) {
switch (cmd) {
case FIONBIO:
/* All handled in the upper FS layer. */
return (0);
case FIOASYNC:
if (*(int *)data)
usb_async_proc = p->td_proc;
else
usb_async_proc = 0;
return (0);
default:
return (EINVAL);
}
}
sc = devclass_get_softc(usb_devclass, unit);
if (sc->sc_dying)
return (EIO);
switch (cmd) {
/* This part should be deleted */
case USB_DISCOVER:
break;
case USB_REQUEST:
{
struct usb_ctl_request *ur = (void *)data;
int len = UGETW(ur->ucr_request.wLength);
struct iovec iov;
struct uio uio;
void *ptr = 0;
int addr = ur->ucr_addr;
usbd_status err;
int error = 0;
DPRINTF(("usbioctl: USB_REQUEST addr=%d len=%d\n", addr, len));
if (len < 0 || len > 32768)
return (EINVAL);
if (addr < 0 || addr >= USB_MAX_DEVICES ||
sc->sc_bus->devices[addr] == 0)
return (EINVAL);
if (len != 0) {
iov.iov_base = (caddr_t)ur->ucr_data;
iov.iov_len = len;
uio.uio_iov = &iov;
uio.uio_iovcnt = 1;
uio.uio_resid = len;
uio.uio_offset = 0;
uio.uio_segflg = UIO_USERSPACE;
uio.uio_rw =
ur->ucr_request.bmRequestType & UT_READ ?
UIO_READ : UIO_WRITE;
uio.uio_td = p;
ptr = malloc(len, M_TEMP, M_WAITOK);
if (uio.uio_rw == UIO_WRITE) {
error = uiomove(ptr, len, &uio);
if (error)
goto ret;
}
}
err = usbd_do_request_flags(sc->sc_bus->devices[addr],
&ur->ucr_request, ptr, ur->ucr_flags, &ur->ucr_actlen,
USBD_DEFAULT_TIMEOUT);
if (err) {
error = EIO;
goto ret;
}
if (len != 0) {
if (uio.uio_rw == UIO_READ) {
error = uiomove(ptr, len, &uio);
if (error)
goto ret;
}
}
ret:
if (ptr)
free(ptr, M_TEMP);
return (error);
}
case USB_DEVICEINFO:
{
struct usb_device_info *di = (void *)data;
int addr = di->udi_addr;
usbd_device_handle dev;
if (addr < 1 || addr >= USB_MAX_DEVICES)
return (EINVAL);
dev = sc->sc_bus->devices[addr];
if (dev == NULL)
return (ENXIO);
usbd_fill_deviceinfo(dev, di, 1);
break;
}
case USB_DEVICESTATS:
*(struct usb_device_stats *)data = sc->sc_bus->stats;
break;
default:
return (EINVAL);
}
return (0);
}
int
usbpoll(struct cdev *dev, int events, struct thread *p)
{
int revents, mask, s;
int unit = USBUNIT(dev);
if (unit == USB_DEV_MINOR) {
revents = 0;
mask = POLLIN | POLLRDNORM;
s = splusb();
if (events & mask && usb_nevents > 0)
revents |= events & mask;
if (revents == 0 && events & mask)
selrecord(p, &usb_selevent);
splx(s);
return (revents);
} else {
return (0); /* select/poll never wakes up - back compat */
}
}
/* Explore device tree from the root. */
static void
usb_discover(void *v)
{
struct usb_softc *sc = v;
/* splxxx should be changed to mutexes for preemption safety some day */
int s;
DPRINTFN(2,("usb_discover\n"));
#ifdef USB_DEBUG
if (usb_noexplore > 1)
return;
#endif
/*
* We need mutual exclusion while traversing the device tree,
* but this is guaranteed since this function is only called
* from the event thread for the controller.
*/
s = splusb();
while (sc->sc_bus->needs_explore && !sc->sc_dying) {
sc->sc_bus->needs_explore = 0;
splx(s);
sc->sc_bus->root_hub->hub->explore(sc->sc_bus->root_hub);
s = splusb();
}
splx(s);
}
void
usb_needs_explore(usbd_device_handle dev)
{
DPRINTFN(2,("usb_needs_explore\n"));
dev->bus->needs_explore = 1;
wakeup(&dev->bus->needs_explore);
}
/* Called at splusb() */
int
usb_get_next_event(struct usb_event *ue)
{
struct usb_event_q *ueq;
if (usb_nevents <= 0)
return (0);
ueq = TAILQ_FIRST(&usb_events);
#ifdef DIAGNOSTIC
if (ueq == NULL) {
printf("usb: usb_nevents got out of sync! %d\n", usb_nevents);
usb_nevents = 0;
return (0);
}
#endif
*ue = ueq->ue;
TAILQ_REMOVE(&usb_events, ueq, next);
free(ueq, M_USBDEV);
usb_nevents--;
return (1);
}
void
usbd_add_dev_event(int type, usbd_device_handle udev)
{
struct usb_event ue;
usbd_fill_deviceinfo(udev, &ue.u.ue_device, USB_EVENT_IS_ATTACH(type));
usb_add_event(type, &ue);
}
void
usbd_add_drv_event(int type, usbd_device_handle udev, device_t dev)
{
struct usb_event ue;
ue.u.ue_driver.ue_cookie = udev->cookie;
strncpy(ue.u.ue_driver.ue_devname, device_get_nameunit(dev),
sizeof ue.u.ue_driver.ue_devname);
usb_add_event(type, &ue);
}
void
usb_add_event(int type, struct usb_event *uep)
{
struct usb_event_q *ueq;
struct usb_event ue;
struct timeval thetime;
int s;
ueq = malloc(sizeof *ueq, M_USBDEV, M_WAITOK);
ueq->ue = *uep;
ueq->ue.ue_type = type;
microtime(&thetime);
TIMEVAL_TO_TIMESPEC(&thetime, &ueq->ue.ue_time);
s = splusb();
if (USB_EVENT_IS_DETACH(type)) {
struct usb_event_q *ueqi, *ueqi_next;
for (ueqi = TAILQ_FIRST(&usb_events); ueqi; ueqi = ueqi_next) {
ueqi_next = TAILQ_NEXT(ueqi, next);
if (ueqi->ue.u.ue_driver.ue_cookie.cookie ==
uep->u.ue_device.udi_cookie.cookie) {
TAILQ_REMOVE(&usb_events, ueqi, next);
free(ueqi, M_USBDEV);
usb_nevents--;
ueqi_next = TAILQ_FIRST(&usb_events);
}
}
}
if (usb_nevents >= USB_MAX_EVENTS) {
/* Too many queued events, drop an old one. */
DPRINTF(("usb: event dropped\n"));
(void)usb_get_next_event(&ue);
}
TAILQ_INSERT_TAIL(&usb_events, ueq, next);
usb_nevents++;
wakeup(&usb_events);
selwakeuppri(&usb_selevent, PZERO);
if (usb_async_proc != NULL) {
PROC_LOCK(usb_async_proc);
psignal(usb_async_proc, SIGIO);
PROC_UNLOCK(usb_async_proc);
}
splx(s);
}
void
usb_schedsoftintr(usbd_bus_handle bus)
{
DPRINTFN(10,("usb_schedsoftintr: polling=%d\n", bus->use_polling));
#ifdef USB_USE_SOFTINTR
if (bus->use_polling) {
bus->methods->soft_intr(bus);
} else {
#ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
softintr_schedule(bus->soft);
#else
if (!callout_pending(&bus->softi))
callout_reset(&bus->softi, 0, bus->methods->soft_intr,
bus);
#endif /* __HAVE_GENERIC_SOFT_INTERRUPTS */
}
#else
bus->methods->soft_intr(bus);
#endif /* USB_USE_SOFTINTR */
}
static int
usb_detach(device_t self)
{
struct usb_softc *sc = device_get_softc(self);
struct usb_event ue;
struct usb_taskq *taskq;
int i;
DPRINTF(("usb_detach: start\n"));
sc->sc_dying = 1;
/* Make all devices disconnect. */
if (sc->sc_port.device != NULL)
usb_disconnect_port(&sc->sc_port, self);
/* Kill off event thread. */
if (sc->sc_event_thread != NULL) {
wakeup(&sc->sc_bus->needs_explore);
if (tsleep(sc, PWAIT, "usbdet", hz * 60))
printf("%s: event thread didn't die\n",
device_get_nameunit(sc->sc_dev));
DPRINTF(("usb_detach: event thread dead\n"));
}
destroy_dev(sc->sc_usbdev);
if (--usb_ndevs == 0) {
destroy_dev(usb_dev);
usb_dev = NULL;
for (i = 0; i < USB_NUM_TASKQS; i++) {
taskq = &usb_taskq[i];
wakeup(&taskq->tasks);
if (tsleep(&taskq->taskcreated, PWAIT, "usbtdt",
hz * 60)) {
printf("usb task thread %s didn't die\n",
taskq->name);
}
}
}
usbd_finish();
#ifdef USB_USE_SOFTINTR
#ifdef __HAVE_GENERIC_SOFT_INTERRUPTS
if (sc->sc_bus->soft != NULL) {
softintr_disestablish(sc->sc_bus->soft);
sc->sc_bus->soft = NULL;
}
#else
callout_stop(&sc->sc_bus->softi);
#endif
#endif
ue.u.ue_ctrlr.ue_bus = device_get_unit(sc->sc_dev);
usb_add_event(USB_EVENT_CTRLR_DETACH, &ue);
return (0);
}
static void
usb_child_detached(device_t self, device_t child)
{
struct usb_softc *sc = device_get_softc(self);
/* XXX, should check it is the right device. */
sc->sc_port.device = NULL;
}
/* Explore USB busses at the end of device configuration. */
static void
usb_cold_explore(void *arg)
{
struct usb_softc *sc;
KASSERT(cold || TAILQ_EMPTY(&usb_coldexplist),
("usb_cold_explore: busses to explore when !cold"));
while (!TAILQ_EMPTY(&usb_coldexplist)) {
sc = TAILQ_FIRST(&usb_coldexplist);
TAILQ_REMOVE(&usb_coldexplist, sc, sc_coldexplist);
sc->sc_bus->use_polling++;
sc->sc_port.device->hub->explore(sc->sc_bus->root_hub);
sc->sc_bus->use_polling--;
}
}
SYSINIT(usb_cold_explore, SI_SUB_CONFIGURE, SI_ORDER_MIDDLE,
usb_cold_explore, NULL);