189 lines
4.3 KiB
C
189 lines
4.3 KiB
C
/* $NetBSD: mcclock.c,v 1.17 2005/12/11 12:21:20 christos Exp $ */
|
|
|
|
/*
|
|
* Copyright (c) 1994, 1995, 1996 Carnegie-Mellon University.
|
|
* All rights reserved.
|
|
*
|
|
* Author: Chris G. Demetriou
|
|
*
|
|
* Permission to use, copy, modify and distribute this software and
|
|
* its documentation is hereby granted, provided that both the copyright
|
|
* notice and this permission notice appear in all copies of the
|
|
* software, derivative works or modified versions, and any portions
|
|
* thereof, and that both notices appear in supporting documentation.
|
|
*
|
|
* CARNEGIE MELLON ALLOWS FREE USE OF THIS SOFTWARE IN ITS "AS IS"
|
|
* CONDITION. CARNEGIE MELLON DISCLAIMS ANY LIABILITY OF ANY KIND
|
|
* FOR ANY DAMAGES WHATSOEVER RESULTING FROM THE USE OF THIS SOFTWARE.
|
|
*
|
|
* Carnegie Mellon requests users of this software to return to
|
|
*
|
|
* Software Distribution Coordinator or Software.Distribution@CS.CMU.EDU
|
|
* School of Computer Science
|
|
* Carnegie Mellon University
|
|
* Pittsburgh PA 15213-3890
|
|
*
|
|
* any improvements or extensions that they make and grant Carnegie the
|
|
* rights to redistribute these changes.
|
|
*/
|
|
|
|
#include <sys/cdefs.h>
|
|
__KERNEL_RCSID(0, "$NetBSD: mcclock.c,v 1.17 2005/12/11 12:21:20 christos Exp $");
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <dev/dec/clockvar.h>
|
|
#include <dev/dec/mcclockvar.h>
|
|
#include <dev/ic/mc146818reg.h>
|
|
|
|
/*
|
|
* XXX default rate is machine-dependent.
|
|
*/
|
|
#ifdef __alpha__
|
|
#define MC_DFEAULTHZ 1024
|
|
#endif
|
|
#ifdef pmax
|
|
#define MC_DEFAULTHZ 256
|
|
#endif
|
|
|
|
|
|
void mcclock_init(struct device *);
|
|
void mcclock_get(struct device *, time_t, struct clocktime *);
|
|
void mcclock_set(struct device *, struct clocktime *);
|
|
|
|
const struct clockfns mcclock_clockfns = {
|
|
mcclock_init, 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");
|
|
|
|
sc->sc_busfns = busfns;
|
|
|
|
/* Turn interrupts off, just in case. */
|
|
mc146818_write(sc, MC_REGB, MC_REGB_BINARY | MC_REGB_24HR);
|
|
|
|
clockattach(&sc->sc_dev, &mcclock_clockfns);
|
|
}
|
|
|
|
void
|
|
mcclock_init(dev)
|
|
struct device *dev;
|
|
{
|
|
struct mcclock_softc *sc = (struct mcclock_softc *)dev;
|
|
int rate;
|
|
|
|
again:
|
|
switch (hz) {
|
|
case 32:
|
|
rate = MC_BASE_32_KHz | MC_RATE_32_Hz;
|
|
break;
|
|
case 64:
|
|
rate = MC_BASE_32_KHz | MC_RATE_64_Hz;
|
|
break;
|
|
case 128:
|
|
rate = MC_BASE_32_KHz | MC_RATE_128_Hz;
|
|
break;
|
|
case 256:
|
|
rate = MC_BASE_32_KHz | MC_RATE_256_Hz;
|
|
break;
|
|
case 512:
|
|
rate = MC_BASE_32_KHz | MC_RATE_512_Hz;
|
|
break;
|
|
case 1024:
|
|
rate = MC_BASE_32_KHz | MC_RATE_1024_Hz;
|
|
break;
|
|
case 2048:
|
|
rate = MC_BASE_32_KHz | MC_RATE_2048_Hz;
|
|
break;
|
|
case 4096:
|
|
rate = MC_BASE_32_KHz | MC_RATE_4096_Hz;
|
|
break;
|
|
case 8192:
|
|
rate = MC_BASE_32_KHz | MC_RATE_8192_Hz;
|
|
break;
|
|
case 16384:
|
|
rate = MC_BASE_4_MHz | MC_RATE_1;
|
|
break;
|
|
case 32768:
|
|
rate = MC_BASE_4_MHz | MC_RATE_2;
|
|
break;
|
|
default:
|
|
printf("%s: Cannot get %d Hz clock; using %d Hz\n",
|
|
sc->sc_dev.dv_xname, hz, MC_DEFAULTHZ);
|
|
hz = MC_DEFAULTHZ;
|
|
goto again;
|
|
}
|
|
mc146818_write(sc, MC_REGA, rate);
|
|
mc146818_write(sc, MC_REGB,
|
|
MC_REGB_PIE | MC_REGB_SQWE | MC_REGB_BINARY | MC_REGB_24HR);
|
|
}
|
|
|
|
/*
|
|
* Get the time of day, based on the clock's value and/or the base value.
|
|
*/
|
|
void
|
|
mcclock_get(dev, base, ct)
|
|
struct device *dev;
|
|
time_t base;
|
|
struct clocktime *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];
|
|
}
|
|
|
|
/*
|
|
* Reset the TODR based on the time value.
|
|
*/
|
|
void
|
|
mcclock_set(dev, ct)
|
|
struct device *dev;
|
|
struct clocktime *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;
|
|
|
|
s = splclock();
|
|
MC146818_PUTTOD(sc, ®s);
|
|
splx(s);
|
|
}
|