xref: /qemu/hw/arm/strongarm.c (revision 3e80f6902c13f6edb6675c0f33edcbbf0163ec32)
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"
31a8d25326SMarkus Armbruster #include "qemu-common.h"
324771d756SPaolo Bonzini #include "cpu.h"
33c8623c02SDirk Müller #include "hw/boards.h"
3464552b6bSMarkus Armbruster #include "hw/irq.h"
35a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h"
3683c9f4caSPaolo Bonzini #include "hw/sysbus.h"
37d6454270SMarkus Armbruster #include "migration/vmstate.h"
3847b43a1fSPaolo Bonzini #include "strongarm.h"
391de7afc9SPaolo Bonzini #include "qemu/error-report.h"
4012ec8bd5SPeter Maydell #include "hw/arm/boot.h"
414d43a603SMarc-André Lureau #include "chardev/char-fe.h"
427566c6efSMarc-André Lureau #include "chardev/char-serial.h"
439c17d615SPaolo Bonzini #include "sysemu/sysemu.h"
448fd06719SAlistair Francis #include "hw/ssi/ssi.h"
45*3e80f690SMarkus Armbruster #include "qapi/error.h"
46f348b6d1SVeronia Bahaa #include "qemu/cutils.h"
4703dd024fSPaolo Bonzini #include "qemu/log.h"
485bc95aa2SDmitry Eremin-Solenikov 
495bc95aa2SDmitry Eremin-Solenikov //#define DEBUG
505bc95aa2SDmitry Eremin-Solenikov 
515bc95aa2SDmitry Eremin-Solenikov /*
525bc95aa2SDmitry Eremin-Solenikov  TODO
535bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c14 ?
545bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c15 !!! (idle used in L)
555bc95aa2SDmitry Eremin-Solenikov  - Implement idle mode handling/DIM
565bc95aa2SDmitry Eremin-Solenikov  - Implement sleep mode/Wake sources
575bc95aa2SDmitry Eremin-Solenikov  - Implement reset control
585bc95aa2SDmitry Eremin-Solenikov  - Implement memory control regs
595bc95aa2SDmitry Eremin-Solenikov  - PCMCIA handling
605bc95aa2SDmitry Eremin-Solenikov  - Maybe support MBGNT/MBREQ
615bc95aa2SDmitry Eremin-Solenikov  - DMA channels
625bc95aa2SDmitry Eremin-Solenikov  - GPCLK
635bc95aa2SDmitry Eremin-Solenikov  - IrDA
645bc95aa2SDmitry Eremin-Solenikov  - MCP
655bc95aa2SDmitry Eremin-Solenikov  - Enhance UART with modem signals
665bc95aa2SDmitry Eremin-Solenikov  */
675bc95aa2SDmitry Eremin-Solenikov 
685bc95aa2SDmitry Eremin-Solenikov #ifdef DEBUG
695bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) printf(format , ## __VA_ARGS__)
705bc95aa2SDmitry Eremin-Solenikov #else
715bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) do { } while (0)
725bc95aa2SDmitry Eremin-Solenikov #endif
735bc95aa2SDmitry Eremin-Solenikov 
745bc95aa2SDmitry Eremin-Solenikov static struct {
75a8170e5eSAvi Kivity     hwaddr io_base;
765bc95aa2SDmitry Eremin-Solenikov     int irq;
775bc95aa2SDmitry Eremin-Solenikov } sa_serial[] = {
785bc95aa2SDmitry Eremin-Solenikov     { 0x80010000, SA_PIC_UART1 },
795bc95aa2SDmitry Eremin-Solenikov     { 0x80030000, SA_PIC_UART2 },
805bc95aa2SDmitry Eremin-Solenikov     { 0x80050000, SA_PIC_UART3 },
815bc95aa2SDmitry Eremin-Solenikov     { 0, 0 }
825bc95aa2SDmitry Eremin-Solenikov };
835bc95aa2SDmitry Eremin-Solenikov 
845bc95aa2SDmitry Eremin-Solenikov /* Interrupt Controller */
8574e075f6SAndreas Färber 
8674e075f6SAndreas Färber #define TYPE_STRONGARM_PIC "strongarm_pic"
8774e075f6SAndreas Färber #define STRONGARM_PIC(obj) \
8874e075f6SAndreas Färber     OBJECT_CHECK(StrongARMPICState, (obj), TYPE_STRONGARM_PIC)
8974e075f6SAndreas Färber 
9074e075f6SAndreas Färber typedef struct StrongARMPICState {
9174e075f6SAndreas Färber     SysBusDevice parent_obj;
9274e075f6SAndreas Färber 
93eb2fefbcSAvi Kivity     MemoryRegion iomem;
945bc95aa2SDmitry Eremin-Solenikov     qemu_irq    irq;
955bc95aa2SDmitry Eremin-Solenikov     qemu_irq    fiq;
965bc95aa2SDmitry Eremin-Solenikov 
975bc95aa2SDmitry Eremin-Solenikov     uint32_t pending;
985bc95aa2SDmitry Eremin-Solenikov     uint32_t enabled;
995bc95aa2SDmitry Eremin-Solenikov     uint32_t is_fiq;
1005bc95aa2SDmitry Eremin-Solenikov     uint32_t int_idle;
1015bc95aa2SDmitry Eremin-Solenikov } StrongARMPICState;
1025bc95aa2SDmitry Eremin-Solenikov 
1035bc95aa2SDmitry Eremin-Solenikov #define ICIP    0x00
1045bc95aa2SDmitry Eremin-Solenikov #define ICMR    0x04
1055bc95aa2SDmitry Eremin-Solenikov #define ICLR    0x08
1065bc95aa2SDmitry Eremin-Solenikov #define ICFP    0x10
1075bc95aa2SDmitry Eremin-Solenikov #define ICPR    0x20
1085bc95aa2SDmitry Eremin-Solenikov #define ICCR    0x0c
1095bc95aa2SDmitry Eremin-Solenikov 
1105bc95aa2SDmitry Eremin-Solenikov #define SA_PIC_SRCS     32
1115bc95aa2SDmitry Eremin-Solenikov 
1125bc95aa2SDmitry Eremin-Solenikov 
1135bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_update(void *opaque)
1145bc95aa2SDmitry Eremin-Solenikov {
1155bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1165bc95aa2SDmitry Eremin-Solenikov 
1175bc95aa2SDmitry Eremin-Solenikov     /* FIXME: reflect DIM */
1185bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->fiq, s->pending & s->enabled &  s->is_fiq);
1195bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, s->pending & s->enabled & ~s->is_fiq);
1205bc95aa2SDmitry Eremin-Solenikov }
1215bc95aa2SDmitry Eremin-Solenikov 
1225bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_set_irq(void *opaque, int irq, int level)
1235bc95aa2SDmitry Eremin-Solenikov {
1245bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1255bc95aa2SDmitry Eremin-Solenikov 
1265bc95aa2SDmitry Eremin-Solenikov     if (level) {
1275bc95aa2SDmitry Eremin-Solenikov         s->pending |= 1 << irq;
1285bc95aa2SDmitry Eremin-Solenikov     } else {
1295bc95aa2SDmitry Eremin-Solenikov         s->pending &= ~(1 << irq);
1305bc95aa2SDmitry Eremin-Solenikov     }
1315bc95aa2SDmitry Eremin-Solenikov 
1325bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1335bc95aa2SDmitry Eremin-Solenikov }
1345bc95aa2SDmitry Eremin-Solenikov 
135a8170e5eSAvi Kivity static uint64_t strongarm_pic_mem_read(void *opaque, hwaddr offset,
136eb2fefbcSAvi Kivity                                        unsigned size)
1375bc95aa2SDmitry Eremin-Solenikov {
1385bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1395bc95aa2SDmitry Eremin-Solenikov 
1405bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1415bc95aa2SDmitry Eremin-Solenikov     case ICIP:
1425bc95aa2SDmitry Eremin-Solenikov         return s->pending & ~s->is_fiq & s->enabled;
1435bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1445bc95aa2SDmitry Eremin-Solenikov         return s->enabled;
1455bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1465bc95aa2SDmitry Eremin-Solenikov         return s->is_fiq;
1475bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1485bc95aa2SDmitry Eremin-Solenikov         return s->int_idle == 0;
1495bc95aa2SDmitry Eremin-Solenikov     case ICFP:
1505bc95aa2SDmitry Eremin-Solenikov         return s->pending & s->is_fiq & s->enabled;
1515bc95aa2SDmitry Eremin-Solenikov     case ICPR:
1525bc95aa2SDmitry Eremin-Solenikov         return s->pending;
1535bc95aa2SDmitry Eremin-Solenikov     default:
1545bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1555bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1565bc95aa2SDmitry Eremin-Solenikov         return 0;
1575bc95aa2SDmitry Eremin-Solenikov     }
1585bc95aa2SDmitry Eremin-Solenikov }
1595bc95aa2SDmitry Eremin-Solenikov 
160a8170e5eSAvi Kivity static void strongarm_pic_mem_write(void *opaque, hwaddr offset,
161eb2fefbcSAvi Kivity                                     uint64_t value, unsigned size)
1625bc95aa2SDmitry Eremin-Solenikov {
1635bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1645bc95aa2SDmitry Eremin-Solenikov 
1655bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1665bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1675bc95aa2SDmitry Eremin-Solenikov         s->enabled = value;
1685bc95aa2SDmitry Eremin-Solenikov         break;
1695bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1705bc95aa2SDmitry Eremin-Solenikov         s->is_fiq = value;
1715bc95aa2SDmitry Eremin-Solenikov         break;
1725bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1735bc95aa2SDmitry Eremin-Solenikov         s->int_idle = (value & 1) ? 0 : ~0;
1745bc95aa2SDmitry Eremin-Solenikov         break;
1755bc95aa2SDmitry Eremin-Solenikov     default:
1765bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1775bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1785bc95aa2SDmitry Eremin-Solenikov         break;
1795bc95aa2SDmitry Eremin-Solenikov     }
1805bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1815bc95aa2SDmitry Eremin-Solenikov }
1825bc95aa2SDmitry Eremin-Solenikov 
183eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_pic_ops = {
184eb2fefbcSAvi Kivity     .read = strongarm_pic_mem_read,
185eb2fefbcSAvi Kivity     .write = strongarm_pic_mem_write,
186eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
1875bc95aa2SDmitry Eremin-Solenikov };
1885bc95aa2SDmitry Eremin-Solenikov 
1895a67508cSxiaoqiang.zhao static void strongarm_pic_initfn(Object *obj)
1905bc95aa2SDmitry Eremin-Solenikov {
1915a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
1925a67508cSxiaoqiang.zhao     StrongARMPICState *s = STRONGARM_PIC(obj);
1935a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
1945bc95aa2SDmitry Eremin-Solenikov 
19574e075f6SAndreas Färber     qdev_init_gpio_in(dev, strongarm_pic_set_irq, SA_PIC_SRCS);
1965a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_pic_ops, s,
19764bde0f3SPaolo Bonzini                           "pic", 0x1000);
19874e075f6SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
19974e075f6SAndreas Färber     sysbus_init_irq(sbd, &s->irq);
20074e075f6SAndreas Färber     sysbus_init_irq(sbd, &s->fiq);
2015bc95aa2SDmitry Eremin-Solenikov }
2025bc95aa2SDmitry Eremin-Solenikov 
2035bc95aa2SDmitry Eremin-Solenikov static int strongarm_pic_post_load(void *opaque, int version_id)
2045bc95aa2SDmitry Eremin-Solenikov {
2055bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(opaque);
2065bc95aa2SDmitry Eremin-Solenikov     return 0;
2075bc95aa2SDmitry Eremin-Solenikov }
2085bc95aa2SDmitry Eremin-Solenikov 
2095bc95aa2SDmitry Eremin-Solenikov static VMStateDescription vmstate_strongarm_pic_regs = {
2105bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm_pic",
2115bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
2125bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
2135bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_pic_post_load,
2145bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
2155bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(pending, StrongARMPICState),
2165bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(enabled, StrongARMPICState),
2175bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(is_fiq, StrongARMPICState),
2185bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(int_idle, StrongARMPICState),
2195bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
2205bc95aa2SDmitry Eremin-Solenikov     },
2215bc95aa2SDmitry Eremin-Solenikov };
2225bc95aa2SDmitry Eremin-Solenikov 
223999e12bbSAnthony Liguori static void strongarm_pic_class_init(ObjectClass *klass, void *data)
224999e12bbSAnthony Liguori {
22539bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
226999e12bbSAnthony Liguori 
22739bffca2SAnthony Liguori     dc->desc = "StrongARM PIC";
22839bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_pic_regs;
229999e12bbSAnthony Liguori }
230999e12bbSAnthony Liguori 
2318c43a6f0SAndreas Färber static const TypeInfo strongarm_pic_info = {
23274e075f6SAndreas Färber     .name          = TYPE_STRONGARM_PIC,
23339bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
23439bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPICState),
2355a67508cSxiaoqiang.zhao     .instance_init = strongarm_pic_initfn,
236999e12bbSAnthony Liguori     .class_init    = strongarm_pic_class_init,
2375bc95aa2SDmitry Eremin-Solenikov };
2385bc95aa2SDmitry Eremin-Solenikov 
2395bc95aa2SDmitry Eremin-Solenikov /* Real-Time Clock */
2405bc95aa2SDmitry Eremin-Solenikov #define RTAR 0x00 /* RTC Alarm register */
2415bc95aa2SDmitry Eremin-Solenikov #define RCNR 0x04 /* RTC Counter register */
2425bc95aa2SDmitry Eremin-Solenikov #define RTTR 0x08 /* RTC Timer Trim register */
2435bc95aa2SDmitry Eremin-Solenikov #define RTSR 0x10 /* RTC Status register */
2445bc95aa2SDmitry Eremin-Solenikov 
2455bc95aa2SDmitry Eremin-Solenikov #define RTSR_AL (1 << 0) /* RTC Alarm detected */
2465bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZ (1 << 1) /* RTC 1Hz detected */
2475bc95aa2SDmitry Eremin-Solenikov #define RTSR_ALE (1 << 2) /* RTC Alarm enable */
2485bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZE (1 << 3) /* RTC 1Hz enable */
2495bc95aa2SDmitry Eremin-Solenikov 
2505bc95aa2SDmitry Eremin-Solenikov /* 16 LSB of RTTR are clockdiv for internal trim logic,
2515bc95aa2SDmitry Eremin-Solenikov  * trim delete isn't emulated, so
2525bc95aa2SDmitry Eremin-Solenikov  * f = 32 768 / (RTTR_trim + 1) */
2535bc95aa2SDmitry Eremin-Solenikov 
2544e002105SAndreas Färber #define TYPE_STRONGARM_RTC "strongarm-rtc"
2554e002105SAndreas Färber #define STRONGARM_RTC(obj) \
2564e002105SAndreas Färber     OBJECT_CHECK(StrongARMRTCState, (obj), TYPE_STRONGARM_RTC)
2574e002105SAndreas Färber 
2584e002105SAndreas Färber typedef struct StrongARMRTCState {
2594e002105SAndreas Färber     SysBusDevice parent_obj;
2604e002105SAndreas Färber 
261eb2fefbcSAvi Kivity     MemoryRegion iomem;
2625bc95aa2SDmitry Eremin-Solenikov     uint32_t rttr;
2635bc95aa2SDmitry Eremin-Solenikov     uint32_t rtsr;
2645bc95aa2SDmitry Eremin-Solenikov     uint32_t rtar;
2655bc95aa2SDmitry Eremin-Solenikov     uint32_t last_rcnr;
2665bc95aa2SDmitry Eremin-Solenikov     int64_t last_hz;
2675bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_alarm;
2685bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_hz;
2695bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_irq;
2705bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_hz_irq;
2715bc95aa2SDmitry Eremin-Solenikov } StrongARMRTCState;
2725bc95aa2SDmitry Eremin-Solenikov 
2735bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_int_update(StrongARMRTCState *s)
2745bc95aa2SDmitry Eremin-Solenikov {
2755bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_irq, s->rtsr & RTSR_AL);
2765bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_hz_irq, s->rtsr & RTSR_HZ);
2775bc95aa2SDmitry Eremin-Solenikov }
2785bc95aa2SDmitry Eremin-Solenikov 
2795bc95aa2SDmitry Eremin-Solenikov static void strongarm_rtc_hzupdate(StrongARMRTCState *s)
2805bc95aa2SDmitry Eremin-Solenikov {
281884f17c2SAlex Bligh     int64_t rt = qemu_clock_get_ms(rtc_clock);
2825bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr += ((rt - s->last_hz) << 15) /
2835bc95aa2SDmitry Eremin-Solenikov             (1000 * ((s->rttr & 0xffff) + 1));
2845bc95aa2SDmitry Eremin-Solenikov     s->last_hz = rt;
2855bc95aa2SDmitry Eremin-Solenikov }
2865bc95aa2SDmitry Eremin-Solenikov 
2875bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_timer_update(StrongARMRTCState *s)
2885bc95aa2SDmitry Eremin-Solenikov {
2895bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_HZE) && !(s->rtsr & RTSR_HZ)) {
290bc72ad67SAlex Bligh         timer_mod(s->rtc_hz, s->last_hz + 1000);
2915bc95aa2SDmitry Eremin-Solenikov     } else {
292bc72ad67SAlex Bligh         timer_del(s->rtc_hz);
2935bc95aa2SDmitry Eremin-Solenikov     }
2945bc95aa2SDmitry Eremin-Solenikov 
2955bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_ALE) && !(s->rtsr & RTSR_AL)) {
296bc72ad67SAlex Bligh         timer_mod(s->rtc_alarm, s->last_hz +
2975bc95aa2SDmitry Eremin-Solenikov                 (((s->rtar - s->last_rcnr) * 1000 *
2985bc95aa2SDmitry Eremin-Solenikov                   ((s->rttr & 0xffff) + 1)) >> 15));
2995bc95aa2SDmitry Eremin-Solenikov     } else {
300bc72ad67SAlex Bligh         timer_del(s->rtc_alarm);
3015bc95aa2SDmitry Eremin-Solenikov     }
3025bc95aa2SDmitry Eremin-Solenikov }
3035bc95aa2SDmitry Eremin-Solenikov 
3045bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_alarm_tick(void *opaque)
3055bc95aa2SDmitry Eremin-Solenikov {
3065bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3075bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_AL;
3085bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
3095bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
3105bc95aa2SDmitry Eremin-Solenikov }
3115bc95aa2SDmitry Eremin-Solenikov 
3125bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_hz_tick(void *opaque)
3135bc95aa2SDmitry Eremin-Solenikov {
3145bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3155bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_HZ;
3165bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
3175bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
3185bc95aa2SDmitry Eremin-Solenikov }
3195bc95aa2SDmitry Eremin-Solenikov 
320a8170e5eSAvi Kivity static uint64_t strongarm_rtc_read(void *opaque, hwaddr addr,
321eb2fefbcSAvi Kivity                                    unsigned size)
3225bc95aa2SDmitry Eremin-Solenikov {
3235bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3245bc95aa2SDmitry Eremin-Solenikov 
3255bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3265bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3275bc95aa2SDmitry Eremin-Solenikov         return s->rttr;
3285bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3295bc95aa2SDmitry Eremin-Solenikov         return s->rtsr;
3305bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3315bc95aa2SDmitry Eremin-Solenikov         return s->rtar;
3325bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3335bc95aa2SDmitry Eremin-Solenikov         return s->last_rcnr +
334884f17c2SAlex Bligh                 ((qemu_clock_get_ms(rtc_clock) - s->last_hz) << 15) /
3355bc95aa2SDmitry Eremin-Solenikov                 (1000 * ((s->rttr & 0xffff) + 1));
3365bc95aa2SDmitry Eremin-Solenikov     default:
3375bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3385bc95aa2SDmitry Eremin-Solenikov         return 0;
3395bc95aa2SDmitry Eremin-Solenikov     }
3405bc95aa2SDmitry Eremin-Solenikov }
3415bc95aa2SDmitry Eremin-Solenikov 
342a8170e5eSAvi Kivity static void strongarm_rtc_write(void *opaque, hwaddr addr,
343eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
3445bc95aa2SDmitry Eremin-Solenikov {
3455bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3465bc95aa2SDmitry Eremin-Solenikov     uint32_t old_rtsr;
3475bc95aa2SDmitry Eremin-Solenikov 
3485bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3495bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3505bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3515bc95aa2SDmitry Eremin-Solenikov         s->rttr = value;
3525bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3535bc95aa2SDmitry Eremin-Solenikov         break;
3545bc95aa2SDmitry Eremin-Solenikov 
3555bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3565bc95aa2SDmitry Eremin-Solenikov         old_rtsr = s->rtsr;
3575bc95aa2SDmitry Eremin-Solenikov         s->rtsr = (value & (RTSR_ALE | RTSR_HZE)) |
3585bc95aa2SDmitry Eremin-Solenikov                   (s->rtsr & ~(value & (RTSR_AL | RTSR_HZ)));
3595bc95aa2SDmitry Eremin-Solenikov 
3605bc95aa2SDmitry Eremin-Solenikov         if (s->rtsr != old_rtsr) {
3615bc95aa2SDmitry Eremin-Solenikov             strongarm_rtc_timer_update(s);
3625bc95aa2SDmitry Eremin-Solenikov         }
3635bc95aa2SDmitry Eremin-Solenikov 
3645bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_int_update(s);
3655bc95aa2SDmitry Eremin-Solenikov         break;
3665bc95aa2SDmitry Eremin-Solenikov 
3675bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3685bc95aa2SDmitry Eremin-Solenikov         s->rtar = value;
3695bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3705bc95aa2SDmitry Eremin-Solenikov         break;
3715bc95aa2SDmitry Eremin-Solenikov 
3725bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3735bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3745bc95aa2SDmitry Eremin-Solenikov         s->last_rcnr = value;
3755bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3765bc95aa2SDmitry Eremin-Solenikov         break;
3775bc95aa2SDmitry Eremin-Solenikov 
3785bc95aa2SDmitry Eremin-Solenikov     default:
3795bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3805bc95aa2SDmitry Eremin-Solenikov     }
3815bc95aa2SDmitry Eremin-Solenikov }
3825bc95aa2SDmitry Eremin-Solenikov 
383eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_rtc_ops = {
384eb2fefbcSAvi Kivity     .read = strongarm_rtc_read,
385eb2fefbcSAvi Kivity     .write = strongarm_rtc_write,
386eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
3875bc95aa2SDmitry Eremin-Solenikov };
3885bc95aa2SDmitry Eremin-Solenikov 
3895a67508cSxiaoqiang.zhao static void strongarm_rtc_init(Object *obj)
3905bc95aa2SDmitry Eremin-Solenikov {
3915a67508cSxiaoqiang.zhao     StrongARMRTCState *s = STRONGARM_RTC(obj);
3925a67508cSxiaoqiang.zhao     SysBusDevice *dev = SYS_BUS_DEVICE(obj);
3935bc95aa2SDmitry Eremin-Solenikov     struct tm tm;
3945bc95aa2SDmitry Eremin-Solenikov 
3955bc95aa2SDmitry Eremin-Solenikov     s->rttr = 0x0;
3965bc95aa2SDmitry Eremin-Solenikov     s->rtsr = 0;
3975bc95aa2SDmitry Eremin-Solenikov 
3985bc95aa2SDmitry Eremin-Solenikov     qemu_get_timedate(&tm, 0);
3995bc95aa2SDmitry Eremin-Solenikov 
4005bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr = (uint32_t) mktimegm(&tm);
401884f17c2SAlex Bligh     s->last_hz = qemu_clock_get_ms(rtc_clock);
4025bc95aa2SDmitry Eremin-Solenikov 
4035bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_irq);
4045bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_hz_irq);
4055bc95aa2SDmitry Eremin-Solenikov 
4065a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_rtc_ops, s,
40764bde0f3SPaolo Bonzini                           "rtc", 0x10000);
408750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
4095bc95aa2SDmitry Eremin-Solenikov }
4105bc95aa2SDmitry Eremin-Solenikov 
411efb27a49SPan Nengyuan static void strongarm_rtc_realize(DeviceState *dev, Error **errp)
412efb27a49SPan Nengyuan {
413efb27a49SPan Nengyuan     StrongARMRTCState *s = STRONGARM_RTC(dev);
414efb27a49SPan Nengyuan     s->rtc_alarm = timer_new_ms(rtc_clock, strongarm_rtc_alarm_tick, s);
415efb27a49SPan Nengyuan     s->rtc_hz = timer_new_ms(rtc_clock, strongarm_rtc_hz_tick, s);
416efb27a49SPan Nengyuan }
417efb27a49SPan Nengyuan 
41844b1ff31SDr. David Alan Gilbert static int strongarm_rtc_pre_save(void *opaque)
4195bc95aa2SDmitry Eremin-Solenikov {
4205bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
4215bc95aa2SDmitry Eremin-Solenikov 
4225bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_hzupdate(s);
42344b1ff31SDr. David Alan Gilbert 
42444b1ff31SDr. David Alan Gilbert     return 0;
4255bc95aa2SDmitry Eremin-Solenikov }
4265bc95aa2SDmitry Eremin-Solenikov 
4275bc95aa2SDmitry Eremin-Solenikov static int strongarm_rtc_post_load(void *opaque, int version_id)
4285bc95aa2SDmitry Eremin-Solenikov {
4295bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
4305bc95aa2SDmitry Eremin-Solenikov 
4315bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
4325bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
4335bc95aa2SDmitry Eremin-Solenikov 
4345bc95aa2SDmitry Eremin-Solenikov     return 0;
4355bc95aa2SDmitry Eremin-Solenikov }
4365bc95aa2SDmitry Eremin-Solenikov 
4375bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_rtc_regs = {
4385bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-rtc",
4395bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
4405bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
4415bc95aa2SDmitry Eremin-Solenikov     .pre_save = strongarm_rtc_pre_save,
4425bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_rtc_post_load,
4435bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
4445bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rttr, StrongARMRTCState),
4455bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtsr, StrongARMRTCState),
4465bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtar, StrongARMRTCState),
4475bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(last_rcnr, StrongARMRTCState),
4485bc95aa2SDmitry Eremin-Solenikov         VMSTATE_INT64(last_hz, StrongARMRTCState),
4495bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
4505bc95aa2SDmitry Eremin-Solenikov     },
4515bc95aa2SDmitry Eremin-Solenikov };
4525bc95aa2SDmitry Eremin-Solenikov 
453999e12bbSAnthony Liguori static void strongarm_rtc_sysbus_class_init(ObjectClass *klass, void *data)
454999e12bbSAnthony Liguori {
45539bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
456999e12bbSAnthony Liguori 
45739bffca2SAnthony Liguori     dc->desc = "StrongARM RTC Controller";
45839bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_rtc_regs;
459efb27a49SPan Nengyuan     dc->realize = strongarm_rtc_realize;
460999e12bbSAnthony Liguori }
461999e12bbSAnthony Liguori 
4628c43a6f0SAndreas Färber static const TypeInfo strongarm_rtc_sysbus_info = {
4634e002105SAndreas Färber     .name          = TYPE_STRONGARM_RTC,
46439bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
46539bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMRTCState),
4665a67508cSxiaoqiang.zhao     .instance_init = strongarm_rtc_init,
467999e12bbSAnthony Liguori     .class_init    = strongarm_rtc_sysbus_class_init,
4685bc95aa2SDmitry Eremin-Solenikov };
4695bc95aa2SDmitry Eremin-Solenikov 
4705bc95aa2SDmitry Eremin-Solenikov /* GPIO */
4715bc95aa2SDmitry Eremin-Solenikov #define GPLR 0x00
4725bc95aa2SDmitry Eremin-Solenikov #define GPDR 0x04
4735bc95aa2SDmitry Eremin-Solenikov #define GPSR 0x08
4745bc95aa2SDmitry Eremin-Solenikov #define GPCR 0x0c
4755bc95aa2SDmitry Eremin-Solenikov #define GRER 0x10
4765bc95aa2SDmitry Eremin-Solenikov #define GFER 0x14
4775bc95aa2SDmitry Eremin-Solenikov #define GEDR 0x18
4785bc95aa2SDmitry Eremin-Solenikov #define GAFR 0x1c
4795bc95aa2SDmitry Eremin-Solenikov 
480f55beb84SAndreas Färber #define TYPE_STRONGARM_GPIO "strongarm-gpio"
481f55beb84SAndreas Färber #define STRONGARM_GPIO(obj) \
482f55beb84SAndreas Färber     OBJECT_CHECK(StrongARMGPIOInfo, (obj), TYPE_STRONGARM_GPIO)
483f55beb84SAndreas Färber 
4845bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMGPIOInfo StrongARMGPIOInfo;
4855bc95aa2SDmitry Eremin-Solenikov struct StrongARMGPIOInfo {
4865bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
487eb2fefbcSAvi Kivity     MemoryRegion iomem;
4885bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
4895bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqs[11];
4905bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqX;
4915bc95aa2SDmitry Eremin-Solenikov 
4925bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
4935bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
4945bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
4955bc95aa2SDmitry Eremin-Solenikov     uint32_t rising;
4965bc95aa2SDmitry Eremin-Solenikov     uint32_t falling;
4975bc95aa2SDmitry Eremin-Solenikov     uint32_t status;
4985bc95aa2SDmitry Eremin-Solenikov     uint32_t gafr;
4995bc95aa2SDmitry Eremin-Solenikov 
5005bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
5015bc95aa2SDmitry Eremin-Solenikov };
5025bc95aa2SDmitry Eremin-Solenikov 
5035bc95aa2SDmitry Eremin-Solenikov 
5045bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_irq_update(StrongARMGPIOInfo *s)
5055bc95aa2SDmitry Eremin-Solenikov {
5065bc95aa2SDmitry Eremin-Solenikov     int i;
5075bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
5085bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->irqs[i], s->status & (1 << i));
5095bc95aa2SDmitry Eremin-Solenikov     }
5105bc95aa2SDmitry Eremin-Solenikov 
5115bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irqX, (s->status & ~0x7ff));
5125bc95aa2SDmitry Eremin-Solenikov }
5135bc95aa2SDmitry Eremin-Solenikov 
5145bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_set(void *opaque, int line, int level)
5155bc95aa2SDmitry Eremin-Solenikov {
5165bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5175bc95aa2SDmitry Eremin-Solenikov     uint32_t mask;
5185bc95aa2SDmitry Eremin-Solenikov 
5195bc95aa2SDmitry Eremin-Solenikov     mask = 1 << line;
5205bc95aa2SDmitry Eremin-Solenikov 
5215bc95aa2SDmitry Eremin-Solenikov     if (level) {
5225bc95aa2SDmitry Eremin-Solenikov         s->status |= s->rising & mask &
5235bc95aa2SDmitry Eremin-Solenikov                 ~s->ilevel & ~s->dir;
5245bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= mask;
5255bc95aa2SDmitry Eremin-Solenikov     } else {
5265bc95aa2SDmitry Eremin-Solenikov         s->status |= s->falling & mask &
5275bc95aa2SDmitry Eremin-Solenikov                 s->ilevel & ~s->dir;
5285bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~mask;
5295bc95aa2SDmitry Eremin-Solenikov     }
5305bc95aa2SDmitry Eremin-Solenikov 
5315bc95aa2SDmitry Eremin-Solenikov     if (s->status & mask) {
5325bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
5335bc95aa2SDmitry Eremin-Solenikov     }
5345bc95aa2SDmitry Eremin-Solenikov }
5355bc95aa2SDmitry Eremin-Solenikov 
5365bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_handler_update(StrongARMGPIOInfo *s)
5375bc95aa2SDmitry Eremin-Solenikov {
5385bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
5395bc95aa2SDmitry Eremin-Solenikov     int bit;
5405bc95aa2SDmitry Eremin-Solenikov 
5415bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
5425bc95aa2SDmitry Eremin-Solenikov 
5435bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
544786a4ea8SStefan Hajnoczi         bit = ctz32(diff);
5455bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
5465bc95aa2SDmitry Eremin-Solenikov     }
5475bc95aa2SDmitry Eremin-Solenikov 
5485bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
5495bc95aa2SDmitry Eremin-Solenikov }
5505bc95aa2SDmitry Eremin-Solenikov 
551a8170e5eSAvi Kivity static uint64_t strongarm_gpio_read(void *opaque, hwaddr offset,
552eb2fefbcSAvi Kivity                                     unsigned size)
5535bc95aa2SDmitry Eremin-Solenikov {
5545bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5555bc95aa2SDmitry Eremin-Solenikov 
5565bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5575bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
5585bc95aa2SDmitry Eremin-Solenikov         return s->dir;
5595bc95aa2SDmitry Eremin-Solenikov 
5605bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
56192335a0dSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
56292335a0dSPeter Maydell                       "strongarm GPIO: read from write only register GPSR\n");
56392335a0dSPeter Maydell         return 0;
5645bc95aa2SDmitry Eremin-Solenikov 
5655bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
56692335a0dSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
56792335a0dSPeter Maydell                       "strongarm GPIO: read from write only register GPCR\n");
56892335a0dSPeter Maydell         return 0;
5695bc95aa2SDmitry Eremin-Solenikov 
5705bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
5715bc95aa2SDmitry Eremin-Solenikov         return s->rising;
5725bc95aa2SDmitry Eremin-Solenikov 
5735bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
5745bc95aa2SDmitry Eremin-Solenikov         return s->falling;
5755bc95aa2SDmitry Eremin-Solenikov 
5765bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
5775bc95aa2SDmitry Eremin-Solenikov         return s->gafr;
5785bc95aa2SDmitry Eremin-Solenikov 
5795bc95aa2SDmitry Eremin-Solenikov     case GPLR:        /* GPIO Pin-Level registers */
5805bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
5815bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir);
5825bc95aa2SDmitry Eremin-Solenikov 
5835bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
5845bc95aa2SDmitry Eremin-Solenikov         return s->status;
5855bc95aa2SDmitry Eremin-Solenikov 
5865bc95aa2SDmitry Eremin-Solenikov     default:
5875bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
5885bc95aa2SDmitry Eremin-Solenikov     }
5895bc95aa2SDmitry Eremin-Solenikov 
5905bc95aa2SDmitry Eremin-Solenikov     return 0;
5915bc95aa2SDmitry Eremin-Solenikov }
5925bc95aa2SDmitry Eremin-Solenikov 
593a8170e5eSAvi Kivity static void strongarm_gpio_write(void *opaque, hwaddr offset,
594eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
5955bc95aa2SDmitry Eremin-Solenikov {
5965bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5975bc95aa2SDmitry Eremin-Solenikov 
5985bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5995bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
6009a93b2faSPrasad J Pandit         s->dir = value & 0x0fffffff;
6015bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
6025bc95aa2SDmitry Eremin-Solenikov         break;
6035bc95aa2SDmitry Eremin-Solenikov 
6045bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
6059a93b2faSPrasad J Pandit         s->olevel |= value & 0x0fffffff;
6065bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
6075bc95aa2SDmitry Eremin-Solenikov         break;
6085bc95aa2SDmitry Eremin-Solenikov 
6095bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
6105bc95aa2SDmitry Eremin-Solenikov         s->olevel &= ~value;
6115bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
6125bc95aa2SDmitry Eremin-Solenikov         break;
6135bc95aa2SDmitry Eremin-Solenikov 
6145bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
6155bc95aa2SDmitry Eremin-Solenikov         s->rising = value;
6165bc95aa2SDmitry Eremin-Solenikov         break;
6175bc95aa2SDmitry Eremin-Solenikov 
6185bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
6195bc95aa2SDmitry Eremin-Solenikov         s->falling = value;
6205bc95aa2SDmitry Eremin-Solenikov         break;
6215bc95aa2SDmitry Eremin-Solenikov 
6225bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
6235bc95aa2SDmitry Eremin-Solenikov         s->gafr = value;
6245bc95aa2SDmitry Eremin-Solenikov         break;
6255bc95aa2SDmitry Eremin-Solenikov 
6265bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
6275bc95aa2SDmitry Eremin-Solenikov         s->status &= ~value;
6285bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
6295bc95aa2SDmitry Eremin-Solenikov         break;
6305bc95aa2SDmitry Eremin-Solenikov 
6315bc95aa2SDmitry Eremin-Solenikov     default:
6325bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
6335bc95aa2SDmitry Eremin-Solenikov     }
6345bc95aa2SDmitry Eremin-Solenikov }
6355bc95aa2SDmitry Eremin-Solenikov 
636eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_gpio_ops = {
637eb2fefbcSAvi Kivity     .read = strongarm_gpio_read,
638eb2fefbcSAvi Kivity     .write = strongarm_gpio_write,
639eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
6405bc95aa2SDmitry Eremin-Solenikov };
6415bc95aa2SDmitry Eremin-Solenikov 
642a8170e5eSAvi Kivity static DeviceState *strongarm_gpio_init(hwaddr base,
6435bc95aa2SDmitry Eremin-Solenikov                 DeviceState *pic)
6445bc95aa2SDmitry Eremin-Solenikov {
6455bc95aa2SDmitry Eremin-Solenikov     DeviceState *dev;
6465bc95aa2SDmitry Eremin-Solenikov     int i;
6475bc95aa2SDmitry Eremin-Solenikov 
648*3e80f690SMarkus Armbruster     dev = qdev_new(TYPE_STRONGARM_GPIO);
649*3e80f690SMarkus Armbruster     qdev_realize_and_unref(dev, NULL, &error_fatal);
6505bc95aa2SDmitry Eremin-Solenikov 
6511356b98dSAndreas Färber     sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, base);
6525bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 12; i++)
6531356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), i,
6545bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(pic, SA_PIC_GPIO0_EDGE + i));
6555bc95aa2SDmitry Eremin-Solenikov 
6565bc95aa2SDmitry Eremin-Solenikov     return dev;
6575bc95aa2SDmitry Eremin-Solenikov }
6585bc95aa2SDmitry Eremin-Solenikov 
6595a67508cSxiaoqiang.zhao static void strongarm_gpio_initfn(Object *obj)
6605bc95aa2SDmitry Eremin-Solenikov {
6615a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
6625a67508cSxiaoqiang.zhao     StrongARMGPIOInfo *s = STRONGARM_GPIO(obj);
6635a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
6645bc95aa2SDmitry Eremin-Solenikov     int i;
6655bc95aa2SDmitry Eremin-Solenikov 
666f55beb84SAndreas Färber     qdev_init_gpio_in(dev, strongarm_gpio_set, 28);
667f55beb84SAndreas Färber     qdev_init_gpio_out(dev, s->handler, 28);
6685bc95aa2SDmitry Eremin-Solenikov 
6695a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_gpio_ops, s,
67064bde0f3SPaolo Bonzini                           "gpio", 0x1000);
6715bc95aa2SDmitry Eremin-Solenikov 
672f55beb84SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
6735bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
674f55beb84SAndreas Färber         sysbus_init_irq(sbd, &s->irqs[i]);
6755bc95aa2SDmitry Eremin-Solenikov     }
676f55beb84SAndreas Färber     sysbus_init_irq(sbd, &s->irqX);
6775bc95aa2SDmitry Eremin-Solenikov }
6785bc95aa2SDmitry Eremin-Solenikov 
6795bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_gpio_regs = {
6805bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-gpio",
6815bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
6825bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
6835bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
6845bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMGPIOInfo),
6855bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMGPIOInfo),
6865bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMGPIOInfo),
6875bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rising, StrongARMGPIOInfo),
6885bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(falling, StrongARMGPIOInfo),
6895bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(status, StrongARMGPIOInfo),
6905bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(gafr, StrongARMGPIOInfo),
691ed657d71SPeter Maydell         VMSTATE_UINT32(prev_level, StrongARMGPIOInfo),
6925bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
6935bc95aa2SDmitry Eremin-Solenikov     },
6945bc95aa2SDmitry Eremin-Solenikov };
6955bc95aa2SDmitry Eremin-Solenikov 
696999e12bbSAnthony Liguori static void strongarm_gpio_class_init(ObjectClass *klass, void *data)
697999e12bbSAnthony Liguori {
69839bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
699999e12bbSAnthony Liguori 
70039bffca2SAnthony Liguori     dc->desc = "StrongARM GPIO controller";
701ed657d71SPeter Maydell     dc->vmsd = &vmstate_strongarm_gpio_regs;
702999e12bbSAnthony Liguori }
703999e12bbSAnthony Liguori 
7048c43a6f0SAndreas Färber static const TypeInfo strongarm_gpio_info = {
705f55beb84SAndreas Färber     .name          = TYPE_STRONGARM_GPIO,
70639bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
70739bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMGPIOInfo),
7085a67508cSxiaoqiang.zhao     .instance_init = strongarm_gpio_initfn,
709999e12bbSAnthony Liguori     .class_init    = strongarm_gpio_class_init,
7105bc95aa2SDmitry Eremin-Solenikov };
7115bc95aa2SDmitry Eremin-Solenikov 
7125bc95aa2SDmitry Eremin-Solenikov /* Peripheral Pin Controller */
7135bc95aa2SDmitry Eremin-Solenikov #define PPDR 0x00
7145bc95aa2SDmitry Eremin-Solenikov #define PPSR 0x04
7155bc95aa2SDmitry Eremin-Solenikov #define PPAR 0x08
7165bc95aa2SDmitry Eremin-Solenikov #define PSDR 0x0c
7175bc95aa2SDmitry Eremin-Solenikov #define PPFR 0x10
7185bc95aa2SDmitry Eremin-Solenikov 
719c71e6732SAndreas Färber #define TYPE_STRONGARM_PPC "strongarm-ppc"
720c71e6732SAndreas Färber #define STRONGARM_PPC(obj) \
721c71e6732SAndreas Färber     OBJECT_CHECK(StrongARMPPCInfo, (obj), TYPE_STRONGARM_PPC)
722c71e6732SAndreas Färber 
7235bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMPPCInfo StrongARMPPCInfo;
7245bc95aa2SDmitry Eremin-Solenikov struct StrongARMPPCInfo {
725c71e6732SAndreas Färber     SysBusDevice parent_obj;
726c71e6732SAndreas Färber 
727eb2fefbcSAvi Kivity     MemoryRegion iomem;
7285bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
7295bc95aa2SDmitry Eremin-Solenikov 
7305bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
7315bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
7325bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
7335bc95aa2SDmitry Eremin-Solenikov     uint32_t ppar;
7345bc95aa2SDmitry Eremin-Solenikov     uint32_t psdr;
7355bc95aa2SDmitry Eremin-Solenikov     uint32_t ppfr;
7365bc95aa2SDmitry Eremin-Solenikov 
7375bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
7385bc95aa2SDmitry Eremin-Solenikov };
7395bc95aa2SDmitry Eremin-Solenikov 
7405bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_set(void *opaque, int line, int level)
7415bc95aa2SDmitry Eremin-Solenikov {
7425bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7435bc95aa2SDmitry Eremin-Solenikov 
7445bc95aa2SDmitry Eremin-Solenikov     if (level) {
7455bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= 1 << line;
7465bc95aa2SDmitry Eremin-Solenikov     } else {
7475bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~(1 << line);
7485bc95aa2SDmitry Eremin-Solenikov     }
7495bc95aa2SDmitry Eremin-Solenikov }
7505bc95aa2SDmitry Eremin-Solenikov 
7515bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_handler_update(StrongARMPPCInfo *s)
7525bc95aa2SDmitry Eremin-Solenikov {
7535bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
7545bc95aa2SDmitry Eremin-Solenikov     int bit;
7555bc95aa2SDmitry Eremin-Solenikov 
7565bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
7575bc95aa2SDmitry Eremin-Solenikov 
7585bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
759786a4ea8SStefan Hajnoczi         bit = ctz32(diff);
7605bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
7615bc95aa2SDmitry Eremin-Solenikov     }
7625bc95aa2SDmitry Eremin-Solenikov 
7635bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
7645bc95aa2SDmitry Eremin-Solenikov }
7655bc95aa2SDmitry Eremin-Solenikov 
766a8170e5eSAvi Kivity static uint64_t strongarm_ppc_read(void *opaque, hwaddr offset,
767eb2fefbcSAvi Kivity                                    unsigned size)
7685bc95aa2SDmitry Eremin-Solenikov {
7695bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7705bc95aa2SDmitry Eremin-Solenikov 
7715bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
7725bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
7735bc95aa2SDmitry Eremin-Solenikov         return s->dir | ~0x3fffff;
7745bc95aa2SDmitry Eremin-Solenikov 
7755bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
7765bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
7775bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir) |
7785bc95aa2SDmitry Eremin-Solenikov                ~0x3fffff;
7795bc95aa2SDmitry Eremin-Solenikov 
7805bc95aa2SDmitry Eremin-Solenikov     case PPAR:
7815bc95aa2SDmitry Eremin-Solenikov         return s->ppar | ~0x41000;
7825bc95aa2SDmitry Eremin-Solenikov 
7835bc95aa2SDmitry Eremin-Solenikov     case PSDR:
7845bc95aa2SDmitry Eremin-Solenikov         return s->psdr;
7855bc95aa2SDmitry Eremin-Solenikov 
7865bc95aa2SDmitry Eremin-Solenikov     case PPFR:
7875bc95aa2SDmitry Eremin-Solenikov         return s->ppfr | ~0x7f001;
7885bc95aa2SDmitry Eremin-Solenikov 
7895bc95aa2SDmitry Eremin-Solenikov     default:
7905bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
7915bc95aa2SDmitry Eremin-Solenikov     }
7925bc95aa2SDmitry Eremin-Solenikov 
7935bc95aa2SDmitry Eremin-Solenikov     return 0;
7945bc95aa2SDmitry Eremin-Solenikov }
7955bc95aa2SDmitry Eremin-Solenikov 
796a8170e5eSAvi Kivity static void strongarm_ppc_write(void *opaque, hwaddr offset,
797eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
7985bc95aa2SDmitry Eremin-Solenikov {
7995bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
8005bc95aa2SDmitry Eremin-Solenikov 
8015bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
8025bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
8035bc95aa2SDmitry Eremin-Solenikov         s->dir = value & 0x3fffff;
8045bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
8055bc95aa2SDmitry Eremin-Solenikov         break;
8065bc95aa2SDmitry Eremin-Solenikov 
8075bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
8085bc95aa2SDmitry Eremin-Solenikov         s->olevel = value & s->dir & 0x3fffff;
8095bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
8105bc95aa2SDmitry Eremin-Solenikov         break;
8115bc95aa2SDmitry Eremin-Solenikov 
8125bc95aa2SDmitry Eremin-Solenikov     case PPAR:
8135bc95aa2SDmitry Eremin-Solenikov         s->ppar = value & 0x41000;
8145bc95aa2SDmitry Eremin-Solenikov         break;
8155bc95aa2SDmitry Eremin-Solenikov 
8165bc95aa2SDmitry Eremin-Solenikov     case PSDR:
8175bc95aa2SDmitry Eremin-Solenikov         s->psdr = value & 0x3fffff;
8185bc95aa2SDmitry Eremin-Solenikov         break;
8195bc95aa2SDmitry Eremin-Solenikov 
8205bc95aa2SDmitry Eremin-Solenikov     case PPFR:
8215bc95aa2SDmitry Eremin-Solenikov         s->ppfr = value & 0x7f001;
8225bc95aa2SDmitry Eremin-Solenikov         break;
8235bc95aa2SDmitry Eremin-Solenikov 
8245bc95aa2SDmitry Eremin-Solenikov     default:
8255bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
8265bc95aa2SDmitry Eremin-Solenikov     }
8275bc95aa2SDmitry Eremin-Solenikov }
8285bc95aa2SDmitry Eremin-Solenikov 
829eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ppc_ops = {
830eb2fefbcSAvi Kivity     .read = strongarm_ppc_read,
831eb2fefbcSAvi Kivity     .write = strongarm_ppc_write,
832eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
8335bc95aa2SDmitry Eremin-Solenikov };
8345bc95aa2SDmitry Eremin-Solenikov 
8355a67508cSxiaoqiang.zhao static void strongarm_ppc_init(Object *obj)
8365bc95aa2SDmitry Eremin-Solenikov {
8375a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
8385a67508cSxiaoqiang.zhao     StrongARMPPCInfo *s = STRONGARM_PPC(obj);
8395a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
8405bc95aa2SDmitry Eremin-Solenikov 
841c71e6732SAndreas Färber     qdev_init_gpio_in(dev, strongarm_ppc_set, 22);
842c71e6732SAndreas Färber     qdev_init_gpio_out(dev, s->handler, 22);
8435bc95aa2SDmitry Eremin-Solenikov 
8445a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_ppc_ops, s,
84564bde0f3SPaolo Bonzini                           "ppc", 0x1000);
8465bc95aa2SDmitry Eremin-Solenikov 
847c71e6732SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
8485bc95aa2SDmitry Eremin-Solenikov }
8495bc95aa2SDmitry Eremin-Solenikov 
8505bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ppc_regs = {
8515bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ppc",
8525bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
8535bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
8545bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
8555bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMPPCInfo),
8565bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMPPCInfo),
8575bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMPPCInfo),
8585bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppar, StrongARMPPCInfo),
8595bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(psdr, StrongARMPPCInfo),
8605bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppfr, StrongARMPPCInfo),
861ed657d71SPeter Maydell         VMSTATE_UINT32(prev_level, StrongARMPPCInfo),
8625bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
8635bc95aa2SDmitry Eremin-Solenikov     },
8645bc95aa2SDmitry Eremin-Solenikov };
8655bc95aa2SDmitry Eremin-Solenikov 
866999e12bbSAnthony Liguori static void strongarm_ppc_class_init(ObjectClass *klass, void *data)
867999e12bbSAnthony Liguori {
86839bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
869999e12bbSAnthony Liguori 
87039bffca2SAnthony Liguori     dc->desc = "StrongARM PPC controller";
871ed657d71SPeter Maydell     dc->vmsd = &vmstate_strongarm_ppc_regs;
872999e12bbSAnthony Liguori }
873999e12bbSAnthony Liguori 
8748c43a6f0SAndreas Färber static const TypeInfo strongarm_ppc_info = {
875c71e6732SAndreas Färber     .name          = TYPE_STRONGARM_PPC,
87639bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
87739bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPPCInfo),
8785a67508cSxiaoqiang.zhao     .instance_init = strongarm_ppc_init,
879999e12bbSAnthony Liguori     .class_init    = strongarm_ppc_class_init,
8805bc95aa2SDmitry Eremin-Solenikov };
8815bc95aa2SDmitry Eremin-Solenikov 
8825bc95aa2SDmitry Eremin-Solenikov /* UART Ports */
8835bc95aa2SDmitry Eremin-Solenikov #define UTCR0 0x00
8845bc95aa2SDmitry Eremin-Solenikov #define UTCR1 0x04
8855bc95aa2SDmitry Eremin-Solenikov #define UTCR2 0x08
8865bc95aa2SDmitry Eremin-Solenikov #define UTCR3 0x0c
8875bc95aa2SDmitry Eremin-Solenikov #define UTDR  0x14
8885bc95aa2SDmitry Eremin-Solenikov #define UTSR0 0x1c
8895bc95aa2SDmitry Eremin-Solenikov #define UTSR1 0x20
8905bc95aa2SDmitry Eremin-Solenikov 
8915bc95aa2SDmitry Eremin-Solenikov #define UTCR0_PE  (1 << 0) /* Parity enable */
8925bc95aa2SDmitry Eremin-Solenikov #define UTCR0_OES (1 << 1) /* Even parity */
8935bc95aa2SDmitry Eremin-Solenikov #define UTCR0_SBS (1 << 2) /* 2 stop bits */
8945bc95aa2SDmitry Eremin-Solenikov #define UTCR0_DSS (1 << 3) /* 8-bit data */
8955bc95aa2SDmitry Eremin-Solenikov 
8965bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RXE (1 << 0) /* Rx enable */
8975bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TXE (1 << 1) /* Tx enable */
8985bc95aa2SDmitry Eremin-Solenikov #define UTCR3_BRK (1 << 2) /* Force Break */
8995bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RIE (1 << 3) /* Rx int enable */
9005bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TIE (1 << 4) /* Tx int enable */
9015bc95aa2SDmitry Eremin-Solenikov #define UTCR3_LBM (1 << 5) /* Loopback */
9025bc95aa2SDmitry Eremin-Solenikov 
9035bc95aa2SDmitry Eremin-Solenikov #define UTSR0_TFS (1 << 0) /* Tx FIFO nearly empty */
9045bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RFS (1 << 1) /* Rx FIFO nearly full */
9055bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RID (1 << 2) /* Receiver Idle */
9065bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RBB (1 << 3) /* Receiver begin break */
9075bc95aa2SDmitry Eremin-Solenikov #define UTSR0_REB (1 << 4) /* Receiver end break */
9085bc95aa2SDmitry Eremin-Solenikov #define UTSR0_EIF (1 << 5) /* Error in FIFO */
9095bc95aa2SDmitry Eremin-Solenikov 
9105bc95aa2SDmitry Eremin-Solenikov #define UTSR1_RNE (1 << 1) /* Receive FIFO not empty */
9115bc95aa2SDmitry Eremin-Solenikov #define UTSR1_TNF (1 << 2) /* Transmit FIFO not full */
9125bc95aa2SDmitry Eremin-Solenikov #define UTSR1_PRE (1 << 3) /* Parity error */
9135bc95aa2SDmitry Eremin-Solenikov #define UTSR1_FRE (1 << 4) /* Frame error */
9145bc95aa2SDmitry Eremin-Solenikov #define UTSR1_ROR (1 << 5) /* Receive Over Run */
9155bc95aa2SDmitry Eremin-Solenikov 
9165bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_PRE (1 << 8)
9175bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_FRE (1 << 9)
9185bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_ROR (1 << 10)
9195bc95aa2SDmitry Eremin-Solenikov 
920fff3af97SAndreas Färber #define TYPE_STRONGARM_UART "strongarm-uart"
921fff3af97SAndreas Färber #define STRONGARM_UART(obj) \
922fff3af97SAndreas Färber     OBJECT_CHECK(StrongARMUARTState, (obj), TYPE_STRONGARM_UART)
923fff3af97SAndreas Färber 
924fff3af97SAndreas Färber typedef struct StrongARMUARTState {
925fff3af97SAndreas Färber     SysBusDevice parent_obj;
926fff3af97SAndreas Färber 
927eb2fefbcSAvi Kivity     MemoryRegion iomem;
928becdfa00SMarc-André Lureau     CharBackend chr;
9295bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
9305bc95aa2SDmitry Eremin-Solenikov 
9315bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr0;
9325bc95aa2SDmitry Eremin-Solenikov     uint16_t brd;
9335bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr3;
9345bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr0;
9355bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr1;
9365bc95aa2SDmitry Eremin-Solenikov 
9375bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_fifo[8];
9385bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_start;
9395bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_len;
9405bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[12]; /* value + error flags in high bits */
9415bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
9425bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_len;
9435bc95aa2SDmitry Eremin-Solenikov 
9445bc95aa2SDmitry Eremin-Solenikov     uint64_t char_transmit_time; /* time to transmit a char in ticks*/
9455bc95aa2SDmitry Eremin-Solenikov     bool wait_break_end;
9465bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rx_timeout_timer;
9475bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *tx_timer;
9485bc95aa2SDmitry Eremin-Solenikov } StrongARMUARTState;
9495bc95aa2SDmitry Eremin-Solenikov 
9505bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_status(StrongARMUARTState *s)
9515bc95aa2SDmitry Eremin-Solenikov {
9525bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr1 = 0;
9535bc95aa2SDmitry Eremin-Solenikov 
9545bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len != 8) {
9555bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_TNF;
9565bc95aa2SDmitry Eremin-Solenikov     }
9575bc95aa2SDmitry Eremin-Solenikov 
9585bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len != 0) {
9595bc95aa2SDmitry Eremin-Solenikov         uint16_t ent = s->rx_fifo[s->rx_start];
9605bc95aa2SDmitry Eremin-Solenikov 
9615bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_RNE;
9625bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_PRE) {
9635bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_PRE;
9645bc95aa2SDmitry Eremin-Solenikov         }
9655bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_FRE) {
9665bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_FRE;
9675bc95aa2SDmitry Eremin-Solenikov         }
9685bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_ROR) {
9695bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_ROR;
9705bc95aa2SDmitry Eremin-Solenikov         }
9715bc95aa2SDmitry Eremin-Solenikov     }
9725bc95aa2SDmitry Eremin-Solenikov 
9735bc95aa2SDmitry Eremin-Solenikov     s->utsr1 = utsr1;
9745bc95aa2SDmitry Eremin-Solenikov }
9755bc95aa2SDmitry Eremin-Solenikov 
9765bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_int_status(StrongARMUARTState *s)
9775bc95aa2SDmitry Eremin-Solenikov {
9785bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr0 = s->utsr0 &
9795bc95aa2SDmitry Eremin-Solenikov             (UTSR0_REB | UTSR0_RBB | UTSR0_RID);
9805bc95aa2SDmitry Eremin-Solenikov     int i;
9815bc95aa2SDmitry Eremin-Solenikov 
9825bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_TXE) &&
9835bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_TIE) &&
9845bc95aa2SDmitry Eremin-Solenikov                 s->tx_len <= 4) {
9855bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_TFS;
9865bc95aa2SDmitry Eremin-Solenikov     }
9875bc95aa2SDmitry Eremin-Solenikov 
9885bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) &&
9895bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_RIE) &&
9905bc95aa2SDmitry Eremin-Solenikov                 s->rx_len > 4) {
9915bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_RFS;
9925bc95aa2SDmitry Eremin-Solenikov     }
9935bc95aa2SDmitry Eremin-Solenikov 
9945bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < s->rx_len && i < 4; i++)
9955bc95aa2SDmitry Eremin-Solenikov         if (s->rx_fifo[(s->rx_start + i) % 12] & ~0xff) {
9965bc95aa2SDmitry Eremin-Solenikov             utsr0 |= UTSR0_EIF;
9975bc95aa2SDmitry Eremin-Solenikov             break;
9985bc95aa2SDmitry Eremin-Solenikov         }
9995bc95aa2SDmitry Eremin-Solenikov 
10005bc95aa2SDmitry Eremin-Solenikov     s->utsr0 = utsr0;
10015bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, utsr0);
10025bc95aa2SDmitry Eremin-Solenikov }
10035bc95aa2SDmitry Eremin-Solenikov 
10045bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_parameters(StrongARMUARTState *s)
10055bc95aa2SDmitry Eremin-Solenikov {
10065bc95aa2SDmitry Eremin-Solenikov     int speed, parity, data_bits, stop_bits, frame_size;
10075bc95aa2SDmitry Eremin-Solenikov     QEMUSerialSetParams ssp;
10085bc95aa2SDmitry Eremin-Solenikov 
10095bc95aa2SDmitry Eremin-Solenikov     /* Start bit. */
10105bc95aa2SDmitry Eremin-Solenikov     frame_size = 1;
10115bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_PE) {
10125bc95aa2SDmitry Eremin-Solenikov         /* Parity bit. */
10135bc95aa2SDmitry Eremin-Solenikov         frame_size++;
10145bc95aa2SDmitry Eremin-Solenikov         if (s->utcr0 & UTCR0_OES) {
10155bc95aa2SDmitry Eremin-Solenikov             parity = 'E';
10165bc95aa2SDmitry Eremin-Solenikov         } else {
10175bc95aa2SDmitry Eremin-Solenikov             parity = 'O';
10185bc95aa2SDmitry Eremin-Solenikov         }
10195bc95aa2SDmitry Eremin-Solenikov     } else {
10205bc95aa2SDmitry Eremin-Solenikov             parity = 'N';
10215bc95aa2SDmitry Eremin-Solenikov     }
10225bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_SBS) {
10235bc95aa2SDmitry Eremin-Solenikov         stop_bits = 2;
10245bc95aa2SDmitry Eremin-Solenikov     } else {
10255bc95aa2SDmitry Eremin-Solenikov         stop_bits = 1;
10265bc95aa2SDmitry Eremin-Solenikov     }
10275bc95aa2SDmitry Eremin-Solenikov 
10285bc95aa2SDmitry Eremin-Solenikov     data_bits = (s->utcr0 & UTCR0_DSS) ? 8 : 7;
10295bc95aa2SDmitry Eremin-Solenikov     frame_size += data_bits + stop_bits;
10305bc95aa2SDmitry Eremin-Solenikov     speed = 3686400 / 16 / (s->brd + 1);
10315bc95aa2SDmitry Eremin-Solenikov     ssp.speed = speed;
10325bc95aa2SDmitry Eremin-Solenikov     ssp.parity = parity;
10335bc95aa2SDmitry Eremin-Solenikov     ssp.data_bits = data_bits;
10345bc95aa2SDmitry Eremin-Solenikov     ssp.stop_bits = stop_bits;
103573bcb24dSRutuja Shah     s->char_transmit_time =  (NANOSECONDS_PER_SECOND / speed) * frame_size;
10365345fdb4SMarc-André Lureau     qemu_chr_fe_ioctl(&s->chr, CHR_IOCTL_SERIAL_SET_PARAMS, &ssp);
10375bc95aa2SDmitry Eremin-Solenikov 
10385bc95aa2SDmitry Eremin-Solenikov     DPRINTF(stderr, "%s speed=%d parity=%c data=%d stop=%d\n", s->chr->label,
10395bc95aa2SDmitry Eremin-Solenikov             speed, parity, data_bits, stop_bits);
10405bc95aa2SDmitry Eremin-Solenikov }
10415bc95aa2SDmitry Eremin-Solenikov 
10425bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_to(void *opaque)
10435bc95aa2SDmitry Eremin-Solenikov {
10445bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10455bc95aa2SDmitry Eremin-Solenikov 
10465bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
10475bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RID;
10485bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
10495bc95aa2SDmitry Eremin-Solenikov     }
10505bc95aa2SDmitry Eremin-Solenikov }
10515bc95aa2SDmitry Eremin-Solenikov 
10525bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_push(StrongARMUARTState *s, uint16_t c)
10535bc95aa2SDmitry Eremin-Solenikov {
10545bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) == 0) {
10555bc95aa2SDmitry Eremin-Solenikov         /* rx disabled */
10565bc95aa2SDmitry Eremin-Solenikov         return;
10575bc95aa2SDmitry Eremin-Solenikov     }
10585bc95aa2SDmitry Eremin-Solenikov 
10595bc95aa2SDmitry Eremin-Solenikov     if (s->wait_break_end) {
10605bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_REB;
10615bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = false;
10625bc95aa2SDmitry Eremin-Solenikov     }
10635bc95aa2SDmitry Eremin-Solenikov 
10645bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 12) {
10655bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + s->rx_len) % 12] = c;
10665bc95aa2SDmitry Eremin-Solenikov         s->rx_len++;
10675bc95aa2SDmitry Eremin-Solenikov     } else
10685bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + 11) % 12] |= RX_FIFO_ROR;
10695bc95aa2SDmitry Eremin-Solenikov }
10705bc95aa2SDmitry Eremin-Solenikov 
10715bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_can_receive(void *opaque)
10725bc95aa2SDmitry Eremin-Solenikov {
10735bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10745bc95aa2SDmitry Eremin-Solenikov 
10755bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len == 12) {
10765bc95aa2SDmitry Eremin-Solenikov         return 0;
10775bc95aa2SDmitry Eremin-Solenikov     }
10785bc95aa2SDmitry Eremin-Solenikov     /* It's best not to get more than 2/3 of RX FIFO, so advertise that much */
10795bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 8) {
10805bc95aa2SDmitry Eremin-Solenikov         return 8 - s->rx_len;
10815bc95aa2SDmitry Eremin-Solenikov     }
10825bc95aa2SDmitry Eremin-Solenikov     return 1;
10835bc95aa2SDmitry Eremin-Solenikov }
10845bc95aa2SDmitry Eremin-Solenikov 
10855bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_receive(void *opaque, const uint8_t *buf, int size)
10865bc95aa2SDmitry Eremin-Solenikov {
10875bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10885bc95aa2SDmitry Eremin-Solenikov     int i;
10895bc95aa2SDmitry Eremin-Solenikov 
10905bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < size; i++) {
10915bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, buf[i]);
10925bc95aa2SDmitry Eremin-Solenikov     }
10935bc95aa2SDmitry Eremin-Solenikov 
10945bc95aa2SDmitry Eremin-Solenikov     /* call the timeout receive callback in 3 char transmit time */
1095bc72ad67SAlex Bligh     timer_mod(s->rx_timeout_timer,
1096bc72ad67SAlex Bligh                     qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
10975bc95aa2SDmitry Eremin-Solenikov 
10985bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
10995bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
11005bc95aa2SDmitry Eremin-Solenikov }
11015bc95aa2SDmitry Eremin-Solenikov 
1102083b266fSPhilippe Mathieu-Daudé static void strongarm_uart_event(void *opaque, QEMUChrEvent event)
11035bc95aa2SDmitry Eremin-Solenikov {
11045bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11055bc95aa2SDmitry Eremin-Solenikov     if (event == CHR_EVENT_BREAK) {
11065bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RBB;
11075bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, RX_FIFO_FRE);
11085bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = true;
11095bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
11105bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
11115bc95aa2SDmitry Eremin-Solenikov     }
11125bc95aa2SDmitry Eremin-Solenikov }
11135bc95aa2SDmitry Eremin-Solenikov 
11145bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_tx(void *opaque)
11155bc95aa2SDmitry Eremin-Solenikov {
11165bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
1117bc72ad67SAlex Bligh     uint64_t new_xmit_ts = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
11185bc95aa2SDmitry Eremin-Solenikov 
11195bc95aa2SDmitry Eremin-Solenikov     if (s->utcr3 & UTCR3_LBM) /* loopback */ {
11205bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_receive(s, &s->tx_fifo[s->tx_start], 1);
112130650701SAnton Nefedov     } else if (qemu_chr_fe_backend_connected(&s->chr)) {
11226ab3fc32SDaniel P. Berrange         /* XXX this blocks entire thread. Rewrite to use
11236ab3fc32SDaniel P. Berrange          * qemu_chr_fe_write and background I/O callbacks */
11245345fdb4SMarc-André Lureau         qemu_chr_fe_write_all(&s->chr, &s->tx_fifo[s->tx_start], 1);
11255bc95aa2SDmitry Eremin-Solenikov     }
11265bc95aa2SDmitry Eremin-Solenikov 
11275bc95aa2SDmitry Eremin-Solenikov     s->tx_start = (s->tx_start + 1) % 8;
11285bc95aa2SDmitry Eremin-Solenikov     s->tx_len--;
11295bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
1130bc72ad67SAlex Bligh         timer_mod(s->tx_timer, new_xmit_ts + s->char_transmit_time);
11315bc95aa2SDmitry Eremin-Solenikov     }
11325bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
11335bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
11345bc95aa2SDmitry Eremin-Solenikov }
11355bc95aa2SDmitry Eremin-Solenikov 
1136a8170e5eSAvi Kivity static uint64_t strongarm_uart_read(void *opaque, hwaddr addr,
1137eb2fefbcSAvi Kivity                                     unsigned size)
11385bc95aa2SDmitry Eremin-Solenikov {
11395bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11405bc95aa2SDmitry Eremin-Solenikov     uint16_t ret;
11415bc95aa2SDmitry Eremin-Solenikov 
11425bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11435bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11445bc95aa2SDmitry Eremin-Solenikov         return s->utcr0;
11455bc95aa2SDmitry Eremin-Solenikov 
11465bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11475bc95aa2SDmitry Eremin-Solenikov         return s->brd >> 8;
11485bc95aa2SDmitry Eremin-Solenikov 
11495bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11505bc95aa2SDmitry Eremin-Solenikov         return s->brd & 0xff;
11515bc95aa2SDmitry Eremin-Solenikov 
11525bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
11535bc95aa2SDmitry Eremin-Solenikov         return s->utcr3;
11545bc95aa2SDmitry Eremin-Solenikov 
11555bc95aa2SDmitry Eremin-Solenikov     case UTDR:
11565bc95aa2SDmitry Eremin-Solenikov         if (s->rx_len != 0) {
11575bc95aa2SDmitry Eremin-Solenikov             ret = s->rx_fifo[s->rx_start];
11585bc95aa2SDmitry Eremin-Solenikov             s->rx_start = (s->rx_start + 1) % 12;
11595bc95aa2SDmitry Eremin-Solenikov             s->rx_len--;
11605bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
11615bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
11625bc95aa2SDmitry Eremin-Solenikov             return ret;
11635bc95aa2SDmitry Eremin-Solenikov         }
11645bc95aa2SDmitry Eremin-Solenikov         return 0;
11655bc95aa2SDmitry Eremin-Solenikov 
11665bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
11675bc95aa2SDmitry Eremin-Solenikov         return s->utsr0;
11685bc95aa2SDmitry Eremin-Solenikov 
11695bc95aa2SDmitry Eremin-Solenikov     case UTSR1:
11705bc95aa2SDmitry Eremin-Solenikov         return s->utsr1;
11715bc95aa2SDmitry Eremin-Solenikov 
11725bc95aa2SDmitry Eremin-Solenikov     default:
11735bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
11745bc95aa2SDmitry Eremin-Solenikov         return 0;
11755bc95aa2SDmitry Eremin-Solenikov     }
11765bc95aa2SDmitry Eremin-Solenikov }
11775bc95aa2SDmitry Eremin-Solenikov 
1178a8170e5eSAvi Kivity static void strongarm_uart_write(void *opaque, hwaddr addr,
1179eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
11805bc95aa2SDmitry Eremin-Solenikov {
11815bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11825bc95aa2SDmitry Eremin-Solenikov 
11835bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11845bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11855bc95aa2SDmitry Eremin-Solenikov         s->utcr0 = value & 0x7f;
11865bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11875bc95aa2SDmitry Eremin-Solenikov         break;
11885bc95aa2SDmitry Eremin-Solenikov 
11895bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11905bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xff) | ((value & 0xf) << 8);
11915bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11925bc95aa2SDmitry Eremin-Solenikov         break;
11935bc95aa2SDmitry Eremin-Solenikov 
11945bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11955bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xf00) | (value & 0xff);
11965bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11975bc95aa2SDmitry Eremin-Solenikov         break;
11985bc95aa2SDmitry Eremin-Solenikov 
11995bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
12005bc95aa2SDmitry Eremin-Solenikov         s->utcr3 = value & 0x3f;
12015bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_RXE) == 0) {
12025bc95aa2SDmitry Eremin-Solenikov             s->rx_len = 0;
12035bc95aa2SDmitry Eremin-Solenikov         }
12045bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) == 0) {
12055bc95aa2SDmitry Eremin-Solenikov             s->tx_len = 0;
12065bc95aa2SDmitry Eremin-Solenikov         }
12075bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
12085bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
12095bc95aa2SDmitry Eremin-Solenikov         break;
12105bc95aa2SDmitry Eremin-Solenikov 
12115bc95aa2SDmitry Eremin-Solenikov     case UTDR:
12125bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) && s->tx_len != 8) {
12135bc95aa2SDmitry Eremin-Solenikov             s->tx_fifo[(s->tx_start + s->tx_len) % 8] = value;
12145bc95aa2SDmitry Eremin-Solenikov             s->tx_len++;
12155bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
12165bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
12175bc95aa2SDmitry Eremin-Solenikov             if (s->tx_len == 1) {
12185bc95aa2SDmitry Eremin-Solenikov                 strongarm_uart_tx(s);
12195bc95aa2SDmitry Eremin-Solenikov             }
12205bc95aa2SDmitry Eremin-Solenikov         }
12215bc95aa2SDmitry Eremin-Solenikov         break;
12225bc95aa2SDmitry Eremin-Solenikov 
12235bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
12245bc95aa2SDmitry Eremin-Solenikov         s->utsr0 = s->utsr0 & ~(value &
12255bc95aa2SDmitry Eremin-Solenikov                 (UTSR0_REB | UTSR0_RBB | UTSR0_RID));
12265bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
12275bc95aa2SDmitry Eremin-Solenikov         break;
12285bc95aa2SDmitry Eremin-Solenikov 
12295bc95aa2SDmitry Eremin-Solenikov     default:
12305bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
12315bc95aa2SDmitry Eremin-Solenikov     }
12325bc95aa2SDmitry Eremin-Solenikov }
12335bc95aa2SDmitry Eremin-Solenikov 
1234eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_uart_ops = {
1235eb2fefbcSAvi Kivity     .read = strongarm_uart_read,
1236eb2fefbcSAvi Kivity     .write = strongarm_uart_write,
1237eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
12385bc95aa2SDmitry Eremin-Solenikov };
12395bc95aa2SDmitry Eremin-Solenikov 
12405a67508cSxiaoqiang.zhao static void strongarm_uart_init(Object *obj)
12415bc95aa2SDmitry Eremin-Solenikov {
12425a67508cSxiaoqiang.zhao     StrongARMUARTState *s = STRONGARM_UART(obj);
12435a67508cSxiaoqiang.zhao     SysBusDevice *dev = SYS_BUS_DEVICE(obj);
12445bc95aa2SDmitry Eremin-Solenikov 
12455a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_uart_ops, s,
124664bde0f3SPaolo Bonzini                           "uart", 0x10000);
1247750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
12485bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->irq);
12498934515aSxiaoqiang zhao }
12508934515aSxiaoqiang zhao 
12518934515aSxiaoqiang zhao static void strongarm_uart_realize(DeviceState *dev, Error **errp)
12528934515aSxiaoqiang zhao {
12538934515aSxiaoqiang zhao     StrongARMUARTState *s = STRONGARM_UART(dev);
12545bc95aa2SDmitry Eremin-Solenikov 
1255efb27a49SPan Nengyuan     s->rx_timeout_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
1256efb27a49SPan Nengyuan                                        strongarm_uart_rx_to,
1257efb27a49SPan Nengyuan                                        s);
1258efb27a49SPan Nengyuan     s->tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_tx, s);
12595345fdb4SMarc-André Lureau     qemu_chr_fe_set_handlers(&s->chr,
12605bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_can_receive,
12615bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_receive,
12625bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_event,
126381517ba3SAnton Nefedov                              NULL, s, NULL, true);
12645bc95aa2SDmitry Eremin-Solenikov }
12655bc95aa2SDmitry Eremin-Solenikov 
12665bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_reset(DeviceState *dev)
12675bc95aa2SDmitry Eremin-Solenikov {
1268fff3af97SAndreas Färber     StrongARMUARTState *s = STRONGARM_UART(dev);
12695bc95aa2SDmitry Eremin-Solenikov 
12705bc95aa2SDmitry Eremin-Solenikov     s->utcr0 = UTCR0_DSS; /* 8 data, no parity */
12715bc95aa2SDmitry Eremin-Solenikov     s->brd = 23;    /* 9600 */
12725bc95aa2SDmitry Eremin-Solenikov     /* enable send & recv - this actually violates spec */
12735bc95aa2SDmitry Eremin-Solenikov     s->utcr3 = UTCR3_TXE | UTCR3_RXE;
12745bc95aa2SDmitry Eremin-Solenikov 
12755bc95aa2SDmitry Eremin-Solenikov     s->rx_len = s->tx_len = 0;
12765bc95aa2SDmitry Eremin-Solenikov 
12775bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12785bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12795bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12805bc95aa2SDmitry Eremin-Solenikov }
12815bc95aa2SDmitry Eremin-Solenikov 
12825bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_post_load(void *opaque, int version_id)
12835bc95aa2SDmitry Eremin-Solenikov {
12845bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
12855bc95aa2SDmitry Eremin-Solenikov 
12865bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12875bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12885bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12895bc95aa2SDmitry Eremin-Solenikov 
12905bc95aa2SDmitry Eremin-Solenikov     /* tx and restart timer */
12915bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
12925bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_tx(s);
12935bc95aa2SDmitry Eremin-Solenikov     }
12945bc95aa2SDmitry Eremin-Solenikov 
12955bc95aa2SDmitry Eremin-Solenikov     /* restart rx timeout timer */
12965bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
1297bc72ad67SAlex Bligh         timer_mod(s->rx_timeout_timer,
1298bc72ad67SAlex Bligh                 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
12995bc95aa2SDmitry Eremin-Solenikov     }
13005bc95aa2SDmitry Eremin-Solenikov 
13015bc95aa2SDmitry Eremin-Solenikov     return 0;
13025bc95aa2SDmitry Eremin-Solenikov }
13035bc95aa2SDmitry Eremin-Solenikov 
13045bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_uart_regs = {
13055bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-uart",
13065bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
13075bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
13085bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_uart_post_load,
13095bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
13105bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr0, StrongARMUARTState),
13115bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(brd, StrongARMUARTState),
13125bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr3, StrongARMUARTState),
13135bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utsr0, StrongARMUARTState),
13145bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8_ARRAY(tx_fifo, StrongARMUARTState, 8),
13155bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_start, StrongARMUARTState),
13165bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_len, StrongARMUARTState),
13175bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMUARTState, 12),
13185bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMUARTState),
13195bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_len, StrongARMUARTState),
13205bc95aa2SDmitry Eremin-Solenikov         VMSTATE_BOOL(wait_break_end, StrongARMUARTState),
13215bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
13225bc95aa2SDmitry Eremin-Solenikov     },
13235bc95aa2SDmitry Eremin-Solenikov };
13245bc95aa2SDmitry Eremin-Solenikov 
1325999e12bbSAnthony Liguori static Property strongarm_uart_properties[] = {
13265bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_CHR("chardev", StrongARMUARTState, chr),
13275bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_END_OF_LIST(),
1328999e12bbSAnthony Liguori };
1329999e12bbSAnthony Liguori 
1330999e12bbSAnthony Liguori static void strongarm_uart_class_init(ObjectClass *klass, void *data)
1331999e12bbSAnthony Liguori {
133239bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1333999e12bbSAnthony Liguori 
133439bffca2SAnthony Liguori     dc->desc = "StrongARM UART controller";
133539bffca2SAnthony Liguori     dc->reset = strongarm_uart_reset;
133639bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_uart_regs;
13374f67d30bSMarc-André Lureau     device_class_set_props(dc, strongarm_uart_properties);
13388934515aSxiaoqiang zhao     dc->realize = strongarm_uart_realize;
13395bc95aa2SDmitry Eremin-Solenikov }
1340999e12bbSAnthony Liguori 
13418c43a6f0SAndreas Färber static const TypeInfo strongarm_uart_info = {
1342fff3af97SAndreas Färber     .name          = TYPE_STRONGARM_UART,
134339bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
134439bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMUARTState),
13455a67508cSxiaoqiang.zhao     .instance_init = strongarm_uart_init,
1346999e12bbSAnthony Liguori     .class_init    = strongarm_uart_class_init,
13475bc95aa2SDmitry Eremin-Solenikov };
13485bc95aa2SDmitry Eremin-Solenikov 
13495bc95aa2SDmitry Eremin-Solenikov /* Synchronous Serial Ports */
13500ca81872SAndreas Färber 
13510ca81872SAndreas Färber #define TYPE_STRONGARM_SSP "strongarm-ssp"
13520ca81872SAndreas Färber #define STRONGARM_SSP(obj) \
13530ca81872SAndreas Färber     OBJECT_CHECK(StrongARMSSPState, (obj), TYPE_STRONGARM_SSP)
13540ca81872SAndreas Färber 
13550ca81872SAndreas Färber typedef struct StrongARMSSPState {
13560ca81872SAndreas Färber     SysBusDevice parent_obj;
13570ca81872SAndreas Färber 
1358eb2fefbcSAvi Kivity     MemoryRegion iomem;
13595bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
13605bc95aa2SDmitry Eremin-Solenikov     SSIBus *bus;
13615bc95aa2SDmitry Eremin-Solenikov 
13625bc95aa2SDmitry Eremin-Solenikov     uint16_t sscr[2];
13635bc95aa2SDmitry Eremin-Solenikov     uint16_t sssr;
13645bc95aa2SDmitry Eremin-Solenikov 
13655bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[8];
13665bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_level;
13675bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
13685bc95aa2SDmitry Eremin-Solenikov } StrongARMSSPState;
13695bc95aa2SDmitry Eremin-Solenikov 
13705bc95aa2SDmitry Eremin-Solenikov #define SSCR0 0x60 /* SSP Control register 0 */
13715bc95aa2SDmitry Eremin-Solenikov #define SSCR1 0x64 /* SSP Control register 1 */
13725bc95aa2SDmitry Eremin-Solenikov #define SSDR  0x6c /* SSP Data register */
13735bc95aa2SDmitry Eremin-Solenikov #define SSSR  0x74 /* SSP Status register */
13745bc95aa2SDmitry Eremin-Solenikov 
13755bc95aa2SDmitry Eremin-Solenikov /* Bitfields for above registers */
13765bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SPI(x)    (((x) & 0x30) == 0x00)
13775bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSP(x)    (((x) & 0x30) == 0x10)
13785bc95aa2SDmitry Eremin-Solenikov #define SSCR0_UWIRE(x)  (((x) & 0x30) == 0x20)
13795bc95aa2SDmitry Eremin-Solenikov #define SSCR0_PSP(x)    (((x) & 0x30) == 0x30)
13805bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSE       (1 << 7)
13815bc95aa2SDmitry Eremin-Solenikov #define SSCR0_DSS(x)    (((x) & 0xf) + 1)
13825bc95aa2SDmitry Eremin-Solenikov #define SSCR1_RIE       (1 << 0)
13835bc95aa2SDmitry Eremin-Solenikov #define SSCR1_TIE       (1 << 1)
13845bc95aa2SDmitry Eremin-Solenikov #define SSCR1_LBM       (1 << 2)
13855bc95aa2SDmitry Eremin-Solenikov #define SSSR_TNF        (1 << 2)
13865bc95aa2SDmitry Eremin-Solenikov #define SSSR_RNE        (1 << 3)
13875bc95aa2SDmitry Eremin-Solenikov #define SSSR_TFS        (1 << 5)
13885bc95aa2SDmitry Eremin-Solenikov #define SSSR_RFS        (1 << 6)
13895bc95aa2SDmitry Eremin-Solenikov #define SSSR_ROR        (1 << 7)
13905bc95aa2SDmitry Eremin-Solenikov #define SSSR_RW         0x0080
13915bc95aa2SDmitry Eremin-Solenikov 
13925bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_int_update(StrongARMSSPState *s)
13935bc95aa2SDmitry Eremin-Solenikov {
13945bc95aa2SDmitry Eremin-Solenikov     int level = 0;
13955bc95aa2SDmitry Eremin-Solenikov 
13965bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_ROR);
13975bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_RFS)  &&  (s->sscr[1] & SSCR1_RIE);
13985bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_TFS)  &&  (s->sscr[1] & SSCR1_TIE);
13995bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, level);
14005bc95aa2SDmitry Eremin-Solenikov }
14015bc95aa2SDmitry Eremin-Solenikov 
14025bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_fifo_update(StrongARMSSPState *s)
14035bc95aa2SDmitry Eremin-Solenikov {
14045bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TFS;
14055bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TNF;
14065bc95aa2SDmitry Eremin-Solenikov     if (s->sscr[0] & SSCR0_SSE) {
14075bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level >= 4) {
14085bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RFS;
14095bc95aa2SDmitry Eremin-Solenikov         } else {
14105bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RFS;
14115bc95aa2SDmitry Eremin-Solenikov         }
14125bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level) {
14135bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RNE;
14145bc95aa2SDmitry Eremin-Solenikov         } else {
14155bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RNE;
14165bc95aa2SDmitry Eremin-Solenikov         }
14175bc95aa2SDmitry Eremin-Solenikov         /* TX FIFO is never filled, so it is always in underrun
14185bc95aa2SDmitry Eremin-Solenikov            condition if SSP is enabled */
14195bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TFS;
14205bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TNF;
14215bc95aa2SDmitry Eremin-Solenikov     }
14225bc95aa2SDmitry Eremin-Solenikov 
14235bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_int_update(s);
14245bc95aa2SDmitry Eremin-Solenikov }
14255bc95aa2SDmitry Eremin-Solenikov 
1426a8170e5eSAvi Kivity static uint64_t strongarm_ssp_read(void *opaque, hwaddr addr,
1427eb2fefbcSAvi Kivity                                    unsigned size)
14285bc95aa2SDmitry Eremin-Solenikov {
14295bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14305bc95aa2SDmitry Eremin-Solenikov     uint32_t retval;
14315bc95aa2SDmitry Eremin-Solenikov 
14325bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
14335bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
14345bc95aa2SDmitry Eremin-Solenikov         return s->sscr[0];
14355bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
14365bc95aa2SDmitry Eremin-Solenikov         return s->sscr[1];
14375bc95aa2SDmitry Eremin-Solenikov     case SSSR:
14385bc95aa2SDmitry Eremin-Solenikov         return s->sssr;
14395bc95aa2SDmitry Eremin-Solenikov     case SSDR:
14405bc95aa2SDmitry Eremin-Solenikov         if (~s->sscr[0] & SSCR0_SSE) {
14415bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
14425bc95aa2SDmitry Eremin-Solenikov         }
14435bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level < 1) {
14445bc95aa2SDmitry Eremin-Solenikov             printf("%s: SSP Rx Underrun\n", __func__);
14455bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
14465bc95aa2SDmitry Eremin-Solenikov         }
14475bc95aa2SDmitry Eremin-Solenikov         s->rx_level--;
14485bc95aa2SDmitry Eremin-Solenikov         retval = s->rx_fifo[s->rx_start++];
14495bc95aa2SDmitry Eremin-Solenikov         s->rx_start &= 0x7;
14505bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14515bc95aa2SDmitry Eremin-Solenikov         return retval;
14525bc95aa2SDmitry Eremin-Solenikov     default:
14535bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
14545bc95aa2SDmitry Eremin-Solenikov         break;
14555bc95aa2SDmitry Eremin-Solenikov     }
14565bc95aa2SDmitry Eremin-Solenikov     return 0;
14575bc95aa2SDmitry Eremin-Solenikov }
14585bc95aa2SDmitry Eremin-Solenikov 
1459a8170e5eSAvi Kivity static void strongarm_ssp_write(void *opaque, hwaddr addr,
1460eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
14615bc95aa2SDmitry Eremin-Solenikov {
14625bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14635bc95aa2SDmitry Eremin-Solenikov 
14645bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
14655bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
14665bc95aa2SDmitry Eremin-Solenikov         s->sscr[0] = value & 0xffbf;
14675bc95aa2SDmitry Eremin-Solenikov         if ((s->sscr[0] & SSCR0_SSE) && SSCR0_DSS(value) < 4) {
14685bc95aa2SDmitry Eremin-Solenikov             printf("%s: Wrong data size: %i bits\n", __func__,
1469eb2fefbcSAvi Kivity                    (int)SSCR0_DSS(value));
14705bc95aa2SDmitry Eremin-Solenikov         }
14715bc95aa2SDmitry Eremin-Solenikov         if (!(value & SSCR0_SSE)) {
14725bc95aa2SDmitry Eremin-Solenikov             s->sssr = 0;
14735bc95aa2SDmitry Eremin-Solenikov             s->rx_level = 0;
14745bc95aa2SDmitry Eremin-Solenikov         }
14755bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14765bc95aa2SDmitry Eremin-Solenikov         break;
14775bc95aa2SDmitry Eremin-Solenikov 
14785bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
14795bc95aa2SDmitry Eremin-Solenikov         s->sscr[1] = value & 0x2f;
14805bc95aa2SDmitry Eremin-Solenikov         if (value & SSCR1_LBM) {
14815bc95aa2SDmitry Eremin-Solenikov             printf("%s: Attempt to use SSP LBM mode\n", __func__);
14825bc95aa2SDmitry Eremin-Solenikov         }
14835bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14845bc95aa2SDmitry Eremin-Solenikov         break;
14855bc95aa2SDmitry Eremin-Solenikov 
14865bc95aa2SDmitry Eremin-Solenikov     case SSSR:
14875bc95aa2SDmitry Eremin-Solenikov         s->sssr &= ~(value & SSSR_RW);
14885bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_int_update(s);
14895bc95aa2SDmitry Eremin-Solenikov         break;
14905bc95aa2SDmitry Eremin-Solenikov 
14915bc95aa2SDmitry Eremin-Solenikov     case SSDR:
14925bc95aa2SDmitry Eremin-Solenikov         if (SSCR0_UWIRE(s->sscr[0])) {
14935bc95aa2SDmitry Eremin-Solenikov             value &= 0xff;
14945bc95aa2SDmitry Eremin-Solenikov         } else
14955bc95aa2SDmitry Eremin-Solenikov             /* Note how 32bits overflow does no harm here */
14965bc95aa2SDmitry Eremin-Solenikov             value &= (1 << SSCR0_DSS(s->sscr[0])) - 1;
14975bc95aa2SDmitry Eremin-Solenikov 
14985bc95aa2SDmitry Eremin-Solenikov         /* Data goes from here to the Tx FIFO and is shifted out from
14995bc95aa2SDmitry Eremin-Solenikov          * there directly to the slave, no need to buffer it.
15005bc95aa2SDmitry Eremin-Solenikov          */
15015bc95aa2SDmitry Eremin-Solenikov         if (s->sscr[0] & SSCR0_SSE) {
15025bc95aa2SDmitry Eremin-Solenikov             uint32_t readval;
15035bc95aa2SDmitry Eremin-Solenikov             if (s->sscr[1] & SSCR1_LBM) {
15045bc95aa2SDmitry Eremin-Solenikov                 readval = value;
15055bc95aa2SDmitry Eremin-Solenikov             } else {
15065bc95aa2SDmitry Eremin-Solenikov                 readval = ssi_transfer(s->bus, value);
15075bc95aa2SDmitry Eremin-Solenikov             }
15085bc95aa2SDmitry Eremin-Solenikov 
15095bc95aa2SDmitry Eremin-Solenikov             if (s->rx_level < 0x08) {
15105bc95aa2SDmitry Eremin-Solenikov                 s->rx_fifo[(s->rx_start + s->rx_level++) & 0x7] = readval;
15115bc95aa2SDmitry Eremin-Solenikov             } else {
15125bc95aa2SDmitry Eremin-Solenikov                 s->sssr |= SSSR_ROR;
15135bc95aa2SDmitry Eremin-Solenikov             }
15145bc95aa2SDmitry Eremin-Solenikov         }
15155bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
15165bc95aa2SDmitry Eremin-Solenikov         break;
15175bc95aa2SDmitry Eremin-Solenikov 
15185bc95aa2SDmitry Eremin-Solenikov     default:
15195bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
15205bc95aa2SDmitry Eremin-Solenikov         break;
15215bc95aa2SDmitry Eremin-Solenikov     }
15225bc95aa2SDmitry Eremin-Solenikov }
15235bc95aa2SDmitry Eremin-Solenikov 
1524eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ssp_ops = {
1525eb2fefbcSAvi Kivity     .read = strongarm_ssp_read,
1526eb2fefbcSAvi Kivity     .write = strongarm_ssp_write,
1527eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
15285bc95aa2SDmitry Eremin-Solenikov };
15295bc95aa2SDmitry Eremin-Solenikov 
15305bc95aa2SDmitry Eremin-Solenikov static int strongarm_ssp_post_load(void *opaque, int version_id)
15315bc95aa2SDmitry Eremin-Solenikov {
15325bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
15335bc95aa2SDmitry Eremin-Solenikov 
15345bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_fifo_update(s);
15355bc95aa2SDmitry Eremin-Solenikov 
15365bc95aa2SDmitry Eremin-Solenikov     return 0;
15375bc95aa2SDmitry Eremin-Solenikov }
15385bc95aa2SDmitry Eremin-Solenikov 
15398934515aSxiaoqiang zhao static void strongarm_ssp_init(Object *obj)
15405bc95aa2SDmitry Eremin-Solenikov {
15418934515aSxiaoqiang zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
15420ca81872SAndreas Färber     DeviceState *dev = DEVICE(sbd);
15430ca81872SAndreas Färber     StrongARMSSPState *s = STRONGARM_SSP(dev);
15445bc95aa2SDmitry Eremin-Solenikov 
15450ca81872SAndreas Färber     sysbus_init_irq(sbd, &s->irq);
15465bc95aa2SDmitry Eremin-Solenikov 
15478934515aSxiaoqiang zhao     memory_region_init_io(&s->iomem, obj, &strongarm_ssp_ops, s,
154864bde0f3SPaolo Bonzini                           "ssp", 0x1000);
15490ca81872SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
15505bc95aa2SDmitry Eremin-Solenikov 
15510ca81872SAndreas Färber     s->bus = ssi_create_bus(dev, "ssi");
15525bc95aa2SDmitry Eremin-Solenikov }
15535bc95aa2SDmitry Eremin-Solenikov 
15545bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_reset(DeviceState *dev)
15555bc95aa2SDmitry Eremin-Solenikov {
15560ca81872SAndreas Färber     StrongARMSSPState *s = STRONGARM_SSP(dev);
15570ca81872SAndreas Färber 
15585bc95aa2SDmitry Eremin-Solenikov     s->sssr = 0x03; /* 3 bit data, SPI, disabled */
15595bc95aa2SDmitry Eremin-Solenikov     s->rx_start = 0;
15605bc95aa2SDmitry Eremin-Solenikov     s->rx_level = 0;
15615bc95aa2SDmitry Eremin-Solenikov }
15625bc95aa2SDmitry Eremin-Solenikov 
15635bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ssp_regs = {
15645bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ssp",
15655bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
15665bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
15675bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_ssp_post_load,
15685bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
15695bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(sscr, StrongARMSSPState, 2),
15705bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(sssr, StrongARMSSPState),
15715bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMSSPState, 8),
15725bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMSSPState),
15735bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_level, StrongARMSSPState),
15745bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
15755bc95aa2SDmitry Eremin-Solenikov     },
15765bc95aa2SDmitry Eremin-Solenikov };
15775bc95aa2SDmitry Eremin-Solenikov 
1578999e12bbSAnthony Liguori static void strongarm_ssp_class_init(ObjectClass *klass, void *data)
1579999e12bbSAnthony Liguori {
158039bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1581999e12bbSAnthony Liguori 
158239bffca2SAnthony Liguori     dc->desc = "StrongARM SSP controller";
158339bffca2SAnthony Liguori     dc->reset = strongarm_ssp_reset;
158439bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_ssp_regs;
1585999e12bbSAnthony Liguori }
1586999e12bbSAnthony Liguori 
15878c43a6f0SAndreas Färber static const TypeInfo strongarm_ssp_info = {
15880ca81872SAndreas Färber     .name          = TYPE_STRONGARM_SSP,
158939bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
159039bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMSSPState),
15918934515aSxiaoqiang zhao     .instance_init = strongarm_ssp_init,
1592999e12bbSAnthony Liguori     .class_init    = strongarm_ssp_class_init,
15935bc95aa2SDmitry Eremin-Solenikov };
15945bc95aa2SDmitry Eremin-Solenikov 
15955bc95aa2SDmitry Eremin-Solenikov /* Main CPU functions */
15963cd892daSPhilippe Mathieu-Daudé StrongARMState *sa1110_init(const char *cpu_type)
15975bc95aa2SDmitry Eremin-Solenikov {
15985bc95aa2SDmitry Eremin-Solenikov     StrongARMState *s;
15995bc95aa2SDmitry Eremin-Solenikov     int i;
16005bc95aa2SDmitry Eremin-Solenikov 
1601b45c03f5SMarkus Armbruster     s = g_new0(StrongARMState, 1);
16025bc95aa2SDmitry Eremin-Solenikov 
1603ba1ba5ccSIgor Mammedov     if (strncmp(cpu_type, "sa1110", 6)) {
16046daf194dSMarkus Armbruster         error_report("Machine requires a SA1110 processor.");
16055bc95aa2SDmitry Eremin-Solenikov         exit(1);
16065bc95aa2SDmitry Eremin-Solenikov     }
16075bc95aa2SDmitry Eremin-Solenikov 
1608ba1ba5ccSIgor Mammedov     s->cpu = ARM_CPU(cpu_create(cpu_type));
16095bc95aa2SDmitry Eremin-Solenikov 
16105bc95aa2SDmitry Eremin-Solenikov     s->pic = sysbus_create_varargs("strongarm_pic", 0x90050000,
16114f071cf9SPeter Maydell                     qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ),
16124f071cf9SPeter Maydell                     qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_FIQ),
16134f071cf9SPeter Maydell                     NULL);
16145bc95aa2SDmitry Eremin-Solenikov 
16155bc95aa2SDmitry Eremin-Solenikov     sysbus_create_varargs("pxa25x-timer", 0x90000000,
16165bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC0),
16175bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC1),
16185bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC2),
16195bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC3),
16205bc95aa2SDmitry Eremin-Solenikov                     NULL);
16215bc95aa2SDmitry Eremin-Solenikov 
16224e002105SAndreas Färber     sysbus_create_simple(TYPE_STRONGARM_RTC, 0x90010000,
16235bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_RTC_ALARM));
16245bc95aa2SDmitry Eremin-Solenikov 
16255bc95aa2SDmitry Eremin-Solenikov     s->gpio = strongarm_gpio_init(0x90040000, s->pic);
16265bc95aa2SDmitry Eremin-Solenikov 
1627c71e6732SAndreas Färber     s->ppc = sysbus_create_varargs(TYPE_STRONGARM_PPC, 0x90060000, NULL);
16285bc95aa2SDmitry Eremin-Solenikov 
16295bc95aa2SDmitry Eremin-Solenikov     for (i = 0; sa_serial[i].io_base; i++) {
1630*3e80f690SMarkus Armbruster         DeviceState *dev = qdev_new(TYPE_STRONGARM_UART);
16319bca0edbSPeter Maydell         qdev_prop_set_chr(dev, "chardev", serial_hd(i));
1632*3e80f690SMarkus Armbruster         qdev_realize_and_unref(dev, NULL, &error_fatal);
16331356b98dSAndreas Färber         sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0,
16345bc95aa2SDmitry Eremin-Solenikov                 sa_serial[i].io_base);
16351356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0,
16365bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, sa_serial[i].irq));
16375bc95aa2SDmitry Eremin-Solenikov     }
16385bc95aa2SDmitry Eremin-Solenikov 
16390ca81872SAndreas Färber     s->ssp = sysbus_create_varargs(TYPE_STRONGARM_SSP, 0x80070000,
16405bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, SA_PIC_SSP), NULL);
16415bc95aa2SDmitry Eremin-Solenikov     s->ssp_bus = (SSIBus *)qdev_get_child_bus(s->ssp, "ssi");
16425bc95aa2SDmitry Eremin-Solenikov 
16435bc95aa2SDmitry Eremin-Solenikov     return s;
16445bc95aa2SDmitry Eremin-Solenikov }
16455bc95aa2SDmitry Eremin-Solenikov 
164683f7d43aSAndreas Färber static void strongarm_register_types(void)
16475bc95aa2SDmitry Eremin-Solenikov {
164839bffca2SAnthony Liguori     type_register_static(&strongarm_pic_info);
164939bffca2SAnthony Liguori     type_register_static(&strongarm_rtc_sysbus_info);
165039bffca2SAnthony Liguori     type_register_static(&strongarm_gpio_info);
165139bffca2SAnthony Liguori     type_register_static(&strongarm_ppc_info);
165239bffca2SAnthony Liguori     type_register_static(&strongarm_uart_info);
165339bffca2SAnthony Liguori     type_register_static(&strongarm_ssp_info);
16545bc95aa2SDmitry Eremin-Solenikov }
165583f7d43aSAndreas Färber 
165683f7d43aSAndreas Färber type_init(strongarm_register_types)
1657