pmtimer.c revision 105730
165865Siwasaki/*-
265865Siwasaki * Copyright (c) 2000 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
365865Siwasaki * All rights reserved.
465865Siwasaki *
565865Siwasaki * Redistribution and use in source and binary forms, with or without
665865Siwasaki * modification, are permitted provided that the following conditions
765865Siwasaki * are met:
865865Siwasaki * 1. Redistributions of source code must retain the above copyright
965865Siwasaki *    notice, this list of conditions and the following disclaimer.
1065865Siwasaki * 2. Redistributions in binary form must reproduce the above copyright
1165865Siwasaki *    notice, this list of conditions and the following disclaimer in the
1265865Siwasaki *    documentation and/or other materials provided with the distribution.
1365865Siwasaki *
1465865Siwasaki * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
1565865Siwasaki * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
1665865Siwasaki * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
1765865Siwasaki * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
1865865Siwasaki * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
1965865Siwasaki * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
2065865Siwasaki * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
2165865Siwasaki * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
2265865Siwasaki * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
2365865Siwasaki * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
2465865Siwasaki * SUCH DAMAGE.
2565865Siwasaki *
2665865Siwasaki *	$FreeBSD: head/sys/i386/isa/pmtimer.c 105730 2002-10-22 17:30:52Z jhb $
2765865Siwasaki */
2865865Siwasaki
2965865Siwasaki/*
3065865Siwasaki * Timer device driver for power management events.
3165865Siwasaki * The code for suspend/resume is derived from APM device driver.
3265865Siwasaki */
3365865Siwasaki
3465865Siwasaki#include <sys/param.h>
3565865Siwasaki#include <sys/systm.h>
3665865Siwasaki#include <sys/bus.h>
3765865Siwasaki#include <sys/kernel.h>
3865865Siwasaki#include <sys/syslog.h>
3965865Siwasaki#include <machine/clock.h>
4065865Siwasaki
4165865Siwasaki#include <isa/isavar.h>
4265865Siwasaki
43105730Sjhbstatic devclass_t pmtimer_devclass;
44105730Sjhb
4565865Siwasaki/* reject any PnP devices for now */
4665865Siwasakistatic struct isa_pnp_id pmtimer_ids[] = {
4765865Siwasaki	{0}
4865865Siwasaki};
4965865Siwasaki
50105730Sjhbstatic void
51105730Sjhbpmtimer_identify(driver_t *driver, device_t parent)
52105730Sjhb{
53105730Sjhb	device_t child;
54105730Sjhb
55105730Sjhb	/*
56105730Sjhb	 * Only add a child if one doesn't exist already.
57105730Sjhb	 */
58105730Sjhb	child = devclass_get_device(pmtimer_devclass, 0);
59105730Sjhb	if (child == NULL) {
60105730Sjhb		child = BUS_ADD_CHILD(parent, 0, "pmtimer", 0);
61105730Sjhb		if (child == NULL)
62105730Sjhb			panic("pmtimer_identify");
63105730Sjhb	}
64105730Sjhb}
65105730Sjhb
6665865Siwasakistatic int
6765865Siwasakipmtimer_probe(device_t dev)
6865865Siwasaki{
6965865Siwasaki
7065865Siwasaki	if (ISA_PNP_PROBE(device_get_parent(dev), dev, pmtimer_ids) == ENXIO) {
7165865Siwasaki		return (ENXIO);
7265865Siwasaki	}
7365865Siwasaki
7465865Siwasaki	/* only one instance always */
7565865Siwasaki	return (device_get_unit(dev));
7665865Siwasaki}
7765865Siwasaki
7865865Siwasakistatic struct timeval suspend_time;
7965865Siwasakistatic struct timeval diff_time;
8065865Siwasaki
8165865Siwasakistatic int
8265865Siwasakipmtimer_suspend(device_t dev)
8365865Siwasaki{
8465865Siwasaki	int	pl;
8565865Siwasaki
8665865Siwasaki	pl = splsoftclock();
8765865Siwasaki	microtime(&diff_time);
8865865Siwasaki	inittodr(0);
8965865Siwasaki	microtime(&suspend_time);
9065865Siwasaki	timevalsub(&diff_time, &suspend_time);
9165865Siwasaki	splx(pl);
9265865Siwasaki	return (0);
9365865Siwasaki}
9465865Siwasaki
9565865Siwasakistatic int
9665865Siwasakipmtimer_resume(device_t dev)
9765865Siwasaki{
9865865Siwasaki	int pl;
9965865Siwasaki	u_int second, minute, hour;
10065865Siwasaki	struct timeval resume_time, tmp_time;
10165865Siwasaki
10265865Siwasaki	/* modified for adjkerntz */
10365865Siwasaki	pl = splsoftclock();
10482971Siwasaki	timer_restore();		/* restore the all timers */
10565865Siwasaki	inittodr(0);			/* adjust time to RTC */
10665865Siwasaki	microtime(&resume_time);
10765865Siwasaki	getmicrotime(&tmp_time);
10865865Siwasaki	timevaladd(&tmp_time, &diff_time);
10965865Siwasaki
11065865Siwasaki#ifdef FIXME
11165865Siwasaki	/* XXX THIS DOESN'T WORK!!! */
11265865Siwasaki	time = tmp_time;
11365865Siwasaki#endif
11465865Siwasaki
11565865Siwasaki#ifdef PMTIMER_FIXUP_CALLTODO
11665865Siwasaki	/* Calculate the delta time suspended */
11765865Siwasaki	timevalsub(&resume_time, &suspend_time);
11865865Siwasaki	/* Fixup the calltodo list with the delta time. */
11965865Siwasaki	adjust_timeout_calltodo(&resume_time);
12065865Siwasaki#endif /* PMTIMER_FIXUP_CALLTODOK */
12165865Siwasaki	splx(pl);
12265865Siwasaki#ifndef PMTIMER_FIXUP_CALLTODO
12365865Siwasaki	second = resume_time.tv_sec - suspend_time.tv_sec;
12465865Siwasaki#else /* PMTIMER_FIXUP_CALLTODO */
12565865Siwasaki	/*
12665865Siwasaki	 * We've already calculated resume_time to be the delta between
12765865Siwasaki	 * the suspend and the resume.
12865865Siwasaki	 */
12965865Siwasaki	second = resume_time.tv_sec;
13065865Siwasaki#endif /* PMTIMER_FIXUP_CALLTODO */
13165865Siwasaki	hour = second / 3600;
13265865Siwasaki	second %= 3600;
13365865Siwasaki	minute = second / 60;
13465865Siwasaki	second %= 60;
13565865Siwasaki	log(LOG_NOTICE, "wakeup from sleeping state (slept %02d:%02d:%02d)\n",
13665865Siwasaki		hour, minute, second);
13765865Siwasaki	return (0);
13865865Siwasaki}
13965865Siwasaki
14065865Siwasakistatic device_method_t pmtimer_methods[] = {
14165865Siwasaki	/* Device interface */
142105730Sjhb	DEVMETHOD(device_identify,	pmtimer_identify),
14365865Siwasaki	DEVMETHOD(device_probe,		pmtimer_probe),
14465865Siwasaki	DEVMETHOD(device_attach,	bus_generic_attach),
14565865Siwasaki	DEVMETHOD(device_suspend,	pmtimer_suspend),
14665865Siwasaki	DEVMETHOD(device_resume,	pmtimer_resume),
14765865Siwasaki	{ 0, 0 }
14865865Siwasaki};
14965865Siwasaki
15065865Siwasakistatic driver_t pmtimer_driver = {
15165865Siwasaki	"pmtimer",
15265865Siwasaki	pmtimer_methods,
15365865Siwasaki	1,		/* no softc */
15465865Siwasaki};
15565865Siwasaki
15665865SiwasakiDRIVER_MODULE(pmtimer, isa, pmtimer_driver, pmtimer_devclass, 0, 0);
157