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