#include "apm.h"
#include <sys/param.h>
#include <sys/systm.h>
#include <sys/kernel.h>
#include <sys/proc.h>
#include <sys/device.h>
#include <sys/fcntl.h>
#include <sys/ioctl.h>
#include <sys/event.h>
#include <sys/reboot.h>
#include <sys/hibernate.h>
#include <sys/task.h>
#include <machine/conf.h>
#include <machine/cpu.h>
#include <machine/acpiapm.h>
#include <machine/apmvar.h>
#if defined(APMDEBUG)
#define DPRINTF(x) printf x
#else
#define DPRINTF(x)
#endif
#ifdef SUSPEND
struct taskq *sleep_taskq;
struct task suspend_task;
void do_suspend(void *);
#ifdef HIBERNATE
struct task hibernate_task;
void do_hibernate(void *);
#endif
#endif
struct apm_softc {
struct device sc_dev;
struct klist sc_note;
int sc_flags;
};
int apmmatch(struct device *, void *, void *);
void apmattach(struct device *, struct device *, void *);
const struct cfattach apm_ca = {
sizeof(struct apm_softc), apmmatch, apmattach
};
struct cfdriver apm_cd = {
NULL, "apm", DV_DULL
};
#define APMUNIT(dev) (minor(dev)&0xf0)
#define APMDEV(dev) (minor(dev)&0x0f)
#define APMDEV_NORMAL 0
#define APMDEV_CTL 8
void filt_apmrdetach(struct knote *kn);
int filt_apmread(struct knote *kn, long hint);
int apmkqfilter(dev_t dev, struct knote *kn);
int apm_getdefaultinfo(struct apm_power_info *);
const struct filterops apmread_filtops = {
.f_flags = FILTEROP_ISFD,
.f_attach = NULL,
.f_detach = filt_apmrdetach,
.f_event = filt_apmread,
};
int (*get_apminfo)(struct apm_power_info *) = apm_getdefaultinfo;
#define SCFLAG_NOPRINT 0x0008000
#define SCFLAG_PCTPRINT 0x0004000
#define SCFLAG_PRINT (SCFLAG_NOPRINT|SCFLAG_PCTPRINT)
#define SCFLAG_OREAD (1 << 0)
#define SCFLAG_OWRITE (1 << 1)
#define SCFLAG_OPEN (SCFLAG_OREAD|SCFLAG_OWRITE)
int
apmmatch(struct device *parent, void *match, void *aux)
{
return (1);
}
void
apmattach(struct device *parent, struct device *self, void *aux)
{
#ifdef SUSPEND
sleep_taskq = taskq_create("sleep", 1, IPL_NONE, 0);
task_set(&suspend_task, do_suspend, NULL);
#ifdef HIBERNATE
task_set(&hibernate_task, do_hibernate, NULL);
#endif
#endif
acpiapm_open = apmopen;
acpiapm_close = apmclose;
acpiapm_ioctl = apmioctl;
acpiapm_kqfilter = apmkqfilter;
printf("\n");
}
int
apmopen(dev_t dev, int flag, int mode, struct proc *p)
{
struct apm_softc *sc;
int error = 0;
if (!apm_cd.cd_ndevs || APMUNIT(dev) != 0 ||
!(sc = apm_cd.cd_devs[APMUNIT(dev)]))
return ENXIO;
DPRINTF(("apmopen: dev %d pid %d flag %x mode %x\n",
APMDEV(dev), p->p_p->ps_pid, flag, mode));
switch (APMDEV(dev)) {
case APMDEV_CTL:
if (!(flag & FWRITE)) {
error = EINVAL;
break;
}
if (sc->sc_flags & SCFLAG_OWRITE) {
error = EBUSY;
break;
}
sc->sc_flags |= SCFLAG_OWRITE;
break;
case APMDEV_NORMAL:
if (!(flag & FREAD) || (flag & FWRITE)) {
error = EINVAL;
break;
}
sc->sc_flags |= SCFLAG_OREAD;
break;
default:
error = ENXIO;
break;
}
return error;
}
int
apmclose(dev_t dev, int flag, int mode, struct proc *p)
{
struct apm_softc *sc;
if (!apm_cd.cd_ndevs || APMUNIT(dev) != 0 ||
!(sc = apm_cd.cd_devs[APMUNIT(dev)]))
return ENXIO;
DPRINTF(("apmclose: pid %d flag %x mode %x\n",
p->p_p->ps_pid, flag, mode));
switch (APMDEV(dev)) {
case APMDEV_CTL:
sc->sc_flags &= ~SCFLAG_OWRITE;
break;
case APMDEV_NORMAL:
sc->sc_flags &= ~SCFLAG_OREAD;
break;
}
return 0;
}
int
apmioctl(dev_t dev, u_long cmd, caddr_t data, int flag, struct proc *p)
{
struct apm_softc *sc;
struct apm_power_info *power;
int error = 0;
if (!apm_cd.cd_ndevs || APMUNIT(dev) != 0 ||
!(sc = apm_cd.cd_devs[APMUNIT(dev)]))
return ENXIO;
switch (cmd) {
#ifdef SUSPEND
case APM_IOC_STANDBY:
case APM_IOC_SUSPEND:
if ((flag & FWRITE) == 0) {
error = EBADF;
break;
}
error = request_sleep(SLEEP_SUSPEND);
break;
#ifdef HIBERNATE
case APM_IOC_HIBERNATE:
if ((error = suser(p)) != 0)
break;
if ((flag & FWRITE) == 0) {
error = EBADF;
break;
}
error = request_sleep(SLEEP_HIBERNATE);
break;
#endif
#endif
case APM_IOC_PRN_CTL:
if ((flag & FWRITE) == 0)
error = EBADF;
else {
int flag = *(int *)data;
DPRINTF(( "APM_IOC_PRN_CTL: %d\n", flag ));
switch (flag) {
case APM_PRINT_ON:
sc->sc_flags &= ~SCFLAG_PRINT;
break;
case APM_PRINT_OFF:
sc->sc_flags &= ~SCFLAG_PRINT;
sc->sc_flags |= SCFLAG_NOPRINT;
break;
case APM_PRINT_PCT:
sc->sc_flags &= ~SCFLAG_PRINT;
sc->sc_flags |= SCFLAG_PCTPRINT;
break;
default:
error = EINVAL;
break;
}
}
break;
case APM_IOC_GETPOWER:
power = (struct apm_power_info *)data;
error = (*get_apminfo)(power);
break;
default:
error = ENOTTY;
}
return error;
}
void
filt_apmrdetach(struct knote *kn)
{
struct apm_softc *sc = (struct apm_softc *)kn->kn_hook;
klist_remove_locked(&sc->sc_note, kn);
}
int
filt_apmread(struct knote *kn, long hint)
{
if (hint && !kn->kn_data)
kn->kn_data = (int)hint;
return (1);
}
int
apmkqfilter(dev_t dev, struct knote *kn)
{
struct apm_softc *sc;
if (!apm_cd.cd_ndevs || APMUNIT(dev) != 0 ||
!(sc = apm_cd.cd_devs[APMUNIT(dev)]))
return ENXIO;
switch (kn->kn_filter) {
case EVFILT_READ:
kn->kn_fop = &apmread_filtops;
break;
default:
return (EINVAL);
}
kn->kn_hook = (caddr_t)sc;
klist_insert_locked(&sc->sc_note, kn);
return (0);
}
int
apm_getdefaultinfo(struct apm_power_info *info)
{
info->battery_state = APM_BATT_UNKNOWN;
info->ac_state = APM_AC_UNKNOWN;
info->battery_life = 0;
info->minutes_left = -1;
return (0);
}
void
apm_setinfohook(int (*hook)(struct apm_power_info *))
{
get_apminfo = hook;
}
int
apm_record_event(u_int event)
{
struct apm_softc *sc = apm_cd.cd_devs[0];
static int apm_evindex;
if (sc == NULL || (sc->sc_flags & SCFLAG_OPEN) == 0)
return 1;
apm_evindex++;
knote_locked(&sc->sc_note, APM_EVENT_COMPOSE(event, apm_evindex));
return 0;
}
#ifdef SUSPEND
void
do_suspend(void *v)
{
sleep_state(v, SLEEP_SUSPEND);
}
#ifdef HIBERNATE
void
do_hibernate(void *v)
{
sleep_state(v, SLEEP_HIBERNATE);
}
#endif
int
request_sleep(int sleepmode)
{
if (sleep_taskq == NULL)
return EINVAL;
switch (sleepmode) {
case SLEEP_SUSPEND:
task_add(sleep_taskq, &suspend_task);
break;
#ifdef HIBERNATE
case SLEEP_HIBERNATE:
if (get_hibernate_io_function(swdevt[0]) == NULL)
return EOPNOTSUPP;
task_add(sleep_taskq, &hibernate_task);
break;
#endif
}
return 0;
}
#ifdef MULTIPROCESSOR
void
sleep_mp(void)
{
CPU_INFO_ITERATOR cii;
struct cpu_info *ci;
CPU_INFO_FOREACH(cii, ci) {
if (CPU_IS_PRIMARY(ci))
continue;
arm_send_ipi(ci, ARM_IPI_HALT);
while (ci->ci_flags & CPUF_RUNNING)
CPU_BUSY_CYCLE();
}
}
void
resume_mp(void)
{
CPU_INFO_ITERATOR cii;
struct cpu_info *ci;
CPU_INFO_FOREACH(cii, ci) {
if (CPU_IS_PRIMARY(ci))
continue;
cpu_resume_secondary(ci);
}
cpu_boot_secondary_processors();
}
#endif
int
sleep_showstate(void *v, int sleepmode)
{
if (sleepmode == SLEEP_SUSPEND)
return 0;
return EOPNOTSUPP;
}
int
sleep_setstate(void *v)
{
return 0;
}
int
gosleep(void *v)
{
return cpu_suspend_primary();
}
int
sleep_resume(void *v)
{
return 0;
}
int
suspend_finish(void *v)
{
apm_record_event(APM_NORMAL_RESUME);
return SLEEP_RESUME;
}
#endif