#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ctl.c,v 1.4 2015/02/18 16:47:58 macallan Exp $");
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <machine/cpu.h>
#include <machine/locore.h>
#include <machine/autoconf.h>
#include <sys/bus.h>
#include <machine/machtype.h>
#include <machine/sysconf.h>
#include <sgimips/dev/ctlreg.h>
struct ctl_softc {
device_t sc_dev;
bus_space_tag_t iot;
bus_space_handle_t ioh;
};
static int ctl_match(device_t, cfdata_t, void *);
static void ctl_attach(device_t, device_t, void *);
static void ctl_bus_reset(void);
static void ctl_bus_error(vaddr_t, uint32_t, uint32_t);
static void ctl_watchdog_enable(void);
static void ctl_watchdog_disable(void);
static void ctl_watchdog_tickle(void);
#if defined(BLINK)
static callout_t ctl_blink_ch;
static void ctl_blink(void *);
#endif
CFATTACH_DECL_NEW(ctl, sizeof(struct ctl_softc),
ctl_match, ctl_attach, NULL, NULL);
static struct ctl_softc *csc;
static int
ctl_match(device_t parent, cfdata_t match, void *aux)
{
if (csc != NULL)
return 0;
if (mach_type == MACH_SGI_IP6 || mach_type == MACH_SGI_IP10)
return 1;
else
return 0;
}
static void
ctl_attach(device_t parent, device_t self, void *aux)
{
struct mainbus_attach_args *ma = aux;
struct ctl_softc * const sc = device_private(self);
#ifdef BLINK
callout_init(&ctl_blink_ch, 0);
#endif
sc->sc_dev = self;
csc = sc;
sc->iot = normal_memt;
if (bus_space_map(sc->iot, ma->ma_addr, 0x10000 ,
BUS_SPACE_MAP_LINEAR, &sc->ioh))
panic("ctl_attach: could not allocate memory\n");
platform.bus_reset = ctl_bus_reset;
platform.intr5 = ctl_bus_error;
platform.watchdog_enable = ctl_watchdog_enable;
platform.watchdog_disable = ctl_watchdog_disable;
platform.watchdog_reset = ctl_watchdog_tickle;
bus_space_write_2(sc->iot, sc->ioh, CTL_CPUCTRL,
(CTL_CPUCTRL_PARITY | CTL_CPUCTRL_SLAVE));
printf("\n");
ctl_bus_reset();
#if defined(BLINK)
ctl_blink(sc);
#endif
}
static void
ctl_bus_reset(void)
{
struct ctl_softc * const sc = csc;
bus_space_read_1(sc->iot, sc->ioh, CTL_LAN_PAR_CLR);
bus_space_read_1(sc->iot, sc->ioh, CTL_DMA_PAR_CLR);
bus_space_read_1(sc->iot, sc->ioh, CTL_CPU_PAR_CLR);
bus_space_read_1(sc->iot, sc->ioh, CTL_VME_PAR_CLR);
}
static void
ctl_bus_error(vaddr_t pc, uint32_t status, uint32_t ipending)
{
printf("ctl0: bus error\n");
ctl_bus_reset();
}
static void
ctl_watchdog_enable(void)
{
struct ctl_softc * const sc = csc;
uint32_t reg;
return;
reg = bus_space_read_2(sc->iot, sc->ioh, CTL_CPUCTRL);
reg |= CTL_CPUCTRL_WDOG;
bus_space_write_2(sc->iot, sc->ioh, CTL_CPUCTRL, reg);
}
static void
ctl_watchdog_disable(void)
{
struct ctl_softc * const sc = csc;
uint16_t reg;
return;
reg = bus_space_read_2(sc->iot, sc->ioh, CTL_CPUCTRL_WDOG);
reg &= ~(CTL_CPUCTRL_WDOG);
bus_space_write_2(sc->iot, sc->ioh, CTL_CPUCTRL, reg);
}
static void
ctl_watchdog_tickle(void)
{
ctl_watchdog_disable();
ctl_watchdog_enable();
}
#if defined(BLINK)
static void
ctl_blink(void *arg)
{
struct ctl_softc *sc = arg;
int s, value;
s = splhigh();
value = bus_space_read_1(sc->iot, sc->ioh, CTL_AUX_CPUCTRL);
value ^= CTL_AUX_CPUCTRL_CONSLED;
bus_space_write_1(sc->iot, sc->ioh, CTL_AUX_CPUCTRL, value);
splx(s);
int ticks = ((averunnable.ldavg[0] + FSCALE) * hz) >> (FSHIFT + 1);
callout_reset(&ctl_blink_ch, ticks, ctl_blink, sc);
}
#endif