j6x0pwr.c revision 1.5.2.4
1 1.5.2.4 skrll /* $NetBSD: j6x0pwr.c,v 1.5.2.4 2004/09/21 13:16:24 skrll Exp $ */ 2 1.5.2.2 skrll 3 1.5.2.2 skrll /* 4 1.5.2.2 skrll * Copyright (c) 2003 Valeriy E. Ushakov 5 1.5.2.2 skrll * All rights reserved. 6 1.5.2.2 skrll * 7 1.5.2.2 skrll * Redistribution and use in source and binary forms, with or without 8 1.5.2.2 skrll * modification, are permitted provided that the following conditions 9 1.5.2.2 skrll * are met: 10 1.5.2.2 skrll * 1. Redistributions of source code must retain the above copyright 11 1.5.2.2 skrll * notice, this list of conditions and the following disclaimer. 12 1.5.2.2 skrll * 2. Redistributions in binary form must reproduce the above copyright 13 1.5.2.2 skrll * notice, this list of conditions and the following disclaimer in the 14 1.5.2.2 skrll * documentation and/or other materials provided with the distribution. 15 1.5.2.2 skrll * 3. The name of the author may not be used to endorse or promote products 16 1.5.2.2 skrll * derived from this software without specific prior written permission 17 1.5.2.2 skrll * 18 1.5.2.2 skrll * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 19 1.5.2.2 skrll * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 20 1.5.2.2 skrll * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 21 1.5.2.2 skrll * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 22 1.5.2.2 skrll * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT 23 1.5.2.2 skrll * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, 24 1.5.2.2 skrll * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY 25 1.5.2.2 skrll * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT 26 1.5.2.2 skrll * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF 27 1.5.2.2 skrll * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 28 1.5.2.2 skrll */ 29 1.5.2.2 skrll 30 1.5.2.2 skrll #include <sys/cdefs.h> 31 1.5.2.4 skrll __KERNEL_RCSID(0, "$NetBSD: j6x0pwr.c,v 1.5.2.4 2004/09/21 13:16:24 skrll Exp $"); 32 1.5.2.2 skrll 33 1.5.2.2 skrll #include <sys/param.h> 34 1.5.2.2 skrll #include <sys/kernel.h> 35 1.5.2.2 skrll #include <sys/device.h> 36 1.5.2.2 skrll #include <sys/malloc.h> 37 1.5.2.2 skrll #include <sys/systm.h> 38 1.5.2.2 skrll #include <sys/callout.h> 39 1.5.2.2 skrll #ifdef GPROF 40 1.5.2.2 skrll #include <sys/gmon.h> 41 1.5.2.2 skrll #endif 42 1.5.2.2 skrll 43 1.5.2.2 skrll #include <machine/platid.h> 44 1.5.2.2 skrll #include <machine/platid_mask.h> 45 1.5.2.2 skrll #include <machine/config_hook.h> 46 1.5.2.2 skrll 47 1.5.2.2 skrll #include <sh3/exception.h> 48 1.5.2.2 skrll #include <sh3/intcreg.h> 49 1.5.2.2 skrll #include <sh3/pfcreg.h> 50 1.5.2.2 skrll 51 1.5.2.2 skrll #include <sh3/dev/adcvar.h> 52 1.5.2.2 skrll 53 1.5.2.2 skrll 54 1.5.2.2 skrll /* SH7709_PGDR bits pertinent to Jornada 6x0 power */ 55 1.5.2.2 skrll #define PGDR_MAIN_BATTERY_OUT 0x04 56 1.5.2.2 skrll #define PGDR_LID_OPEN 0x01 57 1.5.2.2 skrll 58 1.5.2.2 skrll /* A/D covnerter channels to get power stats from */ 59 1.5.2.2 skrll #define ADC_CHANNEL_BATTERY 3 60 1.5.2.2 skrll #define ADC_CHANNEL_BACKUP 4 61 1.5.2.2 skrll #define ADC_CHANNEL_CHARGE 5 62 1.5.2.2 skrll 63 1.5.2.2 skrll /* warn that main battery is low after drops below this value */ 64 1.5.2.2 skrll #define J6X0PWR_BATTERY_WARNING_THRESHOLD 200 65 1.5.2.2 skrll 66 1.5.2.2 skrll 67 1.5.2.2 skrll struct j6x0pwr_softc { 68 1.5.2.2 skrll struct device sc_dev; 69 1.5.2.2 skrll 70 1.5.2.2 skrll struct callout sc_poll_ch; 71 1.5.2.2 skrll void *sc_ih; 72 1.5.2.2 skrll volatile int sc_poweroff; 73 1.5.2.2 skrll }; 74 1.5.2.2 skrll 75 1.5.2.2 skrll static int j6x0pwr_match(struct device *, struct cfdata *, void *); 76 1.5.2.2 skrll static void j6x0pwr_attach(struct device *, struct device *, void *); 77 1.5.2.2 skrll 78 1.5.2.2 skrll CFATTACH_DECL(j6x0pwr, sizeof(struct j6x0pwr_softc), 79 1.5.2.2 skrll j6x0pwr_match, j6x0pwr_attach, NULL, NULL); 80 1.5.2.2 skrll 81 1.5.2.2 skrll 82 1.5.2.2 skrll static int j6x0pwr_intr(void *); 83 1.5.2.2 skrll static void j6x0pwr_poll_callout(void *); 84 1.5.2.2 skrll static void j6x0pwr_sleep(void *); 85 1.5.2.2 skrll static int j6x0pwr_clear_interrupt(void); 86 1.5.2.2 skrll 87 1.5.2.2 skrll static int 88 1.5.2.2 skrll j6x0pwr_match(struct device *parent, struct cfdata *cfp, void *aux) 89 1.5.2.2 skrll { 90 1.5.2.2 skrll 91 1.5.2.2 skrll /* 92 1.5.2.2 skrll * XXX: does platid_mask_MACH_HP_LX matches _JORNADA_6XX too? 93 1.5.2.2 skrll * Is 620 wired similarly? 94 1.5.2.2 skrll */ 95 1.5.2.2 skrll if (!platid_match(&platid, &platid_mask_MACH_HP_JORNADA_6XX)) 96 1.5.2.2 skrll return (0); 97 1.5.2.2 skrll 98 1.5.2.2 skrll if (strcmp(cfp->cf_name, "j6x0pwr") != 0) 99 1.5.2.2 skrll return (0); 100 1.5.2.2 skrll 101 1.5.2.2 skrll return (1); 102 1.5.2.2 skrll } 103 1.5.2.2 skrll 104 1.5.2.2 skrll 105 1.5.2.2 skrll static void 106 1.5.2.2 skrll j6x0pwr_attach(struct device *parent, struct device *self, void *aux) 107 1.5.2.2 skrll { 108 1.5.2.2 skrll extern void (*__sleep_func)(void *); 109 1.5.2.2 skrll extern void *__sleep_ctx; 110 1.5.2.2 skrll struct j6x0pwr_softc *sc = (struct j6x0pwr_softc *)self; 111 1.5.2.2 skrll 112 1.5.2.2 skrll /* regsiter sleep function to APM */ 113 1.5.2.2 skrll __sleep_func = j6x0pwr_sleep; 114 1.5.2.2 skrll __sleep_ctx = self; 115 1.5.2.2 skrll sc->sc_poweroff = 0; 116 1.5.2.2 skrll 117 1.5.2.2 skrll /* drain the old interrupt */ 118 1.5.2.2 skrll j6x0pwr_clear_interrupt(); 119 1.5.2.2 skrll 120 1.5.2.2 skrll sc->sc_ih = intc_intr_establish(SH7709_INTEVT2_IRQ0, IST_EDGE, IPL_TTY, 121 1.5.2.2 skrll j6x0pwr_intr, sc); 122 1.5.2.2 skrll 123 1.5.2.2 skrll callout_init(&sc->sc_poll_ch); 124 1.5.2.2 skrll callout_reset(&sc->sc_poll_ch, 5 * hz, 125 1.5.2.2 skrll j6x0pwr_poll_callout, sc); 126 1.5.2.2 skrll 127 1.5.2.2 skrll _reg_write_1(SH7709_PKDR, 0); /* Green LED on */ 128 1.5.2.2 skrll printf("\n"); 129 1.5.2.2 skrll } 130 1.5.2.2 skrll 131 1.5.2.2 skrll 132 1.5.2.2 skrll /* 133 1.5.2.2 skrll * Triggered when the On/Off button is pressed or the lid is closed. 134 1.5.2.2 skrll * The state of the lid is reflected in the bit PGDR[2]. 135 1.5.2.2 skrll * Closing the lid can trigger several consecutive interrupts. 136 1.5.2.2 skrll * 137 1.5.2.2 skrll * XXX: Since we don't put the machine to sleep, I have no idea how 138 1.5.2.2 skrll * wakeup interrupt(s) look like. Need to revisit when software 139 1.5.2.2 skrll * suspend is added to the kernel (which we need to support ACPI). 140 1.5.2.2 skrll */ 141 1.5.2.2 skrll static int 142 1.5.2.2 skrll j6x0pwr_intr(void *self) 143 1.5.2.2 skrll { 144 1.5.2.2 skrll struct j6x0pwr_softc *sc = (struct j6x0pwr_softc *)self; 145 1.5.2.2 skrll uint8_t irr0; 146 1.5.2.2 skrll uint8_t pgdr; 147 1.5.2.2 skrll 148 1.5.2.2 skrll if (((irr0 = j6x0pwr_clear_interrupt()) & IRR0_IRQ0) == 0) { 149 1.5.2.2 skrll #ifdef DIAGNOSTIC 150 1.5.2.2 skrll printf_nolog("%s: irr0=0x%02x?\n", sc->sc_dev.dv_xname, irr0); 151 1.5.2.2 skrll #endif 152 1.5.2.2 skrll return (0); 153 1.5.2.2 skrll } 154 1.5.2.2 skrll 155 1.5.2.2 skrll pgdr = _reg_read_1(SH7709_PGDR); 156 1.5.2.2 skrll if ((pgdr & PGDR_LID_OPEN) == 0) { 157 1.5.2.2 skrll printf("%s: lid closed %d\n", sc->sc_dev.dv_xname, 158 1.5.2.2 skrll sc->sc_poweroff); 159 1.5.2.2 skrll if (sc->sc_poweroff) 160 1.5.2.2 skrll return 1; 161 1.5.2.2 skrll } else { 162 1.5.2.2 skrll printf("%s: ON/OFF %d\n", sc->sc_dev.dv_xname, sc->sc_poweroff); 163 1.5.2.2 skrll if (sc->sc_poweroff) 164 1.5.2.2 skrll sc->sc_poweroff = 0; 165 1.5.2.2 skrll } 166 1.5.2.2 skrll 167 1.5.2.2 skrll /* push */ 168 1.5.2.2 skrll config_hook_call(CONFIG_HOOK_BUTTONEVENT, CONFIG_HOOK_BUTTONEVENT_POWER, 169 1.5.2.2 skrll (void *)1); 170 1.5.2.2 skrll /* release (fake) */ 171 1.5.2.2 skrll config_hook_call(CONFIG_HOOK_BUTTONEVENT, CONFIG_HOOK_BUTTONEVENT_POWER, 172 1.5.2.2 skrll (void *)0); 173 1.5.2.2 skrll 174 1.5.2.2 skrll return (1); 175 1.5.2.2 skrll } 176 1.5.2.2 skrll 177 1.5.2.2 skrll static int 178 1.5.2.2 skrll j6x0pwr_clear_interrupt() 179 1.5.2.2 skrll { 180 1.5.2.2 skrll uint8_t irr0; 181 1.5.2.2 skrll 182 1.5.2.2 skrll irr0 = _reg_read_1(SH7709_IRR0); 183 1.5.2.2 skrll if (irr0 & IRR0_IRQ0) 184 1.5.2.2 skrll _reg_write_1(SH7709_IRR0, irr0 & ~IRR0_IRQ0); 185 1.5.2.2 skrll 186 1.5.2.2 skrll return irr0; 187 1.5.2.2 skrll } 188 1.5.2.2 skrll 189 1.5.2.2 skrll void 190 1.5.2.2 skrll j6x0pwr_sleep(void *self) 191 1.5.2.2 skrll { 192 1.5.2.2 skrll /* splhigh on entry */ 193 1.5.2.2 skrll struct j6x0pwr_softc *sc = self; 194 1.5.2.2 skrll int s; 195 1.5.2.2 skrll 196 1.5.2.2 skrll /* Reinstall j6x0pwr_intr as a wakeup handler */ 197 1.5.2.2 skrll intc_intr_disestablish(sc->sc_ih); 198 1.5.2.2 skrll sc->sc_ih = intc_intr_establish(SH7709_INTEVT2_IRQ0, IST_EDGE, IPL_HIGH, 199 1.5.2.2 skrll j6x0pwr_intr, sc); 200 1.5.2.2 skrll sc->sc_poweroff = 1; 201 1.5.2.2 skrll do { 202 1.5.2.2 skrll /* Disable interrupt except for power button. */ 203 1.5.2.2 skrll s = _cpu_intr_resume(IPL_CLOCK << 4); 204 1.5.2.2 skrll _reg_write_1(SH7709_PKDR, 0xff); /* Green LED off */ 205 1.5.2.2 skrll __asm__ __volatile__("sleep"); 206 1.5.2.2 skrll _reg_write_1(SH7709_PKDR, 0); /* Green LED on */ 207 1.5.2.2 skrll _cpu_intr_resume(s); 208 1.5.2.2 skrll } while (sc->sc_poweroff); 209 1.5.2.2 skrll 210 1.5.2.2 skrll /* Return to normal power button */ 211 1.5.2.2 skrll intc_intr_disestablish(sc->sc_ih); 212 1.5.2.2 skrll sc->sc_ih = intc_intr_establish(SH7709_INTEVT2_IRQ0, IST_EDGE, IPL_TTY, 213 1.5.2.2 skrll j6x0pwr_intr, sc); 214 1.5.2.2 skrll /* splhigh on exit */ 215 1.5.2.2 skrll } 216 1.5.2.2 skrll 217 1.5.2.2 skrll volatile int j6x0pwr_poll_verbose = 0; /* XXX: tweak from ddb */ 218 1.5.2.2 skrll 219 1.5.2.2 skrll static void 220 1.5.2.2 skrll j6x0pwr_poll_callout(void *self) 221 1.5.2.2 skrll { 222 1.5.2.2 skrll struct j6x0pwr_softc *sc = (struct j6x0pwr_softc *)self; 223 1.5.2.2 skrll int battery, backup, charging; 224 1.5.2.2 skrll uint8_t pgdr; 225 1.5.2.2 skrll int s; 226 1.5.2.2 skrll 227 1.5.2.2 skrll pgdr = _reg_read_1(SH7709_PGDR); 228 1.5.2.2 skrll 229 1.5.2.2 skrll /* just check main battery charge if not verbose and battery is in */ 230 1.5.2.2 skrll if (!j6x0pwr_poll_verbose) { 231 1.5.2.2 skrll if (pgdr & PGDR_MAIN_BATTERY_OUT) 232 1.5.2.2 skrll goto reschedule; 233 1.5.2.2 skrll else { 234 1.5.2.2 skrll s = spltty(); 235 1.5.2.2 skrll battery = adc_sample_channel(ADC_CHANNEL_BATTERY); 236 1.5.2.2 skrll splx(s); 237 1.5.2.2 skrll goto check_battery; 238 1.5.2.2 skrll } 239 1.5.2.2 skrll } 240 1.5.2.2 skrll 241 1.5.2.2 skrll s = spltty(); 242 1.5.2.2 skrll battery = adc_sample_channel(ADC_CHANNEL_BATTERY); 243 1.5.2.2 skrll splx(s); 244 1.5.2.2 skrll 245 1.5.2.2 skrll s = spltty(); 246 1.5.2.2 skrll backup = adc_sample_channel(ADC_CHANNEL_BACKUP); 247 1.5.2.2 skrll splx(s); 248 1.5.2.2 skrll 249 1.5.2.2 skrll s = spltty(); 250 1.5.2.2 skrll charging = adc_sample_channel(ADC_CHANNEL_CHARGE); 251 1.5.2.2 skrll splx(s); 252 1.5.2.2 skrll 253 1.5.2.2 skrll printf_nolog("%s: main=", sc->sc_dev.dv_xname); 254 1.5.2.2 skrll if (pgdr & PGDR_MAIN_BATTERY_OUT) 255 1.5.2.2 skrll printf_nolog("<no>"); 256 1.5.2.2 skrll else 257 1.5.2.2 skrll printf_nolog("%-4d", battery); 258 1.5.2.2 skrll 259 1.5.2.2 skrll printf_nolog(" bkup=%-4d", backup); 260 1.5.2.2 skrll 261 1.5.2.2 skrll /* 262 1.5.2.2 skrll * When main battery is being charged, ADC_CHANNEL_CHARGE 263 1.5.2.2 skrll * samples at almost zero. It samples at 2^10 otherwise. 264 1.5.2.2 skrll */ 265 1.5.2.2 skrll if (charging < 8) 266 1.5.2.2 skrll printf_nolog("charging"); 267 1.5.2.2 skrll 268 1.5.2.2 skrll printf_nolog("\n"); 269 1.5.2.2 skrll 270 1.5.2.2 skrll check_battery: 271 1.5.2.2 skrll if (!(pgdr & PGDR_MAIN_BATTERY_OUT) 272 1.5.2.2 skrll && (battery < J6X0PWR_BATTERY_WARNING_THRESHOLD)) 273 1.5.2.2 skrll printf("%s: WARNING: main battery %d is low!\n", 274 1.5.2.2 skrll sc->sc_dev.dv_xname, battery); 275 1.5.2.2 skrll 276 1.5.2.2 skrll reschedule: 277 1.5.2.2 skrll callout_schedule(&sc->sc_poll_ch, 5*hz); 278 1.5.2.2 skrll } 279
Indexes created Tue Oct 21 07:10:13 GMT 2025