123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129 |
- #include <sys/param.h>
- #include <sys/kernel.h>
- #include <sys/systm.h>
- #include <sys/device.h>
- #include <mips64/dev/clockvar.h>
- #include <loongson/dev/mcclockvar.h>
- #include <dev/ic/mc146818reg.h>
- struct cfdriver mcclock_cd = {
- NULL, "mcclock", DV_DULL,
- };
- void mcclock_get(void *, time_t, struct tod_time *);
- void mcclock_set(void *, struct tod_time *);
- struct tod_desc mcclock_clockfns = {
- NULL, mcclock_get, mcclock_set,
- };
- #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(sc, busfns)
- 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);
- sys_tod.tod_cookie = sc;
- sys_tod.tod_get = mcclock_get;
- sys_tod.tod_set = mcclock_set;
- }
- void
- mcclock_get(dev, base, ct)
- void *dev;
- time_t base;
- struct tod_time *ct;
- {
- struct mcclock_softc *sc = (struct mcclock_softc *)dev;
- mc_todregs regs;
- int s;
- s = splclock();
- MC146818_GETTOD(sc, ®s)
- splx(s);
- ct->sec = regs[MC_SEC];
- ct->min = regs[MC_MIN];
- ct->hour = regs[MC_HOUR];
- ct->dow = regs[MC_DOW];
- ct->day = regs[MC_DOM];
- ct->mon = regs[MC_MONTH];
- ct->year = regs[MC_YEAR] + 100;
- }
- void
- mcclock_set(dev, ct)
- void *dev;
- struct tod_time *ct;
- {
- struct mcclock_softc *sc = (struct mcclock_softc *)dev;
- mc_todregs regs;
- int s;
- s = splclock();
- MC146818_GETTOD(sc, ®s);
- splx(s);
- regs[MC_SEC] = ct->sec;
- regs[MC_MIN] = ct->min;
- regs[MC_HOUR] = ct->hour;
- regs[MC_DOW] = ct->dow;
- regs[MC_DOM] = ct->day;
- regs[MC_MONTH] = ct->mon;
- regs[MC_YEAR] = ct->year - 100;
- s = splclock();
- MC146818_PUTTOD(sc, ®s);
- splx(s);
- }
|