#include <sys/stdint.h>
#include <sys/stddef.h>
#include <sys/param.h>
#include <sys/queue.h>
#include <sys/types.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/bus.h>
#include <sys/module.h>
#include <sys/lock.h>
#include <sys/mutex.h>
#include <sys/condvar.h>
#include <sys/sysctl.h>
#include <sys/sx.h>
#include <sys/unistd.h>
#include <sys/callout.h>
#include <sys/malloc.h>
#include <sys/priv.h>
#include <sys/conf.h>
#include <sys/fcntl.h>
#include "usbdevs.h"
#include <dev/usb/usb.h>
#include <dev/usb/usbdi.h>
#include <dev/usb/usb_ioctl.h>
#define USB_DEBUG_VAR usb_debug
#include <dev/usb/usb_debug.h>
#include <dev/usb/usb_dev.h>
#define UBTBCMFW_CONFIG_NO 1
#define UBTBCMFW_IFACE_IDX 0
#define UBTBCMFW_BSIZE 1024
#define UBTBCMFW_IFQ_MAXLEN 2
enum {
UBTBCMFW_BULK_DT_WR = 0,
UBTBCMFW_INTR_DT_RD,
UBTBCMFW_N_TRANSFER,
};
struct ubtbcmfw_softc {
struct usb_device *sc_udev;
struct mtx sc_mtx;
struct usb_xfer *sc_xfer[UBTBCMFW_N_TRANSFER];
struct usb_fifo_sc sc_fifo;
};
static device_probe_t ubtbcmfw_probe;
static device_attach_t ubtbcmfw_attach;
static device_detach_t ubtbcmfw_detach;
static usb_callback_t ubtbcmfw_write_callback;
static usb_callback_t ubtbcmfw_read_callback;
static usb_fifo_close_t ubtbcmfw_close;
static usb_fifo_cmd_t ubtbcmfw_start_read;
static usb_fifo_cmd_t ubtbcmfw_start_write;
static usb_fifo_cmd_t ubtbcmfw_stop_read;
static usb_fifo_cmd_t ubtbcmfw_stop_write;
static usb_fifo_ioctl_t ubtbcmfw_ioctl;
static usb_fifo_open_t ubtbcmfw_open;
static struct usb_fifo_methods ubtbcmfw_fifo_methods =
{
.f_close = &ubtbcmfw_close,
.f_ioctl = &ubtbcmfw_ioctl,
.f_open = &ubtbcmfw_open,
.f_start_read = &ubtbcmfw_start_read,
.f_start_write = &ubtbcmfw_start_write,
.f_stop_read = &ubtbcmfw_stop_read,
.f_stop_write = &ubtbcmfw_stop_write,
.basename[0] = "ubtbcmfw",
.basename[1] = "ubtbcmfw",
.basename[2] = "ubtbcmfw",
.postfix[0] = "",
.postfix[1] = ".1",
.postfix[2] = ".2",
};
static const struct usb_config ubtbcmfw_config[UBTBCMFW_N_TRANSFER] =
{
[UBTBCMFW_BULK_DT_WR] = {
.type = UE_BULK,
.endpoint = 0x02,
.direction = UE_DIR_OUT,
.if_index = UBTBCMFW_IFACE_IDX,
.bufsize = UBTBCMFW_BSIZE,
.flags = { .pipe_bof = 1, .force_short_xfer = 1,
.proxy_buffer = 1, },
.callback = &ubtbcmfw_write_callback,
},
[UBTBCMFW_INTR_DT_RD] = {
.type = UE_INTERRUPT,
.endpoint = 0x01,
.direction = UE_DIR_IN,
.if_index = UBTBCMFW_IFACE_IDX,
.bufsize = UBTBCMFW_BSIZE,
.flags = { .pipe_bof = 1, .short_xfer_ok = 1,
.proxy_buffer = 1, },
.callback = &ubtbcmfw_read_callback,
},
};
static device_method_t ubtbcmfw_methods[] =
{
DEVMETHOD(device_probe, ubtbcmfw_probe),
DEVMETHOD(device_attach, ubtbcmfw_attach),
DEVMETHOD(device_detach, ubtbcmfw_detach),
{0, 0}
};
static driver_t ubtbcmfw_driver =
{
.name = "ubtbcmfw",
.methods = ubtbcmfw_methods,
.size = sizeof(struct ubtbcmfw_softc),
};
static const STRUCT_USB_HOST_ID ubtbcmfw_devs[] = {
{ USB_VPI(USB_VENDOR_BROADCOM, USB_PRODUCT_BROADCOM_BCM2033, 0) },
};
DRIVER_MODULE(ubtbcmfw, uhub, ubtbcmfw_driver, NULL, NULL);
MODULE_DEPEND(ubtbcmfw, usb, 1, 1, 1);
USB_PNP_HOST_INFO(ubtbcmfw_devs);
static int
ubtbcmfw_probe(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
if (uaa->usb_mode != USB_MODE_HOST)
return (ENXIO);
if (uaa->info.bIfaceIndex != 0)
return (ENXIO);
return (usbd_lookup_id_by_uaa(ubtbcmfw_devs, sizeof(ubtbcmfw_devs), uaa));
}
static int
ubtbcmfw_attach(device_t dev)
{
struct usb_attach_arg *uaa = device_get_ivars(dev);
struct ubtbcmfw_softc *sc = device_get_softc(dev);
uint8_t iface_index;
int error;
sc->sc_udev = uaa->device;
device_set_usb_desc(dev);
mtx_init(&sc->sc_mtx, "ubtbcmfw lock", NULL, MTX_DEF | MTX_RECURSE);
iface_index = UBTBCMFW_IFACE_IDX;
error = usbd_transfer_setup(uaa->device, &iface_index, sc->sc_xfer,
ubtbcmfw_config, UBTBCMFW_N_TRANSFER,
sc, &sc->sc_mtx);
if (error != 0) {
device_printf(dev, "allocating USB transfers failed. %s\n",
usbd_errstr(error));
goto detach;
}
error = usb_fifo_attach(uaa->device, sc, &sc->sc_mtx,
&ubtbcmfw_fifo_methods, &sc->sc_fifo,
device_get_unit(dev), 0 - 1, uaa->info.bIfaceIndex,
UID_ROOT, GID_OPERATOR, 0644);
if (error != 0) {
device_printf(dev, "could not attach fifo. %s\n",
usbd_errstr(error));
goto detach;
}
return (0);
detach:
ubtbcmfw_detach(dev);
return (ENXIO);
}
static int
ubtbcmfw_detach(device_t dev)
{
struct ubtbcmfw_softc *sc = device_get_softc(dev);
usb_fifo_detach(&sc->sc_fifo);
usbd_transfer_unsetup(sc->sc_xfer, UBTBCMFW_N_TRANSFER);
mtx_destroy(&sc->sc_mtx);
return (0);
}
static void
ubtbcmfw_write_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct ubtbcmfw_softc *sc = usbd_xfer_softc(xfer);
struct usb_fifo *f = sc->sc_fifo.fp[USB_FIFO_TX];
struct usb_page_cache *pc;
uint32_t actlen;
switch (USB_GET_STATE(xfer)) {
case USB_ST_SETUP:
case USB_ST_TRANSFERRED:
setup_next:
pc = usbd_xfer_get_frame(xfer, 0);
if (usb_fifo_get_data(f, pc, 0, usbd_xfer_max_len(xfer),
&actlen, 0)) {
usbd_xfer_set_frame_len(xfer, 0, actlen);
usbd_transfer_submit(xfer);
}
break;
default:
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto setup_next;
}
break;
}
}
static void
ubtbcmfw_read_callback(struct usb_xfer *xfer, usb_error_t error)
{
struct ubtbcmfw_softc *sc = usbd_xfer_softc(xfer);
struct usb_fifo *fifo = sc->sc_fifo.fp[USB_FIFO_RX];
struct usb_page_cache *pc;
int actlen;
usbd_xfer_status(xfer, &actlen, NULL, NULL, NULL);
switch (USB_GET_STATE(xfer)) {
case USB_ST_TRANSFERRED:
pc = usbd_xfer_get_frame(xfer, 0);
usb_fifo_put_data(fifo, pc, 0, actlen, 1);
case USB_ST_SETUP:
setup_next:
if (usb_fifo_put_bytes_max(fifo) > 0) {
usbd_xfer_set_frame_len(xfer, 0, usbd_xfer_max_len(xfer));
usbd_transfer_submit(xfer);
}
break;
default:
if (error != USB_ERR_CANCELLED) {
usbd_xfer_set_stall(xfer);
goto setup_next;
}
break;
}
}
static void
ubtbcmfw_start_read(struct usb_fifo *fifo)
{
struct ubtbcmfw_softc *sc = usb_fifo_softc(fifo);
usbd_transfer_start(sc->sc_xfer[UBTBCMFW_INTR_DT_RD]);
}
static void
ubtbcmfw_stop_read(struct usb_fifo *fifo)
{
struct ubtbcmfw_softc *sc = usb_fifo_softc(fifo);
usbd_transfer_stop(sc->sc_xfer[UBTBCMFW_INTR_DT_RD]);
}
static void
ubtbcmfw_start_write(struct usb_fifo *fifo)
{
struct ubtbcmfw_softc *sc = usb_fifo_softc(fifo);
usbd_transfer_start(sc->sc_xfer[UBTBCMFW_BULK_DT_WR]);
}
static void
ubtbcmfw_stop_write(struct usb_fifo *fifo)
{
struct ubtbcmfw_softc *sc = usb_fifo_softc(fifo);
usbd_transfer_stop(sc->sc_xfer[UBTBCMFW_BULK_DT_WR]);
}
static int
ubtbcmfw_open(struct usb_fifo *fifo, int fflags)
{
struct ubtbcmfw_softc *sc = usb_fifo_softc(fifo);
struct usb_xfer *xfer;
if (fflags & FREAD)
xfer = sc->sc_xfer[UBTBCMFW_INTR_DT_RD];
else if (fflags & FWRITE)
xfer = sc->sc_xfer[UBTBCMFW_BULK_DT_WR];
else
return (EINVAL);
if (usb_fifo_alloc_buffer(fifo, usbd_xfer_max_len(xfer),
UBTBCMFW_IFQ_MAXLEN) != 0)
return (ENOMEM);
return (0);
}
static void
ubtbcmfw_close(struct usb_fifo *fifo, int fflags)
{
if (fflags & (FREAD | FWRITE))
usb_fifo_free_buffer(fifo);
}
static int
ubtbcmfw_ioctl(struct usb_fifo *fifo, u_long cmd, void *data,
int fflags)
{
struct ubtbcmfw_softc *sc = usb_fifo_softc(fifo);
int error = 0;
switch (cmd) {
case USB_GET_DEVICE_DESC:
memcpy(data, usbd_get_device_descriptor(sc->sc_udev),
sizeof(struct usb_device_descriptor));
break;
default:
error = EINVAL;
break;
}
return (error);
}