#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: j720ssp.c,v 1.34 2021/08/07 16:18:53 thorpej Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <arm/sa11x0/sa11x0_var.h>
#include <arm/sa11x0/sa11x0_gpioreg.h>
#include <arm/sa11x0/sa11x0_ppcreg.h>
#include <arm/sa11x0/sa11x0_sspreg.h>
#include <hpcarm/dev/j720sspvar.h>
#ifdef DEBUG
#define DPRINTF(arg) aprint_normal arg
#else
#define DPRINTF(arg)
#endif
#define BIT_INVERT(x) \
do { \
(x) = ((((x) & 0xf0) >> 4) | (((x) & 0x0f) << 4)); \
(x) = ((((x) & 0xcc) >> 2) | (((x) & 0x33) << 2)); \
(x) = ((((x) & 0xaa) >> 1) | (((x) & 0x55) << 1)); \
} while (0)
static int j720ssp_match(device_t, cfdata_t, void *);
static void j720ssp_attach(device_t, device_t, void *);
static int j720ssp_search(device_t, cfdata_t, const int *, void *);
static int j720ssp_print(void *, const char *);
CFATTACH_DECL_NEW(j720ssp, sizeof(struct j720ssp_softc),
j720ssp_match, j720ssp_attach, NULL, NULL);
static int
j720ssp_match(device_t parent, cfdata_t cf, void *aux)
{
if (strcmp(cf->cf_name, "j720ssp") != 0)
return 0;
return 1;
}
static void
j720ssp_attach(device_t parent, device_t self, void *aux)
{
struct j720ssp_softc *sc = device_private(self);
struct sa11x0_softc *psc = device_private(parent);
struct sa11x0_attach_args *sa = aux;
sc->sc_dev = self;
sc->sc_iot = psc->sc_iot;
sc->sc_gpioh = psc->sc_gpioh;
sc->sc_parent = psc;
if (bus_space_map(sc->sc_iot, sa->sa_addr, sa->sa_size, 0,
&sc->sc_ssph)) {
aprint_normal(": unable to map SSP registers\n");
return;
}
aprint_normal("\n");
config_search(self, NULL,
CFARGS(.search = j720ssp_search));
}
static int
j720ssp_search(device_t parent, cfdata_t cf, const int *ldesc, void *aux)
{
if (config_probe(parent, cf, NULL))
config_attach(parent, cf, NULL, j720ssp_print, CFARGS_NONE);
return 0;
}
static int
j720ssp_print(void *aux, const char *pnp)
{
return pnp ? QUIET : UNCONF;
}
int
j720ssp_readwrite(struct j720ssp_softc *sc, int drainfifo, int in,
int *out, int wait)
{
int timeout;
while (!(bus_space_read_4(sc->sc_iot, sc->sc_ssph, SASSP_SR) & SR_TNF))
continue;
timeout = 400000;
while (bus_space_read_4(sc->sc_iot, sc->sc_gpioh, SAGPIO_PLR) & 0x400)
if (--timeout == 0) {
DPRINTF(("j720ssp_readwrite: timeout 0\n"));
return -1;
}
if (drainfifo) {
while (bus_space_read_4(sc->sc_iot, sc->sc_ssph, SASSP_SR) &
SR_RNE)
bus_space_read_4(sc->sc_iot, sc->sc_ssph, SASSP_DR);
delay(wait);
}
BIT_INVERT(in);
bus_space_write_4(sc->sc_iot, sc->sc_ssph, SASSP_DR, in << 8);
delay(wait);
timeout = 100000;
while (!(bus_space_read_4(sc->sc_iot, sc->sc_ssph, SASSP_SR) & SR_RNE))
if (--timeout == 0) {
DPRINTF(("j720ssp_readwrite: timeout 1\n"));
return -1;
}
*out = bus_space_read_4(sc->sc_iot, sc->sc_ssph, SASSP_DR);
BIT_INVERT(*out);
return 0;
}