#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <dev/clock_subr.h>
#include <dev/ic/mc146818reg.h>
#include <loongson/dev/mcclockvar.h>
struct cfdriver mcclock_cd = {
NULL, "mcclock", DV_DULL,
};
int mcclock_gettime(struct todr_chip_handle *, struct timeval *);
int mcclock_settime(struct todr_chip_handle *, struct timeval *);
#define mc146818_write(dev, reg, datum) \
(*(dev)->sc_busfns->mc_bf_write)(dev, reg, datum)
#define mc146818_read(dev, reg) \
(*(dev)->sc_busfns->mc_bf_read)(dev, reg)
void
mcclock_attach(struct mcclock_softc *sc, const struct mcclock_busfns *busfns)
{
printf(": mc146818 or compatible\n");
sc->sc_busfns = busfns;
mc146818_write(sc, MC_REGB, MC_REGB_BINARY | MC_REGB_24HR);
mc146818_write(sc, MC_REGA, MC_BASE_32_KHz | MC_RATE_NONE);
sc->sc_todr.cookie = sc;
sc->sc_todr.todr_gettime = mcclock_gettime;
sc->sc_todr.todr_settime = mcclock_settime;
sc->sc_todr.todr_quality = 0;
todr_attach(&sc->sc_todr);
}
int
mcclock_gettime(struct todr_chip_handle *handle, struct timeval *tv)
{
struct clock_ymdhms dt;
struct mcclock_softc *sc = handle->cookie;
mc_todregs regs;
int s;
s = splclock();
MC146818_GETTOD(sc, ®s)
splx(s);
dt.dt_sec = regs[MC_SEC];
dt.dt_min = regs[MC_MIN];
dt.dt_hour = regs[MC_HOUR];
dt.dt_day = regs[MC_DOM];
dt.dt_mon = regs[MC_MONTH];
dt.dt_year = regs[MC_YEAR] + 2000;
tv->tv_sec = clock_ymdhms_to_secs(&dt);
tv->tv_usec = 0;
return 0;
}
int
mcclock_settime(struct todr_chip_handle *handle, struct timeval *tv)
{
struct clock_ymdhms dt;
struct mcclock_softc *sc = handle->cookie;
mc_todregs regs;
int s;
clock_secs_to_ymdhms(tv->tv_sec, &dt);
s = splclock();
MC146818_GETTOD(sc, ®s);
splx(s);
regs[MC_SEC] = dt.dt_sec;
regs[MC_MIN] = dt.dt_min;
regs[MC_HOUR] = dt.dt_hour;
regs[MC_DOW] = dt.dt_wday + 1;
regs[MC_DOM] = dt.dt_day;
regs[MC_MONTH] = dt.dt_mon;
regs[MC_YEAR] = dt.dt_year % 100;
s = splclock();
MC146818_PUTTOD(sc, ®s);
splx(s);
return 0;
}