Author: jkim
Date: Sun Sep 27 14:00:16 2009
New Revision: 197536
URL: http://svn.freebsd.org/changeset/base/197536

Log:
  Copy apm(4) emulation from sys/i386/acpica/acpi_machdep.c and
  install apm(8) and apm_bios.h on amd64.

Added:
  head/sys/amd64/include/apm_bios.h
     - copied, changed from r197533, head/sys/i386/include/apm_bios.h
Modified:
  head/sys/amd64/acpica/acpi_machdep.c
  head/sys/dev/acpica/acpi.c
  head/sys/i386/include/apm_bios.h
  head/usr.sbin/Makefile
  head/usr.sbin/apm/Makefile

Modified: head/sys/amd64/acpica/acpi_machdep.c
==============================================================================
--- head/sys/amd64/acpica/acpi_machdep.c        Sun Sep 27 13:24:34 2009        
(r197535)
+++ head/sys/amd64/acpica/acpi_machdep.c        Sun Sep 27 14:00:16 2009        
(r197536)
@@ -43,6 +43,24 @@ __FBSDID("$FreeBSD$");
 
 #include <machine/nexusvar.h>
 
+/*
+ * APM driver emulation 
+ */
+
+#include <sys/condvar.h>
+#include <sys/conf.h>
+#include <sys/fcntl.h>
+#include <sys/malloc.h>
+#include <sys/poll.h>
+#include <sys/uio.h>
+
+#include <dev/acpica/acpiio.h>
+
+#include <machine/apm_bios.h>
+#include <i386/include/pc/bios.h>
+
+#include <i386/bios/apm.h>
+
 SYSCTL_DECL(_debug_acpi);
 
 int acpi_resume_beep;
@@ -54,7 +72,432 @@ int acpi_reset_video;
 TUNABLE_INT("hw.acpi.reset_video", &acpi_reset_video);
 
 static int intr_model = ACPI_INTR_PIC;
-static struct apm_clone_data acpi_clone;
+static int apm_active;
+static struct clonedevs *apm_clones;
+
+MALLOC_DEFINE(M_APMDEV, "apmdev", "APM device emulation");
+
+static d_open_t                apmopen;
+static d_close_t       apmclose;
+static d_write_t       apmwrite;
+static d_ioctl_t       apmioctl;
+static d_poll_t                apmpoll;
+static d_kqfilter_t    apmkqfilter;
+static void            apmreadfiltdetach(struct knote *kn);
+static int             apmreadfilt(struct knote *kn, long hint);
+static struct filterops        apm_readfiltops = {
+       .f_isfd = 1,
+       .f_detach = apmreadfiltdetach,
+       .f_event = apmreadfilt,
+};
+
+static struct cdevsw apm_cdevsw = {
+       .d_version =    D_VERSION,
+       .d_flags =      D_TRACKCLOSE | D_NEEDMINOR,
+       .d_open =       apmopen,
+       .d_close =      apmclose,
+       .d_write =      apmwrite,
+       .d_ioctl =      apmioctl,
+       .d_poll =       apmpoll,
+       .d_name =       "apm",
+       .d_kqfilter =   apmkqfilter
+};
+
+static int
+acpi_capm_convert_battstate(struct  acpi_battinfo *battp)
+{
+       int     state;
+
+       state = APM_UNKNOWN;
+
+       if (battp->state & ACPI_BATT_STAT_DISCHARG) {
+               if (battp->cap >= 50)
+                       state = 0;      /* high */
+               else
+                       state = 1;      /* low */
+       }
+       if (battp->state & ACPI_BATT_STAT_CRITICAL)
+               state = 2;              /* critical */
+       if (battp->state & ACPI_BATT_STAT_CHARGING)
+               state = 3;              /* charging */
+
+       /* If still unknown, determine it based on the battery capacity. */
+       if (state == APM_UNKNOWN) {
+               if (battp->cap >= 50)
+                       state = 0;      /* high */
+               else
+                       state = 1;      /* low */
+       }
+
+       return (state);
+}
+
+static int
+acpi_capm_convert_battflags(struct  acpi_battinfo *battp)
+{
+       int     flags;
+
+       flags = 0;
+
+       if (battp->cap >= 50)
+               flags |= APM_BATT_HIGH;
+       else {
+               if (battp->state & ACPI_BATT_STAT_CRITICAL)
+                       flags |= APM_BATT_CRITICAL;
+               else
+                       flags |= APM_BATT_LOW;
+       }
+       if (battp->state & ACPI_BATT_STAT_CHARGING)
+               flags |= APM_BATT_CHARGING;
+       if (battp->state == ACPI_BATT_STAT_NOT_PRESENT)
+               flags = APM_BATT_NOT_PRESENT;
+
+       return (flags);
+}
+
+static int
+acpi_capm_get_info(apm_info_t aip)
+{
+       int     acline;
+       struct  acpi_battinfo batt;
+
+       aip->ai_infoversion = 1;
+       aip->ai_major       = 1;
+       aip->ai_minor       = 2;
+       aip->ai_status      = apm_active;
+       aip->ai_capabilities= 0xff00;   /* unknown */
+
+       if (acpi_acad_get_acline(&acline))
+               aip->ai_acline = APM_UNKNOWN;   /* unknown */
+       else
+               aip->ai_acline = acline;        /* on/off */
+
+       if (acpi_battery_get_battinfo(NULL, &batt) != 0) {
+               aip->ai_batt_stat = APM_UNKNOWN;
+               aip->ai_batt_life = APM_UNKNOWN;
+               aip->ai_batt_time = -1;          /* unknown */
+               aip->ai_batteries = ~0U;         /* unknown */
+       } else {
+               aip->ai_batt_stat = acpi_capm_convert_battstate(&batt);
+               aip->ai_batt_life = batt.cap;
+               aip->ai_batt_time = (batt.min == -1) ? -1 : batt.min * 60;
+               aip->ai_batteries = acpi_battery_get_units();
+       }
+
+       return (0);
+}
+
+static int
+acpi_capm_get_pwstatus(apm_pwstatus_t app)
+{
+       device_t dev;
+       int     acline, unit, error;
+       struct  acpi_battinfo batt;
+
+       if (app->ap_device != PMDV_ALLDEV &&
+           (app->ap_device < PMDV_BATT0 || app->ap_device > PMDV_BATT_ALL))
+               return (1);
+
+       if (app->ap_device == PMDV_ALLDEV)
+               error = acpi_battery_get_battinfo(NULL, &batt);
+       else {
+               unit = app->ap_device - PMDV_BATT0;
+               dev = devclass_get_device(devclass_find("battery"), unit);
+               if (dev != NULL)
+                       error = acpi_battery_get_battinfo(dev, &batt);
+               else
+                       error = ENXIO;
+       }
+       if (error)
+               return (1);
+
+       app->ap_batt_stat = acpi_capm_convert_battstate(&batt);
+       app->ap_batt_flag = acpi_capm_convert_battflags(&batt);
+       app->ap_batt_life = batt.cap;
+       app->ap_batt_time = (batt.min == -1) ? -1 : batt.min * 60;
+
+       if (acpi_acad_get_acline(&acline))
+               app->ap_acline = APM_UNKNOWN;
+       else
+               app->ap_acline = acline;        /* on/off */
+
+       return (0);
+}
+
+/* Create single-use devices for /dev/apm and /dev/apmctl. */
+static void
+apm_clone(void *arg, struct ucred *cred, char *name, int namelen,
+    struct cdev **dev)
+{
+       int ctl_dev, unit;
+
+       if (*dev != NULL)
+               return;
+       if (strcmp(name, "apmctl") == 0)
+               ctl_dev = TRUE;
+       else if (strcmp(name, "apm") == 0)
+               ctl_dev = FALSE;
+       else
+               return;
+
+       /* Always create a new device and unit number. */
+       unit = -1;
+       if (clone_create(&apm_clones, &apm_cdevsw, &unit, dev, 0)) {
+               if (ctl_dev) {
+                       *dev = make_dev(&apm_cdevsw, unit,
+                           UID_ROOT, GID_OPERATOR, 0660, "apmctl%d", unit);
+               } else {
+                       *dev = make_dev(&apm_cdevsw, unit,
+                           UID_ROOT, GID_OPERATOR, 0664, "apm%d", unit);
+               }
+               if (*dev != NULL) {
+                       dev_ref(*dev);
+                       (*dev)->si_flags |= SI_CHEAPCLONE;
+               }
+       }
+}
+
+/* Create a struct for tracking per-device suspend notification. */
+static struct apm_clone_data *
+apm_create_clone(struct cdev *dev, struct acpi_softc *acpi_sc)
+{
+       struct apm_clone_data *clone;
+
+       clone = malloc(sizeof(*clone), M_APMDEV, M_WAITOK);
+       clone->cdev = dev;
+       clone->acpi_sc = acpi_sc;
+       clone->notify_status = APM_EV_NONE;
+       bzero(&clone->sel_read, sizeof(clone->sel_read));
+       knlist_init_mtx(&clone->sel_read.si_note, &acpi_mutex);
+
+       /*
+        * The acpi device is always managed by devd(8) and is considered
+        * writable (i.e., ack is required to allow suspend to proceed.)
+        */
+       if (strcmp("acpi", devtoname(dev)) == 0)
+               clone->flags = ACPI_EVF_DEVD | ACPI_EVF_WRITE;
+       else
+               clone->flags = ACPI_EVF_NONE;
+
+       ACPI_LOCK(acpi);
+       STAILQ_INSERT_TAIL(&acpi_sc->apm_cdevs, clone, entries);
+       ACPI_UNLOCK(acpi);
+       return (clone);
+}
+
+static int
+apmopen(struct cdev *dev, int flag, int fmt, struct thread *td)
+{
+       struct  acpi_softc *acpi_sc;
+       struct  apm_clone_data *clone;
+
+       acpi_sc = devclass_get_softc(devclass_find("acpi"), 0);
+       clone = apm_create_clone(dev, acpi_sc);
+       dev->si_drv1 = clone;
+
+       /* If the device is opened for write, record that. */
+       if ((flag & FWRITE) != 0)
+               clone->flags |= ACPI_EVF_WRITE;
+
+       return (0);
+}
+
+static int
+apmclose(struct cdev *dev, int flag, int fmt, struct thread *td)
+{
+       struct  apm_clone_data *clone;
+       struct  acpi_softc *acpi_sc;
+
+       clone = dev->si_drv1;
+       acpi_sc = clone->acpi_sc;
+
+       /* We are about to lose a reference so check if suspend should occur */
+       if (acpi_sc->acpi_next_sstate != 0 &&
+           clone->notify_status != APM_EV_ACKED)
+               acpi_AckSleepState(clone, 0);
+
+       /* Remove this clone's data from the list and free it. */
+       ACPI_LOCK(acpi);
+       STAILQ_REMOVE(&acpi_sc->apm_cdevs, clone, apm_clone_data, entries);
+       knlist_destroy(&clone->sel_read.si_note);
+       ACPI_UNLOCK(acpi);
+       free(clone, M_APMDEV);
+       destroy_dev_sched(dev);
+       return (0);
+}
+
+static int
+apmioctl(struct cdev *dev, u_long cmd, caddr_t addr, int flag, struct thread 
*td)
+{
+       int     error;
+       struct  apm_clone_data *clone;
+       struct  acpi_softc *acpi_sc;
+       struct  apm_info info;
+       struct  apm_event_info *ev_info;
+       apm_info_old_t aiop;
+
+       error = 0;
+       clone = dev->si_drv1;
+       acpi_sc = clone->acpi_sc;
+
+       switch (cmd) {
+       case APMIO_SUSPEND:
+               if ((flag & FWRITE) == 0)
+                       return (EPERM);
+               if (acpi_sc->acpi_next_sstate == 0) {
+                       if (acpi_sc->acpi_suspend_sx != ACPI_STATE_S5) {
+                               error = acpi_ReqSleepState(acpi_sc,
+                                   acpi_sc->acpi_suspend_sx);
+                       } else {
+                               printf(
+                       "power off via apm suspend not supported\n");
+                               error = ENXIO;
+                       }
+               } else
+                       error = acpi_AckSleepState(clone, 0);
+               break;
+       case APMIO_STANDBY:
+               if ((flag & FWRITE) == 0)
+                       return (EPERM);
+               if (acpi_sc->acpi_next_sstate == 0) {
+                       if (acpi_sc->acpi_standby_sx != ACPI_STATE_S5) {
+                               error = acpi_ReqSleepState(acpi_sc,
+                                   acpi_sc->acpi_standby_sx);
+                       } else {
+                               printf(
+                       "power off via apm standby not supported\n");
+                               error = ENXIO;
+                       }
+               } else
+                       error = acpi_AckSleepState(clone, 0);
+               break;
+       case APMIO_NEXTEVENT:
+               printf("apm nextevent start\n");
+               ACPI_LOCK(acpi);
+               if (acpi_sc->acpi_next_sstate != 0 && clone->notify_status ==
+                   APM_EV_NONE) {
+                       ev_info = (struct apm_event_info *)addr;
+                       if (acpi_sc->acpi_next_sstate <= ACPI_STATE_S3)
+                               ev_info->type = PMEV_STANDBYREQ;
+                       else
+                               ev_info->type = PMEV_SUSPENDREQ;
+                       ev_info->index = 0;
+                       clone->notify_status = APM_EV_NOTIFIED;
+                       printf("apm event returning %d\n", ev_info->type);
+               } else
+                       error = EAGAIN;
+               ACPI_UNLOCK(acpi);
+               break;
+       case APMIO_GETINFO_OLD:
+               if (acpi_capm_get_info(&info))
+                       error = ENXIO;
+               aiop = (apm_info_old_t)addr;
+               aiop->ai_major = info.ai_major;
+               aiop->ai_minor = info.ai_minor;
+               aiop->ai_acline = info.ai_acline;
+               aiop->ai_batt_stat = info.ai_batt_stat;
+               aiop->ai_batt_life = info.ai_batt_life;
+               aiop->ai_status = info.ai_status;
+               break;
+       case APMIO_GETINFO:
+               if (acpi_capm_get_info((apm_info_t)addr))
+                       error = ENXIO;
+               break;
+       case APMIO_GETPWSTATUS:
+               if (acpi_capm_get_pwstatus((apm_pwstatus_t)addr))
+                       error = ENXIO;
+               break;
+       case APMIO_ENABLE:
+               if ((flag & FWRITE) == 0)
+                       return (EPERM);
+               apm_active = 1;
+               break;
+       case APMIO_DISABLE:
+               if ((flag & FWRITE) == 0)
+                       return (EPERM);
+               apm_active = 0;
+               break;
+       case APMIO_HALTCPU:
+               break;
+       case APMIO_NOTHALTCPU:
+               break;
+       case APMIO_DISPLAY:
+               if ((flag & FWRITE) == 0)
+                       return (EPERM);
+               break;
+       case APMIO_BIOS:
+               if ((flag & FWRITE) == 0)
+                       return (EPERM);
+               bzero(addr, sizeof(struct apm_bios_arg));
+               break;
+       default:
+               error = EINVAL;
+               break;
+       }
+
+       return (error);
+}
+
+static int
+apmwrite(struct cdev *dev, struct uio *uio, int ioflag)
+{
+       return (uio->uio_resid);
+}
+
+static int
+apmpoll(struct cdev *dev, int events, struct thread *td)
+{
+       struct  apm_clone_data *clone;
+       int revents;
+
+       revents = 0;
+       ACPI_LOCK(acpi);
+       clone = dev->si_drv1;
+       if (clone->acpi_sc->acpi_next_sstate)
+               revents |= events & (POLLIN | POLLRDNORM);
+       else
+               selrecord(td, &clone->sel_read);
+       ACPI_UNLOCK(acpi);
+       return (revents);
+}
+
+static int
+apmkqfilter(struct cdev *dev, struct knote *kn)
+{
+       struct  apm_clone_data *clone;
+
+       ACPI_LOCK(acpi);
+       clone = dev->si_drv1;
+       kn->kn_hook = clone;
+       kn->kn_fop = &apm_readfiltops;
+       knlist_add(&clone->sel_read.si_note, kn, 0);
+       ACPI_UNLOCK(acpi);
+       return (0);
+}
+
+static void
+apmreadfiltdetach(struct knote *kn)
+{
+       struct  apm_clone_data *clone;
+
+       ACPI_LOCK(acpi);
+       clone = kn->kn_hook;
+       knlist_remove(&clone->sel_read.si_note, kn, 0);
+       ACPI_UNLOCK(acpi);
+}
+
+static int
+apmreadfilt(struct knote *kn, long hint)
+{
+       struct  apm_clone_data *clone;
+       int     sleeping;
+
+       ACPI_LOCK(acpi);
+       clone = kn->kn_hook;
+       sleeping = clone->acpi_sc->acpi_next_sstate ? 1 : 0;
+       ACPI_UNLOCK(acpi);
+       return (sleeping);
+}
 
 int
 acpi_machdep_init(device_t dev)
@@ -63,14 +506,11 @@ acpi_machdep_init(device_t dev)
 
        sc = devclass_get_softc(devclass_find("acpi"), 0);
 
-       /* Create a fake clone for /dev/acpi. */
+       /* Create a clone for /dev/acpi also. */
        STAILQ_INIT(&sc->apm_cdevs);
-       acpi_clone.cdev = sc->acpi_dev_t;
-       acpi_clone.acpi_sc = sc;
-       ACPI_LOCK(acpi);
-       STAILQ_INSERT_TAIL(&sc->apm_cdevs, &acpi_clone, entries);
-       ACPI_UNLOCK(acpi);
-       sc->acpi_clone = &acpi_clone;
+       sc->acpi_clone = apm_create_clone(sc->acpi_dev_t, sc);
+       clone_setup(&apm_clones);
+       EVENTHANDLER_REGISTER(dev_clone, apm_clone, 0, 1000);
        acpi_install_wakeup_handler(sc);
 
        if (intr_model != ACPI_INTR_PIC)

Copied and modified: head/sys/amd64/include/apm_bios.h (from r197533, 
head/sys/i386/include/apm_bios.h)
==============================================================================
--- head/sys/i386/include/apm_bios.h    Sat Sep 26 23:25:22 2009        
(r197533, copy source)
+++ head/sys/amd64/include/apm_bios.h   Sun Sep 27 14:00:16 2009        
(r197536)
@@ -230,12 +230,12 @@ typedef struct apm_pwstatus {
 } *apm_pwstatus_t;
 
 struct apm_bios_arg {
-        u_long eax;
-        u_long ebx;
-        u_long ecx;
-        u_long edx;
-        u_long esi;
-        u_long edi;
+        uint32_t eax;
+        uint32_t ebx;
+        uint32_t ecx;
+        uint32_t edx;
+        uint32_t esi;
+        uint32_t edi;
 };
 
 struct apm_event_info {

Modified: head/sys/dev/acpica/acpi.c
==============================================================================
--- head/sys/dev/acpica/acpi.c  Sun Sep 27 13:24:34 2009        (r197535)
+++ head/sys/dev/acpica/acpi.c  Sun Sep 27 14:00:16 2009        (r197536)
@@ -2308,9 +2308,8 @@ acpi_sleep_force(void *arg)
 int
 acpi_ReqSleepState(struct acpi_softc *sc, int state)
 {
-#if defined(__i386__)
+#if defined(__amd64__) || defined(__i386__)
     struct apm_clone_data *clone;
-#endif
 
     if (state < ACPI_STATE_S1 || state > ACPI_S_STATES_MAX)
        return (EINVAL);
@@ -2325,7 +2324,6 @@ acpi_ReqSleepState(struct acpi_softc *sc
            return (ENXIO);
     }
 
-#if defined(__amd64__) || defined(__i386__)
     /* If a suspend request is already in progress, just return. */
     ACPI_LOCK(acpi);
     if (sc->acpi_next_sstate != 0) {
@@ -2335,7 +2333,6 @@ acpi_ReqSleepState(struct acpi_softc *sc
 
     /* Record the pending state and notify all apm devices. */
     sc->acpi_next_sstate = state;
-#if defined(__i386__)
     STAILQ_FOREACH(clone, &sc->apm_cdevs, entries) {
        clone->notify_status = APM_EV_NONE;
        if ((clone->flags & ACPI_EVF_DEVD) == 0) {
@@ -2343,7 +2340,6 @@ acpi_ReqSleepState(struct acpi_softc *sc
            KNOTE_UNLOCKED(&clone->sel_read.si_note, 0);
        }
     }
-#endif
 
     /* If devd(8) is not running, immediately enter the sleep state. */
     if (!devctl_process_running()) {
@@ -2414,7 +2410,6 @@ acpi_AckSleepState(struct apm_clone_data
      * are writable since read-only devices couldn't ack the request.
      */
     sleeping = TRUE;
-#if defined(__i386__)
     clone->notify_status = APM_EV_ACKED;
     STAILQ_FOREACH(clone, &sc->apm_cdevs, entries) {
        if ((clone->flags & ACPI_EVF_WRITE) != 0 &&
@@ -2423,7 +2418,6 @@ acpi_AckSleepState(struct apm_clone_data
            break;
        }
     }
-#endif
 
     /* If all devices have voted "yes", we will suspend now. */
     if (sleeping)

Modified: head/sys/i386/include/apm_bios.h
==============================================================================
--- head/sys/i386/include/apm_bios.h    Sun Sep 27 13:24:34 2009        
(r197535)
+++ head/sys/i386/include/apm_bios.h    Sun Sep 27 14:00:16 2009        
(r197536)
@@ -230,12 +230,12 @@ typedef struct apm_pwstatus {
 } *apm_pwstatus_t;
 
 struct apm_bios_arg {
-        u_long eax;
-        u_long ebx;
-        u_long ecx;
-        u_long edx;
-        u_long esi;
-        u_long edi;
+        uint32_t eax;
+        uint32_t ebx;
+        uint32_t ecx;
+        uint32_t edx;
+        uint32_t esi;
+        uint32_t edi;
 };
 
 struct apm_event_info {

Modified: head/usr.sbin/Makefile
==============================================================================
--- head/usr.sbin/Makefile      Sun Sep 27 13:24:34 2009        (r197535)
+++ head/usr.sbin/Makefile      Sun Sep 27 14:00:16 2009        (r197536)
@@ -468,6 +468,9 @@ _boot98cfg= boot98cfg
 .if ${MK_ACPI} != "no"
 _acpi=         acpi
 .endif
+.if ${MK_APM} != "no"
+_apm=          apm
+.endif
 _asf=          asf
 _boot0cfg=     boot0cfg
 .if ${MK_TOOLCHAIN} != "no"

Modified: head/usr.sbin/apm/Makefile
==============================================================================
--- head/usr.sbin/apm/Makefile  Sun Sep 27 13:24:34 2009        (r197535)
+++ head/usr.sbin/apm/Makefile  Sun Sep 27 14:00:16 2009        (r197536)
@@ -3,7 +3,7 @@
 PROG=  apm
 MAN=   apm.8
 MLINKS=        apm.8 apmconf.8
-MANSUBDIR= /i386
+MANSUBDIR= /${MACHINE_ARCH}
 WARNS?=        6
 
 .include <bsd.prog.mk>
_______________________________________________
svn-src-all@freebsd.org mailing list
http://lists.freebsd.org/mailman/listinfo/svn-src-all
To unsubscribe, send any mail to "svn-src-all-unsubscr...@freebsd.org"

Reply via email to