#include <sys/param.h>
#include <sys/systm.h>
#include <sys/bus.h>
#include <sys/kernel.h>
#include <sys/module.h>
#include <sys/malloc.h>
#include <sys/rman.h>
#include <sys/timeet.h>
#include <sys/timetc.h>
#include <sys/watchdog.h>
#include <dev/ofw/openfirm.h>
#include <dev/ofw/ofw_bus.h>
#include <dev/ofw/ofw_bus_subr.h>
#include <machine/bus.h>
#include <machine/cpu.h>
#include <machine/intr.h>
#include <arm/freescale/vybrid/vf_common.h>
#include <arm/freescale/vybrid/vf_dmamux.h>
#define DMAMUX_CHCFG(n) (0x1 * n)
#define CHCFG_ENBL (1 << 7)
#define CHCFG_TRIG (1 << 6)
#define CHCFG_SOURCE_MASK 0x3f
#define CHCFG_SOURCE_SHIFT 0
struct dmamux_softc {
struct resource *res[4];
bus_space_tag_t bst[4];
bus_space_handle_t bsh[4];
};
struct dmamux_softc *dmamux_sc;
static struct resource_spec dmamux_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 },
{ -1, 0 }
};
static int
dmamux_probe(device_t dev)
{
if (!ofw_bus_status_okay(dev))
return (ENXIO);
if (!ofw_bus_is_compatible(dev, "fsl,mvf600-dmamux"))
return (ENXIO);
device_set_desc(dev, "Vybrid Family Direct Memory Access Multiplexer");
return (BUS_PROBE_DEFAULT);
}
int
dmamux_configure(int mux, int source, int channel, int enable)
{
struct dmamux_softc *sc;
int reg;
sc = dmamux_sc;
MUX_WRITE1(sc, mux, DMAMUX_CHCFG(channel), 0x0);
reg = 0;
if (enable)
reg |= (CHCFG_ENBL);
reg &= ~(CHCFG_SOURCE_MASK << CHCFG_SOURCE_SHIFT);
reg |= (source << CHCFG_SOURCE_SHIFT);
MUX_WRITE1(sc, mux, DMAMUX_CHCFG(channel), reg);
return (0);
}
static int
dmamux_attach(device_t dev)
{
struct dmamux_softc *sc;
int i;
sc = device_get_softc(dev);
if (bus_alloc_resources(dev, dmamux_spec, sc->res)) {
device_printf(dev, "could not allocate resources\n");
return (ENXIO);
}
for (i = 0; i < 4; i++) {
sc->bst[i] = rman_get_bustag(sc->res[i]);
sc->bsh[i] = rman_get_bushandle(sc->res[i]);
}
dmamux_sc = sc;
return (0);
}
static device_method_t dmamux_methods[] = {
DEVMETHOD(device_probe, dmamux_probe),
DEVMETHOD(device_attach, dmamux_attach),
{ 0, 0 }
};
static driver_t dmamux_driver = {
"dmamux",
dmamux_methods,
sizeof(struct dmamux_softc),
};
DRIVER_MODULE(dmamux, simplebus, dmamux_driver, 0, 0);