xref: /qemu/hw/arm/strongarm.c (revision 9a93b2fa0ed8de66a9deb9106ce5ddc2a65d68f0)
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  */
29c8623c02SDirk Müller 
3012b16722SPeter Maydell #include "qemu/osdep.h"
314771d756SPaolo Bonzini #include "cpu.h"
32c8623c02SDirk Müller #include "hw/boards.h"
3383c9f4caSPaolo Bonzini #include "hw/sysbus.h"
3447b43a1fSPaolo Bonzini #include "strongarm.h"
351de7afc9SPaolo Bonzini #include "qemu/error-report.h"
36bd2be150SPeter Maydell #include "hw/arm/arm.h"
374d43a603SMarc-André Lureau #include "chardev/char-fe.h"
387566c6efSMarc-André Lureau #include "chardev/char-serial.h"
399c17d615SPaolo Bonzini #include "sysemu/sysemu.h"
408fd06719SAlistair Francis #include "hw/ssi/ssi.h"
41f348b6d1SVeronia Bahaa #include "qemu/cutils.h"
4203dd024fSPaolo Bonzini #include "qemu/log.h"
435bc95aa2SDmitry Eremin-Solenikov 
445bc95aa2SDmitry Eremin-Solenikov //#define DEBUG
455bc95aa2SDmitry Eremin-Solenikov 
465bc95aa2SDmitry Eremin-Solenikov /*
475bc95aa2SDmitry Eremin-Solenikov  TODO
485bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c14 ?
495bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c15 !!! (idle used in L)
505bc95aa2SDmitry Eremin-Solenikov  - Implement idle mode handling/DIM
515bc95aa2SDmitry Eremin-Solenikov  - Implement sleep mode/Wake sources
525bc95aa2SDmitry Eremin-Solenikov  - Implement reset control
535bc95aa2SDmitry Eremin-Solenikov  - Implement memory control regs
545bc95aa2SDmitry Eremin-Solenikov  - PCMCIA handling
555bc95aa2SDmitry Eremin-Solenikov  - Maybe support MBGNT/MBREQ
565bc95aa2SDmitry Eremin-Solenikov  - DMA channels
575bc95aa2SDmitry Eremin-Solenikov  - GPCLK
585bc95aa2SDmitry Eremin-Solenikov  - IrDA
595bc95aa2SDmitry Eremin-Solenikov  - MCP
605bc95aa2SDmitry Eremin-Solenikov  - Enhance UART with modem signals
615bc95aa2SDmitry Eremin-Solenikov  */
625bc95aa2SDmitry Eremin-Solenikov 
635bc95aa2SDmitry Eremin-Solenikov #ifdef DEBUG
645bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) printf(format , ## __VA_ARGS__)
655bc95aa2SDmitry Eremin-Solenikov #else
665bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) do { } while (0)
675bc95aa2SDmitry Eremin-Solenikov #endif
685bc95aa2SDmitry Eremin-Solenikov 
695bc95aa2SDmitry Eremin-Solenikov static struct {
70a8170e5eSAvi Kivity     hwaddr io_base;
715bc95aa2SDmitry Eremin-Solenikov     int irq;
725bc95aa2SDmitry Eremin-Solenikov } sa_serial[] = {
735bc95aa2SDmitry Eremin-Solenikov     { 0x80010000, SA_PIC_UART1 },
745bc95aa2SDmitry Eremin-Solenikov     { 0x80030000, SA_PIC_UART2 },
755bc95aa2SDmitry Eremin-Solenikov     { 0x80050000, SA_PIC_UART3 },
765bc95aa2SDmitry Eremin-Solenikov     { 0, 0 }
775bc95aa2SDmitry Eremin-Solenikov };
785bc95aa2SDmitry Eremin-Solenikov 
795bc95aa2SDmitry Eremin-Solenikov /* Interrupt Controller */
8074e075f6SAndreas Färber 
8174e075f6SAndreas Färber #define TYPE_STRONGARM_PIC "strongarm_pic"
8274e075f6SAndreas Färber #define STRONGARM_PIC(obj) \
8374e075f6SAndreas Färber     OBJECT_CHECK(StrongARMPICState, (obj), TYPE_STRONGARM_PIC)
8474e075f6SAndreas Färber 
8574e075f6SAndreas Färber typedef struct StrongARMPICState {
8674e075f6SAndreas Färber     SysBusDevice parent_obj;
8774e075f6SAndreas Färber 
88eb2fefbcSAvi Kivity     MemoryRegion iomem;
895bc95aa2SDmitry Eremin-Solenikov     qemu_irq    irq;
905bc95aa2SDmitry Eremin-Solenikov     qemu_irq    fiq;
915bc95aa2SDmitry Eremin-Solenikov 
925bc95aa2SDmitry Eremin-Solenikov     uint32_t pending;
935bc95aa2SDmitry Eremin-Solenikov     uint32_t enabled;
945bc95aa2SDmitry Eremin-Solenikov     uint32_t is_fiq;
955bc95aa2SDmitry Eremin-Solenikov     uint32_t int_idle;
965bc95aa2SDmitry Eremin-Solenikov } StrongARMPICState;
975bc95aa2SDmitry Eremin-Solenikov 
985bc95aa2SDmitry Eremin-Solenikov #define ICIP    0x00
995bc95aa2SDmitry Eremin-Solenikov #define ICMR    0x04
1005bc95aa2SDmitry Eremin-Solenikov #define ICLR    0x08
1015bc95aa2SDmitry Eremin-Solenikov #define ICFP    0x10
1025bc95aa2SDmitry Eremin-Solenikov #define ICPR    0x20
1035bc95aa2SDmitry Eremin-Solenikov #define ICCR    0x0c
1045bc95aa2SDmitry Eremin-Solenikov 
1055bc95aa2SDmitry Eremin-Solenikov #define SA_PIC_SRCS     32
1065bc95aa2SDmitry Eremin-Solenikov 
1075bc95aa2SDmitry Eremin-Solenikov 
1085bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_update(void *opaque)
1095bc95aa2SDmitry Eremin-Solenikov {
1105bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1115bc95aa2SDmitry Eremin-Solenikov 
1125bc95aa2SDmitry Eremin-Solenikov     /* FIXME: reflect DIM */
1135bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->fiq, s->pending & s->enabled &  s->is_fiq);
1145bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, s->pending & s->enabled & ~s->is_fiq);
1155bc95aa2SDmitry Eremin-Solenikov }
1165bc95aa2SDmitry Eremin-Solenikov 
1175bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_set_irq(void *opaque, int irq, int level)
1185bc95aa2SDmitry Eremin-Solenikov {
1195bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1205bc95aa2SDmitry Eremin-Solenikov 
1215bc95aa2SDmitry Eremin-Solenikov     if (level) {
1225bc95aa2SDmitry Eremin-Solenikov         s->pending |= 1 << irq;
1235bc95aa2SDmitry Eremin-Solenikov     } else {
1245bc95aa2SDmitry Eremin-Solenikov         s->pending &= ~(1 << irq);
1255bc95aa2SDmitry Eremin-Solenikov     }
1265bc95aa2SDmitry Eremin-Solenikov 
1275bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1285bc95aa2SDmitry Eremin-Solenikov }
1295bc95aa2SDmitry Eremin-Solenikov 
130a8170e5eSAvi Kivity static uint64_t strongarm_pic_mem_read(void *opaque, hwaddr offset,
131eb2fefbcSAvi Kivity                                        unsigned size)
1325bc95aa2SDmitry Eremin-Solenikov {
1335bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1345bc95aa2SDmitry Eremin-Solenikov 
1355bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1365bc95aa2SDmitry Eremin-Solenikov     case ICIP:
1375bc95aa2SDmitry Eremin-Solenikov         return s->pending & ~s->is_fiq & s->enabled;
1385bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1395bc95aa2SDmitry Eremin-Solenikov         return s->enabled;
1405bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1415bc95aa2SDmitry Eremin-Solenikov         return s->is_fiq;
1425bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1435bc95aa2SDmitry Eremin-Solenikov         return s->int_idle == 0;
1445bc95aa2SDmitry Eremin-Solenikov     case ICFP:
1455bc95aa2SDmitry Eremin-Solenikov         return s->pending & s->is_fiq & s->enabled;
1465bc95aa2SDmitry Eremin-Solenikov     case ICPR:
1475bc95aa2SDmitry Eremin-Solenikov         return s->pending;
1485bc95aa2SDmitry Eremin-Solenikov     default:
1495bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1505bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1515bc95aa2SDmitry Eremin-Solenikov         return 0;
1525bc95aa2SDmitry Eremin-Solenikov     }
1535bc95aa2SDmitry Eremin-Solenikov }
1545bc95aa2SDmitry Eremin-Solenikov 
155a8170e5eSAvi Kivity static void strongarm_pic_mem_write(void *opaque, hwaddr offset,
156eb2fefbcSAvi Kivity                                     uint64_t value, unsigned size)
1575bc95aa2SDmitry Eremin-Solenikov {
1585bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1595bc95aa2SDmitry Eremin-Solenikov 
1605bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1615bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1625bc95aa2SDmitry Eremin-Solenikov         s->enabled = value;
1635bc95aa2SDmitry Eremin-Solenikov         break;
1645bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1655bc95aa2SDmitry Eremin-Solenikov         s->is_fiq = value;
1665bc95aa2SDmitry Eremin-Solenikov         break;
1675bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1685bc95aa2SDmitry Eremin-Solenikov         s->int_idle = (value & 1) ? 0 : ~0;
1695bc95aa2SDmitry Eremin-Solenikov         break;
1705bc95aa2SDmitry Eremin-Solenikov     default:
1715bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1725bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1735bc95aa2SDmitry Eremin-Solenikov         break;
1745bc95aa2SDmitry Eremin-Solenikov     }
1755bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1765bc95aa2SDmitry Eremin-Solenikov }
1775bc95aa2SDmitry Eremin-Solenikov 
178eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_pic_ops = {
179eb2fefbcSAvi Kivity     .read = strongarm_pic_mem_read,
180eb2fefbcSAvi Kivity     .write = strongarm_pic_mem_write,
181eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
1825bc95aa2SDmitry Eremin-Solenikov };
1835bc95aa2SDmitry Eremin-Solenikov 
1845a67508cSxiaoqiang.zhao static void strongarm_pic_initfn(Object *obj)
1855bc95aa2SDmitry Eremin-Solenikov {
1865a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
1875a67508cSxiaoqiang.zhao     StrongARMPICState *s = STRONGARM_PIC(obj);
1885a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
1895bc95aa2SDmitry Eremin-Solenikov 
19074e075f6SAndreas Färber     qdev_init_gpio_in(dev, strongarm_pic_set_irq, SA_PIC_SRCS);
1915a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_pic_ops, s,
19264bde0f3SPaolo Bonzini                           "pic", 0x1000);
19374e075f6SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
19474e075f6SAndreas Färber     sysbus_init_irq(sbd, &s->irq);
19574e075f6SAndreas Färber     sysbus_init_irq(sbd, &s->fiq);
1965bc95aa2SDmitry Eremin-Solenikov }
1975bc95aa2SDmitry Eremin-Solenikov 
1985bc95aa2SDmitry Eremin-Solenikov static int strongarm_pic_post_load(void *opaque, int version_id)
1995bc95aa2SDmitry Eremin-Solenikov {
2005bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(opaque);
2015bc95aa2SDmitry Eremin-Solenikov     return 0;
2025bc95aa2SDmitry Eremin-Solenikov }
2035bc95aa2SDmitry Eremin-Solenikov 
2045bc95aa2SDmitry Eremin-Solenikov static VMStateDescription vmstate_strongarm_pic_regs = {
2055bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm_pic",
2065bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
2075bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
2085bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_pic_post_load,
2095bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
2105bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(pending, StrongARMPICState),
2115bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(enabled, StrongARMPICState),
2125bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(is_fiq, StrongARMPICState),
2135bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(int_idle, StrongARMPICState),
2145bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
2155bc95aa2SDmitry Eremin-Solenikov     },
2165bc95aa2SDmitry Eremin-Solenikov };
2175bc95aa2SDmitry Eremin-Solenikov 
218999e12bbSAnthony Liguori static void strongarm_pic_class_init(ObjectClass *klass, void *data)
219999e12bbSAnthony Liguori {
22039bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
221999e12bbSAnthony Liguori 
22239bffca2SAnthony Liguori     dc->desc = "StrongARM PIC";
22339bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_pic_regs;
224999e12bbSAnthony Liguori }
225999e12bbSAnthony Liguori 
2268c43a6f0SAndreas Färber static const TypeInfo strongarm_pic_info = {
22774e075f6SAndreas Färber     .name          = TYPE_STRONGARM_PIC,
22839bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
22939bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPICState),
2305a67508cSxiaoqiang.zhao     .instance_init = strongarm_pic_initfn,
231999e12bbSAnthony Liguori     .class_init    = strongarm_pic_class_init,
2325bc95aa2SDmitry Eremin-Solenikov };
2335bc95aa2SDmitry Eremin-Solenikov 
2345bc95aa2SDmitry Eremin-Solenikov /* Real-Time Clock */
2355bc95aa2SDmitry Eremin-Solenikov #define RTAR 0x00 /* RTC Alarm register */
2365bc95aa2SDmitry Eremin-Solenikov #define RCNR 0x04 /* RTC Counter register */
2375bc95aa2SDmitry Eremin-Solenikov #define RTTR 0x08 /* RTC Timer Trim register */
2385bc95aa2SDmitry Eremin-Solenikov #define RTSR 0x10 /* RTC Status register */
2395bc95aa2SDmitry Eremin-Solenikov 
2405bc95aa2SDmitry Eremin-Solenikov #define RTSR_AL (1 << 0) /* RTC Alarm detected */
2415bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZ (1 << 1) /* RTC 1Hz detected */
2425bc95aa2SDmitry Eremin-Solenikov #define RTSR_ALE (1 << 2) /* RTC Alarm enable */
2435bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZE (1 << 3) /* RTC 1Hz enable */
2445bc95aa2SDmitry Eremin-Solenikov 
2455bc95aa2SDmitry Eremin-Solenikov /* 16 LSB of RTTR are clockdiv for internal trim logic,
2465bc95aa2SDmitry Eremin-Solenikov  * trim delete isn't emulated, so
2475bc95aa2SDmitry Eremin-Solenikov  * f = 32 768 / (RTTR_trim + 1) */
2485bc95aa2SDmitry Eremin-Solenikov 
2494e002105SAndreas Färber #define TYPE_STRONGARM_RTC "strongarm-rtc"
2504e002105SAndreas Färber #define STRONGARM_RTC(obj) \
2514e002105SAndreas Färber     OBJECT_CHECK(StrongARMRTCState, (obj), TYPE_STRONGARM_RTC)
2524e002105SAndreas Färber 
2534e002105SAndreas Färber typedef struct StrongARMRTCState {
2544e002105SAndreas Färber     SysBusDevice parent_obj;
2554e002105SAndreas Färber 
256eb2fefbcSAvi Kivity     MemoryRegion iomem;
2575bc95aa2SDmitry Eremin-Solenikov     uint32_t rttr;
2585bc95aa2SDmitry Eremin-Solenikov     uint32_t rtsr;
2595bc95aa2SDmitry Eremin-Solenikov     uint32_t rtar;
2605bc95aa2SDmitry Eremin-Solenikov     uint32_t last_rcnr;
2615bc95aa2SDmitry Eremin-Solenikov     int64_t last_hz;
2625bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_alarm;
2635bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_hz;
2645bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_irq;
2655bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_hz_irq;
2665bc95aa2SDmitry Eremin-Solenikov } StrongARMRTCState;
2675bc95aa2SDmitry Eremin-Solenikov 
2685bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_int_update(StrongARMRTCState *s)
2695bc95aa2SDmitry Eremin-Solenikov {
2705bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_irq, s->rtsr & RTSR_AL);
2715bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_hz_irq, s->rtsr & RTSR_HZ);
2725bc95aa2SDmitry Eremin-Solenikov }
2735bc95aa2SDmitry Eremin-Solenikov 
2745bc95aa2SDmitry Eremin-Solenikov static void strongarm_rtc_hzupdate(StrongARMRTCState *s)
2755bc95aa2SDmitry Eremin-Solenikov {
276884f17c2SAlex Bligh     int64_t rt = qemu_clock_get_ms(rtc_clock);
2775bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr += ((rt - s->last_hz) << 15) /
2785bc95aa2SDmitry Eremin-Solenikov             (1000 * ((s->rttr & 0xffff) + 1));
2795bc95aa2SDmitry Eremin-Solenikov     s->last_hz = rt;
2805bc95aa2SDmitry Eremin-Solenikov }
2815bc95aa2SDmitry Eremin-Solenikov 
2825bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_timer_update(StrongARMRTCState *s)
2835bc95aa2SDmitry Eremin-Solenikov {
2845bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_HZE) && !(s->rtsr & RTSR_HZ)) {
285bc72ad67SAlex Bligh         timer_mod(s->rtc_hz, s->last_hz + 1000);
2865bc95aa2SDmitry Eremin-Solenikov     } else {
287bc72ad67SAlex Bligh         timer_del(s->rtc_hz);
2885bc95aa2SDmitry Eremin-Solenikov     }
2895bc95aa2SDmitry Eremin-Solenikov 
2905bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_ALE) && !(s->rtsr & RTSR_AL)) {
291bc72ad67SAlex Bligh         timer_mod(s->rtc_alarm, s->last_hz +
2925bc95aa2SDmitry Eremin-Solenikov                 (((s->rtar - s->last_rcnr) * 1000 *
2935bc95aa2SDmitry Eremin-Solenikov                   ((s->rttr & 0xffff) + 1)) >> 15));
2945bc95aa2SDmitry Eremin-Solenikov     } else {
295bc72ad67SAlex Bligh         timer_del(s->rtc_alarm);
2965bc95aa2SDmitry Eremin-Solenikov     }
2975bc95aa2SDmitry Eremin-Solenikov }
2985bc95aa2SDmitry Eremin-Solenikov 
2995bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_alarm_tick(void *opaque)
3005bc95aa2SDmitry Eremin-Solenikov {
3015bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3025bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_AL;
3035bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
3045bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
3055bc95aa2SDmitry Eremin-Solenikov }
3065bc95aa2SDmitry Eremin-Solenikov 
3075bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_hz_tick(void *opaque)
3085bc95aa2SDmitry Eremin-Solenikov {
3095bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3105bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_HZ;
3115bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
3125bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
3135bc95aa2SDmitry Eremin-Solenikov }
3145bc95aa2SDmitry Eremin-Solenikov 
315a8170e5eSAvi Kivity static uint64_t strongarm_rtc_read(void *opaque, hwaddr addr,
316eb2fefbcSAvi Kivity                                    unsigned size)
3175bc95aa2SDmitry Eremin-Solenikov {
3185bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3195bc95aa2SDmitry Eremin-Solenikov 
3205bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3215bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3225bc95aa2SDmitry Eremin-Solenikov         return s->rttr;
3235bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3245bc95aa2SDmitry Eremin-Solenikov         return s->rtsr;
3255bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3265bc95aa2SDmitry Eremin-Solenikov         return s->rtar;
3275bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3285bc95aa2SDmitry Eremin-Solenikov         return s->last_rcnr +
329884f17c2SAlex Bligh                 ((qemu_clock_get_ms(rtc_clock) - s->last_hz) << 15) /
3305bc95aa2SDmitry Eremin-Solenikov                 (1000 * ((s->rttr & 0xffff) + 1));
3315bc95aa2SDmitry Eremin-Solenikov     default:
3325bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3335bc95aa2SDmitry Eremin-Solenikov         return 0;
3345bc95aa2SDmitry Eremin-Solenikov     }
3355bc95aa2SDmitry Eremin-Solenikov }
3365bc95aa2SDmitry Eremin-Solenikov 
337a8170e5eSAvi Kivity static void strongarm_rtc_write(void *opaque, hwaddr addr,
338eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
3395bc95aa2SDmitry Eremin-Solenikov {
3405bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3415bc95aa2SDmitry Eremin-Solenikov     uint32_t old_rtsr;
3425bc95aa2SDmitry Eremin-Solenikov 
3435bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3445bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3455bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3465bc95aa2SDmitry Eremin-Solenikov         s->rttr = value;
3475bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3485bc95aa2SDmitry Eremin-Solenikov         break;
3495bc95aa2SDmitry Eremin-Solenikov 
3505bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3515bc95aa2SDmitry Eremin-Solenikov         old_rtsr = s->rtsr;
3525bc95aa2SDmitry Eremin-Solenikov         s->rtsr = (value & (RTSR_ALE | RTSR_HZE)) |
3535bc95aa2SDmitry Eremin-Solenikov                   (s->rtsr & ~(value & (RTSR_AL | RTSR_HZ)));
3545bc95aa2SDmitry Eremin-Solenikov 
3555bc95aa2SDmitry Eremin-Solenikov         if (s->rtsr != old_rtsr) {
3565bc95aa2SDmitry Eremin-Solenikov             strongarm_rtc_timer_update(s);
3575bc95aa2SDmitry Eremin-Solenikov         }
3585bc95aa2SDmitry Eremin-Solenikov 
3595bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_int_update(s);
3605bc95aa2SDmitry Eremin-Solenikov         break;
3615bc95aa2SDmitry Eremin-Solenikov 
3625bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3635bc95aa2SDmitry Eremin-Solenikov         s->rtar = value;
3645bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3655bc95aa2SDmitry Eremin-Solenikov         break;
3665bc95aa2SDmitry Eremin-Solenikov 
3675bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3685bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3695bc95aa2SDmitry Eremin-Solenikov         s->last_rcnr = value;
3705bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3715bc95aa2SDmitry Eremin-Solenikov         break;
3725bc95aa2SDmitry Eremin-Solenikov 
3735bc95aa2SDmitry Eremin-Solenikov     default:
3745bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3755bc95aa2SDmitry Eremin-Solenikov     }
3765bc95aa2SDmitry Eremin-Solenikov }
3775bc95aa2SDmitry Eremin-Solenikov 
378eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_rtc_ops = {
379eb2fefbcSAvi Kivity     .read = strongarm_rtc_read,
380eb2fefbcSAvi Kivity     .write = strongarm_rtc_write,
381eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
3825bc95aa2SDmitry Eremin-Solenikov };
3835bc95aa2SDmitry Eremin-Solenikov 
3845a67508cSxiaoqiang.zhao static void strongarm_rtc_init(Object *obj)
3855bc95aa2SDmitry Eremin-Solenikov {
3865a67508cSxiaoqiang.zhao     StrongARMRTCState *s = STRONGARM_RTC(obj);
3875a67508cSxiaoqiang.zhao     SysBusDevice *dev = SYS_BUS_DEVICE(obj);
3885bc95aa2SDmitry Eremin-Solenikov     struct tm tm;
3895bc95aa2SDmitry Eremin-Solenikov 
3905bc95aa2SDmitry Eremin-Solenikov     s->rttr = 0x0;
3915bc95aa2SDmitry Eremin-Solenikov     s->rtsr = 0;
3925bc95aa2SDmitry Eremin-Solenikov 
3935bc95aa2SDmitry Eremin-Solenikov     qemu_get_timedate(&tm, 0);
3945bc95aa2SDmitry Eremin-Solenikov 
3955bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr = (uint32_t) mktimegm(&tm);
396884f17c2SAlex Bligh     s->last_hz = qemu_clock_get_ms(rtc_clock);
3975bc95aa2SDmitry Eremin-Solenikov 
398884f17c2SAlex Bligh     s->rtc_alarm = timer_new_ms(rtc_clock, strongarm_rtc_alarm_tick, s);
399884f17c2SAlex Bligh     s->rtc_hz = timer_new_ms(rtc_clock, strongarm_rtc_hz_tick, s);
4005bc95aa2SDmitry Eremin-Solenikov 
4015bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_irq);
4025bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_hz_irq);
4035bc95aa2SDmitry Eremin-Solenikov 
4045a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_rtc_ops, s,
40564bde0f3SPaolo Bonzini                           "rtc", 0x10000);
406750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
4075bc95aa2SDmitry Eremin-Solenikov }
4085bc95aa2SDmitry Eremin-Solenikov 
40944b1ff31SDr. David Alan Gilbert static int strongarm_rtc_pre_save(void *opaque)
4105bc95aa2SDmitry Eremin-Solenikov {
4115bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
4125bc95aa2SDmitry Eremin-Solenikov 
4135bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_hzupdate(s);
41444b1ff31SDr. David Alan Gilbert 
41544b1ff31SDr. David Alan Gilbert     return 0;
4165bc95aa2SDmitry Eremin-Solenikov }
4175bc95aa2SDmitry Eremin-Solenikov 
4185bc95aa2SDmitry Eremin-Solenikov static int strongarm_rtc_post_load(void *opaque, int version_id)
4195bc95aa2SDmitry Eremin-Solenikov {
4205bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
4215bc95aa2SDmitry Eremin-Solenikov 
4225bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
4235bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
4245bc95aa2SDmitry Eremin-Solenikov 
4255bc95aa2SDmitry Eremin-Solenikov     return 0;
4265bc95aa2SDmitry Eremin-Solenikov }
4275bc95aa2SDmitry Eremin-Solenikov 
4285bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_rtc_regs = {
4295bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-rtc",
4305bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
4315bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
4325bc95aa2SDmitry Eremin-Solenikov     .pre_save = strongarm_rtc_pre_save,
4335bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_rtc_post_load,
4345bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
4355bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rttr, StrongARMRTCState),
4365bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtsr, StrongARMRTCState),
4375bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtar, StrongARMRTCState),
4385bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(last_rcnr, StrongARMRTCState),
4395bc95aa2SDmitry Eremin-Solenikov         VMSTATE_INT64(last_hz, StrongARMRTCState),
4405bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
4415bc95aa2SDmitry Eremin-Solenikov     },
4425bc95aa2SDmitry Eremin-Solenikov };
4435bc95aa2SDmitry Eremin-Solenikov 
444999e12bbSAnthony Liguori static void strongarm_rtc_sysbus_class_init(ObjectClass *klass, void *data)
445999e12bbSAnthony Liguori {
44639bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
447999e12bbSAnthony Liguori 
44839bffca2SAnthony Liguori     dc->desc = "StrongARM RTC Controller";
44939bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_rtc_regs;
450999e12bbSAnthony Liguori }
451999e12bbSAnthony Liguori 
4528c43a6f0SAndreas Färber static const TypeInfo strongarm_rtc_sysbus_info = {
4534e002105SAndreas Färber     .name          = TYPE_STRONGARM_RTC,
45439bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
45539bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMRTCState),
4565a67508cSxiaoqiang.zhao     .instance_init = strongarm_rtc_init,
457999e12bbSAnthony Liguori     .class_init    = strongarm_rtc_sysbus_class_init,
4585bc95aa2SDmitry Eremin-Solenikov };
4595bc95aa2SDmitry Eremin-Solenikov 
4605bc95aa2SDmitry Eremin-Solenikov /* GPIO */
4615bc95aa2SDmitry Eremin-Solenikov #define GPLR 0x00
4625bc95aa2SDmitry Eremin-Solenikov #define GPDR 0x04
4635bc95aa2SDmitry Eremin-Solenikov #define GPSR 0x08
4645bc95aa2SDmitry Eremin-Solenikov #define GPCR 0x0c
4655bc95aa2SDmitry Eremin-Solenikov #define GRER 0x10
4665bc95aa2SDmitry Eremin-Solenikov #define GFER 0x14
4675bc95aa2SDmitry Eremin-Solenikov #define GEDR 0x18
4685bc95aa2SDmitry Eremin-Solenikov #define GAFR 0x1c
4695bc95aa2SDmitry Eremin-Solenikov 
470f55beb84SAndreas Färber #define TYPE_STRONGARM_GPIO "strongarm-gpio"
471f55beb84SAndreas Färber #define STRONGARM_GPIO(obj) \
472f55beb84SAndreas Färber     OBJECT_CHECK(StrongARMGPIOInfo, (obj), TYPE_STRONGARM_GPIO)
473f55beb84SAndreas Färber 
4745bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMGPIOInfo StrongARMGPIOInfo;
4755bc95aa2SDmitry Eremin-Solenikov struct StrongARMGPIOInfo {
4765bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
477eb2fefbcSAvi Kivity     MemoryRegion iomem;
4785bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
4795bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqs[11];
4805bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqX;
4815bc95aa2SDmitry Eremin-Solenikov 
4825bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
4835bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
4845bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
4855bc95aa2SDmitry Eremin-Solenikov     uint32_t rising;
4865bc95aa2SDmitry Eremin-Solenikov     uint32_t falling;
4875bc95aa2SDmitry Eremin-Solenikov     uint32_t status;
4885bc95aa2SDmitry Eremin-Solenikov     uint32_t gafr;
4895bc95aa2SDmitry Eremin-Solenikov 
4905bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
4915bc95aa2SDmitry Eremin-Solenikov };
4925bc95aa2SDmitry Eremin-Solenikov 
4935bc95aa2SDmitry Eremin-Solenikov 
4945bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_irq_update(StrongARMGPIOInfo *s)
4955bc95aa2SDmitry Eremin-Solenikov {
4965bc95aa2SDmitry Eremin-Solenikov     int i;
4975bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
4985bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->irqs[i], s->status & (1 << i));
4995bc95aa2SDmitry Eremin-Solenikov     }
5005bc95aa2SDmitry Eremin-Solenikov 
5015bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irqX, (s->status & ~0x7ff));
5025bc95aa2SDmitry Eremin-Solenikov }
5035bc95aa2SDmitry Eremin-Solenikov 
5045bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_set(void *opaque, int line, int level)
5055bc95aa2SDmitry Eremin-Solenikov {
5065bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5075bc95aa2SDmitry Eremin-Solenikov     uint32_t mask;
5085bc95aa2SDmitry Eremin-Solenikov 
5095bc95aa2SDmitry Eremin-Solenikov     mask = 1 << line;
5105bc95aa2SDmitry Eremin-Solenikov 
5115bc95aa2SDmitry Eremin-Solenikov     if (level) {
5125bc95aa2SDmitry Eremin-Solenikov         s->status |= s->rising & mask &
5135bc95aa2SDmitry Eremin-Solenikov                 ~s->ilevel & ~s->dir;
5145bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= mask;
5155bc95aa2SDmitry Eremin-Solenikov     } else {
5165bc95aa2SDmitry Eremin-Solenikov         s->status |= s->falling & mask &
5175bc95aa2SDmitry Eremin-Solenikov                 s->ilevel & ~s->dir;
5185bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~mask;
5195bc95aa2SDmitry Eremin-Solenikov     }
5205bc95aa2SDmitry Eremin-Solenikov 
5215bc95aa2SDmitry Eremin-Solenikov     if (s->status & mask) {
5225bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
5235bc95aa2SDmitry Eremin-Solenikov     }
5245bc95aa2SDmitry Eremin-Solenikov }
5255bc95aa2SDmitry Eremin-Solenikov 
5265bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_handler_update(StrongARMGPIOInfo *s)
5275bc95aa2SDmitry Eremin-Solenikov {
5285bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
5295bc95aa2SDmitry Eremin-Solenikov     int bit;
5305bc95aa2SDmitry Eremin-Solenikov 
5315bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
5325bc95aa2SDmitry Eremin-Solenikov 
5335bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
534786a4ea8SStefan Hajnoczi         bit = ctz32(diff);
5355bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
5365bc95aa2SDmitry Eremin-Solenikov     }
5375bc95aa2SDmitry Eremin-Solenikov 
5385bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
5395bc95aa2SDmitry Eremin-Solenikov }
5405bc95aa2SDmitry Eremin-Solenikov 
541a8170e5eSAvi Kivity static uint64_t strongarm_gpio_read(void *opaque, hwaddr offset,
542eb2fefbcSAvi Kivity                                     unsigned size)
5435bc95aa2SDmitry Eremin-Solenikov {
5445bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5455bc95aa2SDmitry Eremin-Solenikov 
5465bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5475bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
5485bc95aa2SDmitry Eremin-Solenikov         return s->dir;
5495bc95aa2SDmitry Eremin-Solenikov 
5505bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
55192335a0dSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
55292335a0dSPeter Maydell                       "strongarm GPIO: read from write only register GPSR\n");
55392335a0dSPeter Maydell         return 0;
5545bc95aa2SDmitry Eremin-Solenikov 
5555bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
55692335a0dSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
55792335a0dSPeter Maydell                       "strongarm GPIO: read from write only register GPCR\n");
55892335a0dSPeter Maydell         return 0;
5595bc95aa2SDmitry Eremin-Solenikov 
5605bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
5615bc95aa2SDmitry Eremin-Solenikov         return s->rising;
5625bc95aa2SDmitry Eremin-Solenikov 
5635bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
5645bc95aa2SDmitry Eremin-Solenikov         return s->falling;
5655bc95aa2SDmitry Eremin-Solenikov 
5665bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
5675bc95aa2SDmitry Eremin-Solenikov         return s->gafr;
5685bc95aa2SDmitry Eremin-Solenikov 
5695bc95aa2SDmitry Eremin-Solenikov     case GPLR:        /* GPIO Pin-Level registers */
5705bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
5715bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir);
5725bc95aa2SDmitry Eremin-Solenikov 
5735bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
5745bc95aa2SDmitry Eremin-Solenikov         return s->status;
5755bc95aa2SDmitry Eremin-Solenikov 
5765bc95aa2SDmitry Eremin-Solenikov     default:
5775bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
5785bc95aa2SDmitry Eremin-Solenikov     }
5795bc95aa2SDmitry Eremin-Solenikov 
5805bc95aa2SDmitry Eremin-Solenikov     return 0;
5815bc95aa2SDmitry Eremin-Solenikov }
5825bc95aa2SDmitry Eremin-Solenikov 
583a8170e5eSAvi Kivity static void strongarm_gpio_write(void *opaque, hwaddr offset,
584eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
5855bc95aa2SDmitry Eremin-Solenikov {
5865bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5875bc95aa2SDmitry Eremin-Solenikov 
5885bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5895bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
590*9a93b2faSPrasad J Pandit         s->dir = value & 0x0fffffff;
5915bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
5925bc95aa2SDmitry Eremin-Solenikov         break;
5935bc95aa2SDmitry Eremin-Solenikov 
5945bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
595*9a93b2faSPrasad J Pandit         s->olevel |= value & 0x0fffffff;
5965bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
5975bc95aa2SDmitry Eremin-Solenikov         break;
5985bc95aa2SDmitry Eremin-Solenikov 
5995bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
6005bc95aa2SDmitry Eremin-Solenikov         s->olevel &= ~value;
6015bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
6025bc95aa2SDmitry Eremin-Solenikov         break;
6035bc95aa2SDmitry Eremin-Solenikov 
6045bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
6055bc95aa2SDmitry Eremin-Solenikov         s->rising = value;
6065bc95aa2SDmitry Eremin-Solenikov         break;
6075bc95aa2SDmitry Eremin-Solenikov 
6085bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
6095bc95aa2SDmitry Eremin-Solenikov         s->falling = value;
6105bc95aa2SDmitry Eremin-Solenikov         break;
6115bc95aa2SDmitry Eremin-Solenikov 
6125bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
6135bc95aa2SDmitry Eremin-Solenikov         s->gafr = value;
6145bc95aa2SDmitry Eremin-Solenikov         break;
6155bc95aa2SDmitry Eremin-Solenikov 
6165bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
6175bc95aa2SDmitry Eremin-Solenikov         s->status &= ~value;
6185bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
6195bc95aa2SDmitry Eremin-Solenikov         break;
6205bc95aa2SDmitry Eremin-Solenikov 
6215bc95aa2SDmitry Eremin-Solenikov     default:
6225bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
6235bc95aa2SDmitry Eremin-Solenikov     }
6245bc95aa2SDmitry Eremin-Solenikov }
6255bc95aa2SDmitry Eremin-Solenikov 
626eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_gpio_ops = {
627eb2fefbcSAvi Kivity     .read = strongarm_gpio_read,
628eb2fefbcSAvi Kivity     .write = strongarm_gpio_write,
629eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
6305bc95aa2SDmitry Eremin-Solenikov };
6315bc95aa2SDmitry Eremin-Solenikov 
632a8170e5eSAvi Kivity static DeviceState *strongarm_gpio_init(hwaddr base,
6335bc95aa2SDmitry Eremin-Solenikov                 DeviceState *pic)
6345bc95aa2SDmitry Eremin-Solenikov {
6355bc95aa2SDmitry Eremin-Solenikov     DeviceState *dev;
6365bc95aa2SDmitry Eremin-Solenikov     int i;
6375bc95aa2SDmitry Eremin-Solenikov 
638f55beb84SAndreas Färber     dev = qdev_create(NULL, TYPE_STRONGARM_GPIO);
6395bc95aa2SDmitry Eremin-Solenikov     qdev_init_nofail(dev);
6405bc95aa2SDmitry Eremin-Solenikov 
6411356b98dSAndreas Färber     sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, base);
6425bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 12; i++)
6431356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), i,
6445bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(pic, SA_PIC_GPIO0_EDGE + i));
6455bc95aa2SDmitry Eremin-Solenikov 
6465bc95aa2SDmitry Eremin-Solenikov     return dev;
6475bc95aa2SDmitry Eremin-Solenikov }
6485bc95aa2SDmitry Eremin-Solenikov 
6495a67508cSxiaoqiang.zhao static void strongarm_gpio_initfn(Object *obj)
6505bc95aa2SDmitry Eremin-Solenikov {
6515a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
6525a67508cSxiaoqiang.zhao     StrongARMGPIOInfo *s = STRONGARM_GPIO(obj);
6535a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
6545bc95aa2SDmitry Eremin-Solenikov     int i;
6555bc95aa2SDmitry Eremin-Solenikov 
656f55beb84SAndreas Färber     qdev_init_gpio_in(dev, strongarm_gpio_set, 28);
657f55beb84SAndreas Färber     qdev_init_gpio_out(dev, s->handler, 28);
6585bc95aa2SDmitry Eremin-Solenikov 
6595a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_gpio_ops, s,
66064bde0f3SPaolo Bonzini                           "gpio", 0x1000);
6615bc95aa2SDmitry Eremin-Solenikov 
662f55beb84SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
6635bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
664f55beb84SAndreas Färber         sysbus_init_irq(sbd, &s->irqs[i]);
6655bc95aa2SDmitry Eremin-Solenikov     }
666f55beb84SAndreas Färber     sysbus_init_irq(sbd, &s->irqX);
6675bc95aa2SDmitry Eremin-Solenikov }
6685bc95aa2SDmitry Eremin-Solenikov 
6695bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_gpio_regs = {
6705bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-gpio",
6715bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
6725bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
6735bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
6745bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMGPIOInfo),
6755bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMGPIOInfo),
6765bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMGPIOInfo),
6775bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rising, StrongARMGPIOInfo),
6785bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(falling, StrongARMGPIOInfo),
6795bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(status, StrongARMGPIOInfo),
6805bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(gafr, StrongARMGPIOInfo),
681ed657d71SPeter Maydell         VMSTATE_UINT32(prev_level, StrongARMGPIOInfo),
6825bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
6835bc95aa2SDmitry Eremin-Solenikov     },
6845bc95aa2SDmitry Eremin-Solenikov };
6855bc95aa2SDmitry Eremin-Solenikov 
686999e12bbSAnthony Liguori static void strongarm_gpio_class_init(ObjectClass *klass, void *data)
687999e12bbSAnthony Liguori {
68839bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
689999e12bbSAnthony Liguori 
69039bffca2SAnthony Liguori     dc->desc = "StrongARM GPIO controller";
691ed657d71SPeter Maydell     dc->vmsd = &vmstate_strongarm_gpio_regs;
692999e12bbSAnthony Liguori }
693999e12bbSAnthony Liguori 
6948c43a6f0SAndreas Färber static const TypeInfo strongarm_gpio_info = {
695f55beb84SAndreas Färber     .name          = TYPE_STRONGARM_GPIO,
69639bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
69739bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMGPIOInfo),
6985a67508cSxiaoqiang.zhao     .instance_init = strongarm_gpio_initfn,
699999e12bbSAnthony Liguori     .class_init    = strongarm_gpio_class_init,
7005bc95aa2SDmitry Eremin-Solenikov };
7015bc95aa2SDmitry Eremin-Solenikov 
7025bc95aa2SDmitry Eremin-Solenikov /* Peripheral Pin Controller */
7035bc95aa2SDmitry Eremin-Solenikov #define PPDR 0x00
7045bc95aa2SDmitry Eremin-Solenikov #define PPSR 0x04
7055bc95aa2SDmitry Eremin-Solenikov #define PPAR 0x08
7065bc95aa2SDmitry Eremin-Solenikov #define PSDR 0x0c
7075bc95aa2SDmitry Eremin-Solenikov #define PPFR 0x10
7085bc95aa2SDmitry Eremin-Solenikov 
709c71e6732SAndreas Färber #define TYPE_STRONGARM_PPC "strongarm-ppc"
710c71e6732SAndreas Färber #define STRONGARM_PPC(obj) \
711c71e6732SAndreas Färber     OBJECT_CHECK(StrongARMPPCInfo, (obj), TYPE_STRONGARM_PPC)
712c71e6732SAndreas Färber 
7135bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMPPCInfo StrongARMPPCInfo;
7145bc95aa2SDmitry Eremin-Solenikov struct StrongARMPPCInfo {
715c71e6732SAndreas Färber     SysBusDevice parent_obj;
716c71e6732SAndreas Färber 
717eb2fefbcSAvi Kivity     MemoryRegion iomem;
7185bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
7195bc95aa2SDmitry Eremin-Solenikov 
7205bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
7215bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
7225bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
7235bc95aa2SDmitry Eremin-Solenikov     uint32_t ppar;
7245bc95aa2SDmitry Eremin-Solenikov     uint32_t psdr;
7255bc95aa2SDmitry Eremin-Solenikov     uint32_t ppfr;
7265bc95aa2SDmitry Eremin-Solenikov 
7275bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
7285bc95aa2SDmitry Eremin-Solenikov };
7295bc95aa2SDmitry Eremin-Solenikov 
7305bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_set(void *opaque, int line, int level)
7315bc95aa2SDmitry Eremin-Solenikov {
7325bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7335bc95aa2SDmitry Eremin-Solenikov 
7345bc95aa2SDmitry Eremin-Solenikov     if (level) {
7355bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= 1 << line;
7365bc95aa2SDmitry Eremin-Solenikov     } else {
7375bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~(1 << line);
7385bc95aa2SDmitry Eremin-Solenikov     }
7395bc95aa2SDmitry Eremin-Solenikov }
7405bc95aa2SDmitry Eremin-Solenikov 
7415bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_handler_update(StrongARMPPCInfo *s)
7425bc95aa2SDmitry Eremin-Solenikov {
7435bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
7445bc95aa2SDmitry Eremin-Solenikov     int bit;
7455bc95aa2SDmitry Eremin-Solenikov 
7465bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
7475bc95aa2SDmitry Eremin-Solenikov 
7485bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
749786a4ea8SStefan Hajnoczi         bit = ctz32(diff);
7505bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
7515bc95aa2SDmitry Eremin-Solenikov     }
7525bc95aa2SDmitry Eremin-Solenikov 
7535bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
7545bc95aa2SDmitry Eremin-Solenikov }
7555bc95aa2SDmitry Eremin-Solenikov 
756a8170e5eSAvi Kivity static uint64_t strongarm_ppc_read(void *opaque, hwaddr offset,
757eb2fefbcSAvi Kivity                                    unsigned size)
7585bc95aa2SDmitry Eremin-Solenikov {
7595bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7605bc95aa2SDmitry Eremin-Solenikov 
7615bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
7625bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
7635bc95aa2SDmitry Eremin-Solenikov         return s->dir | ~0x3fffff;
7645bc95aa2SDmitry Eremin-Solenikov 
7655bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
7665bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
7675bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir) |
7685bc95aa2SDmitry Eremin-Solenikov                ~0x3fffff;
7695bc95aa2SDmitry Eremin-Solenikov 
7705bc95aa2SDmitry Eremin-Solenikov     case PPAR:
7715bc95aa2SDmitry Eremin-Solenikov         return s->ppar | ~0x41000;
7725bc95aa2SDmitry Eremin-Solenikov 
7735bc95aa2SDmitry Eremin-Solenikov     case PSDR:
7745bc95aa2SDmitry Eremin-Solenikov         return s->psdr;
7755bc95aa2SDmitry Eremin-Solenikov 
7765bc95aa2SDmitry Eremin-Solenikov     case PPFR:
7775bc95aa2SDmitry Eremin-Solenikov         return s->ppfr | ~0x7f001;
7785bc95aa2SDmitry Eremin-Solenikov 
7795bc95aa2SDmitry Eremin-Solenikov     default:
7805bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
7815bc95aa2SDmitry Eremin-Solenikov     }
7825bc95aa2SDmitry Eremin-Solenikov 
7835bc95aa2SDmitry Eremin-Solenikov     return 0;
7845bc95aa2SDmitry Eremin-Solenikov }
7855bc95aa2SDmitry Eremin-Solenikov 
786a8170e5eSAvi Kivity static void strongarm_ppc_write(void *opaque, hwaddr offset,
787eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
7885bc95aa2SDmitry Eremin-Solenikov {
7895bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7905bc95aa2SDmitry Eremin-Solenikov 
7915bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
7925bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
7935bc95aa2SDmitry Eremin-Solenikov         s->dir = value & 0x3fffff;
7945bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
7955bc95aa2SDmitry Eremin-Solenikov         break;
7965bc95aa2SDmitry Eremin-Solenikov 
7975bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
7985bc95aa2SDmitry Eremin-Solenikov         s->olevel = value & s->dir & 0x3fffff;
7995bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
8005bc95aa2SDmitry Eremin-Solenikov         break;
8015bc95aa2SDmitry Eremin-Solenikov 
8025bc95aa2SDmitry Eremin-Solenikov     case PPAR:
8035bc95aa2SDmitry Eremin-Solenikov         s->ppar = value & 0x41000;
8045bc95aa2SDmitry Eremin-Solenikov         break;
8055bc95aa2SDmitry Eremin-Solenikov 
8065bc95aa2SDmitry Eremin-Solenikov     case PSDR:
8075bc95aa2SDmitry Eremin-Solenikov         s->psdr = value & 0x3fffff;
8085bc95aa2SDmitry Eremin-Solenikov         break;
8095bc95aa2SDmitry Eremin-Solenikov 
8105bc95aa2SDmitry Eremin-Solenikov     case PPFR:
8115bc95aa2SDmitry Eremin-Solenikov         s->ppfr = value & 0x7f001;
8125bc95aa2SDmitry Eremin-Solenikov         break;
8135bc95aa2SDmitry Eremin-Solenikov 
8145bc95aa2SDmitry Eremin-Solenikov     default:
8155bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
8165bc95aa2SDmitry Eremin-Solenikov     }
8175bc95aa2SDmitry Eremin-Solenikov }
8185bc95aa2SDmitry Eremin-Solenikov 
819eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ppc_ops = {
820eb2fefbcSAvi Kivity     .read = strongarm_ppc_read,
821eb2fefbcSAvi Kivity     .write = strongarm_ppc_write,
822eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
8235bc95aa2SDmitry Eremin-Solenikov };
8245bc95aa2SDmitry Eremin-Solenikov 
8255a67508cSxiaoqiang.zhao static void strongarm_ppc_init(Object *obj)
8265bc95aa2SDmitry Eremin-Solenikov {
8275a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
8285a67508cSxiaoqiang.zhao     StrongARMPPCInfo *s = STRONGARM_PPC(obj);
8295a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
8305bc95aa2SDmitry Eremin-Solenikov 
831c71e6732SAndreas Färber     qdev_init_gpio_in(dev, strongarm_ppc_set, 22);
832c71e6732SAndreas Färber     qdev_init_gpio_out(dev, s->handler, 22);
8335bc95aa2SDmitry Eremin-Solenikov 
8345a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_ppc_ops, s,
83564bde0f3SPaolo Bonzini                           "ppc", 0x1000);
8365bc95aa2SDmitry Eremin-Solenikov 
837c71e6732SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
8385bc95aa2SDmitry Eremin-Solenikov }
8395bc95aa2SDmitry Eremin-Solenikov 
8405bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ppc_regs = {
8415bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ppc",
8425bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
8435bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
8445bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
8455bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMPPCInfo),
8465bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMPPCInfo),
8475bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMPPCInfo),
8485bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppar, StrongARMPPCInfo),
8495bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(psdr, StrongARMPPCInfo),
8505bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppfr, StrongARMPPCInfo),
851ed657d71SPeter Maydell         VMSTATE_UINT32(prev_level, StrongARMPPCInfo),
8525bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
8535bc95aa2SDmitry Eremin-Solenikov     },
8545bc95aa2SDmitry Eremin-Solenikov };
8555bc95aa2SDmitry Eremin-Solenikov 
856999e12bbSAnthony Liguori static void strongarm_ppc_class_init(ObjectClass *klass, void *data)
857999e12bbSAnthony Liguori {
85839bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
859999e12bbSAnthony Liguori 
86039bffca2SAnthony Liguori     dc->desc = "StrongARM PPC controller";
861ed657d71SPeter Maydell     dc->vmsd = &vmstate_strongarm_ppc_regs;
862999e12bbSAnthony Liguori }
863999e12bbSAnthony Liguori 
8648c43a6f0SAndreas Färber static const TypeInfo strongarm_ppc_info = {
865c71e6732SAndreas Färber     .name          = TYPE_STRONGARM_PPC,
86639bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
86739bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPPCInfo),
8685a67508cSxiaoqiang.zhao     .instance_init = strongarm_ppc_init,
869999e12bbSAnthony Liguori     .class_init    = strongarm_ppc_class_init,
8705bc95aa2SDmitry Eremin-Solenikov };
8715bc95aa2SDmitry Eremin-Solenikov 
8725bc95aa2SDmitry Eremin-Solenikov /* UART Ports */
8735bc95aa2SDmitry Eremin-Solenikov #define UTCR0 0x00
8745bc95aa2SDmitry Eremin-Solenikov #define UTCR1 0x04
8755bc95aa2SDmitry Eremin-Solenikov #define UTCR2 0x08
8765bc95aa2SDmitry Eremin-Solenikov #define UTCR3 0x0c
8775bc95aa2SDmitry Eremin-Solenikov #define UTDR  0x14
8785bc95aa2SDmitry Eremin-Solenikov #define UTSR0 0x1c
8795bc95aa2SDmitry Eremin-Solenikov #define UTSR1 0x20
8805bc95aa2SDmitry Eremin-Solenikov 
8815bc95aa2SDmitry Eremin-Solenikov #define UTCR0_PE  (1 << 0) /* Parity enable */
8825bc95aa2SDmitry Eremin-Solenikov #define UTCR0_OES (1 << 1) /* Even parity */
8835bc95aa2SDmitry Eremin-Solenikov #define UTCR0_SBS (1 << 2) /* 2 stop bits */
8845bc95aa2SDmitry Eremin-Solenikov #define UTCR0_DSS (1 << 3) /* 8-bit data */
8855bc95aa2SDmitry Eremin-Solenikov 
8865bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RXE (1 << 0) /* Rx enable */
8875bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TXE (1 << 1) /* Tx enable */
8885bc95aa2SDmitry Eremin-Solenikov #define UTCR3_BRK (1 << 2) /* Force Break */
8895bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RIE (1 << 3) /* Rx int enable */
8905bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TIE (1 << 4) /* Tx int enable */
8915bc95aa2SDmitry Eremin-Solenikov #define UTCR3_LBM (1 << 5) /* Loopback */
8925bc95aa2SDmitry Eremin-Solenikov 
8935bc95aa2SDmitry Eremin-Solenikov #define UTSR0_TFS (1 << 0) /* Tx FIFO nearly empty */
8945bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RFS (1 << 1) /* Rx FIFO nearly full */
8955bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RID (1 << 2) /* Receiver Idle */
8965bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RBB (1 << 3) /* Receiver begin break */
8975bc95aa2SDmitry Eremin-Solenikov #define UTSR0_REB (1 << 4) /* Receiver end break */
8985bc95aa2SDmitry Eremin-Solenikov #define UTSR0_EIF (1 << 5) /* Error in FIFO */
8995bc95aa2SDmitry Eremin-Solenikov 
9005bc95aa2SDmitry Eremin-Solenikov #define UTSR1_RNE (1 << 1) /* Receive FIFO not empty */
9015bc95aa2SDmitry Eremin-Solenikov #define UTSR1_TNF (1 << 2) /* Transmit FIFO not full */
9025bc95aa2SDmitry Eremin-Solenikov #define UTSR1_PRE (1 << 3) /* Parity error */
9035bc95aa2SDmitry Eremin-Solenikov #define UTSR1_FRE (1 << 4) /* Frame error */
9045bc95aa2SDmitry Eremin-Solenikov #define UTSR1_ROR (1 << 5) /* Receive Over Run */
9055bc95aa2SDmitry Eremin-Solenikov 
9065bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_PRE (1 << 8)
9075bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_FRE (1 << 9)
9085bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_ROR (1 << 10)
9095bc95aa2SDmitry Eremin-Solenikov 
910fff3af97SAndreas Färber #define TYPE_STRONGARM_UART "strongarm-uart"
911fff3af97SAndreas Färber #define STRONGARM_UART(obj) \
912fff3af97SAndreas Färber     OBJECT_CHECK(StrongARMUARTState, (obj), TYPE_STRONGARM_UART)
913fff3af97SAndreas Färber 
914fff3af97SAndreas Färber typedef struct StrongARMUARTState {
915fff3af97SAndreas Färber     SysBusDevice parent_obj;
916fff3af97SAndreas Färber 
917eb2fefbcSAvi Kivity     MemoryRegion iomem;
918becdfa00SMarc-André Lureau     CharBackend chr;
9195bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
9205bc95aa2SDmitry Eremin-Solenikov 
9215bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr0;
9225bc95aa2SDmitry Eremin-Solenikov     uint16_t brd;
9235bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr3;
9245bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr0;
9255bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr1;
9265bc95aa2SDmitry Eremin-Solenikov 
9275bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_fifo[8];
9285bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_start;
9295bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_len;
9305bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[12]; /* value + error flags in high bits */
9315bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
9325bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_len;
9335bc95aa2SDmitry Eremin-Solenikov 
9345bc95aa2SDmitry Eremin-Solenikov     uint64_t char_transmit_time; /* time to transmit a char in ticks*/
9355bc95aa2SDmitry Eremin-Solenikov     bool wait_break_end;
9365bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rx_timeout_timer;
9375bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *tx_timer;
9385bc95aa2SDmitry Eremin-Solenikov } StrongARMUARTState;
9395bc95aa2SDmitry Eremin-Solenikov 
9405bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_status(StrongARMUARTState *s)
9415bc95aa2SDmitry Eremin-Solenikov {
9425bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr1 = 0;
9435bc95aa2SDmitry Eremin-Solenikov 
9445bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len != 8) {
9455bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_TNF;
9465bc95aa2SDmitry Eremin-Solenikov     }
9475bc95aa2SDmitry Eremin-Solenikov 
9485bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len != 0) {
9495bc95aa2SDmitry Eremin-Solenikov         uint16_t ent = s->rx_fifo[s->rx_start];
9505bc95aa2SDmitry Eremin-Solenikov 
9515bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_RNE;
9525bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_PRE) {
9535bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_PRE;
9545bc95aa2SDmitry Eremin-Solenikov         }
9555bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_FRE) {
9565bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_FRE;
9575bc95aa2SDmitry Eremin-Solenikov         }
9585bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_ROR) {
9595bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_ROR;
9605bc95aa2SDmitry Eremin-Solenikov         }
9615bc95aa2SDmitry Eremin-Solenikov     }
9625bc95aa2SDmitry Eremin-Solenikov 
9635bc95aa2SDmitry Eremin-Solenikov     s->utsr1 = utsr1;
9645bc95aa2SDmitry Eremin-Solenikov }
9655bc95aa2SDmitry Eremin-Solenikov 
9665bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_int_status(StrongARMUARTState *s)
9675bc95aa2SDmitry Eremin-Solenikov {
9685bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr0 = s->utsr0 &
9695bc95aa2SDmitry Eremin-Solenikov             (UTSR0_REB | UTSR0_RBB | UTSR0_RID);
9705bc95aa2SDmitry Eremin-Solenikov     int i;
9715bc95aa2SDmitry Eremin-Solenikov 
9725bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_TXE) &&
9735bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_TIE) &&
9745bc95aa2SDmitry Eremin-Solenikov                 s->tx_len <= 4) {
9755bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_TFS;
9765bc95aa2SDmitry Eremin-Solenikov     }
9775bc95aa2SDmitry Eremin-Solenikov 
9785bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) &&
9795bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_RIE) &&
9805bc95aa2SDmitry Eremin-Solenikov                 s->rx_len > 4) {
9815bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_RFS;
9825bc95aa2SDmitry Eremin-Solenikov     }
9835bc95aa2SDmitry Eremin-Solenikov 
9845bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < s->rx_len && i < 4; i++)
9855bc95aa2SDmitry Eremin-Solenikov         if (s->rx_fifo[(s->rx_start + i) % 12] & ~0xff) {
9865bc95aa2SDmitry Eremin-Solenikov             utsr0 |= UTSR0_EIF;
9875bc95aa2SDmitry Eremin-Solenikov             break;
9885bc95aa2SDmitry Eremin-Solenikov         }
9895bc95aa2SDmitry Eremin-Solenikov 
9905bc95aa2SDmitry Eremin-Solenikov     s->utsr0 = utsr0;
9915bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, utsr0);
9925bc95aa2SDmitry Eremin-Solenikov }
9935bc95aa2SDmitry Eremin-Solenikov 
9945bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_parameters(StrongARMUARTState *s)
9955bc95aa2SDmitry Eremin-Solenikov {
9965bc95aa2SDmitry Eremin-Solenikov     int speed, parity, data_bits, stop_bits, frame_size;
9975bc95aa2SDmitry Eremin-Solenikov     QEMUSerialSetParams ssp;
9985bc95aa2SDmitry Eremin-Solenikov 
9995bc95aa2SDmitry Eremin-Solenikov     /* Start bit. */
10005bc95aa2SDmitry Eremin-Solenikov     frame_size = 1;
10015bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_PE) {
10025bc95aa2SDmitry Eremin-Solenikov         /* Parity bit. */
10035bc95aa2SDmitry Eremin-Solenikov         frame_size++;
10045bc95aa2SDmitry Eremin-Solenikov         if (s->utcr0 & UTCR0_OES) {
10055bc95aa2SDmitry Eremin-Solenikov             parity = 'E';
10065bc95aa2SDmitry Eremin-Solenikov         } else {
10075bc95aa2SDmitry Eremin-Solenikov             parity = 'O';
10085bc95aa2SDmitry Eremin-Solenikov         }
10095bc95aa2SDmitry Eremin-Solenikov     } else {
10105bc95aa2SDmitry Eremin-Solenikov             parity = 'N';
10115bc95aa2SDmitry Eremin-Solenikov     }
10125bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_SBS) {
10135bc95aa2SDmitry Eremin-Solenikov         stop_bits = 2;
10145bc95aa2SDmitry Eremin-Solenikov     } else {
10155bc95aa2SDmitry Eremin-Solenikov         stop_bits = 1;
10165bc95aa2SDmitry Eremin-Solenikov     }
10175bc95aa2SDmitry Eremin-Solenikov 
10185bc95aa2SDmitry Eremin-Solenikov     data_bits = (s->utcr0 & UTCR0_DSS) ? 8 : 7;
10195bc95aa2SDmitry Eremin-Solenikov     frame_size += data_bits + stop_bits;
10205bc95aa2SDmitry Eremin-Solenikov     speed = 3686400 / 16 / (s->brd + 1);
10215bc95aa2SDmitry Eremin-Solenikov     ssp.speed = speed;
10225bc95aa2SDmitry Eremin-Solenikov     ssp.parity = parity;
10235bc95aa2SDmitry Eremin-Solenikov     ssp.data_bits = data_bits;
10245bc95aa2SDmitry Eremin-Solenikov     ssp.stop_bits = stop_bits;
102573bcb24dSRutuja Shah     s->char_transmit_time =  (NANOSECONDS_PER_SECOND / speed) * frame_size;
10265345fdb4SMarc-André Lureau     qemu_chr_fe_ioctl(&s->chr, CHR_IOCTL_SERIAL_SET_PARAMS, &ssp);
10275bc95aa2SDmitry Eremin-Solenikov 
10285bc95aa2SDmitry Eremin-Solenikov     DPRINTF(stderr, "%s speed=%d parity=%c data=%d stop=%d\n", s->chr->label,
10295bc95aa2SDmitry Eremin-Solenikov             speed, parity, data_bits, stop_bits);
10305bc95aa2SDmitry Eremin-Solenikov }
10315bc95aa2SDmitry Eremin-Solenikov 
10325bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_to(void *opaque)
10335bc95aa2SDmitry Eremin-Solenikov {
10345bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10355bc95aa2SDmitry Eremin-Solenikov 
10365bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
10375bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RID;
10385bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
10395bc95aa2SDmitry Eremin-Solenikov     }
10405bc95aa2SDmitry Eremin-Solenikov }
10415bc95aa2SDmitry Eremin-Solenikov 
10425bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_push(StrongARMUARTState *s, uint16_t c)
10435bc95aa2SDmitry Eremin-Solenikov {
10445bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) == 0) {
10455bc95aa2SDmitry Eremin-Solenikov         /* rx disabled */
10465bc95aa2SDmitry Eremin-Solenikov         return;
10475bc95aa2SDmitry Eremin-Solenikov     }
10485bc95aa2SDmitry Eremin-Solenikov 
10495bc95aa2SDmitry Eremin-Solenikov     if (s->wait_break_end) {
10505bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_REB;
10515bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = false;
10525bc95aa2SDmitry Eremin-Solenikov     }
10535bc95aa2SDmitry Eremin-Solenikov 
10545bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 12) {
10555bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + s->rx_len) % 12] = c;
10565bc95aa2SDmitry Eremin-Solenikov         s->rx_len++;
10575bc95aa2SDmitry Eremin-Solenikov     } else
10585bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + 11) % 12] |= RX_FIFO_ROR;
10595bc95aa2SDmitry Eremin-Solenikov }
10605bc95aa2SDmitry Eremin-Solenikov 
10615bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_can_receive(void *opaque)
10625bc95aa2SDmitry Eremin-Solenikov {
10635bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10645bc95aa2SDmitry Eremin-Solenikov 
10655bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len == 12) {
10665bc95aa2SDmitry Eremin-Solenikov         return 0;
10675bc95aa2SDmitry Eremin-Solenikov     }
10685bc95aa2SDmitry Eremin-Solenikov     /* It's best not to get more than 2/3 of RX FIFO, so advertise that much */
10695bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 8) {
10705bc95aa2SDmitry Eremin-Solenikov         return 8 - s->rx_len;
10715bc95aa2SDmitry Eremin-Solenikov     }
10725bc95aa2SDmitry Eremin-Solenikov     return 1;
10735bc95aa2SDmitry Eremin-Solenikov }
10745bc95aa2SDmitry Eremin-Solenikov 
10755bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_receive(void *opaque, const uint8_t *buf, int size)
10765bc95aa2SDmitry Eremin-Solenikov {
10775bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10785bc95aa2SDmitry Eremin-Solenikov     int i;
10795bc95aa2SDmitry Eremin-Solenikov 
10805bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < size; i++) {
10815bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, buf[i]);
10825bc95aa2SDmitry Eremin-Solenikov     }
10835bc95aa2SDmitry Eremin-Solenikov 
10845bc95aa2SDmitry Eremin-Solenikov     /* call the timeout receive callback in 3 char transmit time */
1085bc72ad67SAlex Bligh     timer_mod(s->rx_timeout_timer,
1086bc72ad67SAlex Bligh                     qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
10875bc95aa2SDmitry Eremin-Solenikov 
10885bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
10895bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
10905bc95aa2SDmitry Eremin-Solenikov }
10915bc95aa2SDmitry Eremin-Solenikov 
10925bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_event(void *opaque, int event)
10935bc95aa2SDmitry Eremin-Solenikov {
10945bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10955bc95aa2SDmitry Eremin-Solenikov     if (event == CHR_EVENT_BREAK) {
10965bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RBB;
10975bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, RX_FIFO_FRE);
10985bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = true;
10995bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
11005bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
11015bc95aa2SDmitry Eremin-Solenikov     }
11025bc95aa2SDmitry Eremin-Solenikov }
11035bc95aa2SDmitry Eremin-Solenikov 
11045bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_tx(void *opaque)
11055bc95aa2SDmitry Eremin-Solenikov {
11065bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
1107bc72ad67SAlex Bligh     uint64_t new_xmit_ts = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
11085bc95aa2SDmitry Eremin-Solenikov 
11095bc95aa2SDmitry Eremin-Solenikov     if (s->utcr3 & UTCR3_LBM) /* loopback */ {
11105bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_receive(s, &s->tx_fifo[s->tx_start], 1);
111130650701SAnton Nefedov     } else if (qemu_chr_fe_backend_connected(&s->chr)) {
11126ab3fc32SDaniel P. Berrange         /* XXX this blocks entire thread. Rewrite to use
11136ab3fc32SDaniel P. Berrange          * qemu_chr_fe_write and background I/O callbacks */
11145345fdb4SMarc-André Lureau         qemu_chr_fe_write_all(&s->chr, &s->tx_fifo[s->tx_start], 1);
11155bc95aa2SDmitry Eremin-Solenikov     }
11165bc95aa2SDmitry Eremin-Solenikov 
11175bc95aa2SDmitry Eremin-Solenikov     s->tx_start = (s->tx_start + 1) % 8;
11185bc95aa2SDmitry Eremin-Solenikov     s->tx_len--;
11195bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
1120bc72ad67SAlex Bligh         timer_mod(s->tx_timer, new_xmit_ts + s->char_transmit_time);
11215bc95aa2SDmitry Eremin-Solenikov     }
11225bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
11235bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
11245bc95aa2SDmitry Eremin-Solenikov }
11255bc95aa2SDmitry Eremin-Solenikov 
1126a8170e5eSAvi Kivity static uint64_t strongarm_uart_read(void *opaque, hwaddr addr,
1127eb2fefbcSAvi Kivity                                     unsigned size)
11285bc95aa2SDmitry Eremin-Solenikov {
11295bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11305bc95aa2SDmitry Eremin-Solenikov     uint16_t ret;
11315bc95aa2SDmitry Eremin-Solenikov 
11325bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11335bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11345bc95aa2SDmitry Eremin-Solenikov         return s->utcr0;
11355bc95aa2SDmitry Eremin-Solenikov 
11365bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11375bc95aa2SDmitry Eremin-Solenikov         return s->brd >> 8;
11385bc95aa2SDmitry Eremin-Solenikov 
11395bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11405bc95aa2SDmitry Eremin-Solenikov         return s->brd & 0xff;
11415bc95aa2SDmitry Eremin-Solenikov 
11425bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
11435bc95aa2SDmitry Eremin-Solenikov         return s->utcr3;
11445bc95aa2SDmitry Eremin-Solenikov 
11455bc95aa2SDmitry Eremin-Solenikov     case UTDR:
11465bc95aa2SDmitry Eremin-Solenikov         if (s->rx_len != 0) {
11475bc95aa2SDmitry Eremin-Solenikov             ret = s->rx_fifo[s->rx_start];
11485bc95aa2SDmitry Eremin-Solenikov             s->rx_start = (s->rx_start + 1) % 12;
11495bc95aa2SDmitry Eremin-Solenikov             s->rx_len--;
11505bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
11515bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
11525bc95aa2SDmitry Eremin-Solenikov             return ret;
11535bc95aa2SDmitry Eremin-Solenikov         }
11545bc95aa2SDmitry Eremin-Solenikov         return 0;
11555bc95aa2SDmitry Eremin-Solenikov 
11565bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
11575bc95aa2SDmitry Eremin-Solenikov         return s->utsr0;
11585bc95aa2SDmitry Eremin-Solenikov 
11595bc95aa2SDmitry Eremin-Solenikov     case UTSR1:
11605bc95aa2SDmitry Eremin-Solenikov         return s->utsr1;
11615bc95aa2SDmitry Eremin-Solenikov 
11625bc95aa2SDmitry Eremin-Solenikov     default:
11635bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
11645bc95aa2SDmitry Eremin-Solenikov         return 0;
11655bc95aa2SDmitry Eremin-Solenikov     }
11665bc95aa2SDmitry Eremin-Solenikov }
11675bc95aa2SDmitry Eremin-Solenikov 
1168a8170e5eSAvi Kivity static void strongarm_uart_write(void *opaque, hwaddr addr,
1169eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
11705bc95aa2SDmitry Eremin-Solenikov {
11715bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11725bc95aa2SDmitry Eremin-Solenikov 
11735bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11745bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11755bc95aa2SDmitry Eremin-Solenikov         s->utcr0 = value & 0x7f;
11765bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11775bc95aa2SDmitry Eremin-Solenikov         break;
11785bc95aa2SDmitry Eremin-Solenikov 
11795bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11805bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xff) | ((value & 0xf) << 8);
11815bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11825bc95aa2SDmitry Eremin-Solenikov         break;
11835bc95aa2SDmitry Eremin-Solenikov 
11845bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11855bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xf00) | (value & 0xff);
11865bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11875bc95aa2SDmitry Eremin-Solenikov         break;
11885bc95aa2SDmitry Eremin-Solenikov 
11895bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
11905bc95aa2SDmitry Eremin-Solenikov         s->utcr3 = value & 0x3f;
11915bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_RXE) == 0) {
11925bc95aa2SDmitry Eremin-Solenikov             s->rx_len = 0;
11935bc95aa2SDmitry Eremin-Solenikov         }
11945bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) == 0) {
11955bc95aa2SDmitry Eremin-Solenikov             s->tx_len = 0;
11965bc95aa2SDmitry Eremin-Solenikov         }
11975bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
11985bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
11995bc95aa2SDmitry Eremin-Solenikov         break;
12005bc95aa2SDmitry Eremin-Solenikov 
12015bc95aa2SDmitry Eremin-Solenikov     case UTDR:
12025bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) && s->tx_len != 8) {
12035bc95aa2SDmitry Eremin-Solenikov             s->tx_fifo[(s->tx_start + s->tx_len) % 8] = value;
12045bc95aa2SDmitry Eremin-Solenikov             s->tx_len++;
12055bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
12065bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
12075bc95aa2SDmitry Eremin-Solenikov             if (s->tx_len == 1) {
12085bc95aa2SDmitry Eremin-Solenikov                 strongarm_uart_tx(s);
12095bc95aa2SDmitry Eremin-Solenikov             }
12105bc95aa2SDmitry Eremin-Solenikov         }
12115bc95aa2SDmitry Eremin-Solenikov         break;
12125bc95aa2SDmitry Eremin-Solenikov 
12135bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
12145bc95aa2SDmitry Eremin-Solenikov         s->utsr0 = s->utsr0 & ~(value &
12155bc95aa2SDmitry Eremin-Solenikov                 (UTSR0_REB | UTSR0_RBB | UTSR0_RID));
12165bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
12175bc95aa2SDmitry Eremin-Solenikov         break;
12185bc95aa2SDmitry Eremin-Solenikov 
12195bc95aa2SDmitry Eremin-Solenikov     default:
12205bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
12215bc95aa2SDmitry Eremin-Solenikov     }
12225bc95aa2SDmitry Eremin-Solenikov }
12235bc95aa2SDmitry Eremin-Solenikov 
1224eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_uart_ops = {
1225eb2fefbcSAvi Kivity     .read = strongarm_uart_read,
1226eb2fefbcSAvi Kivity     .write = strongarm_uart_write,
1227eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
12285bc95aa2SDmitry Eremin-Solenikov };
12295bc95aa2SDmitry Eremin-Solenikov 
12305a67508cSxiaoqiang.zhao static void strongarm_uart_init(Object *obj)
12315bc95aa2SDmitry Eremin-Solenikov {
12325a67508cSxiaoqiang.zhao     StrongARMUARTState *s = STRONGARM_UART(obj);
12335a67508cSxiaoqiang.zhao     SysBusDevice *dev = SYS_BUS_DEVICE(obj);
12345bc95aa2SDmitry Eremin-Solenikov 
12355a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_uart_ops, s,
123664bde0f3SPaolo Bonzini                           "uart", 0x10000);
1237750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
12385bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->irq);
12395bc95aa2SDmitry Eremin-Solenikov 
1240bc72ad67SAlex Bligh     s->rx_timeout_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_rx_to, s);
1241bc72ad67SAlex Bligh     s->tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_tx, s);
12428934515aSxiaoqiang zhao }
12438934515aSxiaoqiang zhao 
12448934515aSxiaoqiang zhao static void strongarm_uart_realize(DeviceState *dev, Error **errp)
12458934515aSxiaoqiang zhao {
12468934515aSxiaoqiang zhao     StrongARMUARTState *s = STRONGARM_UART(dev);
12475bc95aa2SDmitry Eremin-Solenikov 
12485345fdb4SMarc-André Lureau     qemu_chr_fe_set_handlers(&s->chr,
12495bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_can_receive,
12505bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_receive,
12515bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_event,
125281517ba3SAnton Nefedov                              NULL, s, NULL, true);
12535bc95aa2SDmitry Eremin-Solenikov }
12545bc95aa2SDmitry Eremin-Solenikov 
12555bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_reset(DeviceState *dev)
12565bc95aa2SDmitry Eremin-Solenikov {
1257fff3af97SAndreas Färber     StrongARMUARTState *s = STRONGARM_UART(dev);
12585bc95aa2SDmitry Eremin-Solenikov 
12595bc95aa2SDmitry Eremin-Solenikov     s->utcr0 = UTCR0_DSS; /* 8 data, no parity */
12605bc95aa2SDmitry Eremin-Solenikov     s->brd = 23;    /* 9600 */
12615bc95aa2SDmitry Eremin-Solenikov     /* enable send & recv - this actually violates spec */
12625bc95aa2SDmitry Eremin-Solenikov     s->utcr3 = UTCR3_TXE | UTCR3_RXE;
12635bc95aa2SDmitry Eremin-Solenikov 
12645bc95aa2SDmitry Eremin-Solenikov     s->rx_len = s->tx_len = 0;
12655bc95aa2SDmitry Eremin-Solenikov 
12665bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12675bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12685bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12695bc95aa2SDmitry Eremin-Solenikov }
12705bc95aa2SDmitry Eremin-Solenikov 
12715bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_post_load(void *opaque, int version_id)
12725bc95aa2SDmitry Eremin-Solenikov {
12735bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
12745bc95aa2SDmitry Eremin-Solenikov 
12755bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12765bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12775bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12785bc95aa2SDmitry Eremin-Solenikov 
12795bc95aa2SDmitry Eremin-Solenikov     /* tx and restart timer */
12805bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
12815bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_tx(s);
12825bc95aa2SDmitry Eremin-Solenikov     }
12835bc95aa2SDmitry Eremin-Solenikov 
12845bc95aa2SDmitry Eremin-Solenikov     /* restart rx timeout timer */
12855bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
1286bc72ad67SAlex Bligh         timer_mod(s->rx_timeout_timer,
1287bc72ad67SAlex Bligh                 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
12885bc95aa2SDmitry Eremin-Solenikov     }
12895bc95aa2SDmitry Eremin-Solenikov 
12905bc95aa2SDmitry Eremin-Solenikov     return 0;
12915bc95aa2SDmitry Eremin-Solenikov }
12925bc95aa2SDmitry Eremin-Solenikov 
12935bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_uart_regs = {
12945bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-uart",
12955bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
12965bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
12975bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_uart_post_load,
12985bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
12995bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr0, StrongARMUARTState),
13005bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(brd, StrongARMUARTState),
13015bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr3, StrongARMUARTState),
13025bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utsr0, StrongARMUARTState),
13035bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8_ARRAY(tx_fifo, StrongARMUARTState, 8),
13045bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_start, StrongARMUARTState),
13055bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_len, StrongARMUARTState),
13065bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMUARTState, 12),
13075bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMUARTState),
13085bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_len, StrongARMUARTState),
13095bc95aa2SDmitry Eremin-Solenikov         VMSTATE_BOOL(wait_break_end, StrongARMUARTState),
13105bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
13115bc95aa2SDmitry Eremin-Solenikov     },
13125bc95aa2SDmitry Eremin-Solenikov };
13135bc95aa2SDmitry Eremin-Solenikov 
1314999e12bbSAnthony Liguori static Property strongarm_uart_properties[] = {
13155bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_CHR("chardev", StrongARMUARTState, chr),
13165bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_END_OF_LIST(),
1317999e12bbSAnthony Liguori };
1318999e12bbSAnthony Liguori 
1319999e12bbSAnthony Liguori static void strongarm_uart_class_init(ObjectClass *klass, void *data)
1320999e12bbSAnthony Liguori {
132139bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1322999e12bbSAnthony Liguori 
132339bffca2SAnthony Liguori     dc->desc = "StrongARM UART controller";
132439bffca2SAnthony Liguori     dc->reset = strongarm_uart_reset;
132539bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_uart_regs;
132639bffca2SAnthony Liguori     dc->props = strongarm_uart_properties;
13278934515aSxiaoqiang zhao     dc->realize = strongarm_uart_realize;
13285bc95aa2SDmitry Eremin-Solenikov }
1329999e12bbSAnthony Liguori 
13308c43a6f0SAndreas Färber static const TypeInfo strongarm_uart_info = {
1331fff3af97SAndreas Färber     .name          = TYPE_STRONGARM_UART,
133239bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
133339bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMUARTState),
13345a67508cSxiaoqiang.zhao     .instance_init = strongarm_uart_init,
1335999e12bbSAnthony Liguori     .class_init    = strongarm_uart_class_init,
13365bc95aa2SDmitry Eremin-Solenikov };
13375bc95aa2SDmitry Eremin-Solenikov 
13385bc95aa2SDmitry Eremin-Solenikov /* Synchronous Serial Ports */
13390ca81872SAndreas Färber 
13400ca81872SAndreas Färber #define TYPE_STRONGARM_SSP "strongarm-ssp"
13410ca81872SAndreas Färber #define STRONGARM_SSP(obj) \
13420ca81872SAndreas Färber     OBJECT_CHECK(StrongARMSSPState, (obj), TYPE_STRONGARM_SSP)
13430ca81872SAndreas Färber 
13440ca81872SAndreas Färber typedef struct StrongARMSSPState {
13450ca81872SAndreas Färber     SysBusDevice parent_obj;
13460ca81872SAndreas Färber 
1347eb2fefbcSAvi Kivity     MemoryRegion iomem;
13485bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
13495bc95aa2SDmitry Eremin-Solenikov     SSIBus *bus;
13505bc95aa2SDmitry Eremin-Solenikov 
13515bc95aa2SDmitry Eremin-Solenikov     uint16_t sscr[2];
13525bc95aa2SDmitry Eremin-Solenikov     uint16_t sssr;
13535bc95aa2SDmitry Eremin-Solenikov 
13545bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[8];
13555bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_level;
13565bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
13575bc95aa2SDmitry Eremin-Solenikov } StrongARMSSPState;
13585bc95aa2SDmitry Eremin-Solenikov 
13595bc95aa2SDmitry Eremin-Solenikov #define SSCR0 0x60 /* SSP Control register 0 */
13605bc95aa2SDmitry Eremin-Solenikov #define SSCR1 0x64 /* SSP Control register 1 */
13615bc95aa2SDmitry Eremin-Solenikov #define SSDR  0x6c /* SSP Data register */
13625bc95aa2SDmitry Eremin-Solenikov #define SSSR  0x74 /* SSP Status register */
13635bc95aa2SDmitry Eremin-Solenikov 
13645bc95aa2SDmitry Eremin-Solenikov /* Bitfields for above registers */
13655bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SPI(x)    (((x) & 0x30) == 0x00)
13665bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSP(x)    (((x) & 0x30) == 0x10)
13675bc95aa2SDmitry Eremin-Solenikov #define SSCR0_UWIRE(x)  (((x) & 0x30) == 0x20)
13685bc95aa2SDmitry Eremin-Solenikov #define SSCR0_PSP(x)    (((x) & 0x30) == 0x30)
13695bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSE       (1 << 7)
13705bc95aa2SDmitry Eremin-Solenikov #define SSCR0_DSS(x)    (((x) & 0xf) + 1)
13715bc95aa2SDmitry Eremin-Solenikov #define SSCR1_RIE       (1 << 0)
13725bc95aa2SDmitry Eremin-Solenikov #define SSCR1_TIE       (1 << 1)
13735bc95aa2SDmitry Eremin-Solenikov #define SSCR1_LBM       (1 << 2)
13745bc95aa2SDmitry Eremin-Solenikov #define SSSR_TNF        (1 << 2)
13755bc95aa2SDmitry Eremin-Solenikov #define SSSR_RNE        (1 << 3)
13765bc95aa2SDmitry Eremin-Solenikov #define SSSR_TFS        (1 << 5)
13775bc95aa2SDmitry Eremin-Solenikov #define SSSR_RFS        (1 << 6)
13785bc95aa2SDmitry Eremin-Solenikov #define SSSR_ROR        (1 << 7)
13795bc95aa2SDmitry Eremin-Solenikov #define SSSR_RW         0x0080
13805bc95aa2SDmitry Eremin-Solenikov 
13815bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_int_update(StrongARMSSPState *s)
13825bc95aa2SDmitry Eremin-Solenikov {
13835bc95aa2SDmitry Eremin-Solenikov     int level = 0;
13845bc95aa2SDmitry Eremin-Solenikov 
13855bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_ROR);
13865bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_RFS)  &&  (s->sscr[1] & SSCR1_RIE);
13875bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_TFS)  &&  (s->sscr[1] & SSCR1_TIE);
13885bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, level);
13895bc95aa2SDmitry Eremin-Solenikov }
13905bc95aa2SDmitry Eremin-Solenikov 
13915bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_fifo_update(StrongARMSSPState *s)
13925bc95aa2SDmitry Eremin-Solenikov {
13935bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TFS;
13945bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TNF;
13955bc95aa2SDmitry Eremin-Solenikov     if (s->sscr[0] & SSCR0_SSE) {
13965bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level >= 4) {
13975bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RFS;
13985bc95aa2SDmitry Eremin-Solenikov         } else {
13995bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RFS;
14005bc95aa2SDmitry Eremin-Solenikov         }
14015bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level) {
14025bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RNE;
14035bc95aa2SDmitry Eremin-Solenikov         } else {
14045bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RNE;
14055bc95aa2SDmitry Eremin-Solenikov         }
14065bc95aa2SDmitry Eremin-Solenikov         /* TX FIFO is never filled, so it is always in underrun
14075bc95aa2SDmitry Eremin-Solenikov            condition if SSP is enabled */
14085bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TFS;
14095bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TNF;
14105bc95aa2SDmitry Eremin-Solenikov     }
14115bc95aa2SDmitry Eremin-Solenikov 
14125bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_int_update(s);
14135bc95aa2SDmitry Eremin-Solenikov }
14145bc95aa2SDmitry Eremin-Solenikov 
1415a8170e5eSAvi Kivity static uint64_t strongarm_ssp_read(void *opaque, hwaddr addr,
1416eb2fefbcSAvi Kivity                                    unsigned size)
14175bc95aa2SDmitry Eremin-Solenikov {
14185bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14195bc95aa2SDmitry Eremin-Solenikov     uint32_t retval;
14205bc95aa2SDmitry Eremin-Solenikov 
14215bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
14225bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
14235bc95aa2SDmitry Eremin-Solenikov         return s->sscr[0];
14245bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
14255bc95aa2SDmitry Eremin-Solenikov         return s->sscr[1];
14265bc95aa2SDmitry Eremin-Solenikov     case SSSR:
14275bc95aa2SDmitry Eremin-Solenikov         return s->sssr;
14285bc95aa2SDmitry Eremin-Solenikov     case SSDR:
14295bc95aa2SDmitry Eremin-Solenikov         if (~s->sscr[0] & SSCR0_SSE) {
14305bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
14315bc95aa2SDmitry Eremin-Solenikov         }
14325bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level < 1) {
14335bc95aa2SDmitry Eremin-Solenikov             printf("%s: SSP Rx Underrun\n", __func__);
14345bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
14355bc95aa2SDmitry Eremin-Solenikov         }
14365bc95aa2SDmitry Eremin-Solenikov         s->rx_level--;
14375bc95aa2SDmitry Eremin-Solenikov         retval = s->rx_fifo[s->rx_start++];
14385bc95aa2SDmitry Eremin-Solenikov         s->rx_start &= 0x7;
14395bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14405bc95aa2SDmitry Eremin-Solenikov         return retval;
14415bc95aa2SDmitry Eremin-Solenikov     default:
14425bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
14435bc95aa2SDmitry Eremin-Solenikov         break;
14445bc95aa2SDmitry Eremin-Solenikov     }
14455bc95aa2SDmitry Eremin-Solenikov     return 0;
14465bc95aa2SDmitry Eremin-Solenikov }
14475bc95aa2SDmitry Eremin-Solenikov 
1448a8170e5eSAvi Kivity static void strongarm_ssp_write(void *opaque, hwaddr addr,
1449eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
14505bc95aa2SDmitry Eremin-Solenikov {
14515bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14525bc95aa2SDmitry Eremin-Solenikov 
14535bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
14545bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
14555bc95aa2SDmitry Eremin-Solenikov         s->sscr[0] = value & 0xffbf;
14565bc95aa2SDmitry Eremin-Solenikov         if ((s->sscr[0] & SSCR0_SSE) && SSCR0_DSS(value) < 4) {
14575bc95aa2SDmitry Eremin-Solenikov             printf("%s: Wrong data size: %i bits\n", __func__,
1458eb2fefbcSAvi Kivity                    (int)SSCR0_DSS(value));
14595bc95aa2SDmitry Eremin-Solenikov         }
14605bc95aa2SDmitry Eremin-Solenikov         if (!(value & SSCR0_SSE)) {
14615bc95aa2SDmitry Eremin-Solenikov             s->sssr = 0;
14625bc95aa2SDmitry Eremin-Solenikov             s->rx_level = 0;
14635bc95aa2SDmitry Eremin-Solenikov         }
14645bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14655bc95aa2SDmitry Eremin-Solenikov         break;
14665bc95aa2SDmitry Eremin-Solenikov 
14675bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
14685bc95aa2SDmitry Eremin-Solenikov         s->sscr[1] = value & 0x2f;
14695bc95aa2SDmitry Eremin-Solenikov         if (value & SSCR1_LBM) {
14705bc95aa2SDmitry Eremin-Solenikov             printf("%s: Attempt to use SSP LBM mode\n", __func__);
14715bc95aa2SDmitry Eremin-Solenikov         }
14725bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14735bc95aa2SDmitry Eremin-Solenikov         break;
14745bc95aa2SDmitry Eremin-Solenikov 
14755bc95aa2SDmitry Eremin-Solenikov     case SSSR:
14765bc95aa2SDmitry Eremin-Solenikov         s->sssr &= ~(value & SSSR_RW);
14775bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_int_update(s);
14785bc95aa2SDmitry Eremin-Solenikov         break;
14795bc95aa2SDmitry Eremin-Solenikov 
14805bc95aa2SDmitry Eremin-Solenikov     case SSDR:
14815bc95aa2SDmitry Eremin-Solenikov         if (SSCR0_UWIRE(s->sscr[0])) {
14825bc95aa2SDmitry Eremin-Solenikov             value &= 0xff;
14835bc95aa2SDmitry Eremin-Solenikov         } else
14845bc95aa2SDmitry Eremin-Solenikov             /* Note how 32bits overflow does no harm here */
14855bc95aa2SDmitry Eremin-Solenikov             value &= (1 << SSCR0_DSS(s->sscr[0])) - 1;
14865bc95aa2SDmitry Eremin-Solenikov 
14875bc95aa2SDmitry Eremin-Solenikov         /* Data goes from here to the Tx FIFO and is shifted out from
14885bc95aa2SDmitry Eremin-Solenikov          * there directly to the slave, no need to buffer it.
14895bc95aa2SDmitry Eremin-Solenikov          */
14905bc95aa2SDmitry Eremin-Solenikov         if (s->sscr[0] & SSCR0_SSE) {
14915bc95aa2SDmitry Eremin-Solenikov             uint32_t readval;
14925bc95aa2SDmitry Eremin-Solenikov             if (s->sscr[1] & SSCR1_LBM) {
14935bc95aa2SDmitry Eremin-Solenikov                 readval = value;
14945bc95aa2SDmitry Eremin-Solenikov             } else {
14955bc95aa2SDmitry Eremin-Solenikov                 readval = ssi_transfer(s->bus, value);
14965bc95aa2SDmitry Eremin-Solenikov             }
14975bc95aa2SDmitry Eremin-Solenikov 
14985bc95aa2SDmitry Eremin-Solenikov             if (s->rx_level < 0x08) {
14995bc95aa2SDmitry Eremin-Solenikov                 s->rx_fifo[(s->rx_start + s->rx_level++) & 0x7] = readval;
15005bc95aa2SDmitry Eremin-Solenikov             } else {
15015bc95aa2SDmitry Eremin-Solenikov                 s->sssr |= SSSR_ROR;
15025bc95aa2SDmitry Eremin-Solenikov             }
15035bc95aa2SDmitry Eremin-Solenikov         }
15045bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
15055bc95aa2SDmitry Eremin-Solenikov         break;
15065bc95aa2SDmitry Eremin-Solenikov 
15075bc95aa2SDmitry Eremin-Solenikov     default:
15085bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
15095bc95aa2SDmitry Eremin-Solenikov         break;
15105bc95aa2SDmitry Eremin-Solenikov     }
15115bc95aa2SDmitry Eremin-Solenikov }
15125bc95aa2SDmitry Eremin-Solenikov 
1513eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ssp_ops = {
1514eb2fefbcSAvi Kivity     .read = strongarm_ssp_read,
1515eb2fefbcSAvi Kivity     .write = strongarm_ssp_write,
1516eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
15175bc95aa2SDmitry Eremin-Solenikov };
15185bc95aa2SDmitry Eremin-Solenikov 
15195bc95aa2SDmitry Eremin-Solenikov static int strongarm_ssp_post_load(void *opaque, int version_id)
15205bc95aa2SDmitry Eremin-Solenikov {
15215bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
15225bc95aa2SDmitry Eremin-Solenikov 
15235bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_fifo_update(s);
15245bc95aa2SDmitry Eremin-Solenikov 
15255bc95aa2SDmitry Eremin-Solenikov     return 0;
15265bc95aa2SDmitry Eremin-Solenikov }
15275bc95aa2SDmitry Eremin-Solenikov 
15288934515aSxiaoqiang zhao static void strongarm_ssp_init(Object *obj)
15295bc95aa2SDmitry Eremin-Solenikov {
15308934515aSxiaoqiang zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
15310ca81872SAndreas Färber     DeviceState *dev = DEVICE(sbd);
15320ca81872SAndreas Färber     StrongARMSSPState *s = STRONGARM_SSP(dev);
15335bc95aa2SDmitry Eremin-Solenikov 
15340ca81872SAndreas Färber     sysbus_init_irq(sbd, &s->irq);
15355bc95aa2SDmitry Eremin-Solenikov 
15368934515aSxiaoqiang zhao     memory_region_init_io(&s->iomem, obj, &strongarm_ssp_ops, s,
153764bde0f3SPaolo Bonzini                           "ssp", 0x1000);
15380ca81872SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
15395bc95aa2SDmitry Eremin-Solenikov 
15400ca81872SAndreas Färber     s->bus = ssi_create_bus(dev, "ssi");
15415bc95aa2SDmitry Eremin-Solenikov }
15425bc95aa2SDmitry Eremin-Solenikov 
15435bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_reset(DeviceState *dev)
15445bc95aa2SDmitry Eremin-Solenikov {
15450ca81872SAndreas Färber     StrongARMSSPState *s = STRONGARM_SSP(dev);
15460ca81872SAndreas Färber 
15475bc95aa2SDmitry Eremin-Solenikov     s->sssr = 0x03; /* 3 bit data, SPI, disabled */
15485bc95aa2SDmitry Eremin-Solenikov     s->rx_start = 0;
15495bc95aa2SDmitry Eremin-Solenikov     s->rx_level = 0;
15505bc95aa2SDmitry Eremin-Solenikov }
15515bc95aa2SDmitry Eremin-Solenikov 
15525bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ssp_regs = {
15535bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ssp",
15545bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
15555bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
15565bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_ssp_post_load,
15575bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
15585bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(sscr, StrongARMSSPState, 2),
15595bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(sssr, StrongARMSSPState),
15605bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMSSPState, 8),
15615bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMSSPState),
15625bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_level, StrongARMSSPState),
15635bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
15645bc95aa2SDmitry Eremin-Solenikov     },
15655bc95aa2SDmitry Eremin-Solenikov };
15665bc95aa2SDmitry Eremin-Solenikov 
1567999e12bbSAnthony Liguori static void strongarm_ssp_class_init(ObjectClass *klass, void *data)
1568999e12bbSAnthony Liguori {
156939bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1570999e12bbSAnthony Liguori 
157139bffca2SAnthony Liguori     dc->desc = "StrongARM SSP controller";
157239bffca2SAnthony Liguori     dc->reset = strongarm_ssp_reset;
157339bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_ssp_regs;
1574999e12bbSAnthony Liguori }
1575999e12bbSAnthony Liguori 
15768c43a6f0SAndreas Färber static const TypeInfo strongarm_ssp_info = {
15770ca81872SAndreas Färber     .name          = TYPE_STRONGARM_SSP,
157839bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
157939bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMSSPState),
15808934515aSxiaoqiang zhao     .instance_init = strongarm_ssp_init,
1581999e12bbSAnthony Liguori     .class_init    = strongarm_ssp_class_init,
15825bc95aa2SDmitry Eremin-Solenikov };
15835bc95aa2SDmitry Eremin-Solenikov 
15845bc95aa2SDmitry Eremin-Solenikov /* Main CPU functions */
1585eb2fefbcSAvi Kivity StrongARMState *sa1110_init(MemoryRegion *sysmem,
1586ba1ba5ccSIgor Mammedov                             unsigned int sdram_size, const char *cpu_type)
15875bc95aa2SDmitry Eremin-Solenikov {
15885bc95aa2SDmitry Eremin-Solenikov     StrongARMState *s;
15895bc95aa2SDmitry Eremin-Solenikov     int i;
15905bc95aa2SDmitry Eremin-Solenikov 
1591b45c03f5SMarkus Armbruster     s = g_new0(StrongARMState, 1);
15925bc95aa2SDmitry Eremin-Solenikov 
1593ba1ba5ccSIgor Mammedov     if (strncmp(cpu_type, "sa1110", 6)) {
15946daf194dSMarkus Armbruster         error_report("Machine requires a SA1110 processor.");
15955bc95aa2SDmitry Eremin-Solenikov         exit(1);
15965bc95aa2SDmitry Eremin-Solenikov     }
15975bc95aa2SDmitry Eremin-Solenikov 
1598ba1ba5ccSIgor Mammedov     s->cpu = ARM_CPU(cpu_create(cpu_type));
15995bc95aa2SDmitry Eremin-Solenikov 
1600c8623c02SDirk Müller     memory_region_allocate_system_memory(&s->sdram, NULL, "strongarm.sdram",
1601c8623c02SDirk Müller                                          sdram_size);
1602eb2fefbcSAvi Kivity     memory_region_add_subregion(sysmem, SA_SDCS0, &s->sdram);
16035bc95aa2SDmitry Eremin-Solenikov 
16045bc95aa2SDmitry Eremin-Solenikov     s->pic = sysbus_create_varargs("strongarm_pic", 0x90050000,
16054f071cf9SPeter Maydell                     qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ),
16064f071cf9SPeter Maydell                     qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_FIQ),
16074f071cf9SPeter Maydell                     NULL);
16085bc95aa2SDmitry Eremin-Solenikov 
16095bc95aa2SDmitry Eremin-Solenikov     sysbus_create_varargs("pxa25x-timer", 0x90000000,
16105bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC0),
16115bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC1),
16125bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC2),
16135bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC3),
16145bc95aa2SDmitry Eremin-Solenikov                     NULL);
16155bc95aa2SDmitry Eremin-Solenikov 
16164e002105SAndreas Färber     sysbus_create_simple(TYPE_STRONGARM_RTC, 0x90010000,
16175bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_RTC_ALARM));
16185bc95aa2SDmitry Eremin-Solenikov 
16195bc95aa2SDmitry Eremin-Solenikov     s->gpio = strongarm_gpio_init(0x90040000, s->pic);
16205bc95aa2SDmitry Eremin-Solenikov 
1621c71e6732SAndreas Färber     s->ppc = sysbus_create_varargs(TYPE_STRONGARM_PPC, 0x90060000, NULL);
16225bc95aa2SDmitry Eremin-Solenikov 
16235bc95aa2SDmitry Eremin-Solenikov     for (i = 0; sa_serial[i].io_base; i++) {
1624fff3af97SAndreas Färber         DeviceState *dev = qdev_create(NULL, TYPE_STRONGARM_UART);
16259bca0edbSPeter Maydell         qdev_prop_set_chr(dev, "chardev", serial_hd(i));
16265bc95aa2SDmitry Eremin-Solenikov         qdev_init_nofail(dev);
16271356b98dSAndreas Färber         sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0,
16285bc95aa2SDmitry Eremin-Solenikov                 sa_serial[i].io_base);
16291356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0,
16305bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, sa_serial[i].irq));
16315bc95aa2SDmitry Eremin-Solenikov     }
16325bc95aa2SDmitry Eremin-Solenikov 
16330ca81872SAndreas Färber     s->ssp = sysbus_create_varargs(TYPE_STRONGARM_SSP, 0x80070000,
16345bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, SA_PIC_SSP), NULL);
16355bc95aa2SDmitry Eremin-Solenikov     s->ssp_bus = (SSIBus *)qdev_get_child_bus(s->ssp, "ssi");
16365bc95aa2SDmitry Eremin-Solenikov 
16375bc95aa2SDmitry Eremin-Solenikov     return s;
16385bc95aa2SDmitry Eremin-Solenikov }
16395bc95aa2SDmitry Eremin-Solenikov 
164083f7d43aSAndreas Färber static void strongarm_register_types(void)
16415bc95aa2SDmitry Eremin-Solenikov {
164239bffca2SAnthony Liguori     type_register_static(&strongarm_pic_info);
164339bffca2SAnthony Liguori     type_register_static(&strongarm_rtc_sysbus_info);
164439bffca2SAnthony Liguori     type_register_static(&strongarm_gpio_info);
164539bffca2SAnthony Liguori     type_register_static(&strongarm_ppc_info);
164639bffca2SAnthony Liguori     type_register_static(&strongarm_uart_info);
164739bffca2SAnthony Liguori     type_register_static(&strongarm_ssp_info);
16485bc95aa2SDmitry Eremin-Solenikov }
164983f7d43aSAndreas Färber 
165083f7d43aSAndreas Färber type_init(strongarm_register_types)
1651