Home | History | Annotate | Line # | Download | only in dev
psh3pwr.c revision 1.7.2.1
      1  1.7.2.1  perseant /*	$NetBSD: psh3pwr.c,v 1.7.2.1 2025/08/02 05:55:41 perseant 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.7.2.1  perseant __KERNEL_RCSID(0, "$NetBSD: psh3pwr.c,v 1.7.2.1 2025/08/02 05:55:41 perseant 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.7.2.1  perseant 	/* 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