482 lines
13 KiB
C
482 lines
13 KiB
C
/*-
|
|
* Copyright (c) 2013 Oleksandr Tymoshenko <gonzo@freebsd.org>
|
|
*
|
|
* 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.
|
|
*
|
|
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR 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 AUTHOR 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.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__FBSDID("$FreeBSD$");
|
|
|
|
#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 <dev/fdt/fdt_common.h>
|
|
#include <dev/ofw/openfirm.h>
|
|
#include <dev/ofw/ofw_bus.h>
|
|
#include <dev/ofw/ofw_bus_subr.h>
|
|
|
|
#include <dev/usb/usb.h>
|
|
#include <dev/usb/usbdi.h>
|
|
|
|
#include <dev/usb/usb_core.h>
|
|
#include <dev/usb/usb_busdma.h>
|
|
#include <dev/usb/usb_process.h>
|
|
#include <dev/usb/usb_util.h>
|
|
|
|
#define USB_DEBUG_VAR usbssdebug
|
|
|
|
#include <dev/usb/usb_controller.h>
|
|
#include <dev/usb/usb_bus.h>
|
|
#include <dev/usb/controller/musb_otg.h>
|
|
#include <dev/usb/usb_debug.h>
|
|
|
|
#include <sys/rman.h>
|
|
|
|
#include <arm/ti/ti_prcm.h>
|
|
#include <arm/ti/ti_scm.h>
|
|
#include <arm/ti/am335x/am335x_scm.h>
|
|
|
|
#define AM335X_USB_PORTS 2
|
|
|
|
#define USBSS_REVREG 0x00
|
|
#define USBSS_SYSCONFIG 0x10
|
|
#define USBSS_SYSCONFIG_SRESET 1
|
|
|
|
#define USBCTRL_REV 0x00
|
|
#define USBCTRL_CTRL 0x14
|
|
#define USBCTRL_STAT 0x18
|
|
#define USBCTRL_IRQ_STAT0 0x30
|
|
#define IRQ_STAT0_RXSHIFT 16
|
|
#define IRQ_STAT0_TXSHIFT 0
|
|
#define USBCTRL_IRQ_STAT1 0x34
|
|
#define IRQ_STAT1_DRVVBUS (1 << 8)
|
|
#define USBCTRL_INTEN_SET0 0x38
|
|
#define USBCTRL_INTEN_SET1 0x3C
|
|
#define USBCTRL_INTEN_USB_ALL 0x1ff
|
|
#define USBCTRL_INTEN_USB_SOF (1 << 3)
|
|
#define USBCTRL_INTEN_CLR0 0x40
|
|
#define USBCTRL_INTEN_CLR1 0x44
|
|
#define USBCTRL_UTMI 0xE0
|
|
#define USBCTRL_UTMI_FSDATAEXT (1 << 1)
|
|
#define USBCTRL_MODE 0xE8
|
|
#define USBCTRL_MODE_IDDIG (1 << 8)
|
|
#define USBCTRL_MODE_IDDIGMUX (1 << 7)
|
|
|
|
/* USBSS resource + 2 MUSB ports */
|
|
|
|
#define RES_USBSS 0
|
|
#define RES_USBCTRL(i) (3*i+1)
|
|
#define RES_USBPHY(i) (3*i+2)
|
|
#define RES_USBCORE(i) (3*i+3)
|
|
|
|
#define USB_WRITE4(sc, idx, reg, val) do { \
|
|
bus_write_4((sc)->sc_mem_res[idx], (reg), (val)); \
|
|
} while (0)
|
|
|
|
#define USB_READ4(sc, idx, reg) bus_read_4((sc)->sc_mem_res[idx], (reg))
|
|
|
|
#define USBSS_WRITE4(sc, reg, val) \
|
|
USB_WRITE4((sc), RES_USBSS, (reg), (val))
|
|
#define USBSS_READ4(sc, reg) \
|
|
USB_READ4((sc), RES_USBSS, (reg))
|
|
#define USBCTRL_WRITE4(sc, unit, reg, val) \
|
|
USB_WRITE4((sc), RES_USBCTRL(unit), (reg), (val))
|
|
#define USBCTRL_READ4(sc, unit, reg) \
|
|
USB_READ4((sc), RES_USBCTRL(unit), (reg))
|
|
#define USBPHY_WRITE4(sc, unit, reg, val) \
|
|
USB_WRITE4((sc), RES_USBPHY(unit), (reg), (val))
|
|
#define USBPHY_READ4(sc, unit, reg) \
|
|
USB_READ4((sc), RES_USBPHY(unit), (reg))
|
|
|
|
static struct resource_spec am335x_musbotg_mem_spec[] = {
|
|
{ SYS_RES_MEMORY, 0, RF_ACTIVE },
|
|
{ SYS_RES_MEMORY, 1, RF_ACTIVE },
|
|
{ SYS_RES_MEMORY, 2, RF_ACTIVE },
|
|
{ SYS_RES_MEMORY, 3, RF_ACTIVE },
|
|
{ SYS_RES_MEMORY, 4, RF_ACTIVE },
|
|
{ SYS_RES_MEMORY, 5, RF_ACTIVE },
|
|
{ SYS_RES_MEMORY, 6, RF_ACTIVE },
|
|
{ -1, 0, 0 }
|
|
};
|
|
|
|
static struct resource_spec am335x_musbotg_irq_spec[] = {
|
|
{ SYS_RES_IRQ, 0, RF_ACTIVE },
|
|
{ SYS_RES_IRQ, 1, RF_ACTIVE },
|
|
{ SYS_RES_IRQ, 2, RF_ACTIVE },
|
|
{ -1, 0, 0 }
|
|
};
|
|
|
|
#ifdef USB_DEBUG
|
|
static int usbssdebug = 0;
|
|
|
|
static SYSCTL_NODE(_hw_usb, OID_AUTO, am335x_usbss, CTLFLAG_RW, 0, "AM335x USBSS");
|
|
SYSCTL_INT(_hw_usb_am335x_usbss, OID_AUTO, debug, CTLFLAG_RW,
|
|
&usbssdebug, 0, "Debug level");
|
|
#endif
|
|
|
|
static device_probe_t musbotg_probe;
|
|
static device_attach_t musbotg_attach;
|
|
static device_detach_t musbotg_detach;
|
|
|
|
struct musbotg_super_softc {
|
|
struct musbotg_softc sc_otg[AM335X_USB_PORTS];
|
|
struct resource *sc_mem_res[AM335X_USB_PORTS*3+1];
|
|
struct resource *sc_irq_res[AM335X_USB_PORTS+1];
|
|
void *sc_intr_hdl;
|
|
};
|
|
|
|
static void
|
|
musbotg_vbus_poll(struct musbotg_super_softc *sc, int port)
|
|
{
|
|
uint32_t stat;
|
|
|
|
if (sc->sc_otg[port].sc_mode == MUSB2_DEVICE_MODE)
|
|
musbotg_vbus_interrupt(&sc->sc_otg[port], 1);
|
|
else {
|
|
stat = USBCTRL_READ4(sc, port, USBCTRL_STAT);
|
|
musbotg_vbus_interrupt(&sc->sc_otg[port], stat & 1);
|
|
}
|
|
}
|
|
|
|
/*
|
|
* Arg to musbotg_clocks_on and musbot_clocks_off is
|
|
* a uint32_t * pointing to the SCM register offset.
|
|
*/
|
|
static uint32_t USB_CTRL[] = {SCM_USB_CTRL0, SCM_USB_CTRL1};
|
|
|
|
static void
|
|
musbotg_clocks_on(void *arg)
|
|
{
|
|
uint32_t c, reg = *(uint32_t *)arg;
|
|
|
|
ti_scm_reg_read_4(reg, &c);
|
|
c &= ~3; /* Enable power */
|
|
c |= 1 << 19; /* VBUS detect enable */
|
|
c |= 1 << 20; /* Session end enable */
|
|
ti_scm_reg_write_4(reg, c);
|
|
}
|
|
|
|
static void
|
|
musbotg_clocks_off(void *arg)
|
|
{
|
|
uint32_t c, reg = *(uint32_t *)arg;
|
|
|
|
/* Disable power to PHY */
|
|
ti_scm_reg_read_4(reg, &c);
|
|
ti_scm_reg_write_4(reg, c | 3);
|
|
}
|
|
|
|
static void
|
|
musbotg_ep_int_set(struct musbotg_softc *sc, int ep, int on)
|
|
{
|
|
struct musbotg_super_softc *ssc = sc->sc_platform_data;
|
|
uint32_t epmask;
|
|
|
|
epmask = ((1 << ep) << IRQ_STAT0_RXSHIFT);
|
|
epmask |= ((1 << ep) << IRQ_STAT0_TXSHIFT);
|
|
if (on)
|
|
USBCTRL_WRITE4(ssc, sc->sc_id,
|
|
USBCTRL_INTEN_SET0, epmask);
|
|
else
|
|
USBCTRL_WRITE4(ssc, sc->sc_id,
|
|
USBCTRL_INTEN_CLR0, epmask);
|
|
}
|
|
|
|
static void
|
|
musbotg_usbss_interrupt(void *arg)
|
|
{
|
|
panic("USBSS real interrupt");
|
|
}
|
|
|
|
static void
|
|
musbotg_wrapper_interrupt(void *arg)
|
|
{
|
|
struct musbotg_softc *sc = arg;
|
|
struct musbotg_super_softc *ssc = sc->sc_platform_data;
|
|
uint32_t stat, stat0, stat1;
|
|
stat = USBCTRL_READ4(ssc, sc->sc_id, USBCTRL_STAT);
|
|
stat0 = USBCTRL_READ4(ssc, sc->sc_id, USBCTRL_IRQ_STAT0);
|
|
stat1 = USBCTRL_READ4(ssc, sc->sc_id, USBCTRL_IRQ_STAT1);
|
|
if (stat0)
|
|
USBCTRL_WRITE4(ssc, sc->sc_id, USBCTRL_IRQ_STAT0, stat0);
|
|
if (stat1)
|
|
USBCTRL_WRITE4(ssc, sc->sc_id, USBCTRL_IRQ_STAT1, stat1);
|
|
|
|
DPRINTFN(4, "port%d: stat0=%08x stat1=%08x, stat=%08x\n",
|
|
sc->sc_id, stat0, stat1, stat);
|
|
|
|
if (stat1 & IRQ_STAT1_DRVVBUS)
|
|
musbotg_vbus_interrupt(sc, stat & 1);
|
|
|
|
musbotg_interrupt(arg, ((stat0 >> 16) & 0xffff),
|
|
stat0 & 0xffff, stat1 & 0xff);
|
|
}
|
|
|
|
static int
|
|
musbotg_probe(device_t dev)
|
|
{
|
|
if (!ofw_bus_is_compatible(dev, "ti,musb-am33xx"))
|
|
return (ENXIO);
|
|
|
|
device_set_desc(dev, "TI AM33xx integrated USB OTG controller");
|
|
|
|
return (BUS_PROBE_DEFAULT);
|
|
}
|
|
|
|
static int
|
|
musbotg_attach(device_t dev)
|
|
{
|
|
struct musbotg_super_softc *sc = device_get_softc(dev);
|
|
int err;
|
|
int i;
|
|
uint32_t rev, reg;
|
|
|
|
/* Request the memory resources */
|
|
err = bus_alloc_resources(dev, am335x_musbotg_mem_spec,
|
|
sc->sc_mem_res);
|
|
if (err) {
|
|
device_printf(dev,
|
|
"Error: could not allocate mem resources\n");
|
|
return (ENXIO);
|
|
}
|
|
|
|
/* Request the IRQ resources */
|
|
err = bus_alloc_resources(dev, am335x_musbotg_irq_spec,
|
|
sc->sc_irq_res);
|
|
if (err) {
|
|
device_printf(dev,
|
|
"Error: could not allocate irq resources\n");
|
|
return (ENXIO);
|
|
}
|
|
|
|
/*
|
|
* Reset USBSS, USB0 and USB1
|
|
*/
|
|
rev = USBSS_READ4(sc, USBSS_REVREG);
|
|
device_printf(dev, "TI AM335X USBSS v%d.%d.%d\n",
|
|
(rev >> 8) & 7, (rev >> 6) & 3, rev & 63);
|
|
|
|
ti_prcm_clk_enable(MUSB0_CLK);
|
|
|
|
USBSS_WRITE4(sc, USBSS_SYSCONFIG,
|
|
USBSS_SYSCONFIG_SRESET);
|
|
while (USBSS_READ4(sc, USBSS_SYSCONFIG) &
|
|
USBSS_SYSCONFIG_SRESET)
|
|
;
|
|
|
|
err = bus_setup_intr(dev, sc->sc_irq_res[0],
|
|
INTR_TYPE_BIO | INTR_MPSAFE,
|
|
NULL, (driver_intr_t *)musbotg_usbss_interrupt, sc,
|
|
&sc->sc_intr_hdl);
|
|
|
|
if (err) {
|
|
sc->sc_intr_hdl = NULL;
|
|
device_printf(dev, "Failed to setup USBSS interrupt\n");
|
|
goto error;
|
|
}
|
|
|
|
for (i = 0; i < AM335X_USB_PORTS; i++) {
|
|
/* setup MUSB OTG USB controller interface softc */
|
|
sc->sc_otg[i].sc_clocks_on = &musbotg_clocks_on;
|
|
sc->sc_otg[i].sc_clocks_off = &musbotg_clocks_off;
|
|
sc->sc_otg[i].sc_clocks_arg = &USB_CTRL[i];
|
|
|
|
sc->sc_otg[i].sc_ep_int_set = musbotg_ep_int_set;
|
|
|
|
/* initialise some bus fields */
|
|
sc->sc_otg[i].sc_bus.parent = dev;
|
|
sc->sc_otg[i].sc_bus.devices = sc->sc_otg[i].sc_devices;
|
|
sc->sc_otg[i].sc_bus.devices_max = MUSB2_MAX_DEVICES;
|
|
|
|
/* get all DMA memory */
|
|
if (usb_bus_mem_alloc_all(&sc->sc_otg[i].sc_bus,
|
|
USB_GET_DMA_TAG(dev), NULL)) {
|
|
device_printf(dev,
|
|
"Failed allocate bus mem for musb%d\n", i);
|
|
return (ENOMEM);
|
|
}
|
|
sc->sc_otg[i].sc_io_res = sc->sc_mem_res[RES_USBCORE(i)];
|
|
sc->sc_otg[i].sc_io_tag =
|
|
rman_get_bustag(sc->sc_otg[i].sc_io_res);
|
|
sc->sc_otg[i].sc_io_hdl =
|
|
rman_get_bushandle(sc->sc_otg[i].sc_io_res);
|
|
sc->sc_otg[i].sc_io_size =
|
|
rman_get_size(sc->sc_otg[i].sc_io_res);
|
|
|
|
sc->sc_otg[i].sc_irq_res = sc->sc_irq_res[i+1];
|
|
|
|
sc->sc_otg[i].sc_bus.bdev = device_add_child(dev, "usbus", -1);
|
|
if (!(sc->sc_otg[i].sc_bus.bdev)) {
|
|
device_printf(dev, "No busdev for musb%d\n", i);
|
|
goto error;
|
|
}
|
|
device_set_ivars(sc->sc_otg[i].sc_bus.bdev,
|
|
&sc->sc_otg[i].sc_bus);
|
|
|
|
err = bus_setup_intr(dev, sc->sc_otg[i].sc_irq_res,
|
|
INTR_TYPE_BIO | INTR_MPSAFE,
|
|
NULL, (driver_intr_t *)musbotg_wrapper_interrupt,
|
|
&sc->sc_otg[i], &sc->sc_otg[i].sc_intr_hdl);
|
|
if (err) {
|
|
sc->sc_otg[i].sc_intr_hdl = NULL;
|
|
device_printf(dev,
|
|
"Failed to setup interrupt for musb%d\n", i);
|
|
goto error;
|
|
}
|
|
|
|
sc->sc_otg[i].sc_id = i;
|
|
sc->sc_otg[i].sc_platform_data = sc;
|
|
if (i == 0)
|
|
sc->sc_otg[i].sc_mode = MUSB2_DEVICE_MODE;
|
|
else
|
|
sc->sc_otg[i].sc_mode = MUSB2_HOST_MODE;
|
|
|
|
/*
|
|
* software-controlled function
|
|
*/
|
|
|
|
if (sc->sc_otg[i].sc_mode == MUSB2_HOST_MODE) {
|
|
reg = USBCTRL_READ4(sc, i, USBCTRL_MODE);
|
|
reg |= USBCTRL_MODE_IDDIGMUX;
|
|
reg &= ~USBCTRL_MODE_IDDIG;
|
|
USBCTRL_WRITE4(sc, i, USBCTRL_MODE, reg);
|
|
USBCTRL_WRITE4(sc, i, USBCTRL_UTMI,
|
|
USBCTRL_UTMI_FSDATAEXT);
|
|
} else {
|
|
reg = USBCTRL_READ4(sc, i, USBCTRL_MODE);
|
|
reg |= USBCTRL_MODE_IDDIGMUX;
|
|
reg |= USBCTRL_MODE_IDDIG;
|
|
USBCTRL_WRITE4(sc, i, USBCTRL_MODE, reg);
|
|
}
|
|
|
|
reg = USBCTRL_INTEN_USB_ALL & ~USBCTRL_INTEN_USB_SOF;
|
|
USBCTRL_WRITE4(sc, i, USBCTRL_INTEN_SET1, reg);
|
|
USBCTRL_WRITE4(sc, i, USBCTRL_INTEN_CLR0, 0xffffffff);
|
|
|
|
err = musbotg_init(&sc->sc_otg[i]);
|
|
if (!err)
|
|
err = device_probe_and_attach(sc->sc_otg[i].sc_bus.bdev);
|
|
|
|
if (err)
|
|
goto error;
|
|
|
|
/* poll VBUS one time */
|
|
musbotg_vbus_poll(sc, i);
|
|
}
|
|
|
|
return (0);
|
|
|
|
error:
|
|
musbotg_detach(dev);
|
|
return (ENXIO);
|
|
}
|
|
|
|
static int
|
|
musbotg_detach(device_t dev)
|
|
{
|
|
struct musbotg_super_softc *sc = device_get_softc(dev);
|
|
device_t bdev;
|
|
int err;
|
|
int i;
|
|
|
|
for (i = 0; i < AM335X_USB_PORTS; i++) {
|
|
if (sc->sc_otg[i].sc_bus.bdev) {
|
|
bdev = sc->sc_otg[i].sc_bus.bdev;
|
|
device_detach(bdev);
|
|
device_delete_child(dev, bdev);
|
|
}
|
|
|
|
if (sc->sc_otg[i].sc_irq_res && sc->sc_otg[i].sc_intr_hdl) {
|
|
/*
|
|
* only call musbotg_uninit() after musbotg_init()
|
|
*/
|
|
musbotg_uninit(&sc->sc_otg[i]);
|
|
|
|
err = bus_teardown_intr(dev, sc->sc_otg[i].sc_irq_res,
|
|
sc->sc_otg[i].sc_intr_hdl);
|
|
sc->sc_otg[i].sc_intr_hdl = NULL;
|
|
}
|
|
|
|
usb_bus_mem_free_all(&sc->sc_otg[i].sc_bus, NULL);
|
|
}
|
|
|
|
if (sc->sc_intr_hdl) {
|
|
bus_teardown_intr(dev, sc->sc_irq_res[0],
|
|
sc->sc_intr_hdl);
|
|
sc->sc_intr_hdl = NULL;
|
|
}
|
|
|
|
|
|
/* Free resources if any */
|
|
if (sc->sc_mem_res[0])
|
|
bus_release_resources(dev, am335x_musbotg_mem_spec,
|
|
sc->sc_mem_res);
|
|
|
|
if (sc->sc_irq_res[0])
|
|
bus_release_resources(dev, am335x_musbotg_irq_spec,
|
|
sc->sc_irq_res);
|
|
|
|
/* during module unload there are lots of children leftover */
|
|
device_delete_children(dev);
|
|
|
|
return (0);
|
|
}
|
|
|
|
static device_method_t musbotg_methods[] = {
|
|
/* Device interface */
|
|
DEVMETHOD(device_probe, musbotg_probe),
|
|
DEVMETHOD(device_attach, musbotg_attach),
|
|
DEVMETHOD(device_detach, musbotg_detach),
|
|
DEVMETHOD(device_suspend, bus_generic_suspend),
|
|
DEVMETHOD(device_resume, bus_generic_resume),
|
|
DEVMETHOD(device_shutdown, bus_generic_shutdown),
|
|
|
|
DEVMETHOD_END
|
|
};
|
|
|
|
static driver_t musbotg_driver = {
|
|
.name = "musbotg",
|
|
.methods = musbotg_methods,
|
|
.size = sizeof(struct musbotg_super_softc),
|
|
};
|
|
|
|
static devclass_t musbotg_devclass;
|
|
|
|
DRIVER_MODULE(musbotg, simplebus, musbotg_driver, musbotg_devclass, 0, 0);
|
|
MODULE_DEPEND(musbotg, usb, 1, 1, 1);
|