qemu/hw/arm/strongarm.c
<<
>>
Prefs
   1/*
   2 * StrongARM SA-1100/SA-1110 emulation
   3 *
   4 * Copyright (C) 2011 Dmitry Eremin-Solenikov
   5 *
   6 * Largely based on StrongARM emulation:
   7 * Copyright (c) 2006 Openedhand Ltd.
   8 * Written by Andrzej Zaborowski <balrog@zabor.org>
   9 *
  10 * UART code based on QEMU 16550A UART emulation
  11 * Copyright (c) 2003-2004 Fabrice Bellard
  12 * Copyright (c) 2008 Citrix Systems, Inc.
  13 *
  14 *  This program is free software; you can redistribute it and/or modify
  15 *  it under the terms of the GNU General Public License version 2 as
  16 *  published by the Free Software Foundation.
  17 *
  18 *  This program is distributed in the hope that it will be useful,
  19 *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  20 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  21 *  GNU General Public License for more details.
  22 *
  23 *  You should have received a copy of the GNU General Public License along
  24 *  with this program; if not, see <http://www.gnu.org/licenses/>.
  25 *
  26 *  Contributions after 2012-01-13 are licensed under the terms of the
  27 *  GNU GPL, version 2 or (at your option) any later version.
  28 */
  29
  30#include "qemu/osdep.h"
  31#include "qemu-common.h"
  32#include "cpu.h"
  33#include "hw/boards.h"
  34#include "hw/irq.h"
  35#include "hw/qdev-properties.h"
  36#include "hw/sysbus.h"
  37#include "migration/vmstate.h"
  38#include "strongarm.h"
  39#include "qemu/error-report.h"
  40#include "hw/arm/boot.h"
  41#include "chardev/char-fe.h"
  42#include "chardev/char-serial.h"
  43#include "sysemu/sysemu.h"
  44#include "hw/ssi/ssi.h"
  45#include "qemu/cutils.h"
  46#include "qemu/log.h"
  47
  48//#define DEBUG
  49
  50/*
  51 TODO
  52 - Implement cp15, c14 ?
  53 - Implement cp15, c15 !!! (idle used in L)
  54 - Implement idle mode handling/DIM
  55 - Implement sleep mode/Wake sources
  56 - Implement reset control
  57 - Implement memory control regs
  58 - PCMCIA handling
  59 - Maybe support MBGNT/MBREQ
  60 - DMA channels
  61 - GPCLK
  62 - IrDA
  63 - MCP
  64 - Enhance UART with modem signals
  65 */
  66
  67#ifdef DEBUG
  68# define DPRINTF(format, ...) printf(format , ## __VA_ARGS__)
  69#else
  70# define DPRINTF(format, ...) do { } while (0)
  71#endif
  72
  73static struct {
  74    hwaddr io_base;
  75    int irq;
  76} sa_serial[] = {
  77    { 0x80010000, SA_PIC_UART1 },
  78    { 0x80030000, SA_PIC_UART2 },
  79    { 0x80050000, SA_PIC_UART3 },
  80    { 0, 0 }
  81};
  82
  83/* Interrupt Controller */
  84
  85#define TYPE_STRONGARM_PIC "strongarm_pic"
  86#define STRONGARM_PIC(obj) \
  87    OBJECT_CHECK(StrongARMPICState, (obj), TYPE_STRONGARM_PIC)
  88
  89typedef struct StrongARMPICState {
  90    SysBusDevice parent_obj;
  91
  92    MemoryRegion iomem;
  93    qemu_irq    irq;
  94    qemu_irq    fiq;
  95
  96    uint32_t pending;
  97    uint32_t enabled;
  98    uint32_t is_fiq;
  99    uint32_t int_idle;
 100} StrongARMPICState;
 101
 102#define ICIP    0x00
 103#define ICMR    0x04
 104#define ICLR    0x08
 105#define ICFP    0x10
 106#define ICPR    0x20
 107#define ICCR    0x0c
 108
 109#define SA_PIC_SRCS     32
 110
 111
 112static void strongarm_pic_update(void *opaque)
 113{
 114    StrongARMPICState *s = opaque;
 115
 116    /* FIXME: reflect DIM */
 117    qemu_set_irq(s->fiq, s->pending & s->enabled &  s->is_fiq);
 118    qemu_set_irq(s->irq, s->pending & s->enabled & ~s->is_fiq);
 119}
 120
 121static void strongarm_pic_set_irq(void *opaque, int irq, int level)
 122{
 123    StrongARMPICState *s = opaque;
 124
 125    if (level) {
 126        s->pending |= 1 << irq;
 127    } else {
 128        s->pending &= ~(1 << irq);
 129    }
 130
 131    strongarm_pic_update(s);
 132}
 133
 134static uint64_t strongarm_pic_mem_read(void *opaque, hwaddr offset,
 135                                       unsigned size)
 136{
 137    StrongARMPICState *s = opaque;
 138
 139    switch (offset) {
 140    case ICIP:
 141        return s->pending & ~s->is_fiq & s->enabled;
 142    case ICMR:
 143        return s->enabled;
 144    case ICLR:
 145        return s->is_fiq;
 146    case ICCR:
 147        return s->int_idle == 0;
 148    case ICFP:
 149        return s->pending & s->is_fiq & s->enabled;
 150    case ICPR:
 151        return s->pending;
 152    default:
 153        printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
 154                        __func__, offset);
 155        return 0;
 156    }
 157}
 158
 159static void strongarm_pic_mem_write(void *opaque, hwaddr offset,
 160                                    uint64_t value, unsigned size)
 161{
 162    StrongARMPICState *s = opaque;
 163
 164    switch (offset) {
 165    case ICMR:
 166        s->enabled = value;
 167        break;
 168    case ICLR:
 169        s->is_fiq = value;
 170        break;
 171    case ICCR:
 172        s->int_idle = (value & 1) ? 0 : ~0;
 173        break;
 174    default:
 175        printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
 176                        __func__, offset);
 177        break;
 178    }
 179    strongarm_pic_update(s);
 180}
 181
 182static const MemoryRegionOps strongarm_pic_ops = {
 183    .read = strongarm_pic_mem_read,
 184    .write = strongarm_pic_mem_write,
 185    .endianness = DEVICE_NATIVE_ENDIAN,
 186};
 187
 188static void strongarm_pic_initfn(Object *obj)
 189{
 190    DeviceState *dev = DEVICE(obj);
 191    StrongARMPICState *s = STRONGARM_PIC(obj);
 192    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
 193
 194    qdev_init_gpio_in(dev, strongarm_pic_set_irq, SA_PIC_SRCS);
 195    memory_region_init_io(&s->iomem, obj, &strongarm_pic_ops, s,
 196                          "pic", 0x1000);
 197    sysbus_init_mmio(sbd, &s->iomem);
 198    sysbus_init_irq(sbd, &s->irq);
 199    sysbus_init_irq(sbd, &s->fiq);
 200}
 201
 202static int strongarm_pic_post_load(void *opaque, int version_id)
 203{
 204    strongarm_pic_update(opaque);
 205    return 0;
 206}
 207
 208static VMStateDescription vmstate_strongarm_pic_regs = {
 209    .name = "strongarm_pic",
 210    .version_id = 0,
 211    .minimum_version_id = 0,
 212    .post_load = strongarm_pic_post_load,
 213    .fields = (VMStateField[]) {
 214        VMSTATE_UINT32(pending, StrongARMPICState),
 215        VMSTATE_UINT32(enabled, StrongARMPICState),
 216        VMSTATE_UINT32(is_fiq, StrongARMPICState),
 217        VMSTATE_UINT32(int_idle, StrongARMPICState),
 218        VMSTATE_END_OF_LIST(),
 219    },
 220};
 221
 222static void strongarm_pic_class_init(ObjectClass *klass, void *data)
 223{
 224    DeviceClass *dc = DEVICE_CLASS(klass);
 225
 226    dc->desc = "StrongARM PIC";
 227    dc->vmsd = &vmstate_strongarm_pic_regs;
 228}
 229
 230static const TypeInfo strongarm_pic_info = {
 231    .name          = TYPE_STRONGARM_PIC,
 232    .parent        = TYPE_SYS_BUS_DEVICE,
 233    .instance_size = sizeof(StrongARMPICState),
 234    .instance_init = strongarm_pic_initfn,
 235    .class_init    = strongarm_pic_class_init,
 236};
 237
 238/* Real-Time Clock */
 239#define RTAR 0x00 /* RTC Alarm register */
 240#define RCNR 0x04 /* RTC Counter register */
 241#define RTTR 0x08 /* RTC Timer Trim register */
 242#define RTSR 0x10 /* RTC Status register */
 243
 244#define RTSR_AL (1 << 0) /* RTC Alarm detected */
 245#define RTSR_HZ (1 << 1) /* RTC 1Hz detected */
 246#define RTSR_ALE (1 << 2) /* RTC Alarm enable */
 247#define RTSR_HZE (1 << 3) /* RTC 1Hz enable */
 248
 249/* 16 LSB of RTTR are clockdiv for internal trim logic,
 250 * trim delete isn't emulated, so
 251 * f = 32 768 / (RTTR_trim + 1) */
 252
 253#define TYPE_STRONGARM_RTC "strongarm-rtc"
 254#define STRONGARM_RTC(obj) \
 255    OBJECT_CHECK(StrongARMRTCState, (obj), TYPE_STRONGARM_RTC)
 256
 257typedef struct StrongARMRTCState {
 258    SysBusDevice parent_obj;
 259
 260    MemoryRegion iomem;
 261    uint32_t rttr;
 262    uint32_t rtsr;
 263    uint32_t rtar;
 264    uint32_t last_rcnr;
 265    int64_t last_hz;
 266    QEMUTimer *rtc_alarm;
 267    QEMUTimer *rtc_hz;
 268    qemu_irq rtc_irq;
 269    qemu_irq rtc_hz_irq;
 270} StrongARMRTCState;
 271
 272static inline void strongarm_rtc_int_update(StrongARMRTCState *s)
 273{
 274    qemu_set_irq(s->rtc_irq, s->rtsr & RTSR_AL);
 275    qemu_set_irq(s->rtc_hz_irq, s->rtsr & RTSR_HZ);
 276}
 277
 278static void strongarm_rtc_hzupdate(StrongARMRTCState *s)
 279{
 280    int64_t rt = qemu_clock_get_ms(rtc_clock);
 281    s->last_rcnr += ((rt - s->last_hz) << 15) /
 282            (1000 * ((s->rttr & 0xffff) + 1));
 283    s->last_hz = rt;
 284}
 285
 286static inline void strongarm_rtc_timer_update(StrongARMRTCState *s)
 287{
 288    if ((s->rtsr & RTSR_HZE) && !(s->rtsr & RTSR_HZ)) {
 289        timer_mod(s->rtc_hz, s->last_hz + 1000);
 290    } else {
 291        timer_del(s->rtc_hz);
 292    }
 293
 294    if ((s->rtsr & RTSR_ALE) && !(s->rtsr & RTSR_AL)) {
 295        timer_mod(s->rtc_alarm, s->last_hz +
 296                (((s->rtar - s->last_rcnr) * 1000 *
 297                  ((s->rttr & 0xffff) + 1)) >> 15));
 298    } else {
 299        timer_del(s->rtc_alarm);
 300    }
 301}
 302
 303static inline void strongarm_rtc_alarm_tick(void *opaque)
 304{
 305    StrongARMRTCState *s = opaque;
 306    s->rtsr |= RTSR_AL;
 307    strongarm_rtc_timer_update(s);
 308    strongarm_rtc_int_update(s);
 309}
 310
 311static inline void strongarm_rtc_hz_tick(void *opaque)
 312{
 313    StrongARMRTCState *s = opaque;
 314    s->rtsr |= RTSR_HZ;
 315    strongarm_rtc_timer_update(s);
 316    strongarm_rtc_int_update(s);
 317}
 318
 319static uint64_t strongarm_rtc_read(void *opaque, hwaddr addr,
 320                                   unsigned size)
 321{
 322    StrongARMRTCState *s = opaque;
 323
 324    switch (addr) {
 325    case RTTR:
 326        return s->rttr;
 327    case RTSR:
 328        return s->rtsr;
 329    case RTAR:
 330        return s->rtar;
 331    case RCNR:
 332        return s->last_rcnr +
 333                ((qemu_clock_get_ms(rtc_clock) - s->last_hz) << 15) /
 334                (1000 * ((s->rttr & 0xffff) + 1));
 335    default:
 336        printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
 337        return 0;
 338    }
 339}
 340
 341static void strongarm_rtc_write(void *opaque, hwaddr addr,
 342                                uint64_t value, unsigned size)
 343{
 344    StrongARMRTCState *s = opaque;
 345    uint32_t old_rtsr;
 346
 347    switch (addr) {
 348    case RTTR:
 349        strongarm_rtc_hzupdate(s);
 350        s->rttr = value;
 351        strongarm_rtc_timer_update(s);
 352        break;
 353
 354    case RTSR:
 355        old_rtsr = s->rtsr;
 356        s->rtsr = (value & (RTSR_ALE | RTSR_HZE)) |
 357                  (s->rtsr & ~(value & (RTSR_AL | RTSR_HZ)));
 358
 359        if (s->rtsr != old_rtsr) {
 360            strongarm_rtc_timer_update(s);
 361        }
 362
 363        strongarm_rtc_int_update(s);
 364        break;
 365
 366    case RTAR:
 367        s->rtar = value;
 368        strongarm_rtc_timer_update(s);
 369        break;
 370
 371    case RCNR:
 372        strongarm_rtc_hzupdate(s);
 373        s->last_rcnr = value;
 374        strongarm_rtc_timer_update(s);
 375        break;
 376
 377    default:
 378        printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
 379    }
 380}
 381
 382static const MemoryRegionOps strongarm_rtc_ops = {
 383    .read = strongarm_rtc_read,
 384    .write = strongarm_rtc_write,
 385    .endianness = DEVICE_NATIVE_ENDIAN,
 386};
 387
 388static void strongarm_rtc_init(Object *obj)
 389{
 390    StrongARMRTCState *s = STRONGARM_RTC(obj);
 391    SysBusDevice *dev = SYS_BUS_DEVICE(obj);
 392    struct tm tm;
 393
 394    s->rttr = 0x0;
 395    s->rtsr = 0;
 396
 397    qemu_get_timedate(&tm, 0);
 398
 399    s->last_rcnr = (uint32_t) mktimegm(&tm);
 400    s->last_hz = qemu_clock_get_ms(rtc_clock);
 401
 402    s->rtc_alarm = timer_new_ms(rtc_clock, strongarm_rtc_alarm_tick, s);
 403    s->rtc_hz = timer_new_ms(rtc_clock, strongarm_rtc_hz_tick, s);
 404
 405    sysbus_init_irq(dev, &s->rtc_irq);
 406    sysbus_init_irq(dev, &s->rtc_hz_irq);
 407
 408    memory_region_init_io(&s->iomem, obj, &strongarm_rtc_ops, s,
 409                          "rtc", 0x10000);
 410    sysbus_init_mmio(dev, &s->iomem);
 411}
 412
 413static int strongarm_rtc_pre_save(void *opaque)
 414{
 415    StrongARMRTCState *s = opaque;
 416
 417    strongarm_rtc_hzupdate(s);
 418
 419    return 0;
 420}
 421
 422static int strongarm_rtc_post_load(void *opaque, int version_id)
 423{
 424    StrongARMRTCState *s = opaque;
 425
 426    strongarm_rtc_timer_update(s);
 427    strongarm_rtc_int_update(s);
 428
 429    return 0;
 430}
 431
 432static const VMStateDescription vmstate_strongarm_rtc_regs = {
 433    .name = "strongarm-rtc",
 434    .version_id = 0,
 435    .minimum_version_id = 0,
 436    .pre_save = strongarm_rtc_pre_save,
 437    .post_load = strongarm_rtc_post_load,
 438    .fields = (VMStateField[]) {
 439        VMSTATE_UINT32(rttr, StrongARMRTCState),
 440        VMSTATE_UINT32(rtsr, StrongARMRTCState),
 441        VMSTATE_UINT32(rtar, StrongARMRTCState),
 442        VMSTATE_UINT32(last_rcnr, StrongARMRTCState),
 443        VMSTATE_INT64(last_hz, StrongARMRTCState),
 444        VMSTATE_END_OF_LIST(),
 445    },
 446};
 447
 448static void strongarm_rtc_sysbus_class_init(ObjectClass *klass, void *data)
 449{
 450    DeviceClass *dc = DEVICE_CLASS(klass);
 451
 452    dc->desc = "StrongARM RTC Controller";
 453    dc->vmsd = &vmstate_strongarm_rtc_regs;
 454}
 455
 456static const TypeInfo strongarm_rtc_sysbus_info = {
 457    .name          = TYPE_STRONGARM_RTC,
 458    .parent        = TYPE_SYS_BUS_DEVICE,
 459    .instance_size = sizeof(StrongARMRTCState),
 460    .instance_init = strongarm_rtc_init,
 461    .class_init    = strongarm_rtc_sysbus_class_init,
 462};
 463
 464/* GPIO */
 465#define GPLR 0x00
 466#define GPDR 0x04
 467#define GPSR 0x08
 468#define GPCR 0x0c
 469#define GRER 0x10
 470#define GFER 0x14
 471#define GEDR 0x18
 472#define GAFR 0x1c
 473
 474#define TYPE_STRONGARM_GPIO "strongarm-gpio"
 475#define STRONGARM_GPIO(obj) \
 476    OBJECT_CHECK(StrongARMGPIOInfo, (obj), TYPE_STRONGARM_GPIO)
 477
 478typedef struct StrongARMGPIOInfo StrongARMGPIOInfo;
 479struct StrongARMGPIOInfo {
 480    SysBusDevice busdev;
 481    MemoryRegion iomem;
 482    qemu_irq handler[28];
 483    qemu_irq irqs[11];
 484    qemu_irq irqX;
 485
 486    uint32_t ilevel;
 487    uint32_t olevel;
 488    uint32_t dir;
 489    uint32_t rising;
 490    uint32_t falling;
 491    uint32_t status;
 492    uint32_t gafr;
 493
 494    uint32_t prev_level;
 495};
 496
 497
 498static void strongarm_gpio_irq_update(StrongARMGPIOInfo *s)
 499{
 500    int i;
 501    for (i = 0; i < 11; i++) {
 502        qemu_set_irq(s->irqs[i], s->status & (1 << i));
 503    }
 504
 505    qemu_set_irq(s->irqX, (s->status & ~0x7ff));
 506}
 507
 508static void strongarm_gpio_set(void *opaque, int line, int level)
 509{
 510    StrongARMGPIOInfo *s = opaque;
 511    uint32_t mask;
 512
 513    mask = 1 << line;
 514
 515    if (level) {
 516        s->status |= s->rising & mask &
 517                ~s->ilevel & ~s->dir;
 518        s->ilevel |= mask;
 519    } else {
 520        s->status |= s->falling & mask &
 521                s->ilevel & ~s->dir;
 522        s->ilevel &= ~mask;
 523    }
 524
 525    if (s->status & mask) {
 526        strongarm_gpio_irq_update(s);
 527    }
 528}
 529
 530static void strongarm_gpio_handler_update(StrongARMGPIOInfo *s)
 531{
 532    uint32_t level, diff;
 533    int bit;
 534
 535    level = s->olevel & s->dir;
 536
 537    for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
 538        bit = ctz32(diff);
 539        qemu_set_irq(s->handler[bit], (level >> bit) & 1);
 540    }
 541
 542    s->prev_level = level;
 543}
 544
 545static uint64_t strongarm_gpio_read(void *opaque, hwaddr offset,
 546                                    unsigned size)
 547{
 548    StrongARMGPIOInfo *s = opaque;
 549
 550    switch (offset) {
 551    case GPDR:        /* GPIO Pin-Direction registers */
 552        return s->dir;
 553
 554    case GPSR:        /* GPIO Pin-Output Set registers */
 555        qemu_log_mask(LOG_GUEST_ERROR,
 556                      "strongarm GPIO: read from write only register GPSR\n");
 557        return 0;
 558
 559    case GPCR:        /* GPIO Pin-Output Clear registers */
 560        qemu_log_mask(LOG_GUEST_ERROR,
 561                      "strongarm GPIO: read from write only register GPCR\n");
 562        return 0;
 563
 564    case GRER:        /* GPIO Rising-Edge Detect Enable registers */
 565        return s->rising;
 566
 567    case GFER:        /* GPIO Falling-Edge Detect Enable registers */
 568        return s->falling;
 569
 570    case GAFR:        /* GPIO Alternate Function registers */
 571        return s->gafr;
 572
 573    case GPLR:        /* GPIO Pin-Level registers */
 574        return (s->olevel & s->dir) |
 575               (s->ilevel & ~s->dir);
 576
 577    case GEDR:        /* GPIO Edge Detect Status registers */
 578        return s->status;
 579
 580    default:
 581        printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
 582    }
 583
 584    return 0;
 585}
 586
 587static void strongarm_gpio_write(void *opaque, hwaddr offset,
 588                                 uint64_t value, unsigned size)
 589{
 590    StrongARMGPIOInfo *s = opaque;
 591
 592    switch (offset) {
 593    case GPDR:        /* GPIO Pin-Direction registers */
 594        s->dir = value & 0x0fffffff;
 595        strongarm_gpio_handler_update(s);
 596        break;
 597
 598    case GPSR:        /* GPIO Pin-Output Set registers */
 599        s->olevel |= value & 0x0fffffff;
 600        strongarm_gpio_handler_update(s);
 601        break;
 602
 603    case GPCR:        /* GPIO Pin-Output Clear registers */
 604        s->olevel &= ~value;
 605        strongarm_gpio_handler_update(s);
 606        break;
 607
 608    case GRER:        /* GPIO Rising-Edge Detect Enable registers */
 609        s->rising = value;
 610        break;
 611
 612    case GFER:        /* GPIO Falling-Edge Detect Enable registers */
 613        s->falling = value;
 614        break;
 615
 616    case GAFR:        /* GPIO Alternate Function registers */
 617        s->gafr = value;
 618        break;
 619
 620    case GEDR:        /* GPIO Edge Detect Status registers */
 621        s->status &= ~value;
 622        strongarm_gpio_irq_update(s);
 623        break;
 624
 625    default:
 626        printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
 627    }
 628}
 629
 630static const MemoryRegionOps strongarm_gpio_ops = {
 631    .read = strongarm_gpio_read,
 632    .write = strongarm_gpio_write,
 633    .endianness = DEVICE_NATIVE_ENDIAN,
 634};
 635
 636static DeviceState *strongarm_gpio_init(hwaddr base,
 637                DeviceState *pic)
 638{
 639    DeviceState *dev;
 640    int i;
 641
 642    dev = qdev_create(NULL, TYPE_STRONGARM_GPIO);
 643    qdev_init_nofail(dev);
 644
 645    sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, base);
 646    for (i = 0; i < 12; i++)
 647        sysbus_connect_irq(SYS_BUS_DEVICE(dev), i,
 648                    qdev_get_gpio_in(pic, SA_PIC_GPIO0_EDGE + i));
 649
 650    return dev;
 651}
 652
 653static void strongarm_gpio_initfn(Object *obj)
 654{
 655    DeviceState *dev = DEVICE(obj);
 656    StrongARMGPIOInfo *s = STRONGARM_GPIO(obj);
 657    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
 658    int i;
 659
 660    qdev_init_gpio_in(dev, strongarm_gpio_set, 28);
 661    qdev_init_gpio_out(dev, s->handler, 28);
 662
 663    memory_region_init_io(&s->iomem, obj, &strongarm_gpio_ops, s,
 664                          "gpio", 0x1000);
 665
 666    sysbus_init_mmio(sbd, &s->iomem);
 667    for (i = 0; i < 11; i++) {
 668        sysbus_init_irq(sbd, &s->irqs[i]);
 669    }
 670    sysbus_init_irq(sbd, &s->irqX);
 671}
 672
 673static const VMStateDescription vmstate_strongarm_gpio_regs = {
 674    .name = "strongarm-gpio",
 675    .version_id = 0,
 676    .minimum_version_id = 0,
 677    .fields = (VMStateField[]) {
 678        VMSTATE_UINT32(ilevel, StrongARMGPIOInfo),
 679        VMSTATE_UINT32(olevel, StrongARMGPIOInfo),
 680        VMSTATE_UINT32(dir, StrongARMGPIOInfo),
 681        VMSTATE_UINT32(rising, StrongARMGPIOInfo),
 682        VMSTATE_UINT32(falling, StrongARMGPIOInfo),
 683        VMSTATE_UINT32(status, StrongARMGPIOInfo),
 684        VMSTATE_UINT32(gafr, StrongARMGPIOInfo),
 685        VMSTATE_UINT32(prev_level, StrongARMGPIOInfo),
 686        VMSTATE_END_OF_LIST(),
 687    },
 688};
 689
 690static void strongarm_gpio_class_init(ObjectClass *klass, void *data)
 691{
 692    DeviceClass *dc = DEVICE_CLASS(klass);
 693
 694    dc->desc = "StrongARM GPIO controller";
 695    dc->vmsd = &vmstate_strongarm_gpio_regs;
 696}
 697
 698static const TypeInfo strongarm_gpio_info = {
 699    .name          = TYPE_STRONGARM_GPIO,
 700    .parent        = TYPE_SYS_BUS_DEVICE,
 701    .instance_size = sizeof(StrongARMGPIOInfo),
 702    .instance_init = strongarm_gpio_initfn,
 703    .class_init    = strongarm_gpio_class_init,
 704};
 705
 706/* Peripheral Pin Controller */
 707#define PPDR 0x00
 708#define PPSR 0x04
 709#define PPAR 0x08
 710#define PSDR 0x0c
 711#define PPFR 0x10
 712
 713#define TYPE_STRONGARM_PPC "strongarm-ppc"
 714#define STRONGARM_PPC(obj) \
 715    OBJECT_CHECK(StrongARMPPCInfo, (obj), TYPE_STRONGARM_PPC)
 716
 717typedef struct StrongARMPPCInfo StrongARMPPCInfo;
 718struct StrongARMPPCInfo {
 719    SysBusDevice parent_obj;
 720
 721    MemoryRegion iomem;
 722    qemu_irq handler[28];
 723
 724    uint32_t ilevel;
 725    uint32_t olevel;
 726    uint32_t dir;
 727    uint32_t ppar;
 728    uint32_t psdr;
 729    uint32_t ppfr;
 730
 731    uint32_t prev_level;
 732};
 733
 734static void strongarm_ppc_set(void *opaque, int line, int level)
 735{
 736    StrongARMPPCInfo *s = opaque;
 737
 738    if (level) {
 739        s->ilevel |= 1 << line;
 740    } else {
 741        s->ilevel &= ~(1 << line);
 742    }
 743}
 744
 745static void strongarm_ppc_handler_update(StrongARMPPCInfo *s)
 746{
 747    uint32_t level, diff;
 748    int bit;
 749
 750    level = s->olevel & s->dir;
 751
 752    for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
 753        bit = ctz32(diff);
 754        qemu_set_irq(s->handler[bit], (level >> bit) & 1);
 755    }
 756
 757    s->prev_level = level;
 758}
 759
 760static uint64_t strongarm_ppc_read(void *opaque, hwaddr offset,
 761                                   unsigned size)
 762{
 763    StrongARMPPCInfo *s = opaque;
 764
 765    switch (offset) {
 766    case PPDR:        /* PPC Pin Direction registers */
 767        return s->dir | ~0x3fffff;
 768
 769    case PPSR:        /* PPC Pin State registers */
 770        return (s->olevel & s->dir) |
 771               (s->ilevel & ~s->dir) |
 772               ~0x3fffff;
 773
 774    case PPAR:
 775        return s->ppar | ~0x41000;
 776
 777    case PSDR:
 778        return s->psdr;
 779
 780    case PPFR:
 781        return s->ppfr | ~0x7f001;
 782
 783    default:
 784        printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
 785    }
 786
 787    return 0;
 788}
 789
 790static void strongarm_ppc_write(void *opaque, hwaddr offset,
 791                                uint64_t value, unsigned size)
 792{
 793    StrongARMPPCInfo *s = opaque;
 794
 795    switch (offset) {
 796    case PPDR:        /* PPC Pin Direction registers */
 797        s->dir = value & 0x3fffff;
 798        strongarm_ppc_handler_update(s);
 799        break;
 800
 801    case PPSR:        /* PPC Pin State registers */
 802        s->olevel = value & s->dir & 0x3fffff;
 803        strongarm_ppc_handler_update(s);
 804        break;
 805
 806    case PPAR:
 807        s->ppar = value & 0x41000;
 808        break;
 809
 810    case PSDR:
 811        s->psdr = value & 0x3fffff;
 812        break;
 813
 814    case PPFR:
 815        s->ppfr = value & 0x7f001;
 816        break;
 817
 818    default:
 819        printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
 820    }
 821}
 822
 823static const MemoryRegionOps strongarm_ppc_ops = {
 824    .read = strongarm_ppc_read,
 825    .write = strongarm_ppc_write,
 826    .endianness = DEVICE_NATIVE_ENDIAN,
 827};
 828
 829static void strongarm_ppc_init(Object *obj)
 830{
 831    DeviceState *dev = DEVICE(obj);
 832    StrongARMPPCInfo *s = STRONGARM_PPC(obj);
 833    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
 834
 835    qdev_init_gpio_in(dev, strongarm_ppc_set, 22);
 836    qdev_init_gpio_out(dev, s->handler, 22);
 837
 838    memory_region_init_io(&s->iomem, obj, &strongarm_ppc_ops, s,
 839                          "ppc", 0x1000);
 840
 841    sysbus_init_mmio(sbd, &s->iomem);
 842}
 843
 844static const VMStateDescription vmstate_strongarm_ppc_regs = {
 845    .name = "strongarm-ppc",
 846    .version_id = 0,
 847    .minimum_version_id = 0,
 848    .fields = (VMStateField[]) {
 849        VMSTATE_UINT32(ilevel, StrongARMPPCInfo),
 850        VMSTATE_UINT32(olevel, StrongARMPPCInfo),
 851        VMSTATE_UINT32(dir, StrongARMPPCInfo),
 852        VMSTATE_UINT32(ppar, StrongARMPPCInfo),
 853        VMSTATE_UINT32(psdr, StrongARMPPCInfo),
 854        VMSTATE_UINT32(ppfr, StrongARMPPCInfo),
 855        VMSTATE_UINT32(prev_level, StrongARMPPCInfo),
 856        VMSTATE_END_OF_LIST(),
 857    },
 858};
 859
 860static void strongarm_ppc_class_init(ObjectClass *klass, void *data)
 861{
 862    DeviceClass *dc = DEVICE_CLASS(klass);
 863
 864    dc->desc = "StrongARM PPC controller";
 865    dc->vmsd = &vmstate_strongarm_ppc_regs;
 866}
 867
 868static const TypeInfo strongarm_ppc_info = {
 869    .name          = TYPE_STRONGARM_PPC,
 870    .parent        = TYPE_SYS_BUS_DEVICE,
 871    .instance_size = sizeof(StrongARMPPCInfo),
 872    .instance_init = strongarm_ppc_init,
 873    .class_init    = strongarm_ppc_class_init,
 874};
 875
 876/* UART Ports */
 877#define UTCR0 0x00
 878#define UTCR1 0x04
 879#define UTCR2 0x08
 880#define UTCR3 0x0c
 881#define UTDR  0x14
 882#define UTSR0 0x1c
 883#define UTSR1 0x20
 884
 885#define UTCR0_PE  (1 << 0) /* Parity enable */
 886#define UTCR0_OES (1 << 1) /* Even parity */
 887#define UTCR0_SBS (1 << 2) /* 2 stop bits */
 888#define UTCR0_DSS (1 << 3) /* 8-bit data */
 889
 890#define UTCR3_RXE (1 << 0) /* Rx enable */
 891#define UTCR3_TXE (1 << 1) /* Tx enable */
 892#define UTCR3_BRK (1 << 2) /* Force Break */
 893#define UTCR3_RIE (1 << 3) /* Rx int enable */
 894#define UTCR3_TIE (1 << 4) /* Tx int enable */
 895#define UTCR3_LBM (1 << 5) /* Loopback */
 896
 897#define UTSR0_TFS (1 << 0) /* Tx FIFO nearly empty */
 898#define UTSR0_RFS (1 << 1) /* Rx FIFO nearly full */
 899#define UTSR0_RID (1 << 2) /* Receiver Idle */
 900#define UTSR0_RBB (1 << 3) /* Receiver begin break */
 901#define UTSR0_REB (1 << 4) /* Receiver end break */
 902#define UTSR0_EIF (1 << 5) /* Error in FIFO */
 903
 904#define UTSR1_RNE (1 << 1) /* Receive FIFO not empty */
 905#define UTSR1_TNF (1 << 2) /* Transmit FIFO not full */
 906#define UTSR1_PRE (1 << 3) /* Parity error */
 907#define UTSR1_FRE (1 << 4) /* Frame error */
 908#define UTSR1_ROR (1 << 5) /* Receive Over Run */
 909
 910#define RX_FIFO_PRE (1 << 8)
 911#define RX_FIFO_FRE (1 << 9)
 912#define RX_FIFO_ROR (1 << 10)
 913
 914#define TYPE_STRONGARM_UART "strongarm-uart"
 915#define STRONGARM_UART(obj) \
 916    OBJECT_CHECK(StrongARMUARTState, (obj), TYPE_STRONGARM_UART)
 917
 918typedef struct StrongARMUARTState {
 919    SysBusDevice parent_obj;
 920
 921    MemoryRegion iomem;
 922    CharBackend chr;
 923    qemu_irq irq;
 924
 925    uint8_t utcr0;
 926    uint16_t brd;
 927    uint8_t utcr3;
 928    uint8_t utsr0;
 929    uint8_t utsr1;
 930
 931    uint8_t tx_fifo[8];
 932    uint8_t tx_start;
 933    uint8_t tx_len;
 934    uint16_t rx_fifo[12]; /* value + error flags in high bits */
 935    uint8_t rx_start;
 936    uint8_t rx_len;
 937
 938    uint64_t char_transmit_time; /* time to transmit a char in ticks*/
 939    bool wait_break_end;
 940    QEMUTimer *rx_timeout_timer;
 941    QEMUTimer *tx_timer;
 942} StrongARMUARTState;
 943
 944static void strongarm_uart_update_status(StrongARMUARTState *s)
 945{
 946    uint16_t utsr1 = 0;
 947
 948    if (s->tx_len != 8) {
 949        utsr1 |= UTSR1_TNF;
 950    }
 951
 952    if (s->rx_len != 0) {
 953        uint16_t ent = s->rx_fifo[s->rx_start];
 954
 955        utsr1 |= UTSR1_RNE;
 956        if (ent & RX_FIFO_PRE) {
 957            s->utsr1 |= UTSR1_PRE;
 958        }
 959        if (ent & RX_FIFO_FRE) {
 960            s->utsr1 |= UTSR1_FRE;
 961        }
 962        if (ent & RX_FIFO_ROR) {
 963            s->utsr1 |= UTSR1_ROR;
 964        }
 965    }
 966
 967    s->utsr1 = utsr1;
 968}
 969
 970static void strongarm_uart_update_int_status(StrongARMUARTState *s)
 971{
 972    uint16_t utsr0 = s->utsr0 &
 973            (UTSR0_REB | UTSR0_RBB | UTSR0_RID);
 974    int i;
 975
 976    if ((s->utcr3 & UTCR3_TXE) &&
 977                (s->utcr3 & UTCR3_TIE) &&
 978                s->tx_len <= 4) {
 979        utsr0 |= UTSR0_TFS;
 980    }
 981
 982    if ((s->utcr3 & UTCR3_RXE) &&
 983                (s->utcr3 & UTCR3_RIE) &&
 984                s->rx_len > 4) {
 985        utsr0 |= UTSR0_RFS;
 986    }
 987
 988    for (i = 0; i < s->rx_len && i < 4; i++)
 989        if (s->rx_fifo[(s->rx_start + i) % 12] & ~0xff) {
 990            utsr0 |= UTSR0_EIF;
 991            break;
 992        }
 993
 994    s->utsr0 = utsr0;
 995    qemu_set_irq(s->irq, utsr0);
 996}
 997
 998static void strongarm_uart_update_parameters(StrongARMUARTState *s)
 999{
1000    int speed, parity, data_bits, stop_bits, frame_size;
1001    QEMUSerialSetParams ssp;
1002
1003    /* Start bit. */
1004    frame_size = 1;
1005    if (s->utcr0 & UTCR0_PE) {
1006        /* Parity bit. */
1007        frame_size++;
1008        if (s->utcr0 & UTCR0_OES) {
1009            parity = 'E';
1010        } else {
1011            parity = 'O';
1012        }
1013    } else {
1014            parity = 'N';
1015    }
1016    if (s->utcr0 & UTCR0_SBS) {
1017        stop_bits = 2;
1018    } else {
1019        stop_bits = 1;
1020    }
1021
1022    data_bits = (s->utcr0 & UTCR0_DSS) ? 8 : 7;
1023    frame_size += data_bits + stop_bits;
1024    speed = 3686400 / 16 / (s->brd + 1);
1025    ssp.speed = speed;
1026    ssp.parity = parity;
1027    ssp.data_bits = data_bits;
1028    ssp.stop_bits = stop_bits;
1029    s->char_transmit_time =  (NANOSECONDS_PER_SECOND / speed) * frame_size;
1030    qemu_chr_fe_ioctl(&s->chr, CHR_IOCTL_SERIAL_SET_PARAMS, &ssp);
1031
1032    DPRINTF(stderr, "%s speed=%d parity=%c data=%d stop=%d\n", s->chr->label,
1033            speed, parity, data_bits, stop_bits);
1034}
1035
1036static void strongarm_uart_rx_to(void *opaque)
1037{
1038    StrongARMUARTState *s = opaque;
1039
1040    if (s->rx_len) {
1041        s->utsr0 |= UTSR0_RID;
1042        strongarm_uart_update_int_status(s);
1043    }
1044}
1045
1046static void strongarm_uart_rx_push(StrongARMUARTState *s, uint16_t c)
1047{
1048    if ((s->utcr3 & UTCR3_RXE) == 0) {
1049        /* rx disabled */
1050        return;
1051    }
1052
1053    if (s->wait_break_end) {
1054        s->utsr0 |= UTSR0_REB;
1055        s->wait_break_end = false;
1056    }
1057
1058    if (s->rx_len < 12) {
1059        s->rx_fifo[(s->rx_start + s->rx_len) % 12] = c;
1060        s->rx_len++;
1061    } else
1062        s->rx_fifo[(s->rx_start + 11) % 12] |= RX_FIFO_ROR;
1063}
1064
1065static int strongarm_uart_can_receive(void *opaque)
1066{
1067    StrongARMUARTState *s = opaque;
1068
1069    if (s->rx_len == 12) {
1070        return 0;
1071    }
1072    /* It's best not to get more than 2/3 of RX FIFO, so advertise that much */
1073    if (s->rx_len < 8) {
1074        return 8 - s->rx_len;
1075    }
1076    return 1;
1077}
1078
1079static void strongarm_uart_receive(void *opaque, const uint8_t *buf, int size)
1080{
1081    StrongARMUARTState *s = opaque;
1082    int i;
1083
1084    for (i = 0; i < size; i++) {
1085        strongarm_uart_rx_push(s, buf[i]);
1086    }
1087
1088    /* call the timeout receive callback in 3 char transmit time */
1089    timer_mod(s->rx_timeout_timer,
1090                    qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
1091
1092    strongarm_uart_update_status(s);
1093    strongarm_uart_update_int_status(s);
1094}
1095
1096static void strongarm_uart_event(void *opaque, int event)
1097{
1098    StrongARMUARTState *s = opaque;
1099    if (event == CHR_EVENT_BREAK) {
1100        s->utsr0 |= UTSR0_RBB;
1101        strongarm_uart_rx_push(s, RX_FIFO_FRE);
1102        s->wait_break_end = true;
1103        strongarm_uart_update_status(s);
1104        strongarm_uart_update_int_status(s);
1105    }
1106}
1107
1108static void strongarm_uart_tx(void *opaque)
1109{
1110    StrongARMUARTState *s = opaque;
1111    uint64_t new_xmit_ts = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
1112
1113    if (s->utcr3 & UTCR3_LBM) /* loopback */ {
1114        strongarm_uart_receive(s, &s->tx_fifo[s->tx_start], 1);
1115    } else if (qemu_chr_fe_backend_connected(&s->chr)) {
1116        /* XXX this blocks entire thread. Rewrite to use
1117         * qemu_chr_fe_write and background I/O callbacks */
1118        qemu_chr_fe_write_all(&s->chr, &s->tx_fifo[s->tx_start], 1);
1119    }
1120
1121    s->tx_start = (s->tx_start + 1) % 8;
1122    s->tx_len--;
1123    if (s->tx_len) {
1124        timer_mod(s->tx_timer, new_xmit_ts + s->char_transmit_time);
1125    }
1126    strongarm_uart_update_status(s);
1127    strongarm_uart_update_int_status(s);
1128}
1129
1130static uint64_t strongarm_uart_read(void *opaque, hwaddr addr,
1131                                    unsigned size)
1132{
1133    StrongARMUARTState *s = opaque;
1134    uint16_t ret;
1135
1136    switch (addr) {
1137    case UTCR0:
1138        return s->utcr0;
1139
1140    case UTCR1:
1141        return s->brd >> 8;
1142
1143    case UTCR2:
1144        return s->brd & 0xff;
1145
1146    case UTCR3:
1147        return s->utcr3;
1148
1149    case UTDR:
1150        if (s->rx_len != 0) {
1151            ret = s->rx_fifo[s->rx_start];
1152            s->rx_start = (s->rx_start + 1) % 12;
1153            s->rx_len--;
1154            strongarm_uart_update_status(s);
1155            strongarm_uart_update_int_status(s);
1156            return ret;
1157        }
1158        return 0;
1159
1160    case UTSR0:
1161        return s->utsr0;
1162
1163    case UTSR1:
1164        return s->utsr1;
1165
1166    default:
1167        printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1168        return 0;
1169    }
1170}
1171
1172static void strongarm_uart_write(void *opaque, hwaddr addr,
1173                                 uint64_t value, unsigned size)
1174{
1175    StrongARMUARTState *s = opaque;
1176
1177    switch (addr) {
1178    case UTCR0:
1179        s->utcr0 = value & 0x7f;
1180        strongarm_uart_update_parameters(s);
1181        break;
1182
1183    case UTCR1:
1184        s->brd = (s->brd & 0xff) | ((value & 0xf) << 8);
1185        strongarm_uart_update_parameters(s);
1186        break;
1187
1188    case UTCR2:
1189        s->brd = (s->brd & 0xf00) | (value & 0xff);
1190        strongarm_uart_update_parameters(s);
1191        break;
1192
1193    case UTCR3:
1194        s->utcr3 = value & 0x3f;
1195        if ((s->utcr3 & UTCR3_RXE) == 0) {
1196            s->rx_len = 0;
1197        }
1198        if ((s->utcr3 & UTCR3_TXE) == 0) {
1199            s->tx_len = 0;
1200        }
1201        strongarm_uart_update_status(s);
1202        strongarm_uart_update_int_status(s);
1203        break;
1204
1205    case UTDR:
1206        if ((s->utcr3 & UTCR3_TXE) && s->tx_len != 8) {
1207            s->tx_fifo[(s->tx_start + s->tx_len) % 8] = value;
1208            s->tx_len++;
1209            strongarm_uart_update_status(s);
1210            strongarm_uart_update_int_status(s);
1211            if (s->tx_len == 1) {
1212                strongarm_uart_tx(s);
1213            }
1214        }
1215        break;
1216
1217    case UTSR0:
1218        s->utsr0 = s->utsr0 & ~(value &
1219                (UTSR0_REB | UTSR0_RBB | UTSR0_RID));
1220        strongarm_uart_update_int_status(s);
1221        break;
1222
1223    default:
1224        printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1225    }
1226}
1227
1228static const MemoryRegionOps strongarm_uart_ops = {
1229    .read = strongarm_uart_read,
1230    .write = strongarm_uart_write,
1231    .endianness = DEVICE_NATIVE_ENDIAN,
1232};
1233
1234static void strongarm_uart_init(Object *obj)
1235{
1236    StrongARMUARTState *s = STRONGARM_UART(obj);
1237    SysBusDevice *dev = SYS_BUS_DEVICE(obj);
1238
1239    memory_region_init_io(&s->iomem, obj, &strongarm_uart_ops, s,
1240                          "uart", 0x10000);
1241    sysbus_init_mmio(dev, &s->iomem);
1242    sysbus_init_irq(dev, &s->irq);
1243
1244    s->rx_timeout_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_rx_to, s);
1245    s->tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_tx, s);
1246}
1247
1248static void strongarm_uart_realize(DeviceState *dev, Error **errp)
1249{
1250    StrongARMUARTState *s = STRONGARM_UART(dev);
1251
1252    qemu_chr_fe_set_handlers(&s->chr,
1253                             strongarm_uart_can_receive,
1254                             strongarm_uart_receive,
1255                             strongarm_uart_event,
1256                             NULL, s, NULL, true);
1257}
1258
1259static void strongarm_uart_reset(DeviceState *dev)
1260{
1261    StrongARMUARTState *s = STRONGARM_UART(dev);
1262
1263    s->utcr0 = UTCR0_DSS; /* 8 data, no parity */
1264    s->brd = 23;    /* 9600 */
1265    /* enable send & recv - this actually violates spec */
1266    s->utcr3 = UTCR3_TXE | UTCR3_RXE;
1267
1268    s->rx_len = s->tx_len = 0;
1269
1270    strongarm_uart_update_parameters(s);
1271    strongarm_uart_update_status(s);
1272    strongarm_uart_update_int_status(s);
1273}
1274
1275static int strongarm_uart_post_load(void *opaque, int version_id)
1276{
1277    StrongARMUARTState *s = opaque;
1278
1279    strongarm_uart_update_parameters(s);
1280    strongarm_uart_update_status(s);
1281    strongarm_uart_update_int_status(s);
1282
1283    /* tx and restart timer */
1284    if (s->tx_len) {
1285        strongarm_uart_tx(s);
1286    }
1287
1288    /* restart rx timeout timer */
1289    if (s->rx_len) {
1290        timer_mod(s->rx_timeout_timer,
1291                qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
1292    }
1293
1294    return 0;
1295}
1296
1297static const VMStateDescription vmstate_strongarm_uart_regs = {
1298    .name = "strongarm-uart",
1299    .version_id = 0,
1300    .minimum_version_id = 0,
1301    .post_load = strongarm_uart_post_load,
1302    .fields = (VMStateField[]) {
1303        VMSTATE_UINT8(utcr0, StrongARMUARTState),
1304        VMSTATE_UINT16(brd, StrongARMUARTState),
1305        VMSTATE_UINT8(utcr3, StrongARMUARTState),
1306        VMSTATE_UINT8(utsr0, StrongARMUARTState),
1307        VMSTATE_UINT8_ARRAY(tx_fifo, StrongARMUARTState, 8),
1308        VMSTATE_UINT8(tx_start, StrongARMUARTState),
1309        VMSTATE_UINT8(tx_len, StrongARMUARTState),
1310        VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMUARTState, 12),
1311        VMSTATE_UINT8(rx_start, StrongARMUARTState),
1312        VMSTATE_UINT8(rx_len, StrongARMUARTState),
1313        VMSTATE_BOOL(wait_break_end, StrongARMUARTState),
1314        VMSTATE_END_OF_LIST(),
1315    },
1316};
1317
1318static Property strongarm_uart_properties[] = {
1319    DEFINE_PROP_CHR("chardev", StrongARMUARTState, chr),
1320    DEFINE_PROP_END_OF_LIST(),
1321};
1322
1323static void strongarm_uart_class_init(ObjectClass *klass, void *data)
1324{
1325    DeviceClass *dc = DEVICE_CLASS(klass);
1326
1327    dc->desc = "StrongARM UART controller";
1328    dc->reset = strongarm_uart_reset;
1329    dc->vmsd = &vmstate_strongarm_uart_regs;
1330    dc->props = strongarm_uart_properties;
1331    dc->realize = strongarm_uart_realize;
1332}
1333
1334static const TypeInfo strongarm_uart_info = {
1335    .name          = TYPE_STRONGARM_UART,
1336    .parent        = TYPE_SYS_BUS_DEVICE,
1337    .instance_size = sizeof(StrongARMUARTState),
1338    .instance_init = strongarm_uart_init,
1339    .class_init    = strongarm_uart_class_init,
1340};
1341
1342/* Synchronous Serial Ports */
1343
1344#define TYPE_STRONGARM_SSP "strongarm-ssp"
1345#define STRONGARM_SSP(obj) \
1346    OBJECT_CHECK(StrongARMSSPState, (obj), TYPE_STRONGARM_SSP)
1347
1348typedef struct StrongARMSSPState {
1349    SysBusDevice parent_obj;
1350
1351    MemoryRegion iomem;
1352    qemu_irq irq;
1353    SSIBus *bus;
1354
1355    uint16_t sscr[2];
1356    uint16_t sssr;
1357
1358    uint16_t rx_fifo[8];
1359    uint8_t rx_level;
1360    uint8_t rx_start;
1361} StrongARMSSPState;
1362
1363#define SSCR0 0x60 /* SSP Control register 0 */
1364#define SSCR1 0x64 /* SSP Control register 1 */
1365#define SSDR  0x6c /* SSP Data register */
1366#define SSSR  0x74 /* SSP Status register */
1367
1368/* Bitfields for above registers */
1369#define SSCR0_SPI(x)    (((x) & 0x30) == 0x00)
1370#define SSCR0_SSP(x)    (((x) & 0x30) == 0x10)
1371#define SSCR0_UWIRE(x)  (((x) & 0x30) == 0x20)
1372#define SSCR0_PSP(x)    (((x) & 0x30) == 0x30)
1373#define SSCR0_SSE       (1 << 7)
1374#define SSCR0_DSS(x)    (((x) & 0xf) + 1)
1375#define SSCR1_RIE       (1 << 0)
1376#define SSCR1_TIE       (1 << 1)
1377#define SSCR1_LBM       (1 << 2)
1378#define SSSR_TNF        (1 << 2)
1379#define SSSR_RNE        (1 << 3)
1380#define SSSR_TFS        (1 << 5)
1381#define SSSR_RFS        (1 << 6)
1382#define SSSR_ROR        (1 << 7)
1383#define SSSR_RW         0x0080
1384
1385static void strongarm_ssp_int_update(StrongARMSSPState *s)
1386{
1387    int level = 0;
1388
1389    level |= (s->sssr & SSSR_ROR);
1390    level |= (s->sssr & SSSR_RFS)  &&  (s->sscr[1] & SSCR1_RIE);
1391    level |= (s->sssr & SSSR_TFS)  &&  (s->sscr[1] & SSCR1_TIE);
1392    qemu_set_irq(s->irq, level);
1393}
1394
1395static void strongarm_ssp_fifo_update(StrongARMSSPState *s)
1396{
1397    s->sssr &= ~SSSR_TFS;
1398    s->sssr &= ~SSSR_TNF;
1399    if (s->sscr[0] & SSCR0_SSE) {
1400        if (s->rx_level >= 4) {
1401            s->sssr |= SSSR_RFS;
1402        } else {
1403            s->sssr &= ~SSSR_RFS;
1404        }
1405        if (s->rx_level) {
1406            s->sssr |= SSSR_RNE;
1407        } else {
1408            s->sssr &= ~SSSR_RNE;
1409        }
1410        /* TX FIFO is never filled, so it is always in underrun
1411           condition if SSP is enabled */
1412        s->sssr |= SSSR_TFS;
1413        s->sssr |= SSSR_TNF;
1414    }
1415
1416    strongarm_ssp_int_update(s);
1417}
1418
1419static uint64_t strongarm_ssp_read(void *opaque, hwaddr addr,
1420                                   unsigned size)
1421{
1422    StrongARMSSPState *s = opaque;
1423    uint32_t retval;
1424
1425    switch (addr) {
1426    case SSCR0:
1427        return s->sscr[0];
1428    case SSCR1:
1429        return s->sscr[1];
1430    case SSSR:
1431        return s->sssr;
1432    case SSDR:
1433        if (~s->sscr[0] & SSCR0_SSE) {
1434            return 0xffffffff;
1435        }
1436        if (s->rx_level < 1) {
1437            printf("%s: SSP Rx Underrun\n", __func__);
1438            return 0xffffffff;
1439        }
1440        s->rx_level--;
1441        retval = s->rx_fifo[s->rx_start++];
1442        s->rx_start &= 0x7;
1443        strongarm_ssp_fifo_update(s);
1444        return retval;
1445    default:
1446        printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1447        break;
1448    }
1449    return 0;
1450}
1451
1452static void strongarm_ssp_write(void *opaque, hwaddr addr,
1453                                uint64_t value, unsigned size)
1454{
1455    StrongARMSSPState *s = opaque;
1456
1457    switch (addr) {
1458    case SSCR0:
1459        s->sscr[0] = value & 0xffbf;
1460        if ((s->sscr[0] & SSCR0_SSE) && SSCR0_DSS(value) < 4) {
1461            printf("%s: Wrong data size: %i bits\n", __func__,
1462                   (int)SSCR0_DSS(value));
1463        }
1464        if (!(value & SSCR0_SSE)) {
1465            s->sssr = 0;
1466            s->rx_level = 0;
1467        }
1468        strongarm_ssp_fifo_update(s);
1469        break;
1470
1471    case SSCR1:
1472        s->sscr[1] = value & 0x2f;
1473        if (value & SSCR1_LBM) {
1474            printf("%s: Attempt to use SSP LBM mode\n", __func__);
1475        }
1476        strongarm_ssp_fifo_update(s);
1477        break;
1478
1479    case SSSR:
1480        s->sssr &= ~(value & SSSR_RW);
1481        strongarm_ssp_int_update(s);
1482        break;
1483
1484    case SSDR:
1485        if (SSCR0_UWIRE(s->sscr[0])) {
1486            value &= 0xff;
1487        } else
1488            /* Note how 32bits overflow does no harm here */
1489            value &= (1 << SSCR0_DSS(s->sscr[0])) - 1;
1490
1491        /* Data goes from here to the Tx FIFO and is shifted out from
1492         * there directly to the slave, no need to buffer it.
1493         */
1494        if (s->sscr[0] & SSCR0_SSE) {
1495            uint32_t readval;
1496            if (s->sscr[1] & SSCR1_LBM) {
1497                readval = value;
1498            } else {
1499                readval = ssi_transfer(s->bus, value);
1500            }
1501
1502            if (s->rx_level < 0x08) {
1503                s->rx_fifo[(s->rx_start + s->rx_level++) & 0x7] = readval;
1504            } else {
1505                s->sssr |= SSSR_ROR;
1506            }
1507        }
1508        strongarm_ssp_fifo_update(s);
1509        break;
1510
1511    default:
1512        printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1513        break;
1514    }
1515}
1516
1517static const MemoryRegionOps strongarm_ssp_ops = {
1518    .read = strongarm_ssp_read,
1519    .write = strongarm_ssp_write,
1520    .endianness = DEVICE_NATIVE_ENDIAN,
1521};
1522
1523static int strongarm_ssp_post_load(void *opaque, int version_id)
1524{
1525    StrongARMSSPState *s = opaque;
1526
1527    strongarm_ssp_fifo_update(s);
1528
1529    return 0;
1530}
1531
1532static void strongarm_ssp_init(Object *obj)
1533{
1534    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
1535    DeviceState *dev = DEVICE(sbd);
1536    StrongARMSSPState *s = STRONGARM_SSP(dev);
1537
1538    sysbus_init_irq(sbd, &s->irq);
1539
1540    memory_region_init_io(&s->iomem, obj, &strongarm_ssp_ops, s,
1541                          "ssp", 0x1000);
1542    sysbus_init_mmio(sbd, &s->iomem);
1543
1544    s->bus = ssi_create_bus(dev, "ssi");
1545}
1546
1547static void strongarm_ssp_reset(DeviceState *dev)
1548{
1549    StrongARMSSPState *s = STRONGARM_SSP(dev);
1550
1551    s->sssr = 0x03; /* 3 bit data, SPI, disabled */
1552    s->rx_start = 0;
1553    s->rx_level = 0;
1554}
1555
1556static const VMStateDescription vmstate_strongarm_ssp_regs = {
1557    .name = "strongarm-ssp",
1558    .version_id = 0,
1559    .minimum_version_id = 0,
1560    .post_load = strongarm_ssp_post_load,
1561    .fields = (VMStateField[]) {
1562        VMSTATE_UINT16_ARRAY(sscr, StrongARMSSPState, 2),
1563        VMSTATE_UINT16(sssr, StrongARMSSPState),
1564        VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMSSPState, 8),
1565        VMSTATE_UINT8(rx_start, StrongARMSSPState),
1566        VMSTATE_UINT8(rx_level, StrongARMSSPState),
1567        VMSTATE_END_OF_LIST(),
1568    },
1569};
1570
1571static void strongarm_ssp_class_init(ObjectClass *klass, void *data)
1572{
1573    DeviceClass *dc = DEVICE_CLASS(klass);
1574
1575    dc->desc = "StrongARM SSP controller";
1576    dc->reset = strongarm_ssp_reset;
1577    dc->vmsd = &vmstate_strongarm_ssp_regs;
1578}
1579
1580static const TypeInfo strongarm_ssp_info = {
1581    .name          = TYPE_STRONGARM_SSP,
1582    .parent        = TYPE_SYS_BUS_DEVICE,
1583    .instance_size = sizeof(StrongARMSSPState),
1584    .instance_init = strongarm_ssp_init,
1585    .class_init    = strongarm_ssp_class_init,
1586};
1587
1588/* Main CPU functions */
1589StrongARMState *sa1110_init(const char *cpu_type)
1590{
1591    StrongARMState *s;
1592    int i;
1593
1594    s = g_new0(StrongARMState, 1);
1595
1596    if (strncmp(cpu_type, "sa1110", 6)) {
1597        error_report("Machine requires a SA1110 processor.");
1598        exit(1);
1599    }
1600
1601    s->cpu = ARM_CPU(cpu_create(cpu_type));
1602
1603    s->pic = sysbus_create_varargs("strongarm_pic", 0x90050000,
1604                    qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ),
1605                    qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_FIQ),
1606                    NULL);
1607
1608    sysbus_create_varargs("pxa25x-timer", 0x90000000,
1609                    qdev_get_gpio_in(s->pic, SA_PIC_OSTC0),
1610                    qdev_get_gpio_in(s->pic, SA_PIC_OSTC1),
1611                    qdev_get_gpio_in(s->pic, SA_PIC_OSTC2),
1612                    qdev_get_gpio_in(s->pic, SA_PIC_OSTC3),
1613                    NULL);
1614
1615    sysbus_create_simple(TYPE_STRONGARM_RTC, 0x90010000,
1616                    qdev_get_gpio_in(s->pic, SA_PIC_RTC_ALARM));
1617
1618    s->gpio = strongarm_gpio_init(0x90040000, s->pic);
1619
1620    s->ppc = sysbus_create_varargs(TYPE_STRONGARM_PPC, 0x90060000, NULL);
1621
1622    for (i = 0; sa_serial[i].io_base; i++) {
1623        DeviceState *dev = qdev_create(NULL, TYPE_STRONGARM_UART);
1624        qdev_prop_set_chr(dev, "chardev", serial_hd(i));
1625        qdev_init_nofail(dev);
1626        sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0,
1627                sa_serial[i].io_base);
1628        sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0,
1629                qdev_get_gpio_in(s->pic, sa_serial[i].irq));
1630    }
1631
1632    s->ssp = sysbus_create_varargs(TYPE_STRONGARM_SSP, 0x80070000,
1633                qdev_get_gpio_in(s->pic, SA_PIC_SSP), NULL);
1634    s->ssp_bus = (SSIBus *)qdev_get_child_bus(s->ssp, "ssi");
1635
1636    return s;
1637}
1638
1639static void strongarm_register_types(void)
1640{
1641    type_register_static(&strongarm_pic_info);
1642    type_register_static(&strongarm_rtc_sysbus_info);
1643    type_register_static(&strongarm_gpio_info);
1644    type_register_static(&strongarm_ppc_info);
1645    type_register_static(&strongarm_uart_info);
1646    type_register_static(&strongarm_ssp_info);
1647}
1648
1649type_init(strongarm_register_types)
1650