Home | History | Annotate | Line # | Download | only in dev
zapm.c revision 1.3.12.2
      1  1.3.12.2  yamt /*	$NetBSD: zapm.c,v 1.3.12.2 2007/09/03 14:31:42 yamt Exp $	*/
      2  1.3.12.2  yamt /*	$OpenBSD: zaurus_apm.c,v 1.13 2006/12/12 23:14:28 dim Exp $	*/
      3  1.3.12.2  yamt 
      4  1.3.12.2  yamt /*
      5  1.3.12.2  yamt  * Copyright (c) 2005 Uwe Stuehler <uwe (at) bsdx.de>
      6  1.3.12.2  yamt  *
      7  1.3.12.2  yamt  * Permission to use, copy, modify, and distribute this software for any
      8  1.3.12.2  yamt  * purpose with or without fee is hereby granted, provided that the above
      9  1.3.12.2  yamt  * copyright notice and this permission notice appear in all copies.
     10  1.3.12.2  yamt  *
     11  1.3.12.2  yamt  * THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
     12  1.3.12.2  yamt  * WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
     13  1.3.12.2  yamt  * MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR
     14  1.3.12.2  yamt  * ANY SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
     15  1.3.12.2  yamt  * WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN
     16  1.3.12.2  yamt  * ACTION OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF
     17  1.3.12.2  yamt  * OR IN CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
     18  1.3.12.2  yamt  */
     19  1.3.12.2  yamt 
     20  1.3.12.2  yamt #include <sys/cdefs.h>
     21  1.3.12.2  yamt __KERNEL_RCSID(0, "$NetBSD: zapm.c,v 1.3.12.2 2007/09/03 14:31:42 yamt Exp $");
     22  1.3.12.2  yamt 
     23  1.3.12.2  yamt #include <sys/param.h>
     24  1.3.12.2  yamt #include <sys/systm.h>
     25  1.3.12.2  yamt #include <sys/kernel.h>
     26  1.3.12.2  yamt #include <sys/callout.h>
     27  1.3.12.2  yamt 
     28  1.3.12.2  yamt #include <dev/hpc/apm/apmvar.h>
     29  1.3.12.2  yamt 
     30  1.3.12.2  yamt #include <arm/xscale/pxa2x0reg.h>
     31  1.3.12.2  yamt #include <arm/xscale/pxa2x0var.h>
     32  1.3.12.2  yamt #include <arm/xscale/pxa2x0cpu.h>
     33  1.3.12.2  yamt #include <arm/xscale/pxa2x0_gpio.h>
     34  1.3.12.2  yamt 
     35  1.3.12.2  yamt #include <machine/config_hook.h>
     36  1.3.12.2  yamt 
     37  1.3.12.2  yamt #include <zaurus/dev/scoopvar.h>
     38  1.3.12.2  yamt #include <zaurus/dev/zsspvar.h>
     39  1.3.12.2  yamt #include <zaurus/zaurus/zaurus_reg.h>
     40  1.3.12.2  yamt #include <zaurus/zaurus/zaurus_var.h>
     41  1.3.12.2  yamt 
     42  1.3.12.2  yamt #ifdef APMDEBUG
     43  1.3.12.2  yamt #define DPRINTF(x)	printf x
     44  1.3.12.2  yamt #else
     45  1.3.12.2  yamt #define	DPRINTF(x)	do { } while (/*CONSTCOND*/0)
     46  1.3.12.2  yamt #endif
     47  1.3.12.2  yamt 
     48  1.3.12.2  yamt struct zapm_softc {
     49  1.3.12.2  yamt 	struct device sc_dev;
     50  1.3.12.2  yamt 	void *sc_apmdev;
     51  1.3.12.2  yamt 
     52  1.3.12.2  yamt 	struct callout sc_cyclic_poll;
     53  1.3.12.2  yamt 	struct callout sc_discharge_poll;
     54  1.3.12.2  yamt 	struct timeval sc_lastbattchk;
     55  1.3.12.2  yamt 	volatile int suspended;
     56  1.3.12.2  yamt 	volatile int charging;
     57  1.3.12.2  yamt 	volatile int discharging;
     58  1.3.12.2  yamt 	int battery_volt;
     59  1.3.12.2  yamt 	int battery_full_cnt;
     60  1.3.12.2  yamt 
     61  1.3.12.2  yamt 	/* GPIO pin */
     62  1.3.12.2  yamt 	int sc_ac_detect_pin;
     63  1.3.12.2  yamt 	int sc_batt_cover_pin;
     64  1.3.12.2  yamt 	int sc_charge_comp_pin;
     65  1.3.12.2  yamt 
     66  1.3.12.2  yamt 	/* machine-independent part */
     67  1.3.12.2  yamt 	volatile u_int events;
     68  1.3.12.2  yamt 	volatile int power_state;
     69  1.3.12.2  yamt 	volatile int battery_state;
     70  1.3.12.2  yamt 	volatile int ac_state;
     71  1.3.12.2  yamt 	config_hook_tag sc_standby_hook;
     72  1.3.12.2  yamt 	config_hook_tag sc_suspend_hook;
     73  1.3.12.2  yamt 	config_hook_tag sc_battery_hook;
     74  1.3.12.2  yamt 	config_hook_tag sc_ac_hook;
     75  1.3.12.2  yamt 	int battery_life;
     76  1.3.12.2  yamt 	int minutes_left;
     77  1.3.12.2  yamt };
     78  1.3.12.2  yamt 
     79  1.3.12.2  yamt static int	zapm_match(struct device *, struct cfdata *, void *);
     80  1.3.12.2  yamt static void	zapm_attach(struct device *, struct device *, void *);
     81  1.3.12.2  yamt 
     82  1.3.12.2  yamt CFATTACH_DECL(zapm, sizeof(struct zapm_softc),
     83  1.3.12.2  yamt     zapm_match, zapm_attach, NULL, NULL);
     84  1.3.12.2  yamt 
     85  1.3.12.2  yamt static int	zapm_hook(void *, int, long, void *);
     86  1.3.12.2  yamt static void     zapm_disconnect(void *);
     87  1.3.12.2  yamt static void     zapm_enable(void *, int);
     88  1.3.12.2  yamt static int      zapm_set_powstate(void *, u_int, u_int);
     89  1.3.12.2  yamt static int      zapm_get_powstat(void *, struct apm_power_info *);
     90  1.3.12.2  yamt static int      zapm_get_event(void *, u_int *, u_int *);
     91  1.3.12.2  yamt static void     zapm_cpu_busy(void *);
     92  1.3.12.2  yamt static void     zapm_cpu_idle(void *);
     93  1.3.12.2  yamt static void     zapm_get_capabilities(void *, u_int *, u_int *);
     94  1.3.12.2  yamt 
     95  1.3.12.2  yamt static struct apm_accessops zapm_accessops = {
     96  1.3.12.2  yamt 	zapm_disconnect,
     97  1.3.12.2  yamt 	zapm_enable,
     98  1.3.12.2  yamt 	zapm_set_powstate,
     99  1.3.12.2  yamt 	zapm_get_powstat,
    100  1.3.12.2  yamt 	zapm_get_event,
    101  1.3.12.2  yamt 	zapm_cpu_busy,
    102  1.3.12.2  yamt 	zapm_cpu_idle,
    103  1.3.12.2  yamt 	zapm_get_capabilities,
    104  1.3.12.2  yamt };
    105  1.3.12.2  yamt 
    106  1.3.12.2  yamt static int	zapm_acintr(void *);
    107  1.3.12.2  yamt static int	zapm_bcintr(void *);
    108  1.3.12.2  yamt static void	zapm_cyclic(void *);
    109  1.3.12.2  yamt static void	zapm_poll(void *);
    110  1.3.12.2  yamt static void	zapm_poll1(void *, int);
    111  1.3.12.2  yamt 
    112  1.3.12.2  yamt /* battery-related GPIO pins */
    113  1.3.12.2  yamt #define GPIO_AC_IN_C3000	115	/* 0=AC connected */
    114  1.3.12.2  yamt #define GPIO_CHRG_CO_C3000	101	/* 1=battery full */
    115  1.3.12.2  yamt #define GPIO_BATT_COVER_C3000	90	/* 0=unlocked */
    116  1.3.12.2  yamt 
    117  1.3.12.2  yamt /* Cyclic timer value */
    118  1.3.12.2  yamt #define	CYCLIC_TIME	(60 * hz)	/* 60s */
    119  1.3.12.2  yamt 
    120  1.3.12.2  yamt static int
    121  1.3.12.2  yamt zapm_match(struct device *parent, struct cfdata *cf, void *aux)
    122  1.3.12.2  yamt {
    123  1.3.12.2  yamt 
    124  1.3.12.2  yamt 	if (!ZAURUS_ISC3000)
    125  1.3.12.2  yamt 		return 0;
    126  1.3.12.2  yamt 	return 1;
    127  1.3.12.2  yamt }
    128  1.3.12.2  yamt 
    129  1.3.12.2  yamt static void
    130  1.3.12.2  yamt zapm_attach(struct device *parent, struct device *self, void *aux)
    131  1.3.12.2  yamt {
    132  1.3.12.2  yamt 	struct zapm_softc *sc = device_private(self);
    133  1.3.12.2  yamt 	struct apmdev_attach_args aaa;
    134  1.3.12.2  yamt 
    135  1.3.12.2  yamt 	aprint_normal(": pseudo power management module\n");
    136  1.3.12.2  yamt 
    137  1.3.12.2  yamt 	/* machine-depent part */
    138  1.3.12.2  yamt 	callout_init(&sc->sc_cyclic_poll, 0);
    139  1.3.12.2  yamt 	callout_setfunc(&sc->sc_cyclic_poll, zapm_cyclic, sc);
    140  1.3.12.2  yamt 	callout_init(&sc->sc_discharge_poll, 0);
    141  1.3.12.2  yamt 	callout_setfunc(&sc->sc_discharge_poll, zapm_poll, sc);
    142  1.3.12.2  yamt 
    143  1.3.12.2  yamt 	if (ZAURUS_ISC3000) {
    144  1.3.12.2  yamt 		sc->sc_ac_detect_pin = GPIO_AC_IN_C3000;
    145  1.3.12.2  yamt 		sc->sc_batt_cover_pin = GPIO_BATT_COVER_C3000;
    146  1.3.12.2  yamt 		sc->sc_charge_comp_pin = GPIO_CHRG_CO_C3000;
    147  1.3.12.2  yamt 	} else {
    148  1.3.12.2  yamt 		/* XXX */
    149  1.3.12.2  yamt 		return;
    150  1.3.12.2  yamt 	}
    151  1.3.12.2  yamt 
    152  1.3.12.2  yamt 	pxa2x0_gpio_set_function(sc->sc_ac_detect_pin, GPIO_IN);
    153  1.3.12.2  yamt 	pxa2x0_gpio_set_function(sc->sc_charge_comp_pin, GPIO_IN);
    154  1.3.12.2  yamt 	pxa2x0_gpio_set_function(sc->sc_batt_cover_pin, GPIO_IN);
    155  1.3.12.2  yamt 
    156  1.3.12.2  yamt 	(void)pxa2x0_gpio_intr_establish(sc->sc_ac_detect_pin,
    157  1.3.12.2  yamt 	    IST_EDGE_BOTH, IPL_BIO, zapm_acintr, sc);
    158  1.3.12.2  yamt 	(void)pxa2x0_gpio_intr_establish(sc->sc_charge_comp_pin,
    159  1.3.12.2  yamt 	    IST_EDGE_BOTH, IPL_BIO, zapm_bcintr, sc);
    160  1.3.12.2  yamt 
    161  1.3.12.2  yamt 	/* machine-independent part */
    162  1.3.12.2  yamt 	sc->events = 0;
    163  1.3.12.2  yamt 	sc->power_state = APM_SYS_READY;
    164  1.3.12.2  yamt 	sc->battery_state = APM_BATT_FLAG_UNKNOWN;
    165  1.3.12.2  yamt 	sc->ac_state = APM_AC_UNKNOWN;
    166  1.3.12.2  yamt 	sc->battery_life = APM_BATT_LIFE_UNKNOWN;
    167  1.3.12.2  yamt 	sc->minutes_left = 0;
    168  1.3.12.2  yamt 	sc->sc_standby_hook = config_hook(CONFIG_HOOK_PMEVENT,
    169  1.3.12.2  yamt 					  CONFIG_HOOK_PMEVENT_STANDBYREQ,
    170  1.3.12.2  yamt 					  CONFIG_HOOK_EXCLUSIVE,
    171  1.3.12.2  yamt 					  zapm_hook, sc);
    172  1.3.12.2  yamt 	sc->sc_suspend_hook = config_hook(CONFIG_HOOK_PMEVENT,
    173  1.3.12.2  yamt 					  CONFIG_HOOK_PMEVENT_SUSPENDREQ,
    174  1.3.12.2  yamt 					  CONFIG_HOOK_EXCLUSIVE,
    175  1.3.12.2  yamt 					  zapm_hook, sc);
    176  1.3.12.2  yamt 
    177  1.3.12.2  yamt 	sc->sc_battery_hook = config_hook(CONFIG_HOOK_PMEVENT,
    178  1.3.12.2  yamt 					  CONFIG_HOOK_PMEVENT_BATTERY,
    179  1.3.12.2  yamt 					  CONFIG_HOOK_SHARE,
    180  1.3.12.2  yamt 					  zapm_hook, sc);
    181  1.3.12.2  yamt 
    182  1.3.12.2  yamt 	sc->sc_ac_hook = config_hook(CONFIG_HOOK_PMEVENT,
    183  1.3.12.2  yamt 				     CONFIG_HOOK_PMEVENT_AC,
    184  1.3.12.2  yamt 				     CONFIG_HOOK_SHARE,
    185  1.3.12.2  yamt 				     zapm_hook, sc);
    186  1.3.12.2  yamt 
    187  1.3.12.2  yamt 	aaa.accessops = &zapm_accessops;
    188  1.3.12.2  yamt 	aaa.accesscookie = sc;
    189  1.3.12.2  yamt 	aaa.apm_detail = 0x0102;
    190  1.3.12.2  yamt 
    191  1.3.12.2  yamt 	sc->sc_apmdev = config_found_ia(self, "apmdevif", &aaa, apmprint);
    192  1.3.12.2  yamt 	if (sc->sc_apmdev != NULL) {
    193  1.3.12.2  yamt 		zapm_poll1(sc, 0);
    194  1.3.12.2  yamt 		callout_schedule(&sc->sc_cyclic_poll, CYCLIC_TIME);
    195  1.3.12.2  yamt 	}
    196  1.3.12.2  yamt }
    197  1.3.12.2  yamt 
    198  1.3.12.2  yamt static int
    199  1.3.12.2  yamt zapm_hook(void *v, int type, long id, void *msg)
    200  1.3.12.2  yamt {
    201  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    202  1.3.12.2  yamt 	int charge;
    203  1.3.12.2  yamt 	int message;
    204  1.3.12.2  yamt 	int s;
    205  1.3.12.2  yamt 
    206  1.3.12.2  yamt 	if (type != CONFIG_HOOK_PMEVENT)
    207  1.3.12.2  yamt 		return 1;
    208  1.3.12.2  yamt 
    209  1.3.12.2  yamt 	if (CONFIG_HOOK_VALUEP(msg))
    210  1.3.12.2  yamt 		message = (int)msg;
    211  1.3.12.2  yamt 	else
    212  1.3.12.2  yamt 		message = *(int *)msg;
    213  1.3.12.2  yamt 
    214  1.3.12.2  yamt 	s = splhigh();
    215  1.3.12.2  yamt 
    216  1.3.12.2  yamt 	switch (id) {
    217  1.3.12.2  yamt 	case CONFIG_HOOK_PMEVENT_STANDBYREQ:
    218  1.3.12.2  yamt 		if (sc->power_state != APM_SYS_STANDBY) {
    219  1.3.12.2  yamt 			sc->events |= (1 << APM_USER_STANDBY_REQ);
    220  1.3.12.2  yamt 		} else {
    221  1.3.12.2  yamt 			sc->events |= (1 << APM_NORMAL_RESUME);
    222  1.3.12.2  yamt 		}
    223  1.3.12.2  yamt 		break;
    224  1.3.12.2  yamt 	case CONFIG_HOOK_PMEVENT_SUSPENDREQ:
    225  1.3.12.2  yamt 		if (sc->power_state != APM_SYS_SUSPEND) {
    226  1.3.12.2  yamt 			DPRINTF(("zapm: suspend request\n"));
    227  1.3.12.2  yamt 			sc->events |= (1 << APM_USER_SUSPEND_REQ);
    228  1.3.12.2  yamt 		} else {
    229  1.3.12.2  yamt 			sc->events |= (1 << APM_NORMAL_RESUME);
    230  1.3.12.2  yamt 		}
    231  1.3.12.2  yamt 		break;
    232  1.3.12.2  yamt 	case CONFIG_HOOK_PMEVENT_BATTERY:
    233  1.3.12.2  yamt 		switch (message) {
    234  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_CRITICAL:
    235  1.3.12.2  yamt 			DPRINTF(("zapm: battery state critical\n"));
    236  1.3.12.2  yamt 			charge = sc->battery_state & APM_BATT_FLAG_CHARGING;
    237  1.3.12.2  yamt 			sc->battery_state = APM_BATT_FLAG_CRITICAL;
    238  1.3.12.2  yamt 			sc->battery_state |= charge;
    239  1.3.12.2  yamt 			sc->battery_life = 0;
    240  1.3.12.2  yamt 			break;
    241  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_LOW:
    242  1.3.12.2  yamt 			DPRINTF(("zapm: battery state low\n"));
    243  1.3.12.2  yamt 			charge = sc->battery_state & APM_BATT_FLAG_CHARGING;
    244  1.3.12.2  yamt 			sc->battery_state = APM_BATT_FLAG_LOW;
    245  1.3.12.2  yamt 			sc->battery_state |= charge;
    246  1.3.12.2  yamt 			break;
    247  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_HIGH:
    248  1.3.12.2  yamt 			DPRINTF(("zapm: battery state high\n"));
    249  1.3.12.2  yamt 			charge = sc->battery_state & APM_BATT_FLAG_CHARGING;
    250  1.3.12.2  yamt 			sc->battery_state = APM_BATT_FLAG_HIGH;
    251  1.3.12.2  yamt 			sc->battery_state |= charge;
    252  1.3.12.2  yamt 			break;
    253  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_10P:
    254  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 10%%\n"));
    255  1.3.12.2  yamt 			sc->battery_life = 10;
    256  1.3.12.2  yamt 			break;
    257  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_20P:
    258  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 20%%\n"));
    259  1.3.12.2  yamt 			sc->battery_life = 20;
    260  1.3.12.2  yamt 			break;
    261  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_30P:
    262  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 30%%\n"));
    263  1.3.12.2  yamt 			sc->battery_life = 30;
    264  1.3.12.2  yamt 			break;
    265  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_40P:
    266  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 40%%\n"));
    267  1.3.12.2  yamt 			sc->battery_life = 40;
    268  1.3.12.2  yamt 			break;
    269  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_50P:
    270  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 50%%\n"));
    271  1.3.12.2  yamt 			sc->battery_life = 50;
    272  1.3.12.2  yamt 			break;
    273  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_60P:
    274  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 60%%\n"));
    275  1.3.12.2  yamt 			sc->battery_life = 60;
    276  1.3.12.2  yamt 			break;
    277  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_70P:
    278  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 70%%\n"));
    279  1.3.12.2  yamt 			sc->battery_life = 70;
    280  1.3.12.2  yamt 			break;
    281  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_80P:
    282  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 80%%\n"));
    283  1.3.12.2  yamt 			sc->battery_life = 80;
    284  1.3.12.2  yamt 			break;
    285  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_90P:
    286  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 90%%\n"));
    287  1.3.12.2  yamt 			sc->battery_life = 90;
    288  1.3.12.2  yamt 			break;
    289  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_100P:
    290  1.3.12.2  yamt 			DPRINTF(("zapm: battery life 100%%\n"));
    291  1.3.12.2  yamt 			sc->battery_life = 100;
    292  1.3.12.2  yamt 			break;
    293  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_UNKNOWN:
    294  1.3.12.2  yamt 			DPRINTF(("zapm: battery state unknown\n"));
    295  1.3.12.2  yamt 			sc->battery_state = APM_BATT_FLAG_UNKNOWN;
    296  1.3.12.2  yamt 			sc->battery_life = APM_BATT_LIFE_UNKNOWN;
    297  1.3.12.2  yamt 			break;
    298  1.3.12.2  yamt 		case CONFIG_HOOK_BATT_NO_SYSTEM_BATTERY:
    299  1.3.12.2  yamt 			DPRINTF(("zapm: battery state no system battery?\n"));
    300  1.3.12.2  yamt 			sc->battery_state = APM_BATT_FLAG_NO_SYSTEM_BATTERY;
    301  1.3.12.2  yamt 			sc->battery_life = APM_BATT_LIFE_UNKNOWN;
    302  1.3.12.2  yamt 			break;
    303  1.3.12.2  yamt 		}
    304  1.3.12.2  yamt 		break;
    305  1.3.12.2  yamt 	case CONFIG_HOOK_PMEVENT_AC:
    306  1.3.12.2  yamt 		switch (message) {
    307  1.3.12.2  yamt 		case CONFIG_HOOK_AC_OFF:
    308  1.3.12.2  yamt 			DPRINTF(("zapm: ac not connected\n"));
    309  1.3.12.2  yamt 			sc->battery_state &= ~APM_BATT_FLAG_CHARGING;
    310  1.3.12.2  yamt 			sc->ac_state = APM_AC_OFF;
    311  1.3.12.2  yamt 			break;
    312  1.3.12.2  yamt 		case CONFIG_HOOK_AC_ON_CHARGE:
    313  1.3.12.2  yamt 			DPRINTF(("zapm: charging\n"));
    314  1.3.12.2  yamt 			sc->battery_state |= APM_BATT_FLAG_CHARGING;
    315  1.3.12.2  yamt 			sc->ac_state = APM_AC_ON;
    316  1.3.12.2  yamt 			break;
    317  1.3.12.2  yamt 		case CONFIG_HOOK_AC_ON_NOCHARGE:
    318  1.3.12.2  yamt 			DPRINTF(("zapm: ac connected\n"));
    319  1.3.12.2  yamt 			sc->battery_state &= ~APM_BATT_FLAG_CHARGING;
    320  1.3.12.2  yamt 			sc->ac_state = APM_AC_ON;
    321  1.3.12.2  yamt 			break;
    322  1.3.12.2  yamt 		case CONFIG_HOOK_AC_UNKNOWN:
    323  1.3.12.2  yamt 			sc->ac_state = APM_AC_UNKNOWN;
    324  1.3.12.2  yamt 			break;
    325  1.3.12.2  yamt 		}
    326  1.3.12.2  yamt 		break;
    327  1.3.12.2  yamt 	}
    328  1.3.12.2  yamt 
    329  1.3.12.2  yamt 	splx(s);
    330  1.3.12.2  yamt 
    331  1.3.12.2  yamt 	return 0;
    332  1.3.12.2  yamt }
    333  1.3.12.2  yamt 
    334  1.3.12.2  yamt static void
    335  1.3.12.2  yamt zapm_disconnect(void *v)
    336  1.3.12.2  yamt {
    337  1.3.12.2  yamt #if 0
    338  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    339  1.3.12.2  yamt #endif
    340  1.3.12.2  yamt }
    341  1.3.12.2  yamt 
    342  1.3.12.2  yamt static void
    343  1.3.12.2  yamt zapm_enable(void *v, int onoff)
    344  1.3.12.2  yamt {
    345  1.3.12.2  yamt #if 0
    346  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    347  1.3.12.2  yamt #endif
    348  1.3.12.2  yamt }
    349  1.3.12.2  yamt 
    350  1.3.12.2  yamt static int
    351  1.3.12.2  yamt zapm_set_powstate(void *v, u_int devid, u_int powstat)
    352  1.3.12.2  yamt {
    353  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    354  1.3.12.2  yamt 
    355  1.3.12.2  yamt 	if (devid != APM_DEV_ALLDEVS)
    356  1.3.12.2  yamt 		return APM_ERR_UNRECOG_DEV;
    357  1.3.12.2  yamt 
    358  1.3.12.2  yamt 	switch (powstat) {
    359  1.3.12.2  yamt 	case APM_SYS_READY:
    360  1.3.12.2  yamt 		DPRINTF(("zapm: set power state READY\n"));
    361  1.3.12.2  yamt 		sc->power_state = APM_SYS_READY;
    362  1.3.12.2  yamt 		break;
    363  1.3.12.2  yamt 	case APM_SYS_STANDBY:
    364  1.3.12.2  yamt 		DPRINTF(("zapm: set power state STANDBY\n"));
    365  1.3.12.2  yamt 		/* XXX */
    366  1.3.12.2  yamt 		DPRINTF(("zapm: resume\n"));
    367  1.3.12.2  yamt 		break;
    368  1.3.12.2  yamt 	case APM_SYS_SUSPEND:
    369  1.3.12.2  yamt 		DPRINTF(("zapm: set power state SUSPEND...\n"));
    370  1.3.12.2  yamt 		/* XXX */
    371  1.3.12.2  yamt 		DPRINTF(("zapm: resume\n"));
    372  1.3.12.2  yamt 		break;
    373  1.3.12.2  yamt 	case APM_SYS_OFF:
    374  1.3.12.2  yamt 		DPRINTF(("zapm: set power state OFF\n"));
    375  1.3.12.2  yamt 		sc->power_state = APM_SYS_OFF;
    376  1.3.12.2  yamt 		break;
    377  1.3.12.2  yamt 	case APM_LASTREQ_INPROG:
    378  1.3.12.2  yamt 		/*DPRINTF(("zapm: set power state INPROG\n"));*/
    379  1.3.12.2  yamt 		break;
    380  1.3.12.2  yamt 	case APM_LASTREQ_REJECTED:
    381  1.3.12.2  yamt 		DPRINTF(("zapm: set power state REJECTED\n"));
    382  1.3.12.2  yamt 		break;
    383  1.3.12.2  yamt 	}
    384  1.3.12.2  yamt 
    385  1.3.12.2  yamt 	return 0;
    386  1.3.12.2  yamt }
    387  1.3.12.2  yamt 
    388  1.3.12.2  yamt static int
    389  1.3.12.2  yamt zapm_get_powstat(void *v, struct apm_power_info *pinfo)
    390  1.3.12.2  yamt {
    391  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    392  1.3.12.2  yamt 	int val;
    393  1.3.12.2  yamt 
    394  1.3.12.2  yamt 	if (config_hook_call(CONFIG_HOOK_GET,
    395  1.3.12.2  yamt 			     CONFIG_HOOK_ACADAPTER, &val) != -1)
    396  1.3.12.2  yamt 		pinfo->ac_state = val;
    397  1.3.12.2  yamt 	else
    398  1.3.12.2  yamt 		pinfo->ac_state = sc->ac_state;
    399  1.3.12.2  yamt 	if (config_hook_call(CONFIG_HOOK_GET,
    400  1.3.12.2  yamt 			     CONFIG_HOOK_CHARGE, &val) != -1)
    401  1.3.12.2  yamt 		pinfo->battery_state = val;
    402  1.3.12.2  yamt 	else
    403  1.3.12.2  yamt 		pinfo->battery_state = sc->battery_state;
    404  1.3.12.2  yamt 	if (config_hook_call(CONFIG_HOOK_GET,
    405  1.3.12.2  yamt 			     CONFIG_HOOK_BATTERYVAL, &val) != -1)
    406  1.3.12.2  yamt 		pinfo->battery_life = val;
    407  1.3.12.2  yamt 	else
    408  1.3.12.2  yamt 		pinfo->battery_life = sc->battery_life;
    409  1.3.12.2  yamt 
    410  1.3.12.2  yamt 	return 0;
    411  1.3.12.2  yamt }
    412  1.3.12.2  yamt 
    413  1.3.12.2  yamt static int
    414  1.3.12.2  yamt zapm_get_event(void *v, u_int *event_type, u_int *event_info)
    415  1.3.12.2  yamt {
    416  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    417  1.3.12.2  yamt 	u_int ev;
    418  1.3.12.2  yamt 	int s;
    419  1.3.12.2  yamt 
    420  1.3.12.2  yamt 	s = splhigh();
    421  1.3.12.2  yamt 	for (ev = APM_STANDBY_REQ; ev <= APM_CAP_CHANGE; ev++) {
    422  1.3.12.2  yamt 		if (sc->events & (1 << ev)) {
    423  1.3.12.2  yamt 			sc->events &= ~(1 << ev);
    424  1.3.12.2  yamt 			*event_type = ev;
    425  1.3.12.2  yamt 			if (*event_type == APM_NORMAL_RESUME ||
    426  1.3.12.2  yamt 			    *event_type == APM_CRIT_RESUME) {
    427  1.3.12.2  yamt 				/* pccard power off in the suspend state */
    428  1.3.12.2  yamt 				*event_info = 1;
    429  1.3.12.2  yamt 				sc->power_state = APM_SYS_READY;
    430  1.3.12.2  yamt 			} else {
    431  1.3.12.2  yamt 				*event_info = 0;
    432  1.3.12.2  yamt 			}
    433  1.3.12.2  yamt 			splx(s);
    434  1.3.12.2  yamt 
    435  1.3.12.2  yamt 			return 0;
    436  1.3.12.2  yamt 		}
    437  1.3.12.2  yamt 	}
    438  1.3.12.2  yamt 	splx(s);
    439  1.3.12.2  yamt 
    440  1.3.12.2  yamt 	return APM_ERR_NOEVENTS;
    441  1.3.12.2  yamt }
    442  1.3.12.2  yamt 
    443  1.3.12.2  yamt static void
    444  1.3.12.2  yamt zapm_cpu_busy(void *v)
    445  1.3.12.2  yamt {
    446  1.3.12.2  yamt #if 0
    447  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    448  1.3.12.2  yamt #endif
    449  1.3.12.2  yamt }
    450  1.3.12.2  yamt 
    451  1.3.12.2  yamt static void
    452  1.3.12.2  yamt zapm_cpu_idle(void *v)
    453  1.3.12.2  yamt {
    454  1.3.12.2  yamt #if 0
    455  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    456  1.3.12.2  yamt #endif
    457  1.3.12.2  yamt }
    458  1.3.12.2  yamt 
    459  1.3.12.2  yamt static void
    460  1.3.12.2  yamt zapm_get_capabilities(void *v, u_int *numbatts, u_int *capflags)
    461  1.3.12.2  yamt {
    462  1.3.12.2  yamt #if 0
    463  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    464  1.3.12.2  yamt #endif
    465  1.3.12.2  yamt 
    466  1.3.12.2  yamt 	*numbatts = 1;
    467  1.3.12.2  yamt 	*capflags = 0 /* | APM_GLOBAL_STANDBY | APM_GLOBAL_SUSPEND */;
    468  1.3.12.2  yamt }
    469  1.3.12.2  yamt 
    470  1.3.12.2  yamt /*-----------------------------------------------------------------------------
    471  1.3.12.2  yamt  * zaurus depent part
    472  1.3.12.2  yamt  */
    473  1.3.12.2  yamt /* MAX1111 command word */
    474  1.3.12.2  yamt #define MAXCTRL_PD0		(1<<0)
    475  1.3.12.2  yamt #define MAXCTRL_PD1		(1<<1)
    476  1.3.12.2  yamt #define MAXCTRL_SGL		(1<<2)
    477  1.3.12.2  yamt #define MAXCTRL_UNI		(1<<3)
    478  1.3.12.2  yamt #define MAXCTRL_SEL_SHIFT	4
    479  1.3.12.2  yamt #define MAXCTRL_STR		(1<<7)
    480  1.3.12.2  yamt 
    481  1.3.12.2  yamt /* MAX1111 ADC channels */
    482  1.3.12.2  yamt #define	BATT_THM		2
    483  1.3.12.2  yamt #define	BATT_AD			4
    484  1.3.12.2  yamt #define JK_VAD			6
    485  1.3.12.2  yamt 
    486  1.3.12.2  yamt /*
    487  1.3.12.2  yamt  * Battery-specific information
    488  1.3.12.2  yamt  */
    489  1.3.12.2  yamt struct battery_threshold {
    490  1.3.12.2  yamt 	int	percent;
    491  1.3.12.2  yamt 	int	value;
    492  1.3.12.2  yamt 	int	state;
    493  1.3.12.2  yamt };
    494  1.3.12.2  yamt 
    495  1.3.12.2  yamt struct battery_info {
    496  1.3.12.2  yamt 	const struct battery_threshold *bi_thres;
    497  1.3.12.2  yamt };
    498  1.3.12.2  yamt 
    499  1.3.12.2  yamt static const struct battery_threshold zaurus_battery_life_c3000[] = {
    500  1.3.12.2  yamt 	{ 100,	194,	CONFIG_HOOK_BATT_HIGH		},
    501  1.3.12.2  yamt 	{  75,	188,	CONFIG_HOOK_BATT_HIGH		},
    502  1.3.12.2  yamt 	{  50,	184,	CONFIG_HOOK_BATT_HIGH		},
    503  1.3.12.2  yamt 	{  25,	180,	CONFIG_HOOK_BATT_LOW		},
    504  1.3.12.2  yamt 	{   5,	178,	CONFIG_HOOK_BATT_LOW		},
    505  1.3.12.2  yamt 	{   0,	  0,	CONFIG_HOOK_BATT_CRITICAL	}
    506  1.3.12.2  yamt };
    507  1.3.12.2  yamt 
    508  1.3.12.2  yamt static const struct battery_info zaurus_battery_c3000 = {
    509  1.3.12.2  yamt 	zaurus_battery_life_c3000
    510  1.3.12.2  yamt };
    511  1.3.12.2  yamt 
    512  1.3.12.2  yamt static const struct battery_info *zaurus_main_battery = &zaurus_battery_c3000;
    513  1.3.12.2  yamt 
    514  1.3.12.2  yamt /* Restart charging this many times before accepting BATT_FULL. */
    515  1.3.12.2  yamt #define	MIN_BATT_FULL		2
    516  1.3.12.2  yamt 
    517  1.3.12.2  yamt /* Discharge 100 ms before reading the voltage if AC is connected. */
    518  1.3.12.2  yamt #define	DISCHARGE_TIMEOUT	(hz / 10)
    519  1.3.12.2  yamt 
    520  1.3.12.2  yamt /* Check battery voltage and "kick charging" every minute. */
    521  1.3.12.2  yamt static const struct timeval zapm_battchkrate = { 60, 0 };
    522  1.3.12.2  yamt 
    523  1.3.12.2  yamt static int	zapm_get_ac_state(struct zapm_softc *);
    524  1.3.12.2  yamt static int	zapm_get_battery_compartment_state(struct zapm_softc *);
    525  1.3.12.2  yamt static int	zapm_get_charge_complete_state(struct zapm_softc *);
    526  1.3.12.2  yamt static void	zapm_set_charging(struct zapm_softc *, int);
    527  1.3.12.2  yamt static int	zapm_charge_complete(struct zapm_softc *);
    528  1.3.12.2  yamt static int	max1111_adc_value_avg(int, int);
    529  1.3.12.2  yamt static int	zapm_get_battery_volt(void);
    530  1.3.12.2  yamt static int	zapm_battery_state(int volt);
    531  1.3.12.2  yamt static int	zapm_battery_life(int volt);
    532  1.3.12.2  yamt 
    533  1.3.12.2  yamt static int
    534  1.3.12.2  yamt zapm_acintr(void *v)
    535  1.3.12.2  yamt {
    536  1.3.12.2  yamt 
    537  1.3.12.2  yamt 	zapm_poll1(v, 1);
    538  1.3.12.2  yamt 
    539  1.3.12.2  yamt 	return 1;
    540  1.3.12.2  yamt }
    541  1.3.12.2  yamt 
    542  1.3.12.2  yamt static int
    543  1.3.12.2  yamt zapm_bcintr(void *v)
    544  1.3.12.2  yamt {
    545  1.3.12.2  yamt 
    546  1.3.12.2  yamt 	zapm_poll1(v, 1);
    547  1.3.12.2  yamt 
    548  1.3.12.2  yamt 	return 1;
    549  1.3.12.2  yamt }
    550  1.3.12.2  yamt 
    551  1.3.12.2  yamt static void
    552  1.3.12.2  yamt zapm_cyclic(void *v)
    553  1.3.12.2  yamt {
    554  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    555  1.3.12.2  yamt 
    556  1.3.12.2  yamt 	zapm_poll1(sc, 1);
    557  1.3.12.2  yamt 
    558  1.3.12.2  yamt 	callout_schedule(&sc->sc_cyclic_poll, CYCLIC_TIME);
    559  1.3.12.2  yamt }
    560  1.3.12.2  yamt 
    561  1.3.12.2  yamt static void
    562  1.3.12.2  yamt zapm_poll(void *v)
    563  1.3.12.2  yamt {
    564  1.3.12.2  yamt 
    565  1.3.12.2  yamt 	zapm_poll1(v, 1);
    566  1.3.12.2  yamt }
    567  1.3.12.2  yamt 
    568  1.3.12.2  yamt static int
    569  1.3.12.2  yamt zapm_get_ac_state(struct zapm_softc *sc)
    570  1.3.12.2  yamt {
    571  1.3.12.2  yamt 
    572  1.3.12.2  yamt 	if (!pxa2x0_gpio_get_bit(sc->sc_ac_detect_pin))
    573  1.3.12.2  yamt 		return APM_AC_ON;
    574  1.3.12.2  yamt 	return APM_AC_OFF;
    575  1.3.12.2  yamt }
    576  1.3.12.2  yamt 
    577  1.3.12.2  yamt static int
    578  1.3.12.2  yamt zapm_get_battery_compartment_state(struct zapm_softc *sc)
    579  1.3.12.2  yamt {
    580  1.3.12.2  yamt 
    581  1.3.12.2  yamt 	return pxa2x0_gpio_get_bit(sc->sc_batt_cover_pin);
    582  1.3.12.2  yamt }
    583  1.3.12.2  yamt 
    584  1.3.12.2  yamt static int
    585  1.3.12.2  yamt zapm_get_charge_complete_state(struct zapm_softc *sc)
    586  1.3.12.2  yamt {
    587  1.3.12.2  yamt 
    588  1.3.12.2  yamt 	return pxa2x0_gpio_get_bit(sc->sc_charge_comp_pin);
    589  1.3.12.2  yamt }
    590  1.3.12.2  yamt 
    591  1.3.12.2  yamt static void
    592  1.3.12.2  yamt zapm_set_charging(struct zapm_softc *sc, int enable)
    593  1.3.12.2  yamt {
    594  1.3.12.2  yamt 
    595  1.3.12.2  yamt 	scoop_discharge_battery(0);
    596  1.3.12.2  yamt 	scoop_charge_battery(enable, 0);
    597  1.3.12.2  yamt 	scoop_led_set(SCOOP_LED_ORANGE, enable);
    598  1.3.12.2  yamt }
    599  1.3.12.2  yamt 
    600  1.3.12.2  yamt /*
    601  1.3.12.2  yamt  * Return non-zero if the charge complete signal indicates that the
    602  1.3.12.2  yamt  * battery is fully charged.  Restart charging to clear this signal.
    603  1.3.12.2  yamt  */
    604  1.3.12.2  yamt static int
    605  1.3.12.2  yamt zapm_charge_complete(struct zapm_softc *sc)
    606  1.3.12.2  yamt {
    607  1.3.12.2  yamt 
    608  1.3.12.2  yamt 	if (sc->charging && sc->battery_full_cnt < MIN_BATT_FULL) {
    609  1.3.12.2  yamt 		if (zapm_get_charge_complete_state(sc)) {
    610  1.3.12.2  yamt 			sc->battery_full_cnt++;
    611  1.3.12.2  yamt 			if (sc->battery_full_cnt < MIN_BATT_FULL) {
    612  1.3.12.2  yamt 				DPRINTF(("battery almost full\n"));
    613  1.3.12.2  yamt 				zapm_set_charging(sc, 0);
    614  1.3.12.2  yamt 				delay(15000);
    615  1.3.12.2  yamt 				zapm_set_charging(sc, 1);
    616  1.3.12.2  yamt 			}
    617  1.3.12.2  yamt 		} else if (sc->battery_full_cnt > 0) {
    618  1.3.12.2  yamt 			/* false alarm */
    619  1.3.12.2  yamt 			sc->battery_full_cnt = 0;
    620  1.3.12.2  yamt 			zapm_set_charging(sc, 0);
    621  1.3.12.2  yamt 			delay(15000);
    622  1.3.12.2  yamt 			zapm_set_charging(sc, 1);
    623  1.3.12.2  yamt 		}
    624  1.3.12.2  yamt 	}
    625  1.3.12.2  yamt 
    626  1.3.12.2  yamt 	return (sc->battery_full_cnt >= MIN_BATT_FULL);
    627  1.3.12.2  yamt }
    628  1.3.12.2  yamt 
    629  1.3.12.2  yamt static int
    630  1.3.12.2  yamt max1111_adc_value(int chan)
    631  1.3.12.2  yamt {
    632  1.3.12.2  yamt 
    633  1.3.12.2  yamt 	return ((int)zssp_ic_send(ZSSP_IC_MAX1111, MAXCTRL_PD0 |
    634  1.3.12.2  yamt 	    MAXCTRL_PD1 | MAXCTRL_SGL | MAXCTRL_UNI |
    635  1.3.12.2  yamt 	    (chan << MAXCTRL_SEL_SHIFT) | MAXCTRL_STR));
    636  1.3.12.2  yamt }
    637  1.3.12.2  yamt 
    638  1.3.12.2  yamt /* XXX simplify */
    639  1.3.12.2  yamt static int
    640  1.3.12.2  yamt max1111_adc_value_avg(int chan, int pause)
    641  1.3.12.2  yamt {
    642  1.3.12.2  yamt 	int val[5];
    643  1.3.12.2  yamt 	int i, j, k, x;
    644  1.3.12.2  yamt 	int sum = 0;
    645  1.3.12.2  yamt 
    646  1.3.12.2  yamt 	DPRINTF(("max1111_adc_value_avg: chan = %d, pause = %d\n",
    647  1.3.12.2  yamt 	    chan, pause));
    648  1.3.12.2  yamt 
    649  1.3.12.2  yamt 	for (i = 0; i < 5; i++) {
    650  1.3.12.2  yamt 		val[i] = max1111_adc_value(chan);
    651  1.3.12.2  yamt 		if (i != 4)
    652  1.3.12.2  yamt 			delay(pause * 1000);
    653  1.3.12.2  yamt 		DPRINTF(("max1111_adc_value_avg: chan[%d] = %d\n", i, val[i]));
    654  1.3.12.2  yamt 	}
    655  1.3.12.2  yamt 
    656  1.3.12.2  yamt 	x = val[0];
    657  1.3.12.2  yamt 	j = 0;
    658  1.3.12.2  yamt 	for (i = 1; i < 5; i++) {
    659  1.3.12.2  yamt 		if (x < val[i]) {
    660  1.3.12.2  yamt 			x = val[i];
    661  1.3.12.2  yamt 			j = i;
    662  1.3.12.2  yamt 		}
    663  1.3.12.2  yamt 	}
    664  1.3.12.2  yamt 
    665  1.3.12.2  yamt 	x = val[4];
    666  1.3.12.2  yamt 	k = 4;
    667  1.3.12.2  yamt 	for (i = 3; i >= 0; i--) {
    668  1.3.12.2  yamt 		if (x > val[i]) {
    669  1.3.12.2  yamt 			x = val[i];
    670  1.3.12.2  yamt 			k = i;
    671  1.3.12.2  yamt 		}
    672  1.3.12.2  yamt 	}
    673  1.3.12.2  yamt 
    674  1.3.12.2  yamt 	DPRINTF(("max1111_adc_value_avg: j = %d, k = %d\n", j, k));
    675  1.3.12.2  yamt 	for (i = 0; i < 5; i++) {
    676  1.3.12.2  yamt 		if (i == j || i == k)
    677  1.3.12.2  yamt 			continue;
    678  1.3.12.2  yamt 		sum += val[i];
    679  1.3.12.2  yamt 	}
    680  1.3.12.2  yamt 
    681  1.3.12.2  yamt 	DPRINTF(("max1111_adc_value_avg: sum = %d, sum / 3 = %d\n",
    682  1.3.12.2  yamt 	    sum, sum / 3));
    683  1.3.12.2  yamt 
    684  1.3.12.2  yamt 	return sum / 3;
    685  1.3.12.2  yamt }
    686  1.3.12.2  yamt 
    687  1.3.12.2  yamt static int
    688  1.3.12.2  yamt zapm_get_battery_volt(void)
    689  1.3.12.2  yamt {
    690  1.3.12.2  yamt 
    691  1.3.12.2  yamt 	return max1111_adc_value_avg(BATT_AD, 10);
    692  1.3.12.2  yamt }
    693  1.3.12.2  yamt 
    694  1.3.12.2  yamt static int
    695  1.3.12.2  yamt zapm_battery_state(int volt)
    696  1.3.12.2  yamt {
    697  1.3.12.2  yamt 	const struct battery_threshold *bthr;
    698  1.3.12.2  yamt 	int i;
    699  1.3.12.2  yamt 
    700  1.3.12.2  yamt 	bthr = zaurus_main_battery->bi_thres;
    701  1.3.12.2  yamt 
    702  1.3.12.2  yamt 	for (i = 0; bthr[i].value > 0; i++)
    703  1.3.12.2  yamt 		if (bthr[i].value <= volt)
    704  1.3.12.2  yamt 			break;
    705  1.3.12.2  yamt 
    706  1.3.12.2  yamt 	return bthr[i].state;
    707  1.3.12.2  yamt }
    708  1.3.12.2  yamt 
    709  1.3.12.2  yamt static int
    710  1.3.12.2  yamt zapm_battery_life(int volt)
    711  1.3.12.2  yamt {
    712  1.3.12.2  yamt 	const struct battery_threshold *bthr;
    713  1.3.12.2  yamt 	int i;
    714  1.3.12.2  yamt 
    715  1.3.12.2  yamt 	bthr = zaurus_main_battery->bi_thres;
    716  1.3.12.2  yamt 
    717  1.3.12.2  yamt 	for (i = 0; bthr[i].value > 0; i++)
    718  1.3.12.2  yamt 		if (bthr[i].value <= volt)
    719  1.3.12.2  yamt 			break;
    720  1.3.12.2  yamt 
    721  1.3.12.2  yamt 	if (i == 0)
    722  1.3.12.2  yamt 		return bthr[0].percent;
    723  1.3.12.2  yamt 
    724  1.3.12.2  yamt 	return (bthr[i].percent +
    725  1.3.12.2  yamt 	    ((volt - bthr[i].value) * 100) /
    726  1.3.12.2  yamt 	    (bthr[i-1].value - bthr[i].value) *
    727  1.3.12.2  yamt 	    (bthr[i-1].percent - bthr[i].percent) / 100);
    728  1.3.12.2  yamt }
    729  1.3.12.2  yamt 
    730  1.3.12.2  yamt /*
    731  1.3.12.2  yamt  * Poll power-management related GPIO inputs, update battery life
    732  1.3.12.2  yamt  * in softc, and/or control battery charging.
    733  1.3.12.2  yamt  */
    734  1.3.12.2  yamt static void
    735  1.3.12.2  yamt zapm_poll1(void *v, int do_suspend)
    736  1.3.12.2  yamt {
    737  1.3.12.2  yamt 	struct zapm_softc *sc = (struct zapm_softc *)v;
    738  1.3.12.2  yamt 	int ac_state;
    739  1.3.12.2  yamt 	int bc_lock;
    740  1.3.12.2  yamt 	int charging;
    741  1.3.12.2  yamt 	int volt;
    742  1.3.12.2  yamt 	int s;
    743  1.3.12.2  yamt 
    744  1.3.12.2  yamt 	s = splhigh();
    745  1.3.12.2  yamt 
    746  1.3.12.2  yamt 	ac_state = zapm_get_ac_state(sc);
    747  1.3.12.2  yamt 	bc_lock = zapm_get_battery_compartment_state(sc);
    748  1.3.12.2  yamt 
    749  1.3.12.2  yamt 	/* Stop discharging. */
    750  1.3.12.2  yamt 	if (sc->discharging) {
    751  1.3.12.2  yamt 		sc->discharging = 0;
    752  1.3.12.2  yamt 		charging = 0;
    753  1.3.12.2  yamt 		volt = zapm_get_battery_volt();
    754  1.3.12.2  yamt 		DPRINTF(("zapm_poll: discharge off volt %d\n", volt));
    755  1.3.12.2  yamt 	} else {
    756  1.3.12.2  yamt 		charging = sc->battery_state & APM_BATT_FLAG_CHARGING;
    757  1.3.12.2  yamt 		volt = sc->battery_volt;
    758  1.3.12.2  yamt 	}
    759  1.3.12.2  yamt 
    760  1.3.12.2  yamt 	/* Start or stop charging as necessary. */
    761  1.3.12.2  yamt 	if (ac_state && bc_lock) {
    762  1.3.12.2  yamt 		int charge_completed = zapm_charge_complete(sc);
    763  1.3.12.2  yamt 		if (charging) {
    764  1.3.12.2  yamt 			if (charge_completed) {
    765  1.3.12.2  yamt 				DPRINTF(("zapm_poll: battery is full\n"));
    766  1.3.12.2  yamt 				charging = 0;
    767  1.3.12.2  yamt 				zapm_set_charging(sc, 0);
    768  1.3.12.2  yamt 			}
    769  1.3.12.2  yamt 		} else if (!charge_completed) {
    770  1.3.12.2  yamt 			charging = 1;
    771  1.3.12.2  yamt 			volt = zapm_get_battery_volt();
    772  1.3.12.2  yamt 			zapm_set_charging(sc, 1);
    773  1.3.12.2  yamt 			DPRINTF(("zapm_poll: start charging volt %d\n", volt));
    774  1.3.12.2  yamt 		}
    775  1.3.12.2  yamt 	} else {
    776  1.3.12.2  yamt 		if (charging) {
    777  1.3.12.2  yamt 			charging = 0;
    778  1.3.12.2  yamt 			zapm_set_charging(sc, 0);
    779  1.3.12.2  yamt 			timerclear(&sc->sc_lastbattchk);
    780  1.3.12.2  yamt 			DPRINTF(("zapm_poll: stop charging\n"));
    781  1.3.12.2  yamt 		}
    782  1.3.12.2  yamt 		sc->battery_full_cnt = 0;
    783  1.3.12.2  yamt 	}
    784  1.3.12.2  yamt 
    785  1.3.12.2  yamt 	/*
    786  1.3.12.2  yamt 	 * Restart charging once in a while.  Discharge a few milliseconds
    787  1.3.12.2  yamt 	 * before updating the voltage in our softc if A/C is connected.
    788  1.3.12.2  yamt 	 */
    789  1.3.12.2  yamt 	if (bc_lock && ratecheck(&sc->sc_lastbattchk, &zapm_battchkrate)) {
    790  1.3.12.2  yamt 		if (do_suspend && sc->suspended) {
    791  1.3.12.2  yamt 			/* XXX */
    792  1.3.12.2  yamt #if 0
    793  1.3.12.2  yamt 			DPRINTF(("zapm_poll: suspended %lu %lu\n",
    794  1.3.12.2  yamt 			    sc->lastbattchk.tv_sec,
    795  1.3.12.2  yamt 			    pxa2x0_rtc_getsecs()));
    796  1.3.12.2  yamt 			if (charging) {
    797  1.3.12.2  yamt 				zapm_set_charging(sc, 0);
    798  1.3.12.2  yamt 				delay(15000);
    799  1.3.12.2  yamt 				zapm_set_charging(sc, 1);
    800  1.3.12.2  yamt 				pxa2x0_rtc_setalarm(pxa2x0_rtc_getsecs() +
    801  1.3.12.2  yamt 				    zapm_battchkrate.tv_sec + 1);
    802  1.3.12.2  yamt 			}
    803  1.3.12.2  yamt #endif
    804  1.3.12.2  yamt 		} else if (ac_state && sc->battery_full_cnt == 0) {
    805  1.3.12.2  yamt 			DPRINTF(("zapm_poll: discharge on\n"));
    806  1.3.12.2  yamt 			if (charging)
    807  1.3.12.2  yamt 				zapm_set_charging(sc, 0);
    808  1.3.12.2  yamt 			sc->discharging = 1;
    809  1.3.12.2  yamt 			scoop_discharge_battery(1);
    810  1.3.12.2  yamt 			callout_schedule(&sc->sc_discharge_poll,
    811  1.3.12.2  yamt 			    DISCHARGE_TIMEOUT);
    812  1.3.12.2  yamt 		} else if (!ac_state) {
    813  1.3.12.2  yamt 			volt = zapm_get_battery_volt();
    814  1.3.12.2  yamt 			DPRINTF(("zapm_poll: volt %d\n", volt));
    815  1.3.12.2  yamt 		}
    816  1.3.12.2  yamt 	}
    817  1.3.12.2  yamt 
    818  1.3.12.2  yamt 	/* Update the cached power state in our softc. */
    819  1.3.12.2  yamt 	if ((ac_state != sc->ac_state)
    820  1.3.12.2  yamt 	 || (charging != (sc->battery_state & APM_BATT_FLAG_CHARGING))) {
    821  1.3.12.2  yamt 		config_hook_call(CONFIG_HOOK_PMEVENT,
    822  1.3.12.2  yamt 		    CONFIG_HOOK_PMEVENT_AC,
    823  1.3.12.2  yamt 		    (void *)((ac_state == APM_AC_OFF)
    824  1.3.12.2  yamt 		        ? CONFIG_HOOK_AC_OFF
    825  1.3.12.2  yamt 		        : (charging ? CONFIG_HOOK_AC_ON_CHARGE
    826  1.3.12.2  yamt 		                    : CONFIG_HOOK_AC_ON_NOCHARGE)));
    827  1.3.12.2  yamt 	}
    828  1.3.12.2  yamt 	if (volt != sc->battery_volt) {
    829  1.3.12.2  yamt 		sc->battery_volt = volt;
    830  1.3.12.2  yamt 		sc->battery_life = zapm_battery_life(volt);
    831  1.3.12.2  yamt 		config_hook_call(CONFIG_HOOK_PMEVENT,
    832  1.3.12.2  yamt 		    CONFIG_HOOK_PMEVENT_BATTERY,
    833  1.3.12.2  yamt 		    (void *)zapm_battery_state(volt));
    834  1.3.12.2  yamt 	}
    835  1.3.12.2  yamt 
    836  1.3.12.2  yamt 	splx(s);
    837  1.3.12.2  yamt }
    838