xref: /qemu/hw/arm/strongarm.c (revision a8d2532645cf5ce4f75981f81dfe363efc35d05c)
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"
31*a8d25326SMarkus Armbruster #include "qemu-common.h"
324771d756SPaolo Bonzini #include "cpu.h"
33c8623c02SDirk Müller #include "hw/boards.h"
3483c9f4caSPaolo Bonzini #include "hw/sysbus.h"
3547b43a1fSPaolo Bonzini #include "strongarm.h"
361de7afc9SPaolo Bonzini #include "qemu/error-report.h"
3712ec8bd5SPeter Maydell #include "hw/arm/boot.h"
384d43a603SMarc-André Lureau #include "chardev/char-fe.h"
397566c6efSMarc-André Lureau #include "chardev/char-serial.h"
409c17d615SPaolo Bonzini #include "sysemu/sysemu.h"
418fd06719SAlistair Francis #include "hw/ssi/ssi.h"
42f348b6d1SVeronia Bahaa #include "qemu/cutils.h"
4303dd024fSPaolo Bonzini #include "qemu/log.h"
445bc95aa2SDmitry Eremin-Solenikov 
455bc95aa2SDmitry Eremin-Solenikov //#define DEBUG
465bc95aa2SDmitry Eremin-Solenikov 
475bc95aa2SDmitry Eremin-Solenikov /*
485bc95aa2SDmitry Eremin-Solenikov  TODO
495bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c14 ?
505bc95aa2SDmitry Eremin-Solenikov  - Implement cp15, c15 !!! (idle used in L)
515bc95aa2SDmitry Eremin-Solenikov  - Implement idle mode handling/DIM
525bc95aa2SDmitry Eremin-Solenikov  - Implement sleep mode/Wake sources
535bc95aa2SDmitry Eremin-Solenikov  - Implement reset control
545bc95aa2SDmitry Eremin-Solenikov  - Implement memory control regs
555bc95aa2SDmitry Eremin-Solenikov  - PCMCIA handling
565bc95aa2SDmitry Eremin-Solenikov  - Maybe support MBGNT/MBREQ
575bc95aa2SDmitry Eremin-Solenikov  - DMA channels
585bc95aa2SDmitry Eremin-Solenikov  - GPCLK
595bc95aa2SDmitry Eremin-Solenikov  - IrDA
605bc95aa2SDmitry Eremin-Solenikov  - MCP
615bc95aa2SDmitry Eremin-Solenikov  - Enhance UART with modem signals
625bc95aa2SDmitry Eremin-Solenikov  */
635bc95aa2SDmitry Eremin-Solenikov 
645bc95aa2SDmitry Eremin-Solenikov #ifdef DEBUG
655bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) printf(format , ## __VA_ARGS__)
665bc95aa2SDmitry Eremin-Solenikov #else
675bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) do { } while (0)
685bc95aa2SDmitry Eremin-Solenikov #endif
695bc95aa2SDmitry Eremin-Solenikov 
705bc95aa2SDmitry Eremin-Solenikov static struct {
71a8170e5eSAvi Kivity     hwaddr io_base;
725bc95aa2SDmitry Eremin-Solenikov     int irq;
735bc95aa2SDmitry Eremin-Solenikov } sa_serial[] = {
745bc95aa2SDmitry Eremin-Solenikov     { 0x80010000, SA_PIC_UART1 },
755bc95aa2SDmitry Eremin-Solenikov     { 0x80030000, SA_PIC_UART2 },
765bc95aa2SDmitry Eremin-Solenikov     { 0x80050000, SA_PIC_UART3 },
775bc95aa2SDmitry Eremin-Solenikov     { 0, 0 }
785bc95aa2SDmitry Eremin-Solenikov };
795bc95aa2SDmitry Eremin-Solenikov 
805bc95aa2SDmitry Eremin-Solenikov /* Interrupt Controller */
8174e075f6SAndreas Färber 
8274e075f6SAndreas Färber #define TYPE_STRONGARM_PIC "strongarm_pic"
8374e075f6SAndreas Färber #define STRONGARM_PIC(obj) \
8474e075f6SAndreas Färber     OBJECT_CHECK(StrongARMPICState, (obj), TYPE_STRONGARM_PIC)
8574e075f6SAndreas Färber 
8674e075f6SAndreas Färber typedef struct StrongARMPICState {
8774e075f6SAndreas Färber     SysBusDevice parent_obj;
8874e075f6SAndreas Färber 
89eb2fefbcSAvi Kivity     MemoryRegion iomem;
905bc95aa2SDmitry Eremin-Solenikov     qemu_irq    irq;
915bc95aa2SDmitry Eremin-Solenikov     qemu_irq    fiq;
925bc95aa2SDmitry Eremin-Solenikov 
935bc95aa2SDmitry Eremin-Solenikov     uint32_t pending;
945bc95aa2SDmitry Eremin-Solenikov     uint32_t enabled;
955bc95aa2SDmitry Eremin-Solenikov     uint32_t is_fiq;
965bc95aa2SDmitry Eremin-Solenikov     uint32_t int_idle;
975bc95aa2SDmitry Eremin-Solenikov } StrongARMPICState;
985bc95aa2SDmitry Eremin-Solenikov 
995bc95aa2SDmitry Eremin-Solenikov #define ICIP    0x00
1005bc95aa2SDmitry Eremin-Solenikov #define ICMR    0x04
1015bc95aa2SDmitry Eremin-Solenikov #define ICLR    0x08
1025bc95aa2SDmitry Eremin-Solenikov #define ICFP    0x10
1035bc95aa2SDmitry Eremin-Solenikov #define ICPR    0x20
1045bc95aa2SDmitry Eremin-Solenikov #define ICCR    0x0c
1055bc95aa2SDmitry Eremin-Solenikov 
1065bc95aa2SDmitry Eremin-Solenikov #define SA_PIC_SRCS     32
1075bc95aa2SDmitry Eremin-Solenikov 
1085bc95aa2SDmitry Eremin-Solenikov 
1095bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_update(void *opaque)
1105bc95aa2SDmitry Eremin-Solenikov {
1115bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1125bc95aa2SDmitry Eremin-Solenikov 
1135bc95aa2SDmitry Eremin-Solenikov     /* FIXME: reflect DIM */
1145bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->fiq, s->pending & s->enabled &  s->is_fiq);
1155bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, s->pending & s->enabled & ~s->is_fiq);
1165bc95aa2SDmitry Eremin-Solenikov }
1175bc95aa2SDmitry Eremin-Solenikov 
1185bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_set_irq(void *opaque, int irq, int level)
1195bc95aa2SDmitry Eremin-Solenikov {
1205bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1215bc95aa2SDmitry Eremin-Solenikov 
1225bc95aa2SDmitry Eremin-Solenikov     if (level) {
1235bc95aa2SDmitry Eremin-Solenikov         s->pending |= 1 << irq;
1245bc95aa2SDmitry Eremin-Solenikov     } else {
1255bc95aa2SDmitry Eremin-Solenikov         s->pending &= ~(1 << irq);
1265bc95aa2SDmitry Eremin-Solenikov     }
1275bc95aa2SDmitry Eremin-Solenikov 
1285bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1295bc95aa2SDmitry Eremin-Solenikov }
1305bc95aa2SDmitry Eremin-Solenikov 
131a8170e5eSAvi Kivity static uint64_t strongarm_pic_mem_read(void *opaque, hwaddr offset,
132eb2fefbcSAvi Kivity                                        unsigned size)
1335bc95aa2SDmitry Eremin-Solenikov {
1345bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1355bc95aa2SDmitry Eremin-Solenikov 
1365bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1375bc95aa2SDmitry Eremin-Solenikov     case ICIP:
1385bc95aa2SDmitry Eremin-Solenikov         return s->pending & ~s->is_fiq & s->enabled;
1395bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1405bc95aa2SDmitry Eremin-Solenikov         return s->enabled;
1415bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1425bc95aa2SDmitry Eremin-Solenikov         return s->is_fiq;
1435bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1445bc95aa2SDmitry Eremin-Solenikov         return s->int_idle == 0;
1455bc95aa2SDmitry Eremin-Solenikov     case ICFP:
1465bc95aa2SDmitry Eremin-Solenikov         return s->pending & s->is_fiq & s->enabled;
1475bc95aa2SDmitry Eremin-Solenikov     case ICPR:
1485bc95aa2SDmitry Eremin-Solenikov         return s->pending;
1495bc95aa2SDmitry Eremin-Solenikov     default:
1505bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1515bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1525bc95aa2SDmitry Eremin-Solenikov         return 0;
1535bc95aa2SDmitry Eremin-Solenikov     }
1545bc95aa2SDmitry Eremin-Solenikov }
1555bc95aa2SDmitry Eremin-Solenikov 
156a8170e5eSAvi Kivity static void strongarm_pic_mem_write(void *opaque, hwaddr offset,
157eb2fefbcSAvi Kivity                                     uint64_t value, unsigned size)
1585bc95aa2SDmitry Eremin-Solenikov {
1595bc95aa2SDmitry Eremin-Solenikov     StrongARMPICState *s = opaque;
1605bc95aa2SDmitry Eremin-Solenikov 
1615bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
1625bc95aa2SDmitry Eremin-Solenikov     case ICMR:
1635bc95aa2SDmitry Eremin-Solenikov         s->enabled = value;
1645bc95aa2SDmitry Eremin-Solenikov         break;
1655bc95aa2SDmitry Eremin-Solenikov     case ICLR:
1665bc95aa2SDmitry Eremin-Solenikov         s->is_fiq = value;
1675bc95aa2SDmitry Eremin-Solenikov         break;
1685bc95aa2SDmitry Eremin-Solenikov     case ICCR:
1695bc95aa2SDmitry Eremin-Solenikov         s->int_idle = (value & 1) ? 0 : ~0;
1705bc95aa2SDmitry Eremin-Solenikov         break;
1715bc95aa2SDmitry Eremin-Solenikov     default:
1725bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
1735bc95aa2SDmitry Eremin-Solenikov                         __func__, offset);
1745bc95aa2SDmitry Eremin-Solenikov         break;
1755bc95aa2SDmitry Eremin-Solenikov     }
1765bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(s);
1775bc95aa2SDmitry Eremin-Solenikov }
1785bc95aa2SDmitry Eremin-Solenikov 
179eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_pic_ops = {
180eb2fefbcSAvi Kivity     .read = strongarm_pic_mem_read,
181eb2fefbcSAvi Kivity     .write = strongarm_pic_mem_write,
182eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
1835bc95aa2SDmitry Eremin-Solenikov };
1845bc95aa2SDmitry Eremin-Solenikov 
1855a67508cSxiaoqiang.zhao static void strongarm_pic_initfn(Object *obj)
1865bc95aa2SDmitry Eremin-Solenikov {
1875a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
1885a67508cSxiaoqiang.zhao     StrongARMPICState *s = STRONGARM_PIC(obj);
1895a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
1905bc95aa2SDmitry Eremin-Solenikov 
19174e075f6SAndreas Färber     qdev_init_gpio_in(dev, strongarm_pic_set_irq, SA_PIC_SRCS);
1925a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_pic_ops, s,
19364bde0f3SPaolo Bonzini                           "pic", 0x1000);
19474e075f6SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
19574e075f6SAndreas Färber     sysbus_init_irq(sbd, &s->irq);
19674e075f6SAndreas Färber     sysbus_init_irq(sbd, &s->fiq);
1975bc95aa2SDmitry Eremin-Solenikov }
1985bc95aa2SDmitry Eremin-Solenikov 
1995bc95aa2SDmitry Eremin-Solenikov static int strongarm_pic_post_load(void *opaque, int version_id)
2005bc95aa2SDmitry Eremin-Solenikov {
2015bc95aa2SDmitry Eremin-Solenikov     strongarm_pic_update(opaque);
2025bc95aa2SDmitry Eremin-Solenikov     return 0;
2035bc95aa2SDmitry Eremin-Solenikov }
2045bc95aa2SDmitry Eremin-Solenikov 
2055bc95aa2SDmitry Eremin-Solenikov static VMStateDescription vmstate_strongarm_pic_regs = {
2065bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm_pic",
2075bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
2085bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
2095bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_pic_post_load,
2105bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
2115bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(pending, StrongARMPICState),
2125bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(enabled, StrongARMPICState),
2135bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(is_fiq, StrongARMPICState),
2145bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(int_idle, StrongARMPICState),
2155bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
2165bc95aa2SDmitry Eremin-Solenikov     },
2175bc95aa2SDmitry Eremin-Solenikov };
2185bc95aa2SDmitry Eremin-Solenikov 
219999e12bbSAnthony Liguori static void strongarm_pic_class_init(ObjectClass *klass, void *data)
220999e12bbSAnthony Liguori {
22139bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
222999e12bbSAnthony Liguori 
22339bffca2SAnthony Liguori     dc->desc = "StrongARM PIC";
22439bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_pic_regs;
225999e12bbSAnthony Liguori }
226999e12bbSAnthony Liguori 
2278c43a6f0SAndreas Färber static const TypeInfo strongarm_pic_info = {
22874e075f6SAndreas Färber     .name          = TYPE_STRONGARM_PIC,
22939bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
23039bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPICState),
2315a67508cSxiaoqiang.zhao     .instance_init = strongarm_pic_initfn,
232999e12bbSAnthony Liguori     .class_init    = strongarm_pic_class_init,
2335bc95aa2SDmitry Eremin-Solenikov };
2345bc95aa2SDmitry Eremin-Solenikov 
2355bc95aa2SDmitry Eremin-Solenikov /* Real-Time Clock */
2365bc95aa2SDmitry Eremin-Solenikov #define RTAR 0x00 /* RTC Alarm register */
2375bc95aa2SDmitry Eremin-Solenikov #define RCNR 0x04 /* RTC Counter register */
2385bc95aa2SDmitry Eremin-Solenikov #define RTTR 0x08 /* RTC Timer Trim register */
2395bc95aa2SDmitry Eremin-Solenikov #define RTSR 0x10 /* RTC Status register */
2405bc95aa2SDmitry Eremin-Solenikov 
2415bc95aa2SDmitry Eremin-Solenikov #define RTSR_AL (1 << 0) /* RTC Alarm detected */
2425bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZ (1 << 1) /* RTC 1Hz detected */
2435bc95aa2SDmitry Eremin-Solenikov #define RTSR_ALE (1 << 2) /* RTC Alarm enable */
2445bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZE (1 << 3) /* RTC 1Hz enable */
2455bc95aa2SDmitry Eremin-Solenikov 
2465bc95aa2SDmitry Eremin-Solenikov /* 16 LSB of RTTR are clockdiv for internal trim logic,
2475bc95aa2SDmitry Eremin-Solenikov  * trim delete isn't emulated, so
2485bc95aa2SDmitry Eremin-Solenikov  * f = 32 768 / (RTTR_trim + 1) */
2495bc95aa2SDmitry Eremin-Solenikov 
2504e002105SAndreas Färber #define TYPE_STRONGARM_RTC "strongarm-rtc"
2514e002105SAndreas Färber #define STRONGARM_RTC(obj) \
2524e002105SAndreas Färber     OBJECT_CHECK(StrongARMRTCState, (obj), TYPE_STRONGARM_RTC)
2534e002105SAndreas Färber 
2544e002105SAndreas Färber typedef struct StrongARMRTCState {
2554e002105SAndreas Färber     SysBusDevice parent_obj;
2564e002105SAndreas Färber 
257eb2fefbcSAvi Kivity     MemoryRegion iomem;
2585bc95aa2SDmitry Eremin-Solenikov     uint32_t rttr;
2595bc95aa2SDmitry Eremin-Solenikov     uint32_t rtsr;
2605bc95aa2SDmitry Eremin-Solenikov     uint32_t rtar;
2615bc95aa2SDmitry Eremin-Solenikov     uint32_t last_rcnr;
2625bc95aa2SDmitry Eremin-Solenikov     int64_t last_hz;
2635bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_alarm;
2645bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rtc_hz;
2655bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_irq;
2665bc95aa2SDmitry Eremin-Solenikov     qemu_irq rtc_hz_irq;
2675bc95aa2SDmitry Eremin-Solenikov } StrongARMRTCState;
2685bc95aa2SDmitry Eremin-Solenikov 
2695bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_int_update(StrongARMRTCState *s)
2705bc95aa2SDmitry Eremin-Solenikov {
2715bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_irq, s->rtsr & RTSR_AL);
2725bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->rtc_hz_irq, s->rtsr & RTSR_HZ);
2735bc95aa2SDmitry Eremin-Solenikov }
2745bc95aa2SDmitry Eremin-Solenikov 
2755bc95aa2SDmitry Eremin-Solenikov static void strongarm_rtc_hzupdate(StrongARMRTCState *s)
2765bc95aa2SDmitry Eremin-Solenikov {
277884f17c2SAlex Bligh     int64_t rt = qemu_clock_get_ms(rtc_clock);
2785bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr += ((rt - s->last_hz) << 15) /
2795bc95aa2SDmitry Eremin-Solenikov             (1000 * ((s->rttr & 0xffff) + 1));
2805bc95aa2SDmitry Eremin-Solenikov     s->last_hz = rt;
2815bc95aa2SDmitry Eremin-Solenikov }
2825bc95aa2SDmitry Eremin-Solenikov 
2835bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_timer_update(StrongARMRTCState *s)
2845bc95aa2SDmitry Eremin-Solenikov {
2855bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_HZE) && !(s->rtsr & RTSR_HZ)) {
286bc72ad67SAlex Bligh         timer_mod(s->rtc_hz, s->last_hz + 1000);
2875bc95aa2SDmitry Eremin-Solenikov     } else {
288bc72ad67SAlex Bligh         timer_del(s->rtc_hz);
2895bc95aa2SDmitry Eremin-Solenikov     }
2905bc95aa2SDmitry Eremin-Solenikov 
2915bc95aa2SDmitry Eremin-Solenikov     if ((s->rtsr & RTSR_ALE) && !(s->rtsr & RTSR_AL)) {
292bc72ad67SAlex Bligh         timer_mod(s->rtc_alarm, s->last_hz +
2935bc95aa2SDmitry Eremin-Solenikov                 (((s->rtar - s->last_rcnr) * 1000 *
2945bc95aa2SDmitry Eremin-Solenikov                   ((s->rttr & 0xffff) + 1)) >> 15));
2955bc95aa2SDmitry Eremin-Solenikov     } else {
296bc72ad67SAlex Bligh         timer_del(s->rtc_alarm);
2975bc95aa2SDmitry Eremin-Solenikov     }
2985bc95aa2SDmitry Eremin-Solenikov }
2995bc95aa2SDmitry Eremin-Solenikov 
3005bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_alarm_tick(void *opaque)
3015bc95aa2SDmitry Eremin-Solenikov {
3025bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3035bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_AL;
3045bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
3055bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
3065bc95aa2SDmitry Eremin-Solenikov }
3075bc95aa2SDmitry Eremin-Solenikov 
3085bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_hz_tick(void *opaque)
3095bc95aa2SDmitry Eremin-Solenikov {
3105bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3115bc95aa2SDmitry Eremin-Solenikov     s->rtsr |= RTSR_HZ;
3125bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
3135bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
3145bc95aa2SDmitry Eremin-Solenikov }
3155bc95aa2SDmitry Eremin-Solenikov 
316a8170e5eSAvi Kivity static uint64_t strongarm_rtc_read(void *opaque, hwaddr addr,
317eb2fefbcSAvi Kivity                                    unsigned size)
3185bc95aa2SDmitry Eremin-Solenikov {
3195bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3205bc95aa2SDmitry Eremin-Solenikov 
3215bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3225bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3235bc95aa2SDmitry Eremin-Solenikov         return s->rttr;
3245bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3255bc95aa2SDmitry Eremin-Solenikov         return s->rtsr;
3265bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3275bc95aa2SDmitry Eremin-Solenikov         return s->rtar;
3285bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3295bc95aa2SDmitry Eremin-Solenikov         return s->last_rcnr +
330884f17c2SAlex Bligh                 ((qemu_clock_get_ms(rtc_clock) - s->last_hz) << 15) /
3315bc95aa2SDmitry Eremin-Solenikov                 (1000 * ((s->rttr & 0xffff) + 1));
3325bc95aa2SDmitry Eremin-Solenikov     default:
3335bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3345bc95aa2SDmitry Eremin-Solenikov         return 0;
3355bc95aa2SDmitry Eremin-Solenikov     }
3365bc95aa2SDmitry Eremin-Solenikov }
3375bc95aa2SDmitry Eremin-Solenikov 
338a8170e5eSAvi Kivity static void strongarm_rtc_write(void *opaque, hwaddr addr,
339eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
3405bc95aa2SDmitry Eremin-Solenikov {
3415bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
3425bc95aa2SDmitry Eremin-Solenikov     uint32_t old_rtsr;
3435bc95aa2SDmitry Eremin-Solenikov 
3445bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
3455bc95aa2SDmitry Eremin-Solenikov     case RTTR:
3465bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3475bc95aa2SDmitry Eremin-Solenikov         s->rttr = value;
3485bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3495bc95aa2SDmitry Eremin-Solenikov         break;
3505bc95aa2SDmitry Eremin-Solenikov 
3515bc95aa2SDmitry Eremin-Solenikov     case RTSR:
3525bc95aa2SDmitry Eremin-Solenikov         old_rtsr = s->rtsr;
3535bc95aa2SDmitry Eremin-Solenikov         s->rtsr = (value & (RTSR_ALE | RTSR_HZE)) |
3545bc95aa2SDmitry Eremin-Solenikov                   (s->rtsr & ~(value & (RTSR_AL | RTSR_HZ)));
3555bc95aa2SDmitry Eremin-Solenikov 
3565bc95aa2SDmitry Eremin-Solenikov         if (s->rtsr != old_rtsr) {
3575bc95aa2SDmitry Eremin-Solenikov             strongarm_rtc_timer_update(s);
3585bc95aa2SDmitry Eremin-Solenikov         }
3595bc95aa2SDmitry Eremin-Solenikov 
3605bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_int_update(s);
3615bc95aa2SDmitry Eremin-Solenikov         break;
3625bc95aa2SDmitry Eremin-Solenikov 
3635bc95aa2SDmitry Eremin-Solenikov     case RTAR:
3645bc95aa2SDmitry Eremin-Solenikov         s->rtar = value;
3655bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3665bc95aa2SDmitry Eremin-Solenikov         break;
3675bc95aa2SDmitry Eremin-Solenikov 
3685bc95aa2SDmitry Eremin-Solenikov     case RCNR:
3695bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_hzupdate(s);
3705bc95aa2SDmitry Eremin-Solenikov         s->last_rcnr = value;
3715bc95aa2SDmitry Eremin-Solenikov         strongarm_rtc_timer_update(s);
3725bc95aa2SDmitry Eremin-Solenikov         break;
3735bc95aa2SDmitry Eremin-Solenikov 
3745bc95aa2SDmitry Eremin-Solenikov     default:
3755bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
3765bc95aa2SDmitry Eremin-Solenikov     }
3775bc95aa2SDmitry Eremin-Solenikov }
3785bc95aa2SDmitry Eremin-Solenikov 
379eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_rtc_ops = {
380eb2fefbcSAvi Kivity     .read = strongarm_rtc_read,
381eb2fefbcSAvi Kivity     .write = strongarm_rtc_write,
382eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
3835bc95aa2SDmitry Eremin-Solenikov };
3845bc95aa2SDmitry Eremin-Solenikov 
3855a67508cSxiaoqiang.zhao static void strongarm_rtc_init(Object *obj)
3865bc95aa2SDmitry Eremin-Solenikov {
3875a67508cSxiaoqiang.zhao     StrongARMRTCState *s = STRONGARM_RTC(obj);
3885a67508cSxiaoqiang.zhao     SysBusDevice *dev = SYS_BUS_DEVICE(obj);
3895bc95aa2SDmitry Eremin-Solenikov     struct tm tm;
3905bc95aa2SDmitry Eremin-Solenikov 
3915bc95aa2SDmitry Eremin-Solenikov     s->rttr = 0x0;
3925bc95aa2SDmitry Eremin-Solenikov     s->rtsr = 0;
3935bc95aa2SDmitry Eremin-Solenikov 
3945bc95aa2SDmitry Eremin-Solenikov     qemu_get_timedate(&tm, 0);
3955bc95aa2SDmitry Eremin-Solenikov 
3965bc95aa2SDmitry Eremin-Solenikov     s->last_rcnr = (uint32_t) mktimegm(&tm);
397884f17c2SAlex Bligh     s->last_hz = qemu_clock_get_ms(rtc_clock);
3985bc95aa2SDmitry Eremin-Solenikov 
399884f17c2SAlex Bligh     s->rtc_alarm = timer_new_ms(rtc_clock, strongarm_rtc_alarm_tick, s);
400884f17c2SAlex Bligh     s->rtc_hz = timer_new_ms(rtc_clock, strongarm_rtc_hz_tick, s);
4015bc95aa2SDmitry Eremin-Solenikov 
4025bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_irq);
4035bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->rtc_hz_irq);
4045bc95aa2SDmitry Eremin-Solenikov 
4055a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_rtc_ops, s,
40664bde0f3SPaolo Bonzini                           "rtc", 0x10000);
407750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
4085bc95aa2SDmitry Eremin-Solenikov }
4095bc95aa2SDmitry Eremin-Solenikov 
41044b1ff31SDr. David Alan Gilbert static int strongarm_rtc_pre_save(void *opaque)
4115bc95aa2SDmitry Eremin-Solenikov {
4125bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
4135bc95aa2SDmitry Eremin-Solenikov 
4145bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_hzupdate(s);
41544b1ff31SDr. David Alan Gilbert 
41644b1ff31SDr. David Alan Gilbert     return 0;
4175bc95aa2SDmitry Eremin-Solenikov }
4185bc95aa2SDmitry Eremin-Solenikov 
4195bc95aa2SDmitry Eremin-Solenikov static int strongarm_rtc_post_load(void *opaque, int version_id)
4205bc95aa2SDmitry Eremin-Solenikov {
4215bc95aa2SDmitry Eremin-Solenikov     StrongARMRTCState *s = opaque;
4225bc95aa2SDmitry Eremin-Solenikov 
4235bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_timer_update(s);
4245bc95aa2SDmitry Eremin-Solenikov     strongarm_rtc_int_update(s);
4255bc95aa2SDmitry Eremin-Solenikov 
4265bc95aa2SDmitry Eremin-Solenikov     return 0;
4275bc95aa2SDmitry Eremin-Solenikov }
4285bc95aa2SDmitry Eremin-Solenikov 
4295bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_rtc_regs = {
4305bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-rtc",
4315bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
4325bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
4335bc95aa2SDmitry Eremin-Solenikov     .pre_save = strongarm_rtc_pre_save,
4345bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_rtc_post_load,
4355bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
4365bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rttr, StrongARMRTCState),
4375bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtsr, StrongARMRTCState),
4385bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rtar, StrongARMRTCState),
4395bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(last_rcnr, StrongARMRTCState),
4405bc95aa2SDmitry Eremin-Solenikov         VMSTATE_INT64(last_hz, StrongARMRTCState),
4415bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
4425bc95aa2SDmitry Eremin-Solenikov     },
4435bc95aa2SDmitry Eremin-Solenikov };
4445bc95aa2SDmitry Eremin-Solenikov 
445999e12bbSAnthony Liguori static void strongarm_rtc_sysbus_class_init(ObjectClass *klass, void *data)
446999e12bbSAnthony Liguori {
44739bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
448999e12bbSAnthony Liguori 
44939bffca2SAnthony Liguori     dc->desc = "StrongARM RTC Controller";
45039bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_rtc_regs;
451999e12bbSAnthony Liguori }
452999e12bbSAnthony Liguori 
4538c43a6f0SAndreas Färber static const TypeInfo strongarm_rtc_sysbus_info = {
4544e002105SAndreas Färber     .name          = TYPE_STRONGARM_RTC,
45539bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
45639bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMRTCState),
4575a67508cSxiaoqiang.zhao     .instance_init = strongarm_rtc_init,
458999e12bbSAnthony Liguori     .class_init    = strongarm_rtc_sysbus_class_init,
4595bc95aa2SDmitry Eremin-Solenikov };
4605bc95aa2SDmitry Eremin-Solenikov 
4615bc95aa2SDmitry Eremin-Solenikov /* GPIO */
4625bc95aa2SDmitry Eremin-Solenikov #define GPLR 0x00
4635bc95aa2SDmitry Eremin-Solenikov #define GPDR 0x04
4645bc95aa2SDmitry Eremin-Solenikov #define GPSR 0x08
4655bc95aa2SDmitry Eremin-Solenikov #define GPCR 0x0c
4665bc95aa2SDmitry Eremin-Solenikov #define GRER 0x10
4675bc95aa2SDmitry Eremin-Solenikov #define GFER 0x14
4685bc95aa2SDmitry Eremin-Solenikov #define GEDR 0x18
4695bc95aa2SDmitry Eremin-Solenikov #define GAFR 0x1c
4705bc95aa2SDmitry Eremin-Solenikov 
471f55beb84SAndreas Färber #define TYPE_STRONGARM_GPIO "strongarm-gpio"
472f55beb84SAndreas Färber #define STRONGARM_GPIO(obj) \
473f55beb84SAndreas Färber     OBJECT_CHECK(StrongARMGPIOInfo, (obj), TYPE_STRONGARM_GPIO)
474f55beb84SAndreas Färber 
4755bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMGPIOInfo StrongARMGPIOInfo;
4765bc95aa2SDmitry Eremin-Solenikov struct StrongARMGPIOInfo {
4775bc95aa2SDmitry Eremin-Solenikov     SysBusDevice busdev;
478eb2fefbcSAvi Kivity     MemoryRegion iomem;
4795bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
4805bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqs[11];
4815bc95aa2SDmitry Eremin-Solenikov     qemu_irq irqX;
4825bc95aa2SDmitry Eremin-Solenikov 
4835bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
4845bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
4855bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
4865bc95aa2SDmitry Eremin-Solenikov     uint32_t rising;
4875bc95aa2SDmitry Eremin-Solenikov     uint32_t falling;
4885bc95aa2SDmitry Eremin-Solenikov     uint32_t status;
4895bc95aa2SDmitry Eremin-Solenikov     uint32_t gafr;
4905bc95aa2SDmitry Eremin-Solenikov 
4915bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
4925bc95aa2SDmitry Eremin-Solenikov };
4935bc95aa2SDmitry Eremin-Solenikov 
4945bc95aa2SDmitry Eremin-Solenikov 
4955bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_irq_update(StrongARMGPIOInfo *s)
4965bc95aa2SDmitry Eremin-Solenikov {
4975bc95aa2SDmitry Eremin-Solenikov     int i;
4985bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
4995bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->irqs[i], s->status & (1 << i));
5005bc95aa2SDmitry Eremin-Solenikov     }
5015bc95aa2SDmitry Eremin-Solenikov 
5025bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irqX, (s->status & ~0x7ff));
5035bc95aa2SDmitry Eremin-Solenikov }
5045bc95aa2SDmitry Eremin-Solenikov 
5055bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_set(void *opaque, int line, int level)
5065bc95aa2SDmitry Eremin-Solenikov {
5075bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5085bc95aa2SDmitry Eremin-Solenikov     uint32_t mask;
5095bc95aa2SDmitry Eremin-Solenikov 
5105bc95aa2SDmitry Eremin-Solenikov     mask = 1 << line;
5115bc95aa2SDmitry Eremin-Solenikov 
5125bc95aa2SDmitry Eremin-Solenikov     if (level) {
5135bc95aa2SDmitry Eremin-Solenikov         s->status |= s->rising & mask &
5145bc95aa2SDmitry Eremin-Solenikov                 ~s->ilevel & ~s->dir;
5155bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= mask;
5165bc95aa2SDmitry Eremin-Solenikov     } else {
5175bc95aa2SDmitry Eremin-Solenikov         s->status |= s->falling & mask &
5185bc95aa2SDmitry Eremin-Solenikov                 s->ilevel & ~s->dir;
5195bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~mask;
5205bc95aa2SDmitry Eremin-Solenikov     }
5215bc95aa2SDmitry Eremin-Solenikov 
5225bc95aa2SDmitry Eremin-Solenikov     if (s->status & mask) {
5235bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
5245bc95aa2SDmitry Eremin-Solenikov     }
5255bc95aa2SDmitry Eremin-Solenikov }
5265bc95aa2SDmitry Eremin-Solenikov 
5275bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_handler_update(StrongARMGPIOInfo *s)
5285bc95aa2SDmitry Eremin-Solenikov {
5295bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
5305bc95aa2SDmitry Eremin-Solenikov     int bit;
5315bc95aa2SDmitry Eremin-Solenikov 
5325bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
5335bc95aa2SDmitry Eremin-Solenikov 
5345bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
535786a4ea8SStefan Hajnoczi         bit = ctz32(diff);
5365bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
5375bc95aa2SDmitry Eremin-Solenikov     }
5385bc95aa2SDmitry Eremin-Solenikov 
5395bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
5405bc95aa2SDmitry Eremin-Solenikov }
5415bc95aa2SDmitry Eremin-Solenikov 
542a8170e5eSAvi Kivity static uint64_t strongarm_gpio_read(void *opaque, hwaddr offset,
543eb2fefbcSAvi Kivity                                     unsigned size)
5445bc95aa2SDmitry Eremin-Solenikov {
5455bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5465bc95aa2SDmitry Eremin-Solenikov 
5475bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5485bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
5495bc95aa2SDmitry Eremin-Solenikov         return s->dir;
5505bc95aa2SDmitry Eremin-Solenikov 
5515bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
55292335a0dSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
55392335a0dSPeter Maydell                       "strongarm GPIO: read from write only register GPSR\n");
55492335a0dSPeter Maydell         return 0;
5555bc95aa2SDmitry Eremin-Solenikov 
5565bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
55792335a0dSPeter Maydell         qemu_log_mask(LOG_GUEST_ERROR,
55892335a0dSPeter Maydell                       "strongarm GPIO: read from write only register GPCR\n");
55992335a0dSPeter Maydell         return 0;
5605bc95aa2SDmitry Eremin-Solenikov 
5615bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
5625bc95aa2SDmitry Eremin-Solenikov         return s->rising;
5635bc95aa2SDmitry Eremin-Solenikov 
5645bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
5655bc95aa2SDmitry Eremin-Solenikov         return s->falling;
5665bc95aa2SDmitry Eremin-Solenikov 
5675bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
5685bc95aa2SDmitry Eremin-Solenikov         return s->gafr;
5695bc95aa2SDmitry Eremin-Solenikov 
5705bc95aa2SDmitry Eremin-Solenikov     case GPLR:        /* GPIO Pin-Level registers */
5715bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
5725bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir);
5735bc95aa2SDmitry Eremin-Solenikov 
5745bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
5755bc95aa2SDmitry Eremin-Solenikov         return s->status;
5765bc95aa2SDmitry Eremin-Solenikov 
5775bc95aa2SDmitry Eremin-Solenikov     default:
5785bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
5795bc95aa2SDmitry Eremin-Solenikov     }
5805bc95aa2SDmitry Eremin-Solenikov 
5815bc95aa2SDmitry Eremin-Solenikov     return 0;
5825bc95aa2SDmitry Eremin-Solenikov }
5835bc95aa2SDmitry Eremin-Solenikov 
584a8170e5eSAvi Kivity static void strongarm_gpio_write(void *opaque, hwaddr offset,
585eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
5865bc95aa2SDmitry Eremin-Solenikov {
5875bc95aa2SDmitry Eremin-Solenikov     StrongARMGPIOInfo *s = opaque;
5885bc95aa2SDmitry Eremin-Solenikov 
5895bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
5905bc95aa2SDmitry Eremin-Solenikov     case GPDR:        /* GPIO Pin-Direction registers */
5919a93b2faSPrasad J Pandit         s->dir = value & 0x0fffffff;
5925bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
5935bc95aa2SDmitry Eremin-Solenikov         break;
5945bc95aa2SDmitry Eremin-Solenikov 
5955bc95aa2SDmitry Eremin-Solenikov     case GPSR:        /* GPIO Pin-Output Set registers */
5969a93b2faSPrasad J Pandit         s->olevel |= value & 0x0fffffff;
5975bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
5985bc95aa2SDmitry Eremin-Solenikov         break;
5995bc95aa2SDmitry Eremin-Solenikov 
6005bc95aa2SDmitry Eremin-Solenikov     case GPCR:        /* GPIO Pin-Output Clear registers */
6015bc95aa2SDmitry Eremin-Solenikov         s->olevel &= ~value;
6025bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_handler_update(s);
6035bc95aa2SDmitry Eremin-Solenikov         break;
6045bc95aa2SDmitry Eremin-Solenikov 
6055bc95aa2SDmitry Eremin-Solenikov     case GRER:        /* GPIO Rising-Edge Detect Enable registers */
6065bc95aa2SDmitry Eremin-Solenikov         s->rising = value;
6075bc95aa2SDmitry Eremin-Solenikov         break;
6085bc95aa2SDmitry Eremin-Solenikov 
6095bc95aa2SDmitry Eremin-Solenikov     case GFER:        /* GPIO Falling-Edge Detect Enable registers */
6105bc95aa2SDmitry Eremin-Solenikov         s->falling = value;
6115bc95aa2SDmitry Eremin-Solenikov         break;
6125bc95aa2SDmitry Eremin-Solenikov 
6135bc95aa2SDmitry Eremin-Solenikov     case GAFR:        /* GPIO Alternate Function registers */
6145bc95aa2SDmitry Eremin-Solenikov         s->gafr = value;
6155bc95aa2SDmitry Eremin-Solenikov         break;
6165bc95aa2SDmitry Eremin-Solenikov 
6175bc95aa2SDmitry Eremin-Solenikov     case GEDR:        /* GPIO Edge Detect Status registers */
6185bc95aa2SDmitry Eremin-Solenikov         s->status &= ~value;
6195bc95aa2SDmitry Eremin-Solenikov         strongarm_gpio_irq_update(s);
6205bc95aa2SDmitry Eremin-Solenikov         break;
6215bc95aa2SDmitry Eremin-Solenikov 
6225bc95aa2SDmitry Eremin-Solenikov     default:
6235bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
6245bc95aa2SDmitry Eremin-Solenikov     }
6255bc95aa2SDmitry Eremin-Solenikov }
6265bc95aa2SDmitry Eremin-Solenikov 
627eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_gpio_ops = {
628eb2fefbcSAvi Kivity     .read = strongarm_gpio_read,
629eb2fefbcSAvi Kivity     .write = strongarm_gpio_write,
630eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
6315bc95aa2SDmitry Eremin-Solenikov };
6325bc95aa2SDmitry Eremin-Solenikov 
633a8170e5eSAvi Kivity static DeviceState *strongarm_gpio_init(hwaddr base,
6345bc95aa2SDmitry Eremin-Solenikov                 DeviceState *pic)
6355bc95aa2SDmitry Eremin-Solenikov {
6365bc95aa2SDmitry Eremin-Solenikov     DeviceState *dev;
6375bc95aa2SDmitry Eremin-Solenikov     int i;
6385bc95aa2SDmitry Eremin-Solenikov 
639f55beb84SAndreas Färber     dev = qdev_create(NULL, TYPE_STRONGARM_GPIO);
6405bc95aa2SDmitry Eremin-Solenikov     qdev_init_nofail(dev);
6415bc95aa2SDmitry Eremin-Solenikov 
6421356b98dSAndreas Färber     sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, base);
6435bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 12; i++)
6441356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), i,
6455bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(pic, SA_PIC_GPIO0_EDGE + i));
6465bc95aa2SDmitry Eremin-Solenikov 
6475bc95aa2SDmitry Eremin-Solenikov     return dev;
6485bc95aa2SDmitry Eremin-Solenikov }
6495bc95aa2SDmitry Eremin-Solenikov 
6505a67508cSxiaoqiang.zhao static void strongarm_gpio_initfn(Object *obj)
6515bc95aa2SDmitry Eremin-Solenikov {
6525a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
6535a67508cSxiaoqiang.zhao     StrongARMGPIOInfo *s = STRONGARM_GPIO(obj);
6545a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
6555bc95aa2SDmitry Eremin-Solenikov     int i;
6565bc95aa2SDmitry Eremin-Solenikov 
657f55beb84SAndreas Färber     qdev_init_gpio_in(dev, strongarm_gpio_set, 28);
658f55beb84SAndreas Färber     qdev_init_gpio_out(dev, s->handler, 28);
6595bc95aa2SDmitry Eremin-Solenikov 
6605a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_gpio_ops, s,
66164bde0f3SPaolo Bonzini                           "gpio", 0x1000);
6625bc95aa2SDmitry Eremin-Solenikov 
663f55beb84SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
6645bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < 11; i++) {
665f55beb84SAndreas Färber         sysbus_init_irq(sbd, &s->irqs[i]);
6665bc95aa2SDmitry Eremin-Solenikov     }
667f55beb84SAndreas Färber     sysbus_init_irq(sbd, &s->irqX);
6685bc95aa2SDmitry Eremin-Solenikov }
6695bc95aa2SDmitry Eremin-Solenikov 
6705bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_gpio_regs = {
6715bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-gpio",
6725bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
6735bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
6745bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
6755bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMGPIOInfo),
6765bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMGPIOInfo),
6775bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMGPIOInfo),
6785bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(rising, StrongARMGPIOInfo),
6795bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(falling, StrongARMGPIOInfo),
6805bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(status, StrongARMGPIOInfo),
6815bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(gafr, StrongARMGPIOInfo),
682ed657d71SPeter Maydell         VMSTATE_UINT32(prev_level, StrongARMGPIOInfo),
6835bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
6845bc95aa2SDmitry Eremin-Solenikov     },
6855bc95aa2SDmitry Eremin-Solenikov };
6865bc95aa2SDmitry Eremin-Solenikov 
687999e12bbSAnthony Liguori static void strongarm_gpio_class_init(ObjectClass *klass, void *data)
688999e12bbSAnthony Liguori {
68939bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
690999e12bbSAnthony Liguori 
69139bffca2SAnthony Liguori     dc->desc = "StrongARM GPIO controller";
692ed657d71SPeter Maydell     dc->vmsd = &vmstate_strongarm_gpio_regs;
693999e12bbSAnthony Liguori }
694999e12bbSAnthony Liguori 
6958c43a6f0SAndreas Färber static const TypeInfo strongarm_gpio_info = {
696f55beb84SAndreas Färber     .name          = TYPE_STRONGARM_GPIO,
69739bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
69839bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMGPIOInfo),
6995a67508cSxiaoqiang.zhao     .instance_init = strongarm_gpio_initfn,
700999e12bbSAnthony Liguori     .class_init    = strongarm_gpio_class_init,
7015bc95aa2SDmitry Eremin-Solenikov };
7025bc95aa2SDmitry Eremin-Solenikov 
7035bc95aa2SDmitry Eremin-Solenikov /* Peripheral Pin Controller */
7045bc95aa2SDmitry Eremin-Solenikov #define PPDR 0x00
7055bc95aa2SDmitry Eremin-Solenikov #define PPSR 0x04
7065bc95aa2SDmitry Eremin-Solenikov #define PPAR 0x08
7075bc95aa2SDmitry Eremin-Solenikov #define PSDR 0x0c
7085bc95aa2SDmitry Eremin-Solenikov #define PPFR 0x10
7095bc95aa2SDmitry Eremin-Solenikov 
710c71e6732SAndreas Färber #define TYPE_STRONGARM_PPC "strongarm-ppc"
711c71e6732SAndreas Färber #define STRONGARM_PPC(obj) \
712c71e6732SAndreas Färber     OBJECT_CHECK(StrongARMPPCInfo, (obj), TYPE_STRONGARM_PPC)
713c71e6732SAndreas Färber 
7145bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMPPCInfo StrongARMPPCInfo;
7155bc95aa2SDmitry Eremin-Solenikov struct StrongARMPPCInfo {
716c71e6732SAndreas Färber     SysBusDevice parent_obj;
717c71e6732SAndreas Färber 
718eb2fefbcSAvi Kivity     MemoryRegion iomem;
7195bc95aa2SDmitry Eremin-Solenikov     qemu_irq handler[28];
7205bc95aa2SDmitry Eremin-Solenikov 
7215bc95aa2SDmitry Eremin-Solenikov     uint32_t ilevel;
7225bc95aa2SDmitry Eremin-Solenikov     uint32_t olevel;
7235bc95aa2SDmitry Eremin-Solenikov     uint32_t dir;
7245bc95aa2SDmitry Eremin-Solenikov     uint32_t ppar;
7255bc95aa2SDmitry Eremin-Solenikov     uint32_t psdr;
7265bc95aa2SDmitry Eremin-Solenikov     uint32_t ppfr;
7275bc95aa2SDmitry Eremin-Solenikov 
7285bc95aa2SDmitry Eremin-Solenikov     uint32_t prev_level;
7295bc95aa2SDmitry Eremin-Solenikov };
7305bc95aa2SDmitry Eremin-Solenikov 
7315bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_set(void *opaque, int line, int level)
7325bc95aa2SDmitry Eremin-Solenikov {
7335bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7345bc95aa2SDmitry Eremin-Solenikov 
7355bc95aa2SDmitry Eremin-Solenikov     if (level) {
7365bc95aa2SDmitry Eremin-Solenikov         s->ilevel |= 1 << line;
7375bc95aa2SDmitry Eremin-Solenikov     } else {
7385bc95aa2SDmitry Eremin-Solenikov         s->ilevel &= ~(1 << line);
7395bc95aa2SDmitry Eremin-Solenikov     }
7405bc95aa2SDmitry Eremin-Solenikov }
7415bc95aa2SDmitry Eremin-Solenikov 
7425bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_handler_update(StrongARMPPCInfo *s)
7435bc95aa2SDmitry Eremin-Solenikov {
7445bc95aa2SDmitry Eremin-Solenikov     uint32_t level, diff;
7455bc95aa2SDmitry Eremin-Solenikov     int bit;
7465bc95aa2SDmitry Eremin-Solenikov 
7475bc95aa2SDmitry Eremin-Solenikov     level = s->olevel & s->dir;
7485bc95aa2SDmitry Eremin-Solenikov 
7495bc95aa2SDmitry Eremin-Solenikov     for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
750786a4ea8SStefan Hajnoczi         bit = ctz32(diff);
7515bc95aa2SDmitry Eremin-Solenikov         qemu_set_irq(s->handler[bit], (level >> bit) & 1);
7525bc95aa2SDmitry Eremin-Solenikov     }
7535bc95aa2SDmitry Eremin-Solenikov 
7545bc95aa2SDmitry Eremin-Solenikov     s->prev_level = level;
7555bc95aa2SDmitry Eremin-Solenikov }
7565bc95aa2SDmitry Eremin-Solenikov 
757a8170e5eSAvi Kivity static uint64_t strongarm_ppc_read(void *opaque, hwaddr offset,
758eb2fefbcSAvi Kivity                                    unsigned size)
7595bc95aa2SDmitry Eremin-Solenikov {
7605bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7615bc95aa2SDmitry Eremin-Solenikov 
7625bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
7635bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
7645bc95aa2SDmitry Eremin-Solenikov         return s->dir | ~0x3fffff;
7655bc95aa2SDmitry Eremin-Solenikov 
7665bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
7675bc95aa2SDmitry Eremin-Solenikov         return (s->olevel & s->dir) |
7685bc95aa2SDmitry Eremin-Solenikov                (s->ilevel & ~s->dir) |
7695bc95aa2SDmitry Eremin-Solenikov                ~0x3fffff;
7705bc95aa2SDmitry Eremin-Solenikov 
7715bc95aa2SDmitry Eremin-Solenikov     case PPAR:
7725bc95aa2SDmitry Eremin-Solenikov         return s->ppar | ~0x41000;
7735bc95aa2SDmitry Eremin-Solenikov 
7745bc95aa2SDmitry Eremin-Solenikov     case PSDR:
7755bc95aa2SDmitry Eremin-Solenikov         return s->psdr;
7765bc95aa2SDmitry Eremin-Solenikov 
7775bc95aa2SDmitry Eremin-Solenikov     case PPFR:
7785bc95aa2SDmitry Eremin-Solenikov         return s->ppfr | ~0x7f001;
7795bc95aa2SDmitry Eremin-Solenikov 
7805bc95aa2SDmitry Eremin-Solenikov     default:
7815bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
7825bc95aa2SDmitry Eremin-Solenikov     }
7835bc95aa2SDmitry Eremin-Solenikov 
7845bc95aa2SDmitry Eremin-Solenikov     return 0;
7855bc95aa2SDmitry Eremin-Solenikov }
7865bc95aa2SDmitry Eremin-Solenikov 
787a8170e5eSAvi Kivity static void strongarm_ppc_write(void *opaque, hwaddr offset,
788eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
7895bc95aa2SDmitry Eremin-Solenikov {
7905bc95aa2SDmitry Eremin-Solenikov     StrongARMPPCInfo *s = opaque;
7915bc95aa2SDmitry Eremin-Solenikov 
7925bc95aa2SDmitry Eremin-Solenikov     switch (offset) {
7935bc95aa2SDmitry Eremin-Solenikov     case PPDR:        /* PPC Pin Direction registers */
7945bc95aa2SDmitry Eremin-Solenikov         s->dir = value & 0x3fffff;
7955bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
7965bc95aa2SDmitry Eremin-Solenikov         break;
7975bc95aa2SDmitry Eremin-Solenikov 
7985bc95aa2SDmitry Eremin-Solenikov     case PPSR:        /* PPC Pin State registers */
7995bc95aa2SDmitry Eremin-Solenikov         s->olevel = value & s->dir & 0x3fffff;
8005bc95aa2SDmitry Eremin-Solenikov         strongarm_ppc_handler_update(s);
8015bc95aa2SDmitry Eremin-Solenikov         break;
8025bc95aa2SDmitry Eremin-Solenikov 
8035bc95aa2SDmitry Eremin-Solenikov     case PPAR:
8045bc95aa2SDmitry Eremin-Solenikov         s->ppar = value & 0x41000;
8055bc95aa2SDmitry Eremin-Solenikov         break;
8065bc95aa2SDmitry Eremin-Solenikov 
8075bc95aa2SDmitry Eremin-Solenikov     case PSDR:
8085bc95aa2SDmitry Eremin-Solenikov         s->psdr = value & 0x3fffff;
8095bc95aa2SDmitry Eremin-Solenikov         break;
8105bc95aa2SDmitry Eremin-Solenikov 
8115bc95aa2SDmitry Eremin-Solenikov     case PPFR:
8125bc95aa2SDmitry Eremin-Solenikov         s->ppfr = value & 0x7f001;
8135bc95aa2SDmitry Eremin-Solenikov         break;
8145bc95aa2SDmitry Eremin-Solenikov 
8155bc95aa2SDmitry Eremin-Solenikov     default:
8165bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
8175bc95aa2SDmitry Eremin-Solenikov     }
8185bc95aa2SDmitry Eremin-Solenikov }
8195bc95aa2SDmitry Eremin-Solenikov 
820eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ppc_ops = {
821eb2fefbcSAvi Kivity     .read = strongarm_ppc_read,
822eb2fefbcSAvi Kivity     .write = strongarm_ppc_write,
823eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
8245bc95aa2SDmitry Eremin-Solenikov };
8255bc95aa2SDmitry Eremin-Solenikov 
8265a67508cSxiaoqiang.zhao static void strongarm_ppc_init(Object *obj)
8275bc95aa2SDmitry Eremin-Solenikov {
8285a67508cSxiaoqiang.zhao     DeviceState *dev = DEVICE(obj);
8295a67508cSxiaoqiang.zhao     StrongARMPPCInfo *s = STRONGARM_PPC(obj);
8305a67508cSxiaoqiang.zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
8315bc95aa2SDmitry Eremin-Solenikov 
832c71e6732SAndreas Färber     qdev_init_gpio_in(dev, strongarm_ppc_set, 22);
833c71e6732SAndreas Färber     qdev_init_gpio_out(dev, s->handler, 22);
8345bc95aa2SDmitry Eremin-Solenikov 
8355a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_ppc_ops, s,
83664bde0f3SPaolo Bonzini                           "ppc", 0x1000);
8375bc95aa2SDmitry Eremin-Solenikov 
838c71e6732SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
8395bc95aa2SDmitry Eremin-Solenikov }
8405bc95aa2SDmitry Eremin-Solenikov 
8415bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ppc_regs = {
8425bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ppc",
8435bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
8445bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
8455bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
8465bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ilevel, StrongARMPPCInfo),
8475bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(olevel, StrongARMPPCInfo),
8485bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(dir, StrongARMPPCInfo),
8495bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppar, StrongARMPPCInfo),
8505bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(psdr, StrongARMPPCInfo),
8515bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT32(ppfr, StrongARMPPCInfo),
852ed657d71SPeter Maydell         VMSTATE_UINT32(prev_level, StrongARMPPCInfo),
8535bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
8545bc95aa2SDmitry Eremin-Solenikov     },
8555bc95aa2SDmitry Eremin-Solenikov };
8565bc95aa2SDmitry Eremin-Solenikov 
857999e12bbSAnthony Liguori static void strongarm_ppc_class_init(ObjectClass *klass, void *data)
858999e12bbSAnthony Liguori {
85939bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
860999e12bbSAnthony Liguori 
86139bffca2SAnthony Liguori     dc->desc = "StrongARM PPC controller";
862ed657d71SPeter Maydell     dc->vmsd = &vmstate_strongarm_ppc_regs;
863999e12bbSAnthony Liguori }
864999e12bbSAnthony Liguori 
8658c43a6f0SAndreas Färber static const TypeInfo strongarm_ppc_info = {
866c71e6732SAndreas Färber     .name          = TYPE_STRONGARM_PPC,
86739bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
86839bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMPPCInfo),
8695a67508cSxiaoqiang.zhao     .instance_init = strongarm_ppc_init,
870999e12bbSAnthony Liguori     .class_init    = strongarm_ppc_class_init,
8715bc95aa2SDmitry Eremin-Solenikov };
8725bc95aa2SDmitry Eremin-Solenikov 
8735bc95aa2SDmitry Eremin-Solenikov /* UART Ports */
8745bc95aa2SDmitry Eremin-Solenikov #define UTCR0 0x00
8755bc95aa2SDmitry Eremin-Solenikov #define UTCR1 0x04
8765bc95aa2SDmitry Eremin-Solenikov #define UTCR2 0x08
8775bc95aa2SDmitry Eremin-Solenikov #define UTCR3 0x0c
8785bc95aa2SDmitry Eremin-Solenikov #define UTDR  0x14
8795bc95aa2SDmitry Eremin-Solenikov #define UTSR0 0x1c
8805bc95aa2SDmitry Eremin-Solenikov #define UTSR1 0x20
8815bc95aa2SDmitry Eremin-Solenikov 
8825bc95aa2SDmitry Eremin-Solenikov #define UTCR0_PE  (1 << 0) /* Parity enable */
8835bc95aa2SDmitry Eremin-Solenikov #define UTCR0_OES (1 << 1) /* Even parity */
8845bc95aa2SDmitry Eremin-Solenikov #define UTCR0_SBS (1 << 2) /* 2 stop bits */
8855bc95aa2SDmitry Eremin-Solenikov #define UTCR0_DSS (1 << 3) /* 8-bit data */
8865bc95aa2SDmitry Eremin-Solenikov 
8875bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RXE (1 << 0) /* Rx enable */
8885bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TXE (1 << 1) /* Tx enable */
8895bc95aa2SDmitry Eremin-Solenikov #define UTCR3_BRK (1 << 2) /* Force Break */
8905bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RIE (1 << 3) /* Rx int enable */
8915bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TIE (1 << 4) /* Tx int enable */
8925bc95aa2SDmitry Eremin-Solenikov #define UTCR3_LBM (1 << 5) /* Loopback */
8935bc95aa2SDmitry Eremin-Solenikov 
8945bc95aa2SDmitry Eremin-Solenikov #define UTSR0_TFS (1 << 0) /* Tx FIFO nearly empty */
8955bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RFS (1 << 1) /* Rx FIFO nearly full */
8965bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RID (1 << 2) /* Receiver Idle */
8975bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RBB (1 << 3) /* Receiver begin break */
8985bc95aa2SDmitry Eremin-Solenikov #define UTSR0_REB (1 << 4) /* Receiver end break */
8995bc95aa2SDmitry Eremin-Solenikov #define UTSR0_EIF (1 << 5) /* Error in FIFO */
9005bc95aa2SDmitry Eremin-Solenikov 
9015bc95aa2SDmitry Eremin-Solenikov #define UTSR1_RNE (1 << 1) /* Receive FIFO not empty */
9025bc95aa2SDmitry Eremin-Solenikov #define UTSR1_TNF (1 << 2) /* Transmit FIFO not full */
9035bc95aa2SDmitry Eremin-Solenikov #define UTSR1_PRE (1 << 3) /* Parity error */
9045bc95aa2SDmitry Eremin-Solenikov #define UTSR1_FRE (1 << 4) /* Frame error */
9055bc95aa2SDmitry Eremin-Solenikov #define UTSR1_ROR (1 << 5) /* Receive Over Run */
9065bc95aa2SDmitry Eremin-Solenikov 
9075bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_PRE (1 << 8)
9085bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_FRE (1 << 9)
9095bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_ROR (1 << 10)
9105bc95aa2SDmitry Eremin-Solenikov 
911fff3af97SAndreas Färber #define TYPE_STRONGARM_UART "strongarm-uart"
912fff3af97SAndreas Färber #define STRONGARM_UART(obj) \
913fff3af97SAndreas Färber     OBJECT_CHECK(StrongARMUARTState, (obj), TYPE_STRONGARM_UART)
914fff3af97SAndreas Färber 
915fff3af97SAndreas Färber typedef struct StrongARMUARTState {
916fff3af97SAndreas Färber     SysBusDevice parent_obj;
917fff3af97SAndreas Färber 
918eb2fefbcSAvi Kivity     MemoryRegion iomem;
919becdfa00SMarc-André Lureau     CharBackend chr;
9205bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
9215bc95aa2SDmitry Eremin-Solenikov 
9225bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr0;
9235bc95aa2SDmitry Eremin-Solenikov     uint16_t brd;
9245bc95aa2SDmitry Eremin-Solenikov     uint8_t utcr3;
9255bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr0;
9265bc95aa2SDmitry Eremin-Solenikov     uint8_t utsr1;
9275bc95aa2SDmitry Eremin-Solenikov 
9285bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_fifo[8];
9295bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_start;
9305bc95aa2SDmitry Eremin-Solenikov     uint8_t tx_len;
9315bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[12]; /* value + error flags in high bits */
9325bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
9335bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_len;
9345bc95aa2SDmitry Eremin-Solenikov 
9355bc95aa2SDmitry Eremin-Solenikov     uint64_t char_transmit_time; /* time to transmit a char in ticks*/
9365bc95aa2SDmitry Eremin-Solenikov     bool wait_break_end;
9375bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *rx_timeout_timer;
9385bc95aa2SDmitry Eremin-Solenikov     QEMUTimer *tx_timer;
9395bc95aa2SDmitry Eremin-Solenikov } StrongARMUARTState;
9405bc95aa2SDmitry Eremin-Solenikov 
9415bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_status(StrongARMUARTState *s)
9425bc95aa2SDmitry Eremin-Solenikov {
9435bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr1 = 0;
9445bc95aa2SDmitry Eremin-Solenikov 
9455bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len != 8) {
9465bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_TNF;
9475bc95aa2SDmitry Eremin-Solenikov     }
9485bc95aa2SDmitry Eremin-Solenikov 
9495bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len != 0) {
9505bc95aa2SDmitry Eremin-Solenikov         uint16_t ent = s->rx_fifo[s->rx_start];
9515bc95aa2SDmitry Eremin-Solenikov 
9525bc95aa2SDmitry Eremin-Solenikov         utsr1 |= UTSR1_RNE;
9535bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_PRE) {
9545bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_PRE;
9555bc95aa2SDmitry Eremin-Solenikov         }
9565bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_FRE) {
9575bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_FRE;
9585bc95aa2SDmitry Eremin-Solenikov         }
9595bc95aa2SDmitry Eremin-Solenikov         if (ent & RX_FIFO_ROR) {
9605bc95aa2SDmitry Eremin-Solenikov             s->utsr1 |= UTSR1_ROR;
9615bc95aa2SDmitry Eremin-Solenikov         }
9625bc95aa2SDmitry Eremin-Solenikov     }
9635bc95aa2SDmitry Eremin-Solenikov 
9645bc95aa2SDmitry Eremin-Solenikov     s->utsr1 = utsr1;
9655bc95aa2SDmitry Eremin-Solenikov }
9665bc95aa2SDmitry Eremin-Solenikov 
9675bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_int_status(StrongARMUARTState *s)
9685bc95aa2SDmitry Eremin-Solenikov {
9695bc95aa2SDmitry Eremin-Solenikov     uint16_t utsr0 = s->utsr0 &
9705bc95aa2SDmitry Eremin-Solenikov             (UTSR0_REB | UTSR0_RBB | UTSR0_RID);
9715bc95aa2SDmitry Eremin-Solenikov     int i;
9725bc95aa2SDmitry Eremin-Solenikov 
9735bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_TXE) &&
9745bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_TIE) &&
9755bc95aa2SDmitry Eremin-Solenikov                 s->tx_len <= 4) {
9765bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_TFS;
9775bc95aa2SDmitry Eremin-Solenikov     }
9785bc95aa2SDmitry Eremin-Solenikov 
9795bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) &&
9805bc95aa2SDmitry Eremin-Solenikov                 (s->utcr3 & UTCR3_RIE) &&
9815bc95aa2SDmitry Eremin-Solenikov                 s->rx_len > 4) {
9825bc95aa2SDmitry Eremin-Solenikov         utsr0 |= UTSR0_RFS;
9835bc95aa2SDmitry Eremin-Solenikov     }
9845bc95aa2SDmitry Eremin-Solenikov 
9855bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < s->rx_len && i < 4; i++)
9865bc95aa2SDmitry Eremin-Solenikov         if (s->rx_fifo[(s->rx_start + i) % 12] & ~0xff) {
9875bc95aa2SDmitry Eremin-Solenikov             utsr0 |= UTSR0_EIF;
9885bc95aa2SDmitry Eremin-Solenikov             break;
9895bc95aa2SDmitry Eremin-Solenikov         }
9905bc95aa2SDmitry Eremin-Solenikov 
9915bc95aa2SDmitry Eremin-Solenikov     s->utsr0 = utsr0;
9925bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, utsr0);
9935bc95aa2SDmitry Eremin-Solenikov }
9945bc95aa2SDmitry Eremin-Solenikov 
9955bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_parameters(StrongARMUARTState *s)
9965bc95aa2SDmitry Eremin-Solenikov {
9975bc95aa2SDmitry Eremin-Solenikov     int speed, parity, data_bits, stop_bits, frame_size;
9985bc95aa2SDmitry Eremin-Solenikov     QEMUSerialSetParams ssp;
9995bc95aa2SDmitry Eremin-Solenikov 
10005bc95aa2SDmitry Eremin-Solenikov     /* Start bit. */
10015bc95aa2SDmitry Eremin-Solenikov     frame_size = 1;
10025bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_PE) {
10035bc95aa2SDmitry Eremin-Solenikov         /* Parity bit. */
10045bc95aa2SDmitry Eremin-Solenikov         frame_size++;
10055bc95aa2SDmitry Eremin-Solenikov         if (s->utcr0 & UTCR0_OES) {
10065bc95aa2SDmitry Eremin-Solenikov             parity = 'E';
10075bc95aa2SDmitry Eremin-Solenikov         } else {
10085bc95aa2SDmitry Eremin-Solenikov             parity = 'O';
10095bc95aa2SDmitry Eremin-Solenikov         }
10105bc95aa2SDmitry Eremin-Solenikov     } else {
10115bc95aa2SDmitry Eremin-Solenikov             parity = 'N';
10125bc95aa2SDmitry Eremin-Solenikov     }
10135bc95aa2SDmitry Eremin-Solenikov     if (s->utcr0 & UTCR0_SBS) {
10145bc95aa2SDmitry Eremin-Solenikov         stop_bits = 2;
10155bc95aa2SDmitry Eremin-Solenikov     } else {
10165bc95aa2SDmitry Eremin-Solenikov         stop_bits = 1;
10175bc95aa2SDmitry Eremin-Solenikov     }
10185bc95aa2SDmitry Eremin-Solenikov 
10195bc95aa2SDmitry Eremin-Solenikov     data_bits = (s->utcr0 & UTCR0_DSS) ? 8 : 7;
10205bc95aa2SDmitry Eremin-Solenikov     frame_size += data_bits + stop_bits;
10215bc95aa2SDmitry Eremin-Solenikov     speed = 3686400 / 16 / (s->brd + 1);
10225bc95aa2SDmitry Eremin-Solenikov     ssp.speed = speed;
10235bc95aa2SDmitry Eremin-Solenikov     ssp.parity = parity;
10245bc95aa2SDmitry Eremin-Solenikov     ssp.data_bits = data_bits;
10255bc95aa2SDmitry Eremin-Solenikov     ssp.stop_bits = stop_bits;
102673bcb24dSRutuja Shah     s->char_transmit_time =  (NANOSECONDS_PER_SECOND / speed) * frame_size;
10275345fdb4SMarc-André Lureau     qemu_chr_fe_ioctl(&s->chr, CHR_IOCTL_SERIAL_SET_PARAMS, &ssp);
10285bc95aa2SDmitry Eremin-Solenikov 
10295bc95aa2SDmitry Eremin-Solenikov     DPRINTF(stderr, "%s speed=%d parity=%c data=%d stop=%d\n", s->chr->label,
10305bc95aa2SDmitry Eremin-Solenikov             speed, parity, data_bits, stop_bits);
10315bc95aa2SDmitry Eremin-Solenikov }
10325bc95aa2SDmitry Eremin-Solenikov 
10335bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_to(void *opaque)
10345bc95aa2SDmitry Eremin-Solenikov {
10355bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10365bc95aa2SDmitry Eremin-Solenikov 
10375bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
10385bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RID;
10395bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
10405bc95aa2SDmitry Eremin-Solenikov     }
10415bc95aa2SDmitry Eremin-Solenikov }
10425bc95aa2SDmitry Eremin-Solenikov 
10435bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_push(StrongARMUARTState *s, uint16_t c)
10445bc95aa2SDmitry Eremin-Solenikov {
10455bc95aa2SDmitry Eremin-Solenikov     if ((s->utcr3 & UTCR3_RXE) == 0) {
10465bc95aa2SDmitry Eremin-Solenikov         /* rx disabled */
10475bc95aa2SDmitry Eremin-Solenikov         return;
10485bc95aa2SDmitry Eremin-Solenikov     }
10495bc95aa2SDmitry Eremin-Solenikov 
10505bc95aa2SDmitry Eremin-Solenikov     if (s->wait_break_end) {
10515bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_REB;
10525bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = false;
10535bc95aa2SDmitry Eremin-Solenikov     }
10545bc95aa2SDmitry Eremin-Solenikov 
10555bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 12) {
10565bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + s->rx_len) % 12] = c;
10575bc95aa2SDmitry Eremin-Solenikov         s->rx_len++;
10585bc95aa2SDmitry Eremin-Solenikov     } else
10595bc95aa2SDmitry Eremin-Solenikov         s->rx_fifo[(s->rx_start + 11) % 12] |= RX_FIFO_ROR;
10605bc95aa2SDmitry Eremin-Solenikov }
10615bc95aa2SDmitry Eremin-Solenikov 
10625bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_can_receive(void *opaque)
10635bc95aa2SDmitry Eremin-Solenikov {
10645bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10655bc95aa2SDmitry Eremin-Solenikov 
10665bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len == 12) {
10675bc95aa2SDmitry Eremin-Solenikov         return 0;
10685bc95aa2SDmitry Eremin-Solenikov     }
10695bc95aa2SDmitry Eremin-Solenikov     /* It's best not to get more than 2/3 of RX FIFO, so advertise that much */
10705bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len < 8) {
10715bc95aa2SDmitry Eremin-Solenikov         return 8 - s->rx_len;
10725bc95aa2SDmitry Eremin-Solenikov     }
10735bc95aa2SDmitry Eremin-Solenikov     return 1;
10745bc95aa2SDmitry Eremin-Solenikov }
10755bc95aa2SDmitry Eremin-Solenikov 
10765bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_receive(void *opaque, const uint8_t *buf, int size)
10775bc95aa2SDmitry Eremin-Solenikov {
10785bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10795bc95aa2SDmitry Eremin-Solenikov     int i;
10805bc95aa2SDmitry Eremin-Solenikov 
10815bc95aa2SDmitry Eremin-Solenikov     for (i = 0; i < size; i++) {
10825bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, buf[i]);
10835bc95aa2SDmitry Eremin-Solenikov     }
10845bc95aa2SDmitry Eremin-Solenikov 
10855bc95aa2SDmitry Eremin-Solenikov     /* call the timeout receive callback in 3 char transmit time */
1086bc72ad67SAlex Bligh     timer_mod(s->rx_timeout_timer,
1087bc72ad67SAlex Bligh                     qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
10885bc95aa2SDmitry Eremin-Solenikov 
10895bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
10905bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
10915bc95aa2SDmitry Eremin-Solenikov }
10925bc95aa2SDmitry Eremin-Solenikov 
10935bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_event(void *opaque, int event)
10945bc95aa2SDmitry Eremin-Solenikov {
10955bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
10965bc95aa2SDmitry Eremin-Solenikov     if (event == CHR_EVENT_BREAK) {
10975bc95aa2SDmitry Eremin-Solenikov         s->utsr0 |= UTSR0_RBB;
10985bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_rx_push(s, RX_FIFO_FRE);
10995bc95aa2SDmitry Eremin-Solenikov         s->wait_break_end = true;
11005bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
11015bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
11025bc95aa2SDmitry Eremin-Solenikov     }
11035bc95aa2SDmitry Eremin-Solenikov }
11045bc95aa2SDmitry Eremin-Solenikov 
11055bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_tx(void *opaque)
11065bc95aa2SDmitry Eremin-Solenikov {
11075bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
1108bc72ad67SAlex Bligh     uint64_t new_xmit_ts = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
11095bc95aa2SDmitry Eremin-Solenikov 
11105bc95aa2SDmitry Eremin-Solenikov     if (s->utcr3 & UTCR3_LBM) /* loopback */ {
11115bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_receive(s, &s->tx_fifo[s->tx_start], 1);
111230650701SAnton Nefedov     } else if (qemu_chr_fe_backend_connected(&s->chr)) {
11136ab3fc32SDaniel P. Berrange         /* XXX this blocks entire thread. Rewrite to use
11146ab3fc32SDaniel P. Berrange          * qemu_chr_fe_write and background I/O callbacks */
11155345fdb4SMarc-André Lureau         qemu_chr_fe_write_all(&s->chr, &s->tx_fifo[s->tx_start], 1);
11165bc95aa2SDmitry Eremin-Solenikov     }
11175bc95aa2SDmitry Eremin-Solenikov 
11185bc95aa2SDmitry Eremin-Solenikov     s->tx_start = (s->tx_start + 1) % 8;
11195bc95aa2SDmitry Eremin-Solenikov     s->tx_len--;
11205bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
1121bc72ad67SAlex Bligh         timer_mod(s->tx_timer, new_xmit_ts + s->char_transmit_time);
11225bc95aa2SDmitry Eremin-Solenikov     }
11235bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
11245bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
11255bc95aa2SDmitry Eremin-Solenikov }
11265bc95aa2SDmitry Eremin-Solenikov 
1127a8170e5eSAvi Kivity static uint64_t strongarm_uart_read(void *opaque, hwaddr addr,
1128eb2fefbcSAvi Kivity                                     unsigned size)
11295bc95aa2SDmitry Eremin-Solenikov {
11305bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11315bc95aa2SDmitry Eremin-Solenikov     uint16_t ret;
11325bc95aa2SDmitry Eremin-Solenikov 
11335bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11345bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11355bc95aa2SDmitry Eremin-Solenikov         return s->utcr0;
11365bc95aa2SDmitry Eremin-Solenikov 
11375bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11385bc95aa2SDmitry Eremin-Solenikov         return s->brd >> 8;
11395bc95aa2SDmitry Eremin-Solenikov 
11405bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11415bc95aa2SDmitry Eremin-Solenikov         return s->brd & 0xff;
11425bc95aa2SDmitry Eremin-Solenikov 
11435bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
11445bc95aa2SDmitry Eremin-Solenikov         return s->utcr3;
11455bc95aa2SDmitry Eremin-Solenikov 
11465bc95aa2SDmitry Eremin-Solenikov     case UTDR:
11475bc95aa2SDmitry Eremin-Solenikov         if (s->rx_len != 0) {
11485bc95aa2SDmitry Eremin-Solenikov             ret = s->rx_fifo[s->rx_start];
11495bc95aa2SDmitry Eremin-Solenikov             s->rx_start = (s->rx_start + 1) % 12;
11505bc95aa2SDmitry Eremin-Solenikov             s->rx_len--;
11515bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
11525bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
11535bc95aa2SDmitry Eremin-Solenikov             return ret;
11545bc95aa2SDmitry Eremin-Solenikov         }
11555bc95aa2SDmitry Eremin-Solenikov         return 0;
11565bc95aa2SDmitry Eremin-Solenikov 
11575bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
11585bc95aa2SDmitry Eremin-Solenikov         return s->utsr0;
11595bc95aa2SDmitry Eremin-Solenikov 
11605bc95aa2SDmitry Eremin-Solenikov     case UTSR1:
11615bc95aa2SDmitry Eremin-Solenikov         return s->utsr1;
11625bc95aa2SDmitry Eremin-Solenikov 
11635bc95aa2SDmitry Eremin-Solenikov     default:
11645bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
11655bc95aa2SDmitry Eremin-Solenikov         return 0;
11665bc95aa2SDmitry Eremin-Solenikov     }
11675bc95aa2SDmitry Eremin-Solenikov }
11685bc95aa2SDmitry Eremin-Solenikov 
1169a8170e5eSAvi Kivity static void strongarm_uart_write(void *opaque, hwaddr addr,
1170eb2fefbcSAvi Kivity                                  uint64_t value, unsigned size)
11715bc95aa2SDmitry Eremin-Solenikov {
11725bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
11735bc95aa2SDmitry Eremin-Solenikov 
11745bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
11755bc95aa2SDmitry Eremin-Solenikov     case UTCR0:
11765bc95aa2SDmitry Eremin-Solenikov         s->utcr0 = value & 0x7f;
11775bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11785bc95aa2SDmitry Eremin-Solenikov         break;
11795bc95aa2SDmitry Eremin-Solenikov 
11805bc95aa2SDmitry Eremin-Solenikov     case UTCR1:
11815bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xff) | ((value & 0xf) << 8);
11825bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11835bc95aa2SDmitry Eremin-Solenikov         break;
11845bc95aa2SDmitry Eremin-Solenikov 
11855bc95aa2SDmitry Eremin-Solenikov     case UTCR2:
11865bc95aa2SDmitry Eremin-Solenikov         s->brd = (s->brd & 0xf00) | (value & 0xff);
11875bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_parameters(s);
11885bc95aa2SDmitry Eremin-Solenikov         break;
11895bc95aa2SDmitry Eremin-Solenikov 
11905bc95aa2SDmitry Eremin-Solenikov     case UTCR3:
11915bc95aa2SDmitry Eremin-Solenikov         s->utcr3 = value & 0x3f;
11925bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_RXE) == 0) {
11935bc95aa2SDmitry Eremin-Solenikov             s->rx_len = 0;
11945bc95aa2SDmitry Eremin-Solenikov         }
11955bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) == 0) {
11965bc95aa2SDmitry Eremin-Solenikov             s->tx_len = 0;
11975bc95aa2SDmitry Eremin-Solenikov         }
11985bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_status(s);
11995bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
12005bc95aa2SDmitry Eremin-Solenikov         break;
12015bc95aa2SDmitry Eremin-Solenikov 
12025bc95aa2SDmitry Eremin-Solenikov     case UTDR:
12035bc95aa2SDmitry Eremin-Solenikov         if ((s->utcr3 & UTCR3_TXE) && s->tx_len != 8) {
12045bc95aa2SDmitry Eremin-Solenikov             s->tx_fifo[(s->tx_start + s->tx_len) % 8] = value;
12055bc95aa2SDmitry Eremin-Solenikov             s->tx_len++;
12065bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_status(s);
12075bc95aa2SDmitry Eremin-Solenikov             strongarm_uart_update_int_status(s);
12085bc95aa2SDmitry Eremin-Solenikov             if (s->tx_len == 1) {
12095bc95aa2SDmitry Eremin-Solenikov                 strongarm_uart_tx(s);
12105bc95aa2SDmitry Eremin-Solenikov             }
12115bc95aa2SDmitry Eremin-Solenikov         }
12125bc95aa2SDmitry Eremin-Solenikov         break;
12135bc95aa2SDmitry Eremin-Solenikov 
12145bc95aa2SDmitry Eremin-Solenikov     case UTSR0:
12155bc95aa2SDmitry Eremin-Solenikov         s->utsr0 = s->utsr0 & ~(value &
12165bc95aa2SDmitry Eremin-Solenikov                 (UTSR0_REB | UTSR0_RBB | UTSR0_RID));
12175bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_update_int_status(s);
12185bc95aa2SDmitry Eremin-Solenikov         break;
12195bc95aa2SDmitry Eremin-Solenikov 
12205bc95aa2SDmitry Eremin-Solenikov     default:
12215bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
12225bc95aa2SDmitry Eremin-Solenikov     }
12235bc95aa2SDmitry Eremin-Solenikov }
12245bc95aa2SDmitry Eremin-Solenikov 
1225eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_uart_ops = {
1226eb2fefbcSAvi Kivity     .read = strongarm_uart_read,
1227eb2fefbcSAvi Kivity     .write = strongarm_uart_write,
1228eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
12295bc95aa2SDmitry Eremin-Solenikov };
12305bc95aa2SDmitry Eremin-Solenikov 
12315a67508cSxiaoqiang.zhao static void strongarm_uart_init(Object *obj)
12325bc95aa2SDmitry Eremin-Solenikov {
12335a67508cSxiaoqiang.zhao     StrongARMUARTState *s = STRONGARM_UART(obj);
12345a67508cSxiaoqiang.zhao     SysBusDevice *dev = SYS_BUS_DEVICE(obj);
12355bc95aa2SDmitry Eremin-Solenikov 
12365a67508cSxiaoqiang.zhao     memory_region_init_io(&s->iomem, obj, &strongarm_uart_ops, s,
123764bde0f3SPaolo Bonzini                           "uart", 0x10000);
1238750ecd44SAvi Kivity     sysbus_init_mmio(dev, &s->iomem);
12395bc95aa2SDmitry Eremin-Solenikov     sysbus_init_irq(dev, &s->irq);
12405bc95aa2SDmitry Eremin-Solenikov 
1241bc72ad67SAlex Bligh     s->rx_timeout_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_rx_to, s);
1242bc72ad67SAlex Bligh     s->tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_tx, s);
12438934515aSxiaoqiang zhao }
12448934515aSxiaoqiang zhao 
12458934515aSxiaoqiang zhao static void strongarm_uart_realize(DeviceState *dev, Error **errp)
12468934515aSxiaoqiang zhao {
12478934515aSxiaoqiang zhao     StrongARMUARTState *s = STRONGARM_UART(dev);
12485bc95aa2SDmitry Eremin-Solenikov 
12495345fdb4SMarc-André Lureau     qemu_chr_fe_set_handlers(&s->chr,
12505bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_can_receive,
12515bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_receive,
12525bc95aa2SDmitry Eremin-Solenikov                              strongarm_uart_event,
125381517ba3SAnton Nefedov                              NULL, s, NULL, true);
12545bc95aa2SDmitry Eremin-Solenikov }
12555bc95aa2SDmitry Eremin-Solenikov 
12565bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_reset(DeviceState *dev)
12575bc95aa2SDmitry Eremin-Solenikov {
1258fff3af97SAndreas Färber     StrongARMUARTState *s = STRONGARM_UART(dev);
12595bc95aa2SDmitry Eremin-Solenikov 
12605bc95aa2SDmitry Eremin-Solenikov     s->utcr0 = UTCR0_DSS; /* 8 data, no parity */
12615bc95aa2SDmitry Eremin-Solenikov     s->brd = 23;    /* 9600 */
12625bc95aa2SDmitry Eremin-Solenikov     /* enable send & recv - this actually violates spec */
12635bc95aa2SDmitry Eremin-Solenikov     s->utcr3 = UTCR3_TXE | UTCR3_RXE;
12645bc95aa2SDmitry Eremin-Solenikov 
12655bc95aa2SDmitry Eremin-Solenikov     s->rx_len = s->tx_len = 0;
12665bc95aa2SDmitry Eremin-Solenikov 
12675bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12685bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12695bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12705bc95aa2SDmitry Eremin-Solenikov }
12715bc95aa2SDmitry Eremin-Solenikov 
12725bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_post_load(void *opaque, int version_id)
12735bc95aa2SDmitry Eremin-Solenikov {
12745bc95aa2SDmitry Eremin-Solenikov     StrongARMUARTState *s = opaque;
12755bc95aa2SDmitry Eremin-Solenikov 
12765bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_parameters(s);
12775bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_status(s);
12785bc95aa2SDmitry Eremin-Solenikov     strongarm_uart_update_int_status(s);
12795bc95aa2SDmitry Eremin-Solenikov 
12805bc95aa2SDmitry Eremin-Solenikov     /* tx and restart timer */
12815bc95aa2SDmitry Eremin-Solenikov     if (s->tx_len) {
12825bc95aa2SDmitry Eremin-Solenikov         strongarm_uart_tx(s);
12835bc95aa2SDmitry Eremin-Solenikov     }
12845bc95aa2SDmitry Eremin-Solenikov 
12855bc95aa2SDmitry Eremin-Solenikov     /* restart rx timeout timer */
12865bc95aa2SDmitry Eremin-Solenikov     if (s->rx_len) {
1287bc72ad67SAlex Bligh         timer_mod(s->rx_timeout_timer,
1288bc72ad67SAlex Bligh                 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
12895bc95aa2SDmitry Eremin-Solenikov     }
12905bc95aa2SDmitry Eremin-Solenikov 
12915bc95aa2SDmitry Eremin-Solenikov     return 0;
12925bc95aa2SDmitry Eremin-Solenikov }
12935bc95aa2SDmitry Eremin-Solenikov 
12945bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_uart_regs = {
12955bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-uart",
12965bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
12975bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
12985bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_uart_post_load,
12995bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
13005bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr0, StrongARMUARTState),
13015bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(brd, StrongARMUARTState),
13025bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utcr3, StrongARMUARTState),
13035bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(utsr0, StrongARMUARTState),
13045bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8_ARRAY(tx_fifo, StrongARMUARTState, 8),
13055bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_start, StrongARMUARTState),
13065bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(tx_len, StrongARMUARTState),
13075bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMUARTState, 12),
13085bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMUARTState),
13095bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_len, StrongARMUARTState),
13105bc95aa2SDmitry Eremin-Solenikov         VMSTATE_BOOL(wait_break_end, StrongARMUARTState),
13115bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
13125bc95aa2SDmitry Eremin-Solenikov     },
13135bc95aa2SDmitry Eremin-Solenikov };
13145bc95aa2SDmitry Eremin-Solenikov 
1315999e12bbSAnthony Liguori static Property strongarm_uart_properties[] = {
13165bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_CHR("chardev", StrongARMUARTState, chr),
13175bc95aa2SDmitry Eremin-Solenikov     DEFINE_PROP_END_OF_LIST(),
1318999e12bbSAnthony Liguori };
1319999e12bbSAnthony Liguori 
1320999e12bbSAnthony Liguori static void strongarm_uart_class_init(ObjectClass *klass, void *data)
1321999e12bbSAnthony Liguori {
132239bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1323999e12bbSAnthony Liguori 
132439bffca2SAnthony Liguori     dc->desc = "StrongARM UART controller";
132539bffca2SAnthony Liguori     dc->reset = strongarm_uart_reset;
132639bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_uart_regs;
132739bffca2SAnthony Liguori     dc->props = strongarm_uart_properties;
13288934515aSxiaoqiang zhao     dc->realize = strongarm_uart_realize;
13295bc95aa2SDmitry Eremin-Solenikov }
1330999e12bbSAnthony Liguori 
13318c43a6f0SAndreas Färber static const TypeInfo strongarm_uart_info = {
1332fff3af97SAndreas Färber     .name          = TYPE_STRONGARM_UART,
133339bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
133439bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMUARTState),
13355a67508cSxiaoqiang.zhao     .instance_init = strongarm_uart_init,
1336999e12bbSAnthony Liguori     .class_init    = strongarm_uart_class_init,
13375bc95aa2SDmitry Eremin-Solenikov };
13385bc95aa2SDmitry Eremin-Solenikov 
13395bc95aa2SDmitry Eremin-Solenikov /* Synchronous Serial Ports */
13400ca81872SAndreas Färber 
13410ca81872SAndreas Färber #define TYPE_STRONGARM_SSP "strongarm-ssp"
13420ca81872SAndreas Färber #define STRONGARM_SSP(obj) \
13430ca81872SAndreas Färber     OBJECT_CHECK(StrongARMSSPState, (obj), TYPE_STRONGARM_SSP)
13440ca81872SAndreas Färber 
13450ca81872SAndreas Färber typedef struct StrongARMSSPState {
13460ca81872SAndreas Färber     SysBusDevice parent_obj;
13470ca81872SAndreas Färber 
1348eb2fefbcSAvi Kivity     MemoryRegion iomem;
13495bc95aa2SDmitry Eremin-Solenikov     qemu_irq irq;
13505bc95aa2SDmitry Eremin-Solenikov     SSIBus *bus;
13515bc95aa2SDmitry Eremin-Solenikov 
13525bc95aa2SDmitry Eremin-Solenikov     uint16_t sscr[2];
13535bc95aa2SDmitry Eremin-Solenikov     uint16_t sssr;
13545bc95aa2SDmitry Eremin-Solenikov 
13555bc95aa2SDmitry Eremin-Solenikov     uint16_t rx_fifo[8];
13565bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_level;
13575bc95aa2SDmitry Eremin-Solenikov     uint8_t rx_start;
13585bc95aa2SDmitry Eremin-Solenikov } StrongARMSSPState;
13595bc95aa2SDmitry Eremin-Solenikov 
13605bc95aa2SDmitry Eremin-Solenikov #define SSCR0 0x60 /* SSP Control register 0 */
13615bc95aa2SDmitry Eremin-Solenikov #define SSCR1 0x64 /* SSP Control register 1 */
13625bc95aa2SDmitry Eremin-Solenikov #define SSDR  0x6c /* SSP Data register */
13635bc95aa2SDmitry Eremin-Solenikov #define SSSR  0x74 /* SSP Status register */
13645bc95aa2SDmitry Eremin-Solenikov 
13655bc95aa2SDmitry Eremin-Solenikov /* Bitfields for above registers */
13665bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SPI(x)    (((x) & 0x30) == 0x00)
13675bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSP(x)    (((x) & 0x30) == 0x10)
13685bc95aa2SDmitry Eremin-Solenikov #define SSCR0_UWIRE(x)  (((x) & 0x30) == 0x20)
13695bc95aa2SDmitry Eremin-Solenikov #define SSCR0_PSP(x)    (((x) & 0x30) == 0x30)
13705bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSE       (1 << 7)
13715bc95aa2SDmitry Eremin-Solenikov #define SSCR0_DSS(x)    (((x) & 0xf) + 1)
13725bc95aa2SDmitry Eremin-Solenikov #define SSCR1_RIE       (1 << 0)
13735bc95aa2SDmitry Eremin-Solenikov #define SSCR1_TIE       (1 << 1)
13745bc95aa2SDmitry Eremin-Solenikov #define SSCR1_LBM       (1 << 2)
13755bc95aa2SDmitry Eremin-Solenikov #define SSSR_TNF        (1 << 2)
13765bc95aa2SDmitry Eremin-Solenikov #define SSSR_RNE        (1 << 3)
13775bc95aa2SDmitry Eremin-Solenikov #define SSSR_TFS        (1 << 5)
13785bc95aa2SDmitry Eremin-Solenikov #define SSSR_RFS        (1 << 6)
13795bc95aa2SDmitry Eremin-Solenikov #define SSSR_ROR        (1 << 7)
13805bc95aa2SDmitry Eremin-Solenikov #define SSSR_RW         0x0080
13815bc95aa2SDmitry Eremin-Solenikov 
13825bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_int_update(StrongARMSSPState *s)
13835bc95aa2SDmitry Eremin-Solenikov {
13845bc95aa2SDmitry Eremin-Solenikov     int level = 0;
13855bc95aa2SDmitry Eremin-Solenikov 
13865bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_ROR);
13875bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_RFS)  &&  (s->sscr[1] & SSCR1_RIE);
13885bc95aa2SDmitry Eremin-Solenikov     level |= (s->sssr & SSSR_TFS)  &&  (s->sscr[1] & SSCR1_TIE);
13895bc95aa2SDmitry Eremin-Solenikov     qemu_set_irq(s->irq, level);
13905bc95aa2SDmitry Eremin-Solenikov }
13915bc95aa2SDmitry Eremin-Solenikov 
13925bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_fifo_update(StrongARMSSPState *s)
13935bc95aa2SDmitry Eremin-Solenikov {
13945bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TFS;
13955bc95aa2SDmitry Eremin-Solenikov     s->sssr &= ~SSSR_TNF;
13965bc95aa2SDmitry Eremin-Solenikov     if (s->sscr[0] & SSCR0_SSE) {
13975bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level >= 4) {
13985bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RFS;
13995bc95aa2SDmitry Eremin-Solenikov         } else {
14005bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RFS;
14015bc95aa2SDmitry Eremin-Solenikov         }
14025bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level) {
14035bc95aa2SDmitry Eremin-Solenikov             s->sssr |= SSSR_RNE;
14045bc95aa2SDmitry Eremin-Solenikov         } else {
14055bc95aa2SDmitry Eremin-Solenikov             s->sssr &= ~SSSR_RNE;
14065bc95aa2SDmitry Eremin-Solenikov         }
14075bc95aa2SDmitry Eremin-Solenikov         /* TX FIFO is never filled, so it is always in underrun
14085bc95aa2SDmitry Eremin-Solenikov            condition if SSP is enabled */
14095bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TFS;
14105bc95aa2SDmitry Eremin-Solenikov         s->sssr |= SSSR_TNF;
14115bc95aa2SDmitry Eremin-Solenikov     }
14125bc95aa2SDmitry Eremin-Solenikov 
14135bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_int_update(s);
14145bc95aa2SDmitry Eremin-Solenikov }
14155bc95aa2SDmitry Eremin-Solenikov 
1416a8170e5eSAvi Kivity static uint64_t strongarm_ssp_read(void *opaque, hwaddr addr,
1417eb2fefbcSAvi Kivity                                    unsigned size)
14185bc95aa2SDmitry Eremin-Solenikov {
14195bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14205bc95aa2SDmitry Eremin-Solenikov     uint32_t retval;
14215bc95aa2SDmitry Eremin-Solenikov 
14225bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
14235bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
14245bc95aa2SDmitry Eremin-Solenikov         return s->sscr[0];
14255bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
14265bc95aa2SDmitry Eremin-Solenikov         return s->sscr[1];
14275bc95aa2SDmitry Eremin-Solenikov     case SSSR:
14285bc95aa2SDmitry Eremin-Solenikov         return s->sssr;
14295bc95aa2SDmitry Eremin-Solenikov     case SSDR:
14305bc95aa2SDmitry Eremin-Solenikov         if (~s->sscr[0] & SSCR0_SSE) {
14315bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
14325bc95aa2SDmitry Eremin-Solenikov         }
14335bc95aa2SDmitry Eremin-Solenikov         if (s->rx_level < 1) {
14345bc95aa2SDmitry Eremin-Solenikov             printf("%s: SSP Rx Underrun\n", __func__);
14355bc95aa2SDmitry Eremin-Solenikov             return 0xffffffff;
14365bc95aa2SDmitry Eremin-Solenikov         }
14375bc95aa2SDmitry Eremin-Solenikov         s->rx_level--;
14385bc95aa2SDmitry Eremin-Solenikov         retval = s->rx_fifo[s->rx_start++];
14395bc95aa2SDmitry Eremin-Solenikov         s->rx_start &= 0x7;
14405bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14415bc95aa2SDmitry Eremin-Solenikov         return retval;
14425bc95aa2SDmitry Eremin-Solenikov     default:
14435bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
14445bc95aa2SDmitry Eremin-Solenikov         break;
14455bc95aa2SDmitry Eremin-Solenikov     }
14465bc95aa2SDmitry Eremin-Solenikov     return 0;
14475bc95aa2SDmitry Eremin-Solenikov }
14485bc95aa2SDmitry Eremin-Solenikov 
1449a8170e5eSAvi Kivity static void strongarm_ssp_write(void *opaque, hwaddr addr,
1450eb2fefbcSAvi Kivity                                 uint64_t value, unsigned size)
14515bc95aa2SDmitry Eremin-Solenikov {
14525bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
14535bc95aa2SDmitry Eremin-Solenikov 
14545bc95aa2SDmitry Eremin-Solenikov     switch (addr) {
14555bc95aa2SDmitry Eremin-Solenikov     case SSCR0:
14565bc95aa2SDmitry Eremin-Solenikov         s->sscr[0] = value & 0xffbf;
14575bc95aa2SDmitry Eremin-Solenikov         if ((s->sscr[0] & SSCR0_SSE) && SSCR0_DSS(value) < 4) {
14585bc95aa2SDmitry Eremin-Solenikov             printf("%s: Wrong data size: %i bits\n", __func__,
1459eb2fefbcSAvi Kivity                    (int)SSCR0_DSS(value));
14605bc95aa2SDmitry Eremin-Solenikov         }
14615bc95aa2SDmitry Eremin-Solenikov         if (!(value & SSCR0_SSE)) {
14625bc95aa2SDmitry Eremin-Solenikov             s->sssr = 0;
14635bc95aa2SDmitry Eremin-Solenikov             s->rx_level = 0;
14645bc95aa2SDmitry Eremin-Solenikov         }
14655bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14665bc95aa2SDmitry Eremin-Solenikov         break;
14675bc95aa2SDmitry Eremin-Solenikov 
14685bc95aa2SDmitry Eremin-Solenikov     case SSCR1:
14695bc95aa2SDmitry Eremin-Solenikov         s->sscr[1] = value & 0x2f;
14705bc95aa2SDmitry Eremin-Solenikov         if (value & SSCR1_LBM) {
14715bc95aa2SDmitry Eremin-Solenikov             printf("%s: Attempt to use SSP LBM mode\n", __func__);
14725bc95aa2SDmitry Eremin-Solenikov         }
14735bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
14745bc95aa2SDmitry Eremin-Solenikov         break;
14755bc95aa2SDmitry Eremin-Solenikov 
14765bc95aa2SDmitry Eremin-Solenikov     case SSSR:
14775bc95aa2SDmitry Eremin-Solenikov         s->sssr &= ~(value & SSSR_RW);
14785bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_int_update(s);
14795bc95aa2SDmitry Eremin-Solenikov         break;
14805bc95aa2SDmitry Eremin-Solenikov 
14815bc95aa2SDmitry Eremin-Solenikov     case SSDR:
14825bc95aa2SDmitry Eremin-Solenikov         if (SSCR0_UWIRE(s->sscr[0])) {
14835bc95aa2SDmitry Eremin-Solenikov             value &= 0xff;
14845bc95aa2SDmitry Eremin-Solenikov         } else
14855bc95aa2SDmitry Eremin-Solenikov             /* Note how 32bits overflow does no harm here */
14865bc95aa2SDmitry Eremin-Solenikov             value &= (1 << SSCR0_DSS(s->sscr[0])) - 1;
14875bc95aa2SDmitry Eremin-Solenikov 
14885bc95aa2SDmitry Eremin-Solenikov         /* Data goes from here to the Tx FIFO and is shifted out from
14895bc95aa2SDmitry Eremin-Solenikov          * there directly to the slave, no need to buffer it.
14905bc95aa2SDmitry Eremin-Solenikov          */
14915bc95aa2SDmitry Eremin-Solenikov         if (s->sscr[0] & SSCR0_SSE) {
14925bc95aa2SDmitry Eremin-Solenikov             uint32_t readval;
14935bc95aa2SDmitry Eremin-Solenikov             if (s->sscr[1] & SSCR1_LBM) {
14945bc95aa2SDmitry Eremin-Solenikov                 readval = value;
14955bc95aa2SDmitry Eremin-Solenikov             } else {
14965bc95aa2SDmitry Eremin-Solenikov                 readval = ssi_transfer(s->bus, value);
14975bc95aa2SDmitry Eremin-Solenikov             }
14985bc95aa2SDmitry Eremin-Solenikov 
14995bc95aa2SDmitry Eremin-Solenikov             if (s->rx_level < 0x08) {
15005bc95aa2SDmitry Eremin-Solenikov                 s->rx_fifo[(s->rx_start + s->rx_level++) & 0x7] = readval;
15015bc95aa2SDmitry Eremin-Solenikov             } else {
15025bc95aa2SDmitry Eremin-Solenikov                 s->sssr |= SSSR_ROR;
15035bc95aa2SDmitry Eremin-Solenikov             }
15045bc95aa2SDmitry Eremin-Solenikov         }
15055bc95aa2SDmitry Eremin-Solenikov         strongarm_ssp_fifo_update(s);
15065bc95aa2SDmitry Eremin-Solenikov         break;
15075bc95aa2SDmitry Eremin-Solenikov 
15085bc95aa2SDmitry Eremin-Solenikov     default:
15095bc95aa2SDmitry Eremin-Solenikov         printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
15105bc95aa2SDmitry Eremin-Solenikov         break;
15115bc95aa2SDmitry Eremin-Solenikov     }
15125bc95aa2SDmitry Eremin-Solenikov }
15135bc95aa2SDmitry Eremin-Solenikov 
1514eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ssp_ops = {
1515eb2fefbcSAvi Kivity     .read = strongarm_ssp_read,
1516eb2fefbcSAvi Kivity     .write = strongarm_ssp_write,
1517eb2fefbcSAvi Kivity     .endianness = DEVICE_NATIVE_ENDIAN,
15185bc95aa2SDmitry Eremin-Solenikov };
15195bc95aa2SDmitry Eremin-Solenikov 
15205bc95aa2SDmitry Eremin-Solenikov static int strongarm_ssp_post_load(void *opaque, int version_id)
15215bc95aa2SDmitry Eremin-Solenikov {
15225bc95aa2SDmitry Eremin-Solenikov     StrongARMSSPState *s = opaque;
15235bc95aa2SDmitry Eremin-Solenikov 
15245bc95aa2SDmitry Eremin-Solenikov     strongarm_ssp_fifo_update(s);
15255bc95aa2SDmitry Eremin-Solenikov 
15265bc95aa2SDmitry Eremin-Solenikov     return 0;
15275bc95aa2SDmitry Eremin-Solenikov }
15285bc95aa2SDmitry Eremin-Solenikov 
15298934515aSxiaoqiang zhao static void strongarm_ssp_init(Object *obj)
15305bc95aa2SDmitry Eremin-Solenikov {
15318934515aSxiaoqiang zhao     SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
15320ca81872SAndreas Färber     DeviceState *dev = DEVICE(sbd);
15330ca81872SAndreas Färber     StrongARMSSPState *s = STRONGARM_SSP(dev);
15345bc95aa2SDmitry Eremin-Solenikov 
15350ca81872SAndreas Färber     sysbus_init_irq(sbd, &s->irq);
15365bc95aa2SDmitry Eremin-Solenikov 
15378934515aSxiaoqiang zhao     memory_region_init_io(&s->iomem, obj, &strongarm_ssp_ops, s,
153864bde0f3SPaolo Bonzini                           "ssp", 0x1000);
15390ca81872SAndreas Färber     sysbus_init_mmio(sbd, &s->iomem);
15405bc95aa2SDmitry Eremin-Solenikov 
15410ca81872SAndreas Färber     s->bus = ssi_create_bus(dev, "ssi");
15425bc95aa2SDmitry Eremin-Solenikov }
15435bc95aa2SDmitry Eremin-Solenikov 
15445bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_reset(DeviceState *dev)
15455bc95aa2SDmitry Eremin-Solenikov {
15460ca81872SAndreas Färber     StrongARMSSPState *s = STRONGARM_SSP(dev);
15470ca81872SAndreas Färber 
15485bc95aa2SDmitry Eremin-Solenikov     s->sssr = 0x03; /* 3 bit data, SPI, disabled */
15495bc95aa2SDmitry Eremin-Solenikov     s->rx_start = 0;
15505bc95aa2SDmitry Eremin-Solenikov     s->rx_level = 0;
15515bc95aa2SDmitry Eremin-Solenikov }
15525bc95aa2SDmitry Eremin-Solenikov 
15535bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ssp_regs = {
15545bc95aa2SDmitry Eremin-Solenikov     .name = "strongarm-ssp",
15555bc95aa2SDmitry Eremin-Solenikov     .version_id = 0,
15565bc95aa2SDmitry Eremin-Solenikov     .minimum_version_id = 0,
15575bc95aa2SDmitry Eremin-Solenikov     .post_load = strongarm_ssp_post_load,
15585bc95aa2SDmitry Eremin-Solenikov     .fields = (VMStateField[]) {
15595bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(sscr, StrongARMSSPState, 2),
15605bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16(sssr, StrongARMSSPState),
15615bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMSSPState, 8),
15625bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_start, StrongARMSSPState),
15635bc95aa2SDmitry Eremin-Solenikov         VMSTATE_UINT8(rx_level, StrongARMSSPState),
15645bc95aa2SDmitry Eremin-Solenikov         VMSTATE_END_OF_LIST(),
15655bc95aa2SDmitry Eremin-Solenikov     },
15665bc95aa2SDmitry Eremin-Solenikov };
15675bc95aa2SDmitry Eremin-Solenikov 
1568999e12bbSAnthony Liguori static void strongarm_ssp_class_init(ObjectClass *klass, void *data)
1569999e12bbSAnthony Liguori {
157039bffca2SAnthony Liguori     DeviceClass *dc = DEVICE_CLASS(klass);
1571999e12bbSAnthony Liguori 
157239bffca2SAnthony Liguori     dc->desc = "StrongARM SSP controller";
157339bffca2SAnthony Liguori     dc->reset = strongarm_ssp_reset;
157439bffca2SAnthony Liguori     dc->vmsd = &vmstate_strongarm_ssp_regs;
1575999e12bbSAnthony Liguori }
1576999e12bbSAnthony Liguori 
15778c43a6f0SAndreas Färber static const TypeInfo strongarm_ssp_info = {
15780ca81872SAndreas Färber     .name          = TYPE_STRONGARM_SSP,
157939bffca2SAnthony Liguori     .parent        = TYPE_SYS_BUS_DEVICE,
158039bffca2SAnthony Liguori     .instance_size = sizeof(StrongARMSSPState),
15818934515aSxiaoqiang zhao     .instance_init = strongarm_ssp_init,
1582999e12bbSAnthony Liguori     .class_init    = strongarm_ssp_class_init,
15835bc95aa2SDmitry Eremin-Solenikov };
15845bc95aa2SDmitry Eremin-Solenikov 
15855bc95aa2SDmitry Eremin-Solenikov /* Main CPU functions */
1586eb2fefbcSAvi Kivity StrongARMState *sa1110_init(MemoryRegion *sysmem,
1587ba1ba5ccSIgor Mammedov                             unsigned int sdram_size, const char *cpu_type)
15885bc95aa2SDmitry Eremin-Solenikov {
15895bc95aa2SDmitry Eremin-Solenikov     StrongARMState *s;
15905bc95aa2SDmitry Eremin-Solenikov     int i;
15915bc95aa2SDmitry Eremin-Solenikov 
1592b45c03f5SMarkus Armbruster     s = g_new0(StrongARMState, 1);
15935bc95aa2SDmitry Eremin-Solenikov 
1594ba1ba5ccSIgor Mammedov     if (strncmp(cpu_type, "sa1110", 6)) {
15956daf194dSMarkus Armbruster         error_report("Machine requires a SA1110 processor.");
15965bc95aa2SDmitry Eremin-Solenikov         exit(1);
15975bc95aa2SDmitry Eremin-Solenikov     }
15985bc95aa2SDmitry Eremin-Solenikov 
1599ba1ba5ccSIgor Mammedov     s->cpu = ARM_CPU(cpu_create(cpu_type));
16005bc95aa2SDmitry Eremin-Solenikov 
1601c8623c02SDirk Müller     memory_region_allocate_system_memory(&s->sdram, NULL, "strongarm.sdram",
1602c8623c02SDirk Müller                                          sdram_size);
1603eb2fefbcSAvi Kivity     memory_region_add_subregion(sysmem, SA_SDCS0, &s->sdram);
16045bc95aa2SDmitry Eremin-Solenikov 
16055bc95aa2SDmitry Eremin-Solenikov     s->pic = sysbus_create_varargs("strongarm_pic", 0x90050000,
16064f071cf9SPeter Maydell                     qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ),
16074f071cf9SPeter Maydell                     qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_FIQ),
16084f071cf9SPeter Maydell                     NULL);
16095bc95aa2SDmitry Eremin-Solenikov 
16105bc95aa2SDmitry Eremin-Solenikov     sysbus_create_varargs("pxa25x-timer", 0x90000000,
16115bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC0),
16125bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC1),
16135bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC2),
16145bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_OSTC3),
16155bc95aa2SDmitry Eremin-Solenikov                     NULL);
16165bc95aa2SDmitry Eremin-Solenikov 
16174e002105SAndreas Färber     sysbus_create_simple(TYPE_STRONGARM_RTC, 0x90010000,
16185bc95aa2SDmitry Eremin-Solenikov                     qdev_get_gpio_in(s->pic, SA_PIC_RTC_ALARM));
16195bc95aa2SDmitry Eremin-Solenikov 
16205bc95aa2SDmitry Eremin-Solenikov     s->gpio = strongarm_gpio_init(0x90040000, s->pic);
16215bc95aa2SDmitry Eremin-Solenikov 
1622c71e6732SAndreas Färber     s->ppc = sysbus_create_varargs(TYPE_STRONGARM_PPC, 0x90060000, NULL);
16235bc95aa2SDmitry Eremin-Solenikov 
16245bc95aa2SDmitry Eremin-Solenikov     for (i = 0; sa_serial[i].io_base; i++) {
1625fff3af97SAndreas Färber         DeviceState *dev = qdev_create(NULL, TYPE_STRONGARM_UART);
16269bca0edbSPeter Maydell         qdev_prop_set_chr(dev, "chardev", serial_hd(i));
16275bc95aa2SDmitry Eremin-Solenikov         qdev_init_nofail(dev);
16281356b98dSAndreas Färber         sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0,
16295bc95aa2SDmitry Eremin-Solenikov                 sa_serial[i].io_base);
16301356b98dSAndreas Färber         sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0,
16315bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, sa_serial[i].irq));
16325bc95aa2SDmitry Eremin-Solenikov     }
16335bc95aa2SDmitry Eremin-Solenikov 
16340ca81872SAndreas Färber     s->ssp = sysbus_create_varargs(TYPE_STRONGARM_SSP, 0x80070000,
16355bc95aa2SDmitry Eremin-Solenikov                 qdev_get_gpio_in(s->pic, SA_PIC_SSP), NULL);
16365bc95aa2SDmitry Eremin-Solenikov     s->ssp_bus = (SSIBus *)qdev_get_child_bus(s->ssp, "ssi");
16375bc95aa2SDmitry Eremin-Solenikov 
16385bc95aa2SDmitry Eremin-Solenikov     return s;
16395bc95aa2SDmitry Eremin-Solenikov }
16405bc95aa2SDmitry Eremin-Solenikov 
164183f7d43aSAndreas Färber static void strongarm_register_types(void)
16425bc95aa2SDmitry Eremin-Solenikov {
164339bffca2SAnthony Liguori     type_register_static(&strongarm_pic_info);
164439bffca2SAnthony Liguori     type_register_static(&strongarm_rtc_sysbus_info);
164539bffca2SAnthony Liguori     type_register_static(&strongarm_gpio_info);
164639bffca2SAnthony Liguori     type_register_static(&strongarm_ppc_info);
164739bffca2SAnthony Liguori     type_register_static(&strongarm_uart_info);
164839bffca2SAnthony Liguori     type_register_static(&strongarm_ssp_info);
16495bc95aa2SDmitry Eremin-Solenikov }
165083f7d43aSAndreas Färber 
165183f7d43aSAndreas Färber type_init(strongarm_register_types)
1652