#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: sbtimer.c,v 1.21 2017/07/24 09:56:46 mrg Exp $");
#include <sys/param.h>
#include <sys/device.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/cpu.h>
#include <mips/locore.h>
#include <mips/sibyte/include/sb1250_regs.h>
#include <mips/sibyte/include/sb1250_scd.h>
#include <mips/sibyte/dev/sbscdvar.h>
#include <evbmips/sbmips/systemsw.h>
struct sbtimer_softc {
device_t sc_dev;
void *sc_intrhand;
int sc_flags;
void *sc_addr_icnt, *sc_addr_cnt, *sc_addr_cfg;
};
#define SBTIMER_CLOCK 1
#define SBTIMER_STATCLOCK 2
#define READ_REG(rp) mips3_ld((register_t)(rp))
#define WRITE_REG(rp, val) mips3_sd((register_t)(rp), (val))
static int sbtimer_match(device_t, cfdata_t, void *);
static void sbtimer_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(sbtimer, sizeof(struct sbtimer_softc),
sbtimer_match, sbtimer_attach, NULL, NULL);
static void sbtimer_clockintr(void *arg, uint32_t status, vaddr_t pc);
static void sbtimer_statclockintr(void *arg, uint32_t status, vaddr_t pc);
static void sbtimer_miscintr(void *arg, uint32_t status, vaddr_t pc);
static void sbtimer_clock_init(void *arg);
static int
sbtimer_match(device_t parent, cfdata_t match, void *aux)
{
struct sbscd_attach_args *sap = aux;
if (sap->sa_locs.sa_type != SBSCD_DEVTYPE_TIMER)
return (0);
return 1;
}
static void
sbtimer_attach(device_t parent, device_t self, void *aux)
{
struct sbscd_attach_args *sa = aux;
struct sbtimer_softc *sc = device_private(self);
void (*fun)(void *, uint32_t, vaddr_t);
int ipl;
const char *comment = "";
sc->sc_dev = self;
sc->sc_flags = device_cfdata(sc->sc_dev)->cf_flags;
sc->sc_addr_icnt = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_base +
sa->sa_locs.sa_offset + R_SCD_TIMER_INIT);
sc->sc_addr_cnt = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_base +
sa->sa_locs.sa_offset + R_SCD_TIMER_CNT);
sc->sc_addr_cfg = (uint64_t *)MIPS_PHYS_TO_KSEG1(sa->sa_base +
sa->sa_locs.sa_offset + R_SCD_TIMER_CFG);
aprint_normal(": ");
if ((sc->sc_flags & SBTIMER_CLOCK) != 0) {
ipl = IPL_CLOCK;
fun = sbtimer_clockintr;
if (system_set_clockfns(sc, sbtimer_clock_init)) {
sc->sc_flags &= ~SBTIMER_CLOCK;
comment = " (not system timer)";
goto not_really;
}
aprint_normal("system timer");
} else if ((sc->sc_flags & SBTIMER_STATCLOCK) != 0) {
ipl = IPL_HIGH;
fun = sbtimer_statclockintr;
if (1) {
sc->sc_flags &= ~SBTIMER_STATCLOCK;
comment = " (not system statistics timer)";
goto not_really;
}
aprint_normal("system statistics timer");
} else {
not_really:
ipl = IPL_BIO;
fun = sbtimer_miscintr;
aprint_normal("general-purpose timer%s", comment);
}
aprint_normal("\n");
WRITE_REG(sc->sc_addr_cfg, 0x00);
sc->sc_intrhand = cpu_intr_establish(sa->sa_locs.sa_intr[0], ipl,
fun, sc);
}
static void
sbtimer_clock_init(void *arg)
{
struct sbtimer_softc *sc = arg;
if ((1000000 % hz) == 0) {
aprint_normal_dev(sc->sc_dev, "%dHz system timer\n", hz);
} else {
aprint_error_dev(sc->sc_dev,
"cannot get %dHz clock; using 1000Hz\n", hz);
hz = 1000;
tick = 1000000 / hz;
}
WRITE_REG(sc->sc_addr_cfg, 0x00);
if (G_SYS_PLL_DIV(READ_REG(MIPS_PHYS_TO_KSEG1(A_SCD_SYSTEM_CFG))) == 0) {
aprint_debug_dev(sc->sc_dev,
"PLL_DIV == 0; speeding up clock ticks for simulator\n");
WRITE_REG(sc->sc_addr_icnt, (tick/100) - 1);
} else {
WRITE_REG(sc->sc_addr_icnt, tick - 1);
}
WRITE_REG(sc->sc_addr_cfg, 0x03);
}
static void
sbtimer_clockintr(void *arg, uint32_t status, vaddr_t pc)
{
struct sbtimer_softc *sc = arg;
struct clockframe cf;
WRITE_REG(sc->sc_addr_cfg, 0x03);
cf.pc = pc;
cf.sr = status;
cf.intr = (curcpu()->ci_idepth > 1);
hardclock(&cf);
mips3_cp0_compare_write(mips3_cp0_count_read() - 1);
}
static void
sbtimer_statclockintr(void *arg, uint32_t status, vaddr_t pc)
{
struct sbtimer_softc *sc = arg;
struct clockframe cf;
WRITE_REG(sc->sc_addr_cfg, 0x00);
cf.pc = pc;
cf.sr = status;
statclock(&cf);
}
static void
sbtimer_miscintr(void *arg, uint32_t status, vaddr_t pc)
{
struct sbtimer_softc *sc = arg;
WRITE_REG(sc->sc_addr_cfg, 0x00);
}