#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: dmac3.c,v 1.13 2009/12/14 00:46:09 matt Exp $");
#include <sys/param.h>
#include <sys/device.h>
#include <sys/kernel.h>
#include <sys/systm.h>
#include <uvm/uvm_extern.h>
#include <machine/locore.h>
#include <newsmips/apbus/apbusvar.h>
#include <newsmips/apbus/dmac3reg.h>
#include <newsmips/apbus/dmac3var.h>
#include <mips/cache.h>
#include "ioconf.h"
#define DMA_BURST
#define DMA_APAD_OFF
#ifdef DMA_APAD_OFF
# define APAD_MODE 0
#else
# define APAD_MODE DMAC3_CSR_APAD
#endif
#ifdef DMA_BURST
# define BURST_MODE (DMAC3_CSR_DBURST | DMAC3_CSR_MBURST)
#else
# define BURST_MODE 0
#endif
int dmac3_match(device_t, cfdata_t, void *);
void dmac3_attach(device_t, device_t, void *);
extern paddr_t kvtophys(vaddr_t);
CFATTACH_DECL_NEW(dmac, sizeof(struct dmac3_softc),
dmac3_match, dmac3_attach, NULL, NULL);
int
dmac3_match(device_t parent, cfdata_t cf, void *aux)
{
struct apbus_attach_args *apa = aux;
if (strcmp(apa->apa_name, "dmac3") == 0)
return 1;
return 0;
}
void
dmac3_attach(device_t parent, device_t self, void *aux)
{
struct dmac3_softc *sc = device_private(self);
struct apbus_attach_args *apa = aux;
struct dmac3reg *reg;
static paddr_t dmamap = DMAC3_PAGEMAP;
static vaddr_t dmaaddr = 0;
sc->sc_dev = self;
reg = (void *)apa->apa_hwbase;
sc->sc_reg = reg;
sc->sc_ctlnum = apa->apa_ctlnum;
sc->sc_dmamap = (uint32_t *)dmamap;
sc->sc_dmaaddr = dmaaddr;
dmamap += 0x1000;
dmaaddr += 0x200000;
sc->sc_conf = DMAC3_CONF_PCEN | DMAC3_CONF_DCEN | DMAC3_CONF_FASTACCESS;
dmac3_reset(sc);
aprint_normal(" slot%d addr 0x%lx", apa->apa_slotno, apa->apa_hwbase);
aprint_normal(": ctlnum = %d, map = %p, va = %#"PRIxVADDR,
apa->apa_ctlnum, sc->sc_dmamap, sc->sc_dmaaddr);
aprint_normal("\n");
}
struct dmac3_softc *
dmac3_link(int ctlnum)
{
struct dmac3_softc *sc;
int unit;
for (unit = 0; unit < dmac_cd.cd_ndevs; unit++) {
sc = device_lookup_private(&dmac_cd, unit);
if (sc == NULL)
continue;
if (sc->sc_ctlnum == ctlnum)
return sc;
}
return NULL;
}
void
dmac3_reset(struct dmac3_softc *sc)
{
struct dmac3reg *reg = sc->sc_reg;
reg->csr = DMAC3_CSR_RESET;
reg->csr = 0;
reg->intr = DMAC3_INTR_EOPIE | DMAC3_INTR_INTEN;
reg->conf = sc->sc_conf;
}
void
dmac3_start(struct dmac3_softc *sc, vaddr_t addr, int len, int direction)
{
struct dmac3reg *reg = sc->sc_reg;
paddr_t pa;
vaddr_t start, end, v;
volatile uint32_t *p;
if (reg->csr & DMAC3_CSR_ENABLE)
dmac3_reset(sc);
start = mips_trunc_page(addr);
end = mips_round_page(addr + len);
p = sc->sc_dmamap;
for (v = start; v < end; v += PAGE_SIZE) {
pa = kvtophys(v);
mips_dcache_wbinv_range(MIPS_PHYS_TO_KSEG0(pa), PAGE_SIZE);
*p++ = 0;
*p++ = (pa >> PGSHIFT) | 0xc0000000;
}
*p++ = 0;
*p++ = 0x003fffff;
addr &= PGOFSET;
addr += sc->sc_dmaaddr;
reg->len = len;
reg->addr = addr;
reg->intr = DMAC3_INTR_EOPIE | DMAC3_INTR_INTEN;
reg->csr = DMAC3_CSR_ENABLE | direction | BURST_MODE | APAD_MODE;
}
int
dmac3_intr(void *v)
{
struct dmac3_softc *sc = v;
struct dmac3reg *reg = sc->sc_reg;
int intr, conf, rv = 1;
intr = reg->intr;
if ((intr & DMAC3_INTR_INT) == 0)
return 0;
conf = reg->conf;
reg->conf = conf;
reg->intr = intr;
if (intr & DMAC3_INTR_PERR) {
printf("%s: intr = 0x%x\n", device_xname(sc->sc_dev), intr);
rv = -1;
}
if (conf & (DMAC3_CONF_IPER | DMAC3_CONF_MPER | DMAC3_CONF_DERR)) {
printf("%s: conf = 0x%x\n", device_xname(sc->sc_dev), conf);
if (conf & DMAC3_CONF_DERR) {
printf("DMA address = 0x%x\n", reg->addr);
printf("resetting DMA...\n");
dmac3_reset(sc);
}
}
return rv;
}
void
dmac3_misc(struct dmac3_softc *sc, int cmd)
{
struct dmac3reg *reg = sc->sc_reg;
int conf;
conf = DMAC3_CONF_PCEN | DMAC3_CONF_DCEN | cmd;
sc->sc_conf = conf;
reg->conf = conf;
}