NetBSD/sys/arch/hpcmips/dev/hpcapm.c

358 lines
8.0 KiB
C

/* $NetBSD: hpcapm.c,v 1.4 2000/10/04 13:53:55 uch Exp $ */
/*
* Copyright (c) 2000 Takemura Shin
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
*/
#include <sys/param.h>
#include <sys/device.h>
#include <sys/systm.h>
#include <arch/hpcmips/dev/apm/apmvar.h>
#include <machine/bus.h>
#include <machine/autoconf.h>
#include <machine/config_hook.h>
#include <machine/platid.h>
#include <machine/platid_mask.h>
#include "vrip.h"
#if NVRIP > 0
#include <hpcmips/vr/vripvar.h>
#include <hpcmips/vr/vr_asm.h>
#endif
#include "opt_tx39xx.h"
#ifdef TX39XX
#include <hpcmips/tx/tx39var.h> /* suspend CPU */
#endif
#define HPCAPMDEBUG
#ifdef HPCAPMDEBUG
#ifndef HPCAPMDEBUG_CONF
#define HPCAPMDEBUG_CONF 1
#endif
int hpcapm_debug = HPCAPMDEBUG_CONF;
#define DPRINTF(arg) do { if (hpcapm_debug) printf arg; } while(0);
#define DPRINTFN(n, arg) do { if (hpcapm_debug > (n)) printf arg; } while (0);
#else
#define DPRINTF(arg) do { } while (0);
#define DPRINTFN(n, arg) do { } while (0);
#endif
/* Definition of the driver for autoconfig. */
static int hpcapm_match(struct device *, struct cfdata *, void *);
static void hpcapm_attach(struct device *, struct device *, void *);
static int hpcapm_hook __P((void *, int, long, void *));
static void hpcapm_disconnect __P((void *));
static void hpcapm_enable __P((void *, int));
static int hpcapm_set_powstate __P((void *, u_int, u_int));
static int hpcapm_get_powstat __P((void *, struct apm_power_info *));
static int hpcapm_get_event __P((void *, u_int *, u_int *));
static void hpcapm_cpu_busy __P((void *));
static void hpcapm_cpu_idle __P((void *));
static void hpcapm_get_capabilities __P((void *, u_int *, u_int *));
struct cfattach hpcapm_ca = {
sizeof (struct device), hpcapm_match, hpcapm_attach
};
struct apmhpc_softc {
struct device sc_dev;
void *sc_apmdev;
volatile unsigned int events;
volatile int power_state;
config_hook_tag sc_standby_hook;
config_hook_tag sc_suspend_hook;
};
struct apm_accessops hpcapm_accessops = {
hpcapm_disconnect,
hpcapm_enable,
hpcapm_set_powstate,
hpcapm_get_powstat,
hpcapm_get_event,
hpcapm_cpu_busy,
hpcapm_cpu_idle,
hpcapm_get_capabilities,
};
extern struct cfdriver hpcapm_cd;
static int
hpcapm_match(parent, cf, aux)
struct device *parent;
struct cfdata *cf;
void *aux;
{
struct mainbus_attach_args *ma = aux;
if (strcmp(ma->ma_name, hpcapm_cd.cd_name) != 0) {
return (0);
}
return (1);
}
static void
hpcapm_attach(parent, self, aux)
struct device *parent;
struct device *self;
void *aux;
{
struct apmhpc_softc *sc;
struct apmdev_attach_args aaa;
sc = (struct apmhpc_softc *)self;
printf(": pseudo power management module\n");
sc->events = 0;
sc->power_state = APM_SYS_READY;
sc->sc_standby_hook = config_hook(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_STANDBYREQ,
CONFIG_HOOK_EXCLUSIVE,
hpcapm_hook, sc);
sc->sc_suspend_hook = config_hook(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_SUSPENDREQ,
CONFIG_HOOK_EXCLUSIVE,
hpcapm_hook, sc);
aaa.accessops = &hpcapm_accessops;
aaa.accesscookie = sc;
aaa.apm_detail = 0x0102;
sc->sc_apmdev = config_found(self, &aaa, apmprint);
}
static int
hpcapm_hook(ctx, type, id, msg)
void *ctx;
int type;
long id;
void *msg;
{
struct apmhpc_softc *sc;
int s;
sc = ctx;
s = splhigh();
switch (id) {
case CONFIG_HOOK_PMEVENT_STANDBYREQ:
if (sc->power_state != APM_SYS_STANDBY) {
sc->events |= (1 << APM_USER_STANDBY_REQ);
} else {
sc->events |= (1 << APM_NORMAL_RESUME);
}
break;
case CONFIG_HOOK_PMEVENT_SUSPENDREQ:
if (sc->power_state != APM_SYS_SUSPEND) {
DPRINTF(("hpcapm: suspend req\n"));
sc->events |= (1 << APM_USER_SUSPEND_REQ);
} else {
sc->events |= (1 << APM_NORMAL_RESUME);
}
break;
}
splx(s);
return (0);
}
static void
hpcapm_disconnect(scx)
void *scx;
{
struct apmhpc_softc *sc;
sc = scx;
}
static void
hpcapm_enable(scx, onoff)
void *scx;
int onoff;
{
struct apmhpc_softc *sc;
sc = scx;
}
static int
hpcapm_set_powstate(scx, devid, powstat)
void *scx;
u_int devid, powstat;
{
struct apmhpc_softc *sc;
int s;
sc = scx;
if (devid != APM_DEV_ALLDEVS)
return APM_ERR_UNRECOG_DEV;
switch (powstat) {
case APM_SYS_READY:
DPRINTF(("hpcapm: set power state READY\n"));
sc->power_state = APM_SYS_READY;
break;
case APM_SYS_STANDBY:
DPRINTF(("hpcapm: set power state STANDBY\n"));
sc->power_state = APM_SYS_STANDBY;
break;
case APM_SYS_SUSPEND:
DPRINTF(("hpcapm: set power state SUSPEND...\n"));
s = splhigh();
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_HARDPOWER,
(void *)PWR_SUSPEND);
sc->power_state = APM_SYS_SUSPEND;
#if NVRIP > 0
if (platid_match(&platid, &platid_mask_CPU_MIPS_VR_41XX)) {
/*
* disable all interrupts except PIU interrupt
*/
vrip_intr_suspend();
_spllower(~MIPS_INT_MASK_0);
/*
* SUSPEND instruction puts the CPU into power saveing
* state until some interrupt occuer.
* It sleeps until you push the power button.
*/
__asm(".set noreorder");
__asm(__CONCAT(".word ",___STRING(VR_OPCODE_SUSPEND)));
__asm("nop");
__asm("nop");
__asm("nop");
__asm("nop");
__asm("nop");
__asm(".set reorder");
splhigh();
vrip_intr_resume();
}
#endif /* NVRIP > 0 */
#ifdef TX39XX
tx39power_suspend_cpu();
#endif
config_hook_call(CONFIG_HOOK_PMEVENT,
CONFIG_HOOK_PMEVENT_HARDPOWER,
(void *)PWR_RESUME);
DPRINTF(("hpcapm: resume\n"));
splx(s);
break;
case APM_SYS_OFF:
DPRINTF(("hpcapm: set power state OFF\n"));
sc->power_state = APM_SYS_OFF;
break;
case APM_LASTREQ_INPROG:
/*DPRINTF(("hpcapm: set power state INPROG\n"));
*/
break;
case APM_LASTREQ_REJECTED:
DPRINTF(("hpcapm: set power state REJECTED\n"));
break;
}
return (0);
}
static int
hpcapm_get_powstat(scx, pinfo)
void *scx;
struct apm_power_info *pinfo;
{
struct apmhpc_softc *sc;
sc = scx;
memset(pinfo, 0, sizeof(*pinfo));
return (0);
}
static int
hpcapm_get_event(scx, event_type, event_info)
void *scx;
u_int *event_type;
u_int *event_info;
{
struct apmhpc_softc *sc;
int s, i;
sc = scx;
s = splhigh();
for (i = APM_STANDBY_REQ; i <= APM_CAP_CHANGE; i++) {
if (sc->events & (1 << i)) {
sc->events &= ~(1 << i);
*event_type = i;
if (*event_type == APM_NORMAL_RESUME ||
*event_type == APM_CRIT_RESUME) {
/* pccard power off in the suspend state */
*event_info = 1;
sc->power_state = APM_SYS_READY;
} else
*event_info = 0;
return (0);
}
}
splx(s);
return APM_ERR_NOEVENTS;
}
static void
hpcapm_cpu_busy(scx)
void *scx;
{
struct apmhpc_softc *sc;
sc = scx;
}
static void
hpcapm_cpu_idle(scx)
void *scx;
{
struct apmhpc_softc *sc;
sc = scx;
}
static void
hpcapm_get_capabilities(scx, numbatts, capflags)
void *scx;
u_int *numbatts, *capflags;
{
struct apmhpc_softc *sc;
*numbatts = 0;
*capflags = APM_GLOBAL_STANDBY | APM_GLOBAL_SUSPEND;
sc = scx;
}