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