Home | History | Annotate | Line # | Download | only in dev
      1  1.8    andvar /*	$NetBSD: psh3pwr.c,v 1.8 2024/09/20 19:32:19 andvar Exp $	*/
      2  1.1  kiyohara /*
      3  1.1  kiyohara  * Copyright (c) 2005, 2007 KIYOHARA Takashi
      4  1.1  kiyohara  * All rights reserved.
      5  1.1  kiyohara  *
      6  1.1  kiyohara  * Redistribution and use in source and binary forms, with or without
      7  1.1  kiyohara  * modification, are permitted provided that the following conditions
      8  1.1  kiyohara  * are met:
      9  1.1  kiyohara  * 1. Redistributions of source code must retain the above copyright
     10  1.1  kiyohara  *    notice, this list of conditions and the following disclaimer.
     11  1.1  kiyohara  * 2. Redistributions in binary form must reproduce the above copyright
     12  1.1  kiyohara  *    notice, this list of conditions and the following disclaimer in the
     13  1.1  kiyohara  *    documentation and/or other materials provided with the distribution.
     14  1.1  kiyohara  *
     15  1.1  kiyohara  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
     16  1.1  kiyohara  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
     17  1.1  kiyohara  * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
     18  1.1  kiyohara  * DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT,
     19  1.1  kiyohara  * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
     20  1.1  kiyohara  * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
     21  1.1  kiyohara  * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     22  1.1  kiyohara  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
     23  1.1  kiyohara  * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
     24  1.1  kiyohara  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     25  1.1  kiyohara  * POSSIBILITY OF SUCH DAMAGE.
     26  1.1  kiyohara  *
     27  1.1  kiyohara  */
     28  1.1  kiyohara 
     29  1.1  kiyohara #include <sys/cdefs.h>
     30  1.8    andvar __KERNEL_RCSID(0, "$NetBSD: psh3pwr.c,v 1.8 2024/09/20 19:32:19 andvar Exp $");
     31  1.1  kiyohara 
     32  1.1  kiyohara #include <sys/param.h>
     33  1.1  kiyohara #include <sys/kernel.h>
     34  1.1  kiyohara #include <sys/device.h>
     35  1.1  kiyohara #include <sys/systm.h>
     36  1.1  kiyohara #include <sys/callout.h>
     37  1.1  kiyohara 
     38  1.2  kiyohara #include <machine/config_hook.h>
     39  1.1  kiyohara #include <machine/platid.h>
     40  1.1  kiyohara #include <machine/platid_mask.h>
     41  1.1  kiyohara 
     42  1.2  kiyohara #include <dev/apm/apmbios.h>
     43  1.1  kiyohara 
     44  1.1  kiyohara #include <sh3/exception.h>
     45  1.1  kiyohara #include <sh3/intcreg.h>
     46  1.1  kiyohara #include <sh3/pfcreg.h>
     47  1.1  kiyohara 
     48  1.1  kiyohara #include <sh3/dev/adcvar.h>
     49  1.1  kiyohara 
     50  1.1  kiyohara 
     51  1.1  kiyohara #ifdef PSH3PWR_DEBUG
     52  1.1  kiyohara #define DPRINTF(arg)            printf arg
     53  1.1  kiyohara #else
     54  1.1  kiyohara #define DPRINTF(arg)            ((void)0)
     55  1.1  kiyohara #endif
     56  1.1  kiyohara 
     57  1.1  kiyohara 
     58  1.7    andvar /* A/D converter channels to get power stats from */
     59  1.1  kiyohara #define ADC_CHANNEL_BATTERY	3
     60  1.1  kiyohara 
     61  1.1  kiyohara /* On/Off bit for Green LED. pin 7 in SH7709 GPIO port H. */
     62  1.1  kiyohara #define PSH3_GREEN_LED_ON	0x80
     63  1.1  kiyohara 
     64  1.1  kiyohara /*
     65  1.1  kiyohara  * XXXX:
     66  1.1  kiyohara  *   WindowsCE seem to be using this as a flag.
     67  1.1  kiyohara  *   pin 6 in SH7709 GPIO port SCPDR.
     68  1.1  kiyohara  */
     69  1.1  kiyohara #define PSH3PWR_PLUG_OUT	0x40
     70  1.1  kiyohara 
     71  1.2  kiyohara 
     72  1.2  kiyohara static inline int __attribute__((__always_inline__))
     73  1.2  kiyohara psh3pwr_ac_is_off(void)
     74  1.2  kiyohara {
     75  1.2  kiyohara 
     76  1.2  kiyohara 	return _reg_read_1(SH7709_SCPDR) & PSH3PWR_PLUG_OUT;
     77  1.2  kiyohara }
     78  1.2  kiyohara 
     79  1.2  kiyohara 
     80  1.2  kiyohara /*
     81  1.2  kiyohara  * Empirical range of battery values.
     82  1.2  kiyohara  * Thanks to Joseph Heenan for measurements.
     83  1.2  kiyohara  */
     84  1.2  kiyohara #define PSH3PWR_BATTERY_MIN		630
     85  1.2  kiyohara #define PSH3PWR_BATTERY_CRITICAL	635
     86  1.2  kiyohara #define PSH3PWR_BATTERY_LOW		645
     87  1.2  kiyohara #define PSH3PWR_BATTERY_FULL		910 /* can be slightly more */
     88  1.1  kiyohara 
     89  1.1  kiyohara 
     90  1.1  kiyohara struct psh3pwr_softc {
     91  1.3  kiyohara 	device_t sc_dev;
     92  1.1  kiyohara 
     93  1.1  kiyohara 	void *sc_ih_pin;
     94  1.1  kiyohara 	void *sc_ih_pout;
     95  1.1  kiyohara };
     96  1.1  kiyohara 
     97  1.3  kiyohara static int psh3pwr_match(device_t, struct cfdata *, void *);
     98  1.3  kiyohara static void psh3pwr_attach(device_t, device_t, void *);
     99  1.1  kiyohara 
    100  1.3  kiyohara CFATTACH_DECL_NEW(psh3pwr, sizeof(struct psh3pwr_softc),
    101  1.1  kiyohara     psh3pwr_match, psh3pwr_attach, NULL, NULL);
    102  1.1  kiyohara 
    103  1.2  kiyohara static int psh3pwr_intr_plug_out(void *);
    104  1.1  kiyohara static int psh3pwr_intr_plug_in(void *);
    105  1.1  kiyohara static void psh3pwr_sleep(void *);
    106  1.2  kiyohara static int psh3pwr_apm_getpower_hook(void *, int, long, void *);
    107  1.2  kiyohara static int psh3pwr_get_battery(void);
    108  1.1  kiyohara 
    109  1.1  kiyohara 
    110  1.1  kiyohara static int
    111  1.3  kiyohara psh3pwr_match(device_t parent, struct cfdata *cfp, void *aux)
    112  1.1  kiyohara {
    113  1.1  kiyohara 
    114  1.1  kiyohara 	if (!platid_match(&platid, &platid_mask_MACH_HITACHI_PERSONA))
    115  1.1  kiyohara 		return 0;
    116  1.1  kiyohara 
    117  1.1  kiyohara 	if (strcmp(cfp->cf_name, "psh3pwr") != 0)
    118  1.1  kiyohara 		return 0;
    119  1.1  kiyohara 
    120  1.1  kiyohara 	return 1;
    121  1.1  kiyohara }
    122  1.1  kiyohara 
    123  1.1  kiyohara 
    124  1.1  kiyohara static void
    125  1.3  kiyohara psh3pwr_attach(device_t parent, device_t self, void *aux)
    126  1.1  kiyohara {
    127  1.1  kiyohara 	extern void (*__sleep_func)(void *);
    128  1.1  kiyohara 	extern void *__sleep_ctx;
    129  1.3  kiyohara 	struct psh3pwr_softc *sc = device_private(self);
    130  1.2  kiyohara 	uint8_t phdr;
    131  1.2  kiyohara 
    132  1.3  kiyohara 	sc->sc_dev = self;
    133  1.3  kiyohara 
    134  1.2  kiyohara 	/* arrange for hpcapm to call us when power status is requested */
    135  1.2  kiyohara 	config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_ACADAPTER,
    136  1.2  kiyohara 	    CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
    137  1.2  kiyohara 	config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_CHARGE,
    138  1.2  kiyohara 	    CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
    139  1.2  kiyohara 	config_hook(CONFIG_HOOK_GET, CONFIG_HOOK_BATTERYVAL,
    140  1.2  kiyohara 	    CONFIG_HOOK_EXCLUSIVE, psh3pwr_apm_getpower_hook, sc);
    141  1.1  kiyohara 
    142  1.8    andvar 	/* register sleep function to APM */
    143  1.1  kiyohara 	__sleep_func = psh3pwr_sleep;
    144  1.1  kiyohara 	__sleep_ctx = self;
    145  1.1  kiyohara 
    146  1.1  kiyohara 	phdr = _reg_read_1(SH7709_PHDR);
    147  1.1  kiyohara 	_reg_write_1(SH7709_PHDR, phdr | PSH3_GREEN_LED_ON);
    148  1.1  kiyohara 
    149  1.3  kiyohara 	aprint_naive("\n");
    150  1.3  kiyohara 	aprint_normal("\n");
    151  1.1  kiyohara 
    152  1.1  kiyohara 	sc->sc_ih_pout = intc_intr_establish(SH7709_INTEVT2_IRQ0,
    153  1.6       chs 	    IST_EDGE, IPL_TTY, psh3pwr_intr_plug_out, self);
    154  1.1  kiyohara 	sc->sc_ih_pin = intc_intr_establish(SH7709_INTEVT2_IRQ1,
    155  1.6       chs 	    IST_EDGE, IPL_TTY, psh3pwr_intr_plug_in, self);
    156  1.1  kiyohara 
    157  1.1  kiyohara 	/* XXXX: WindowsCE sets this bit. */
    158  1.3  kiyohara 	aprint_normal_dev(self, "plug status: %s\n",
    159  1.3  kiyohara 	    psh3pwr_ac_is_off() ? "out" : "in");
    160  1.4  kiyohara 
    161  1.4  kiyohara  	if (!pmf_device_register(self, NULL, NULL))
    162  1.4  kiyohara  		aprint_error_dev(self, "unable to establish power handler\n");
    163  1.1  kiyohara }
    164  1.1  kiyohara 
    165  1.1  kiyohara 
    166  1.2  kiyohara static int
    167  1.6       chs psh3pwr_intr_plug_out(void *dev)
    168  1.1  kiyohara {
    169  1.1  kiyohara 	uint8_t irr0, scpdr;
    170  1.1  kiyohara 
    171  1.1  kiyohara 	irr0 = _reg_read_1(SH7709_IRR0);
    172  1.1  kiyohara 	if (!(irr0 & IRR0_IRQ0)) {
    173  1.1  kiyohara 		return 0;
    174  1.1  kiyohara 	}
    175  1.1  kiyohara 	_reg_write_1(SH7709_IRR0, irr0 & ~IRR0_IRQ0);
    176  1.1  kiyohara 
    177  1.1  kiyohara 	/* XXXX: WindowsCE sets this bit. */
    178  1.1  kiyohara 	scpdr = _reg_read_1(SH7709_SCPDR);
    179  1.1  kiyohara 	_reg_write_1(SH7709_SCPDR, scpdr | PSH3PWR_PLUG_OUT);
    180  1.1  kiyohara 
    181  1.6       chs 	DPRINTF(("%s: plug out\n", device_xname(dev)));
    182  1.1  kiyohara 
    183  1.1  kiyohara 	return 1;
    184  1.1  kiyohara }
    185  1.1  kiyohara 
    186  1.2  kiyohara static int
    187  1.6       chs psh3pwr_intr_plug_in(void *dev)
    188  1.1  kiyohara {
    189  1.1  kiyohara 	uint8_t irr0, scpdr;
    190  1.1  kiyohara 
    191  1.1  kiyohara 	irr0 = _reg_read_1(SH7709_IRR0);
    192  1.1  kiyohara 	if (!(irr0 & IRR0_IRQ1))
    193  1.1  kiyohara 		return 0;
    194  1.1  kiyohara 	_reg_write_1(SH7709_IRR0, irr0 & ~IRR0_IRQ1);
    195  1.1  kiyohara 
    196  1.1  kiyohara 	/* XXXX: WindowsCE sets this bit. */
    197  1.1  kiyohara 	scpdr = _reg_read_1(SH7709_SCPDR);
    198  1.1  kiyohara 	_reg_write_1(SH7709_SCPDR, scpdr & ~PSH3PWR_PLUG_OUT);
    199  1.1  kiyohara 
    200  1.6       chs 	DPRINTF(("%s: plug in\n", device_xname(dev)));
    201  1.1  kiyohara 
    202  1.1  kiyohara 	return 1;
    203  1.1  kiyohara }
    204  1.1  kiyohara 
    205  1.1  kiyohara void
    206  1.6       chs psh3pwr_sleep(void *v)
    207  1.1  kiyohara {
    208  1.1  kiyohara 	/* splhigh on entry */
    209  1.1  kiyohara 	extern void pfckbd_poll_hitachi_power(void);
    210  1.1  kiyohara 
    211  1.1  kiyohara 	uint8_t phdr;
    212  1.1  kiyohara 
    213  1.1  kiyohara 	phdr = _reg_read_1(SH7709_PHDR);
    214  1.1  kiyohara 	_reg_write_1(SH7709_PHDR, phdr & ~PSH3_GREEN_LED_ON);
    215  1.1  kiyohara 
    216  1.1  kiyohara 	pfckbd_poll_hitachi_power();
    217  1.1  kiyohara 
    218  1.1  kiyohara 	phdr = _reg_read_1(SH7709_PHDR);
    219  1.1  kiyohara 	_reg_write_1(SH7709_PHDR, phdr | PSH3_GREEN_LED_ON);
    220  1.1  kiyohara }
    221  1.1  kiyohara 
    222  1.2  kiyohara static int
    223  1.2  kiyohara psh3pwr_apm_getpower_hook(void *ctx, int type, long id, void *msg)
    224  1.2  kiyohara {
    225  1.2  kiyohara 	/* struct psh0pwr_softc * const sc = ctx; */
    226  1.2  kiyohara 	int * const pval = msg;
    227  1.2  kiyohara 	int battery, state;
    228  1.2  kiyohara 
    229  1.2  kiyohara 	if (type != CONFIG_HOOK_GET)
    230  1.2  kiyohara 		return EINVAL;
    231  1.2  kiyohara 
    232  1.2  kiyohara 	switch (id) {
    233  1.1  kiyohara 
    234  1.2  kiyohara 	case CONFIG_HOOK_ACADAPTER:
    235  1.2  kiyohara 		*pval = psh3pwr_ac_is_off() ? APM_AC_OFF : APM_AC_ON;
    236  1.2  kiyohara 		return 0;
    237  1.1  kiyohara 
    238  1.2  kiyohara 	case CONFIG_HOOK_CHARGE:
    239  1.2  kiyohara 		battery = psh3pwr_get_battery();
    240  1.2  kiyohara 		if (battery < PSH3PWR_BATTERY_CRITICAL)
    241  1.2  kiyohara 			state = APM_BATT_FLAG_CRITICAL;
    242  1.2  kiyohara 		else if (battery < PSH3PWR_BATTERY_LOW)
    243  1.2  kiyohara 			state = APM_BATT_FLAG_LOW;
    244  1.2  kiyohara 		else
    245  1.2  kiyohara 			state = APM_BATT_FLAG_HIGH; /* XXX? */
    246  1.2  kiyohara 		*pval = state;
    247  1.2  kiyohara 		return 0;
    248  1.1  kiyohara 
    249  1.2  kiyohara 	case CONFIG_HOOK_BATTERYVAL:
    250  1.2  kiyohara 		battery = psh3pwr_get_battery();
    251  1.2  kiyohara 		if (battery > PSH3PWR_BATTERY_FULL)
    252  1.2  kiyohara 			state = 100;
    253  1.2  kiyohara 		else
    254  1.2  kiyohara 			state = 100 * (battery - PSH3PWR_BATTERY_MIN) /
    255  1.2  kiyohara 			    (PSH3PWR_BATTERY_FULL - PSH3PWR_BATTERY_MIN);
    256  1.2  kiyohara 		*pval = state;
    257  1.2  kiyohara 		return 0;
    258  1.2  kiyohara 	}
    259  1.1  kiyohara 
    260  1.2  kiyohara 	return EINVAL;
    261  1.1  kiyohara }
    262  1.1  kiyohara 
    263  1.2  kiyohara 
    264  1.1  kiyohara static int
    265  1.2  kiyohara psh3pwr_get_battery(void)
    266  1.1  kiyohara {
    267  1.2  kiyohara 	int battery;
    268  1.2  kiyohara 	int s;
    269  1.1  kiyohara 
    270  1.2  kiyohara 	s = spltty();
    271  1.2  kiyohara 	battery = adc_sample_channel(ADC_CHANNEL_BATTERY);
    272  1.2  kiyohara 	splx(s);
    273  1.1  kiyohara 
    274  1.2  kiyohara 	return battery;
    275  1.1  kiyohara }
    276