xref: /qemu/hw/arm/strongarm.c (revision 2c9b15cab12c21e32dffb67c5e18f3dc407ca224)
15bc95aa2SDmitry Eremin-Solenikov /*
25bc95aa2SDmitry Eremin-Solenikov  * StrongARM SA-1100/SA-1110 emulation
35bc95aa2SDmitry Eremin-Solenikov  *
45bc95aa2SDmitry Eremin-Solenikov  * Copyright (C) 2011 Dmitry Eremin-Solenikov
55bc95aa2SDmitry Eremin-Solenikov  *
65bc95aa2SDmitry Eremin-Solenikov  * Largely based on StrongARM emulation:
75bc95aa2SDmitry Eremin-Solenikov  * Copyright (c) 2006 Openedhand Ltd.
85bc95aa2SDmitry Eremin-Solenikov  * Written by Andrzej Zaborowski <balrog@zabor.org>
95bc95aa2SDmitry Eremin-Solenikov  *
105bc95aa2SDmitry Eremin-Solenikov  * UART code based on QEMU 16550A UART emulation
115bc95aa2SDmitry Eremin-Solenikov  * Copyright (c) 2003-2004 Fabrice Bellard
125bc95aa2SDmitry Eremin-Solenikov  * Copyright (c) 2008 Citrix Systems, Inc.
135bc95aa2SDmitry Eremin-Solenikov  *
145bc95aa2SDmitry Eremin-Solenikov  *  This program is free software; you can redistribute it and/or modify
155bc95aa2SDmitry Eremin-Solenikov  *  it under the terms of the GNU General Public License version 2 as
165bc95aa2SDmitry Eremin-Solenikov  *  published by the Free Software Foundation.
175bc95aa2SDmitry Eremin-Solenikov  *
185bc95aa2SDmitry Eremin-Solenikov  *  This program is distributed in the hope that it will be useful,
195bc95aa2SDmitry Eremin-Solenikov  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
205bc95aa2SDmitry Eremin-Solenikov  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
215bc95aa2SDmitry Eremin-Solenikov  *  GNU General Public License for more details.
225bc95aa2SDmitry Eremin-Solenikov  *
235bc95aa2SDmitry Eremin-Solenikov  *  You should have received a copy of the GNU General Public License along
245bc95aa2SDmitry Eremin-Solenikov  *  with this program; if not, see <http://www.gnu.org/licenses/>.
256b620ca3SPaolo Bonzini  *
266b620ca3SPaolo Bonzini  *  Contributions after 2012-01-13 are licensed under the terms of the
276b620ca3SPaolo Bonzini  *  GNU GPL, version 2 or (at your option) any later version.
285bc95aa2SDmitry Eremin-Solenikov  */
2983c9f4caSPaolo Bonzini #include "hw/sysbus.h"
3047b43a1fSPaolo Bonzini #include "strongarm.h"
311de7afc9SPaolo Bonzini #include "qemu/error-report.h"
32bd2be150SPeter Maydell #include "hw/arm/arm.h"
33dccfcd0eSPaolo Bonzini #include "sysemu/char.h"
349c17d615SPaolo Bonzini #include "sysemu/sysemu.h"
3583c9f4caSPaolo Bonzini #include "hw/ssi.h"
365bc95aa2SDmitry Eremin-Solenikov 
375bc95aa2SDmitry Eremin-Solenikov //#define DEBUG
385bc95aa2SDmitry Eremin-Solenikov 
395bc95aa2SDmitry Eremin-Solenikov /*
405bc95aa2SDmitry Eremin-Solenikov  TODO
415bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c14 ?
425bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c15 !!! (idle used in L)
435bc95aa2SDmitry Eremin-Solenikov  - Implement idle mode handling/DIM
445bc95aa2SDmitry Eremin-Solenikov  - Implement sleep mode/Wake sources
455bc95aa2SDmitry Eremin-Solenikov  - Implement reset control
465bc95aa2SDmitry Eremin-Solenikov  - Implement memory control regs
475bc95aa2SDmitry Eremin-Solenikov  - PCMCIA handling
485bc95aa2SDmitry Eremin-Solenikov  - Maybe support MBGNT/MBREQ
495bc95aa2SDmitry Eremin-Solenikov  - DMA channels
505bc95aa2SDmitry Eremin-Solenikov  - GPCLK
515bc95aa2SDmitry Eremin-Solenikov  - IrDA
525bc95aa2SDmitry Eremin-Solenikov  - MCP
535bc95aa2SDmitry Eremin-Solenikov  - Enhance UART with modem signals
545bc95aa2SDmitry Eremin-Solenikov  */
555bc95aa2SDmitry Eremin-Solenikov 
565bc95aa2SDmitry Eremin-Solenikov #ifdef DEBUG
575bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) printf(format , ## __VA_ARGS__)
585bc95aa2SDmitry Eremin-Solenikov #else
595bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) do { } while (0)
605bc95aa2SDmitry Eremin-Solenikov #endif
615bc95aa2SDmitry Eremin-Solenikov 
625bc95aa2SDmitry Eremin-Solenikov static struct {
63a8170e5eSAvi Kivity     hwaddr io_base;
645bc95aa2SDmitry Eremin-Solenikov     int irq;
655bc95aa2SDmitry Eremin-Solenikov } sa_serial[] = {
665bc95aa2SDmitry Eremin-Solenikov     { 0x80010000, SA_PIC_UART1 },
675bc95aa2SDmitry Eremin-Solenikov     { 0x80030000, SA_PIC_UART2 },
685bc95aa2SDmitry Eremin-Solenikov     { 0x80050000, SA_PIC_UART3 },
695bc95aa2SDmitry Eremin-Solenikov     { 0, 0 }
705bc95aa2SDmitry Eremin-Solenikov };
715bc95aa2SDmitry Eremin-Solenikov 
725bc95aa2SDmitry Eremin-Solenikov /* Interrupt Controller */
735bc95aa2SDmitry Eremin-Solenikov typedef struct {
745bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
75eb2fefbcSAvi Kivity     MemoryRegion iomem;
765bc95aa2SDmitry Eremin-Solenikov     qemu_irq    irq;
775bc95aa2SDmitry Eremin-Solenikov     qemu_irq    fiq;
785bc95aa2SDmitry Eremin-Solenikov 
795bc95aa2SDmitry Eremin-Solenikov     uint32_t pending;
805bc95aa2SDmitry Eremin-Solenikov     uint32_t enabled;
815bc95aa2SDmitry Eremin-Solenikov     uint32_t is_fiq;
825bc95aa2SDmitry Eremin-Solenikov     uint32_t int_idle;
835bc95aa2SDmitry Eremin-Solenikov } StrongARMPICState;
845bc95aa2SDmitry Eremin-Solenikov 
855bc95aa2SDmitry Eremin-Solenikov #define ICIP    0x00
865bc95aa2SDmitry Eremin-Solenikov #define ICMR    0x04
875bc95aa2SDmitry Eremin-Solenikov #define ICLR    0x08
885bc95aa2SDmitry Eremin-Solenikov #define ICFP    0x10
895bc95aa2SDmitry Eremin-Solenikov #define ICPR    0x20
905bc95aa2SDmitry Eremin-Solenikov #define ICCR    0x0c
915bc95aa2SDmitry Eremin-Solenikov 
925bc95aa2SDmitry Eremin-Solenikov #define SA_PIC_SRCS     32
935bc95aa2SDmitry Eremin-Solenikov 
945bc95aa2SDmitry Eremin-Solenikov 
955bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_update(void *opaque)
965bc95aa2SDmitry Eremin-Solenikov {
975bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
985bc95aa2SDmitry Eremin-Solenikov 
995bc95aa2SDmitry Eremin-Solenikov     /* FIXME: reflect DIM */
1005bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->fiq, s->pending & s->enabled &  s->is_fiq);
1015bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, s->pending & s->enabled & ~s->is_fiq);
1025bc95aa2SDmitry Eremin-Solenikov }
1035bc95aa2SDmitry Eremin-Solenikov 
1045bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_set_irq(void *opaque, int irq, int level)
1055bc95aa2SDmitry Eremin-Solenikov {
1065bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1075bc95aa2SDmitry Eremin-Solenikov 
1085bc95aa2SDmitry Eremin-Solenikov     if (level) {
1095bc95aa2SDmitry Eremin-Solenikov         s->pending |= 1 << irq;
1105bc95aa2SDmitry Eremin-Solenikov     } else {
1115bc95aa2SDmitry Eremin-Solenikov         s->pending &= ~(1 << irq);
1125bc95aa2SDmitry Eremin-Solenikov     }
1135bc95aa2SDmitry Eremin-Solenikov 
1145bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1155bc95aa2SDmitry Eremin-Solenikov }
1165bc95aa2SDmitry Eremin-Solenikov 
117a8170e5eSAvi Kivity static uint64_t strongarm_pic_mem_read(void *opaque, hwaddr offset,
118eb2fefbcSAvi Kivity                                        unsigned size)
1195bc95aa2SDmitry Eremin-Solenikov {
1205bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1215bc95aa2SDmitry Eremin-Solenikov 
1225bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1235bc95aa2SDmitry Eremin-Solenikov     case ICIP:
1245bc95aa2SDmitry Eremin-Solenikov         return s->pending & ~s->is_fiq & s->enabled;
1255bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1265bc95aa2SDmitry Eremin-Solenikov         return s->enabled;
1275bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1285bc95aa2SDmitry Eremin-Solenikov         return s->is_fiq;
1295bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1305bc95aa2SDmitry Eremin-Solenikov         return s->int_idle == 0;
1315bc95aa2SDmitry Eremin-Solenikov     case ICFP:
1325bc95aa2SDmitry Eremin-Solenikov         return s->pending & s->is_fiq & s->enabled;
1335bc95aa2SDmitry Eremin-Solenikov     case ICPR:
1345bc95aa2SDmitry Eremin-Solenikov         return s->pending;
1355bc95aa2SDmitry Eremin-Solenikov     default:
1365bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1375bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1385bc95aa2SDmitry Eremin-Solenikov         return 0;
1395bc95aa2SDmitry Eremin-Solenikov     }
1405bc95aa2SDmitry Eremin-Solenikov }
1415bc95aa2SDmitry Eremin-Solenikov 
142a8170e5eSAvi Kivity static void strongarm_pic_mem_write(void *opaque, hwaddr offset,
143eb2fefbcSAvi Kivity                                     uint64_t value, unsigned size)
1445bc95aa2SDmitry Eremin-Solenikov {
1455bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1465bc95aa2SDmitry Eremin-Solenikov 
1475bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1485bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1495bc95aa2SDmitry Eremin-Solenikov         s->enabled = value;
1505bc95aa2SDmitry Eremin-Solenikov         break;
1515bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1525bc95aa2SDmitry Eremin-Solenikov         s->is_fiq = value;
1535bc95aa2SDmitry Eremin-Solenikov         break;
1545bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1555bc95aa2SDmitry Eremin-Solenikov         s->int_idle = (value & 1) ? 0 : ~0;
1565bc95aa2SDmitry Eremin-Solenikov         break;
1575bc95aa2SDmitry Eremin-Solenikov     default:
1585bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1595bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1605bc95aa2SDmitry Eremin-Solenikov         break;
1615bc95aa2SDmitry Eremin-Solenikov     }
1625bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1635bc95aa2SDmitry Eremin-Solenikov }
1645bc95aa2SDmitry Eremin-Solenikov 
165eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_pic_ops = {
166eb2fefbcSAvi Kivity     .read = strongarm_pic_mem_read,
167eb2fefbcSAvi Kivity     .write = strongarm_pic_mem_write,
168eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
1695bc95aa2SDmitry Eremin-Solenikov };
1705bc95aa2SDmitry Eremin-Solenikov 
1715bc95aa2SDmitry Eremin-Solenikov static int strongarm_pic_initfn(SysBusDevice *dev)
1725bc95aa2SDmitry Eremin-Solenikov {
1735bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = FROM_SYSBUS(StrongARMPICState, dev);
1745bc95aa2SDmitry Eremin-Solenikov 
1755bc95aa2SDmitry Eremin-Solenikov     qdev_init_gpio_in(&dev->qdev, strongarm_pic_set_irq, SA_PIC_SRCS);
176*2c9b15caSPaolo Bonzini     memory_region_init_io(&s->iomem, NULL, &strongarm_pic_ops, s, "pic", 0x1000);
177750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
1785bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->irq);
1795bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->fiq);
1805bc95aa2SDmitry Eremin-Solenikov 
1815bc95aa2SDmitry Eremin-Solenikov     return 0;
1825bc95aa2SDmitry Eremin-Solenikov }
1835bc95aa2SDmitry Eremin-Solenikov 
1845bc95aa2SDmitry Eremin-Solenikov static int strongarm_pic_post_load(void *opaque, int version_id)
1855bc95aa2SDmitry Eremin-Solenikov {
1865bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(opaque);
1875bc95aa2SDmitry Eremin-Solenikov     return 0;
1885bc95aa2SDmitry Eremin-Solenikov }
1895bc95aa2SDmitry Eremin-Solenikov 
1905bc95aa2SDmitry Eremin-Solenikov static VMStateDescription vmstate_strongarm_pic_regs = {
1915bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm_pic",
1925bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
1935bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
1945bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id_old = 0,
1955bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_pic_post_load,
1965bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
1975bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(pending, StrongARMPICState),
1985bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(enabled, StrongARMPICState),
1995bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(is_fiq, StrongARMPICState),
2005bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(int_idle, StrongARMPICState),
2015bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
2025bc95aa2SDmitry Eremin-Solenikov     },
2035bc95aa2SDmitry Eremin-Solenikov };
2045bc95aa2SDmitry Eremin-Solenikov 
205999e12bbSAnthony Liguori static void strongarm_pic_class_init(ObjectClass *klass, void *data)
206999e12bbSAnthony Liguori {
20739bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
208999e12bbSAnthony Liguori     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
209999e12bbSAnthony Liguori 
210999e12bbSAnthony Liguori     k->init = strongarm_pic_initfn;
21139bffca2SAnthony Liguori     dc->desc = "StrongARM PIC";
21239bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_pic_regs;
213999e12bbSAnthony Liguori }
214999e12bbSAnthony Liguori 
2158c43a6f0SAndreas Färber static const TypeInfo strongarm_pic_info = {
216999e12bbSAnthony Liguori     .name          = "strongarm_pic",
21739bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
21839bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPICState),
219999e12bbSAnthony Liguori     .class_init    = strongarm_pic_class_init,
2205bc95aa2SDmitry Eremin-Solenikov };
2215bc95aa2SDmitry Eremin-Solenikov 
2225bc95aa2SDmitry Eremin-Solenikov /* Real-Time Clock */
2235bc95aa2SDmitry Eremin-Solenikov #define RTAR 0x00 /* RTC Alarm register */
2245bc95aa2SDmitry Eremin-Solenikov #define RCNR 0x04 /* RTC Counter register */
2255bc95aa2SDmitry Eremin-Solenikov #define RTTR 0x08 /* RTC Timer Trim register */
2265bc95aa2SDmitry Eremin-Solenikov #define RTSR 0x10 /* RTC Status register */
2275bc95aa2SDmitry Eremin-Solenikov 
2285bc95aa2SDmitry Eremin-Solenikov #define RTSR_AL (1 << 0) /* RTC Alarm detected */
2295bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZ (1 << 1) /* RTC 1Hz detected */
2305bc95aa2SDmitry Eremin-Solenikov #define RTSR_ALE (1 << 2) /* RTC Alarm enable */
2315bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZE (1 << 3) /* RTC 1Hz enable */
2325bc95aa2SDmitry Eremin-Solenikov 
2335bc95aa2SDmitry Eremin-Solenikov /* 16 LSB of RTTR are clockdiv for internal trim logic,
2345bc95aa2SDmitry Eremin-Solenikov  * trim delete isn't emulated, so
2355bc95aa2SDmitry Eremin-Solenikov  * f = 32 768 / (RTTR_trim + 1) */
2365bc95aa2SDmitry Eremin-Solenikov 
2375bc95aa2SDmitry Eremin-Solenikov typedef struct {
2385bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
239eb2fefbcSAvi Kivity     MemoryRegion iomem;
2405bc95aa2SDmitry Eremin-Solenikov     uint32_t rttr;
2415bc95aa2SDmitry Eremin-Solenikov     uint32_t rtsr;
2425bc95aa2SDmitry Eremin-Solenikov     uint32_t rtar;
2435bc95aa2SDmitry Eremin-Solenikov     uint32_t last_rcnr;
2445bc95aa2SDmitry Eremin-Solenikov     int64_t last_hz;
2455bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_alarm;
2465bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_hz;
2475bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_irq;
2485bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_hz_irq;
2495bc95aa2SDmitry Eremin-Solenikov } StrongARMRTCState;
2505bc95aa2SDmitry Eremin-Solenikov 
2515bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_int_update(StrongARMRTCState *s)
2525bc95aa2SDmitry Eremin-Solenikov {
2535bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_irq, s->rtsr & RTSR_AL);
2545bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_hz_irq, s->rtsr & RTSR_HZ);
2555bc95aa2SDmitry Eremin-Solenikov }
2565bc95aa2SDmitry Eremin-Solenikov 
2575bc95aa2SDmitry Eremin-Solenikov static void strongarm_rtc_hzupdate(StrongARMRTCState *s)
2585bc95aa2SDmitry Eremin-Solenikov {
259348abc86SPaolo Bonzini     int64_t rt = qemu_get_clock_ms(rtc_clock);
2605bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr += ((rt - s->last_hz) << 15) /
2615bc95aa2SDmitry Eremin-Solenikov             (1000 * ((s->rttr & 0xffff) + 1));
2625bc95aa2SDmitry Eremin-Solenikov     s->last_hz = rt;
2635bc95aa2SDmitry Eremin-Solenikov }
2645bc95aa2SDmitry Eremin-Solenikov 
2655bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_timer_update(StrongARMRTCState *s)
2665bc95aa2SDmitry Eremin-Solenikov {
2675bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_HZE) && !(s->rtsr & RTSR_HZ)) {
2685bc95aa2SDmitry Eremin-Solenikov         qemu_mod_timer(s->rtc_hz, s->last_hz + 1000);
2695bc95aa2SDmitry Eremin-Solenikov     } else {
2705bc95aa2SDmitry Eremin-Solenikov         qemu_del_timer(s->rtc_hz);
2715bc95aa2SDmitry Eremin-Solenikov     }
2725bc95aa2SDmitry Eremin-Solenikov 
2735bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_ALE) && !(s->rtsr & RTSR_AL)) {
2745bc95aa2SDmitry Eremin-Solenikov         qemu_mod_timer(s->rtc_alarm, s->last_hz +
2755bc95aa2SDmitry Eremin-Solenikov                 (((s->rtar - s->last_rcnr) * 1000 *
2765bc95aa2SDmitry Eremin-Solenikov                   ((s->rttr & 0xffff) + 1)) >> 15));
2775bc95aa2SDmitry Eremin-Solenikov     } else {
2785bc95aa2SDmitry Eremin-Solenikov         qemu_del_timer(s->rtc_alarm);
2795bc95aa2SDmitry Eremin-Solenikov     }
2805bc95aa2SDmitry Eremin-Solenikov }
2815bc95aa2SDmitry Eremin-Solenikov 
2825bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_alarm_tick(void *opaque)
2835bc95aa2SDmitry Eremin-Solenikov {
2845bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
2855bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_AL;
2865bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
2875bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
2885bc95aa2SDmitry Eremin-Solenikov }
2895bc95aa2SDmitry Eremin-Solenikov 
2905bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_hz_tick(void *opaque)
2915bc95aa2SDmitry Eremin-Solenikov {
2925bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
2935bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_HZ;
2945bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
2955bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
2965bc95aa2SDmitry Eremin-Solenikov }
2975bc95aa2SDmitry Eremin-Solenikov 
298a8170e5eSAvi Kivity static uint64_t strongarm_rtc_read(void *opaque, hwaddr addr,
299eb2fefbcSAvi Kivity                                    unsigned size)
3005bc95aa2SDmitry Eremin-Solenikov {
3015bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3025bc95aa2SDmitry Eremin-Solenikov 
3035bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3045bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3055bc95aa2SDmitry Eremin-Solenikov         return s->rttr;
3065bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3075bc95aa2SDmitry Eremin-Solenikov         return s->rtsr;
3085bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3095bc95aa2SDmitry Eremin-Solenikov         return s->rtar;
3105bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3115bc95aa2SDmitry Eremin-Solenikov         return s->last_rcnr +
312348abc86SPaolo Bonzini                 ((qemu_get_clock_ms(rtc_clock) - s->last_hz) << 15) /
3135bc95aa2SDmitry Eremin-Solenikov                 (1000 * ((s->rttr & 0xffff) + 1));
3145bc95aa2SDmitry Eremin-Solenikov     default:
3155bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3165bc95aa2SDmitry Eremin-Solenikov         return 0;
3175bc95aa2SDmitry Eremin-Solenikov     }
3185bc95aa2SDmitry Eremin-Solenikov }
3195bc95aa2SDmitry Eremin-Solenikov 
320a8170e5eSAvi Kivity static void strongarm_rtc_write(void *opaque, hwaddr addr,
321eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
3225bc95aa2SDmitry Eremin-Solenikov {
3235bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3245bc95aa2SDmitry Eremin-Solenikov     uint32_t old_rtsr;
3255bc95aa2SDmitry Eremin-Solenikov 
3265bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3275bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3285bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3295bc95aa2SDmitry Eremin-Solenikov         s->rttr = value;
3305bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3315bc95aa2SDmitry Eremin-Solenikov         break;
3325bc95aa2SDmitry Eremin-Solenikov 
3335bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3345bc95aa2SDmitry Eremin-Solenikov         old_rtsr = s->rtsr;
3355bc95aa2SDmitry Eremin-Solenikov         s->rtsr = (value & (RTSR_ALE | RTSR_HZE)) |
3365bc95aa2SDmitry Eremin-Solenikov                   (s->rtsr & ~(value & (RTSR_AL | RTSR_HZ)));
3375bc95aa2SDmitry Eremin-Solenikov 
3385bc95aa2SDmitry Eremin-Solenikov         if (s->rtsr != old_rtsr) {
3395bc95aa2SDmitry Eremin-Solenikov             strongarm_rtc_timer_update(s);
3405bc95aa2SDmitry Eremin-Solenikov         }
3415bc95aa2SDmitry Eremin-Solenikov 
3425bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_int_update(s);
3435bc95aa2SDmitry Eremin-Solenikov         break;
3445bc95aa2SDmitry Eremin-Solenikov 
3455bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3465bc95aa2SDmitry Eremin-Solenikov         s->rtar = value;
3475bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3485bc95aa2SDmitry Eremin-Solenikov         break;
3495bc95aa2SDmitry Eremin-Solenikov 
3505bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3515bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3525bc95aa2SDmitry Eremin-Solenikov         s->last_rcnr = value;
3535bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3545bc95aa2SDmitry Eremin-Solenikov         break;
3555bc95aa2SDmitry Eremin-Solenikov 
3565bc95aa2SDmitry Eremin-Solenikov     default:
3575bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3585bc95aa2SDmitry Eremin-Solenikov     }
3595bc95aa2SDmitry Eremin-Solenikov }
3605bc95aa2SDmitry Eremin-Solenikov 
361eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_rtc_ops = {
362eb2fefbcSAvi Kivity     .read = strongarm_rtc_read,
363eb2fefbcSAvi Kivity     .write = strongarm_rtc_write,
364eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
3655bc95aa2SDmitry Eremin-Solenikov };
3665bc95aa2SDmitry Eremin-Solenikov 
3675bc95aa2SDmitry Eremin-Solenikov static int strongarm_rtc_init(SysBusDevice *dev)
3685bc95aa2SDmitry Eremin-Solenikov {
3695bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = FROM_SYSBUS(StrongARMRTCState, dev);
3705bc95aa2SDmitry Eremin-Solenikov     struct tm tm;
3715bc95aa2SDmitry Eremin-Solenikov 
3725bc95aa2SDmitry Eremin-Solenikov     s->rttr = 0x0;
3735bc95aa2SDmitry Eremin-Solenikov     s->rtsr = 0;
3745bc95aa2SDmitry Eremin-Solenikov 
3755bc95aa2SDmitry Eremin-Solenikov     qemu_get_timedate(&tm, 0);
3765bc95aa2SDmitry Eremin-Solenikov 
3775bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr = (uint32_t) mktimegm(&tm);
378348abc86SPaolo Bonzini     s->last_hz = qemu_get_clock_ms(rtc_clock);
3795bc95aa2SDmitry Eremin-Solenikov 
380348abc86SPaolo Bonzini     s->rtc_alarm = qemu_new_timer_ms(rtc_clock, strongarm_rtc_alarm_tick, s);
381348abc86SPaolo Bonzini     s->rtc_hz = qemu_new_timer_ms(rtc_clock, strongarm_rtc_hz_tick, s);
3825bc95aa2SDmitry Eremin-Solenikov 
3835bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_irq);
3845bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_hz_irq);
3855bc95aa2SDmitry Eremin-Solenikov 
386*2c9b15caSPaolo Bonzini     memory_region_init_io(&s->iomem, NULL, &strongarm_rtc_ops, s, "rtc", 0x10000);
387750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
3885bc95aa2SDmitry Eremin-Solenikov 
3895bc95aa2SDmitry Eremin-Solenikov     return 0;
3905bc95aa2SDmitry Eremin-Solenikov }
3915bc95aa2SDmitry Eremin-Solenikov 
3925bc95aa2SDmitry Eremin-Solenikov static void strongarm_rtc_pre_save(void *opaque)
3935bc95aa2SDmitry Eremin-Solenikov {
3945bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3955bc95aa2SDmitry Eremin-Solenikov 
3965bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_hzupdate(s);
3975bc95aa2SDmitry Eremin-Solenikov }
3985bc95aa2SDmitry Eremin-Solenikov 
3995bc95aa2SDmitry Eremin-Solenikov static int strongarm_rtc_post_load(void *opaque, int version_id)
4005bc95aa2SDmitry Eremin-Solenikov {
4015bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
4025bc95aa2SDmitry Eremin-Solenikov 
4035bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
4045bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
4055bc95aa2SDmitry Eremin-Solenikov 
4065bc95aa2SDmitry Eremin-Solenikov     return 0;
4075bc95aa2SDmitry Eremin-Solenikov }
4085bc95aa2SDmitry Eremin-Solenikov 
4095bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_rtc_regs = {
4105bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-rtc",
4115bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
4125bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
4135bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id_old = 0,
4145bc95aa2SDmitry Eremin-Solenikov     .pre_save = strongarm_rtc_pre_save,
4155bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_rtc_post_load,
4165bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
4175bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rttr, StrongARMRTCState),
4185bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtsr, StrongARMRTCState),
4195bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtar, StrongARMRTCState),
4205bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(last_rcnr, StrongARMRTCState),
4215bc95aa2SDmitry Eremin-Solenikov         VMSTATE_INT64(last_hz, StrongARMRTCState),
4225bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
4235bc95aa2SDmitry Eremin-Solenikov     },
4245bc95aa2SDmitry Eremin-Solenikov };
4255bc95aa2SDmitry Eremin-Solenikov 
426999e12bbSAnthony Liguori static void strongarm_rtc_sysbus_class_init(ObjectClass *klass, void *data)
427999e12bbSAnthony Liguori {
42839bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
429999e12bbSAnthony Liguori     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
430999e12bbSAnthony Liguori 
431999e12bbSAnthony Liguori     k->init = strongarm_rtc_init;
43239bffca2SAnthony Liguori     dc->desc = "StrongARM RTC Controller";
43339bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_rtc_regs;
434999e12bbSAnthony Liguori }
435999e12bbSAnthony Liguori 
4368c43a6f0SAndreas Färber static const TypeInfo strongarm_rtc_sysbus_info = {
437999e12bbSAnthony Liguori     .name          = "strongarm-rtc",
43839bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
43939bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMRTCState),
440999e12bbSAnthony Liguori     .class_init    = strongarm_rtc_sysbus_class_init,
4415bc95aa2SDmitry Eremin-Solenikov };
4425bc95aa2SDmitry Eremin-Solenikov 
4435bc95aa2SDmitry Eremin-Solenikov /* GPIO */
4445bc95aa2SDmitry Eremin-Solenikov #define GPLR 0x00
4455bc95aa2SDmitry Eremin-Solenikov #define GPDR 0x04
4465bc95aa2SDmitry Eremin-Solenikov #define GPSR 0x08
4475bc95aa2SDmitry Eremin-Solenikov #define GPCR 0x0c
4485bc95aa2SDmitry Eremin-Solenikov #define GRER 0x10
4495bc95aa2SDmitry Eremin-Solenikov #define GFER 0x14
4505bc95aa2SDmitry Eremin-Solenikov #define GEDR 0x18
4515bc95aa2SDmitry Eremin-Solenikov #define GAFR 0x1c
4525bc95aa2SDmitry Eremin-Solenikov 
4535bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMGPIOInfo StrongARMGPIOInfo;
4545bc95aa2SDmitry Eremin-Solenikov struct StrongARMGPIOInfo {
4555bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
456eb2fefbcSAvi Kivity     MemoryRegion iomem;
4575bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
4585bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqs[11];
4595bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqX;
4605bc95aa2SDmitry Eremin-Solenikov 
4615bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
4625bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
4635bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
4645bc95aa2SDmitry Eremin-Solenikov     uint32_t rising;
4655bc95aa2SDmitry Eremin-Solenikov     uint32_t falling;
4665bc95aa2SDmitry Eremin-Solenikov     uint32_t status;
4675bc95aa2SDmitry Eremin-Solenikov     uint32_t gpsr;
4685bc95aa2SDmitry Eremin-Solenikov     uint32_t gafr;
4695bc95aa2SDmitry Eremin-Solenikov 
4705bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
4715bc95aa2SDmitry Eremin-Solenikov };
4725bc95aa2SDmitry Eremin-Solenikov 
4735bc95aa2SDmitry Eremin-Solenikov 
4745bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_irq_update(StrongARMGPIOInfo *s)
4755bc95aa2SDmitry Eremin-Solenikov {
4765bc95aa2SDmitry Eremin-Solenikov     int i;
4775bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
4785bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->irqs[i], s->status & (1 << i));
4795bc95aa2SDmitry Eremin-Solenikov     }
4805bc95aa2SDmitry Eremin-Solenikov 
4815bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irqX, (s->status & ~0x7ff));
4825bc95aa2SDmitry Eremin-Solenikov }
4835bc95aa2SDmitry Eremin-Solenikov 
4845bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_set(void *opaque, int line, int level)
4855bc95aa2SDmitry Eremin-Solenikov {
4865bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
4875bc95aa2SDmitry Eremin-Solenikov     uint32_t mask;
4885bc95aa2SDmitry Eremin-Solenikov 
4895bc95aa2SDmitry Eremin-Solenikov     mask = 1 << line;
4905bc95aa2SDmitry Eremin-Solenikov 
4915bc95aa2SDmitry Eremin-Solenikov     if (level) {
4925bc95aa2SDmitry Eremin-Solenikov         s->status |= s->rising & mask &
4935bc95aa2SDmitry Eremin-Solenikov                 ~s->ilevel & ~s->dir;
4945bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= mask;
4955bc95aa2SDmitry Eremin-Solenikov     } else {
4965bc95aa2SDmitry Eremin-Solenikov         s->status |= s->falling & mask &
4975bc95aa2SDmitry Eremin-Solenikov                 s->ilevel & ~s->dir;
4985bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~mask;
4995bc95aa2SDmitry Eremin-Solenikov     }
5005bc95aa2SDmitry Eremin-Solenikov 
5015bc95aa2SDmitry Eremin-Solenikov     if (s->status & mask) {
5025bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
5035bc95aa2SDmitry Eremin-Solenikov     }
5045bc95aa2SDmitry Eremin-Solenikov }
5055bc95aa2SDmitry Eremin-Solenikov 
5065bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_handler_update(StrongARMGPIOInfo *s)
5075bc95aa2SDmitry Eremin-Solenikov {
5085bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
5095bc95aa2SDmitry Eremin-Solenikov     int bit;
5105bc95aa2SDmitry Eremin-Solenikov 
5115bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
5125bc95aa2SDmitry Eremin-Solenikov 
5135bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
5145bc95aa2SDmitry Eremin-Solenikov         bit = ffs(diff) - 1;
5155bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
5165bc95aa2SDmitry Eremin-Solenikov     }
5175bc95aa2SDmitry Eremin-Solenikov 
5185bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
5195bc95aa2SDmitry Eremin-Solenikov }
5205bc95aa2SDmitry Eremin-Solenikov 
521a8170e5eSAvi Kivity static uint64_t strongarm_gpio_read(void *opaque, hwaddr offset,
522eb2fefbcSAvi Kivity                                     unsigned size)
5235bc95aa2SDmitry Eremin-Solenikov {
5245bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5255bc95aa2SDmitry Eremin-Solenikov 
5265bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5275bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
5285bc95aa2SDmitry Eremin-Solenikov         return s->dir;
5295bc95aa2SDmitry Eremin-Solenikov 
5305bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
5315bc95aa2SDmitry Eremin-Solenikov         DPRINTF("%s: Read from a write-only register 0x" TARGET_FMT_plx "\n",
5325bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
5335bc95aa2SDmitry Eremin-Solenikov         return s->gpsr;    /* Return last written value.  */
5345bc95aa2SDmitry Eremin-Solenikov 
5355bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
5365bc95aa2SDmitry Eremin-Solenikov         DPRINTF("%s: Read from a write-only register 0x" TARGET_FMT_plx "\n",
5375bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
5385bc95aa2SDmitry Eremin-Solenikov         return 31337;        /* Specified as unpredictable in the docs.  */
5395bc95aa2SDmitry Eremin-Solenikov 
5405bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
5415bc95aa2SDmitry Eremin-Solenikov         return s->rising;
5425bc95aa2SDmitry Eremin-Solenikov 
5435bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
5445bc95aa2SDmitry Eremin-Solenikov         return s->falling;
5455bc95aa2SDmitry Eremin-Solenikov 
5465bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
5475bc95aa2SDmitry Eremin-Solenikov         return s->gafr;
5485bc95aa2SDmitry Eremin-Solenikov 
5495bc95aa2SDmitry Eremin-Solenikov     case GPLR:        /* GPIO Pin-Level registers */
5505bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
5515bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir);
5525bc95aa2SDmitry Eremin-Solenikov 
5535bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
5545bc95aa2SDmitry Eremin-Solenikov         return s->status;
5555bc95aa2SDmitry Eremin-Solenikov 
5565bc95aa2SDmitry Eremin-Solenikov     default:
5575bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
5585bc95aa2SDmitry Eremin-Solenikov     }
5595bc95aa2SDmitry Eremin-Solenikov 
5605bc95aa2SDmitry Eremin-Solenikov     return 0;
5615bc95aa2SDmitry Eremin-Solenikov }
5625bc95aa2SDmitry Eremin-Solenikov 
563a8170e5eSAvi Kivity static void strongarm_gpio_write(void *opaque, hwaddr offset,
564eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
5655bc95aa2SDmitry Eremin-Solenikov {
5665bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5675bc95aa2SDmitry Eremin-Solenikov 
5685bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5695bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
5705bc95aa2SDmitry Eremin-Solenikov         s->dir = value;
5715bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
5725bc95aa2SDmitry Eremin-Solenikov         break;
5735bc95aa2SDmitry Eremin-Solenikov 
5745bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
5755bc95aa2SDmitry Eremin-Solenikov         s->olevel |= value;
5765bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
5775bc95aa2SDmitry Eremin-Solenikov         s->gpsr = value;
5785bc95aa2SDmitry Eremin-Solenikov         break;
5795bc95aa2SDmitry Eremin-Solenikov 
5805bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
5815bc95aa2SDmitry Eremin-Solenikov         s->olevel &= ~value;
5825bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
5835bc95aa2SDmitry Eremin-Solenikov         break;
5845bc95aa2SDmitry Eremin-Solenikov 
5855bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
5865bc95aa2SDmitry Eremin-Solenikov         s->rising = value;
5875bc95aa2SDmitry Eremin-Solenikov         break;
5885bc95aa2SDmitry Eremin-Solenikov 
5895bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
5905bc95aa2SDmitry Eremin-Solenikov         s->falling = value;
5915bc95aa2SDmitry Eremin-Solenikov         break;
5925bc95aa2SDmitry Eremin-Solenikov 
5935bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
5945bc95aa2SDmitry Eremin-Solenikov         s->gafr = value;
5955bc95aa2SDmitry Eremin-Solenikov         break;
5965bc95aa2SDmitry Eremin-Solenikov 
5975bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
5985bc95aa2SDmitry Eremin-Solenikov         s->status &= ~value;
5995bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
6005bc95aa2SDmitry Eremin-Solenikov         break;
6015bc95aa2SDmitry Eremin-Solenikov 
6025bc95aa2SDmitry Eremin-Solenikov     default:
6035bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
6045bc95aa2SDmitry Eremin-Solenikov     }
6055bc95aa2SDmitry Eremin-Solenikov }
6065bc95aa2SDmitry Eremin-Solenikov 
607eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_gpio_ops = {
608eb2fefbcSAvi Kivity     .read = strongarm_gpio_read,
609eb2fefbcSAvi Kivity     .write = strongarm_gpio_write,
610eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
6115bc95aa2SDmitry Eremin-Solenikov };
6125bc95aa2SDmitry Eremin-Solenikov 
613a8170e5eSAvi Kivity static DeviceState *strongarm_gpio_init(hwaddr base,
6145bc95aa2SDmitry Eremin-Solenikov                 DeviceState *pic)
6155bc95aa2SDmitry Eremin-Solenikov {
6165bc95aa2SDmitry Eremin-Solenikov     DeviceState *dev;
6175bc95aa2SDmitry Eremin-Solenikov     int i;
6185bc95aa2SDmitry Eremin-Solenikov 
6195bc95aa2SDmitry Eremin-Solenikov     dev = qdev_create(NULL, "strongarm-gpio");
6205bc95aa2SDmitry Eremin-Solenikov     qdev_init_nofail(dev);
6215bc95aa2SDmitry Eremin-Solenikov 
6221356b98dSAndreas Färber     sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, base);
6235bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 12; i++)
6241356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), i,
6255bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(pic, SA_PIC_GPIO0_EDGE + i));
6265bc95aa2SDmitry Eremin-Solenikov 
6275bc95aa2SDmitry Eremin-Solenikov     return dev;
6285bc95aa2SDmitry Eremin-Solenikov }
6295bc95aa2SDmitry Eremin-Solenikov 
6305bc95aa2SDmitry Eremin-Solenikov static int strongarm_gpio_initfn(SysBusDevice *dev)
6315bc95aa2SDmitry Eremin-Solenikov {
6325bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s;
6335bc95aa2SDmitry Eremin-Solenikov     int i;
6345bc95aa2SDmitry Eremin-Solenikov 
6355bc95aa2SDmitry Eremin-Solenikov     s = FROM_SYSBUS(StrongARMGPIOInfo, dev);
6365bc95aa2SDmitry Eremin-Solenikov 
6375bc95aa2SDmitry Eremin-Solenikov     qdev_init_gpio_in(&dev->qdev, strongarm_gpio_set, 28);
6385bc95aa2SDmitry Eremin-Solenikov     qdev_init_gpio_out(&dev->qdev, s->handler, 28);
6395bc95aa2SDmitry Eremin-Solenikov 
640*2c9b15caSPaolo Bonzini     memory_region_init_io(&s->iomem, NULL, &strongarm_gpio_ops, s, "gpio", 0x1000);
6415bc95aa2SDmitry Eremin-Solenikov 
642750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
6435bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
6445bc95aa2SDmitry Eremin-Solenikov         sysbus_init_irq(dev, &s->irqs[i]);
6455bc95aa2SDmitry Eremin-Solenikov     }
6465bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->irqX);
6475bc95aa2SDmitry Eremin-Solenikov 
6485bc95aa2SDmitry Eremin-Solenikov     return 0;
6495bc95aa2SDmitry Eremin-Solenikov }
6505bc95aa2SDmitry Eremin-Solenikov 
6515bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_gpio_regs = {
6525bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-gpio",
6535bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
6545bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
6555bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id_old = 0,
6565bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
6575bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMGPIOInfo),
6585bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMGPIOInfo),
6595bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMGPIOInfo),
6605bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rising, StrongARMGPIOInfo),
6615bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(falling, StrongARMGPIOInfo),
6625bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(status, StrongARMGPIOInfo),
6635bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(gafr, StrongARMGPIOInfo),
6645bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
6655bc95aa2SDmitry Eremin-Solenikov     },
6665bc95aa2SDmitry Eremin-Solenikov };
6675bc95aa2SDmitry Eremin-Solenikov 
668999e12bbSAnthony Liguori static void strongarm_gpio_class_init(ObjectClass *klass, void *data)
669999e12bbSAnthony Liguori {
67039bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
671999e12bbSAnthony Liguori     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
672999e12bbSAnthony Liguori 
673999e12bbSAnthony Liguori     k->init = strongarm_gpio_initfn;
67439bffca2SAnthony Liguori     dc->desc = "StrongARM GPIO controller";
675999e12bbSAnthony Liguori }
676999e12bbSAnthony Liguori 
6778c43a6f0SAndreas Färber static const TypeInfo strongarm_gpio_info = {
678999e12bbSAnthony Liguori     .name          = "strongarm-gpio",
67939bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
68039bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMGPIOInfo),
681999e12bbSAnthony Liguori     .class_init    = strongarm_gpio_class_init,
6825bc95aa2SDmitry Eremin-Solenikov };
6835bc95aa2SDmitry Eremin-Solenikov 
6845bc95aa2SDmitry Eremin-Solenikov /* Peripheral Pin Controller */
6855bc95aa2SDmitry Eremin-Solenikov #define PPDR 0x00
6865bc95aa2SDmitry Eremin-Solenikov #define PPSR 0x04
6875bc95aa2SDmitry Eremin-Solenikov #define PPAR 0x08
6885bc95aa2SDmitry Eremin-Solenikov #define PSDR 0x0c
6895bc95aa2SDmitry Eremin-Solenikov #define PPFR 0x10
6905bc95aa2SDmitry Eremin-Solenikov 
6915bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMPPCInfo StrongARMPPCInfo;
6925bc95aa2SDmitry Eremin-Solenikov struct StrongARMPPCInfo {
6935bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
694eb2fefbcSAvi Kivity     MemoryRegion iomem;
6955bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
6965bc95aa2SDmitry Eremin-Solenikov 
6975bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
6985bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
6995bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
7005bc95aa2SDmitry Eremin-Solenikov     uint32_t ppar;
7015bc95aa2SDmitry Eremin-Solenikov     uint32_t psdr;
7025bc95aa2SDmitry Eremin-Solenikov     uint32_t ppfr;
7035bc95aa2SDmitry Eremin-Solenikov 
7045bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
7055bc95aa2SDmitry Eremin-Solenikov };
7065bc95aa2SDmitry Eremin-Solenikov 
7075bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_set(void *opaque, int line, int level)
7085bc95aa2SDmitry Eremin-Solenikov {
7095bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7105bc95aa2SDmitry Eremin-Solenikov 
7115bc95aa2SDmitry Eremin-Solenikov     if (level) {
7125bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= 1 << line;
7135bc95aa2SDmitry Eremin-Solenikov     } else {
7145bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~(1 << line);
7155bc95aa2SDmitry Eremin-Solenikov     }
7165bc95aa2SDmitry Eremin-Solenikov }
7175bc95aa2SDmitry Eremin-Solenikov 
7185bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_handler_update(StrongARMPPCInfo *s)
7195bc95aa2SDmitry Eremin-Solenikov {
7205bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
7215bc95aa2SDmitry Eremin-Solenikov     int bit;
7225bc95aa2SDmitry Eremin-Solenikov 
7235bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
7245bc95aa2SDmitry Eremin-Solenikov 
7255bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
7265bc95aa2SDmitry Eremin-Solenikov         bit = ffs(diff) - 1;
7275bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
7285bc95aa2SDmitry Eremin-Solenikov     }
7295bc95aa2SDmitry Eremin-Solenikov 
7305bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
7315bc95aa2SDmitry Eremin-Solenikov }
7325bc95aa2SDmitry Eremin-Solenikov 
733a8170e5eSAvi Kivity static uint64_t strongarm_ppc_read(void *opaque, hwaddr offset,
734eb2fefbcSAvi Kivity                                    unsigned size)
7355bc95aa2SDmitry Eremin-Solenikov {
7365bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7375bc95aa2SDmitry Eremin-Solenikov 
7385bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
7395bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
7405bc95aa2SDmitry Eremin-Solenikov         return s->dir | ~0x3fffff;
7415bc95aa2SDmitry Eremin-Solenikov 
7425bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
7435bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
7445bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir) |
7455bc95aa2SDmitry Eremin-Solenikov                ~0x3fffff;
7465bc95aa2SDmitry Eremin-Solenikov 
7475bc95aa2SDmitry Eremin-Solenikov     case PPAR:
7485bc95aa2SDmitry Eremin-Solenikov         return s->ppar | ~0x41000;
7495bc95aa2SDmitry Eremin-Solenikov 
7505bc95aa2SDmitry Eremin-Solenikov     case PSDR:
7515bc95aa2SDmitry Eremin-Solenikov         return s->psdr;
7525bc95aa2SDmitry Eremin-Solenikov 
7535bc95aa2SDmitry Eremin-Solenikov     case PPFR:
7545bc95aa2SDmitry Eremin-Solenikov         return s->ppfr | ~0x7f001;
7555bc95aa2SDmitry Eremin-Solenikov 
7565bc95aa2SDmitry Eremin-Solenikov     default:
7575bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
7585bc95aa2SDmitry Eremin-Solenikov     }
7595bc95aa2SDmitry Eremin-Solenikov 
7605bc95aa2SDmitry Eremin-Solenikov     return 0;
7615bc95aa2SDmitry Eremin-Solenikov }
7625bc95aa2SDmitry Eremin-Solenikov 
763a8170e5eSAvi Kivity static void strongarm_ppc_write(void *opaque, hwaddr offset,
764eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
7655bc95aa2SDmitry Eremin-Solenikov {
7665bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7675bc95aa2SDmitry Eremin-Solenikov 
7685bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
7695bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
7705bc95aa2SDmitry Eremin-Solenikov         s->dir = value & 0x3fffff;
7715bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
7725bc95aa2SDmitry Eremin-Solenikov         break;
7735bc95aa2SDmitry Eremin-Solenikov 
7745bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
7755bc95aa2SDmitry Eremin-Solenikov         s->olevel = value & s->dir & 0x3fffff;
7765bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
7775bc95aa2SDmitry Eremin-Solenikov         break;
7785bc95aa2SDmitry Eremin-Solenikov 
7795bc95aa2SDmitry Eremin-Solenikov     case PPAR:
7805bc95aa2SDmitry Eremin-Solenikov         s->ppar = value & 0x41000;
7815bc95aa2SDmitry Eremin-Solenikov         break;
7825bc95aa2SDmitry Eremin-Solenikov 
7835bc95aa2SDmitry Eremin-Solenikov     case PSDR:
7845bc95aa2SDmitry Eremin-Solenikov         s->psdr = value & 0x3fffff;
7855bc95aa2SDmitry Eremin-Solenikov         break;
7865bc95aa2SDmitry Eremin-Solenikov 
7875bc95aa2SDmitry Eremin-Solenikov     case PPFR:
7885bc95aa2SDmitry Eremin-Solenikov         s->ppfr = value & 0x7f001;
7895bc95aa2SDmitry Eremin-Solenikov         break;
7905bc95aa2SDmitry Eremin-Solenikov 
7915bc95aa2SDmitry Eremin-Solenikov     default:
7925bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
7935bc95aa2SDmitry Eremin-Solenikov     }
7945bc95aa2SDmitry Eremin-Solenikov }
7955bc95aa2SDmitry Eremin-Solenikov 
796eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ppc_ops = {
797eb2fefbcSAvi Kivity     .read = strongarm_ppc_read,
798eb2fefbcSAvi Kivity     .write = strongarm_ppc_write,
799eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
8005bc95aa2SDmitry Eremin-Solenikov };
8015bc95aa2SDmitry Eremin-Solenikov 
8025bc95aa2SDmitry Eremin-Solenikov static int strongarm_ppc_init(SysBusDevice *dev)
8035bc95aa2SDmitry Eremin-Solenikov {
8045bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s;
8055bc95aa2SDmitry Eremin-Solenikov 
8065bc95aa2SDmitry Eremin-Solenikov     s = FROM_SYSBUS(StrongARMPPCInfo, dev);
8075bc95aa2SDmitry Eremin-Solenikov 
8085bc95aa2SDmitry Eremin-Solenikov     qdev_init_gpio_in(&dev->qdev, strongarm_ppc_set, 22);
8095bc95aa2SDmitry Eremin-Solenikov     qdev_init_gpio_out(&dev->qdev, s->handler, 22);
8105bc95aa2SDmitry Eremin-Solenikov 
811*2c9b15caSPaolo Bonzini     memory_region_init_io(&s->iomem, NULL, &strongarm_ppc_ops, s, "ppc", 0x1000);
8125bc95aa2SDmitry Eremin-Solenikov 
813750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
8145bc95aa2SDmitry Eremin-Solenikov 
8155bc95aa2SDmitry Eremin-Solenikov     return 0;
8165bc95aa2SDmitry Eremin-Solenikov }
8175bc95aa2SDmitry Eremin-Solenikov 
8185bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ppc_regs = {
8195bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ppc",
8205bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
8215bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
8225bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id_old = 0,
8235bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
8245bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMPPCInfo),
8255bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMPPCInfo),
8265bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMPPCInfo),
8275bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppar, StrongARMPPCInfo),
8285bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(psdr, StrongARMPPCInfo),
8295bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppfr, StrongARMPPCInfo),
8305bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
8315bc95aa2SDmitry Eremin-Solenikov     },
8325bc95aa2SDmitry Eremin-Solenikov };
8335bc95aa2SDmitry Eremin-Solenikov 
834999e12bbSAnthony Liguori static void strongarm_ppc_class_init(ObjectClass *klass, void *data)
835999e12bbSAnthony Liguori {
83639bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
837999e12bbSAnthony Liguori     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
838999e12bbSAnthony Liguori 
839999e12bbSAnthony Liguori     k->init = strongarm_ppc_init;
84039bffca2SAnthony Liguori     dc->desc = "StrongARM PPC controller";
841999e12bbSAnthony Liguori }
842999e12bbSAnthony Liguori 
8438c43a6f0SAndreas Färber static const TypeInfo strongarm_ppc_info = {
844999e12bbSAnthony Liguori     .name          = "strongarm-ppc",
84539bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
84639bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPPCInfo),
847999e12bbSAnthony Liguori     .class_init    = strongarm_ppc_class_init,
8485bc95aa2SDmitry Eremin-Solenikov };
8495bc95aa2SDmitry Eremin-Solenikov 
8505bc95aa2SDmitry Eremin-Solenikov /* UART Ports */
8515bc95aa2SDmitry Eremin-Solenikov #define UTCR0 0x00
8525bc95aa2SDmitry Eremin-Solenikov #define UTCR1 0x04
8535bc95aa2SDmitry Eremin-Solenikov #define UTCR2 0x08
8545bc95aa2SDmitry Eremin-Solenikov #define UTCR3 0x0c
8555bc95aa2SDmitry Eremin-Solenikov #define UTDR  0x14
8565bc95aa2SDmitry Eremin-Solenikov #define UTSR0 0x1c
8575bc95aa2SDmitry Eremin-Solenikov #define UTSR1 0x20
8585bc95aa2SDmitry Eremin-Solenikov 
8595bc95aa2SDmitry Eremin-Solenikov #define UTCR0_PE  (1 << 0) /* Parity enable */
8605bc95aa2SDmitry Eremin-Solenikov #define UTCR0_OES (1 << 1) /* Even parity */
8615bc95aa2SDmitry Eremin-Solenikov #define UTCR0_SBS (1 << 2) /* 2 stop bits */
8625bc95aa2SDmitry Eremin-Solenikov #define UTCR0_DSS (1 << 3) /* 8-bit data */
8635bc95aa2SDmitry Eremin-Solenikov 
8645bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RXE (1 << 0) /* Rx enable */
8655bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TXE (1 << 1) /* Tx enable */
8665bc95aa2SDmitry Eremin-Solenikov #define UTCR3_BRK (1 << 2) /* Force Break */
8675bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RIE (1 << 3) /* Rx int enable */
8685bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TIE (1 << 4) /* Tx int enable */
8695bc95aa2SDmitry Eremin-Solenikov #define UTCR3_LBM (1 << 5) /* Loopback */
8705bc95aa2SDmitry Eremin-Solenikov 
8715bc95aa2SDmitry Eremin-Solenikov #define UTSR0_TFS (1 << 0) /* Tx FIFO nearly empty */
8725bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RFS (1 << 1) /* Rx FIFO nearly full */
8735bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RID (1 << 2) /* Receiver Idle */
8745bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RBB (1 << 3) /* Receiver begin break */
8755bc95aa2SDmitry Eremin-Solenikov #define UTSR0_REB (1 << 4) /* Receiver end break */
8765bc95aa2SDmitry Eremin-Solenikov #define UTSR0_EIF (1 << 5) /* Error in FIFO */
8775bc95aa2SDmitry Eremin-Solenikov 
8785bc95aa2SDmitry Eremin-Solenikov #define UTSR1_RNE (1 << 1) /* Receive FIFO not empty */
8795bc95aa2SDmitry Eremin-Solenikov #define UTSR1_TNF (1 << 2) /* Transmit FIFO not full */
8805bc95aa2SDmitry Eremin-Solenikov #define UTSR1_PRE (1 << 3) /* Parity error */
8815bc95aa2SDmitry Eremin-Solenikov #define UTSR1_FRE (1 << 4) /* Frame error */
8825bc95aa2SDmitry Eremin-Solenikov #define UTSR1_ROR (1 << 5) /* Receive Over Run */
8835bc95aa2SDmitry Eremin-Solenikov 
8845bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_PRE (1 << 8)
8855bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_FRE (1 << 9)
8865bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_ROR (1 << 10)
8875bc95aa2SDmitry Eremin-Solenikov 
8885bc95aa2SDmitry Eremin-Solenikov typedef struct {
8895bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
890eb2fefbcSAvi Kivity     MemoryRegion iomem;
8915bc95aa2SDmitry Eremin-Solenikov     CharDriverState *chr;
8925bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
8935bc95aa2SDmitry Eremin-Solenikov 
8945bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr0;
8955bc95aa2SDmitry Eremin-Solenikov     uint16_t brd;
8965bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr3;
8975bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr0;
8985bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr1;
8995bc95aa2SDmitry Eremin-Solenikov 
9005bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_fifo[8];
9015bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_start;
9025bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_len;
9035bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[12]; /* value + error flags in high bits */
9045bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
9055bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_len;
9065bc95aa2SDmitry Eremin-Solenikov 
9075bc95aa2SDmitry Eremin-Solenikov     uint64_t char_transmit_time; /* time to transmit a char in ticks*/
9085bc95aa2SDmitry Eremin-Solenikov     bool wait_break_end;
9095bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rx_timeout_timer;
9105bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *tx_timer;
9115bc95aa2SDmitry Eremin-Solenikov } StrongARMUARTState;
9125bc95aa2SDmitry Eremin-Solenikov 
9135bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_status(StrongARMUARTState *s)
9145bc95aa2SDmitry Eremin-Solenikov {
9155bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr1 = 0;
9165bc95aa2SDmitry Eremin-Solenikov 
9175bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len != 8) {
9185bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_TNF;
9195bc95aa2SDmitry Eremin-Solenikov     }
9205bc95aa2SDmitry Eremin-Solenikov 
9215bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len != 0) {
9225bc95aa2SDmitry Eremin-Solenikov         uint16_t ent = s->rx_fifo[s->rx_start];
9235bc95aa2SDmitry Eremin-Solenikov 
9245bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_RNE;
9255bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_PRE) {
9265bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_PRE;
9275bc95aa2SDmitry Eremin-Solenikov         }
9285bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_FRE) {
9295bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_FRE;
9305bc95aa2SDmitry Eremin-Solenikov         }
9315bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_ROR) {
9325bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_ROR;
9335bc95aa2SDmitry Eremin-Solenikov         }
9345bc95aa2SDmitry Eremin-Solenikov     }
9355bc95aa2SDmitry Eremin-Solenikov 
9365bc95aa2SDmitry Eremin-Solenikov     s->utsr1 = utsr1;
9375bc95aa2SDmitry Eremin-Solenikov }
9385bc95aa2SDmitry Eremin-Solenikov 
9395bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_int_status(StrongARMUARTState *s)
9405bc95aa2SDmitry Eremin-Solenikov {
9415bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr0 = s->utsr0 &
9425bc95aa2SDmitry Eremin-Solenikov             (UTSR0_REB | UTSR0_RBB | UTSR0_RID);
9435bc95aa2SDmitry Eremin-Solenikov     int i;
9445bc95aa2SDmitry Eremin-Solenikov 
9455bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_TXE) &&
9465bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_TIE) &&
9475bc95aa2SDmitry Eremin-Solenikov                 s->tx_len <= 4) {
9485bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_TFS;
9495bc95aa2SDmitry Eremin-Solenikov     }
9505bc95aa2SDmitry Eremin-Solenikov 
9515bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) &&
9525bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_RIE) &&
9535bc95aa2SDmitry Eremin-Solenikov                 s->rx_len > 4) {
9545bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_RFS;
9555bc95aa2SDmitry Eremin-Solenikov     }
9565bc95aa2SDmitry Eremin-Solenikov 
9575bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < s->rx_len && i < 4; i++)
9585bc95aa2SDmitry Eremin-Solenikov         if (s->rx_fifo[(s->rx_start + i) % 12] & ~0xff) {
9595bc95aa2SDmitry Eremin-Solenikov             utsr0 |= UTSR0_EIF;
9605bc95aa2SDmitry Eremin-Solenikov             break;
9615bc95aa2SDmitry Eremin-Solenikov         }
9625bc95aa2SDmitry Eremin-Solenikov 
9635bc95aa2SDmitry Eremin-Solenikov     s->utsr0 = utsr0;
9645bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, utsr0);
9655bc95aa2SDmitry Eremin-Solenikov }
9665bc95aa2SDmitry Eremin-Solenikov 
9675bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_parameters(StrongARMUARTState *s)
9685bc95aa2SDmitry Eremin-Solenikov {
9695bc95aa2SDmitry Eremin-Solenikov     int speed, parity, data_bits, stop_bits, frame_size;
9705bc95aa2SDmitry Eremin-Solenikov     QEMUSerialSetParams ssp;
9715bc95aa2SDmitry Eremin-Solenikov 
9725bc95aa2SDmitry Eremin-Solenikov     /* Start bit. */
9735bc95aa2SDmitry Eremin-Solenikov     frame_size = 1;
9745bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_PE) {
9755bc95aa2SDmitry Eremin-Solenikov         /* Parity bit. */
9765bc95aa2SDmitry Eremin-Solenikov         frame_size++;
9775bc95aa2SDmitry Eremin-Solenikov         if (s->utcr0 & UTCR0_OES) {
9785bc95aa2SDmitry Eremin-Solenikov             parity = 'E';
9795bc95aa2SDmitry Eremin-Solenikov         } else {
9805bc95aa2SDmitry Eremin-Solenikov             parity = 'O';
9815bc95aa2SDmitry Eremin-Solenikov         }
9825bc95aa2SDmitry Eremin-Solenikov     } else {
9835bc95aa2SDmitry Eremin-Solenikov             parity = 'N';
9845bc95aa2SDmitry Eremin-Solenikov     }
9855bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_SBS) {
9865bc95aa2SDmitry Eremin-Solenikov         stop_bits = 2;
9875bc95aa2SDmitry Eremin-Solenikov     } else {
9885bc95aa2SDmitry Eremin-Solenikov         stop_bits = 1;
9895bc95aa2SDmitry Eremin-Solenikov     }
9905bc95aa2SDmitry Eremin-Solenikov 
9915bc95aa2SDmitry Eremin-Solenikov     data_bits = (s->utcr0 & UTCR0_DSS) ? 8 : 7;
9925bc95aa2SDmitry Eremin-Solenikov     frame_size += data_bits + stop_bits;
9935bc95aa2SDmitry Eremin-Solenikov     speed = 3686400 / 16 / (s->brd + 1);
9945bc95aa2SDmitry Eremin-Solenikov     ssp.speed = speed;
9955bc95aa2SDmitry Eremin-Solenikov     ssp.parity = parity;
9965bc95aa2SDmitry Eremin-Solenikov     ssp.data_bits = data_bits;
9975bc95aa2SDmitry Eremin-Solenikov     ssp.stop_bits = stop_bits;
9985bc95aa2SDmitry Eremin-Solenikov     s->char_transmit_time =  (get_ticks_per_sec() / speed) * frame_size;
9995bc95aa2SDmitry Eremin-Solenikov     if (s->chr) {
100041084f1bSAnthony Liguori         qemu_chr_fe_ioctl(s->chr, CHR_IOCTL_SERIAL_SET_PARAMS, &ssp);
10015bc95aa2SDmitry Eremin-Solenikov     }
10025bc95aa2SDmitry Eremin-Solenikov 
10035bc95aa2SDmitry Eremin-Solenikov     DPRINTF(stderr, "%s speed=%d parity=%c data=%d stop=%d\n", s->chr->label,
10045bc95aa2SDmitry Eremin-Solenikov             speed, parity, data_bits, stop_bits);
10055bc95aa2SDmitry Eremin-Solenikov }
10065bc95aa2SDmitry Eremin-Solenikov 
10075bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_to(void *opaque)
10085bc95aa2SDmitry Eremin-Solenikov {
10095bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10105bc95aa2SDmitry Eremin-Solenikov 
10115bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
10125bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RID;
10135bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
10145bc95aa2SDmitry Eremin-Solenikov     }
10155bc95aa2SDmitry Eremin-Solenikov }
10165bc95aa2SDmitry Eremin-Solenikov 
10175bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_push(StrongARMUARTState *s, uint16_t c)
10185bc95aa2SDmitry Eremin-Solenikov {
10195bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) == 0) {
10205bc95aa2SDmitry Eremin-Solenikov         /* rx disabled */
10215bc95aa2SDmitry Eremin-Solenikov         return;
10225bc95aa2SDmitry Eremin-Solenikov     }
10235bc95aa2SDmitry Eremin-Solenikov 
10245bc95aa2SDmitry Eremin-Solenikov     if (s->wait_break_end) {
10255bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_REB;
10265bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = false;
10275bc95aa2SDmitry Eremin-Solenikov     }
10285bc95aa2SDmitry Eremin-Solenikov 
10295bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 12) {
10305bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + s->rx_len) % 12] = c;
10315bc95aa2SDmitry Eremin-Solenikov         s->rx_len++;
10325bc95aa2SDmitry Eremin-Solenikov     } else
10335bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + 11) % 12] |= RX_FIFO_ROR;
10345bc95aa2SDmitry Eremin-Solenikov }
10355bc95aa2SDmitry Eremin-Solenikov 
10365bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_can_receive(void *opaque)
10375bc95aa2SDmitry Eremin-Solenikov {
10385bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10395bc95aa2SDmitry Eremin-Solenikov 
10405bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len == 12) {
10415bc95aa2SDmitry Eremin-Solenikov         return 0;
10425bc95aa2SDmitry Eremin-Solenikov     }
10435bc95aa2SDmitry Eremin-Solenikov     /* It's best not to get more than 2/3 of RX FIFO, so advertise that much */
10445bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 8) {
10455bc95aa2SDmitry Eremin-Solenikov         return 8 - s->rx_len;
10465bc95aa2SDmitry Eremin-Solenikov     }
10475bc95aa2SDmitry Eremin-Solenikov     return 1;
10485bc95aa2SDmitry Eremin-Solenikov }
10495bc95aa2SDmitry Eremin-Solenikov 
10505bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_receive(void *opaque, const uint8_t *buf, int size)
10515bc95aa2SDmitry Eremin-Solenikov {
10525bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10535bc95aa2SDmitry Eremin-Solenikov     int i;
10545bc95aa2SDmitry Eremin-Solenikov 
10555bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < size; i++) {
10565bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, buf[i]);
10575bc95aa2SDmitry Eremin-Solenikov     }
10585bc95aa2SDmitry Eremin-Solenikov 
10595bc95aa2SDmitry Eremin-Solenikov     /* call the timeout receive callback in 3 char transmit time */
10605bc95aa2SDmitry Eremin-Solenikov     qemu_mod_timer(s->rx_timeout_timer,
10615bc95aa2SDmitry Eremin-Solenikov                     qemu_get_clock_ns(vm_clock) + s->char_transmit_time * 3);
10625bc95aa2SDmitry Eremin-Solenikov 
10635bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
10645bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
10655bc95aa2SDmitry Eremin-Solenikov }
10665bc95aa2SDmitry Eremin-Solenikov 
10675bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_event(void *opaque, int event)
10685bc95aa2SDmitry Eremin-Solenikov {
10695bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10705bc95aa2SDmitry Eremin-Solenikov     if (event == CHR_EVENT_BREAK) {
10715bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RBB;
10725bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, RX_FIFO_FRE);
10735bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = true;
10745bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
10755bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
10765bc95aa2SDmitry Eremin-Solenikov     }
10775bc95aa2SDmitry Eremin-Solenikov }
10785bc95aa2SDmitry Eremin-Solenikov 
10795bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_tx(void *opaque)
10805bc95aa2SDmitry Eremin-Solenikov {
10815bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10825bc95aa2SDmitry Eremin-Solenikov     uint64_t new_xmit_ts = qemu_get_clock_ns(vm_clock);
10835bc95aa2SDmitry Eremin-Solenikov 
10845bc95aa2SDmitry Eremin-Solenikov     if (s->utcr3 & UTCR3_LBM) /* loopback */ {
10855bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_receive(s, &s->tx_fifo[s->tx_start], 1);
10865bc95aa2SDmitry Eremin-Solenikov     } else if (s->chr) {
10872cc6e0a1SAnthony Liguori         qemu_chr_fe_write(s->chr, &s->tx_fifo[s->tx_start], 1);
10885bc95aa2SDmitry Eremin-Solenikov     }
10895bc95aa2SDmitry Eremin-Solenikov 
10905bc95aa2SDmitry Eremin-Solenikov     s->tx_start = (s->tx_start + 1) % 8;
10915bc95aa2SDmitry Eremin-Solenikov     s->tx_len--;
10925bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
10935bc95aa2SDmitry Eremin-Solenikov         qemu_mod_timer(s->tx_timer, new_xmit_ts + s->char_transmit_time);
10945bc95aa2SDmitry Eremin-Solenikov     }
10955bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
10965bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
10975bc95aa2SDmitry Eremin-Solenikov }
10985bc95aa2SDmitry Eremin-Solenikov 
1099a8170e5eSAvi Kivity static uint64_t strongarm_uart_read(void *opaque, hwaddr addr,
1100eb2fefbcSAvi Kivity                                     unsigned size)
11015bc95aa2SDmitry Eremin-Solenikov {
11025bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11035bc95aa2SDmitry Eremin-Solenikov     uint16_t ret;
11045bc95aa2SDmitry Eremin-Solenikov 
11055bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11065bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11075bc95aa2SDmitry Eremin-Solenikov         return s->utcr0;
11085bc95aa2SDmitry Eremin-Solenikov 
11095bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11105bc95aa2SDmitry Eremin-Solenikov         return s->brd >> 8;
11115bc95aa2SDmitry Eremin-Solenikov 
11125bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11135bc95aa2SDmitry Eremin-Solenikov         return s->brd & 0xff;
11145bc95aa2SDmitry Eremin-Solenikov 
11155bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
11165bc95aa2SDmitry Eremin-Solenikov         return s->utcr3;
11175bc95aa2SDmitry Eremin-Solenikov 
11185bc95aa2SDmitry Eremin-Solenikov     case UTDR:
11195bc95aa2SDmitry Eremin-Solenikov         if (s->rx_len != 0) {
11205bc95aa2SDmitry Eremin-Solenikov             ret = s->rx_fifo[s->rx_start];
11215bc95aa2SDmitry Eremin-Solenikov             s->rx_start = (s->rx_start + 1) % 12;
11225bc95aa2SDmitry Eremin-Solenikov             s->rx_len--;
11235bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
11245bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
11255bc95aa2SDmitry Eremin-Solenikov             return ret;
11265bc95aa2SDmitry Eremin-Solenikov         }
11275bc95aa2SDmitry Eremin-Solenikov         return 0;
11285bc95aa2SDmitry Eremin-Solenikov 
11295bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
11305bc95aa2SDmitry Eremin-Solenikov         return s->utsr0;
11315bc95aa2SDmitry Eremin-Solenikov 
11325bc95aa2SDmitry Eremin-Solenikov     case UTSR1:
11335bc95aa2SDmitry Eremin-Solenikov         return s->utsr1;
11345bc95aa2SDmitry Eremin-Solenikov 
11355bc95aa2SDmitry Eremin-Solenikov     default:
11365bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
11375bc95aa2SDmitry Eremin-Solenikov         return 0;
11385bc95aa2SDmitry Eremin-Solenikov     }
11395bc95aa2SDmitry Eremin-Solenikov }
11405bc95aa2SDmitry Eremin-Solenikov 
1141a8170e5eSAvi Kivity static void strongarm_uart_write(void *opaque, hwaddr addr,
1142eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
11435bc95aa2SDmitry Eremin-Solenikov {
11445bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11455bc95aa2SDmitry Eremin-Solenikov 
11465bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11475bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11485bc95aa2SDmitry Eremin-Solenikov         s->utcr0 = value & 0x7f;
11495bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11505bc95aa2SDmitry Eremin-Solenikov         break;
11515bc95aa2SDmitry Eremin-Solenikov 
11525bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11535bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xff) | ((value & 0xf) << 8);
11545bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11555bc95aa2SDmitry Eremin-Solenikov         break;
11565bc95aa2SDmitry Eremin-Solenikov 
11575bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11585bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xf00) | (value & 0xff);
11595bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11605bc95aa2SDmitry Eremin-Solenikov         break;
11615bc95aa2SDmitry Eremin-Solenikov 
11625bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
11635bc95aa2SDmitry Eremin-Solenikov         s->utcr3 = value & 0x3f;
11645bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_RXE) == 0) {
11655bc95aa2SDmitry Eremin-Solenikov             s->rx_len = 0;
11665bc95aa2SDmitry Eremin-Solenikov         }
11675bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) == 0) {
11685bc95aa2SDmitry Eremin-Solenikov             s->tx_len = 0;
11695bc95aa2SDmitry Eremin-Solenikov         }
11705bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
11715bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
11725bc95aa2SDmitry Eremin-Solenikov         break;
11735bc95aa2SDmitry Eremin-Solenikov 
11745bc95aa2SDmitry Eremin-Solenikov     case UTDR:
11755bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) && s->tx_len != 8) {
11765bc95aa2SDmitry Eremin-Solenikov             s->tx_fifo[(s->tx_start + s->tx_len) % 8] = value;
11775bc95aa2SDmitry Eremin-Solenikov             s->tx_len++;
11785bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
11795bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
11805bc95aa2SDmitry Eremin-Solenikov             if (s->tx_len == 1) {
11815bc95aa2SDmitry Eremin-Solenikov                 strongarm_uart_tx(s);
11825bc95aa2SDmitry Eremin-Solenikov             }
11835bc95aa2SDmitry Eremin-Solenikov         }
11845bc95aa2SDmitry Eremin-Solenikov         break;
11855bc95aa2SDmitry Eremin-Solenikov 
11865bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
11875bc95aa2SDmitry Eremin-Solenikov         s->utsr0 = s->utsr0 & ~(value &
11885bc95aa2SDmitry Eremin-Solenikov                 (UTSR0_REB | UTSR0_RBB | UTSR0_RID));
11895bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
11905bc95aa2SDmitry Eremin-Solenikov         break;
11915bc95aa2SDmitry Eremin-Solenikov 
11925bc95aa2SDmitry Eremin-Solenikov     default:
11935bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
11945bc95aa2SDmitry Eremin-Solenikov     }
11955bc95aa2SDmitry Eremin-Solenikov }
11965bc95aa2SDmitry Eremin-Solenikov 
1197eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_uart_ops = {
1198eb2fefbcSAvi Kivity     .read = strongarm_uart_read,
1199eb2fefbcSAvi Kivity     .write = strongarm_uart_write,
1200eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
12015bc95aa2SDmitry Eremin-Solenikov };
12025bc95aa2SDmitry Eremin-Solenikov 
12035bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_init(SysBusDevice *dev)
12045bc95aa2SDmitry Eremin-Solenikov {
12055bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = FROM_SYSBUS(StrongARMUARTState, dev);
12065bc95aa2SDmitry Eremin-Solenikov 
1207*2c9b15caSPaolo Bonzini     memory_region_init_io(&s->iomem, NULL, &strongarm_uart_ops, s, "uart", 0x10000);
1208750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
12095bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->irq);
12105bc95aa2SDmitry Eremin-Solenikov 
12115bc95aa2SDmitry Eremin-Solenikov     s->rx_timeout_timer = qemu_new_timer_ns(vm_clock, strongarm_uart_rx_to, s);
12125bc95aa2SDmitry Eremin-Solenikov     s->tx_timer = qemu_new_timer_ns(vm_clock, strongarm_uart_tx, s);
12135bc95aa2SDmitry Eremin-Solenikov 
12145bc95aa2SDmitry Eremin-Solenikov     if (s->chr) {
12155bc95aa2SDmitry Eremin-Solenikov         qemu_chr_add_handlers(s->chr,
12165bc95aa2SDmitry Eremin-Solenikov                         strongarm_uart_can_receive,
12175bc95aa2SDmitry Eremin-Solenikov                         strongarm_uart_receive,
12185bc95aa2SDmitry Eremin-Solenikov                         strongarm_uart_event,
12195bc95aa2SDmitry Eremin-Solenikov                         s);
12205bc95aa2SDmitry Eremin-Solenikov     }
12215bc95aa2SDmitry Eremin-Solenikov 
12225bc95aa2SDmitry Eremin-Solenikov     return 0;
12235bc95aa2SDmitry Eremin-Solenikov }
12245bc95aa2SDmitry Eremin-Solenikov 
12255bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_reset(DeviceState *dev)
12265bc95aa2SDmitry Eremin-Solenikov {
12275bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = DO_UPCAST(StrongARMUARTState, busdev.qdev, dev);
12285bc95aa2SDmitry Eremin-Solenikov 
12295bc95aa2SDmitry Eremin-Solenikov     s->utcr0 = UTCR0_DSS; /* 8 data, no parity */
12305bc95aa2SDmitry Eremin-Solenikov     s->brd = 23;    /* 9600 */
12315bc95aa2SDmitry Eremin-Solenikov     /* enable send & recv - this actually violates spec */
12325bc95aa2SDmitry Eremin-Solenikov     s->utcr3 = UTCR3_TXE | UTCR3_RXE;
12335bc95aa2SDmitry Eremin-Solenikov 
12345bc95aa2SDmitry Eremin-Solenikov     s->rx_len = s->tx_len = 0;
12355bc95aa2SDmitry Eremin-Solenikov 
12365bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12375bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12385bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12395bc95aa2SDmitry Eremin-Solenikov }
12405bc95aa2SDmitry Eremin-Solenikov 
12415bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_post_load(void *opaque, int version_id)
12425bc95aa2SDmitry Eremin-Solenikov {
12435bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
12445bc95aa2SDmitry Eremin-Solenikov 
12455bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12465bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12475bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12485bc95aa2SDmitry Eremin-Solenikov 
12495bc95aa2SDmitry Eremin-Solenikov     /* tx and restart timer */
12505bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
12515bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_tx(s);
12525bc95aa2SDmitry Eremin-Solenikov     }
12535bc95aa2SDmitry Eremin-Solenikov 
12545bc95aa2SDmitry Eremin-Solenikov     /* restart rx timeout timer */
12555bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
12565bc95aa2SDmitry Eremin-Solenikov         qemu_mod_timer(s->rx_timeout_timer,
12575bc95aa2SDmitry Eremin-Solenikov                 qemu_get_clock_ns(vm_clock) + s->char_transmit_time * 3);
12585bc95aa2SDmitry Eremin-Solenikov     }
12595bc95aa2SDmitry Eremin-Solenikov 
12605bc95aa2SDmitry Eremin-Solenikov     return 0;
12615bc95aa2SDmitry Eremin-Solenikov }
12625bc95aa2SDmitry Eremin-Solenikov 
12635bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_uart_regs = {
12645bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-uart",
12655bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
12665bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
12675bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id_old = 0,
12685bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_uart_post_load,
12695bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
12705bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr0, StrongARMUARTState),
12715bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(brd, StrongARMUARTState),
12725bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr3, StrongARMUARTState),
12735bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utsr0, StrongARMUARTState),
12745bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8_ARRAY(tx_fifo, StrongARMUARTState, 8),
12755bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_start, StrongARMUARTState),
12765bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_len, StrongARMUARTState),
12775bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMUARTState, 12),
12785bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMUARTState),
12795bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_len, StrongARMUARTState),
12805bc95aa2SDmitry Eremin-Solenikov         VMSTATE_BOOL(wait_break_end, StrongARMUARTState),
12815bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
12825bc95aa2SDmitry Eremin-Solenikov     },
12835bc95aa2SDmitry Eremin-Solenikov };
12845bc95aa2SDmitry Eremin-Solenikov 
1285999e12bbSAnthony Liguori static Property strongarm_uart_properties[] = {
12865bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_CHR("chardev", StrongARMUARTState, chr),
12875bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_END_OF_LIST(),
1288999e12bbSAnthony Liguori };
1289999e12bbSAnthony Liguori 
1290999e12bbSAnthony Liguori static void strongarm_uart_class_init(ObjectClass *klass, void *data)
1291999e12bbSAnthony Liguori {
129239bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1293999e12bbSAnthony Liguori     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
1294999e12bbSAnthony Liguori 
1295999e12bbSAnthony Liguori     k->init = strongarm_uart_init;
129639bffca2SAnthony Liguori     dc->desc = "StrongARM UART controller";
129739bffca2SAnthony Liguori     dc->reset = strongarm_uart_reset;
129839bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_uart_regs;
129939bffca2SAnthony Liguori     dc->props = strongarm_uart_properties;
13005bc95aa2SDmitry Eremin-Solenikov }
1301999e12bbSAnthony Liguori 
13028c43a6f0SAndreas Färber static const TypeInfo strongarm_uart_info = {
1303999e12bbSAnthony Liguori     .name          = "strongarm-uart",
130439bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
130539bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMUARTState),
1306999e12bbSAnthony Liguori     .class_init    = strongarm_uart_class_init,
13075bc95aa2SDmitry Eremin-Solenikov };
13085bc95aa2SDmitry Eremin-Solenikov 
13095bc95aa2SDmitry Eremin-Solenikov /* Synchronous Serial Ports */
13105bc95aa2SDmitry Eremin-Solenikov typedef struct {
13115bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
1312eb2fefbcSAvi Kivity     MemoryRegion iomem;
13135bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
13145bc95aa2SDmitry Eremin-Solenikov     SSIBus *bus;
13155bc95aa2SDmitry Eremin-Solenikov 
13165bc95aa2SDmitry Eremin-Solenikov     uint16_t sscr[2];
13175bc95aa2SDmitry Eremin-Solenikov     uint16_t sssr;
13185bc95aa2SDmitry Eremin-Solenikov 
13195bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[8];
13205bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_level;
13215bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
13225bc95aa2SDmitry Eremin-Solenikov } StrongARMSSPState;
13235bc95aa2SDmitry Eremin-Solenikov 
13245bc95aa2SDmitry Eremin-Solenikov #define SSCR0 0x60 /* SSP Control register 0 */
13255bc95aa2SDmitry Eremin-Solenikov #define SSCR1 0x64 /* SSP Control register 1 */
13265bc95aa2SDmitry Eremin-Solenikov #define SSDR  0x6c /* SSP Data register */
13275bc95aa2SDmitry Eremin-Solenikov #define SSSR  0x74 /* SSP Status register */
13285bc95aa2SDmitry Eremin-Solenikov 
13295bc95aa2SDmitry Eremin-Solenikov /* Bitfields for above registers */
13305bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SPI(x)    (((x) & 0x30) == 0x00)
13315bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSP(x)    (((x) & 0x30) == 0x10)
13325bc95aa2SDmitry Eremin-Solenikov #define SSCR0_UWIRE(x)  (((x) & 0x30) == 0x20)
13335bc95aa2SDmitry Eremin-Solenikov #define SSCR0_PSP(x)    (((x) & 0x30) == 0x30)
13345bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSE       (1 << 7)
13355bc95aa2SDmitry Eremin-Solenikov #define SSCR0_DSS(x)    (((x) & 0xf) + 1)
13365bc95aa2SDmitry Eremin-Solenikov #define SSCR1_RIE       (1 << 0)
13375bc95aa2SDmitry Eremin-Solenikov #define SSCR1_TIE       (1 << 1)
13385bc95aa2SDmitry Eremin-Solenikov #define SSCR1_LBM       (1 << 2)
13395bc95aa2SDmitry Eremin-Solenikov #define SSSR_TNF        (1 << 2)
13405bc95aa2SDmitry Eremin-Solenikov #define SSSR_RNE        (1 << 3)
13415bc95aa2SDmitry Eremin-Solenikov #define SSSR_TFS        (1 << 5)
13425bc95aa2SDmitry Eremin-Solenikov #define SSSR_RFS        (1 << 6)
13435bc95aa2SDmitry Eremin-Solenikov #define SSSR_ROR        (1 << 7)
13445bc95aa2SDmitry Eremin-Solenikov #define SSSR_RW         0x0080
13455bc95aa2SDmitry Eremin-Solenikov 
13465bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_int_update(StrongARMSSPState *s)
13475bc95aa2SDmitry Eremin-Solenikov {
13485bc95aa2SDmitry Eremin-Solenikov     int level = 0;
13495bc95aa2SDmitry Eremin-Solenikov 
13505bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_ROR);
13515bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_RFS)  &&  (s->sscr[1] & SSCR1_RIE);
13525bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_TFS)  &&  (s->sscr[1] & SSCR1_TIE);
13535bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, level);
13545bc95aa2SDmitry Eremin-Solenikov }
13555bc95aa2SDmitry Eremin-Solenikov 
13565bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_fifo_update(StrongARMSSPState *s)
13575bc95aa2SDmitry Eremin-Solenikov {
13585bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TFS;
13595bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TNF;
13605bc95aa2SDmitry Eremin-Solenikov     if (s->sscr[0] & SSCR0_SSE) {
13615bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level >= 4) {
13625bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RFS;
13635bc95aa2SDmitry Eremin-Solenikov         } else {
13645bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RFS;
13655bc95aa2SDmitry Eremin-Solenikov         }
13665bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level) {
13675bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RNE;
13685bc95aa2SDmitry Eremin-Solenikov         } else {
13695bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RNE;
13705bc95aa2SDmitry Eremin-Solenikov         }
13715bc95aa2SDmitry Eremin-Solenikov         /* TX FIFO is never filled, so it is always in underrun
13725bc95aa2SDmitry Eremin-Solenikov            condition if SSP is enabled */
13735bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TFS;
13745bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TNF;
13755bc95aa2SDmitry Eremin-Solenikov     }
13765bc95aa2SDmitry Eremin-Solenikov 
13775bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_int_update(s);
13785bc95aa2SDmitry Eremin-Solenikov }
13795bc95aa2SDmitry Eremin-Solenikov 
1380a8170e5eSAvi Kivity static uint64_t strongarm_ssp_read(void *opaque, hwaddr addr,
1381eb2fefbcSAvi Kivity                                    unsigned size)
13825bc95aa2SDmitry Eremin-Solenikov {
13835bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
13845bc95aa2SDmitry Eremin-Solenikov     uint32_t retval;
13855bc95aa2SDmitry Eremin-Solenikov 
13865bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
13875bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
13885bc95aa2SDmitry Eremin-Solenikov         return s->sscr[0];
13895bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
13905bc95aa2SDmitry Eremin-Solenikov         return s->sscr[1];
13915bc95aa2SDmitry Eremin-Solenikov     case SSSR:
13925bc95aa2SDmitry Eremin-Solenikov         return s->sssr;
13935bc95aa2SDmitry Eremin-Solenikov     case SSDR:
13945bc95aa2SDmitry Eremin-Solenikov         if (~s->sscr[0] & SSCR0_SSE) {
13955bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
13965bc95aa2SDmitry Eremin-Solenikov         }
13975bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level < 1) {
13985bc95aa2SDmitry Eremin-Solenikov             printf("%s: SSP Rx Underrun\n", __func__);
13995bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
14005bc95aa2SDmitry Eremin-Solenikov         }
14015bc95aa2SDmitry Eremin-Solenikov         s->rx_level--;
14025bc95aa2SDmitry Eremin-Solenikov         retval = s->rx_fifo[s->rx_start++];
14035bc95aa2SDmitry Eremin-Solenikov         s->rx_start &= 0x7;
14045bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14055bc95aa2SDmitry Eremin-Solenikov         return retval;
14065bc95aa2SDmitry Eremin-Solenikov     default:
14075bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
14085bc95aa2SDmitry Eremin-Solenikov         break;
14095bc95aa2SDmitry Eremin-Solenikov     }
14105bc95aa2SDmitry Eremin-Solenikov     return 0;
14115bc95aa2SDmitry Eremin-Solenikov }
14125bc95aa2SDmitry Eremin-Solenikov 
1413a8170e5eSAvi Kivity static void strongarm_ssp_write(void *opaque, hwaddr addr,
1414eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
14155bc95aa2SDmitry Eremin-Solenikov {
14165bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14175bc95aa2SDmitry Eremin-Solenikov 
14185bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
14195bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
14205bc95aa2SDmitry Eremin-Solenikov         s->sscr[0] = value & 0xffbf;
14215bc95aa2SDmitry Eremin-Solenikov         if ((s->sscr[0] & SSCR0_SSE) && SSCR0_DSS(value) < 4) {
14225bc95aa2SDmitry Eremin-Solenikov             printf("%s: Wrong data size: %i bits\n", __func__,
1423eb2fefbcSAvi Kivity                    (int)SSCR0_DSS(value));
14245bc95aa2SDmitry Eremin-Solenikov         }
14255bc95aa2SDmitry Eremin-Solenikov         if (!(value & SSCR0_SSE)) {
14265bc95aa2SDmitry Eremin-Solenikov             s->sssr = 0;
14275bc95aa2SDmitry Eremin-Solenikov             s->rx_level = 0;
14285bc95aa2SDmitry Eremin-Solenikov         }
14295bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14305bc95aa2SDmitry Eremin-Solenikov         break;
14315bc95aa2SDmitry Eremin-Solenikov 
14325bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
14335bc95aa2SDmitry Eremin-Solenikov         s->sscr[1] = value & 0x2f;
14345bc95aa2SDmitry Eremin-Solenikov         if (value & SSCR1_LBM) {
14355bc95aa2SDmitry Eremin-Solenikov             printf("%s: Attempt to use SSP LBM mode\n", __func__);
14365bc95aa2SDmitry Eremin-Solenikov         }
14375bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14385bc95aa2SDmitry Eremin-Solenikov         break;
14395bc95aa2SDmitry Eremin-Solenikov 
14405bc95aa2SDmitry Eremin-Solenikov     case SSSR:
14415bc95aa2SDmitry Eremin-Solenikov         s->sssr &= ~(value & SSSR_RW);
14425bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_int_update(s);
14435bc95aa2SDmitry Eremin-Solenikov         break;
14445bc95aa2SDmitry Eremin-Solenikov 
14455bc95aa2SDmitry Eremin-Solenikov     case SSDR:
14465bc95aa2SDmitry Eremin-Solenikov         if (SSCR0_UWIRE(s->sscr[0])) {
14475bc95aa2SDmitry Eremin-Solenikov             value &= 0xff;
14485bc95aa2SDmitry Eremin-Solenikov         } else
14495bc95aa2SDmitry Eremin-Solenikov             /* Note how 32bits overflow does no harm here */
14505bc95aa2SDmitry Eremin-Solenikov             value &= (1 << SSCR0_DSS(s->sscr[0])) - 1;
14515bc95aa2SDmitry Eremin-Solenikov 
14525bc95aa2SDmitry Eremin-Solenikov         /* Data goes from here to the Tx FIFO and is shifted out from
14535bc95aa2SDmitry Eremin-Solenikov          * there directly to the slave, no need to buffer it.
14545bc95aa2SDmitry Eremin-Solenikov          */
14555bc95aa2SDmitry Eremin-Solenikov         if (s->sscr[0] & SSCR0_SSE) {
14565bc95aa2SDmitry Eremin-Solenikov             uint32_t readval;
14575bc95aa2SDmitry Eremin-Solenikov             if (s->sscr[1] & SSCR1_LBM) {
14585bc95aa2SDmitry Eremin-Solenikov                 readval = value;
14595bc95aa2SDmitry Eremin-Solenikov             } else {
14605bc95aa2SDmitry Eremin-Solenikov                 readval = ssi_transfer(s->bus, value);
14615bc95aa2SDmitry Eremin-Solenikov             }
14625bc95aa2SDmitry Eremin-Solenikov 
14635bc95aa2SDmitry Eremin-Solenikov             if (s->rx_level < 0x08) {
14645bc95aa2SDmitry Eremin-Solenikov                 s->rx_fifo[(s->rx_start + s->rx_level++) & 0x7] = readval;
14655bc95aa2SDmitry Eremin-Solenikov             } else {
14665bc95aa2SDmitry Eremin-Solenikov                 s->sssr |= SSSR_ROR;
14675bc95aa2SDmitry Eremin-Solenikov             }
14685bc95aa2SDmitry Eremin-Solenikov         }
14695bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14705bc95aa2SDmitry Eremin-Solenikov         break;
14715bc95aa2SDmitry Eremin-Solenikov 
14725bc95aa2SDmitry Eremin-Solenikov     default:
14735bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
14745bc95aa2SDmitry Eremin-Solenikov         break;
14755bc95aa2SDmitry Eremin-Solenikov     }
14765bc95aa2SDmitry Eremin-Solenikov }
14775bc95aa2SDmitry Eremin-Solenikov 
1478eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ssp_ops = {
1479eb2fefbcSAvi Kivity     .read = strongarm_ssp_read,
1480eb2fefbcSAvi Kivity     .write = strongarm_ssp_write,
1481eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
14825bc95aa2SDmitry Eremin-Solenikov };
14835bc95aa2SDmitry Eremin-Solenikov 
14845bc95aa2SDmitry Eremin-Solenikov static int strongarm_ssp_post_load(void *opaque, int version_id)
14855bc95aa2SDmitry Eremin-Solenikov {
14865bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14875bc95aa2SDmitry Eremin-Solenikov 
14885bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_fifo_update(s);
14895bc95aa2SDmitry Eremin-Solenikov 
14905bc95aa2SDmitry Eremin-Solenikov     return 0;
14915bc95aa2SDmitry Eremin-Solenikov }
14925bc95aa2SDmitry Eremin-Solenikov 
14935bc95aa2SDmitry Eremin-Solenikov static int strongarm_ssp_init(SysBusDevice *dev)
14945bc95aa2SDmitry Eremin-Solenikov {
14955bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = FROM_SYSBUS(StrongARMSSPState, dev);
14965bc95aa2SDmitry Eremin-Solenikov 
14975bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->irq);
14985bc95aa2SDmitry Eremin-Solenikov 
1499*2c9b15caSPaolo Bonzini     memory_region_init_io(&s->iomem, NULL, &strongarm_ssp_ops, s, "ssp", 0x1000);
1500750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
15015bc95aa2SDmitry Eremin-Solenikov 
15025bc95aa2SDmitry Eremin-Solenikov     s->bus = ssi_create_bus(&dev->qdev, "ssi");
15035bc95aa2SDmitry Eremin-Solenikov     return 0;
15045bc95aa2SDmitry Eremin-Solenikov }
15055bc95aa2SDmitry Eremin-Solenikov 
15065bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_reset(DeviceState *dev)
15075bc95aa2SDmitry Eremin-Solenikov {
15085bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = DO_UPCAST(StrongARMSSPState, busdev.qdev, dev);
15095bc95aa2SDmitry Eremin-Solenikov     s->sssr = 0x03; /* 3 bit data, SPI, disabled */
15105bc95aa2SDmitry Eremin-Solenikov     s->rx_start = 0;
15115bc95aa2SDmitry Eremin-Solenikov     s->rx_level = 0;
15125bc95aa2SDmitry Eremin-Solenikov }
15135bc95aa2SDmitry Eremin-Solenikov 
15145bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ssp_regs = {
15155bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ssp",
15165bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
15175bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
15185bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id_old = 0,
15195bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_ssp_post_load,
15205bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
15215bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(sscr, StrongARMSSPState, 2),
15225bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(sssr, StrongARMSSPState),
15235bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMSSPState, 8),
15245bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMSSPState),
15255bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_level, StrongARMSSPState),
15265bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
15275bc95aa2SDmitry Eremin-Solenikov     },
15285bc95aa2SDmitry Eremin-Solenikov };
15295bc95aa2SDmitry Eremin-Solenikov 
1530999e12bbSAnthony Liguori static void strongarm_ssp_class_init(ObjectClass *klass, void *data)
1531999e12bbSAnthony Liguori {
153239bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1533999e12bbSAnthony Liguori     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
1534999e12bbSAnthony Liguori 
1535999e12bbSAnthony Liguori     k->init = strongarm_ssp_init;
153639bffca2SAnthony Liguori     dc->desc = "StrongARM SSP controller";
153739bffca2SAnthony Liguori     dc->reset = strongarm_ssp_reset;
153839bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_ssp_regs;
1539999e12bbSAnthony Liguori }
1540999e12bbSAnthony Liguori 
15418c43a6f0SAndreas Färber static const TypeInfo strongarm_ssp_info = {
1542999e12bbSAnthony Liguori     .name          = "strongarm-ssp",
154339bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
154439bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMSSPState),
1545999e12bbSAnthony Liguori     .class_init    = strongarm_ssp_class_init,
15465bc95aa2SDmitry Eremin-Solenikov };
15475bc95aa2SDmitry Eremin-Solenikov 
15485bc95aa2SDmitry Eremin-Solenikov /* Main CPU functions */
1549eb2fefbcSAvi Kivity StrongARMState *sa1110_init(MemoryRegion *sysmem,
1550eb2fefbcSAvi Kivity                             unsigned int sdram_size, const char *rev)
15515bc95aa2SDmitry Eremin-Solenikov {
15525bc95aa2SDmitry Eremin-Solenikov     StrongARMState *s;
15535bc95aa2SDmitry Eremin-Solenikov     qemu_irq *pic;
15545bc95aa2SDmitry Eremin-Solenikov     int i;
15555bc95aa2SDmitry Eremin-Solenikov 
15567267c094SAnthony Liguori     s = g_malloc0(sizeof(StrongARMState));
15575bc95aa2SDmitry Eremin-Solenikov 
15585bc95aa2SDmitry Eremin-Solenikov     if (!rev) {
15595bc95aa2SDmitry Eremin-Solenikov         rev = "sa1110-b5";
15605bc95aa2SDmitry Eremin-Solenikov     }
15615bc95aa2SDmitry Eremin-Solenikov 
15625bc95aa2SDmitry Eremin-Solenikov     if (strncmp(rev, "sa1110", 6)) {
15636daf194dSMarkus Armbruster         error_report("Machine requires a SA1110 processor.");
15645bc95aa2SDmitry Eremin-Solenikov         exit(1);
15655bc95aa2SDmitry Eremin-Solenikov     }
15665bc95aa2SDmitry Eremin-Solenikov 
15678bf502e2SAndreas Färber     s->cpu = cpu_arm_init(rev);
15685bc95aa2SDmitry Eremin-Solenikov 
15698bf502e2SAndreas Färber     if (!s->cpu) {
15706daf194dSMarkus Armbruster         error_report("Unable to find CPU definition");
15715bc95aa2SDmitry Eremin-Solenikov         exit(1);
15725bc95aa2SDmitry Eremin-Solenikov     }
15735bc95aa2SDmitry Eremin-Solenikov 
1574*2c9b15caSPaolo Bonzini     memory_region_init_ram(&s->sdram, NULL, "strongarm.sdram", sdram_size);
1575c5705a77SAvi Kivity     vmstate_register_ram_global(&s->sdram);
1576eb2fefbcSAvi Kivity     memory_region_add_subregion(sysmem, SA_SDCS0, &s->sdram);
15775bc95aa2SDmitry Eremin-Solenikov 
15784bd74661SAndreas Färber     pic = arm_pic_init_cpu(s->cpu);
15795bc95aa2SDmitry Eremin-Solenikov     s->pic = sysbus_create_varargs("strongarm_pic", 0x90050000,
15805bc95aa2SDmitry Eremin-Solenikov                     pic[ARM_PIC_CPU_IRQ], pic[ARM_PIC_CPU_FIQ], NULL);
15815bc95aa2SDmitry Eremin-Solenikov 
15825bc95aa2SDmitry Eremin-Solenikov     sysbus_create_varargs("pxa25x-timer", 0x90000000,
15835bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC0),
15845bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC1),
15855bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC2),
15865bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC3),
15875bc95aa2SDmitry Eremin-Solenikov                     NULL);
15885bc95aa2SDmitry Eremin-Solenikov 
15895bc95aa2SDmitry Eremin-Solenikov     sysbus_create_simple("strongarm-rtc", 0x90010000,
15905bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_RTC_ALARM));
15915bc95aa2SDmitry Eremin-Solenikov 
15925bc95aa2SDmitry Eremin-Solenikov     s->gpio = strongarm_gpio_init(0x90040000, s->pic);
15935bc95aa2SDmitry Eremin-Solenikov 
15945bc95aa2SDmitry Eremin-Solenikov     s->ppc = sysbus_create_varargs("strongarm-ppc", 0x90060000, NULL);
15955bc95aa2SDmitry Eremin-Solenikov 
15965bc95aa2SDmitry Eremin-Solenikov     for (i = 0; sa_serial[i].io_base; i++) {
15975bc95aa2SDmitry Eremin-Solenikov         DeviceState *dev = qdev_create(NULL, "strongarm-uart");
15985bc95aa2SDmitry Eremin-Solenikov         qdev_prop_set_chr(dev, "chardev", serial_hds[i]);
15995bc95aa2SDmitry Eremin-Solenikov         qdev_init_nofail(dev);
16001356b98dSAndreas Färber         sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0,
16015bc95aa2SDmitry Eremin-Solenikov                 sa_serial[i].io_base);
16021356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0,
16035bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, sa_serial[i].irq));
16045bc95aa2SDmitry Eremin-Solenikov     }
16055bc95aa2SDmitry Eremin-Solenikov 
16065bc95aa2SDmitry Eremin-Solenikov     s->ssp = sysbus_create_varargs("strongarm-ssp", 0x80070000,
16075bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, SA_PIC_SSP), NULL);
16085bc95aa2SDmitry Eremin-Solenikov     s->ssp_bus = (SSIBus *)qdev_get_child_bus(s->ssp, "ssi");
16095bc95aa2SDmitry Eremin-Solenikov 
16105bc95aa2SDmitry Eremin-Solenikov     return s;
16115bc95aa2SDmitry Eremin-Solenikov }
16125bc95aa2SDmitry Eremin-Solenikov 
161383f7d43aSAndreas Färber static void strongarm_register_types(void)
16145bc95aa2SDmitry Eremin-Solenikov {
161539bffca2SAnthony Liguori     type_register_static(&strongarm_pic_info);
161639bffca2SAnthony Liguori     type_register_static(&strongarm_rtc_sysbus_info);
161739bffca2SAnthony Liguori     type_register_static(&strongarm_gpio_info);
161839bffca2SAnthony Liguori     type_register_static(&strongarm_ppc_info);
161939bffca2SAnthony Liguori     type_register_static(&strongarm_uart_info);
162039bffca2SAnthony Liguori     type_register_static(&strongarm_ssp_info);
16215bc95aa2SDmitry Eremin-Solenikov }
162283f7d43aSAndreas Färber 
162383f7d43aSAndreas Färber type_init(strongarm_register_types)
1624