1 /*- 2 * Copyright (c) 2006 Michael Lorenz 3 * Copyright 2008 by Nathan Whitehorn 4 * All rights reserved. 5 * 6 * Redistribution and use in source and binary forms, with or without 7 * modification, are permitted provided that the following conditions 8 * are met: 9 * 1. Redistributions of source code must retain the above copyright 10 * notice, this list of conditions and the following disclaimer. 11 * 2. Redistributions in binary form must reproduce the above copyright 12 * notice, this list of conditions and the following disclaimer in the 13 * documentation and/or other materials provided with the distribution. 14 * 15 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR 16 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 17 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 18 * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, 19 * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 20 * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 21 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED 22 * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, 23 * OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 24 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 25 * SUCH DAMAGE. 26 * 27 */ 28 29 #include <sys/cdefs.h> 30 __FBSDID("$FreeBSD$"); 31 32 #include <sys/param.h> 33 #include <sys/systm.h> 34 #include <sys/module.h> 35 #include <sys/bus.h> 36 #include <sys/conf.h> 37 #include <sys/kernel.h> 38 #include <sys/sysctl.h> 39 40 #include <dev/ofw/ofw_bus.h> 41 #include <dev/ofw/openfirm.h> 42 #include <dev/led/led.h> 43 44 #include <machine/bus.h> 45 #include <machine/intr.h> 46 #include <machine/intr_machdep.h> 47 #include <machine/md_var.h> 48 #include <machine/pio.h> 49 #include <machine/resource.h> 50 51 #include <vm/vm.h> 52 #include <vm/pmap.h> 53 54 #include <sys/rman.h> 55 56 #include <dev/adb/adb.h> 57 58 #include "pmuvar.h" 59 #include "viareg.h" 60 61 /* 62 * MacIO interface 63 */ 64 static int pmu_probe(device_t); 65 static int pmu_attach(device_t); 66 static int pmu_detach(device_t); 67 68 static u_int pmu_adb_send(device_t dev, u_char command_byte, int len, 69 u_char *data, u_char poll); 70 static u_int pmu_adb_autopoll(device_t dev, uint16_t mask); 71 static void pmu_poll(device_t dev); 72 73 static void pmu_set_sleepled(void *xsc, int onoff); 74 static int pmu_server_mode(SYSCTL_HANDLER_ARGS); 75 static int pmu_acline_state(SYSCTL_HANDLER_ARGS); 76 static int pmu_query_battery(struct pmu_softc *sc, int batt, 77 struct pmu_battstate *info); 78 static int pmu_battquery_sysctl(SYSCTL_HANDLER_ARGS); 79 80 /* 81 * List of battery-related sysctls we might ask for 82 */ 83 84 enum { 85 PMU_BATSYSCTL_PRESENT = 1 << 8, 86 PMU_BATSYSCTL_CHARGING = 2 << 8, 87 PMU_BATSYSCTL_CHARGE = 3 << 8, 88 PMU_BATSYSCTL_MAXCHARGE = 4 << 8, 89 PMU_BATSYSCTL_CURRENT = 5 << 8, 90 PMU_BATSYSCTL_VOLTAGE = 6 << 8, 91 PMU_BATSYSCTL_TIME = 7 << 8, 92 PMU_BATSYSCTL_LIFE = 8 << 8 93 }; 94 95 static device_method_t pmu_methods[] = { 96 /* Device interface */ 97 DEVMETHOD(device_probe, pmu_probe), 98 DEVMETHOD(device_attach, pmu_attach), 99 DEVMETHOD(device_detach, pmu_detach), 100 DEVMETHOD(device_shutdown, bus_generic_shutdown), 101 DEVMETHOD(device_suspend, bus_generic_suspend), 102 DEVMETHOD(device_resume, bus_generic_resume), 103 104 /* bus interface, for ADB root */ 105 DEVMETHOD(bus_print_child, bus_generic_print_child), 106 DEVMETHOD(bus_driver_added, bus_generic_driver_added), 107 108 /* ADB bus interface */ 109 DEVMETHOD(adb_hb_send_raw_packet, pmu_adb_send), 110 DEVMETHOD(adb_hb_controller_poll, pmu_poll), 111 DEVMETHOD(adb_hb_set_autopoll_mask, pmu_adb_autopoll), 112 113 { 0, 0 }, 114 }; 115 116 static driver_t pmu_driver = { 117 "pmu", 118 pmu_methods, 119 sizeof(struct pmu_softc), 120 }; 121 122 static devclass_t pmu_devclass; 123 124 DRIVER_MODULE(pmu, macio, pmu_driver, pmu_devclass, 0, 0); 125 DRIVER_MODULE(adb, pmu, adb_driver, adb_devclass, 0, 0); 126 127 static int pmuextint_probe(device_t); 128 static int pmuextint_attach(device_t); 129 130 static device_method_t pmuextint_methods[] = { 131 /* Device interface */ 132 DEVMETHOD(device_probe, pmuextint_probe), 133 DEVMETHOD(device_attach, pmuextint_attach), 134 135 {0,0} 136 }; 137 138 static driver_t pmuextint_driver = { 139 "pmuextint", 140 pmuextint_methods, 141 0 142 }; 143 144 static devclass_t pmuextint_devclass; 145 146 DRIVER_MODULE(pmuextint, macgpio, pmuextint_driver, pmuextint_devclass, 0, 0); 147 148 /* Make sure uhid is loaded, as it turns off some of the ADB emulation */ 149 MODULE_DEPEND(pmu, usb, 1, 1, 1); 150 151 static void pmu_intr(void *arg); 152 static void pmu_in(struct pmu_softc *sc); 153 static void pmu_out(struct pmu_softc *sc); 154 static void pmu_ack_on(struct pmu_softc *sc); 155 static void pmu_ack_off(struct pmu_softc *sc); 156 static int pmu_send(void *cookie, int cmd, int length, uint8_t *in_msg, 157 int rlen, uint8_t *out_msg); 158 static uint8_t pmu_read_reg(struct pmu_softc *sc, u_int offset); 159 static void pmu_write_reg(struct pmu_softc *sc, u_int offset, uint8_t value); 160 static int pmu_intr_state(struct pmu_softc *); 161 162 /* these values shows that number of data returned after 'send' cmd is sent */ 163 static signed char pm_send_cmd_type[] = { 164 -1, -1, -1, -1, -1, -1, -1, -1, 165 -1, -1, -1, -1, -1, -1, -1, -1, 166 0x01, 0x01, -1, -1, -1, -1, -1, -1, 167 0x00, 0x00, -1, -1, -1, -1, -1, 0x00, 168 -1, 0x00, 0x02, 0x01, 0x01, -1, -1, -1, 169 0x00, -1, -1, -1, -1, -1, -1, -1, 170 0x04, 0x14, -1, 0x03, -1, -1, -1, -1, 171 0x00, 0x00, 0x02, 0x02, -1, -1, -1, -1, 172 0x01, 0x01, -1, -1, -1, -1, -1, -1, 173 0x00, 0x00, -1, -1, 0x01, -1, -1, -1, 174 0x01, 0x00, 0x02, 0x02, -1, 0x01, 0x03, 0x01, 175 0x00, 0x01, 0x00, 0x00, 0x00, -1, -1, -1, 176 0x02, -1, -1, -1, -1, -1, -1, -1, 177 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, -1, -1, 178 0x01, 0x01, 0x01, -1, -1, -1, -1, -1, 179 0x00, 0x00, -1, -1, -1, -1, 0x04, 0x04, 180 0x04, -1, 0x00, -1, -1, -1, -1, -1, 181 0x00, -1, -1, -1, -1, -1, -1, -1, 182 0x01, 0x02, -1, -1, -1, -1, -1, -1, 183 0x00, 0x00, -1, -1, -1, -1, -1, -1, 184 0x02, 0x02, 0x02, 0x04, -1, 0x00, -1, -1, 185 0x01, 0x01, 0x03, 0x02, -1, -1, -1, -1, 186 -1, -1, -1, -1, -1, -1, -1, -1, 187 -1, -1, -1, -1, -1, -1, -1, -1, 188 -1, -1, -1, -1, -1, -1, -1, -1, 189 -1, -1, -1, -1, -1, -1, -1, -1, 190 0x00, -1, -1, -1, -1, -1, -1, -1, 191 0x01, 0x01, -1, -1, 0x00, 0x00, -1, -1, 192 -1, 0x04, 0x00, -1, -1, -1, -1, -1, 193 0x03, -1, 0x00, -1, 0x00, -1, -1, 0x00, 194 -1, -1, -1, -1, -1, -1, -1, -1, 195 -1, -1, -1, -1, -1, -1, -1, -1 196 }; 197 198 /* these values shows that number of data returned after 'receive' cmd is sent */ 199 static signed char pm_receive_cmd_type[] = { 200 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 201 -1, -1, -1, -1, -1, -1, -1, -1, 202 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 203 0x02, 0x02, -1, -1, -1, -1, -1, 0x00, 204 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 205 -1, -1, -1, -1, -1, -1, -1, -1, 206 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 207 0x05, 0x15, -1, 0x02, -1, -1, -1, -1, 208 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 209 0x02, 0x02, -1, -1, -1, -1, -1, -1, 210 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 211 0x02, 0x00, 0x03, 0x03, -1, -1, -1, -1, 212 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 213 0x04, 0x04, 0x03, 0x09, -1, -1, -1, -1, 214 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 215 -1, -1, -1, -1, -1, -1, 0x01, 0x01, 216 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 217 0x06, -1, -1, -1, -1, -1, -1, -1, 218 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 219 0x02, 0x02, -1, -1, -1, -1, -1, -1, 220 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 221 0x02, 0x00, 0x00, 0x00, -1, -1, -1, -1, 222 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 223 -1, -1, -1, -1, -1, -1, -1, -1, 224 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 225 -1, -1, -1, -1, -1, -1, -1, -1, 226 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 227 0x02, 0x02, -1, -1, 0x02, -1, -1, -1, 228 0x00, 0x00, 0x01, 0x00, 0x00, 0x00, 0x00, 0x00, 229 -1, -1, 0x02, -1, -1, -1, -1, 0x00, 230 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 0x00, 231 -1, -1, -1, -1, -1, -1, -1, -1, 232 }; 233 234 /* We only have one of each device, so globals are safe */ 235 static device_t pmu = NULL; 236 static device_t pmu_extint = NULL; 237 238 static int 239 pmuextint_probe(device_t dev) 240 { 241 const char *type = ofw_bus_get_type(dev); 242 243 if (strcmp(type, "extint-gpio1") != 0) 244 return (ENXIO); 245 246 device_set_desc(dev, "Apple PMU99 External Interrupt"); 247 return (0); 248 } 249 250 static int 251 pmu_probe(device_t dev) 252 { 253 const char *type = ofw_bus_get_type(dev); 254 255 if (strcmp(type, "via-pmu") != 0) 256 return (ENXIO); 257 258 device_set_desc(dev, "Apple PMU99 Controller"); 259 return (0); 260 } 261 262 263 static int 264 setup_pmu_intr(device_t dev, device_t extint) 265 { 266 struct pmu_softc *sc; 267 sc = device_get_softc(dev); 268 269 sc->sc_irqrid = 0; 270 sc->sc_irq = bus_alloc_resource_any(extint, SYS_RES_IRQ, &sc->sc_irqrid, 271 RF_ACTIVE); 272 if (sc->sc_irq == NULL) { 273 device_printf(dev, "could not allocate interrupt\n"); 274 return (ENXIO); 275 } 276 277 if (bus_setup_intr(dev, sc->sc_irq, INTR_TYPE_MISC | INTR_MPSAFE 278 | INTR_ENTROPY, NULL, pmu_intr, dev, &sc->sc_ih) != 0) { 279 device_printf(dev, "could not setup interrupt\n"); 280 bus_release_resource(dev, SYS_RES_IRQ, sc->sc_irqrid, 281 sc->sc_irq); 282 return (ENXIO); 283 } 284 285 return (0); 286 } 287 288 static int 289 pmuextint_attach(device_t dev) 290 { 291 pmu_extint = dev; 292 if (pmu) 293 return (setup_pmu_intr(pmu,dev)); 294 295 return (0); 296 } 297 298 static int 299 pmu_attach(device_t dev) 300 { 301 struct pmu_softc *sc; 302 303 int i; 304 uint8_t reg; 305 uint8_t cmd[2] = {2, 0}; 306 uint8_t resp[16]; 307 phandle_t node,child; 308 struct sysctl_ctx_list *ctx; 309 struct sysctl_oid *tree; 310 311 sc = device_get_softc(dev); 312 sc->sc_dev = dev; 313 314 sc->sc_memrid = 0; 315 sc->sc_memr = bus_alloc_resource_any(dev, SYS_RES_MEMORY, 316 &sc->sc_memrid, RF_ACTIVE); 317 318 mtx_init(&sc->sc_mutex,"pmu",NULL,MTX_DEF | MTX_RECURSE); 319 320 if (sc->sc_memr == NULL) { 321 device_printf(dev, "Could not alloc mem resource!\n"); 322 return (ENXIO); 323 } 324 325 /* 326 * Our interrupt is attached to a GPIO pin. Depending on probe order, 327 * we may not have found it yet. If we haven't, it will find us, and 328 * attach our interrupt then. 329 */ 330 pmu = dev; 331 if (pmu_extint != NULL) { 332 if (setup_pmu_intr(dev,pmu_extint) != 0) 333 return (ENXIO); 334 } 335 336 sc->sc_autopoll = 0; 337 sc->sc_batteries = 0; 338 sc->adb_bus = NULL; 339 sc->sc_leddev = NULL; 340 341 /* Init PMU */ 342 343 reg = PMU_INT_TICK | PMU_INT_ADB | PMU_INT_PCEJECT | PMU_INT_SNDBRT; 344 reg |= PMU_INT_BATTERY; 345 reg |= PMU_INT_ENVIRONMENT; 346 pmu_send(sc, PMU_SET_IMASK, 1, ®, 16, resp); 347 348 pmu_write_reg(sc, vIER, 0x90); /* make sure VIA interrupts are on */ 349 350 pmu_send(sc, PMU_SYSTEM_READY, 1, cmd, 16, resp); 351 pmu_send(sc, PMU_GET_VERSION, 1, cmd, 16, resp); 352 353 /* Initialize child buses (ADB) */ 354 node = ofw_bus_get_node(dev); 355 356 for (child = OF_child(node); child != 0; child = OF_peer(child)) { 357 char name[32]; 358 359 memset(name, 0, sizeof(name)); 360 OF_getprop(child, "name", name, sizeof(name)); 361 362 if (bootverbose) 363 device_printf(dev, "PMU child <%s>\n",name); 364 365 if (strncmp(name, "adb", 4) == 0) { 366 sc->adb_bus = device_add_child(dev,"adb",-1); 367 } 368 369 if (strncmp(name, "power-mgt", 9) == 0) { 370 uint32_t prim_info[9]; 371 372 if (OF_getprop(child, "prim-info", prim_info, 373 sizeof(prim_info)) >= 7) 374 sc->sc_batteries = (prim_info[6] >> 16) & 0xff; 375 376 if (bootverbose && sc->sc_batteries > 0) 377 device_printf(dev, "%d batteries detected\n", 378 sc->sc_batteries); 379 } 380 } 381 382 /* 383 * Set up sysctls 384 */ 385 386 ctx = device_get_sysctl_ctx(dev); 387 tree = device_get_sysctl_tree(dev); 388 389 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, 390 "server_mode", CTLTYPE_INT | CTLFLAG_RW, sc, 0, 391 pmu_server_mode, "I", "Enable reboot after power failure"); 392 393 if (sc->sc_batteries > 0) { 394 struct sysctl_oid *oid, *battroot; 395 char battnum[2]; 396 397 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, 398 "acline", CTLTYPE_INT | CTLFLAG_RD, sc, 0, 399 pmu_acline_state, "I", "AC Line Status"); 400 401 battroot = SYSCTL_ADD_NODE(ctx, SYSCTL_CHILDREN(tree), OID_AUTO, 402 "batteries", CTLFLAG_RD, 0, "Battery Information"); 403 404 for (i = 0; i < sc->sc_batteries; i++) { 405 battnum[0] = i + '0'; 406 battnum[1] = '\0'; 407 408 oid = SYSCTL_ADD_NODE(ctx, SYSCTL_CHILDREN(battroot), 409 OID_AUTO, battnum, CTLFLAG_RD, 0, 410 "Battery Information"); 411 412 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 413 "present", CTLTYPE_INT | CTLFLAG_RD, sc, 414 PMU_BATSYSCTL_PRESENT | i, pmu_battquery_sysctl, 415 "I", "Battery present"); 416 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 417 "charging", CTLTYPE_INT | CTLFLAG_RD, sc, 418 PMU_BATSYSCTL_CHARGING | i, pmu_battquery_sysctl, 419 "I", "Battery charging"); 420 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 421 "charge", CTLTYPE_INT | CTLFLAG_RD, sc, 422 PMU_BATSYSCTL_CHARGE | i, pmu_battquery_sysctl, 423 "I", "Battery charge (mAh)"); 424 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 425 "maxcharge", CTLTYPE_INT | CTLFLAG_RD, sc, 426 PMU_BATSYSCTL_MAXCHARGE | i, pmu_battquery_sysctl, 427 "I", "Maximum battery capacity (mAh)"); 428 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 429 "rate", CTLTYPE_INT | CTLFLAG_RD, sc, 430 PMU_BATSYSCTL_CURRENT | i, pmu_battquery_sysctl, 431 "I", "Battery discharge rate (mA)"); 432 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 433 "voltage", CTLTYPE_INT | CTLFLAG_RD, sc, 434 PMU_BATSYSCTL_VOLTAGE | i, pmu_battquery_sysctl, 435 "I", "Battery voltage (mV)"); 436 437 /* Knobs for mental compatibility with ACPI */ 438 439 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 440 "time", CTLTYPE_INT | CTLFLAG_RD, sc, 441 PMU_BATSYSCTL_TIME | i, pmu_battquery_sysctl, 442 "I", "Time Remaining (minutes)"); 443 SYSCTL_ADD_PROC(ctx, SYSCTL_CHILDREN(oid), OID_AUTO, 444 "life", CTLTYPE_INT | CTLFLAG_RD, sc, 445 PMU_BATSYSCTL_LIFE | i, pmu_battquery_sysctl, 446 "I", "Capacity remaining (percent)"); 447 } 448 } 449 450 /* 451 * Set up LED interface 452 */ 453 454 sc->sc_leddev = led_create(pmu_set_sleepled, sc, "sleepled"); 455 456 return (bus_generic_attach(dev)); 457 } 458 459 static int 460 pmu_detach(device_t dev) 461 { 462 struct pmu_softc *sc; 463 464 sc = device_get_softc(dev); 465 466 if (sc->sc_leddev != NULL) 467 led_destroy(sc->sc_leddev); 468 469 bus_teardown_intr(dev, sc->sc_irq, sc->sc_ih); 470 bus_release_resource(dev, SYS_RES_IRQ, sc->sc_irqrid, sc->sc_irq); 471 bus_release_resource(dev, SYS_RES_MEMORY, sc->sc_memrid, sc->sc_memr); 472 mtx_destroy(&sc->sc_mutex); 473 474 return (bus_generic_detach(dev)); 475 } 476 477 static uint8_t 478 pmu_read_reg(struct pmu_softc *sc, u_int offset) 479 { 480 return (bus_read_1(sc->sc_memr, offset)); 481 } 482 483 static void 484 pmu_write_reg(struct pmu_softc *sc, u_int offset, uint8_t value) 485 { 486 bus_write_1(sc->sc_memr, offset, value); 487 } 488 489 static int 490 pmu_send_byte(struct pmu_softc *sc, uint8_t data) 491 { 492 493 pmu_out(sc); 494 pmu_write_reg(sc, vSR, data); 495 pmu_ack_off(sc); 496 /* wait for intr to come up */ 497 /* XXX should add a timeout and bail if it expires */ 498 do {} while (pmu_intr_state(sc) == 0); 499 pmu_ack_on(sc); 500 do {} while (pmu_intr_state(sc)); 501 pmu_ack_on(sc); 502 return 0; 503 } 504 505 static inline int 506 pmu_read_byte(struct pmu_softc *sc, uint8_t *data) 507 { 508 volatile uint8_t scratch; 509 pmu_in(sc); 510 scratch = pmu_read_reg(sc, vSR); 511 pmu_ack_off(sc); 512 /* wait for intr to come up */ 513 do {} while (pmu_intr_state(sc) == 0); 514 pmu_ack_on(sc); 515 do {} while (pmu_intr_state(sc)); 516 *data = pmu_read_reg(sc, vSR); 517 return 0; 518 } 519 520 static int 521 pmu_intr_state(struct pmu_softc *sc) 522 { 523 return ((pmu_read_reg(sc, vBufB) & vPB3) == 0); 524 } 525 526 static int 527 pmu_send(void *cookie, int cmd, int length, uint8_t *in_msg, int rlen, 528 uint8_t *out_msg) 529 { 530 struct pmu_softc *sc = cookie; 531 int i, rcv_len = -1; 532 uint8_t out_len, intreg; 533 534 intreg = pmu_read_reg(sc, vIER); 535 intreg &= 0x10; 536 pmu_write_reg(sc, vIER, intreg); 537 538 /* wait idle */ 539 do {} while (pmu_intr_state(sc)); 540 541 /* send command */ 542 pmu_send_byte(sc, cmd); 543 544 /* send length if necessary */ 545 if (pm_send_cmd_type[cmd] < 0) { 546 pmu_send_byte(sc, length); 547 } 548 549 for (i = 0; i < length; i++) { 550 pmu_send_byte(sc, in_msg[i]); 551 } 552 553 /* see if there's data to read */ 554 rcv_len = pm_receive_cmd_type[cmd]; 555 if (rcv_len == 0) 556 goto done; 557 558 /* read command */ 559 if (rcv_len == 1) { 560 pmu_read_byte(sc, out_msg); 561 goto done; 562 } else 563 out_msg[0] = cmd; 564 if (rcv_len < 0) { 565 pmu_read_byte(sc, &out_len); 566 rcv_len = out_len + 1; 567 } 568 for (i = 1; i < min(rcv_len, rlen); i++) 569 pmu_read_byte(sc, &out_msg[i]); 570 571 done: 572 pmu_write_reg(sc, vIER, (intreg == 0) ? 0 : 0x90); 573 574 return rcv_len; 575 } 576 577 578 static void 579 pmu_poll(device_t dev) 580 { 581 pmu_intr(dev); 582 } 583 584 static void 585 pmu_in(struct pmu_softc *sc) 586 { 587 uint8_t reg; 588 589 reg = pmu_read_reg(sc, vACR); 590 reg &= ~vSR_OUT; 591 reg |= 0x0c; 592 pmu_write_reg(sc, vACR, reg); 593 } 594 595 static void 596 pmu_out(struct pmu_softc *sc) 597 { 598 uint8_t reg; 599 600 reg = pmu_read_reg(sc, vACR); 601 reg |= vSR_OUT; 602 reg |= 0x0c; 603 pmu_write_reg(sc, vACR, reg); 604 } 605 606 static void 607 pmu_ack_off(struct pmu_softc *sc) 608 { 609 uint8_t reg; 610 611 reg = pmu_read_reg(sc, vBufB); 612 reg &= ~vPB4; 613 pmu_write_reg(sc, vBufB, reg); 614 } 615 616 static void 617 pmu_ack_on(struct pmu_softc *sc) 618 { 619 uint8_t reg; 620 621 reg = pmu_read_reg(sc, vBufB); 622 reg |= vPB4; 623 pmu_write_reg(sc, vBufB, reg); 624 } 625 626 static void 627 pmu_intr(void *arg) 628 { 629 device_t dev; 630 struct pmu_softc *sc; 631 632 unsigned int len; 633 uint8_t resp[16]; 634 uint8_t junk[16]; 635 636 dev = (device_t)arg; 637 sc = device_get_softc(dev); 638 639 mtx_lock(&sc->sc_mutex); 640 641 pmu_write_reg(sc, vIFR, 0x90); /* Clear 'em */ 642 len = pmu_send(sc, PMU_INT_ACK, 0, NULL, 16, resp); 643 644 mtx_unlock(&sc->sc_mutex); 645 646 if ((len < 1) || (resp[1] == 0)) { 647 return; 648 } 649 650 if (resp[1] & PMU_INT_ADB) { 651 /* 652 * the PMU will turn off autopolling after each command that 653 * it did not issue, so we assume any but TALK R0 is ours and 654 * re-enable autopoll here whenever we receive an ACK for a 655 * non TR0 command. 656 */ 657 mtx_lock(&sc->sc_mutex); 658 659 if ((resp[2] & 0x0f) != (ADB_COMMAND_TALK << 2)) { 660 if (sc->sc_autopoll) { 661 uint8_t cmd[] = {0, PMU_SET_POLL_MASK, 662 (sc->sc_autopoll >> 8) & 0xff, 663 sc->sc_autopoll & 0xff}; 664 665 pmu_send(sc, PMU_ADB_CMD, 4, cmd, 16, junk); 666 } 667 } 668 669 mtx_unlock(&sc->sc_mutex); 670 671 adb_receive_raw_packet(sc->adb_bus,resp[1],resp[2], 672 len - 3,&resp[3]); 673 } 674 } 675 676 static u_int 677 pmu_adb_send(device_t dev, u_char command_byte, int len, u_char *data, 678 u_char poll) 679 { 680 struct pmu_softc *sc = device_get_softc(dev); 681 int i,replen; 682 uint8_t packet[16], resp[16]; 683 684 /* construct an ADB command packet and send it */ 685 686 packet[0] = command_byte; 687 688 packet[1] = 0; 689 packet[2] = len; 690 for (i = 0; i < len; i++) 691 packet[i + 3] = data[i]; 692 693 mtx_lock(&sc->sc_mutex); 694 replen = pmu_send(sc, PMU_ADB_CMD, len + 3, packet, 16, resp); 695 mtx_unlock(&sc->sc_mutex); 696 697 if (poll) 698 pmu_poll(dev); 699 700 return 0; 701 } 702 703 static u_int 704 pmu_adb_autopoll(device_t dev, uint16_t mask) 705 { 706 struct pmu_softc *sc = device_get_softc(dev); 707 708 /* magical incantation to re-enable autopolling */ 709 uint8_t cmd[] = {0, PMU_SET_POLL_MASK, (mask >> 8) & 0xff, mask & 0xff}; 710 uint8_t resp[16]; 711 712 mtx_lock(&sc->sc_mutex); 713 714 if (sc->sc_autopoll == mask) { 715 mtx_unlock(&sc->sc_mutex); 716 return 0; 717 } 718 719 sc->sc_autopoll = mask & 0xffff; 720 721 if (mask) 722 pmu_send(sc, PMU_ADB_CMD, 4, cmd, 16, resp); 723 else 724 pmu_send(sc, PMU_ADB_POLL_OFF, 0, NULL, 16, resp); 725 726 mtx_unlock(&sc->sc_mutex); 727 728 return 0; 729 } 730 731 static void 732 pmu_set_sleepled(void *xsc, int onoff) 733 { 734 struct pmu_softc *sc = xsc; 735 uint8_t cmd[] = {4, 0, 0}; 736 737 cmd[2] = onoff; 738 739 mtx_lock(&sc->sc_mutex); 740 pmu_send(sc, PMU_SET_SLEEPLED, 3, cmd, 0, NULL); 741 mtx_unlock(&sc->sc_mutex); 742 } 743 744 static int 745 pmu_server_mode(SYSCTL_HANDLER_ARGS) 746 { 747 struct pmu_softc *sc = arg1; 748 749 u_int server_mode = 0; 750 uint8_t getcmd[] = {PMU_PWR_GET_POWERUP_EVENTS}; 751 uint8_t setcmd[] = {0, 0, PMU_PWR_WAKEUP_AC_INSERT}; 752 uint8_t resp[3]; 753 int error, len; 754 755 mtx_lock(&sc->sc_mutex); 756 len = pmu_send(sc, PMU_POWER_EVENTS, 1, getcmd, 3, resp); 757 mtx_unlock(&sc->sc_mutex); 758 759 if (len == 3) 760 server_mode = (resp[2] & PMU_PWR_WAKEUP_AC_INSERT) ? 1 : 0; 761 762 error = sysctl_handle_int(oidp, &server_mode, 0, req); 763 764 if (len != 3) 765 return (EINVAL); 766 767 if (error || !req->newptr) 768 return (error); 769 770 if (server_mode == 1) 771 setcmd[0] = PMU_PWR_SET_POWERUP_EVENTS; 772 else if (server_mode == 0) 773 setcmd[0] = PMU_PWR_CLR_POWERUP_EVENTS; 774 else 775 return (EINVAL); 776 777 setcmd[1] = resp[1]; 778 779 mtx_lock(&sc->sc_mutex); 780 pmu_send(sc, PMU_POWER_EVENTS, 3, setcmd, 2, resp); 781 mtx_unlock(&sc->sc_mutex); 782 783 return (0); 784 } 785 786 static int 787 pmu_query_battery(struct pmu_softc *sc, int batt, struct pmu_battstate *info) 788 { 789 uint8_t reg; 790 uint8_t resp[16]; 791 int len; 792 793 reg = batt + 1; 794 795 mtx_lock(&sc->sc_mutex); 796 len = pmu_send(sc, PMU_SMART_BATTERY_STATE, 1, ®, 16, resp); 797 mtx_unlock(&sc->sc_mutex); 798 799 if (len < 3) 800 return (-1); 801 802 /* All PMU battery info replies share a common header: 803 * Byte 1 Payload Format 804 * Byte 2 Battery Flags 805 */ 806 807 info->state = resp[2]; 808 809 switch (resp[1]) { 810 case 3: 811 case 4: 812 /* 813 * Formats 3 and 4 appear to be the same: 814 * Byte 3 Charge 815 * Byte 4 Max Charge 816 * Byte 5 Current 817 * Byte 6 Voltage 818 */ 819 820 info->charge = resp[3]; 821 info->maxcharge = resp[4]; 822 /* Current can be positive or negative */ 823 info->current = (int8_t)resp[5]; 824 info->voltage = resp[6]; 825 break; 826 case 5: 827 /* 828 * Formats 5 is a wider version of formats 3 and 4 829 * Byte 3-4 Charge 830 * Byte 5-6 Max Charge 831 * Byte 7-8 Current 832 * Byte 9-10 Voltage 833 */ 834 835 info->charge = (resp[3] << 8) | resp[4]; 836 info->maxcharge = (resp[5] << 8) | resp[6]; 837 /* Current can be positive or negative */ 838 info->current = (int16_t)((resp[7] << 8) | resp[8]); 839 info->voltage = (resp[9] << 8) | resp[10]; 840 break; 841 default: 842 device_printf(sc->sc_dev, "Unknown battery info format (%d)!\n", 843 resp[1]); 844 return (-1); 845 } 846 847 return (0); 848 } 849 850 static int 851 pmu_acline_state(SYSCTL_HANDLER_ARGS) 852 { 853 struct pmu_softc *sc; 854 struct pmu_battstate batt; 855 int error, result; 856 857 sc = arg1; 858 859 /* The PMU treats the AC line status as a property of the battery */ 860 error = pmu_query_battery(sc, 0, &batt); 861 862 if (error != 0) 863 return (error); 864 865 result = (batt.state & PMU_PWR_AC_PRESENT) ? 1 : 0; 866 error = sysctl_handle_int(oidp, &result, 0, req); 867 868 return (error); 869 } 870 871 static int 872 pmu_battquery_sysctl(SYSCTL_HANDLER_ARGS) 873 { 874 struct pmu_softc *sc; 875 struct pmu_battstate batt; 876 int error, result; 877 878 sc = arg1; 879 880 error = pmu_query_battery(sc, arg2 & 0x00ff, &batt); 881 882 if (error != 0) 883 return (error); 884 885 switch (arg2 & 0xff00) { 886 case PMU_BATSYSCTL_PRESENT: 887 result = (batt.state & PMU_PWR_BATT_PRESENT) ? 1 : 0; 888 break; 889 case PMU_BATSYSCTL_CHARGING: 890 result = (batt.state & PMU_PWR_BATT_CHARGING) ? 1 : 0; 891 break; 892 case PMU_BATSYSCTL_CHARGE: 893 result = batt.charge; 894 break; 895 case PMU_BATSYSCTL_MAXCHARGE: 896 result = batt.maxcharge; 897 break; 898 case PMU_BATSYSCTL_CURRENT: 899 result = batt.current; 900 break; 901 case PMU_BATSYSCTL_VOLTAGE: 902 result = batt.voltage; 903 break; 904 case PMU_BATSYSCTL_TIME: 905 /* Time remaining until full charge/discharge, in minutes */ 906 907 if (batt.current >= 0) 908 result = (batt.maxcharge - batt.charge) /* mAh */ * 60 909 / batt.current /* mA */; 910 else 911 result = (batt.charge /* mAh */ * 60) 912 / (-batt.current /* mA */); 913 break; 914 case PMU_BATSYSCTL_LIFE: 915 /* Battery charge fraction, in percent */ 916 result = (batt.charge * 100) / batt.maxcharge; 917 break; 918 default: 919 /* This should never happen */ 920 result = -1; 921 }; 922 923 error = sysctl_handle_int(oidp, &result, 0, req); 924 925 return (error); 926 } 927 928