#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: ecc_plb.c,v 1.16 2021/02/27 20:43:58 rin Exp $");
#include "locators.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/cpu.h>
#include <prop/proplib.h>
#include <powerpc/ibm4xx/cpu.h>
#include <powerpc/ibm4xx/dcr4xx.h>
#include <powerpc/ibm4xx/dev/plbvar.h>
struct ecc_plb_softc {
device_t sc_dev;
uint64_t sc_ecc_tb;
uint64_t sc_ecc_iv;
uint32_t sc_ecc_cnt;
u_int sc_memsize;
int sc_irq;
};
static int ecc_plbmatch(device_t, cfdata_t, void *);
static void ecc_plbattach(device_t, device_t, void *);
static void ecc_plb_deferred(device_t);
static int ecc_plb_intr(void *);
CFATTACH_DECL_NEW(ecc_plb, sizeof(struct ecc_plb_softc),
ecc_plbmatch, ecc_plbattach, NULL, NULL);
static int ecc_plb_found;
static int
ecc_plbmatch(device_t parent, cfdata_t cf, void *aux)
{
struct plb_attach_args *paa = aux;
if (strcmp(paa->plb_name, cf->cf_name) != 0)
return (0);
if (cf->cf_loc[PLBCF_IRQ] == PLBCF_IRQ_DEFAULT)
panic("ecc_plbmatch: wildcard IRQ not allowed");
paa->plb_irq = cf->cf_loc[PLBCF_IRQ];
return (!ecc_plb_found);
}
static void
ecc_plbattach(device_t parent, device_t self, void *aux)
{
struct ecc_plb_softc *sc = device_private(self);
struct plb_attach_args *paa = aux;
unsigned int processor_freq;
unsigned int memsiz;
prop_number_t pn;
ecc_plb_found++;
pn = prop_dictionary_get(board_properties, "processor-frequency");
KASSERT(pn != NULL);
processor_freq = (unsigned int) prop_number_integer_value(pn);
pn = prop_dictionary_get(board_properties, "mem-size");
KASSERT(pn != NULL);
memsiz = (unsigned int) prop_number_integer_value(pn);
aprint_normal(": ECC controller\n");
sc->sc_dev = self;
sc->sc_ecc_tb = 0;
sc->sc_ecc_cnt = 0;
sc->sc_ecc_iv = processor_freq;
sc->sc_memsize = memsiz;
sc->sc_irq = paa->plb_irq;
config_defer(self, ecc_plb_deferred);
}
static void
ecc_plb_deferred(device_t self)
{
struct ecc_plb_softc *sc = device_private(self);
intr_establish_xname(sc->sc_irq, IST_LEVEL, IPL_SERIAL, ecc_plb_intr,
sc, device_xname(self));
}
static int
ecc_plb_intr(void *arg)
{
struct ecc_plb_softc *sc = arg;
u_int32_t esr, ear;
int ue;
u_quad_t tb;
u_long tmp, msr, dat;
mtdcr(DCR_SDRAM0_CFGADDR, DCR_SDRAM0_ECCESR);
esr = mfdcr(DCR_SDRAM0_CFGDATA);
mtdcr(DCR_SDRAM0_CFGADDR, DCR_SDRAM0_BEAR);
ear = mfdcr(DCR_SDRAM0_CFGDATA);
mtdcr(DCR_SDRAM0_CFGADDR, DCR_SDRAM0_ECCESR);
mtdcr(DCR_SDRAM0_CFGDATA, 0xffffffff);
if (esr == 0x00) {
return(1);
}
__asm ("1: mftbu %0; mftb %0+1; mftbu %1; cmpw %0,%1; bne 1b"
: "=r"(tb), "=r"(tmp));
sc->sc_ecc_cnt++;
if ((tb - sc->sc_ecc_tb) < sc->sc_ecc_iv)
return(1);
ue = (esr & SDRAM0_ECCESR_UE) != 0x00;
printf("ECC: Error CNT=%d ESR=%x EAR=%x %s BKNE=%d%d%d%d "
"BLCE=%d%d%d%d CBE=%d%d.\n",
sc->sc_ecc_cnt, esr, ear,
(ue) ? "Uncorrectable" : "Correctable",
((esr & SDRAM0_ECCESR_BKEN(0)) != 0x00),
((esr & SDRAM0_ECCESR_BKEN(1)) != 0x00),
((esr & SDRAM0_ECCESR_BKEN(2)) != 0x00),
((esr & SDRAM0_ECCESR_BKEN(3)) != 0x00),
((esr & SDRAM0_ECCESR_BLCEN(0)) != 0x00),
((esr & SDRAM0_ECCESR_BLCEN(1)) != 0x00),
((esr & SDRAM0_ECCESR_BLCEN(2)) != 0x00),
((esr & SDRAM0_ECCESR_BLCEN(3)) != 0x00),
((esr & SDRAM0_ECCESR_CBEN(0)) != 0x00),
((esr & SDRAM0_ECCESR_CBEN(1)) != 0x00));
if (sc->sc_ecc_cnt > 1000) {
printf("ECC: Too many errors, recycling entire "
"SDRAM (size = %d).\n", sc->sc_memsize);
__asm volatile(
"mfmsr %0;"
"li %1, 0x00;"
"ori %1, %1, 0x8010;"
"andc %1, %0, %1;"
"mtmsr %1;"
"sync;isync;"
"li %1, 0x00;"
"1:"
"dcbt 0, %1;"
"sync;isync;"
"lwz %2, 0(%1);"
"stw %2, 0(%1);"
"sync;isync;"
"dcbf 0, %1;"
"sync;isync;"
"addi %1, %1, 0x20;"
"addic. %3, %3, -0x20;"
"bge 1b;"
"mtmsr %0;"
"sync;isync;"
: "=&r" (msr), "=&r" (tmp), "=&r" (dat)
: "r" (sc->sc_memsize) : "0" );
mtdcr(DCR_SDRAM0_CFGADDR, DCR_SDRAM0_ECCESR);
esr = mfdcr(DCR_SDRAM0_CFGDATA);
mtdcr(DCR_SDRAM0_CFGADDR, DCR_SDRAM0_ECCESR);
mtdcr(DCR_SDRAM0_CFGDATA, 0xffffffff);
printf("ECC: Recycling complete, ESR=%x. "
"Checking for persistent errors.\n", esr);
__asm volatile(
"mfmsr %0;"
"li %1, 0x00;"
"ori %1, %1, 0x8010;"
"andc %1, %0, %1;"
"mtmsr %1;"
"sync;isync;"
"li %1, 0x00;"
"1:"
"dcbt 0, %1;"
"sync;isync;"
"lwz %2, 0(%1);"
"stw %2, 0(%1);"
"sync;isync;"
"dcbf 0, %1;"
"sync;isync;"
"addi %1, %1, 0x20;"
"addic. %3, %3, -0x20;"
"bge 1b;"
"mtmsr %0;"
"sync;isync;"
: "=&r" (msr), "=&r" (tmp), "=&r" (dat)
: "r" (sc->sc_memsize) : "0" );
mtdcr(DCR_SDRAM0_CFGADDR, DCR_SDRAM0_ECCESR);
esr = mfdcr(DCR_SDRAM0_CFGDATA);
printf("ECC: Persistent error check complete, "
"final ESR=%x.\n", esr);
}
sc->sc_ecc_tb = tb;
sc->sc_ecc_cnt = 0;
return(1);
}