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