qemu/hw/misc/macio/pmu.c
<<
>>
Prefs
   1/*
   2 * QEMU PowerMac PMU device support
   3 *
   4 * Copyright (c) 2016 Benjamin Herrenschmidt, IBM Corp.
   5 * Copyright (c) 2018 Mark Cave-Ayland
   6 *
   7 * Based on the CUDA device by:
   8 *
   9 * Copyright (c) 2004-2007 Fabrice Bellard
  10 * Copyright (c) 2007 Jocelyn Mayer
  11 *
  12 * Permission is hereby granted, free of charge, to any person obtaining a copy
  13 * of this software and associated documentation files (the "Software"), to deal
  14 * in the Software without restriction, including without limitation the rights
  15 * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  16 * copies of the Software, and to permit persons to whom the Software is
  17 * furnished to do so, subject to the following conditions:
  18 *
  19 * The above copyright notice and this permission notice shall be included in
  20 * all copies or substantial portions of the Software.
  21 *
  22 * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  23 * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  24 * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
  25 * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  26 * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  27 * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  28 * THE SOFTWARE.
  29 */
  30
  31#include "qemu/osdep.h"
  32#include "qemu-common.h"
  33#include "hw/ppc/mac.h"
  34#include "hw/qdev-properties.h"
  35#include "migration/vmstate.h"
  36#include "hw/input/adb.h"
  37#include "hw/irq.h"
  38#include "hw/misc/mos6522.h"
  39#include "hw/misc/macio/gpio.h"
  40#include "hw/misc/macio/pmu.h"
  41#include "qemu/timer.h"
  42#include "sysemu/runstate.h"
  43#include "qemu/cutils.h"
  44#include "qemu/log.h"
  45#include "qemu/module.h"
  46#include "trace.h"
  47
  48
  49/* Bits in B data register: all active low */
  50#define TACK    0x08    /* Transfer request (input) */
  51#define TREQ    0x10    /* Transfer acknowledge (output) */
  52
  53/* PMU returns time_t's offset from Jan 1, 1904, not 1970 */
  54#define RTC_OFFSET                      2082844800
  55
  56#define VIA_TIMER_FREQ (4700000 / 6)
  57
  58static void via_update_irq(PMUState *s)
  59{
  60    MOS6522PMUState *mps = MOS6522_PMU(&s->mos6522_pmu);
  61    MOS6522State *ms = MOS6522(mps);
  62
  63    bool new_state = !!(ms->ifr & ms->ier & (SR_INT | T1_INT | T2_INT));
  64
  65    if (new_state != s->via_irq_state) {
  66        s->via_irq_state = new_state;
  67        qemu_set_irq(s->via_irq, new_state);
  68    }
  69}
  70
  71static void via_set_sr_int(void *opaque)
  72{
  73    PMUState *s = opaque;
  74    MOS6522PMUState *mps = MOS6522_PMU(&s->mos6522_pmu);
  75    MOS6522State *ms = MOS6522(mps);
  76    MOS6522DeviceClass *mdc = MOS6522_DEVICE_GET_CLASS(ms);
  77
  78    mdc->set_sr_int(ms);
  79}
  80
  81static void pmu_update_extirq(PMUState *s)
  82{
  83    if ((s->intbits & s->intmask) != 0) {
  84        macio_set_gpio(s->gpio, 1, false);
  85    } else {
  86        macio_set_gpio(s->gpio, 1, true);
  87    }
  88}
  89
  90static void pmu_adb_poll(void *opaque)
  91{
  92    PMUState *s = opaque;
  93    int olen;
  94
  95    if (!(s->intbits & PMU_INT_ADB)) {
  96        olen = adb_poll(&s->adb_bus, s->adb_reply, s->adb_poll_mask);
  97        trace_pmu_adb_poll(olen);
  98
  99        if (olen > 0) {
 100            s->adb_reply_size = olen;
 101            s->intbits |= PMU_INT_ADB | PMU_INT_ADB_AUTO;
 102            pmu_update_extirq(s);
 103        }
 104    }
 105
 106    timer_mod(s->adb_poll_timer,
 107              qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 30);
 108}
 109
 110static void pmu_one_sec_timer(void *opaque)
 111{
 112    PMUState *s = opaque;
 113
 114    trace_pmu_one_sec_timer();
 115
 116    s->intbits |= PMU_INT_TICK;
 117    pmu_update_extirq(s);
 118    s->one_sec_target += 1000;
 119
 120    timer_mod(s->one_sec_timer, s->one_sec_target);
 121}
 122
 123static void pmu_cmd_int_ack(PMUState *s,
 124                            const uint8_t *in_data, uint8_t in_len,
 125                            uint8_t *out_data, uint8_t *out_len)
 126{
 127    if (in_len != 0) {
 128        qemu_log_mask(LOG_GUEST_ERROR,
 129                      "PMU: INT_ACK command, invalid len: %d want: 0\n",
 130                      in_len);
 131        return;
 132    }
 133
 134    /* Make appropriate reply packet */
 135    if (s->intbits & PMU_INT_ADB) {
 136        if (!s->adb_reply_size) {
 137            qemu_log_mask(LOG_GUEST_ERROR,
 138                          "Odd, PMU_INT_ADB set with no reply in buffer\n");
 139        }
 140
 141        memcpy(out_data + 1, s->adb_reply, s->adb_reply_size);
 142        out_data[0] = s->intbits & (PMU_INT_ADB | PMU_INT_ADB_AUTO);
 143        *out_len = s->adb_reply_size + 1;
 144        s->intbits &= ~(PMU_INT_ADB | PMU_INT_ADB_AUTO);
 145        s->adb_reply_size = 0;
 146    } else {
 147        out_data[0] = s->intbits;
 148        s->intbits = 0;
 149        *out_len = 1;
 150    }
 151
 152    pmu_update_extirq(s);
 153}
 154
 155static void pmu_cmd_set_int_mask(PMUState *s,
 156                                 const uint8_t *in_data, uint8_t in_len,
 157                                 uint8_t *out_data, uint8_t *out_len)
 158{
 159    if (in_len != 1) {
 160        qemu_log_mask(LOG_GUEST_ERROR,
 161                      "PMU: SET_INT_MASK command, invalid len: %d want: 1\n",
 162                      in_len);
 163        return;
 164    }
 165
 166    trace_pmu_cmd_set_int_mask(s->intmask);
 167    s->intmask = in_data[0];
 168
 169    pmu_update_extirq(s);
 170}
 171
 172static void pmu_cmd_set_adb_autopoll(PMUState *s, uint16_t mask)
 173{
 174    trace_pmu_cmd_set_adb_autopoll(mask);
 175
 176    if (s->autopoll_mask == mask) {
 177        return;
 178    }
 179
 180    s->autopoll_mask = mask;
 181    if (mask) {
 182        timer_mod(s->adb_poll_timer,
 183                  qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 30);
 184    } else {
 185        timer_del(s->adb_poll_timer);
 186    }
 187}
 188
 189static void pmu_cmd_adb(PMUState *s,
 190                        const uint8_t *in_data, uint8_t in_len,
 191                        uint8_t *out_data, uint8_t *out_len)
 192{
 193    int len, adblen;
 194    uint8_t adb_cmd[255];
 195
 196    if (in_len < 2) {
 197        qemu_log_mask(LOG_GUEST_ERROR,
 198                      "PMU: ADB PACKET, invalid len: %d want at least 2\n",
 199                      in_len);
 200        return;
 201    }
 202
 203    *out_len = 0;
 204
 205    if (!s->has_adb) {
 206        trace_pmu_cmd_adb_nobus();
 207        return;
 208    }
 209
 210    /* Set autopoll is a special form of the command */
 211    if (in_data[0] == 0 && in_data[1] == 0x86) {
 212        uint16_t mask = in_data[2];
 213        mask = (mask << 8) | in_data[3];
 214        if (in_len != 4) {
 215            qemu_log_mask(LOG_GUEST_ERROR,
 216                          "PMU: ADB Autopoll requires 4 bytes, got %d\n",
 217                          in_len);
 218            return;
 219        }
 220
 221        pmu_cmd_set_adb_autopoll(s, mask);
 222        return;
 223    }
 224
 225    trace_pmu_cmd_adb_request(in_len, in_data[0], in_data[1], in_data[2],
 226                              in_data[3], in_data[4]);
 227
 228    *out_len = 0;
 229
 230    /* Check ADB len */
 231    adblen = in_data[2];
 232    if (adblen > (in_len - 3)) {
 233        qemu_log_mask(LOG_GUEST_ERROR,
 234                      "PMU: ADB len is %d > %d (in_len -3)...erroring\n",
 235                      adblen, in_len - 3);
 236        len = -1;
 237    } else if (adblen > 252) {
 238        qemu_log_mask(LOG_GUEST_ERROR, "PMU: ADB command too big!\n");
 239        len = -1;
 240    } else {
 241        /* Format command */
 242        adb_cmd[0] = in_data[0];
 243        memcpy(&adb_cmd[1], &in_data[3], in_len - 3);
 244        len = adb_request(&s->adb_bus, s->adb_reply + 2, adb_cmd, in_len - 2);
 245
 246        trace_pmu_cmd_adb_reply(len);
 247    }
 248
 249    if (len > 0) {
 250        /* XXX Check this */
 251        s->adb_reply_size = len + 2;
 252        s->adb_reply[0] = 0x01;
 253        s->adb_reply[1] = len;
 254    } else {
 255        /* XXX Check this */
 256        s->adb_reply_size = 1;
 257        s->adb_reply[0] = 0x00;
 258    }
 259
 260    s->intbits |= PMU_INT_ADB;
 261    pmu_update_extirq(s);
 262}
 263
 264static void pmu_cmd_adb_poll_off(PMUState *s,
 265                                 const uint8_t *in_data, uint8_t in_len,
 266                                 uint8_t *out_data, uint8_t *out_len)
 267{
 268    if (in_len != 0) {
 269        qemu_log_mask(LOG_GUEST_ERROR,
 270                      "PMU: ADB POLL OFF command, invalid len: %d want: 0\n",
 271                      in_len);
 272        return;
 273    }
 274
 275    if (s->has_adb && s->autopoll_mask) {
 276        timer_del(s->adb_poll_timer);
 277        s->autopoll_mask = false;
 278    }
 279}
 280
 281static void pmu_cmd_shutdown(PMUState *s,
 282                             const uint8_t *in_data, uint8_t in_len,
 283                             uint8_t *out_data, uint8_t *out_len)
 284{
 285    if (in_len != 4) {
 286        qemu_log_mask(LOG_GUEST_ERROR,
 287                      "PMU: SHUTDOWN command, invalid len: %d want: 4\n",
 288                      in_len);
 289        return;
 290    }
 291
 292    *out_len = 1;
 293    out_data[0] = 0;
 294
 295    if (in_data[0] != 'M' || in_data[1] != 'A' || in_data[2] != 'T' ||
 296        in_data[3] != 'T') {
 297
 298        qemu_log_mask(LOG_GUEST_ERROR,
 299                      "PMU: SHUTDOWN command, Bad MATT signature\n");
 300        return;
 301    }
 302
 303    qemu_system_shutdown_request(SHUTDOWN_CAUSE_GUEST_SHUTDOWN);
 304}
 305
 306static void pmu_cmd_reset(PMUState *s,
 307                          const uint8_t *in_data, uint8_t in_len,
 308                          uint8_t *out_data, uint8_t *out_len)
 309{
 310    if (in_len != 0) {
 311        qemu_log_mask(LOG_GUEST_ERROR,
 312                      "PMU: RESET command, invalid len: %d want: 0\n",
 313                      in_len);
 314        return;
 315    }
 316
 317    qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
 318}
 319
 320static void pmu_cmd_get_rtc(PMUState *s,
 321                            const uint8_t *in_data, uint8_t in_len,
 322                            uint8_t *out_data, uint8_t *out_len)
 323{
 324    uint32_t ti;
 325
 326    if (in_len != 0) {
 327        qemu_log_mask(LOG_GUEST_ERROR,
 328                      "PMU: GET_RTC command, invalid len: %d want: 0\n",
 329                      in_len);
 330        return;
 331    }
 332
 333    ti = s->tick_offset + (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
 334                           / NANOSECONDS_PER_SECOND);
 335    out_data[0] = ti >> 24;
 336    out_data[1] = ti >> 16;
 337    out_data[2] = ti >> 8;
 338    out_data[3] = ti;
 339    *out_len = 4;
 340}
 341
 342static void pmu_cmd_set_rtc(PMUState *s,
 343                            const uint8_t *in_data, uint8_t in_len,
 344                            uint8_t *out_data, uint8_t *out_len)
 345{
 346    uint32_t ti;
 347
 348    if (in_len != 4) {
 349        qemu_log_mask(LOG_GUEST_ERROR,
 350                      "PMU: SET_RTC command, invalid len: %d want: 4\n",
 351                      in_len);
 352        return;
 353    }
 354
 355    ti = (((uint32_t)in_data[0]) << 24) + (((uint32_t)in_data[1]) << 16)
 356         + (((uint32_t)in_data[2]) << 8) + in_data[3];
 357
 358    s->tick_offset = ti - (qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL)
 359                           / NANOSECONDS_PER_SECOND);
 360}
 361
 362static void pmu_cmd_system_ready(PMUState *s,
 363                                 const uint8_t *in_data, uint8_t in_len,
 364                                 uint8_t *out_data, uint8_t *out_len)
 365{
 366    /* Do nothing */
 367}
 368
 369static void pmu_cmd_get_version(PMUState *s,
 370                                const uint8_t *in_data, uint8_t in_len,
 371                                uint8_t *out_data, uint8_t *out_len)
 372{
 373    *out_len = 1;
 374    *out_data = 1; /* ??? Check what Apple does */
 375}
 376
 377static void pmu_cmd_power_events(PMUState *s,
 378                                 const uint8_t *in_data, uint8_t in_len,
 379                                 uint8_t *out_data, uint8_t *out_len)
 380{
 381    if (in_len < 1) {
 382        qemu_log_mask(LOG_GUEST_ERROR,
 383                      "PMU: POWER EVENTS command, invalid len %d, want at least 1\n",
 384                      in_len);
 385        return;
 386    }
 387
 388    switch (in_data[0]) {
 389    /* Dummies for now */
 390    case PMU_PWR_GET_POWERUP_EVENTS:
 391        *out_len = 2;
 392        out_data[0] = 0;
 393        out_data[1] = 0;
 394        break;
 395    case PMU_PWR_SET_POWERUP_EVENTS:
 396    case PMU_PWR_CLR_POWERUP_EVENTS:
 397        break;
 398    case PMU_PWR_GET_WAKEUP_EVENTS:
 399        *out_len = 2;
 400        out_data[0] = 0;
 401        out_data[1] = 0;
 402        break;
 403    case PMU_PWR_SET_WAKEUP_EVENTS:
 404    case PMU_PWR_CLR_WAKEUP_EVENTS:
 405        break;
 406    default:
 407        qemu_log_mask(LOG_GUEST_ERROR,
 408                      "PMU: POWER EVENTS unknown subcommand 0x%02x\n",
 409                      in_data[0]);
 410    }
 411}
 412
 413static void pmu_cmd_get_cover(PMUState *s,
 414                              const uint8_t *in_data, uint8_t in_len,
 415                              uint8_t *out_data, uint8_t *out_len)
 416{
 417    /* Not 100% sure here, will have to check what a real Mac
 418     * returns other than byte 0 bit 0 is LID closed on laptops
 419     */
 420    *out_len = 1;
 421    *out_data = 0x00;
 422}
 423
 424static void pmu_cmd_download_status(PMUState *s,
 425                                    const uint8_t *in_data, uint8_t in_len,
 426                                    uint8_t *out_data, uint8_t *out_len)
 427{
 428    /* This has to do with PMU firmware updates as far as I can tell.
 429     *
 430     * We return 0x62 which is what OpenPMU expects
 431     */
 432    *out_len = 1;
 433    *out_data = 0x62;
 434}
 435
 436static void pmu_cmd_read_pmu_ram(PMUState *s,
 437                                 const uint8_t *in_data, uint8_t in_len,
 438                                 uint8_t *out_data, uint8_t *out_len)
 439{
 440    if (in_len < 3) {
 441        qemu_log_mask(LOG_GUEST_ERROR,
 442                      "PMU: READ_PMU_RAM command, invalid len %d, expected 3\n",
 443                      in_len);
 444        return;
 445    }
 446
 447    qemu_log_mask(LOG_GUEST_ERROR,
 448                  "PMU: Unsupported READ_PMU_RAM, args: %02x %02x %02x\n",
 449                  in_data[0], in_data[1], in_data[2]);
 450
 451    *out_len = 0;
 452}
 453
 454/* description of commands */
 455typedef struct PMUCmdHandler {
 456    uint8_t command;
 457    const char *name;
 458    void (*handler)(PMUState *s,
 459                    const uint8_t *in_args, uint8_t in_len,
 460                    uint8_t *out_args, uint8_t *out_len);
 461} PMUCmdHandler;
 462
 463static const PMUCmdHandler PMUCmdHandlers[] = {
 464    { PMU_INT_ACK, "INT ACK", pmu_cmd_int_ack },
 465    { PMU_SET_INTR_MASK, "SET INT MASK", pmu_cmd_set_int_mask },
 466    { PMU_ADB_CMD, "ADB COMMAND", pmu_cmd_adb },
 467    { PMU_ADB_POLL_OFF, "ADB POLL OFF", pmu_cmd_adb_poll_off },
 468    { PMU_RESET, "REBOOT", pmu_cmd_reset },
 469    { PMU_SHUTDOWN, "SHUTDOWN", pmu_cmd_shutdown },
 470    { PMU_READ_RTC, "GET RTC", pmu_cmd_get_rtc },
 471    { PMU_SET_RTC, "SET RTC", pmu_cmd_set_rtc },
 472    { PMU_SYSTEM_READY, "SYSTEM READY", pmu_cmd_system_ready },
 473    { PMU_GET_VERSION, "GET VERSION", pmu_cmd_get_version },
 474    { PMU_POWER_EVENTS, "POWER EVENTS", pmu_cmd_power_events },
 475    { PMU_GET_COVER, "GET_COVER", pmu_cmd_get_cover },
 476    { PMU_DOWNLOAD_STATUS, "DOWNLOAD STATUS", pmu_cmd_download_status },
 477    { PMU_READ_PMU_RAM, "READ PMGR RAM", pmu_cmd_read_pmu_ram },
 478};
 479
 480static void pmu_dispatch_cmd(PMUState *s)
 481{
 482    unsigned int i;
 483
 484    /* No response by default */
 485    s->cmd_rsp_sz = 0;
 486
 487    for (i = 0; i < ARRAY_SIZE(PMUCmdHandlers); i++) {
 488        const PMUCmdHandler *desc = &PMUCmdHandlers[i];
 489
 490        if (desc->command != s->cmd) {
 491            continue;
 492        }
 493
 494        trace_pmu_dispatch_cmd(desc->name);
 495        desc->handler(s, s->cmd_buf, s->cmd_buf_pos,
 496                      s->cmd_rsp, &s->cmd_rsp_sz);
 497
 498        if (s->rsplen != -1 && s->rsplen != s->cmd_rsp_sz) {
 499            trace_pmu_debug_protocol_string("QEMU internal cmd resp mismatch!");
 500        } else {
 501            trace_pmu_debug_protocol_resp_size(s->cmd_rsp_sz);
 502        }
 503
 504        return;
 505    }
 506
 507    trace_pmu_dispatch_unknown_cmd(s->cmd);
 508
 509    /* Manufacture fake response with 0's */
 510    if (s->rsplen == -1) {
 511        s->cmd_rsp_sz = 0;
 512    } else {
 513        s->cmd_rsp_sz = s->rsplen;
 514        memset(s->cmd_rsp, 0, s->rsplen);
 515    }
 516}
 517
 518static void pmu_update(PMUState *s)
 519{
 520    MOS6522PMUState *mps = &s->mos6522_pmu;
 521    MOS6522State *ms = MOS6522(mps);
 522
 523    /* Only react to changes in reg B */
 524    if (ms->b == s->last_b) {
 525        return;
 526    }
 527    s->last_b = ms->b;
 528
 529    /* Check the TREQ / TACK state */
 530    switch (ms->b & (TREQ | TACK)) {
 531    case TREQ:
 532        /* This is an ack release, handle it and bail out */
 533        ms->b |= TACK;
 534        s->last_b = ms->b;
 535
 536        trace_pmu_debug_protocol_string("handshake: TREQ high, setting TACK");
 537        return;
 538    case TACK:
 539        /* This is a valid request, handle below */
 540        break;
 541    case TREQ | TACK:
 542        /* This is an idle state */
 543        return;
 544    default:
 545        /* Invalid state, log and ignore */
 546        trace_pmu_debug_protocol_error(ms->b);
 547        return;
 548    }
 549
 550    /* If we wanted to handle commands asynchronously, this is where
 551     * we would delay the clearing of TACK until we are ready to send
 552     * the response
 553     */
 554
 555    /* We have a request, handshake TACK so we don't stay in
 556     * an invalid state. If we were concurrent with the OS we
 557     * should only do this after we grabbed the SR but that isn't
 558     * a problem here.
 559     */
 560
 561    trace_pmu_debug_protocol_clear_treq(s->cmd_state);
 562
 563    ms->b &= ~TACK;
 564    s->last_b = ms->b;
 565
 566    /* Act according to state */
 567    switch (s->cmd_state) {
 568    case pmu_state_idle:
 569        if (!(ms->acr & SR_OUT)) {
 570            trace_pmu_debug_protocol_string("protocol error! "
 571                                            "state idle, ACR reading");
 572            break;
 573        }
 574
 575        s->cmd = ms->sr;
 576        via_set_sr_int(s);
 577        s->cmdlen = pmu_data_len[s->cmd][0];
 578        s->rsplen = pmu_data_len[s->cmd][1];
 579        s->cmd_buf_pos = 0;
 580        s->cmd_rsp_pos = 0;
 581        s->cmd_state = pmu_state_cmd;
 582
 583        trace_pmu_debug_protocol_cmd(s->cmd, s->cmdlen, s->rsplen);
 584        break;
 585
 586    case pmu_state_cmd:
 587        if (!(ms->acr & SR_OUT)) {
 588            trace_pmu_debug_protocol_string("protocol error! "
 589                                            "state cmd, ACR reading");
 590            break;
 591        }
 592
 593        if (s->cmdlen == -1) {
 594            trace_pmu_debug_protocol_cmdlen(ms->sr);
 595
 596            s->cmdlen = ms->sr;
 597            if (s->cmdlen > sizeof(s->cmd_buf)) {
 598                trace_pmu_debug_protocol_cmd_toobig(s->cmdlen);
 599            }
 600        } else if (s->cmd_buf_pos < sizeof(s->cmd_buf)) {
 601            s->cmd_buf[s->cmd_buf_pos++] = ms->sr;
 602        }
 603
 604        via_set_sr_int(s);
 605        break;
 606
 607    case pmu_state_rsp:
 608        if (ms->acr & SR_OUT) {
 609            trace_pmu_debug_protocol_string("protocol error! "
 610                                            "state resp, ACR writing");
 611            break;
 612        }
 613
 614        if (s->rsplen == -1) {
 615            trace_pmu_debug_protocol_cmd_send_resp_size(s->cmd_rsp_sz);
 616
 617            ms->sr = s->cmd_rsp_sz;
 618            s->rsplen = s->cmd_rsp_sz;
 619        } else if (s->cmd_rsp_pos < s->cmd_rsp_sz) {
 620            trace_pmu_debug_protocol_cmd_send_resp(s->cmd_rsp_pos, s->rsplen);
 621
 622            ms->sr = s->cmd_rsp[s->cmd_rsp_pos++];
 623        }
 624
 625        via_set_sr_int(s);
 626        break;
 627    }
 628
 629    /* Check for state completion */
 630    if (s->cmd_state == pmu_state_cmd && s->cmdlen == s->cmd_buf_pos) {
 631        trace_pmu_debug_protocol_string("Command reception complete, "
 632                                        "dispatching...");
 633
 634        pmu_dispatch_cmd(s);
 635        s->cmd_state = pmu_state_rsp;
 636    }
 637
 638    if (s->cmd_state == pmu_state_rsp && s->rsplen == s->cmd_rsp_pos) {
 639        trace_pmu_debug_protocol_cmd_resp_complete(ms->ier);
 640
 641        s->cmd_state = pmu_state_idle;
 642    }
 643}
 644
 645static uint64_t mos6522_pmu_read(void *opaque, hwaddr addr, unsigned size)
 646{
 647    PMUState *s = opaque;
 648    MOS6522PMUState *mps = &s->mos6522_pmu;
 649    MOS6522State *ms = MOS6522(mps);
 650
 651    addr = (addr >> 9) & 0xf;
 652    return mos6522_read(ms, addr, size);
 653}
 654
 655static void mos6522_pmu_write(void *opaque, hwaddr addr, uint64_t val,
 656                              unsigned size)
 657{
 658    PMUState *s = opaque;
 659    MOS6522PMUState *mps = &s->mos6522_pmu;
 660    MOS6522State *ms = MOS6522(mps);
 661
 662    addr = (addr >> 9) & 0xf;
 663    mos6522_write(ms, addr, val, size);
 664}
 665
 666static const MemoryRegionOps mos6522_pmu_ops = {
 667    .read = mos6522_pmu_read,
 668    .write = mos6522_pmu_write,
 669    .endianness = DEVICE_BIG_ENDIAN,
 670    .impl = {
 671        .min_access_size = 1,
 672        .max_access_size = 1,
 673    },
 674};
 675
 676static bool pmu_adb_state_needed(void *opaque)
 677{
 678    PMUState *s = opaque;
 679
 680    return s->has_adb;
 681}
 682
 683static const VMStateDescription vmstate_pmu_adb = {
 684    .name = "pmu/adb",
 685    .version_id = 0,
 686    .minimum_version_id = 0,
 687    .needed = pmu_adb_state_needed,
 688    .fields = (VMStateField[]) {
 689        VMSTATE_UINT16(adb_poll_mask, PMUState),
 690        VMSTATE_TIMER_PTR(adb_poll_timer, PMUState),
 691        VMSTATE_UINT8(adb_reply_size, PMUState),
 692        VMSTATE_BUFFER(adb_reply, PMUState),
 693        VMSTATE_END_OF_LIST()
 694    }
 695};
 696
 697static const VMStateDescription vmstate_pmu = {
 698    .name = "pmu",
 699    .version_id = 0,
 700    .minimum_version_id = 0,
 701    .fields = (VMStateField[]) {
 702        VMSTATE_STRUCT(mos6522_pmu.parent_obj, PMUState, 0, vmstate_mos6522,
 703                       MOS6522State),
 704        VMSTATE_UINT8(last_b, PMUState),
 705        VMSTATE_UINT8(cmd, PMUState),
 706        VMSTATE_UINT32(cmdlen, PMUState),
 707        VMSTATE_UINT32(rsplen, PMUState),
 708        VMSTATE_UINT8(cmd_buf_pos, PMUState),
 709        VMSTATE_BUFFER(cmd_buf, PMUState),
 710        VMSTATE_UINT8(cmd_rsp_pos, PMUState),
 711        VMSTATE_UINT8(cmd_rsp_sz, PMUState),
 712        VMSTATE_BUFFER(cmd_rsp, PMUState),
 713        VMSTATE_UINT8(intbits, PMUState),
 714        VMSTATE_UINT8(intmask, PMUState),
 715        VMSTATE_UINT8(autopoll_rate_ms, PMUState),
 716        VMSTATE_UINT8(autopoll_mask, PMUState),
 717        VMSTATE_UINT32(tick_offset, PMUState),
 718        VMSTATE_TIMER_PTR(one_sec_timer, PMUState),
 719        VMSTATE_INT64(one_sec_target, PMUState),
 720        VMSTATE_END_OF_LIST()
 721    },
 722    .subsections = (const VMStateDescription * []) {
 723        &vmstate_pmu_adb,
 724    }
 725};
 726
 727static void pmu_reset(DeviceState *dev)
 728{
 729    PMUState *s = VIA_PMU(dev);
 730
 731    /* OpenBIOS needs to do this? MacOS 9 needs it */
 732    s->intmask = PMU_INT_ADB | PMU_INT_TICK;
 733    s->intbits = 0;
 734
 735    s->cmd_state = pmu_state_idle;
 736    s->autopoll_mask = 0;
 737}
 738
 739static void pmu_realize(DeviceState *dev, Error **errp)
 740{
 741    PMUState *s = VIA_PMU(dev);
 742    SysBusDevice *sbd;
 743    MOS6522State *ms;
 744    DeviceState *d;
 745    struct tm tm;
 746
 747    /* Pass IRQ from 6522 */
 748    d = DEVICE(&s->mos6522_pmu);
 749    ms = MOS6522(d);
 750    sbd = SYS_BUS_DEVICE(s);
 751    sysbus_pass_irq(sbd, SYS_BUS_DEVICE(ms));
 752
 753    qemu_get_timedate(&tm, 0);
 754    s->tick_offset = (uint32_t)mktimegm(&tm) + RTC_OFFSET;
 755    s->one_sec_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL, pmu_one_sec_timer, s);
 756    s->one_sec_target = qemu_clock_get_ms(QEMU_CLOCK_VIRTUAL) + 1000;
 757    timer_mod(s->one_sec_timer, s->one_sec_target);
 758
 759    if (s->has_adb) {
 760        qbus_create_inplace(&s->adb_bus, sizeof(s->adb_bus), TYPE_ADB_BUS,
 761                            DEVICE(dev), "adb.0");
 762        s->adb_poll_timer = timer_new_ms(QEMU_CLOCK_VIRTUAL, pmu_adb_poll, s);
 763        s->adb_poll_mask = 0xffff;
 764        s->autopoll_rate_ms = 20;
 765    }
 766}
 767
 768static void pmu_init(Object *obj)
 769{
 770    SysBusDevice *d = SYS_BUS_DEVICE(obj);
 771    PMUState *s = VIA_PMU(obj);
 772
 773    object_property_add_link(obj, "gpio", TYPE_MACIO_GPIO,
 774                             (Object **) &s->gpio,
 775                             qdev_prop_allow_set_link_before_realize,
 776                             0, NULL);
 777
 778    sysbus_init_child_obj(obj, "mos6522-pmu", &s->mos6522_pmu,
 779                          sizeof(s->mos6522_pmu), TYPE_MOS6522_PMU);
 780
 781    memory_region_init_io(&s->mem, obj, &mos6522_pmu_ops, s, "via-pmu",
 782                          0x2000);
 783    sysbus_init_mmio(d, &s->mem);
 784}
 785
 786static Property pmu_properties[] = {
 787    DEFINE_PROP_BOOL("has-adb", PMUState, has_adb, true),
 788    DEFINE_PROP_END_OF_LIST()
 789};
 790
 791static void pmu_class_init(ObjectClass *oc, void *data)
 792{
 793    DeviceClass *dc = DEVICE_CLASS(oc);
 794
 795    dc->realize = pmu_realize;
 796    dc->reset = pmu_reset;
 797    dc->vmsd = &vmstate_pmu;
 798    dc->props = pmu_properties;
 799    set_bit(DEVICE_CATEGORY_BRIDGE, dc->categories);
 800}
 801
 802static const TypeInfo pmu_type_info = {
 803    .name = TYPE_VIA_PMU,
 804    .parent = TYPE_SYS_BUS_DEVICE,
 805    .instance_size = sizeof(PMUState),
 806    .instance_init = pmu_init,
 807    .class_init = pmu_class_init,
 808};
 809
 810static void mos6522_pmu_portB_write(MOS6522State *s)
 811{
 812    MOS6522PMUState *mps = container_of(s, MOS6522PMUState, parent_obj);
 813    PMUState *ps = container_of(mps, PMUState, mos6522_pmu);
 814
 815    if ((s->pcr & 0xe0) == 0x20 || (s->pcr & 0xe0) == 0x60) {
 816        s->ifr &= ~CB2_INT;
 817    }
 818    s->ifr &= ~CB1_INT;
 819
 820    via_update_irq(ps);
 821    pmu_update(ps);
 822}
 823
 824static void mos6522_pmu_portA_write(MOS6522State *s)
 825{
 826    MOS6522PMUState *mps = container_of(s, MOS6522PMUState, parent_obj);
 827    PMUState *ps = container_of(mps, PMUState, mos6522_pmu);
 828
 829    if ((s->pcr & 0x0e) == 0x02 || (s->pcr & 0x0e) == 0x06) {
 830        s->ifr &= ~CA2_INT;
 831    }
 832    s->ifr &= ~CA1_INT;
 833
 834    via_update_irq(ps);
 835}
 836
 837static void mos6522_pmu_reset(DeviceState *dev)
 838{
 839    MOS6522State *ms = MOS6522(dev);
 840    MOS6522PMUState *mps = container_of(ms, MOS6522PMUState, parent_obj);
 841    PMUState *s = container_of(mps, PMUState, mos6522_pmu);
 842    MOS6522DeviceClass *mdc = MOS6522_DEVICE_GET_CLASS(ms);
 843
 844    mdc->parent_reset(dev);
 845
 846    ms->timers[0].frequency = VIA_TIMER_FREQ;
 847    ms->timers[1].frequency = (SCALE_US * 6000) / 4700;
 848
 849    s->last_b = ms->b = TACK | TREQ;
 850}
 851
 852static void mos6522_pmu_class_init(ObjectClass *oc, void *data)
 853{
 854    DeviceClass *dc = DEVICE_CLASS(oc);
 855    MOS6522DeviceClass *mdc = MOS6522_DEVICE_CLASS(oc);
 856
 857    dc->reset = mos6522_pmu_reset;
 858    mdc->portB_write = mos6522_pmu_portB_write;
 859    mdc->portA_write = mos6522_pmu_portA_write;
 860}
 861
 862static const TypeInfo mos6522_pmu_type_info = {
 863    .name = TYPE_MOS6522_PMU,
 864    .parent = TYPE_MOS6522,
 865    .instance_size = sizeof(MOS6522PMUState),
 866    .class_init = mos6522_pmu_class_init,
 867};
 868
 869static void pmu_register_types(void)
 870{
 871    type_register_static(&pmu_type_info);
 872    type_register_static(&mos6522_pmu_type_info);
 873}
 874
 875type_init(pmu_register_types)
 876