NetBSD/sys/dev/ic/mc146818.c

221 lines
5.7 KiB
C

/* $NetBSD: mc146818.c,v 1.4 2003/11/24 06:20:40 tsutsui Exp $ */
/*
* Copyright (c) 2003 Izumi Tsutsui. All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. The name of the author may not be used to endorse or promote products
* derived from this software without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
* OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
* IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
* NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
* DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
* THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
* (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
* THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
*/
/*
* mc146818 and compatible time of day chip subroutines
*/
#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: mc146818.c,v 1.4 2003/11/24 06:20:40 tsutsui Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/errno.h>
#include <machine/bus.h>
#include <dev/clock_subr.h>
#include <dev/ic/mc146818reg.h>
#include <dev/ic/mc146818var.h>
int mc146818_gettime(todr_chip_handle_t, struct timeval *);
int mc146818_settime(todr_chip_handle_t, struct timeval *);
int mc146818_getcal(todr_chip_handle_t, int *);
int mc146818_setcal(todr_chip_handle_t, int);
void
mc146818_attach(sc)
struct mc146818_softc *sc;
{
todr_chip_handle_t handle;
#ifdef DIAGNOSTIC
if (sc->sc_mcread == NULL ||
sc->sc_mcwrite == NULL)
panic("mc146818_attach: invalid read/write functions");
#endif
printf(": mc146818 compatible time-of-day clock");
handle = &sc->sc_handle;
handle->cookie = sc;
handle->todr_gettime = mc146818_gettime;
handle->todr_settime = mc146818_settime;
handle->todr_getcal = mc146818_getcal;
handle->todr_setcal = mc146818_setcal;
handle->todr_setwen = NULL;
}
/*
* todr_gettime function:
* Get time of day and convert it to a struct timeval.
* Return 0 on success, an error number othersize.
*/
int
mc146818_gettime(handle, tv)
todr_chip_handle_t handle;
struct timeval *tv;
{
struct mc146818_softc *sc;
struct clock_ymdhms dt;
int s, timeout, cent, year;
sc = handle->cookie;
s = splclock(); /* XXX really needed? */
todr_wenable(handle, 1);
timeout = 1000000; /* XXX how long should we wait? */
for (;;) {
if ((*sc->sc_mcread)(sc, MC_REGA) & MC_REGA_UIP)
break;
if (--timeout < 0) {
printf("mc146818_gettime: timeout\n");
return EBUSY;
}
}
#define FROMREG(x) ((sc->sc_flag & MC146818_BCD) ? FROMBCD(x) : (x))
dt.dt_sec = FROMREG((*sc->sc_mcread)(sc, MC_SEC));
dt.dt_min = FROMREG((*sc->sc_mcread)(sc, MC_MIN));
dt.dt_hour = FROMREG((*sc->sc_mcread)(sc, MC_HOUR));
dt.dt_wday = FROMREG((*sc->sc_mcread)(sc, MC_DOW));
dt.dt_day = FROMREG((*sc->sc_mcread)(sc, MC_DOM));
dt.dt_mon = FROMREG((*sc->sc_mcread)(sc, MC_MONTH));
year = FROMREG((*sc->sc_mcread)(sc, MC_YEAR));
if (sc->sc_getcent) {
cent = (*sc->sc_getcent)(sc);
year += cent * 100;
}
#undef FROMREG
year += sc->sc_year0;
if (year < POSIX_BASE_YEAR &&
(sc->sc_flag & MC146818_NO_CENT_ADJUST) == 0)
year += 100;
dt.dt_year = year;
todr_wenable(handle, 0);
splx(s);
/* simple sanity checks */
if (dt.dt_mon > 12 || dt.dt_day > 31 ||
dt.dt_hour >= 24 || dt.dt_min >= 60 || dt.dt_sec >= 60)
return EIO;
tv->tv_sec = clock_ymdhms_to_secs(&dt);
tv->tv_usec = 0;
return 0;
}
/*
* todr_settime function:
* Set the time of day clock based on the value of the struct timeval arg.
* Return 0 on success, an error number othersize.
*/
int
mc146818_settime(handle, tv)
todr_chip_handle_t handle;
struct timeval *tv;
{
struct mc146818_softc *sc;
struct clock_ymdhms dt;
int s, timeout, cent, year;
sc = handle->cookie;
/* Note: we ignore `tv_usec' */
clock_secs_to_ymdhms(tv->tv_sec, &dt);
s = splclock(); /* XXX really needed? */
todr_wenable(handle, 1);
timeout = 1000000; /* XXX how long should we wait? */
for (;;) {
if ((*sc->sc_mcread)(sc, MC_REGA) & MC_REGA_UIP)
break;
if (--timeout < 0) {
printf("mc146818_settime: timeout\n");
return EBUSY;
}
}
#define TOREG(x) ((sc->sc_flag & MC146818_BCD) ? TOBCD(x) : (x))
(*sc->sc_mcwrite)(sc, MC_SEC, TOREG(dt.dt_sec));
(*sc->sc_mcwrite)(sc, MC_MIN, TOREG(dt.dt_min));
(*sc->sc_mcwrite)(sc, MC_HOUR, TOREG(dt.dt_hour));
(*sc->sc_mcwrite)(sc, MC_DOW, TOREG(dt.dt_wday));
(*sc->sc_mcwrite)(sc, MC_DOM, TOREG(dt.dt_day));
(*sc->sc_mcwrite)(sc, MC_MONTH, TOREG(dt.dt_mon));
year = dt.dt_year - sc->sc_year0;
if (sc->sc_setcent) {
cent = year / 100;
(*sc->sc_setcent)(sc, cent);
year -= cent * 100;
}
if (year > 99 &&
(sc->sc_flag & MC146818_NO_CENT_ADJUST) == 0)
year -= 100;
(*sc->sc_mcwrite)(sc, MC_YEAR, TOREG(year));
#undef TOREG
todr_wenable(handle, 0);
splx(s);
return 0;
}
int
mc146818_getcal(handle, vp)
todr_chip_handle_t handle;
int *vp;
{
return EOPNOTSUPP;
}
int
mc146818_setcal(handle, v)
todr_chip_handle_t handle;
int v;
{
return EOPNOTSUPP;
}