psm.c revision 1.3.10.3
1 1.3.10.3 yamt /* $NetBSD: psm.c,v 1.3.10.3 2007/09/03 14:30:16 yamt Exp $ */ 2 1.3.10.2 yamt /* 3 1.3.10.2 yamt * Copyright (c) 2006 Itronix Inc. 4 1.3.10.2 yamt * All rights reserved. 5 1.3.10.2 yamt * 6 1.3.10.2 yamt * Ported from Tadpole Solaris sources by Garrett D'Amore for Itronix Inc. 7 1.3.10.2 yamt * 8 1.3.10.2 yamt * Redistribution and use in source and binary forms, with or without 9 1.3.10.2 yamt * modification, are permitted provided that the following conditions 10 1.3.10.2 yamt * are met: 11 1.3.10.2 yamt * 1. Redistributions of source code must retain the above copyright 12 1.3.10.2 yamt * notice, this list of conditions and the following disclaimer. 13 1.3.10.2 yamt * 2. Redistributions in binary form must reproduce the above copyright 14 1.3.10.2 yamt * notice, this list of conditions and the following disclaimer in the 15 1.3.10.2 yamt * documentation and/or other materials provided with the distribution. 16 1.3.10.2 yamt * 3. The name of Itronix Inc. may not be used to endorse 17 1.3.10.2 yamt * or promote products derived from this software without specific 18 1.3.10.2 yamt * prior written permission. 19 1.3.10.2 yamt * 20 1.3.10.2 yamt * THIS SOFTWARE IS PROVIDED BY ITRONIX INC. ``AS IS'' AND 21 1.3.10.2 yamt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 22 1.3.10.2 yamt * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 23 1.3.10.2 yamt * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL ITRONIX INC. BE LIABLE FOR ANY 24 1.3.10.2 yamt * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 25 1.3.10.2 yamt * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 26 1.3.10.2 yamt * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND 27 1.3.10.2 yamt * ON ANY THEORY OF LIABILITY, WHETHER IN 28 1.3.10.2 yamt * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 29 1.3.10.2 yamt * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 30 1.3.10.2 yamt * POSSIBILITY OF SUCH DAMAGE. 31 1.3.10.2 yamt */ 32 1.3.10.2 yamt /* 33 1.3.10.2 yamt * Tadpole-RDI Ultrabook IIi (huxley) power management. Note that 34 1.3.10.2 yamt * there is a lot of stuff still missing here, due in part to the confusion 35 1.3.10.2 yamt * that exists with the NetBSD power management framework. I'm not wasting 36 1.3.10.2 yamt * time with APM at this point, and some of sysmon seems "lacking". 37 1.3.10.2 yamt */ 38 1.3.10.2 yamt #include <sys/cdefs.h> 39 1.3.10.3 yamt __KERNEL_RCSID(0, "$NetBSD: psm.c,v 1.3.10.3 2007/09/03 14:30:16 yamt Exp $"); 40 1.3.10.2 yamt 41 1.3.10.2 yamt #include <sys/param.h> 42 1.3.10.2 yamt #include <sys/systm.h> 43 1.3.10.2 yamt #include <sys/proc.h> 44 1.3.10.2 yamt #include <sys/kernel.h> 45 1.3.10.2 yamt #include <sys/kthread.h> 46 1.3.10.2 yamt #include <sys/types.h> 47 1.3.10.2 yamt #include <sys/device.h> 48 1.3.10.2 yamt #include <sys/poll.h> 49 1.3.10.2 yamt #include <sys/kauth.h> 50 1.3.10.2 yamt 51 1.3.10.2 yamt #include <machine/autoconf.h> 52 1.3.10.2 yamt #include <machine/bus.h> 53 1.3.10.2 yamt #include <machine/intr.h> 54 1.3.10.2 yamt 55 1.3.10.2 yamt #include <dev/ebus/ebusreg.h> 56 1.3.10.2 yamt #include <dev/ebus/ebusvar.h> 57 1.3.10.2 yamt 58 1.3.10.2 yamt #include <dev/sysmon/sysmonvar.h> 59 1.3.10.2 yamt 60 1.3.10.2 yamt #include <sparc64/dev/psmreg.h> 61 1.3.10.2 yamt 62 1.3.10.2 yamt struct psm_softc { 63 1.3.10.2 yamt struct device sc_dev; 64 1.3.10.2 yamt bus_space_tag_t sc_memt; 65 1.3.10.2 yamt bus_space_handle_t sc_memh; 66 1.3.10.2 yamt 67 1.3.10.2 yamt int sc_event; 68 1.3.10.2 yamt int sc_flags; 69 1.3.10.2 yamt struct sysmon_pswitch sc_sm_pbutton; 70 1.3.10.2 yamt struct sysmon_pswitch sc_sm_lid; 71 1.3.10.2 yamt struct sysmon_pswitch sc_sm_ac; 72 1.3.10.2 yamt struct evcnt sc_intrcnt; 73 1.3.10.3 yamt lwp_t *sc_thread; 74 1.3.10.2 yamt }; 75 1.3.10.2 yamt 76 1.3.10.2 yamt #define PUT8(sc, r, v) \ 77 1.3.10.2 yamt bus_space_write_1(sc->sc_memt, sc->sc_memh, r, v) 78 1.3.10.2 yamt #define GET8(sc, r) \ 79 1.3.10.2 yamt bus_space_read_1(sc->sc_memt, sc->sc_memh, r) 80 1.3.10.2 yamt 81 1.3.10.2 yamt #define WAIT_DELAY 1000 82 1.3.10.2 yamt #define WAIT_RETRIES 1000 83 1.3.10.2 yamt 84 1.3.10.2 yamt #define RESET_DELAY 200 85 1.3.10.2 yamt #define CMD_DELAY 10 86 1.3.10.2 yamt #define CMD_RETRIES 5 87 1.3.10.2 yamt 88 1.3.10.2 yamt #ifdef DEBUG 89 1.3.10.2 yamt #define STATIC 90 1.3.10.2 yamt #else 91 1.3.10.2 yamt #define STATIC static 92 1.3.10.2 yamt #endif 93 1.3.10.2 yamt 94 1.3.10.2 yamt /* flags indicating state */ 95 1.3.10.2 yamt #define PSM_FLAG_ACPWR 0x1 96 1.3.10.2 yamt #define PSM_FLAG_LIDCLOSED 0x2 97 1.3.10.2 yamt #define PSM_FLAG_DOCKED 0x4 98 1.3.10.2 yamt 99 1.3.10.2 yamt /* system events -- causes activity in the event thread */ 100 1.3.10.2 yamt #define PSM_EV_PBUTTON 0x1 101 1.3.10.2 yamt #define PSM_EV_LID 0x2 102 1.3.10.2 yamt #define PSM_EV_ACPWR 0x4 103 1.3.10.2 yamt #define PSM_EV_BATT 0x8 104 1.3.10.2 yamt #define PSM_EV_TEMP 0x10 105 1.3.10.2 yamt 106 1.3.10.2 yamt STATIC void psm_sysmon_setup(struct psm_softc *); 107 1.3.10.2 yamt STATIC void psm_event_thread(void *); 108 1.3.10.2 yamt STATIC int psm_init(struct psm_softc *); 109 1.3.10.2 yamt STATIC void psm_reset(struct psm_softc *); 110 1.3.10.2 yamt STATIC void psm_poll_acpower(struct psm_softc *); 111 1.3.10.2 yamt STATIC int psm_intr(void *); 112 1.3.10.2 yamt STATIC int psm_misc_rd(struct psm_softc *, uint8_t, uint8_t *); 113 1.3.10.2 yamt STATIC int psm_misc_wr(struct psm_softc *, uint8_t, uint8_t); 114 1.3.10.2 yamt STATIC int psm_wait(struct psm_softc *, uint8_t); 115 1.3.10.2 yamt #if 0 116 1.3.10.2 yamt STATIC int psm_ecmd_rd16(struct psm_softc *, uint16_t *, uint8_t, uint8_t, 117 1.3.10.2 yamt uint8_t); 118 1.3.10.2 yamt #endif 119 1.3.10.2 yamt STATIC int psm_ecmd_rd8(struct psm_softc *, uint8_t *, uint8_t, uint8_t, 120 1.3.10.2 yamt uint8_t); 121 1.3.10.2 yamt STATIC int psm_ecmd_wr8(struct psm_softc *, uint8_t, uint8_t, uint8_t, 122 1.3.10.2 yamt uint8_t); 123 1.3.10.2 yamt STATIC int psm_match(struct device *, struct cfdata *, void *); 124 1.3.10.2 yamt STATIC void psm_attach(struct device *, struct device *, void *); 125 1.3.10.2 yamt 126 1.3.10.2 yamt CFATTACH_DECL(psm, sizeof(struct psm_softc), 127 1.3.10.2 yamt psm_match, psm_attach, NULL, NULL); 128 1.3.10.2 yamt 129 1.3.10.2 yamt 130 1.3.10.2 yamt int 131 1.3.10.2 yamt psm_match(struct device *parent, struct cfdata *cf, void *aux) 132 1.3.10.2 yamt { 133 1.3.10.2 yamt struct ebus_attach_args *ea = aux; 134 1.3.10.2 yamt 135 1.3.10.2 yamt if (strcmp(ea->ea_name, "psm") != 0) 136 1.3.10.2 yamt return (0); 137 1.3.10.2 yamt return (1); 138 1.3.10.2 yamt } 139 1.3.10.2 yamt 140 1.3.10.2 yamt void 141 1.3.10.2 yamt psm_attach(struct device *parent, struct device *self, void *aux) 142 1.3.10.2 yamt { 143 1.3.10.2 yamt struct psm_softc *sc = (struct psm_softc *)self; 144 1.3.10.2 yamt struct ebus_attach_args *ea = aux; 145 1.3.10.2 yamt bus_addr_t devaddr; 146 1.3.10.2 yamt char *xname; 147 1.3.10.2 yamt 148 1.3.10.2 yamt xname = sc->sc_dev.dv_xname; 149 1.3.10.2 yamt 150 1.3.10.2 yamt sc->sc_memt = ea->ea_bustag; 151 1.3.10.2 yamt devaddr = EBUS_ADDR_FROM_REG(&ea->ea_reg[0]); 152 1.3.10.2 yamt 153 1.3.10.2 yamt if (bus_space_map(sc->sc_memt, devaddr, ea->ea_reg[0].size, 154 1.3.10.2 yamt 0, &sc->sc_memh) != 0) { 155 1.3.10.2 yamt printf(": unable to map device registers\n"); 156 1.3.10.2 yamt return; 157 1.3.10.2 yamt } 158 1.3.10.2 yamt if (psm_init(sc) != 0) { 159 1.3.10.2 yamt printf(": unable to initialize device\n"); 160 1.3.10.2 yamt return; 161 1.3.10.2 yamt } 162 1.3.10.2 yamt 163 1.3.10.2 yamt printf(": UltraBook IIi power control\n"); 164 1.3.10.2 yamt 165 1.3.10.2 yamt psm_sysmon_setup(sc); 166 1.3.10.2 yamt 167 1.3.10.3 yamt if (kthread_create(PRI_NONE, 0, NULL, psm_event_thread, sc, 168 1.3.10.3 yamt &sc->sc_thread, "%s", sc->sc_dev.dv_xname) != 0) { 169 1.3.10.3 yamt printf("%s: unable to create event kthread\n", 170 1.3.10.3 yamt sc->sc_dev.dv_xname); 171 1.3.10.3 yamt } 172 1.3.10.2 yamt 173 1.3.10.2 yamt /* 174 1.3.10.2 yamt * Establish device interrupts 175 1.3.10.2 yamt */ 176 1.3.10.2 yamt (void) bus_intr_establish(sc->sc_memt, ea->ea_intr[0], IPL_HIGH, 177 1.3.10.2 yamt psm_intr, sc); 178 1.3.10.2 yamt evcnt_attach_dynamic(&sc->sc_intrcnt, EVCNT_TYPE_INTR, NULL, 179 1.3.10.2 yamt sc->sc_dev.dv_xname, "intr"); 180 1.3.10.2 yamt } 181 1.3.10.2 yamt 182 1.3.10.2 yamt /* 183 1.3.10.2 yamt * Register sensors and events with sysmon. 184 1.3.10.2 yamt */ 185 1.3.10.2 yamt void 186 1.3.10.2 yamt psm_sysmon_setup(struct psm_softc *sc) 187 1.3.10.2 yamt { 188 1.3.10.2 yamt const char *xname = sc->sc_dev.dv_xname; 189 1.3.10.2 yamt 190 1.3.10.2 yamt 191 1.3.10.2 yamt /* 192 1.3.10.2 yamt * XXX: Register sysmon environment. 193 1.3.10.2 yamt */ 194 1.3.10.2 yamt 195 1.3.10.2 yamt /* 196 1.3.10.2 yamt * Register sysmon events 197 1.3.10.2 yamt */ 198 1.3.10.2 yamt sc->sc_sm_pbutton.smpsw_name = xname; 199 1.3.10.2 yamt sc->sc_sm_pbutton.smpsw_type = PSWITCH_TYPE_POWER; 200 1.3.10.2 yamt if (sysmon_pswitch_register(&sc->sc_sm_pbutton) != 0) 201 1.3.10.2 yamt printf("%s: unable to register power button\n", xname); 202 1.3.10.2 yamt 203 1.3.10.2 yamt sc->sc_sm_lid.smpsw_name = xname; 204 1.3.10.2 yamt sc->sc_sm_lid.smpsw_type = PSWITCH_TYPE_LID; 205 1.3.10.2 yamt if (sysmon_pswitch_register(&sc->sc_sm_lid) != 0) 206 1.3.10.2 yamt printf("%s: unable to register lid switch\n", xname); 207 1.3.10.2 yamt 208 1.3.10.2 yamt sc->sc_sm_ac.smpsw_name = xname; 209 1.3.10.2 yamt sc->sc_sm_ac.smpsw_type = PSWITCH_TYPE_ACADAPTER; 210 1.3.10.2 yamt if (sysmon_pswitch_register(&sc->sc_sm_ac) != 0) 211 1.3.10.2 yamt printf("%s: unable to register AC adapter\n", xname); 212 1.3.10.2 yamt } 213 1.3.10.2 yamt 214 1.3.10.2 yamt void 215 1.3.10.2 yamt psm_event_thread(void *arg) 216 1.3.10.2 yamt { 217 1.3.10.2 yamt struct psm_softc *sc = arg; 218 1.3.10.2 yamt int x; 219 1.3.10.2 yamt int event; 220 1.3.10.2 yamt int flags; 221 1.3.10.2 yamt 222 1.3.10.2 yamt for (;;) { 223 1.3.10.2 yamt x = splhigh(); 224 1.3.10.2 yamt /* check for AC power. sets event if there is a change */ 225 1.3.10.2 yamt psm_poll_acpower(sc); 226 1.3.10.2 yamt 227 1.3.10.2 yamt /* read and clear events */ 228 1.3.10.2 yamt event = sc->sc_event; 229 1.3.10.2 yamt flags = sc->sc_flags; 230 1.3.10.2 yamt sc->sc_event = 0; 231 1.3.10.2 yamt splx(x); 232 1.3.10.2 yamt 233 1.3.10.2 yamt if (event & PSM_EV_PBUTTON) { 234 1.3.10.2 yamt sysmon_pswitch_event(&sc->sc_sm_pbutton, 235 1.3.10.2 yamt PSWITCH_EVENT_PRESSED); 236 1.3.10.2 yamt } 237 1.3.10.2 yamt 238 1.3.10.2 yamt if (event & PSM_EV_LID) { 239 1.3.10.2 yamt sysmon_pswitch_event(&sc->sc_sm_lid, 240 1.3.10.2 yamt flags & PSM_FLAG_LIDCLOSED ? 241 1.3.10.3 yamt PSWITCH_EVENT_PRESSED : PSWITCH_EVENT_RELEASED); 242 1.3.10.2 yamt } 243 1.3.10.2 yamt 244 1.3.10.2 yamt if (event & PSM_EV_ACPWR) { 245 1.3.10.2 yamt sysmon_pswitch_event(&sc->sc_sm_ac, 246 1.3.10.2 yamt flags & PSM_FLAG_ACPWR ? 247 1.3.10.3 yamt PSWITCH_EVENT_PRESSED : PSWITCH_EVENT_RELEASED); 248 1.3.10.2 yamt } 249 1.3.10.2 yamt 250 1.3.10.2 yamt /* XXX: handle PSM_EV_TEMP */ 251 1.3.10.2 yamt 252 1.3.10.2 yamt /* one second interval between probes of power */ 253 1.3.10.2 yamt tsleep(&sc, PWAIT, "psm", hz); 254 1.3.10.2 yamt } 255 1.3.10.2 yamt } 256 1.3.10.2 yamt 257 1.3.10.2 yamt int 258 1.3.10.2 yamt psm_init(struct psm_softc *sc) 259 1.3.10.2 yamt { 260 1.3.10.2 yamt int x; 261 1.3.10.2 yamt uint8_t batt = 0xff; /* keep GCC 4.x happy */ 262 1.3.10.2 yamt 263 1.3.10.2 yamt /* clear interrupts */ 264 1.3.10.2 yamt x = splhigh(); 265 1.3.10.2 yamt PUT8(sc, PSM_ICR, 0xff); 266 1.3.10.2 yamt splx(x); 267 1.3.10.2 yamt 268 1.3.10.2 yamt /* enable interrupts */ 269 1.3.10.2 yamt if (psm_misc_wr(sc, PSM_MISC_IMR, PSM_IMR_ALL)) 270 1.3.10.2 yamt return (-1); 271 1.3.10.2 yamt 272 1.3.10.2 yamt /* make sure that UPS battery is reasonable */ 273 1.3.10.2 yamt if (psm_misc_rd(sc, PSM_MISC_UPS, &batt) || (batt > PSM_MAX_BATTERIES)) 274 1.3.10.2 yamt if (psm_misc_wr(sc, PSM_MISC_UPS, batt)) 275 1.3.10.2 yamt printf("%s: cannot set UPS battery", 276 1.3.10.2 yamt sc->sc_dev.dv_xname); 277 1.3.10.2 yamt 278 1.3.10.2 yamt return (0); 279 1.3.10.2 yamt } 280 1.3.10.2 yamt 281 1.3.10.2 yamt void 282 1.3.10.2 yamt psm_reset(struct psm_softc *sc) 283 1.3.10.2 yamt { 284 1.3.10.2 yamt 285 1.3.10.2 yamt PUT8(sc, PSM_MCR, PSM_MCR_RST); 286 1.3.10.2 yamt delay(RESET_DELAY); 287 1.3.10.2 yamt } 288 1.3.10.2 yamt 289 1.3.10.2 yamt void 290 1.3.10.2 yamt psm_poll_acpower(struct psm_softc *sc) 291 1.3.10.2 yamt { 292 1.3.10.2 yamt int flags = sc->sc_flags; 293 1.3.10.2 yamt 294 1.3.10.2 yamt if (GET8(sc, PSM_STAT) & PSM_STAT_AC) { 295 1.3.10.2 yamt sc->sc_flags |= PSM_FLAG_ACPWR; 296 1.3.10.2 yamt } else { 297 1.3.10.2 yamt sc->sc_flags &= ~PSM_FLAG_ACPWR; 298 1.3.10.2 yamt } 299 1.3.10.2 yamt if (flags != sc->sc_flags) 300 1.3.10.2 yamt sc->sc_event |= PSM_EV_ACPWR; 301 1.3.10.2 yamt } 302 1.3.10.2 yamt 303 1.3.10.2 yamt int 304 1.3.10.2 yamt psm_misc_rd(struct psm_softc *sc, uint8_t mreg, uint8_t *data) 305 1.3.10.2 yamt { 306 1.3.10.2 yamt 307 1.3.10.2 yamt return (psm_ecmd_rd8(sc, data, mreg, PSM_MODE_MISC, 0)); 308 1.3.10.2 yamt } 309 1.3.10.2 yamt 310 1.3.10.2 yamt int 311 1.3.10.2 yamt psm_misc_wr(struct psm_softc *sc, uint8_t mreg, uint8_t data) 312 1.3.10.2 yamt { 313 1.3.10.2 yamt 314 1.3.10.2 yamt return (psm_ecmd_wr8(sc, data, mreg, PSM_MODE_MISC, 0)); 315 1.3.10.2 yamt } 316 1.3.10.2 yamt 317 1.3.10.2 yamt int 318 1.3.10.2 yamt psm_wait(struct psm_softc *sc, uint8_t flag) 319 1.3.10.2 yamt { 320 1.3.10.2 yamt int retr = WAIT_RETRIES; 321 1.3.10.2 yamt 322 1.3.10.2 yamt while (GET8(sc, PSM_STAT) & flag) { 323 1.3.10.2 yamt if (!(retr--)) { 324 1.3.10.2 yamt return (-1); 325 1.3.10.2 yamt } 326 1.3.10.2 yamt delay(WAIT_DELAY); 327 1.3.10.2 yamt } 328 1.3.10.2 yamt return (0); 329 1.3.10.2 yamt } 330 1.3.10.2 yamt 331 1.3.10.2 yamt #if 0 332 1.3.10.2 yamt int 333 1.3.10.2 yamt psm_ecmd_rd16(struct psm_softc *sc, uint16_t *data, uint8_t iar, uint8_t mode, 334 1.3.10.2 yamt uint8_t addr) 335 1.3.10.2 yamt { 336 1.3.10.2 yamt uint8_t cmr = PSM_CMR_DATA(mode, PSM_L_16, PSM_D_RD, addr); 337 1.3.10.2 yamt int x, rc, retr = CMD_RETRIES; 338 1.3.10.2 yamt 339 1.3.10.2 yamt x = splhigh(); 340 1.3.10.2 yamt 341 1.3.10.2 yamt do { 342 1.3.10.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) != 0) { 343 1.3.10.2 yamt psm_reset(sc); 344 1.3.10.2 yamt continue; 345 1.3.10.2 yamt } 346 1.3.10.2 yamt 347 1.3.10.2 yamt PUT8(sc, PSM_IAR, iar); 348 1.3.10.2 yamt PUT8(sc, PSM_CMR, cmr); 349 1.3.10.2 yamt 350 1.3.10.2 yamt delay(CMD_DELAY); 351 1.3.10.2 yamt 352 1.3.10.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) == 0) { 353 1.3.10.2 yamt *data = GET8(sc, PSM_PWDL) | (GET8(sc, PSM_PWDU) << 8); 354 1.3.10.2 yamt break; 355 1.3.10.2 yamt } 356 1.3.10.2 yamt 357 1.3.10.2 yamt psm_reset(sc); 358 1.3.10.2 yamt 359 1.3.10.2 yamt } while (--retr); 360 1.3.10.2 yamt 361 1.3.10.2 yamt splx(x); 362 1.3.10.2 yamt return (rc); 363 1.3.10.2 yamt } 364 1.3.10.2 yamt #endif 365 1.3.10.2 yamt 366 1.3.10.2 yamt int 367 1.3.10.2 yamt psm_ecmd_rd8(struct psm_softc *sc, uint8_t *data, uint8_t iar, uint8_t mode, 368 1.3.10.2 yamt uint8_t addr) 369 1.3.10.2 yamt { 370 1.3.10.2 yamt uint8_t cmr = PSM_CMR_DATA(mode, PSM_L_8, PSM_D_RD, addr); 371 1.3.10.2 yamt int x, rc, retr = CMD_RETRIES; 372 1.3.10.2 yamt 373 1.3.10.2 yamt x = splhigh(); 374 1.3.10.2 yamt 375 1.3.10.2 yamt do { 376 1.3.10.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) != 0) { 377 1.3.10.2 yamt psm_reset(sc); 378 1.3.10.2 yamt continue; 379 1.3.10.2 yamt } 380 1.3.10.2 yamt 381 1.3.10.2 yamt PUT8(sc, PSM_IAR, iar); 382 1.3.10.2 yamt PUT8(sc, PSM_CMR, cmr); 383 1.3.10.2 yamt 384 1.3.10.2 yamt delay(CMD_DELAY); 385 1.3.10.2 yamt 386 1.3.10.2 yamt if ((rc = psm_wait(sc, PSM_STAT_RDA)) == 0) { 387 1.3.10.2 yamt (void) GET8(sc, PSM_PWDU); 388 1.3.10.2 yamt *data = GET8(sc, PSM_PWDL); 389 1.3.10.2 yamt break; 390 1.3.10.2 yamt } 391 1.3.10.2 yamt 392 1.3.10.2 yamt psm_reset(sc); 393 1.3.10.2 yamt 394 1.3.10.2 yamt } while (--retr); 395 1.3.10.2 yamt 396 1.3.10.2 yamt splx(x); 397 1.3.10.2 yamt return (rc); 398 1.3.10.2 yamt } 399 1.3.10.2 yamt 400 1.3.10.2 yamt int 401 1.3.10.2 yamt psm_ecmd_wr8(struct psm_softc *sc, uint8_t data, uint8_t iar, uint8_t mode, 402 1.3.10.2 yamt uint8_t addr) 403 1.3.10.2 yamt { 404 1.3.10.2 yamt uint8_t cmr = PSM_CMR_DATA(mode, PSM_L_8, PSM_D_WR, addr); 405 1.3.10.2 yamt int x, rc, retr = CMD_RETRIES; 406 1.3.10.2 yamt 407 1.3.10.2 yamt x = splhigh(); 408 1.3.10.2 yamt 409 1.3.10.2 yamt do { 410 1.3.10.2 yamt if ((rc = psm_wait(sc, PSM_STAT_WBF)) != 0) { 411 1.3.10.2 yamt psm_reset(sc); 412 1.3.10.2 yamt continue; 413 1.3.10.2 yamt } 414 1.3.10.2 yamt 415 1.3.10.2 yamt PUT8(sc, PSM_PWDU, 0); 416 1.3.10.2 yamt PUT8(sc, PSM_PWDL, data); 417 1.3.10.2 yamt PUT8(sc, PSM_IAR, iar); 418 1.3.10.2 yamt PUT8(sc, PSM_CMR, cmr); 419 1.3.10.2 yamt 420 1.3.10.2 yamt delay(CMD_DELAY); 421 1.3.10.2 yamt 422 1.3.10.2 yamt if ((rc = psm_wait(sc, PSM_STAT_WBF)) == 0) { 423 1.3.10.2 yamt break; 424 1.3.10.2 yamt } 425 1.3.10.2 yamt 426 1.3.10.2 yamt psm_reset(sc); 427 1.3.10.2 yamt } while (--retr); 428 1.3.10.2 yamt 429 1.3.10.2 yamt splx(x); 430 1.3.10.2 yamt 431 1.3.10.2 yamt return (rc); 432 1.3.10.2 yamt } 433 1.3.10.2 yamt 434 1.3.10.2 yamt int 435 1.3.10.2 yamt psm_intr(void *arg) 436 1.3.10.2 yamt { 437 1.3.10.2 yamt struct psm_softc *sc = arg; 438 1.3.10.2 yamt uint8_t isr; 439 1.3.10.2 yamt 440 1.3.10.2 yamt isr = GET8(sc, PSM_ISR); 441 1.3.10.2 yamt if (isr & PSM_ISR_PO) { 442 1.3.10.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_PO); 443 1.3.10.2 yamt sc->sc_event |= PSM_EV_PBUTTON; 444 1.3.10.2 yamt } 445 1.3.10.2 yamt if (isr & PSM_ISR_DK) { 446 1.3.10.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_DK); 447 1.3.10.2 yamt sc->sc_flags |= PSM_FLAG_DOCKED; 448 1.3.10.2 yamt } 449 1.3.10.2 yamt if (isr & PSM_ISR_UDK) { 450 1.3.10.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_UDK); 451 1.3.10.2 yamt sc->sc_flags &= ~PSM_FLAG_DOCKED; 452 1.3.10.2 yamt } 453 1.3.10.2 yamt if (isr & PSM_ISR_LIDC) { 454 1.3.10.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_LIDC); 455 1.3.10.2 yamt sc->sc_flags |= PSM_FLAG_LIDCLOSED; 456 1.3.10.2 yamt sc->sc_event |= PSM_EV_LID; 457 1.3.10.2 yamt } 458 1.3.10.2 yamt if (isr & PSM_ISR_LIDO) { 459 1.3.10.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_LIDO); 460 1.3.10.2 yamt sc->sc_flags &= ~PSM_FLAG_LIDCLOSED; 461 1.3.10.2 yamt sc->sc_event |= PSM_EV_LID; 462 1.3.10.2 yamt } 463 1.3.10.2 yamt if (isr & PSM_ISR_TMP) { 464 1.3.10.2 yamt /* Over temperature */ 465 1.3.10.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_TMP); 466 1.3.10.2 yamt sc->sc_event |= PSM_EV_TEMP; 467 1.3.10.2 yamt } 468 1.3.10.2 yamt if (isr & PSM_ISR_BCC) { 469 1.3.10.2 yamt /* battery config changed */ 470 1.3.10.2 yamt PUT8(sc, PSM_ICR, PSM_ISR_BCC); 471 1.3.10.2 yamt sc->sc_event |= PSM_EV_BATT; 472 1.3.10.2 yamt } 473 1.3.10.2 yamt if (isr & PSM_ISR_RPD) { 474 1.3.10.2 yamt /* request to power down */ 475 1.3.10.2 yamt sc->sc_event |= PSM_EV_PBUTTON; 476 1.3.10.2 yamt } 477 1.3.10.2 yamt if (sc->sc_event) { 478 1.3.10.2 yamt /* wake up the thread */ 479 1.3.10.2 yamt wakeup(sc); 480 1.3.10.2 yamt } 481 1.3.10.2 yamt return (1); 482 1.3.10.2 yamt } 483
Indexes created Thu Oct 02 14:10:14 GMT 2025