pmtimer.c revision 162954 
1/*-
2 * Copyright (c) 2000 Mitsuru IWASAKI <iwasaki@FreeBSD.org>
3 * All rights reserved.
4 *
5 * Redistribution and use in source and binary forms, with or without
6 * modification, are permitted provided that the following conditions
7 * are met:
8 * 1. Redistributions of source code must retain the above copyright
9 *    notice, this list of conditions and the following disclaimer.
10 * 2. Redistributions in binary form must reproduce the above copyright
11 *    notice, this list of conditions and the following disclaimer in the
12 *    documentation and/or other materials provided with the distribution.
13 *
14 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
15 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
16 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
17 * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
18 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
19 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
20 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
21 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
22 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
23 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
24 * SUCH DAMAGE.
25 */
26
27#include <sys/cdefs.h>
28__FBSDID("$FreeBSD: head/sys/i386/isa/pmtimer.c 162954 2006-10-02 12:59:59Z phk $");
29
30/*
31 * Timer device driver for power management events.
32 * The code for suspend/resume is derived from APM device driver.
33 */
34
35#include <sys/param.h>
36#include <sys/systm.h>
37#include <sys/bus.h>
38#include <sys/clock.h>
39#include <sys/kernel.h>
40#include <sys/module.h>
41#include <sys/syslog.h>
42#include <machine/clock.h>
43
44#include <isa/isavar.h>
45
46static devclass_t pmtimer_devclass;
47
48/* reject any PnP devices for now */
49static struct isa_pnp_id pmtimer_ids[] = {
50	{0}
51};
52
53static void
54pmtimer_identify(driver_t *driver, device_t parent)
55{
56	device_t child;
57
58	/*
59	 * Only add a child if one doesn't exist already.
60	 */
61	child = devclass_get_device(pmtimer_devclass, 0);
62	if (child == NULL) {
63		child = BUS_ADD_CHILD(parent, 0, "pmtimer", 0);
64		if (child == NULL)
65			panic("pmtimer_identify");
66	}
67}
68
69static int
70pmtimer_probe(device_t dev)
71{
72
73	if (ISA_PNP_PROBE(device_get_parent(dev), dev, pmtimer_ids) == ENXIO) {
74		return (ENXIO);
75	}
76
77	/* only one instance always */
78	return (device_get_unit(dev));
79}
80
81static struct timeval suspend_time;
82static struct timeval diff_time;
83
84static int
85pmtimer_suspend(device_t dev)
86{
87	int	pl;
88
89	pl = splsoftclock();
90	microtime(&diff_time);
91	inittodr(0);
92	microtime(&suspend_time);
93	timevalsub(&diff_time, &suspend_time);
94	splx(pl);
95	return (0);
96}
97
98static int
99pmtimer_resume(device_t dev)
100{
101	int pl;
102	u_int second, minute, hour;
103	struct timeval resume_time, tmp_time;
104
105	/* modified for adjkerntz */
106	pl = splsoftclock();
107	timer_restore();		/* restore the all timers */
108	inittodr(0);			/* adjust time to RTC */
109	microtime(&resume_time);
110	getmicrotime(&tmp_time);
111	timevaladd(&tmp_time, &diff_time);
112
113#ifdef FIXME
114	/* XXX THIS DOESN'T WORK!!! */
115	time = tmp_time;
116#endif
117
118#ifdef PMTIMER_FIXUP_CALLTODO
119	/* Calculate the delta time suspended */
120	timevalsub(&resume_time, &suspend_time);
121	/* Fixup the calltodo list with the delta time. */
122	adjust_timeout_calltodo(&resume_time);
123#endif /* PMTIMER_FIXUP_CALLTODOK */
124	splx(pl);
125#ifndef PMTIMER_FIXUP_CALLTODO
126	second = resume_time.tv_sec - suspend_time.tv_sec;
127#else /* PMTIMER_FIXUP_CALLTODO */
128	/*
129	 * We've already calculated resume_time to be the delta between
130	 * the suspend and the resume.
131	 */
132	second = resume_time.tv_sec;
133#endif /* PMTIMER_FIXUP_CALLTODO */
134	hour = second / 3600;
135	second %= 3600;
136	minute = second / 60;
137	second %= 60;
138	log(LOG_NOTICE, "wakeup from sleeping state (slept %02d:%02d:%02d)\n",
139		hour, minute, second);
140	return (0);
141}
142
143static device_method_t pmtimer_methods[] = {
144	/* Device interface */
145	DEVMETHOD(device_identify,	pmtimer_identify),
146	DEVMETHOD(device_probe,		pmtimer_probe),
147	DEVMETHOD(device_attach,	bus_generic_attach),
148	DEVMETHOD(device_suspend,	pmtimer_suspend),
149	DEVMETHOD(device_resume,	pmtimer_resume),
150	{ 0, 0 }
151};
152
153static driver_t pmtimer_driver = {
154	"pmtimer",
155	pmtimer_methods,
156	1,		/* no softc */
157};
158
159DRIVER_MODULE(pmtimer, isa, pmtimer_driver, pmtimer_devclass, 0, 0);
160