NetBSD/sys/dev/ic/mc146818.c

188 lines
5.0 KiB
C

/* $NetBSD: mc146818.c,v 1.19 2014/11/20 16:34:26 christos 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.
*
* 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.19 2014/11/20 16:34:26 christos Exp $");
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/device.h>
#include <sys/errno.h>
#include <sys/bus.h>
#include <dev/clock_subr.h>
#include <dev/ic/mc146818reg.h>
#include <dev/ic/mc146818var.h>
int mc146818_gettime_ymdhms(todr_chip_handle_t, struct clock_ymdhms *);
int mc146818_settime_ymdhms(todr_chip_handle_t, struct clock_ymdhms *);
void
mc146818_attach(struct mc146818_softc *sc)
{
todr_chip_handle_t handle;
#ifdef DIAGNOSTIC
if (sc->sc_mcread == NULL ||
sc->sc_mcwrite == NULL)
panic("%s: invalid read/write functions", __func__);
#endif
aprint_normal(": mc146818 compatible time-of-day clock");
handle = &sc->sc_handle;
handle->cookie = sc;
handle->todr_gettime = NULL;
handle->todr_settime = NULL;
handle->todr_gettime_ymdhms = mc146818_gettime_ymdhms;
handle->todr_settime_ymdhms = mc146818_settime_ymdhms;
handle->todr_setwen = NULL;
todr_attach(handle);
}
/*
* 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_ymdhms(todr_chip_handle_t handle, struct clock_ymdhms *dt)
{
struct mc146818_softc *sc;
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) == 0)
break;
if (--timeout < 0) {
printf("%s: timeout\n", __func__);
return EBUSY;
}
}
#define FROMREG(x) ((sc->sc_flag & MC146818_BCD) ? bcdtobin(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);
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_ymdhms(todr_chip_handle_t handle, struct clock_ymdhms *dt)
{
struct mc146818_softc *sc;
int s, cent, year;
sc = handle->cookie;
s = splclock(); /* XXX really needed? */
todr_wenable(handle, 1);
/*
* Disable RTC updates during clock updates
*/
(*sc->sc_mcwrite)(sc, MC_REGB,
(*sc->sc_mcread)(sc, MC_REGB) | MC_REGB_SET);
#define TOREG(x) ((sc->sc_flag & MC146818_BCD) ? bintobcd(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
/*
* Re-enable RTC updates
*/
(*sc->sc_mcwrite)(sc, MC_REGB,
(*sc->sc_mcread)(sc, MC_REGB) & ~MC_REGB_SET);
todr_wenable(handle, 0);
splx(s);
return 0;
}