qemu/hw/arm/musicpal.c
<<
>>
Prefs
   1/*
   2 * Marvell MV88W8618 / Freecom MusicPal emulation.
   3 *
   4 * Copyright (c) 2008 Jan Kiszka
   5 *
   6 * This code is licensed under the GNU GPL v2.
   7 *
   8 * Contributions after 2012-01-13 are licensed under the terms of the
   9 * GNU GPL, version 2 or (at your option) any later version.
  10 */
  11
  12#include "qemu/osdep.h"
  13#include "qapi/error.h"
  14#include "cpu.h"
  15#include "hw/sysbus.h"
  16#include "migration/vmstate.h"
  17#include "hw/arm/boot.h"
  18#include "net/net.h"
  19#include "sysemu/sysemu.h"
  20#include "hw/boards.h"
  21#include "hw/char/serial.h"
  22#include "hw/hw.h"
  23#include "qemu/timer.h"
  24#include "hw/ptimer.h"
  25#include "hw/qdev-properties.h"
  26#include "hw/block/flash.h"
  27#include "ui/console.h"
  28#include "hw/i2c/i2c.h"
  29#include "hw/irq.h"
  30#include "hw/audio/wm8750.h"
  31#include "sysemu/block-backend.h"
  32#include "sysemu/runstate.h"
  33#include "exec/address-spaces.h"
  34#include "ui/pixel_ops.h"
  35
  36#define MP_MISC_BASE            0x80002000
  37#define MP_MISC_SIZE            0x00001000
  38
  39#define MP_ETH_BASE             0x80008000
  40#define MP_ETH_SIZE             0x00001000
  41
  42#define MP_WLAN_BASE            0x8000C000
  43#define MP_WLAN_SIZE            0x00000800
  44
  45#define MP_UART1_BASE           0x8000C840
  46#define MP_UART2_BASE           0x8000C940
  47
  48#define MP_GPIO_BASE            0x8000D000
  49#define MP_GPIO_SIZE            0x00001000
  50
  51#define MP_FLASHCFG_BASE        0x90006000
  52#define MP_FLASHCFG_SIZE        0x00001000
  53
  54#define MP_AUDIO_BASE           0x90007000
  55
  56#define MP_PIC_BASE             0x90008000
  57#define MP_PIC_SIZE             0x00001000
  58
  59#define MP_PIT_BASE             0x90009000
  60#define MP_PIT_SIZE             0x00001000
  61
  62#define MP_LCD_BASE             0x9000c000
  63#define MP_LCD_SIZE             0x00001000
  64
  65#define MP_SRAM_BASE            0xC0000000
  66#define MP_SRAM_SIZE            0x00020000
  67
  68#define MP_RAM_DEFAULT_SIZE     32*1024*1024
  69#define MP_FLASH_SIZE_MAX       32*1024*1024
  70
  71#define MP_TIMER1_IRQ           4
  72#define MP_TIMER2_IRQ           5
  73#define MP_TIMER3_IRQ           6
  74#define MP_TIMER4_IRQ           7
  75#define MP_EHCI_IRQ             8
  76#define MP_ETH_IRQ              9
  77#define MP_UART1_IRQ            11
  78#define MP_UART2_IRQ            11
  79#define MP_GPIO_IRQ             12
  80#define MP_RTC_IRQ              28
  81#define MP_AUDIO_IRQ            30
  82
  83/* Wolfson 8750 I2C address */
  84#define MP_WM_ADDR              0x1A
  85
  86/* Ethernet register offsets */
  87#define MP_ETH_SMIR             0x010
  88#define MP_ETH_PCXR             0x408
  89#define MP_ETH_SDCMR            0x448
  90#define MP_ETH_ICR              0x450
  91#define MP_ETH_IMR              0x458
  92#define MP_ETH_FRDP0            0x480
  93#define MP_ETH_FRDP1            0x484
  94#define MP_ETH_FRDP2            0x488
  95#define MP_ETH_FRDP3            0x48C
  96#define MP_ETH_CRDP0            0x4A0
  97#define MP_ETH_CRDP1            0x4A4
  98#define MP_ETH_CRDP2            0x4A8
  99#define MP_ETH_CRDP3            0x4AC
 100#define MP_ETH_CTDP0            0x4E0
 101#define MP_ETH_CTDP1            0x4E4
 102
 103/* MII PHY access */
 104#define MP_ETH_SMIR_DATA        0x0000FFFF
 105#define MP_ETH_SMIR_ADDR        0x03FF0000
 106#define MP_ETH_SMIR_OPCODE      (1 << 26) /* Read value */
 107#define MP_ETH_SMIR_RDVALID     (1 << 27)
 108
 109/* PHY registers */
 110#define MP_ETH_PHY1_BMSR        0x00210000
 111#define MP_ETH_PHY1_PHYSID1     0x00410000
 112#define MP_ETH_PHY1_PHYSID2     0x00610000
 113
 114#define MP_PHY_BMSR_LINK        0x0004
 115#define MP_PHY_BMSR_AUTONEG     0x0008
 116
 117#define MP_PHY_88E3015          0x01410E20
 118
 119/* TX descriptor status */
 120#define MP_ETH_TX_OWN           (1U << 31)
 121
 122/* RX descriptor status */
 123#define MP_ETH_RX_OWN           (1U << 31)
 124
 125/* Interrupt cause/mask bits */
 126#define MP_ETH_IRQ_RX_BIT       0
 127#define MP_ETH_IRQ_RX           (1 << MP_ETH_IRQ_RX_BIT)
 128#define MP_ETH_IRQ_TXHI_BIT     2
 129#define MP_ETH_IRQ_TXLO_BIT     3
 130
 131/* Port config bits */
 132#define MP_ETH_PCXR_2BSM_BIT    28 /* 2-byte incoming suffix */
 133
 134/* SDMA command bits */
 135#define MP_ETH_CMD_TXHI         (1 << 23)
 136#define MP_ETH_CMD_TXLO         (1 << 22)
 137
 138typedef struct mv88w8618_tx_desc {
 139    uint32_t cmdstat;
 140    uint16_t res;
 141    uint16_t bytes;
 142    uint32_t buffer;
 143    uint32_t next;
 144} mv88w8618_tx_desc;
 145
 146typedef struct mv88w8618_rx_desc {
 147    uint32_t cmdstat;
 148    uint16_t bytes;
 149    uint16_t buffer_size;
 150    uint32_t buffer;
 151    uint32_t next;
 152} mv88w8618_rx_desc;
 153
 154#define TYPE_MV88W8618_ETH "mv88w8618_eth"
 155#define MV88W8618_ETH(obj) \
 156    OBJECT_CHECK(mv88w8618_eth_state, (obj), TYPE_MV88W8618_ETH)
 157
 158typedef struct mv88w8618_eth_state {
 159    /*< private >*/
 160    SysBusDevice parent_obj;
 161    /*< public >*/
 162
 163    MemoryRegion iomem;
 164    qemu_irq irq;
 165    uint32_t smir;
 166    uint32_t icr;
 167    uint32_t imr;
 168    int mmio_index;
 169    uint32_t vlan_header;
 170    uint32_t tx_queue[2];
 171    uint32_t rx_queue[4];
 172    uint32_t frx_queue[4];
 173    uint32_t cur_rx[4];
 174    NICState *nic;
 175    NICConf conf;
 176} mv88w8618_eth_state;
 177
 178static void eth_rx_desc_put(uint32_t addr, mv88w8618_rx_desc *desc)
 179{
 180    cpu_to_le32s(&desc->cmdstat);
 181    cpu_to_le16s(&desc->bytes);
 182    cpu_to_le16s(&desc->buffer_size);
 183    cpu_to_le32s(&desc->buffer);
 184    cpu_to_le32s(&desc->next);
 185    cpu_physical_memory_write(addr, desc, sizeof(*desc));
 186}
 187
 188static void eth_rx_desc_get(uint32_t addr, mv88w8618_rx_desc *desc)
 189{
 190    cpu_physical_memory_read(addr, desc, sizeof(*desc));
 191    le32_to_cpus(&desc->cmdstat);
 192    le16_to_cpus(&desc->bytes);
 193    le16_to_cpus(&desc->buffer_size);
 194    le32_to_cpus(&desc->buffer);
 195    le32_to_cpus(&desc->next);
 196}
 197
 198static ssize_t eth_receive(NetClientState *nc, const uint8_t *buf, size_t size)
 199{
 200    mv88w8618_eth_state *s = qemu_get_nic_opaque(nc);
 201    uint32_t desc_addr;
 202    mv88w8618_rx_desc desc;
 203    int i;
 204
 205    for (i = 0; i < 4; i++) {
 206        desc_addr = s->cur_rx[i];
 207        if (!desc_addr) {
 208            continue;
 209        }
 210        do {
 211            eth_rx_desc_get(desc_addr, &desc);
 212            if ((desc.cmdstat & MP_ETH_RX_OWN) && desc.buffer_size >= size) {
 213                cpu_physical_memory_write(desc.buffer + s->vlan_header,
 214                                          buf, size);
 215                desc.bytes = size + s->vlan_header;
 216                desc.cmdstat &= ~MP_ETH_RX_OWN;
 217                s->cur_rx[i] = desc.next;
 218
 219                s->icr |= MP_ETH_IRQ_RX;
 220                if (s->icr & s->imr) {
 221                    qemu_irq_raise(s->irq);
 222                }
 223                eth_rx_desc_put(desc_addr, &desc);
 224                return size;
 225            }
 226            desc_addr = desc.next;
 227        } while (desc_addr != s->rx_queue[i]);
 228    }
 229    return size;
 230}
 231
 232static void eth_tx_desc_put(uint32_t addr, mv88w8618_tx_desc *desc)
 233{
 234    cpu_to_le32s(&desc->cmdstat);
 235    cpu_to_le16s(&desc->res);
 236    cpu_to_le16s(&desc->bytes);
 237    cpu_to_le32s(&desc->buffer);
 238    cpu_to_le32s(&desc->next);
 239    cpu_physical_memory_write(addr, desc, sizeof(*desc));
 240}
 241
 242static void eth_tx_desc_get(uint32_t addr, mv88w8618_tx_desc *desc)
 243{
 244    cpu_physical_memory_read(addr, desc, sizeof(*desc));
 245    le32_to_cpus(&desc->cmdstat);
 246    le16_to_cpus(&desc->res);
 247    le16_to_cpus(&desc->bytes);
 248    le32_to_cpus(&desc->buffer);
 249    le32_to_cpus(&desc->next);
 250}
 251
 252static void eth_send(mv88w8618_eth_state *s, int queue_index)
 253{
 254    uint32_t desc_addr = s->tx_queue[queue_index];
 255    mv88w8618_tx_desc desc;
 256    uint32_t next_desc;
 257    uint8_t buf[2048];
 258    int len;
 259
 260    do {
 261        eth_tx_desc_get(desc_addr, &desc);
 262        next_desc = desc.next;
 263        if (desc.cmdstat & MP_ETH_TX_OWN) {
 264            len = desc.bytes;
 265            if (len < 2048) {
 266                cpu_physical_memory_read(desc.buffer, buf, len);
 267                qemu_send_packet(qemu_get_queue(s->nic), buf, len);
 268            }
 269            desc.cmdstat &= ~MP_ETH_TX_OWN;
 270            s->icr |= 1 << (MP_ETH_IRQ_TXLO_BIT - queue_index);
 271            eth_tx_desc_put(desc_addr, &desc);
 272        }
 273        desc_addr = next_desc;
 274    } while (desc_addr != s->tx_queue[queue_index]);
 275}
 276
 277static uint64_t mv88w8618_eth_read(void *opaque, hwaddr offset,
 278                                   unsigned size)
 279{
 280    mv88w8618_eth_state *s = opaque;
 281
 282    switch (offset) {
 283    case MP_ETH_SMIR:
 284        if (s->smir & MP_ETH_SMIR_OPCODE) {
 285            switch (s->smir & MP_ETH_SMIR_ADDR) {
 286            case MP_ETH_PHY1_BMSR:
 287                return MP_PHY_BMSR_LINK | MP_PHY_BMSR_AUTONEG |
 288                       MP_ETH_SMIR_RDVALID;
 289            case MP_ETH_PHY1_PHYSID1:
 290                return (MP_PHY_88E3015 >> 16) | MP_ETH_SMIR_RDVALID;
 291            case MP_ETH_PHY1_PHYSID2:
 292                return (MP_PHY_88E3015 & 0xFFFF) | MP_ETH_SMIR_RDVALID;
 293            default:
 294                return MP_ETH_SMIR_RDVALID;
 295            }
 296        }
 297        return 0;
 298
 299    case MP_ETH_ICR:
 300        return s->icr;
 301
 302    case MP_ETH_IMR:
 303        return s->imr;
 304
 305    case MP_ETH_FRDP0 ... MP_ETH_FRDP3:
 306        return s->frx_queue[(offset - MP_ETH_FRDP0)/4];
 307
 308    case MP_ETH_CRDP0 ... MP_ETH_CRDP3:
 309        return s->rx_queue[(offset - MP_ETH_CRDP0)/4];
 310
 311    case MP_ETH_CTDP0 ... MP_ETH_CTDP1:
 312        return s->tx_queue[(offset - MP_ETH_CTDP0)/4];
 313
 314    default:
 315        return 0;
 316    }
 317}
 318
 319static void mv88w8618_eth_write(void *opaque, hwaddr offset,
 320                                uint64_t value, unsigned size)
 321{
 322    mv88w8618_eth_state *s = opaque;
 323
 324    switch (offset) {
 325    case MP_ETH_SMIR:
 326        s->smir = value;
 327        break;
 328
 329    case MP_ETH_PCXR:
 330        s->vlan_header = ((value >> MP_ETH_PCXR_2BSM_BIT) & 1) * 2;
 331        break;
 332
 333    case MP_ETH_SDCMR:
 334        if (value & MP_ETH_CMD_TXHI) {
 335            eth_send(s, 1);
 336        }
 337        if (value & MP_ETH_CMD_TXLO) {
 338            eth_send(s, 0);
 339        }
 340        if (value & (MP_ETH_CMD_TXHI | MP_ETH_CMD_TXLO) && s->icr & s->imr) {
 341            qemu_irq_raise(s->irq);
 342        }
 343        break;
 344
 345    case MP_ETH_ICR:
 346        s->icr &= value;
 347        break;
 348
 349    case MP_ETH_IMR:
 350        s->imr = value;
 351        if (s->icr & s->imr) {
 352            qemu_irq_raise(s->irq);
 353        }
 354        break;
 355
 356    case MP_ETH_FRDP0 ... MP_ETH_FRDP3:
 357        s->frx_queue[(offset - MP_ETH_FRDP0)/4] = value;
 358        break;
 359
 360    case MP_ETH_CRDP0 ... MP_ETH_CRDP3:
 361        s->rx_queue[(offset - MP_ETH_CRDP0)/4] =
 362            s->cur_rx[(offset - MP_ETH_CRDP0)/4] = value;
 363        break;
 364
 365    case MP_ETH_CTDP0 ... MP_ETH_CTDP1:
 366        s->tx_queue[(offset - MP_ETH_CTDP0)/4] = value;
 367        break;
 368    }
 369}
 370
 371static const MemoryRegionOps mv88w8618_eth_ops = {
 372    .read = mv88w8618_eth_read,
 373    .write = mv88w8618_eth_write,
 374    .endianness = DEVICE_NATIVE_ENDIAN,
 375};
 376
 377static void eth_cleanup(NetClientState *nc)
 378{
 379    mv88w8618_eth_state *s = qemu_get_nic_opaque(nc);
 380
 381    s->nic = NULL;
 382}
 383
 384static NetClientInfo net_mv88w8618_info = {
 385    .type = NET_CLIENT_DRIVER_NIC,
 386    .size = sizeof(NICState),
 387    .receive = eth_receive,
 388    .cleanup = eth_cleanup,
 389};
 390
 391static void mv88w8618_eth_init(Object *obj)
 392{
 393    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
 394    DeviceState *dev = DEVICE(sbd);
 395    mv88w8618_eth_state *s = MV88W8618_ETH(dev);
 396
 397    sysbus_init_irq(sbd, &s->irq);
 398    memory_region_init_io(&s->iomem, obj, &mv88w8618_eth_ops, s,
 399                          "mv88w8618-eth", MP_ETH_SIZE);
 400    sysbus_init_mmio(sbd, &s->iomem);
 401}
 402
 403static void mv88w8618_eth_realize(DeviceState *dev, Error **errp)
 404{
 405    mv88w8618_eth_state *s = MV88W8618_ETH(dev);
 406
 407    s->nic = qemu_new_nic(&net_mv88w8618_info, &s->conf,
 408                          object_get_typename(OBJECT(dev)), dev->id, s);
 409}
 410
 411static const VMStateDescription mv88w8618_eth_vmsd = {
 412    .name = "mv88w8618_eth",
 413    .version_id = 1,
 414    .minimum_version_id = 1,
 415    .fields = (VMStateField[]) {
 416        VMSTATE_UINT32(smir, mv88w8618_eth_state),
 417        VMSTATE_UINT32(icr, mv88w8618_eth_state),
 418        VMSTATE_UINT32(imr, mv88w8618_eth_state),
 419        VMSTATE_UINT32(vlan_header, mv88w8618_eth_state),
 420        VMSTATE_UINT32_ARRAY(tx_queue, mv88w8618_eth_state, 2),
 421        VMSTATE_UINT32_ARRAY(rx_queue, mv88w8618_eth_state, 4),
 422        VMSTATE_UINT32_ARRAY(frx_queue, mv88w8618_eth_state, 4),
 423        VMSTATE_UINT32_ARRAY(cur_rx, mv88w8618_eth_state, 4),
 424        VMSTATE_END_OF_LIST()
 425    }
 426};
 427
 428static Property mv88w8618_eth_properties[] = {
 429    DEFINE_NIC_PROPERTIES(mv88w8618_eth_state, conf),
 430    DEFINE_PROP_END_OF_LIST(),
 431};
 432
 433static void mv88w8618_eth_class_init(ObjectClass *klass, void *data)
 434{
 435    DeviceClass *dc = DEVICE_CLASS(klass);
 436
 437    dc->vmsd = &mv88w8618_eth_vmsd;
 438    dc->props = mv88w8618_eth_properties;
 439    dc->realize = mv88w8618_eth_realize;
 440}
 441
 442static const TypeInfo mv88w8618_eth_info = {
 443    .name          = TYPE_MV88W8618_ETH,
 444    .parent        = TYPE_SYS_BUS_DEVICE,
 445    .instance_size = sizeof(mv88w8618_eth_state),
 446    .instance_init = mv88w8618_eth_init,
 447    .class_init    = mv88w8618_eth_class_init,
 448};
 449
 450/* LCD register offsets */
 451#define MP_LCD_IRQCTRL          0x180
 452#define MP_LCD_IRQSTAT          0x184
 453#define MP_LCD_SPICTRL          0x1ac
 454#define MP_LCD_INST             0x1bc
 455#define MP_LCD_DATA             0x1c0
 456
 457/* Mode magics */
 458#define MP_LCD_SPI_DATA         0x00100011
 459#define MP_LCD_SPI_CMD          0x00104011
 460#define MP_LCD_SPI_INVALID      0x00000000
 461
 462/* Commmands */
 463#define MP_LCD_INST_SETPAGE0    0xB0
 464/* ... */
 465#define MP_LCD_INST_SETPAGE7    0xB7
 466
 467#define MP_LCD_TEXTCOLOR        0xe0e0ff /* RRGGBB */
 468
 469#define TYPE_MUSICPAL_LCD "musicpal_lcd"
 470#define MUSICPAL_LCD(obj) \
 471    OBJECT_CHECK(musicpal_lcd_state, (obj), TYPE_MUSICPAL_LCD)
 472
 473typedef struct musicpal_lcd_state {
 474    /*< private >*/
 475    SysBusDevice parent_obj;
 476    /*< public >*/
 477
 478    MemoryRegion iomem;
 479    uint32_t brightness;
 480    uint32_t mode;
 481    uint32_t irqctrl;
 482    uint32_t page;
 483    uint32_t page_off;
 484    QemuConsole *con;
 485    uint8_t video_ram[128*64/8];
 486} musicpal_lcd_state;
 487
 488static uint8_t scale_lcd_color(musicpal_lcd_state *s, uint8_t col)
 489{
 490    switch (s->brightness) {
 491    case 7:
 492        return col;
 493    case 0:
 494        return 0;
 495    default:
 496        return (col * s->brightness) / 7;
 497    }
 498}
 499
 500#define SET_LCD_PIXEL(depth, type) \
 501static inline void glue(set_lcd_pixel, depth) \
 502        (musicpal_lcd_state *s, int x, int y, type col) \
 503{ \
 504    int dx, dy; \
 505    DisplaySurface *surface = qemu_console_surface(s->con); \
 506    type *pixel = &((type *) surface_data(surface))[(y * 128 * 3 + x) * 3]; \
 507\
 508    for (dy = 0; dy < 3; dy++, pixel += 127 * 3) \
 509        for (dx = 0; dx < 3; dx++, pixel++) \
 510            *pixel = col; \
 511}
 512SET_LCD_PIXEL(8, uint8_t)
 513SET_LCD_PIXEL(16, uint16_t)
 514SET_LCD_PIXEL(32, uint32_t)
 515
 516static void lcd_refresh(void *opaque)
 517{
 518    musicpal_lcd_state *s = opaque;
 519    DisplaySurface *surface = qemu_console_surface(s->con);
 520    int x, y, col;
 521
 522    switch (surface_bits_per_pixel(surface)) {
 523    case 0:
 524        return;
 525#define LCD_REFRESH(depth, func) \
 526    case depth: \
 527        col = func(scale_lcd_color(s, (MP_LCD_TEXTCOLOR >> 16) & 0xff), \
 528                   scale_lcd_color(s, (MP_LCD_TEXTCOLOR >> 8) & 0xff), \
 529                   scale_lcd_color(s, MP_LCD_TEXTCOLOR & 0xff)); \
 530        for (x = 0; x < 128; x++) { \
 531            for (y = 0; y < 64; y++) { \
 532                if (s->video_ram[x + (y/8)*128] & (1 << (y % 8))) { \
 533                    glue(set_lcd_pixel, depth)(s, x, y, col); \
 534                } else { \
 535                    glue(set_lcd_pixel, depth)(s, x, y, 0); \
 536                } \
 537            } \
 538        } \
 539        break;
 540    LCD_REFRESH(8, rgb_to_pixel8)
 541    LCD_REFRESH(16, rgb_to_pixel16)
 542    LCD_REFRESH(32, (is_surface_bgr(surface) ?
 543                     rgb_to_pixel32bgr : rgb_to_pixel32))
 544    default:
 545        hw_error("unsupported colour depth %i\n",
 546                 surface_bits_per_pixel(surface));
 547    }
 548
 549    dpy_gfx_update(s->con, 0, 0, 128*3, 64*3);
 550}
 551
 552static void lcd_invalidate(void *opaque)
 553{
 554}
 555
 556static void musicpal_lcd_gpio_brightness_in(void *opaque, int irq, int level)
 557{
 558    musicpal_lcd_state *s = opaque;
 559    s->brightness &= ~(1 << irq);
 560    s->brightness |= level << irq;
 561}
 562
 563static uint64_t musicpal_lcd_read(void *opaque, hwaddr offset,
 564                                  unsigned size)
 565{
 566    musicpal_lcd_state *s = opaque;
 567
 568    switch (offset) {
 569    case MP_LCD_IRQCTRL:
 570        return s->irqctrl;
 571
 572    default:
 573        return 0;
 574    }
 575}
 576
 577static void musicpal_lcd_write(void *opaque, hwaddr offset,
 578                               uint64_t value, unsigned size)
 579{
 580    musicpal_lcd_state *s = opaque;
 581
 582    switch (offset) {
 583    case MP_LCD_IRQCTRL:
 584        s->irqctrl = value;
 585        break;
 586
 587    case MP_LCD_SPICTRL:
 588        if (value == MP_LCD_SPI_DATA || value == MP_LCD_SPI_CMD) {
 589            s->mode = value;
 590        } else {
 591            s->mode = MP_LCD_SPI_INVALID;
 592        }
 593        break;
 594
 595    case MP_LCD_INST:
 596        if (value >= MP_LCD_INST_SETPAGE0 && value <= MP_LCD_INST_SETPAGE7) {
 597            s->page = value - MP_LCD_INST_SETPAGE0;
 598            s->page_off = 0;
 599        }
 600        break;
 601
 602    case MP_LCD_DATA:
 603        if (s->mode == MP_LCD_SPI_CMD) {
 604            if (value >= MP_LCD_INST_SETPAGE0 &&
 605                value <= MP_LCD_INST_SETPAGE7) {
 606                s->page = value - MP_LCD_INST_SETPAGE0;
 607                s->page_off = 0;
 608            }
 609        } else if (s->mode == MP_LCD_SPI_DATA) {
 610            s->video_ram[s->page*128 + s->page_off] = value;
 611            s->page_off = (s->page_off + 1) & 127;
 612        }
 613        break;
 614    }
 615}
 616
 617static const MemoryRegionOps musicpal_lcd_ops = {
 618    .read = musicpal_lcd_read,
 619    .write = musicpal_lcd_write,
 620    .endianness = DEVICE_NATIVE_ENDIAN,
 621};
 622
 623static const GraphicHwOps musicpal_gfx_ops = {
 624    .invalidate  = lcd_invalidate,
 625    .gfx_update  = lcd_refresh,
 626};
 627
 628static void musicpal_lcd_realize(DeviceState *dev, Error **errp)
 629{
 630    musicpal_lcd_state *s = MUSICPAL_LCD(dev);
 631    s->con = graphic_console_init(dev, 0, &musicpal_gfx_ops, s);
 632    qemu_console_resize(s->con, 128 * 3, 64 * 3);
 633}
 634
 635static void musicpal_lcd_init(Object *obj)
 636{
 637    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
 638    DeviceState *dev = DEVICE(sbd);
 639    musicpal_lcd_state *s = MUSICPAL_LCD(dev);
 640
 641    s->brightness = 7;
 642
 643    memory_region_init_io(&s->iomem, obj, &musicpal_lcd_ops, s,
 644                          "musicpal-lcd", MP_LCD_SIZE);
 645    sysbus_init_mmio(sbd, &s->iomem);
 646
 647    qdev_init_gpio_in(dev, musicpal_lcd_gpio_brightness_in, 3);
 648}
 649
 650static const VMStateDescription musicpal_lcd_vmsd = {
 651    .name = "musicpal_lcd",
 652    .version_id = 1,
 653    .minimum_version_id = 1,
 654    .fields = (VMStateField[]) {
 655        VMSTATE_UINT32(brightness, musicpal_lcd_state),
 656        VMSTATE_UINT32(mode, musicpal_lcd_state),
 657        VMSTATE_UINT32(irqctrl, musicpal_lcd_state),
 658        VMSTATE_UINT32(page, musicpal_lcd_state),
 659        VMSTATE_UINT32(page_off, musicpal_lcd_state),
 660        VMSTATE_BUFFER(video_ram, musicpal_lcd_state),
 661        VMSTATE_END_OF_LIST()
 662    }
 663};
 664
 665static void musicpal_lcd_class_init(ObjectClass *klass, void *data)
 666{
 667    DeviceClass *dc = DEVICE_CLASS(klass);
 668
 669    dc->vmsd = &musicpal_lcd_vmsd;
 670    dc->realize = musicpal_lcd_realize;
 671}
 672
 673static const TypeInfo musicpal_lcd_info = {
 674    .name          = TYPE_MUSICPAL_LCD,
 675    .parent        = TYPE_SYS_BUS_DEVICE,
 676    .instance_size = sizeof(musicpal_lcd_state),
 677    .instance_init = musicpal_lcd_init,
 678    .class_init    = musicpal_lcd_class_init,
 679};
 680
 681/* PIC register offsets */
 682#define MP_PIC_STATUS           0x00
 683#define MP_PIC_ENABLE_SET       0x08
 684#define MP_PIC_ENABLE_CLR       0x0C
 685
 686#define TYPE_MV88W8618_PIC "mv88w8618_pic"
 687#define MV88W8618_PIC(obj) \
 688    OBJECT_CHECK(mv88w8618_pic_state, (obj), TYPE_MV88W8618_PIC)
 689
 690typedef struct mv88w8618_pic_state {
 691    /*< private >*/
 692    SysBusDevice parent_obj;
 693    /*< public >*/
 694
 695    MemoryRegion iomem;
 696    uint32_t level;
 697    uint32_t enabled;
 698    qemu_irq parent_irq;
 699} mv88w8618_pic_state;
 700
 701static void mv88w8618_pic_update(mv88w8618_pic_state *s)
 702{
 703    qemu_set_irq(s->parent_irq, (s->level & s->enabled));
 704}
 705
 706static void mv88w8618_pic_set_irq(void *opaque, int irq, int level)
 707{
 708    mv88w8618_pic_state *s = opaque;
 709
 710    if (level) {
 711        s->level |= 1 << irq;
 712    } else {
 713        s->level &= ~(1 << irq);
 714    }
 715    mv88w8618_pic_update(s);
 716}
 717
 718static uint64_t mv88w8618_pic_read(void *opaque, hwaddr offset,
 719                                   unsigned size)
 720{
 721    mv88w8618_pic_state *s = opaque;
 722
 723    switch (offset) {
 724    case MP_PIC_STATUS:
 725        return s->level & s->enabled;
 726
 727    default:
 728        return 0;
 729    }
 730}
 731
 732static void mv88w8618_pic_write(void *opaque, hwaddr offset,
 733                                uint64_t value, unsigned size)
 734{
 735    mv88w8618_pic_state *s = opaque;
 736
 737    switch (offset) {
 738    case MP_PIC_ENABLE_SET:
 739        s->enabled |= value;
 740        break;
 741
 742    case MP_PIC_ENABLE_CLR:
 743        s->enabled &= ~value;
 744        s->level &= ~value;
 745        break;
 746    }
 747    mv88w8618_pic_update(s);
 748}
 749
 750static void mv88w8618_pic_reset(DeviceState *d)
 751{
 752    mv88w8618_pic_state *s = MV88W8618_PIC(d);
 753
 754    s->level = 0;
 755    s->enabled = 0;
 756}
 757
 758static const MemoryRegionOps mv88w8618_pic_ops = {
 759    .read = mv88w8618_pic_read,
 760    .write = mv88w8618_pic_write,
 761    .endianness = DEVICE_NATIVE_ENDIAN,
 762};
 763
 764static void mv88w8618_pic_init(Object *obj)
 765{
 766    SysBusDevice *dev = SYS_BUS_DEVICE(obj);
 767    mv88w8618_pic_state *s = MV88W8618_PIC(dev);
 768
 769    qdev_init_gpio_in(DEVICE(dev), mv88w8618_pic_set_irq, 32);
 770    sysbus_init_irq(dev, &s->parent_irq);
 771    memory_region_init_io(&s->iomem, obj, &mv88w8618_pic_ops, s,
 772                          "musicpal-pic", MP_PIC_SIZE);
 773    sysbus_init_mmio(dev, &s->iomem);
 774}
 775
 776static const VMStateDescription mv88w8618_pic_vmsd = {
 777    .name = "mv88w8618_pic",
 778    .version_id = 1,
 779    .minimum_version_id = 1,
 780    .fields = (VMStateField[]) {
 781        VMSTATE_UINT32(level, mv88w8618_pic_state),
 782        VMSTATE_UINT32(enabled, mv88w8618_pic_state),
 783        VMSTATE_END_OF_LIST()
 784    }
 785};
 786
 787static void mv88w8618_pic_class_init(ObjectClass *klass, void *data)
 788{
 789    DeviceClass *dc = DEVICE_CLASS(klass);
 790
 791    dc->reset = mv88w8618_pic_reset;
 792    dc->vmsd = &mv88w8618_pic_vmsd;
 793}
 794
 795static const TypeInfo mv88w8618_pic_info = {
 796    .name          = TYPE_MV88W8618_PIC,
 797    .parent        = TYPE_SYS_BUS_DEVICE,
 798    .instance_size = sizeof(mv88w8618_pic_state),
 799    .instance_init = mv88w8618_pic_init,
 800    .class_init    = mv88w8618_pic_class_init,
 801};
 802
 803/* PIT register offsets */
 804#define MP_PIT_TIMER1_LENGTH    0x00
 805/* ... */
 806#define MP_PIT_TIMER4_LENGTH    0x0C
 807#define MP_PIT_CONTROL          0x10
 808#define MP_PIT_TIMER1_VALUE     0x14
 809/* ... */
 810#define MP_PIT_TIMER4_VALUE     0x20
 811#define MP_BOARD_RESET          0x34
 812
 813/* Magic board reset value (probably some watchdog behind it) */
 814#define MP_BOARD_RESET_MAGIC    0x10000
 815
 816typedef struct mv88w8618_timer_state {
 817    ptimer_state *ptimer;
 818    uint32_t limit;
 819    int freq;
 820    qemu_irq irq;
 821} mv88w8618_timer_state;
 822
 823#define TYPE_MV88W8618_PIT "mv88w8618_pit"
 824#define MV88W8618_PIT(obj) \
 825    OBJECT_CHECK(mv88w8618_pit_state, (obj), TYPE_MV88W8618_PIT)
 826
 827typedef struct mv88w8618_pit_state {
 828    /*< private >*/
 829    SysBusDevice parent_obj;
 830    /*< public >*/
 831
 832    MemoryRegion iomem;
 833    mv88w8618_timer_state timer[4];
 834} mv88w8618_pit_state;
 835
 836static void mv88w8618_timer_tick(void *opaque)
 837{
 838    mv88w8618_timer_state *s = opaque;
 839
 840    qemu_irq_raise(s->irq);
 841}
 842
 843static void mv88w8618_timer_init(SysBusDevice *dev, mv88w8618_timer_state *s,
 844                                 uint32_t freq)
 845{
 846    sysbus_init_irq(dev, &s->irq);
 847    s->freq = freq;
 848
 849    s->ptimer = ptimer_init(mv88w8618_timer_tick, s, PTIMER_POLICY_DEFAULT);
 850}
 851
 852static uint64_t mv88w8618_pit_read(void *opaque, hwaddr offset,
 853                                   unsigned size)
 854{
 855    mv88w8618_pit_state *s = opaque;
 856    mv88w8618_timer_state *t;
 857
 858    switch (offset) {
 859    case MP_PIT_TIMER1_VALUE ... MP_PIT_TIMER4_VALUE:
 860        t = &s->timer[(offset-MP_PIT_TIMER1_VALUE) >> 2];
 861        return ptimer_get_count(t->ptimer);
 862
 863    default:
 864        return 0;
 865    }
 866}
 867
 868static void mv88w8618_pit_write(void *opaque, hwaddr offset,
 869                                uint64_t value, unsigned size)
 870{
 871    mv88w8618_pit_state *s = opaque;
 872    mv88w8618_timer_state *t;
 873    int i;
 874
 875    switch (offset) {
 876    case MP_PIT_TIMER1_LENGTH ... MP_PIT_TIMER4_LENGTH:
 877        t = &s->timer[offset >> 2];
 878        t->limit = value;
 879        ptimer_transaction_begin(t->ptimer);
 880        if (t->limit > 0) {
 881            ptimer_set_limit(t->ptimer, t->limit, 1);
 882        } else {
 883            ptimer_stop(t->ptimer);
 884        }
 885        ptimer_transaction_commit(t->ptimer);
 886        break;
 887
 888    case MP_PIT_CONTROL:
 889        for (i = 0; i < 4; i++) {
 890            t = &s->timer[i];
 891            ptimer_transaction_begin(t->ptimer);
 892            if (value & 0xf && t->limit > 0) {
 893                ptimer_set_limit(t->ptimer, t->limit, 0);
 894                ptimer_set_freq(t->ptimer, t->freq);
 895                ptimer_run(t->ptimer, 0);
 896            } else {
 897                ptimer_stop(t->ptimer);
 898            }
 899            ptimer_transaction_commit(t->ptimer);
 900            value >>= 4;
 901        }
 902        break;
 903
 904    case MP_BOARD_RESET:
 905        if (value == MP_BOARD_RESET_MAGIC) {
 906            qemu_system_reset_request(SHUTDOWN_CAUSE_GUEST_RESET);
 907        }
 908        break;
 909    }
 910}
 911
 912static void mv88w8618_pit_reset(DeviceState *d)
 913{
 914    mv88w8618_pit_state *s = MV88W8618_PIT(d);
 915    int i;
 916
 917    for (i = 0; i < 4; i++) {
 918        mv88w8618_timer_state *t = &s->timer[i];
 919        ptimer_transaction_begin(t->ptimer);
 920        ptimer_stop(t->ptimer);
 921        ptimer_transaction_commit(t->ptimer);
 922        t->limit = 0;
 923    }
 924}
 925
 926static const MemoryRegionOps mv88w8618_pit_ops = {
 927    .read = mv88w8618_pit_read,
 928    .write = mv88w8618_pit_write,
 929    .endianness = DEVICE_NATIVE_ENDIAN,
 930};
 931
 932static void mv88w8618_pit_init(Object *obj)
 933{
 934    SysBusDevice *dev = SYS_BUS_DEVICE(obj);
 935    mv88w8618_pit_state *s = MV88W8618_PIT(dev);
 936    int i;
 937
 938    /* Letting them all run at 1 MHz is likely just a pragmatic
 939     * simplification. */
 940    for (i = 0; i < 4; i++) {
 941        mv88w8618_timer_init(dev, &s->timer[i], 1000000);
 942    }
 943
 944    memory_region_init_io(&s->iomem, obj, &mv88w8618_pit_ops, s,
 945                          "musicpal-pit", MP_PIT_SIZE);
 946    sysbus_init_mmio(dev, &s->iomem);
 947}
 948
 949static const VMStateDescription mv88w8618_timer_vmsd = {
 950    .name = "timer",
 951    .version_id = 1,
 952    .minimum_version_id = 1,
 953    .fields = (VMStateField[]) {
 954        VMSTATE_PTIMER(ptimer, mv88w8618_timer_state),
 955        VMSTATE_UINT32(limit, mv88w8618_timer_state),
 956        VMSTATE_END_OF_LIST()
 957    }
 958};
 959
 960static const VMStateDescription mv88w8618_pit_vmsd = {
 961    .name = "mv88w8618_pit",
 962    .version_id = 1,
 963    .minimum_version_id = 1,
 964    .fields = (VMStateField[]) {
 965        VMSTATE_STRUCT_ARRAY(timer, mv88w8618_pit_state, 4, 1,
 966                             mv88w8618_timer_vmsd, mv88w8618_timer_state),
 967        VMSTATE_END_OF_LIST()
 968    }
 969};
 970
 971static void mv88w8618_pit_class_init(ObjectClass *klass, void *data)
 972{
 973    DeviceClass *dc = DEVICE_CLASS(klass);
 974
 975    dc->reset = mv88w8618_pit_reset;
 976    dc->vmsd = &mv88w8618_pit_vmsd;
 977}
 978
 979static const TypeInfo mv88w8618_pit_info = {
 980    .name          = TYPE_MV88W8618_PIT,
 981    .parent        = TYPE_SYS_BUS_DEVICE,
 982    .instance_size = sizeof(mv88w8618_pit_state),
 983    .instance_init = mv88w8618_pit_init,
 984    .class_init    = mv88w8618_pit_class_init,
 985};
 986
 987/* Flash config register offsets */
 988#define MP_FLASHCFG_CFGR0    0x04
 989
 990#define TYPE_MV88W8618_FLASHCFG "mv88w8618_flashcfg"
 991#define MV88W8618_FLASHCFG(obj) \
 992    OBJECT_CHECK(mv88w8618_flashcfg_state, (obj), TYPE_MV88W8618_FLASHCFG)
 993
 994typedef struct mv88w8618_flashcfg_state {
 995    /*< private >*/
 996    SysBusDevice parent_obj;
 997    /*< public >*/
 998
 999    MemoryRegion iomem;
1000    uint32_t cfgr0;
1001} mv88w8618_flashcfg_state;
1002
1003static uint64_t mv88w8618_flashcfg_read(void *opaque,
1004                                        hwaddr offset,
1005                                        unsigned size)
1006{
1007    mv88w8618_flashcfg_state *s = opaque;
1008
1009    switch (offset) {
1010    case MP_FLASHCFG_CFGR0:
1011        return s->cfgr0;
1012
1013    default:
1014        return 0;
1015    }
1016}
1017
1018static void mv88w8618_flashcfg_write(void *opaque, hwaddr offset,
1019                                     uint64_t value, unsigned size)
1020{
1021    mv88w8618_flashcfg_state *s = opaque;
1022
1023    switch (offset) {
1024    case MP_FLASHCFG_CFGR0:
1025        s->cfgr0 = value;
1026        break;
1027    }
1028}
1029
1030static const MemoryRegionOps mv88w8618_flashcfg_ops = {
1031    .read = mv88w8618_flashcfg_read,
1032    .write = mv88w8618_flashcfg_write,
1033    .endianness = DEVICE_NATIVE_ENDIAN,
1034};
1035
1036static void mv88w8618_flashcfg_init(Object *obj)
1037{
1038    SysBusDevice *dev = SYS_BUS_DEVICE(obj);
1039    mv88w8618_flashcfg_state *s = MV88W8618_FLASHCFG(dev);
1040
1041    s->cfgr0 = 0xfffe4285; /* Default as set by U-Boot for 8 MB flash */
1042    memory_region_init_io(&s->iomem, obj, &mv88w8618_flashcfg_ops, s,
1043                          "musicpal-flashcfg", MP_FLASHCFG_SIZE);
1044    sysbus_init_mmio(dev, &s->iomem);
1045}
1046
1047static const VMStateDescription mv88w8618_flashcfg_vmsd = {
1048    .name = "mv88w8618_flashcfg",
1049    .version_id = 1,
1050    .minimum_version_id = 1,
1051    .fields = (VMStateField[]) {
1052        VMSTATE_UINT32(cfgr0, mv88w8618_flashcfg_state),
1053        VMSTATE_END_OF_LIST()
1054    }
1055};
1056
1057static void mv88w8618_flashcfg_class_init(ObjectClass *klass, void *data)
1058{
1059    DeviceClass *dc = DEVICE_CLASS(klass);
1060
1061    dc->vmsd = &mv88w8618_flashcfg_vmsd;
1062}
1063
1064static const TypeInfo mv88w8618_flashcfg_info = {
1065    .name          = TYPE_MV88W8618_FLASHCFG,
1066    .parent        = TYPE_SYS_BUS_DEVICE,
1067    .instance_size = sizeof(mv88w8618_flashcfg_state),
1068    .instance_init = mv88w8618_flashcfg_init,
1069    .class_init    = mv88w8618_flashcfg_class_init,
1070};
1071
1072/* Misc register offsets */
1073#define MP_MISC_BOARD_REVISION  0x18
1074
1075#define MP_BOARD_REVISION       0x31
1076
1077typedef struct {
1078    SysBusDevice parent_obj;
1079    MemoryRegion iomem;
1080} MusicPalMiscState;
1081
1082#define TYPE_MUSICPAL_MISC "musicpal-misc"
1083#define MUSICPAL_MISC(obj) \
1084     OBJECT_CHECK(MusicPalMiscState, (obj), TYPE_MUSICPAL_MISC)
1085
1086static uint64_t musicpal_misc_read(void *opaque, hwaddr offset,
1087                                   unsigned size)
1088{
1089    switch (offset) {
1090    case MP_MISC_BOARD_REVISION:
1091        return MP_BOARD_REVISION;
1092
1093    default:
1094        return 0;
1095    }
1096}
1097
1098static void musicpal_misc_write(void *opaque, hwaddr offset,
1099                                uint64_t value, unsigned size)
1100{
1101}
1102
1103static const MemoryRegionOps musicpal_misc_ops = {
1104    .read = musicpal_misc_read,
1105    .write = musicpal_misc_write,
1106    .endianness = DEVICE_NATIVE_ENDIAN,
1107};
1108
1109static void musicpal_misc_init(Object *obj)
1110{
1111    SysBusDevice *sd = SYS_BUS_DEVICE(obj);
1112    MusicPalMiscState *s = MUSICPAL_MISC(obj);
1113
1114    memory_region_init_io(&s->iomem, OBJECT(s), &musicpal_misc_ops, NULL,
1115                          "musicpal-misc", MP_MISC_SIZE);
1116    sysbus_init_mmio(sd, &s->iomem);
1117}
1118
1119static const TypeInfo musicpal_misc_info = {
1120    .name = TYPE_MUSICPAL_MISC,
1121    .parent = TYPE_SYS_BUS_DEVICE,
1122    .instance_init = musicpal_misc_init,
1123    .instance_size = sizeof(MusicPalMiscState),
1124};
1125
1126/* WLAN register offsets */
1127#define MP_WLAN_MAGIC1          0x11c
1128#define MP_WLAN_MAGIC2          0x124
1129
1130static uint64_t mv88w8618_wlan_read(void *opaque, hwaddr offset,
1131                                    unsigned size)
1132{
1133    switch (offset) {
1134    /* Workaround to allow loading the binary-only wlandrv.ko crap
1135     * from the original Freecom firmware. */
1136    case MP_WLAN_MAGIC1:
1137        return ~3;
1138    case MP_WLAN_MAGIC2:
1139        return -1;
1140
1141    default:
1142        return 0;
1143    }
1144}
1145
1146static void mv88w8618_wlan_write(void *opaque, hwaddr offset,
1147                                 uint64_t value, unsigned size)
1148{
1149}
1150
1151static const MemoryRegionOps mv88w8618_wlan_ops = {
1152    .read = mv88w8618_wlan_read,
1153    .write =mv88w8618_wlan_write,
1154    .endianness = DEVICE_NATIVE_ENDIAN,
1155};
1156
1157static void mv88w8618_wlan_realize(DeviceState *dev, Error **errp)
1158{
1159    MemoryRegion *iomem = g_new(MemoryRegion, 1);
1160
1161    memory_region_init_io(iomem, OBJECT(dev), &mv88w8618_wlan_ops, NULL,
1162                          "musicpal-wlan", MP_WLAN_SIZE);
1163    sysbus_init_mmio(SYS_BUS_DEVICE(dev), iomem);
1164}
1165
1166/* GPIO register offsets */
1167#define MP_GPIO_OE_LO           0x008
1168#define MP_GPIO_OUT_LO          0x00c
1169#define MP_GPIO_IN_LO           0x010
1170#define MP_GPIO_IER_LO          0x014
1171#define MP_GPIO_IMR_LO          0x018
1172#define MP_GPIO_ISR_LO          0x020
1173#define MP_GPIO_OE_HI           0x508
1174#define MP_GPIO_OUT_HI          0x50c
1175#define MP_GPIO_IN_HI           0x510
1176#define MP_GPIO_IER_HI          0x514
1177#define MP_GPIO_IMR_HI          0x518
1178#define MP_GPIO_ISR_HI          0x520
1179
1180/* GPIO bits & masks */
1181#define MP_GPIO_LCD_BRIGHTNESS  0x00070000
1182#define MP_GPIO_I2C_DATA_BIT    29
1183#define MP_GPIO_I2C_CLOCK_BIT   30
1184
1185/* LCD brightness bits in GPIO_OE_HI */
1186#define MP_OE_LCD_BRIGHTNESS    0x0007
1187
1188#define TYPE_MUSICPAL_GPIO "musicpal_gpio"
1189#define MUSICPAL_GPIO(obj) \
1190    OBJECT_CHECK(musicpal_gpio_state, (obj), TYPE_MUSICPAL_GPIO)
1191
1192typedef struct musicpal_gpio_state {
1193    /*< private >*/
1194    SysBusDevice parent_obj;
1195    /*< public >*/
1196
1197    MemoryRegion iomem;
1198    uint32_t lcd_brightness;
1199    uint32_t out_state;
1200    uint32_t in_state;
1201    uint32_t ier;
1202    uint32_t imr;
1203    uint32_t isr;
1204    qemu_irq irq;
1205    qemu_irq out[5]; /* 3 brightness out + 2 lcd (data and clock ) */
1206} musicpal_gpio_state;
1207
1208static void musicpal_gpio_brightness_update(musicpal_gpio_state *s) {
1209    int i;
1210    uint32_t brightness;
1211
1212    /* compute brightness ratio */
1213    switch (s->lcd_brightness) {
1214    case 0x00000007:
1215        brightness = 0;
1216        break;
1217
1218    case 0x00020000:
1219        brightness = 1;
1220        break;
1221
1222    case 0x00020001:
1223        brightness = 2;
1224        break;
1225
1226    case 0x00040000:
1227        brightness = 3;
1228        break;
1229
1230    case 0x00010006:
1231        brightness = 4;
1232        break;
1233
1234    case 0x00020005:
1235        brightness = 5;
1236        break;
1237
1238    case 0x00040003:
1239        brightness = 6;
1240        break;
1241
1242    case 0x00030004:
1243    default:
1244        brightness = 7;
1245    }
1246
1247    /* set lcd brightness GPIOs  */
1248    for (i = 0; i <= 2; i++) {
1249        qemu_set_irq(s->out[i], (brightness >> i) & 1);
1250    }
1251}
1252
1253static void musicpal_gpio_pin_event(void *opaque, int pin, int level)
1254{
1255    musicpal_gpio_state *s = opaque;
1256    uint32_t mask = 1 << pin;
1257    uint32_t delta = level << pin;
1258    uint32_t old = s->in_state & mask;
1259
1260    s->in_state &= ~mask;
1261    s->in_state |= delta;
1262
1263    if ((old ^ delta) &&
1264        ((level && (s->imr & mask)) || (!level && (s->ier & mask)))) {
1265        s->isr = mask;
1266        qemu_irq_raise(s->irq);
1267    }
1268}
1269
1270static uint64_t musicpal_gpio_read(void *opaque, hwaddr offset,
1271                                   unsigned size)
1272{
1273    musicpal_gpio_state *s = opaque;
1274
1275    switch (offset) {
1276    case MP_GPIO_OE_HI: /* used for LCD brightness control */
1277        return s->lcd_brightness & MP_OE_LCD_BRIGHTNESS;
1278
1279    case MP_GPIO_OUT_LO:
1280        return s->out_state & 0xFFFF;
1281    case MP_GPIO_OUT_HI:
1282        return s->out_state >> 16;
1283
1284    case MP_GPIO_IN_LO:
1285        return s->in_state & 0xFFFF;
1286    case MP_GPIO_IN_HI:
1287        return s->in_state >> 16;
1288
1289    case MP_GPIO_IER_LO:
1290        return s->ier & 0xFFFF;
1291    case MP_GPIO_IER_HI:
1292        return s->ier >> 16;
1293
1294    case MP_GPIO_IMR_LO:
1295        return s->imr & 0xFFFF;
1296    case MP_GPIO_IMR_HI:
1297        return s->imr >> 16;
1298
1299    case MP_GPIO_ISR_LO:
1300        return s->isr & 0xFFFF;
1301    case MP_GPIO_ISR_HI:
1302        return s->isr >> 16;
1303
1304    default:
1305        return 0;
1306    }
1307}
1308
1309static void musicpal_gpio_write(void *opaque, hwaddr offset,
1310                                uint64_t value, unsigned size)
1311{
1312    musicpal_gpio_state *s = opaque;
1313    switch (offset) {
1314    case MP_GPIO_OE_HI: /* used for LCD brightness control */
1315        s->lcd_brightness = (s->lcd_brightness & MP_GPIO_LCD_BRIGHTNESS) |
1316                         (value & MP_OE_LCD_BRIGHTNESS);
1317        musicpal_gpio_brightness_update(s);
1318        break;
1319
1320    case MP_GPIO_OUT_LO:
1321        s->out_state = (s->out_state & 0xFFFF0000) | (value & 0xFFFF);
1322        break;
1323    case MP_GPIO_OUT_HI:
1324        s->out_state = (s->out_state & 0xFFFF) | (value << 16);
1325        s->lcd_brightness = (s->lcd_brightness & 0xFFFF) |
1326                            (s->out_state & MP_GPIO_LCD_BRIGHTNESS);
1327        musicpal_gpio_brightness_update(s);
1328        qemu_set_irq(s->out[3], (s->out_state >> MP_GPIO_I2C_DATA_BIT) & 1);
1329        qemu_set_irq(s->out[4], (s->out_state >> MP_GPIO_I2C_CLOCK_BIT) & 1);
1330        break;
1331
1332    case MP_GPIO_IER_LO:
1333        s->ier = (s->ier & 0xFFFF0000) | (value & 0xFFFF);
1334        break;
1335    case MP_GPIO_IER_HI:
1336        s->ier = (s->ier & 0xFFFF) | (value << 16);
1337        break;
1338
1339    case MP_GPIO_IMR_LO:
1340        s->imr = (s->imr & 0xFFFF0000) | (value & 0xFFFF);
1341        break;
1342    case MP_GPIO_IMR_HI:
1343        s->imr = (s->imr & 0xFFFF) | (value << 16);
1344        break;
1345    }
1346}
1347
1348static const MemoryRegionOps musicpal_gpio_ops = {
1349    .read = musicpal_gpio_read,
1350    .write = musicpal_gpio_write,
1351    .endianness = DEVICE_NATIVE_ENDIAN,
1352};
1353
1354static void musicpal_gpio_reset(DeviceState *d)
1355{
1356    musicpal_gpio_state *s = MUSICPAL_GPIO(d);
1357
1358    s->lcd_brightness = 0;
1359    s->out_state = 0;
1360    s->in_state = 0xffffffff;
1361    s->ier = 0;
1362    s->imr = 0;
1363    s->isr = 0;
1364}
1365
1366static void musicpal_gpio_init(Object *obj)
1367{
1368    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
1369    DeviceState *dev = DEVICE(sbd);
1370    musicpal_gpio_state *s = MUSICPAL_GPIO(dev);
1371
1372    sysbus_init_irq(sbd, &s->irq);
1373
1374    memory_region_init_io(&s->iomem, obj, &musicpal_gpio_ops, s,
1375                          "musicpal-gpio", MP_GPIO_SIZE);
1376    sysbus_init_mmio(sbd, &s->iomem);
1377
1378    qdev_init_gpio_out(dev, s->out, ARRAY_SIZE(s->out));
1379
1380    qdev_init_gpio_in(dev, musicpal_gpio_pin_event, 32);
1381}
1382
1383static const VMStateDescription musicpal_gpio_vmsd = {
1384    .name = "musicpal_gpio",
1385    .version_id = 1,
1386    .minimum_version_id = 1,
1387    .fields = (VMStateField[]) {
1388        VMSTATE_UINT32(lcd_brightness, musicpal_gpio_state),
1389        VMSTATE_UINT32(out_state, musicpal_gpio_state),
1390        VMSTATE_UINT32(in_state, musicpal_gpio_state),
1391        VMSTATE_UINT32(ier, musicpal_gpio_state),
1392        VMSTATE_UINT32(imr, musicpal_gpio_state),
1393        VMSTATE_UINT32(isr, musicpal_gpio_state),
1394        VMSTATE_END_OF_LIST()
1395    }
1396};
1397
1398static void musicpal_gpio_class_init(ObjectClass *klass, void *data)
1399{
1400    DeviceClass *dc = DEVICE_CLASS(klass);
1401
1402    dc->reset = musicpal_gpio_reset;
1403    dc->vmsd = &musicpal_gpio_vmsd;
1404}
1405
1406static const TypeInfo musicpal_gpio_info = {
1407    .name          = TYPE_MUSICPAL_GPIO,
1408    .parent        = TYPE_SYS_BUS_DEVICE,
1409    .instance_size = sizeof(musicpal_gpio_state),
1410    .instance_init = musicpal_gpio_init,
1411    .class_init    = musicpal_gpio_class_init,
1412};
1413
1414/* Keyboard codes & masks */
1415#define KEY_RELEASED            0x80
1416#define KEY_CODE                0x7f
1417
1418#define KEYCODE_TAB             0x0f
1419#define KEYCODE_ENTER           0x1c
1420#define KEYCODE_F               0x21
1421#define KEYCODE_M               0x32
1422
1423#define KEYCODE_EXTENDED        0xe0
1424#define KEYCODE_UP              0x48
1425#define KEYCODE_DOWN            0x50
1426#define KEYCODE_LEFT            0x4b
1427#define KEYCODE_RIGHT           0x4d
1428
1429#define MP_KEY_WHEEL_VOL       (1 << 0)
1430#define MP_KEY_WHEEL_VOL_INV   (1 << 1)
1431#define MP_KEY_WHEEL_NAV       (1 << 2)
1432#define MP_KEY_WHEEL_NAV_INV   (1 << 3)
1433#define MP_KEY_BTN_FAVORITS    (1 << 4)
1434#define MP_KEY_BTN_MENU        (1 << 5)
1435#define MP_KEY_BTN_VOLUME      (1 << 6)
1436#define MP_KEY_BTN_NAVIGATION  (1 << 7)
1437
1438#define TYPE_MUSICPAL_KEY "musicpal_key"
1439#define MUSICPAL_KEY(obj) \
1440    OBJECT_CHECK(musicpal_key_state, (obj), TYPE_MUSICPAL_KEY)
1441
1442typedef struct musicpal_key_state {
1443    /*< private >*/
1444    SysBusDevice parent_obj;
1445    /*< public >*/
1446
1447    MemoryRegion iomem;
1448    uint32_t kbd_extended;
1449    uint32_t pressed_keys;
1450    qemu_irq out[8];
1451} musicpal_key_state;
1452
1453static void musicpal_key_event(void *opaque, int keycode)
1454{
1455    musicpal_key_state *s = opaque;
1456    uint32_t event = 0;
1457    int i;
1458
1459    if (keycode == KEYCODE_EXTENDED) {
1460        s->kbd_extended = 1;
1461        return;
1462    }
1463
1464    if (s->kbd_extended) {
1465        switch (keycode & KEY_CODE) {
1466        case KEYCODE_UP:
1467            event = MP_KEY_WHEEL_NAV | MP_KEY_WHEEL_NAV_INV;
1468            break;
1469
1470        case KEYCODE_DOWN:
1471            event = MP_KEY_WHEEL_NAV;
1472            break;
1473
1474        case KEYCODE_LEFT:
1475            event = MP_KEY_WHEEL_VOL | MP_KEY_WHEEL_VOL_INV;
1476            break;
1477
1478        case KEYCODE_RIGHT:
1479            event = MP_KEY_WHEEL_VOL;
1480            break;
1481        }
1482    } else {
1483        switch (keycode & KEY_CODE) {
1484        case KEYCODE_F:
1485            event = MP_KEY_BTN_FAVORITS;
1486            break;
1487
1488        case KEYCODE_TAB:
1489            event = MP_KEY_BTN_VOLUME;
1490            break;
1491
1492        case KEYCODE_ENTER:
1493            event = MP_KEY_BTN_NAVIGATION;
1494            break;
1495
1496        case KEYCODE_M:
1497            event = MP_KEY_BTN_MENU;
1498            break;
1499        }
1500        /* Do not repeat already pressed buttons */
1501        if (!(keycode & KEY_RELEASED) && (s->pressed_keys & event)) {
1502            event = 0;
1503        }
1504    }
1505
1506    if (event) {
1507        /* Raise GPIO pin first if repeating a key */
1508        if (!(keycode & KEY_RELEASED) && (s->pressed_keys & event)) {
1509            for (i = 0; i <= 7; i++) {
1510                if (event & (1 << i)) {
1511                    qemu_set_irq(s->out[i], 1);
1512                }
1513            }
1514        }
1515        for (i = 0; i <= 7; i++) {
1516            if (event & (1 << i)) {
1517                qemu_set_irq(s->out[i], !!(keycode & KEY_RELEASED));
1518            }
1519        }
1520        if (keycode & KEY_RELEASED) {
1521            s->pressed_keys &= ~event;
1522        } else {
1523            s->pressed_keys |= event;
1524        }
1525    }
1526
1527    s->kbd_extended = 0;
1528}
1529
1530static void musicpal_key_init(Object *obj)
1531{
1532    SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
1533    DeviceState *dev = DEVICE(sbd);
1534    musicpal_key_state *s = MUSICPAL_KEY(dev);
1535
1536    memory_region_init(&s->iomem, obj, "dummy", 0);
1537    sysbus_init_mmio(sbd, &s->iomem);
1538
1539    s->kbd_extended = 0;
1540    s->pressed_keys = 0;
1541
1542    qdev_init_gpio_out(dev, s->out, ARRAY_SIZE(s->out));
1543
1544    qemu_add_kbd_event_handler(musicpal_key_event, s);
1545}
1546
1547static const VMStateDescription musicpal_key_vmsd = {
1548    .name = "musicpal_key",
1549    .version_id = 1,
1550    .minimum_version_id = 1,
1551    .fields = (VMStateField[]) {
1552        VMSTATE_UINT32(kbd_extended, musicpal_key_state),
1553        VMSTATE_UINT32(pressed_keys, musicpal_key_state),
1554        VMSTATE_END_OF_LIST()
1555    }
1556};
1557
1558static void musicpal_key_class_init(ObjectClass *klass, void *data)
1559{
1560    DeviceClass *dc = DEVICE_CLASS(klass);
1561
1562    dc->vmsd = &musicpal_key_vmsd;
1563}
1564
1565static const TypeInfo musicpal_key_info = {
1566    .name          = TYPE_MUSICPAL_KEY,
1567    .parent        = TYPE_SYS_BUS_DEVICE,
1568    .instance_size = sizeof(musicpal_key_state),
1569    .instance_init = musicpal_key_init,
1570    .class_init    = musicpal_key_class_init,
1571};
1572
1573static struct arm_boot_info musicpal_binfo = {
1574    .loader_start = 0x0,
1575    .board_id = 0x20e,
1576};
1577
1578static void musicpal_init(MachineState *machine)
1579{
1580    ARMCPU *cpu;
1581    qemu_irq pic[32];
1582    DeviceState *dev;
1583    DeviceState *i2c_dev;
1584    DeviceState *lcd_dev;
1585    DeviceState *key_dev;
1586    DeviceState *wm8750_dev;
1587    SysBusDevice *s;
1588    I2CBus *i2c;
1589    int i;
1590    unsigned long flash_size;
1591    DriveInfo *dinfo;
1592    MemoryRegion *address_space_mem = get_system_memory();
1593    MemoryRegion *ram = g_new(MemoryRegion, 1);
1594    MemoryRegion *sram = g_new(MemoryRegion, 1);
1595
1596    cpu = ARM_CPU(cpu_create(machine->cpu_type));
1597
1598    /* For now we use a fixed - the original - RAM size */
1599    memory_region_allocate_system_memory(ram, NULL, "musicpal.ram",
1600                                         MP_RAM_DEFAULT_SIZE);
1601    memory_region_add_subregion(address_space_mem, 0, ram);
1602
1603    memory_region_init_ram(sram, NULL, "musicpal.sram", MP_SRAM_SIZE,
1604                           &error_fatal);
1605    memory_region_add_subregion(address_space_mem, MP_SRAM_BASE, sram);
1606
1607    dev = sysbus_create_simple(TYPE_MV88W8618_PIC, MP_PIC_BASE,
1608                               qdev_get_gpio_in(DEVICE(cpu), ARM_CPU_IRQ));
1609    for (i = 0; i < 32; i++) {
1610        pic[i] = qdev_get_gpio_in(dev, i);
1611    }
1612    sysbus_create_varargs(TYPE_MV88W8618_PIT, MP_PIT_BASE, pic[MP_TIMER1_IRQ],
1613                          pic[MP_TIMER2_IRQ], pic[MP_TIMER3_IRQ],
1614                          pic[MP_TIMER4_IRQ], NULL);
1615
1616    if (serial_hd(0)) {
1617        serial_mm_init(address_space_mem, MP_UART1_BASE, 2, pic[MP_UART1_IRQ],
1618                       1825000, serial_hd(0), DEVICE_NATIVE_ENDIAN);
1619    }
1620    if (serial_hd(1)) {
1621        serial_mm_init(address_space_mem, MP_UART2_BASE, 2, pic[MP_UART2_IRQ],
1622                       1825000, serial_hd(1), DEVICE_NATIVE_ENDIAN);
1623    }
1624
1625    /* Register flash */
1626    dinfo = drive_get(IF_PFLASH, 0, 0);
1627    if (dinfo) {
1628        BlockBackend *blk = blk_by_legacy_dinfo(dinfo);
1629
1630        flash_size = blk_getlength(blk);
1631        if (flash_size != 8*1024*1024 && flash_size != 16*1024*1024 &&
1632            flash_size != 32*1024*1024) {
1633            error_report("Invalid flash image size");
1634            exit(1);
1635        }
1636
1637        /*
1638         * The original U-Boot accesses the flash at 0xFE000000 instead of
1639         * 0xFF800000 (if there is 8 MB flash). So remap flash access if the
1640         * image is smaller than 32 MB.
1641         */
1642#ifdef TARGET_WORDS_BIGENDIAN
1643        pflash_cfi02_register(0x100000000ULL - MP_FLASH_SIZE_MAX,
1644                              "musicpal.flash", flash_size,
1645                              blk, 0x10000,
1646                              MP_FLASH_SIZE_MAX / flash_size,
1647                              2, 0x00BF, 0x236D, 0x0000, 0x0000,
1648                              0x5555, 0x2AAA, 1);
1649#else
1650        pflash_cfi02_register(0x100000000ULL - MP_FLASH_SIZE_MAX,
1651                              "musicpal.flash", flash_size,
1652                              blk, 0x10000,
1653                              MP_FLASH_SIZE_MAX / flash_size,
1654                              2, 0x00BF, 0x236D, 0x0000, 0x0000,
1655                              0x5555, 0x2AAA, 0);
1656#endif
1657
1658    }
1659    sysbus_create_simple(TYPE_MV88W8618_FLASHCFG, MP_FLASHCFG_BASE, NULL);
1660
1661    qemu_check_nic_model(&nd_table[0], "mv88w8618");
1662    dev = qdev_create(NULL, TYPE_MV88W8618_ETH);
1663    qdev_set_nic_properties(dev, &nd_table[0]);
1664    qdev_init_nofail(dev);
1665    sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, MP_ETH_BASE);
1666    sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0, pic[MP_ETH_IRQ]);
1667
1668    sysbus_create_simple("mv88w8618_wlan", MP_WLAN_BASE, NULL);
1669
1670    sysbus_create_simple(TYPE_MUSICPAL_MISC, MP_MISC_BASE, NULL);
1671
1672    dev = sysbus_create_simple(TYPE_MUSICPAL_GPIO, MP_GPIO_BASE,
1673                               pic[MP_GPIO_IRQ]);
1674    i2c_dev = sysbus_create_simple("gpio_i2c", -1, NULL);
1675    i2c = (I2CBus *)qdev_get_child_bus(i2c_dev, "i2c");
1676
1677    lcd_dev = sysbus_create_simple(TYPE_MUSICPAL_LCD, MP_LCD_BASE, NULL);
1678    key_dev = sysbus_create_simple(TYPE_MUSICPAL_KEY, -1, NULL);
1679
1680    /* I2C read data */
1681    qdev_connect_gpio_out(i2c_dev, 0,
1682                          qdev_get_gpio_in(dev, MP_GPIO_I2C_DATA_BIT));
1683    /* I2C data */
1684    qdev_connect_gpio_out(dev, 3, qdev_get_gpio_in(i2c_dev, 0));
1685    /* I2C clock */
1686    qdev_connect_gpio_out(dev, 4, qdev_get_gpio_in(i2c_dev, 1));
1687
1688    for (i = 0; i < 3; i++) {
1689        qdev_connect_gpio_out(dev, i, qdev_get_gpio_in(lcd_dev, i));
1690    }
1691    for (i = 0; i < 4; i++) {
1692        qdev_connect_gpio_out(key_dev, i, qdev_get_gpio_in(dev, i + 8));
1693    }
1694    for (i = 4; i < 8; i++) {
1695        qdev_connect_gpio_out(key_dev, i, qdev_get_gpio_in(dev, i + 15));
1696    }
1697
1698    wm8750_dev = i2c_create_slave(i2c, TYPE_WM8750, MP_WM_ADDR);
1699    dev = qdev_create(NULL, TYPE_MV88W8618_AUDIO);
1700    s = SYS_BUS_DEVICE(dev);
1701    object_property_set_link(OBJECT(dev), OBJECT(wm8750_dev),
1702                             "wm8750", NULL);
1703    qdev_init_nofail(dev);
1704    sysbus_mmio_map(s, 0, MP_AUDIO_BASE);
1705    sysbus_connect_irq(s, 0, pic[MP_AUDIO_IRQ]);
1706
1707    musicpal_binfo.ram_size = MP_RAM_DEFAULT_SIZE;
1708    arm_load_kernel(cpu, machine, &musicpal_binfo);
1709}
1710
1711static void musicpal_machine_init(MachineClass *mc)
1712{
1713    mc->desc = "Marvell 88w8618 / MusicPal (ARM926EJ-S)";
1714    mc->init = musicpal_init;
1715    mc->ignore_memory_transaction_failures = true;
1716    mc->default_cpu_type = ARM_CPU_TYPE_NAME("arm926");
1717}
1718
1719DEFINE_MACHINE("musicpal", musicpal_machine_init)
1720
1721static void mv88w8618_wlan_class_init(ObjectClass *klass, void *data)
1722{
1723    DeviceClass *dc = DEVICE_CLASS(klass);
1724
1725    dc->realize = mv88w8618_wlan_realize;
1726}
1727
1728static const TypeInfo mv88w8618_wlan_info = {
1729    .name          = "mv88w8618_wlan",
1730    .parent        = TYPE_SYS_BUS_DEVICE,
1731    .instance_size = sizeof(SysBusDevice),
1732    .class_init    = mv88w8618_wlan_class_init,
1733};
1734
1735static void musicpal_register_types(void)
1736{
1737    type_register_static(&mv88w8618_pic_info);
1738    type_register_static(&mv88w8618_pit_info);
1739    type_register_static(&mv88w8618_flashcfg_info);
1740    type_register_static(&mv88w8618_eth_info);
1741    type_register_static(&mv88w8618_wlan_info);
1742    type_register_static(&musicpal_lcd_info);
1743    type_register_static(&musicpal_gpio_info);
1744    type_register_static(&musicpal_key_info);
1745    type_register_static(&musicpal_misc_info);
1746}
1747
1748type_init(musicpal_register_types)
1749