#include <sys/cdefs.h>
__KERNEL_RCSID(0, "$NetBSD: psh3pwr.c,v 1.8 2024/09/20 19:32:19 andvar Exp $");
#include <sys/param.h>
#include <sys/kernel.h>
#include <sys/device.h>
#include <sys/systm.h>
#include <sys/callout.h>
#include <machine/config_hook.h>
#include <machine/platid.h>
#include <machine/platid_mask.h>
#include <dev/apm/apmbios.h>
#include <sh3/exception.h>
#include <sh3/intcreg.h>
#include <sh3/pfcreg.h>
#include <sh3/dev/adcvar.h>
#ifdef PSH3PWR_DEBUG
#define DPRINTF(arg) printf arg
#else
#define DPRINTF(arg) ((void)0)
#endif
#define ADC_CHANNEL_BATTERY 3
#define PSH3_GREEN_LED_ON 0x80
#define PSH3PWR_PLUG_OUT 0x40
static inline int __attribute__((__always_inline__))
psh3pwr_ac_is_off(void)
{
return _reg_read_1(SH7709_SCPDR) & PSH3PWR_PLUG_OUT;
}
#define PSH3PWR_BATTERY_MIN 630
#define PSH3PWR_BATTERY_CRITICAL 635
#define PSH3PWR_BATTERY_LOW 645
#define PSH3PWR_BATTERY_FULL 910
struct psh3pwr_softc {
device_t sc_dev;
void *sc_ih_pin;
void *sc_ih_pout;
};
static int psh3pwr_match(device_t, struct cfdata *, void *);
static void psh3pwr_attach(device_t, device_t, void *);
CFATTACH_DECL_NEW(psh3pwr, sizeof(struct psh3pwr_softc),
psh3pwr_match, psh3pwr_attach, NULL, NULL);
static int psh3pwr_intr_plug_out(void *);
static int psh3pwr_intr_plug_in(void *);
static void psh3pwr_sleep(void *);
static int psh3pwr_apm_getpower_hook(void *, int, long, void *);
static int psh3pwr_get_battery(void);
static int
psh3pwr_match(device_t parent, struct cfdata *cfp, void *aux)
{
if (!platid_match(&platid, &platid_mask_MACH_HITACHI_PERSONA))
return 0;
if (strcmp(cfp->cf_name, "psh3pwr") != 0)
return 0;
return 1;
}
static void
psh3pwr_attach(device_t parent, device_t self, void *aux)
{
extern void (*__sleep_func)(void *);
extern void *__sleep_ctx;
struct psh3pwr_softc *sc = device_private(self);
uint8_t phdr;
sc->sc_dev = self;
config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_ACADAPTER,
CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_CHARGE,
CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_BATTERYVAL,
CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
__sleep_func = psh3pwr_sleep;
__sleep_ctx = self;
phdr = _reg_read_1(SH7709_PHDR);
_reg_write_1(SH7709_PHDR, phdr | PSH3_GREEN_LED_ON);
aprint_naive("\n");
aprint_normal("\n");
sc->sc_ih_pout = intc_intr_establish(SH7709_INTEVT2_IRQ0,
IST_EDGE, IPL_TTY, psh3pwr_intr_plug_out, self);
sc->sc_ih_pin = intc_intr_establish(SH7709_INTEVT2_IRQ1,
IST_EDGE, IPL_TTY, psh3pwr_intr_plug_in, self);
aprint_normal_dev(self, "plug status: %s\n",
psh3pwr_ac_is_off() ? "out" : "in");
if (!pmf_device_register(self, NULL, NULL))
aprint_error_dev(self, "unable to establish power handler\n");
}
static int
psh3pwr_intr_plug_out(void *dev)
{
uint8_t irr0, scpdr;
irr0 = _reg_read_1(SH7709_IRR0);
if (!(irr0 & IRR0_IRQ0)) {
return 0;
}
_reg_write_1(SH7709_IRR0, irr0 & ~IRR0_IRQ0);
scpdr = _reg_read_1(SH7709_SCPDR);
_reg_write_1(SH7709_SCPDR, scpdr | PSH3PWR_PLUG_OUT);
DPRINTF(("%s: plug out\n", device_xname(dev)));
return 1;
}
static int
psh3pwr_intr_plug_in(void *dev)
{
uint8_t irr0, scpdr;
irr0 = _reg_read_1(SH7709_IRR0);
if (!(irr0 & IRR0_IRQ1))
return 0;
_reg_write_1(SH7709_IRR0, irr0 & ~IRR0_IRQ1);
scpdr = _reg_read_1(SH7709_SCPDR);
_reg_write_1(SH7709_SCPDR, scpdr & ~PSH3PWR_PLUG_OUT);
DPRINTF(("%s: plug in\n", device_xname(dev)));
return 1;
}
void
psh3pwr_sleep(void *v)
{
extern void pfckbd_poll_hitachi_power(void);
uint8_t phdr;
phdr = _reg_read_1(SH7709_PHDR);
_reg_write_1(SH7709_PHDR, phdr & ~PSH3_GREEN_LED_ON);
pfckbd_poll_hitachi_power();
phdr = _reg_read_1(SH7709_PHDR);
_reg_write_1(SH7709_PHDR, phdr | PSH3_GREEN_LED_ON);
}
static int
psh3pwr_apm_getpower_hook(void *ctx, int type, long id, void *msg)
{
int * const pval = msg;
int battery, state;
if (type != CONFIG_HOOK_GET)
return EINVAL;
switch (id) {
case CONFIG_HOOK_ACADAPTER:
*pval = psh3pwr_ac_is_off() ? APM_AC_OFF : APM_AC_ON;
return 0;
case CONFIG_HOOK_CHARGE:
battery = psh3pwr_get_battery();
if (battery < PSH3PWR_BATTERY_CRITICAL)
state = APM_BATT_FLAG_CRITICAL;
else if (battery < PSH3PWR_BATTERY_LOW)
state = APM_BATT_FLAG_LOW;
else
state = APM_BATT_FLAG_HIGH;
*pval = state;
return 0;
case CONFIG_HOOK_BATTERYVAL:
battery = psh3pwr_get_battery();
if (battery > PSH3PWR_BATTERY_FULL)
state = 100;
else
state = 100 * (battery - PSH3PWR_BATTERY_MIN) /
(PSH3PWR_BATTERY_FULL - PSH3PWR_BATTERY_MIN);
*pval = state;
return 0;
}
return EINVAL;
}
static int
psh3pwr_get_battery(void)
{
int battery;
int s;
s = spltty();
battery = adc_sample_channel(ADC_CHANNEL_BATTERY);
splx(s);
return battery;
}