sys/platform/pc32/isa/pmtimer.c

   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  * $DragonFly: src/sys/platform/pc32/isa/pmtimer.c,v 1.1 2003/09/24 03:32:17 drhodus Exp $
  26  */
  27
  28 #include <sys/cdefs.h>
  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/kernel.h>
  39 #include <sys/syslog.h>
  40 #include <machine/clock.h>
  41
  42 #include <bus/isa/isavar.h>
  43
  44 static devclass_t pmtimer_devclass;
  45
  46 /* reject any PnP devices for now */
  47 static struct isa_pnp_id pmtimer_ids[] = {
  48         {0}
  49 };
  50
  51 static void
  52 pmtimer_identify(driver_t *driver, device_t parent)
  53 {
  54         device_t child;
  55
  56         /*
  57          * Only add a child if one doesn't exist already.
  58          */
  59         child = devclass_get_device(pmtimer_devclass, 0);
  60         if (child == NULL) {
  61                 child = BUS_ADD_CHILD(parent, 0, "pmtimer", 0);
  62                 if (child == NULL)
  63                         panic("pmtimer_identify");
  64         }
  65 }
  66
  67 static int
  68 pmtimer_probe(device_t dev)
  69 {
  70
  71         if (ISA_PNP_PROBE(device_get_parent(dev), dev, pmtimer_ids) == ENXIO) {
  72                 return (ENXIO);
  73         }
  74
  75         /* only one instance always */
  76         return (device_get_unit(dev));
  77 }
  78
  79 static struct timeval suspend_time;
  80 static struct timeval diff_time;
  81
  82 static int
  83 pmtimer_suspend(device_t dev)
  84 {
  85         int     pl;
  86
  87         pl = splsoftclock();
  88         microtime(&diff_time);
  89         inittodr(0);
  90         microtime(&suspend_time);
  91         timevalsub(&diff_time, &suspend_time);
  92         splx(pl);
  93         return (0);
  94 }
  95
  96 static int
  97 pmtimer_resume(device_t dev)
  98 {
  99         int pl;
 100         u_int second, minute, hour;
 101         struct timeval resume_time, tmp_time;
 102
 103         /* modified for adjkerntz */
 104         pl = splsoftclock();
 105         timer_restore();                /* restore the all timers */
 106         inittodr(0);                    /* adjust time to RTC */
 107         microtime(&resume_time);
 108         getmicrotime(&tmp_time);
 109         timevaladd(&tmp_time, &diff_time);
 110
 111 #ifdef FIXME
 112         /* XXX THIS DOESN'T WORK!!! */
 113         time = tmp_time;
 114 #endif
 115
 116 #ifdef PMTIMER_FIXUP_CALLTODO
 117         /* Calculate the delta time suspended */
 118         timevalsub(&resume_time, &suspend_time);
 119         /* Fixup the calltodo list with the delta time. */
 120         adjust_timeout_calltodo(&resume_time);
 121 #endif /* PMTIMER_FIXUP_CALLTODOK */
 122         splx(pl);
 123 #ifndef PMTIMER_FIXUP_CALLTODO
 124         second = resume_time.tv_sec - suspend_time.tv_sec;
 125 #else /* PMTIMER_FIXUP_CALLTODO */
 126         /*
 127          * We've already calculated resume_time to be the delta between
 128          * the suspend and the resume.
 129          */
 130         second = resume_time.tv_sec;
 131 #endif /* PMTIMER_FIXUP_CALLTODO */
 132         hour = second / 3600;
 133         second %= 3600;
 134         minute = second / 60;
 135         second %= 60;
 136         log(LOG_NOTICE, "wakeup from sleeping state (slept %02d:%02d:%02d)\n",
 137                 hour, minute, second);
 138         return (0);
 139 }
 140
 141 static device_method_t pmtimer_methods[] = {
 142         /* Device interface */
 143         DEVMETHOD(device_identify,      pmtimer_identify),
 144         DEVMETHOD(device_probe,         pmtimer_probe),
 145         DEVMETHOD(device_attach,        bus_generic_attach),
 146         DEVMETHOD(device_suspend,       pmtimer_suspend),
 147         DEVMETHOD(device_resume,        pmtimer_resume),
 148         { 0, 0 }
 149 };
 150
 151 static driver_t pmtimer_driver = {
 152         "pmtimer",
 153         pmtimer_methods,
 154         1,              /* no softc */
 155 };
 156
 157 DRIVER_MODULE(pmtimer, isa, pmtimer_driver, pmtimer_devclass, 0, 0);