#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: mkclock_isa.c,v 1.15 2014/11/20 16:34:25 christos Exp $");
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/bus.h>
#include <dev/clock_subr.h>
#include <dev/ic/mk48txxreg.h>
#include <dev/ic/mk48txxvar.h>
#include <dev/isa/isavar.h>
#define MKCLOCK_STB0 0
#define MKCLOCK_STB1 1
#define MKCLOCK_DATA 3
#define MKCLOCK_NPORTS (MKCLOCK_DATA - MKCLOCK_STB0 + 1)
int mkclock_isa_match(device_t, cfdata_t, void *);
void mkclock_isa_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(mkclock_isa, sizeof(struct mk48txx_softc),
mkclock_isa_match, mkclock_isa_attach, NULL, NULL);
uint8_t mkclock_isa_nvrd(struct mk48txx_softc *, int);
void mkclock_isa_nvwr(struct mk48txx_softc *, int, uint8_t);
int
mkclock_isa_match(device_t parent, cfdata_t cf, void *aux)
{
struct isa_attach_args *ia = aux;
struct mk48txx_softc mk48txx, *sc;
uint8_t csr, ocsr;
unsigned int t1, t2;
int found;
found = 0;
if (ia->ia_nio < 1 ||
(ia->ia_io[0].ir_addr != ISA_UNKNOWN_PORT &&
ia->ia_io[0].ir_addr != 0x74))
return (0);
if (ia->ia_niomem > 0 &&
(ia->ia_iomem[0].ir_addr != ISA_UNKNOWN_IOMEM))
return (0);
if (ia->ia_nirq > 0 &&
(ia->ia_irq[0].ir_irq != ISA_UNKNOWN_IRQ))
return (0);
if (ia->ia_ndrq > 0 &&
(ia->ia_drq[0].ir_drq != ISA_UNKNOWN_DRQ))
return (0);
sc = &mk48txx;
sc->sc_bst = ia->ia_iot;
if (bus_space_map(sc->sc_bst, 0x74, MKCLOCK_NPORTS, 0, &sc->sc_bsh))
return (0);
ocsr = mkclock_isa_nvrd(sc, MK48T18_CLKOFF + MK48TXX_ICSR);
if (ocsr != 0)
goto unmap;
csr = ocsr | MK48TXX_CSR_READ;
mkclock_isa_nvwr(sc, MK48T18_CLKOFF + MK48TXX_ICSR, csr);
if (mkclock_isa_nvrd(sc, MK48T18_CLKOFF + MK48TXX_ICSR) != csr)
goto restore;
t1 = bcdtobin(mkclock_isa_nvrd(sc, MK48T18_CLKOFF + MK48TXX_ISEC));
if (t1 > 59)
goto restore;
mkclock_isa_nvwr(sc, MK48T18_CLKOFF + MK48TXX_ICSR, ocsr);
DELAY(1100000);
mkclock_isa_nvwr(sc, MK48T18_CLKOFF + MK48TXX_ICSR, csr);
t2 = bcdtobin(mkclock_isa_nvrd(sc, MK48T18_CLKOFF + MK48TXX_ISEC));
if (t2 > 59)
goto restore;
if ((t1 + 1) % 60 == t2 || (t1 + 2) % 60 == t2)
found = 1;
restore:
mkclock_isa_nvwr(sc, MK48T18_CLKOFF + MK48TXX_ICSR, ocsr);
unmap:
bus_space_unmap(sc->sc_bst, sc->sc_bsh, MKCLOCK_NPORTS);
if (found) {
ia->ia_nio = 1;
ia->ia_io[0].ir_addr = 0x74;
ia->ia_io[0].ir_size = MKCLOCK_NPORTS;
ia->ia_niomem = 0;
ia->ia_nirq = 0;
ia->ia_ndrq = 0;
}
return (found);
}
void
mkclock_isa_attach(device_t parent, device_t self, void *aux)
{
struct mk48txx_softc *sc = device_private(self);
struct isa_attach_args *ia = aux;
sc->sc_dev = self;
sc->sc_bst = ia->ia_iot;
if (bus_space_map(sc->sc_bst, ia->ia_io[0].ir_addr,
ia->ia_io[0].ir_size, 0, &sc->sc_bsh))
panic("mkclock_isa_attach: couldn't map clock I/O space");
sc->sc_model = "mk48t18";
sc->sc_year0 = 1968;
sc->sc_nvrd = mkclock_isa_nvrd;
sc->sc_nvwr = mkclock_isa_nvwr;
mk48txx_attach(sc);
aprint_normal(" Timekeeper NVRAM/RTC\n");
}
uint8_t
mkclock_isa_nvrd(struct mk48txx_softc *sc, int off)
{
bus_space_tag_t iot;
bus_space_handle_t ioh;
uint8_t datum;
int s;
iot = sc->sc_bst;
ioh = sc->sc_bsh;
s = splclock();
bus_space_write_1(iot, ioh, MKCLOCK_STB0, off & 0xff);
bus_space_write_1(iot, ioh, MKCLOCK_STB1, off >> 8);
datum = bus_space_read_1(iot, ioh, MKCLOCK_DATA);
splx(s);
return (datum);
}
void
mkclock_isa_nvwr(struct mk48txx_softc *sc, int off, uint8_t datum)
{
bus_space_tag_t iot;
bus_space_handle_t ioh;
int s;
iot = sc->sc_bst;
ioh = sc->sc_bsh;
s = splclock();
bus_space_write_1(iot, ioh, MKCLOCK_STB0, off & 0xff);
bus_space_write_1(iot, ioh, MKCLOCK_STB1, off >> 8);
bus_space_write_1(iot, ioh, MKCLOCK_DATA, datum);
splx(s);
}