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" 37dccfcd0eSPaolo Bonzini #include "sysemu/char.h" 389c17d615SPaolo Bonzini #include "sysemu/sysemu.h" 398fd06719SAlistair Francis #include "hw/ssi/ssi.h" 405bc95aa2SDmitry Eremin-Solenikov 415bc95aa2SDmitry Eremin-Solenikov //#define DEBUG 425bc95aa2SDmitry Eremin-Solenikov 435bc95aa2SDmitry Eremin-Solenikov /* 445bc95aa2SDmitry Eremin-Solenikov TODO 455bc95aa2SDmitry Eremin-Solenikov - Implement cp15, c14 ? 465bc95aa2SDmitry Eremin-Solenikov - Implement cp15, c15 !!! (idle used in L) 475bc95aa2SDmitry Eremin-Solenikov - Implement idle mode handling/DIM 485bc95aa2SDmitry Eremin-Solenikov - Implement sleep mode/Wake sources 495bc95aa2SDmitry Eremin-Solenikov - Implement reset control 505bc95aa2SDmitry Eremin-Solenikov - Implement memory control regs 515bc95aa2SDmitry Eremin-Solenikov - PCMCIA handling 525bc95aa2SDmitry Eremin-Solenikov - Maybe support MBGNT/MBREQ 535bc95aa2SDmitry Eremin-Solenikov - DMA channels 545bc95aa2SDmitry Eremin-Solenikov - GPCLK 555bc95aa2SDmitry Eremin-Solenikov - IrDA 565bc95aa2SDmitry Eremin-Solenikov - MCP 575bc95aa2SDmitry Eremin-Solenikov - Enhance UART with modem signals 585bc95aa2SDmitry Eremin-Solenikov */ 595bc95aa2SDmitry Eremin-Solenikov 605bc95aa2SDmitry Eremin-Solenikov #ifdef DEBUG 615bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) printf(format , ## __VA_ARGS__) 625bc95aa2SDmitry Eremin-Solenikov #else 635bc95aa2SDmitry Eremin-Solenikov # define DPRINTF(format, ...) do { } while (0) 645bc95aa2SDmitry Eremin-Solenikov #endif 655bc95aa2SDmitry Eremin-Solenikov 665bc95aa2SDmitry Eremin-Solenikov static struct { 67a8170e5eSAvi Kivity hwaddr io_base; 685bc95aa2SDmitry Eremin-Solenikov int irq; 695bc95aa2SDmitry Eremin-Solenikov } sa_serial[] = { 705bc95aa2SDmitry Eremin-Solenikov { 0x80010000, SA_PIC_UART1 }, 715bc95aa2SDmitry Eremin-Solenikov { 0x80030000, SA_PIC_UART2 }, 725bc95aa2SDmitry Eremin-Solenikov { 0x80050000, SA_PIC_UART3 }, 735bc95aa2SDmitry Eremin-Solenikov { 0, 0 } 745bc95aa2SDmitry Eremin-Solenikov }; 755bc95aa2SDmitry Eremin-Solenikov 765bc95aa2SDmitry Eremin-Solenikov /* Interrupt Controller */ 7774e075f6SAndreas Färber 7874e075f6SAndreas Färber #define TYPE_STRONGARM_PIC "strongarm_pic" 7974e075f6SAndreas Färber #define STRONGARM_PIC(obj) \ 8074e075f6SAndreas Färber OBJECT_CHECK(StrongARMPICState, (obj), TYPE_STRONGARM_PIC) 8174e075f6SAndreas Färber 8274e075f6SAndreas Färber typedef struct StrongARMPICState { 8374e075f6SAndreas Färber SysBusDevice parent_obj; 8474e075f6SAndreas Färber 85eb2fefbcSAvi Kivity MemoryRegion iomem; 865bc95aa2SDmitry Eremin-Solenikov qemu_irq irq; 875bc95aa2SDmitry Eremin-Solenikov qemu_irq fiq; 885bc95aa2SDmitry Eremin-Solenikov 895bc95aa2SDmitry Eremin-Solenikov uint32_t pending; 905bc95aa2SDmitry Eremin-Solenikov uint32_t enabled; 915bc95aa2SDmitry Eremin-Solenikov uint32_t is_fiq; 925bc95aa2SDmitry Eremin-Solenikov uint32_t int_idle; 935bc95aa2SDmitry Eremin-Solenikov } StrongARMPICState; 945bc95aa2SDmitry Eremin-Solenikov 955bc95aa2SDmitry Eremin-Solenikov #define ICIP 0x00 965bc95aa2SDmitry Eremin-Solenikov #define ICMR 0x04 975bc95aa2SDmitry Eremin-Solenikov #define ICLR 0x08 985bc95aa2SDmitry Eremin-Solenikov #define ICFP 0x10 995bc95aa2SDmitry Eremin-Solenikov #define ICPR 0x20 1005bc95aa2SDmitry Eremin-Solenikov #define ICCR 0x0c 1015bc95aa2SDmitry Eremin-Solenikov 1025bc95aa2SDmitry Eremin-Solenikov #define SA_PIC_SRCS 32 1035bc95aa2SDmitry Eremin-Solenikov 1045bc95aa2SDmitry Eremin-Solenikov 1055bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_update(void *opaque) 1065bc95aa2SDmitry Eremin-Solenikov { 1075bc95aa2SDmitry Eremin-Solenikov StrongARMPICState *s = opaque; 1085bc95aa2SDmitry Eremin-Solenikov 1095bc95aa2SDmitry Eremin-Solenikov /* FIXME: reflect DIM */ 1105bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->fiq, s->pending & s->enabled & s->is_fiq); 1115bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->irq, s->pending & s->enabled & ~s->is_fiq); 1125bc95aa2SDmitry Eremin-Solenikov } 1135bc95aa2SDmitry Eremin-Solenikov 1145bc95aa2SDmitry Eremin-Solenikov static void strongarm_pic_set_irq(void *opaque, int irq, int level) 1155bc95aa2SDmitry Eremin-Solenikov { 1165bc95aa2SDmitry Eremin-Solenikov StrongARMPICState *s = opaque; 1175bc95aa2SDmitry Eremin-Solenikov 1185bc95aa2SDmitry Eremin-Solenikov if (level) { 1195bc95aa2SDmitry Eremin-Solenikov s->pending |= 1 << irq; 1205bc95aa2SDmitry Eremin-Solenikov } else { 1215bc95aa2SDmitry Eremin-Solenikov s->pending &= ~(1 << irq); 1225bc95aa2SDmitry Eremin-Solenikov } 1235bc95aa2SDmitry Eremin-Solenikov 1245bc95aa2SDmitry Eremin-Solenikov strongarm_pic_update(s); 1255bc95aa2SDmitry Eremin-Solenikov } 1265bc95aa2SDmitry Eremin-Solenikov 127a8170e5eSAvi Kivity static uint64_t strongarm_pic_mem_read(void *opaque, hwaddr offset, 128eb2fefbcSAvi Kivity unsigned size) 1295bc95aa2SDmitry Eremin-Solenikov { 1305bc95aa2SDmitry Eremin-Solenikov StrongARMPICState *s = opaque; 1315bc95aa2SDmitry Eremin-Solenikov 1325bc95aa2SDmitry Eremin-Solenikov switch (offset) { 1335bc95aa2SDmitry Eremin-Solenikov case ICIP: 1345bc95aa2SDmitry Eremin-Solenikov return s->pending & ~s->is_fiq & s->enabled; 1355bc95aa2SDmitry Eremin-Solenikov case ICMR: 1365bc95aa2SDmitry Eremin-Solenikov return s->enabled; 1375bc95aa2SDmitry Eremin-Solenikov case ICLR: 1385bc95aa2SDmitry Eremin-Solenikov return s->is_fiq; 1395bc95aa2SDmitry Eremin-Solenikov case ICCR: 1405bc95aa2SDmitry Eremin-Solenikov return s->int_idle == 0; 1415bc95aa2SDmitry Eremin-Solenikov case ICFP: 1425bc95aa2SDmitry Eremin-Solenikov return s->pending & s->is_fiq & s->enabled; 1435bc95aa2SDmitry Eremin-Solenikov case ICPR: 1445bc95aa2SDmitry Eremin-Solenikov return s->pending; 1455bc95aa2SDmitry Eremin-Solenikov default: 1465bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n", 1475bc95aa2SDmitry Eremin-Solenikov __func__, offset); 1485bc95aa2SDmitry Eremin-Solenikov return 0; 1495bc95aa2SDmitry Eremin-Solenikov } 1505bc95aa2SDmitry Eremin-Solenikov } 1515bc95aa2SDmitry Eremin-Solenikov 152a8170e5eSAvi Kivity static void strongarm_pic_mem_write(void *opaque, hwaddr offset, 153eb2fefbcSAvi Kivity uint64_t value, unsigned size) 1545bc95aa2SDmitry Eremin-Solenikov { 1555bc95aa2SDmitry Eremin-Solenikov StrongARMPICState *s = opaque; 1565bc95aa2SDmitry Eremin-Solenikov 1575bc95aa2SDmitry Eremin-Solenikov switch (offset) { 1585bc95aa2SDmitry Eremin-Solenikov case ICMR: 1595bc95aa2SDmitry Eremin-Solenikov s->enabled = value; 1605bc95aa2SDmitry Eremin-Solenikov break; 1615bc95aa2SDmitry Eremin-Solenikov case ICLR: 1625bc95aa2SDmitry Eremin-Solenikov s->is_fiq = value; 1635bc95aa2SDmitry Eremin-Solenikov break; 1645bc95aa2SDmitry Eremin-Solenikov case ICCR: 1655bc95aa2SDmitry Eremin-Solenikov s->int_idle = (value & 1) ? 0 : ~0; 1665bc95aa2SDmitry Eremin-Solenikov break; 1675bc95aa2SDmitry Eremin-Solenikov default: 1685bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n", 1695bc95aa2SDmitry Eremin-Solenikov __func__, offset); 1705bc95aa2SDmitry Eremin-Solenikov break; 1715bc95aa2SDmitry Eremin-Solenikov } 1725bc95aa2SDmitry Eremin-Solenikov strongarm_pic_update(s); 1735bc95aa2SDmitry Eremin-Solenikov } 1745bc95aa2SDmitry Eremin-Solenikov 175eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_pic_ops = { 176eb2fefbcSAvi Kivity .read = strongarm_pic_mem_read, 177eb2fefbcSAvi Kivity .write = strongarm_pic_mem_write, 178eb2fefbcSAvi Kivity .endianness = DEVICE_NATIVE_ENDIAN, 1795bc95aa2SDmitry Eremin-Solenikov }; 1805bc95aa2SDmitry Eremin-Solenikov 18174e075f6SAndreas Färber static int strongarm_pic_initfn(SysBusDevice *sbd) 1825bc95aa2SDmitry Eremin-Solenikov { 18374e075f6SAndreas Färber DeviceState *dev = DEVICE(sbd); 18474e075f6SAndreas Färber StrongARMPICState *s = STRONGARM_PIC(dev); 1855bc95aa2SDmitry Eremin-Solenikov 18674e075f6SAndreas Färber qdev_init_gpio_in(dev, strongarm_pic_set_irq, SA_PIC_SRCS); 18764bde0f3SPaolo Bonzini memory_region_init_io(&s->iomem, OBJECT(s), &strongarm_pic_ops, s, 18864bde0f3SPaolo Bonzini "pic", 0x1000); 18974e075f6SAndreas Färber sysbus_init_mmio(sbd, &s->iomem); 19074e075f6SAndreas Färber sysbus_init_irq(sbd, &s->irq); 19174e075f6SAndreas Färber sysbus_init_irq(sbd, &s->fiq); 1925bc95aa2SDmitry Eremin-Solenikov 1935bc95aa2SDmitry Eremin-Solenikov return 0; 1945bc95aa2SDmitry Eremin-Solenikov } 1955bc95aa2SDmitry Eremin-Solenikov 1965bc95aa2SDmitry Eremin-Solenikov static int strongarm_pic_post_load(void *opaque, int version_id) 1975bc95aa2SDmitry Eremin-Solenikov { 1985bc95aa2SDmitry Eremin-Solenikov strongarm_pic_update(opaque); 1995bc95aa2SDmitry Eremin-Solenikov return 0; 2005bc95aa2SDmitry Eremin-Solenikov } 2015bc95aa2SDmitry Eremin-Solenikov 2025bc95aa2SDmitry Eremin-Solenikov static VMStateDescription vmstate_strongarm_pic_regs = { 2035bc95aa2SDmitry Eremin-Solenikov .name = "strongarm_pic", 2045bc95aa2SDmitry Eremin-Solenikov .version_id = 0, 2055bc95aa2SDmitry Eremin-Solenikov .minimum_version_id = 0, 2065bc95aa2SDmitry Eremin-Solenikov .post_load = strongarm_pic_post_load, 2075bc95aa2SDmitry Eremin-Solenikov .fields = (VMStateField[]) { 2085bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(pending, StrongARMPICState), 2095bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(enabled, StrongARMPICState), 2105bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(is_fiq, StrongARMPICState), 2115bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(int_idle, StrongARMPICState), 2125bc95aa2SDmitry Eremin-Solenikov VMSTATE_END_OF_LIST(), 2135bc95aa2SDmitry Eremin-Solenikov }, 2145bc95aa2SDmitry Eremin-Solenikov }; 2155bc95aa2SDmitry Eremin-Solenikov 216999e12bbSAnthony Liguori static void strongarm_pic_class_init(ObjectClass *klass, void *data) 217999e12bbSAnthony Liguori { 21839bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 219999e12bbSAnthony Liguori SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 220999e12bbSAnthony Liguori 221999e12bbSAnthony Liguori k->init = strongarm_pic_initfn; 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), 230999e12bbSAnthony Liguori .class_init = strongarm_pic_class_init, 2315bc95aa2SDmitry Eremin-Solenikov }; 2325bc95aa2SDmitry Eremin-Solenikov 2335bc95aa2SDmitry Eremin-Solenikov /* Real-Time Clock */ 2345bc95aa2SDmitry Eremin-Solenikov #define RTAR 0x00 /* RTC Alarm register */ 2355bc95aa2SDmitry Eremin-Solenikov #define RCNR 0x04 /* RTC Counter register */ 2365bc95aa2SDmitry Eremin-Solenikov #define RTTR 0x08 /* RTC Timer Trim register */ 2375bc95aa2SDmitry Eremin-Solenikov #define RTSR 0x10 /* RTC Status register */ 2385bc95aa2SDmitry Eremin-Solenikov 2395bc95aa2SDmitry Eremin-Solenikov #define RTSR_AL (1 << 0) /* RTC Alarm detected */ 2405bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZ (1 << 1) /* RTC 1Hz detected */ 2415bc95aa2SDmitry Eremin-Solenikov #define RTSR_ALE (1 << 2) /* RTC Alarm enable */ 2425bc95aa2SDmitry Eremin-Solenikov #define RTSR_HZE (1 << 3) /* RTC 1Hz enable */ 2435bc95aa2SDmitry Eremin-Solenikov 2445bc95aa2SDmitry Eremin-Solenikov /* 16 LSB of RTTR are clockdiv for internal trim logic, 2455bc95aa2SDmitry Eremin-Solenikov * trim delete isn't emulated, so 2465bc95aa2SDmitry Eremin-Solenikov * f = 32 768 / (RTTR_trim + 1) */ 2475bc95aa2SDmitry Eremin-Solenikov 2484e002105SAndreas Färber #define TYPE_STRONGARM_RTC "strongarm-rtc" 2494e002105SAndreas Färber #define STRONGARM_RTC(obj) \ 2504e002105SAndreas Färber OBJECT_CHECK(StrongARMRTCState, (obj), TYPE_STRONGARM_RTC) 2514e002105SAndreas Färber 2524e002105SAndreas Färber typedef struct StrongARMRTCState { 2534e002105SAndreas Färber SysBusDevice parent_obj; 2544e002105SAndreas Färber 255eb2fefbcSAvi Kivity MemoryRegion iomem; 2565bc95aa2SDmitry Eremin-Solenikov uint32_t rttr; 2575bc95aa2SDmitry Eremin-Solenikov uint32_t rtsr; 2585bc95aa2SDmitry Eremin-Solenikov uint32_t rtar; 2595bc95aa2SDmitry Eremin-Solenikov uint32_t last_rcnr; 2605bc95aa2SDmitry Eremin-Solenikov int64_t last_hz; 2615bc95aa2SDmitry Eremin-Solenikov QEMUTimer *rtc_alarm; 2625bc95aa2SDmitry Eremin-Solenikov QEMUTimer *rtc_hz; 2635bc95aa2SDmitry Eremin-Solenikov qemu_irq rtc_irq; 2645bc95aa2SDmitry Eremin-Solenikov qemu_irq rtc_hz_irq; 2655bc95aa2SDmitry Eremin-Solenikov } StrongARMRTCState; 2665bc95aa2SDmitry Eremin-Solenikov 2675bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_int_update(StrongARMRTCState *s) 2685bc95aa2SDmitry Eremin-Solenikov { 2695bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->rtc_irq, s->rtsr & RTSR_AL); 2705bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->rtc_hz_irq, s->rtsr & RTSR_HZ); 2715bc95aa2SDmitry Eremin-Solenikov } 2725bc95aa2SDmitry Eremin-Solenikov 2735bc95aa2SDmitry Eremin-Solenikov static void strongarm_rtc_hzupdate(StrongARMRTCState *s) 2745bc95aa2SDmitry Eremin-Solenikov { 275884f17c2SAlex Bligh int64_t rt = qemu_clock_get_ms(rtc_clock); 2765bc95aa2SDmitry Eremin-Solenikov s->last_rcnr += ((rt - s->last_hz) << 15) / 2775bc95aa2SDmitry Eremin-Solenikov (1000 * ((s->rttr & 0xffff) + 1)); 2785bc95aa2SDmitry Eremin-Solenikov s->last_hz = rt; 2795bc95aa2SDmitry Eremin-Solenikov } 2805bc95aa2SDmitry Eremin-Solenikov 2815bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_timer_update(StrongARMRTCState *s) 2825bc95aa2SDmitry Eremin-Solenikov { 2835bc95aa2SDmitry Eremin-Solenikov if ((s->rtsr & RTSR_HZE) && !(s->rtsr & RTSR_HZ)) { 284bc72ad67SAlex Bligh timer_mod(s->rtc_hz, s->last_hz + 1000); 2855bc95aa2SDmitry Eremin-Solenikov } else { 286bc72ad67SAlex Bligh timer_del(s->rtc_hz); 2875bc95aa2SDmitry Eremin-Solenikov } 2885bc95aa2SDmitry Eremin-Solenikov 2895bc95aa2SDmitry Eremin-Solenikov if ((s->rtsr & RTSR_ALE) && !(s->rtsr & RTSR_AL)) { 290bc72ad67SAlex Bligh timer_mod(s->rtc_alarm, s->last_hz + 2915bc95aa2SDmitry Eremin-Solenikov (((s->rtar - s->last_rcnr) * 1000 * 2925bc95aa2SDmitry Eremin-Solenikov ((s->rttr & 0xffff) + 1)) >> 15)); 2935bc95aa2SDmitry Eremin-Solenikov } else { 294bc72ad67SAlex Bligh timer_del(s->rtc_alarm); 2955bc95aa2SDmitry Eremin-Solenikov } 2965bc95aa2SDmitry Eremin-Solenikov } 2975bc95aa2SDmitry Eremin-Solenikov 2985bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_alarm_tick(void *opaque) 2995bc95aa2SDmitry Eremin-Solenikov { 3005bc95aa2SDmitry Eremin-Solenikov StrongARMRTCState *s = opaque; 3015bc95aa2SDmitry Eremin-Solenikov s->rtsr |= RTSR_AL; 3025bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_timer_update(s); 3035bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_int_update(s); 3045bc95aa2SDmitry Eremin-Solenikov } 3055bc95aa2SDmitry Eremin-Solenikov 3065bc95aa2SDmitry Eremin-Solenikov static inline void strongarm_rtc_hz_tick(void *opaque) 3075bc95aa2SDmitry Eremin-Solenikov { 3085bc95aa2SDmitry Eremin-Solenikov StrongARMRTCState *s = opaque; 3095bc95aa2SDmitry Eremin-Solenikov s->rtsr |= RTSR_HZ; 3105bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_timer_update(s); 3115bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_int_update(s); 3125bc95aa2SDmitry Eremin-Solenikov } 3135bc95aa2SDmitry Eremin-Solenikov 314a8170e5eSAvi Kivity static uint64_t strongarm_rtc_read(void *opaque, hwaddr addr, 315eb2fefbcSAvi Kivity unsigned size) 3165bc95aa2SDmitry Eremin-Solenikov { 3175bc95aa2SDmitry Eremin-Solenikov StrongARMRTCState *s = opaque; 3185bc95aa2SDmitry Eremin-Solenikov 3195bc95aa2SDmitry Eremin-Solenikov switch (addr) { 3205bc95aa2SDmitry Eremin-Solenikov case RTTR: 3215bc95aa2SDmitry Eremin-Solenikov return s->rttr; 3225bc95aa2SDmitry Eremin-Solenikov case RTSR: 3235bc95aa2SDmitry Eremin-Solenikov return s->rtsr; 3245bc95aa2SDmitry Eremin-Solenikov case RTAR: 3255bc95aa2SDmitry Eremin-Solenikov return s->rtar; 3265bc95aa2SDmitry Eremin-Solenikov case RCNR: 3275bc95aa2SDmitry Eremin-Solenikov return s->last_rcnr + 328884f17c2SAlex Bligh ((qemu_clock_get_ms(rtc_clock) - s->last_hz) << 15) / 3295bc95aa2SDmitry Eremin-Solenikov (1000 * ((s->rttr & 0xffff) + 1)); 3305bc95aa2SDmitry Eremin-Solenikov default: 3315bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr); 3325bc95aa2SDmitry Eremin-Solenikov return 0; 3335bc95aa2SDmitry Eremin-Solenikov } 3345bc95aa2SDmitry Eremin-Solenikov } 3355bc95aa2SDmitry Eremin-Solenikov 336a8170e5eSAvi Kivity static void strongarm_rtc_write(void *opaque, hwaddr addr, 337eb2fefbcSAvi Kivity uint64_t value, unsigned size) 3385bc95aa2SDmitry Eremin-Solenikov { 3395bc95aa2SDmitry Eremin-Solenikov StrongARMRTCState *s = opaque; 3405bc95aa2SDmitry Eremin-Solenikov uint32_t old_rtsr; 3415bc95aa2SDmitry Eremin-Solenikov 3425bc95aa2SDmitry Eremin-Solenikov switch (addr) { 3435bc95aa2SDmitry Eremin-Solenikov case RTTR: 3445bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_hzupdate(s); 3455bc95aa2SDmitry Eremin-Solenikov s->rttr = value; 3465bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_timer_update(s); 3475bc95aa2SDmitry Eremin-Solenikov break; 3485bc95aa2SDmitry Eremin-Solenikov 3495bc95aa2SDmitry Eremin-Solenikov case RTSR: 3505bc95aa2SDmitry Eremin-Solenikov old_rtsr = s->rtsr; 3515bc95aa2SDmitry Eremin-Solenikov s->rtsr = (value & (RTSR_ALE | RTSR_HZE)) | 3525bc95aa2SDmitry Eremin-Solenikov (s->rtsr & ~(value & (RTSR_AL | RTSR_HZ))); 3535bc95aa2SDmitry Eremin-Solenikov 3545bc95aa2SDmitry Eremin-Solenikov if (s->rtsr != old_rtsr) { 3555bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_timer_update(s); 3565bc95aa2SDmitry Eremin-Solenikov } 3575bc95aa2SDmitry Eremin-Solenikov 3585bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_int_update(s); 3595bc95aa2SDmitry Eremin-Solenikov break; 3605bc95aa2SDmitry Eremin-Solenikov 3615bc95aa2SDmitry Eremin-Solenikov case RTAR: 3625bc95aa2SDmitry Eremin-Solenikov s->rtar = value; 3635bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_timer_update(s); 3645bc95aa2SDmitry Eremin-Solenikov break; 3655bc95aa2SDmitry Eremin-Solenikov 3665bc95aa2SDmitry Eremin-Solenikov case RCNR: 3675bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_hzupdate(s); 3685bc95aa2SDmitry Eremin-Solenikov s->last_rcnr = value; 3695bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_timer_update(s); 3705bc95aa2SDmitry Eremin-Solenikov break; 3715bc95aa2SDmitry Eremin-Solenikov 3725bc95aa2SDmitry Eremin-Solenikov default: 3735bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr); 3745bc95aa2SDmitry Eremin-Solenikov } 3755bc95aa2SDmitry Eremin-Solenikov } 3765bc95aa2SDmitry Eremin-Solenikov 377eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_rtc_ops = { 378eb2fefbcSAvi Kivity .read = strongarm_rtc_read, 379eb2fefbcSAvi Kivity .write = strongarm_rtc_write, 380eb2fefbcSAvi Kivity .endianness = DEVICE_NATIVE_ENDIAN, 3815bc95aa2SDmitry Eremin-Solenikov }; 3825bc95aa2SDmitry Eremin-Solenikov 3835bc95aa2SDmitry Eremin-Solenikov static int strongarm_rtc_init(SysBusDevice *dev) 3845bc95aa2SDmitry Eremin-Solenikov { 3854e002105SAndreas Färber StrongARMRTCState *s = STRONGARM_RTC(dev); 3865bc95aa2SDmitry Eremin-Solenikov struct tm tm; 3875bc95aa2SDmitry Eremin-Solenikov 3885bc95aa2SDmitry Eremin-Solenikov s->rttr = 0x0; 3895bc95aa2SDmitry Eremin-Solenikov s->rtsr = 0; 3905bc95aa2SDmitry Eremin-Solenikov 3915bc95aa2SDmitry Eremin-Solenikov qemu_get_timedate(&tm, 0); 3925bc95aa2SDmitry Eremin-Solenikov 3935bc95aa2SDmitry Eremin-Solenikov s->last_rcnr = (uint32_t) mktimegm(&tm); 394884f17c2SAlex Bligh s->last_hz = qemu_clock_get_ms(rtc_clock); 3955bc95aa2SDmitry Eremin-Solenikov 396884f17c2SAlex Bligh s->rtc_alarm = timer_new_ms(rtc_clock, strongarm_rtc_alarm_tick, s); 397884f17c2SAlex Bligh s->rtc_hz = timer_new_ms(rtc_clock, strongarm_rtc_hz_tick, s); 3985bc95aa2SDmitry Eremin-Solenikov 3995bc95aa2SDmitry Eremin-Solenikov sysbus_init_irq(dev, &s->rtc_irq); 4005bc95aa2SDmitry Eremin-Solenikov sysbus_init_irq(dev, &s->rtc_hz_irq); 4015bc95aa2SDmitry Eremin-Solenikov 40264bde0f3SPaolo Bonzini memory_region_init_io(&s->iomem, OBJECT(s), &strongarm_rtc_ops, s, 40364bde0f3SPaolo Bonzini "rtc", 0x10000); 404750ecd44SAvi Kivity sysbus_init_mmio(dev, &s->iomem); 4055bc95aa2SDmitry Eremin-Solenikov 4065bc95aa2SDmitry Eremin-Solenikov return 0; 4075bc95aa2SDmitry Eremin-Solenikov } 4085bc95aa2SDmitry Eremin-Solenikov 4095bc95aa2SDmitry Eremin-Solenikov static void 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); 4145bc95aa2SDmitry Eremin-Solenikov } 4155bc95aa2SDmitry Eremin-Solenikov 4165bc95aa2SDmitry Eremin-Solenikov static int strongarm_rtc_post_load(void *opaque, int version_id) 4175bc95aa2SDmitry Eremin-Solenikov { 4185bc95aa2SDmitry Eremin-Solenikov StrongARMRTCState *s = opaque; 4195bc95aa2SDmitry Eremin-Solenikov 4205bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_timer_update(s); 4215bc95aa2SDmitry Eremin-Solenikov strongarm_rtc_int_update(s); 4225bc95aa2SDmitry Eremin-Solenikov 4235bc95aa2SDmitry Eremin-Solenikov return 0; 4245bc95aa2SDmitry Eremin-Solenikov } 4255bc95aa2SDmitry Eremin-Solenikov 4265bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_rtc_regs = { 4275bc95aa2SDmitry Eremin-Solenikov .name = "strongarm-rtc", 4285bc95aa2SDmitry Eremin-Solenikov .version_id = 0, 4295bc95aa2SDmitry Eremin-Solenikov .minimum_version_id = 0, 4305bc95aa2SDmitry Eremin-Solenikov .pre_save = strongarm_rtc_pre_save, 4315bc95aa2SDmitry Eremin-Solenikov .post_load = strongarm_rtc_post_load, 4325bc95aa2SDmitry Eremin-Solenikov .fields = (VMStateField[]) { 4335bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(rttr, StrongARMRTCState), 4345bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(rtsr, StrongARMRTCState), 4355bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(rtar, StrongARMRTCState), 4365bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(last_rcnr, StrongARMRTCState), 4375bc95aa2SDmitry Eremin-Solenikov VMSTATE_INT64(last_hz, StrongARMRTCState), 4385bc95aa2SDmitry Eremin-Solenikov VMSTATE_END_OF_LIST(), 4395bc95aa2SDmitry Eremin-Solenikov }, 4405bc95aa2SDmitry Eremin-Solenikov }; 4415bc95aa2SDmitry Eremin-Solenikov 442999e12bbSAnthony Liguori static void strongarm_rtc_sysbus_class_init(ObjectClass *klass, void *data) 443999e12bbSAnthony Liguori { 44439bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 445999e12bbSAnthony Liguori SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 446999e12bbSAnthony Liguori 447999e12bbSAnthony Liguori k->init = strongarm_rtc_init; 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), 456999e12bbSAnthony Liguori .class_init = strongarm_rtc_sysbus_class_init, 4575bc95aa2SDmitry Eremin-Solenikov }; 4585bc95aa2SDmitry Eremin-Solenikov 4595bc95aa2SDmitry Eremin-Solenikov /* GPIO */ 4605bc95aa2SDmitry Eremin-Solenikov #define GPLR 0x00 4615bc95aa2SDmitry Eremin-Solenikov #define GPDR 0x04 4625bc95aa2SDmitry Eremin-Solenikov #define GPSR 0x08 4635bc95aa2SDmitry Eremin-Solenikov #define GPCR 0x0c 4645bc95aa2SDmitry Eremin-Solenikov #define GRER 0x10 4655bc95aa2SDmitry Eremin-Solenikov #define GFER 0x14 4665bc95aa2SDmitry Eremin-Solenikov #define GEDR 0x18 4675bc95aa2SDmitry Eremin-Solenikov #define GAFR 0x1c 4685bc95aa2SDmitry Eremin-Solenikov 469f55beb84SAndreas Färber #define TYPE_STRONGARM_GPIO "strongarm-gpio" 470f55beb84SAndreas Färber #define STRONGARM_GPIO(obj) \ 471f55beb84SAndreas Färber OBJECT_CHECK(StrongARMGPIOInfo, (obj), TYPE_STRONGARM_GPIO) 472f55beb84SAndreas Färber 4735bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMGPIOInfo StrongARMGPIOInfo; 4745bc95aa2SDmitry Eremin-Solenikov struct StrongARMGPIOInfo { 4755bc95aa2SDmitry Eremin-Solenikov SysBusDevice busdev; 476eb2fefbcSAvi Kivity MemoryRegion iomem; 4775bc95aa2SDmitry Eremin-Solenikov qemu_irq handler[28]; 4785bc95aa2SDmitry Eremin-Solenikov qemu_irq irqs[11]; 4795bc95aa2SDmitry Eremin-Solenikov qemu_irq irqX; 4805bc95aa2SDmitry Eremin-Solenikov 4815bc95aa2SDmitry Eremin-Solenikov uint32_t ilevel; 4825bc95aa2SDmitry Eremin-Solenikov uint32_t olevel; 4835bc95aa2SDmitry Eremin-Solenikov uint32_t dir; 4845bc95aa2SDmitry Eremin-Solenikov uint32_t rising; 4855bc95aa2SDmitry Eremin-Solenikov uint32_t falling; 4865bc95aa2SDmitry Eremin-Solenikov uint32_t status; 4875bc95aa2SDmitry Eremin-Solenikov uint32_t gafr; 4885bc95aa2SDmitry Eremin-Solenikov 4895bc95aa2SDmitry Eremin-Solenikov uint32_t prev_level; 4905bc95aa2SDmitry Eremin-Solenikov }; 4915bc95aa2SDmitry Eremin-Solenikov 4925bc95aa2SDmitry Eremin-Solenikov 4935bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_irq_update(StrongARMGPIOInfo *s) 4945bc95aa2SDmitry Eremin-Solenikov { 4955bc95aa2SDmitry Eremin-Solenikov int i; 4965bc95aa2SDmitry Eremin-Solenikov for (i = 0; i < 11; i++) { 4975bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->irqs[i], s->status & (1 << i)); 4985bc95aa2SDmitry Eremin-Solenikov } 4995bc95aa2SDmitry Eremin-Solenikov 5005bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->irqX, (s->status & ~0x7ff)); 5015bc95aa2SDmitry Eremin-Solenikov } 5025bc95aa2SDmitry Eremin-Solenikov 5035bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_set(void *opaque, int line, int level) 5045bc95aa2SDmitry Eremin-Solenikov { 5055bc95aa2SDmitry Eremin-Solenikov StrongARMGPIOInfo *s = opaque; 5065bc95aa2SDmitry Eremin-Solenikov uint32_t mask; 5075bc95aa2SDmitry Eremin-Solenikov 5085bc95aa2SDmitry Eremin-Solenikov mask = 1 << line; 5095bc95aa2SDmitry Eremin-Solenikov 5105bc95aa2SDmitry Eremin-Solenikov if (level) { 5115bc95aa2SDmitry Eremin-Solenikov s->status |= s->rising & mask & 5125bc95aa2SDmitry Eremin-Solenikov ~s->ilevel & ~s->dir; 5135bc95aa2SDmitry Eremin-Solenikov s->ilevel |= mask; 5145bc95aa2SDmitry Eremin-Solenikov } else { 5155bc95aa2SDmitry Eremin-Solenikov s->status |= s->falling & mask & 5165bc95aa2SDmitry Eremin-Solenikov s->ilevel & ~s->dir; 5175bc95aa2SDmitry Eremin-Solenikov s->ilevel &= ~mask; 5185bc95aa2SDmitry Eremin-Solenikov } 5195bc95aa2SDmitry Eremin-Solenikov 5205bc95aa2SDmitry Eremin-Solenikov if (s->status & mask) { 5215bc95aa2SDmitry Eremin-Solenikov strongarm_gpio_irq_update(s); 5225bc95aa2SDmitry Eremin-Solenikov } 5235bc95aa2SDmitry Eremin-Solenikov } 5245bc95aa2SDmitry Eremin-Solenikov 5255bc95aa2SDmitry Eremin-Solenikov static void strongarm_gpio_handler_update(StrongARMGPIOInfo *s) 5265bc95aa2SDmitry Eremin-Solenikov { 5275bc95aa2SDmitry Eremin-Solenikov uint32_t level, diff; 5285bc95aa2SDmitry Eremin-Solenikov int bit; 5295bc95aa2SDmitry Eremin-Solenikov 5305bc95aa2SDmitry Eremin-Solenikov level = s->olevel & s->dir; 5315bc95aa2SDmitry Eremin-Solenikov 5325bc95aa2SDmitry Eremin-Solenikov for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) { 533786a4ea8SStefan Hajnoczi bit = ctz32(diff); 5345bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->handler[bit], (level >> bit) & 1); 5355bc95aa2SDmitry Eremin-Solenikov } 5365bc95aa2SDmitry Eremin-Solenikov 5375bc95aa2SDmitry Eremin-Solenikov s->prev_level = level; 5385bc95aa2SDmitry Eremin-Solenikov } 5395bc95aa2SDmitry Eremin-Solenikov 540a8170e5eSAvi Kivity static uint64_t strongarm_gpio_read(void *opaque, hwaddr offset, 541eb2fefbcSAvi Kivity unsigned size) 5425bc95aa2SDmitry Eremin-Solenikov { 5435bc95aa2SDmitry Eremin-Solenikov StrongARMGPIOInfo *s = opaque; 5445bc95aa2SDmitry Eremin-Solenikov 5455bc95aa2SDmitry Eremin-Solenikov switch (offset) { 5465bc95aa2SDmitry Eremin-Solenikov case GPDR: /* GPIO Pin-Direction registers */ 5475bc95aa2SDmitry Eremin-Solenikov return s->dir; 5485bc95aa2SDmitry Eremin-Solenikov 5495bc95aa2SDmitry Eremin-Solenikov case GPSR: /* GPIO Pin-Output Set registers */ 55092335a0dSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 55192335a0dSPeter Maydell "strongarm GPIO: read from write only register GPSR\n"); 55292335a0dSPeter Maydell return 0; 5535bc95aa2SDmitry Eremin-Solenikov 5545bc95aa2SDmitry Eremin-Solenikov case GPCR: /* GPIO Pin-Output Clear registers */ 55592335a0dSPeter Maydell qemu_log_mask(LOG_GUEST_ERROR, 55692335a0dSPeter Maydell "strongarm GPIO: read from write only register GPCR\n"); 55792335a0dSPeter Maydell return 0; 5585bc95aa2SDmitry Eremin-Solenikov 5595bc95aa2SDmitry Eremin-Solenikov case GRER: /* GPIO Rising-Edge Detect Enable registers */ 5605bc95aa2SDmitry Eremin-Solenikov return s->rising; 5615bc95aa2SDmitry Eremin-Solenikov 5625bc95aa2SDmitry Eremin-Solenikov case GFER: /* GPIO Falling-Edge Detect Enable registers */ 5635bc95aa2SDmitry Eremin-Solenikov return s->falling; 5645bc95aa2SDmitry Eremin-Solenikov 5655bc95aa2SDmitry Eremin-Solenikov case GAFR: /* GPIO Alternate Function registers */ 5665bc95aa2SDmitry Eremin-Solenikov return s->gafr; 5675bc95aa2SDmitry Eremin-Solenikov 5685bc95aa2SDmitry Eremin-Solenikov case GPLR: /* GPIO Pin-Level registers */ 5695bc95aa2SDmitry Eremin-Solenikov return (s->olevel & s->dir) | 5705bc95aa2SDmitry Eremin-Solenikov (s->ilevel & ~s->dir); 5715bc95aa2SDmitry Eremin-Solenikov 5725bc95aa2SDmitry Eremin-Solenikov case GEDR: /* GPIO Edge Detect Status registers */ 5735bc95aa2SDmitry Eremin-Solenikov return s->status; 5745bc95aa2SDmitry Eremin-Solenikov 5755bc95aa2SDmitry Eremin-Solenikov default: 5765bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset); 5775bc95aa2SDmitry Eremin-Solenikov } 5785bc95aa2SDmitry Eremin-Solenikov 5795bc95aa2SDmitry Eremin-Solenikov return 0; 5805bc95aa2SDmitry Eremin-Solenikov } 5815bc95aa2SDmitry Eremin-Solenikov 582a8170e5eSAvi Kivity static void strongarm_gpio_write(void *opaque, hwaddr offset, 583eb2fefbcSAvi Kivity uint64_t value, unsigned size) 5845bc95aa2SDmitry Eremin-Solenikov { 5855bc95aa2SDmitry Eremin-Solenikov StrongARMGPIOInfo *s = opaque; 5865bc95aa2SDmitry Eremin-Solenikov 5875bc95aa2SDmitry Eremin-Solenikov switch (offset) { 5885bc95aa2SDmitry Eremin-Solenikov case GPDR: /* GPIO Pin-Direction registers */ 5895bc95aa2SDmitry Eremin-Solenikov s->dir = value; 5905bc95aa2SDmitry Eremin-Solenikov strongarm_gpio_handler_update(s); 5915bc95aa2SDmitry Eremin-Solenikov break; 5925bc95aa2SDmitry Eremin-Solenikov 5935bc95aa2SDmitry Eremin-Solenikov case GPSR: /* GPIO Pin-Output Set registers */ 5945bc95aa2SDmitry Eremin-Solenikov s->olevel |= value; 5955bc95aa2SDmitry Eremin-Solenikov strongarm_gpio_handler_update(s); 5965bc95aa2SDmitry Eremin-Solenikov break; 5975bc95aa2SDmitry Eremin-Solenikov 5985bc95aa2SDmitry Eremin-Solenikov case GPCR: /* GPIO Pin-Output Clear registers */ 5995bc95aa2SDmitry Eremin-Solenikov s->olevel &= ~value; 6005bc95aa2SDmitry Eremin-Solenikov strongarm_gpio_handler_update(s); 6015bc95aa2SDmitry Eremin-Solenikov break; 6025bc95aa2SDmitry Eremin-Solenikov 6035bc95aa2SDmitry Eremin-Solenikov case GRER: /* GPIO Rising-Edge Detect Enable registers */ 6045bc95aa2SDmitry Eremin-Solenikov s->rising = value; 6055bc95aa2SDmitry Eremin-Solenikov break; 6065bc95aa2SDmitry Eremin-Solenikov 6075bc95aa2SDmitry Eremin-Solenikov case GFER: /* GPIO Falling-Edge Detect Enable registers */ 6085bc95aa2SDmitry Eremin-Solenikov s->falling = value; 6095bc95aa2SDmitry Eremin-Solenikov break; 6105bc95aa2SDmitry Eremin-Solenikov 6115bc95aa2SDmitry Eremin-Solenikov case GAFR: /* GPIO Alternate Function registers */ 6125bc95aa2SDmitry Eremin-Solenikov s->gafr = value; 6135bc95aa2SDmitry Eremin-Solenikov break; 6145bc95aa2SDmitry Eremin-Solenikov 6155bc95aa2SDmitry Eremin-Solenikov case GEDR: /* GPIO Edge Detect Status registers */ 6165bc95aa2SDmitry Eremin-Solenikov s->status &= ~value; 6175bc95aa2SDmitry Eremin-Solenikov strongarm_gpio_irq_update(s); 6185bc95aa2SDmitry Eremin-Solenikov break; 6195bc95aa2SDmitry Eremin-Solenikov 6205bc95aa2SDmitry Eremin-Solenikov default: 6215bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset); 6225bc95aa2SDmitry Eremin-Solenikov } 6235bc95aa2SDmitry Eremin-Solenikov } 6245bc95aa2SDmitry Eremin-Solenikov 625eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_gpio_ops = { 626eb2fefbcSAvi Kivity .read = strongarm_gpio_read, 627eb2fefbcSAvi Kivity .write = strongarm_gpio_write, 628eb2fefbcSAvi Kivity .endianness = DEVICE_NATIVE_ENDIAN, 6295bc95aa2SDmitry Eremin-Solenikov }; 6305bc95aa2SDmitry Eremin-Solenikov 631a8170e5eSAvi Kivity static DeviceState *strongarm_gpio_init(hwaddr base, 6325bc95aa2SDmitry Eremin-Solenikov DeviceState *pic) 6335bc95aa2SDmitry Eremin-Solenikov { 6345bc95aa2SDmitry Eremin-Solenikov DeviceState *dev; 6355bc95aa2SDmitry Eremin-Solenikov int i; 6365bc95aa2SDmitry Eremin-Solenikov 637f55beb84SAndreas Färber dev = qdev_create(NULL, TYPE_STRONGARM_GPIO); 6385bc95aa2SDmitry Eremin-Solenikov qdev_init_nofail(dev); 6395bc95aa2SDmitry Eremin-Solenikov 6401356b98dSAndreas Färber sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, base); 6415bc95aa2SDmitry Eremin-Solenikov for (i = 0; i < 12; i++) 6421356b98dSAndreas Färber sysbus_connect_irq(SYS_BUS_DEVICE(dev), i, 6435bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(pic, SA_PIC_GPIO0_EDGE + i)); 6445bc95aa2SDmitry Eremin-Solenikov 6455bc95aa2SDmitry Eremin-Solenikov return dev; 6465bc95aa2SDmitry Eremin-Solenikov } 6475bc95aa2SDmitry Eremin-Solenikov 648f55beb84SAndreas Färber static int strongarm_gpio_initfn(SysBusDevice *sbd) 6495bc95aa2SDmitry Eremin-Solenikov { 650f55beb84SAndreas Färber DeviceState *dev = DEVICE(sbd); 651f55beb84SAndreas Färber StrongARMGPIOInfo *s = STRONGARM_GPIO(dev); 6525bc95aa2SDmitry Eremin-Solenikov int i; 6535bc95aa2SDmitry Eremin-Solenikov 654f55beb84SAndreas Färber qdev_init_gpio_in(dev, strongarm_gpio_set, 28); 655f55beb84SAndreas Färber qdev_init_gpio_out(dev, s->handler, 28); 6565bc95aa2SDmitry Eremin-Solenikov 65764bde0f3SPaolo Bonzini memory_region_init_io(&s->iomem, OBJECT(s), &strongarm_gpio_ops, s, 65864bde0f3SPaolo Bonzini "gpio", 0x1000); 6595bc95aa2SDmitry Eremin-Solenikov 660f55beb84SAndreas Färber sysbus_init_mmio(sbd, &s->iomem); 6615bc95aa2SDmitry Eremin-Solenikov for (i = 0; i < 11; i++) { 662f55beb84SAndreas Färber sysbus_init_irq(sbd, &s->irqs[i]); 6635bc95aa2SDmitry Eremin-Solenikov } 664f55beb84SAndreas Färber sysbus_init_irq(sbd, &s->irqX); 6655bc95aa2SDmitry Eremin-Solenikov 6665bc95aa2SDmitry Eremin-Solenikov return 0; 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 SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 690999e12bbSAnthony Liguori 691999e12bbSAnthony Liguori k->init = strongarm_gpio_initfn; 69239bffca2SAnthony Liguori dc->desc = "StrongARM GPIO controller"; 693ed657d71SPeter Maydell dc->vmsd = &vmstate_strongarm_gpio_regs; 694999e12bbSAnthony Liguori } 695999e12bbSAnthony Liguori 6968c43a6f0SAndreas Färber static const TypeInfo strongarm_gpio_info = { 697f55beb84SAndreas Färber .name = TYPE_STRONGARM_GPIO, 69839bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 69939bffca2SAnthony Liguori .instance_size = sizeof(StrongARMGPIOInfo), 700999e12bbSAnthony Liguori .class_init = strongarm_gpio_class_init, 7015bc95aa2SDmitry Eremin-Solenikov }; 7025bc95aa2SDmitry Eremin-Solenikov 7035bc95aa2SDmitry Eremin-Solenikov /* Peripheral Pin Controller */ 7045bc95aa2SDmitry Eremin-Solenikov #define PPDR 0x00 7055bc95aa2SDmitry Eremin-Solenikov #define PPSR 0x04 7065bc95aa2SDmitry Eremin-Solenikov #define PPAR 0x08 7075bc95aa2SDmitry Eremin-Solenikov #define PSDR 0x0c 7085bc95aa2SDmitry Eremin-Solenikov #define PPFR 0x10 7095bc95aa2SDmitry Eremin-Solenikov 710c71e6732SAndreas Färber #define TYPE_STRONGARM_PPC "strongarm-ppc" 711c71e6732SAndreas Färber #define STRONGARM_PPC(obj) \ 712c71e6732SAndreas Färber OBJECT_CHECK(StrongARMPPCInfo, (obj), TYPE_STRONGARM_PPC) 713c71e6732SAndreas Färber 7145bc95aa2SDmitry Eremin-Solenikov typedef struct StrongARMPPCInfo StrongARMPPCInfo; 7155bc95aa2SDmitry Eremin-Solenikov struct StrongARMPPCInfo { 716c71e6732SAndreas Färber SysBusDevice parent_obj; 717c71e6732SAndreas Färber 718eb2fefbcSAvi Kivity MemoryRegion iomem; 7195bc95aa2SDmitry Eremin-Solenikov qemu_irq handler[28]; 7205bc95aa2SDmitry Eremin-Solenikov 7215bc95aa2SDmitry Eremin-Solenikov uint32_t ilevel; 7225bc95aa2SDmitry Eremin-Solenikov uint32_t olevel; 7235bc95aa2SDmitry Eremin-Solenikov uint32_t dir; 7245bc95aa2SDmitry Eremin-Solenikov uint32_t ppar; 7255bc95aa2SDmitry Eremin-Solenikov uint32_t psdr; 7265bc95aa2SDmitry Eremin-Solenikov uint32_t ppfr; 7275bc95aa2SDmitry Eremin-Solenikov 7285bc95aa2SDmitry Eremin-Solenikov uint32_t prev_level; 7295bc95aa2SDmitry Eremin-Solenikov }; 7305bc95aa2SDmitry Eremin-Solenikov 7315bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_set(void *opaque, int line, int level) 7325bc95aa2SDmitry Eremin-Solenikov { 7335bc95aa2SDmitry Eremin-Solenikov StrongARMPPCInfo *s = opaque; 7345bc95aa2SDmitry Eremin-Solenikov 7355bc95aa2SDmitry Eremin-Solenikov if (level) { 7365bc95aa2SDmitry Eremin-Solenikov s->ilevel |= 1 << line; 7375bc95aa2SDmitry Eremin-Solenikov } else { 7385bc95aa2SDmitry Eremin-Solenikov s->ilevel &= ~(1 << line); 7395bc95aa2SDmitry Eremin-Solenikov } 7405bc95aa2SDmitry Eremin-Solenikov } 7415bc95aa2SDmitry Eremin-Solenikov 7425bc95aa2SDmitry Eremin-Solenikov static void strongarm_ppc_handler_update(StrongARMPPCInfo *s) 7435bc95aa2SDmitry Eremin-Solenikov { 7445bc95aa2SDmitry Eremin-Solenikov uint32_t level, diff; 7455bc95aa2SDmitry Eremin-Solenikov int bit; 7465bc95aa2SDmitry Eremin-Solenikov 7475bc95aa2SDmitry Eremin-Solenikov level = s->olevel & s->dir; 7485bc95aa2SDmitry Eremin-Solenikov 7495bc95aa2SDmitry Eremin-Solenikov for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) { 750786a4ea8SStefan Hajnoczi bit = ctz32(diff); 7515bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->handler[bit], (level >> bit) & 1); 7525bc95aa2SDmitry Eremin-Solenikov } 7535bc95aa2SDmitry Eremin-Solenikov 7545bc95aa2SDmitry Eremin-Solenikov s->prev_level = level; 7555bc95aa2SDmitry Eremin-Solenikov } 7565bc95aa2SDmitry Eremin-Solenikov 757a8170e5eSAvi Kivity static uint64_t strongarm_ppc_read(void *opaque, hwaddr offset, 758eb2fefbcSAvi Kivity unsigned size) 7595bc95aa2SDmitry Eremin-Solenikov { 7605bc95aa2SDmitry Eremin-Solenikov StrongARMPPCInfo *s = opaque; 7615bc95aa2SDmitry Eremin-Solenikov 7625bc95aa2SDmitry Eremin-Solenikov switch (offset) { 7635bc95aa2SDmitry Eremin-Solenikov case PPDR: /* PPC Pin Direction registers */ 7645bc95aa2SDmitry Eremin-Solenikov return s->dir | ~0x3fffff; 7655bc95aa2SDmitry Eremin-Solenikov 7665bc95aa2SDmitry Eremin-Solenikov case PPSR: /* PPC Pin State registers */ 7675bc95aa2SDmitry Eremin-Solenikov return (s->olevel & s->dir) | 7685bc95aa2SDmitry Eremin-Solenikov (s->ilevel & ~s->dir) | 7695bc95aa2SDmitry Eremin-Solenikov ~0x3fffff; 7705bc95aa2SDmitry Eremin-Solenikov 7715bc95aa2SDmitry Eremin-Solenikov case PPAR: 7725bc95aa2SDmitry Eremin-Solenikov return s->ppar | ~0x41000; 7735bc95aa2SDmitry Eremin-Solenikov 7745bc95aa2SDmitry Eremin-Solenikov case PSDR: 7755bc95aa2SDmitry Eremin-Solenikov return s->psdr; 7765bc95aa2SDmitry Eremin-Solenikov 7775bc95aa2SDmitry Eremin-Solenikov case PPFR: 7785bc95aa2SDmitry Eremin-Solenikov return s->ppfr | ~0x7f001; 7795bc95aa2SDmitry Eremin-Solenikov 7805bc95aa2SDmitry Eremin-Solenikov default: 7815bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset); 7825bc95aa2SDmitry Eremin-Solenikov } 7835bc95aa2SDmitry Eremin-Solenikov 7845bc95aa2SDmitry Eremin-Solenikov return 0; 7855bc95aa2SDmitry Eremin-Solenikov } 7865bc95aa2SDmitry Eremin-Solenikov 787a8170e5eSAvi Kivity static void strongarm_ppc_write(void *opaque, hwaddr offset, 788eb2fefbcSAvi Kivity uint64_t value, unsigned size) 7895bc95aa2SDmitry Eremin-Solenikov { 7905bc95aa2SDmitry Eremin-Solenikov StrongARMPPCInfo *s = opaque; 7915bc95aa2SDmitry Eremin-Solenikov 7925bc95aa2SDmitry Eremin-Solenikov switch (offset) { 7935bc95aa2SDmitry Eremin-Solenikov case PPDR: /* PPC Pin Direction registers */ 7945bc95aa2SDmitry Eremin-Solenikov s->dir = value & 0x3fffff; 7955bc95aa2SDmitry Eremin-Solenikov strongarm_ppc_handler_update(s); 7965bc95aa2SDmitry Eremin-Solenikov break; 7975bc95aa2SDmitry Eremin-Solenikov 7985bc95aa2SDmitry Eremin-Solenikov case PPSR: /* PPC Pin State registers */ 7995bc95aa2SDmitry Eremin-Solenikov s->olevel = value & s->dir & 0x3fffff; 8005bc95aa2SDmitry Eremin-Solenikov strongarm_ppc_handler_update(s); 8015bc95aa2SDmitry Eremin-Solenikov break; 8025bc95aa2SDmitry Eremin-Solenikov 8035bc95aa2SDmitry Eremin-Solenikov case PPAR: 8045bc95aa2SDmitry Eremin-Solenikov s->ppar = value & 0x41000; 8055bc95aa2SDmitry Eremin-Solenikov break; 8065bc95aa2SDmitry Eremin-Solenikov 8075bc95aa2SDmitry Eremin-Solenikov case PSDR: 8085bc95aa2SDmitry Eremin-Solenikov s->psdr = value & 0x3fffff; 8095bc95aa2SDmitry Eremin-Solenikov break; 8105bc95aa2SDmitry Eremin-Solenikov 8115bc95aa2SDmitry Eremin-Solenikov case PPFR: 8125bc95aa2SDmitry Eremin-Solenikov s->ppfr = value & 0x7f001; 8135bc95aa2SDmitry Eremin-Solenikov break; 8145bc95aa2SDmitry Eremin-Solenikov 8155bc95aa2SDmitry Eremin-Solenikov default: 8165bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset); 8175bc95aa2SDmitry Eremin-Solenikov } 8185bc95aa2SDmitry Eremin-Solenikov } 8195bc95aa2SDmitry Eremin-Solenikov 820eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ppc_ops = { 821eb2fefbcSAvi Kivity .read = strongarm_ppc_read, 822eb2fefbcSAvi Kivity .write = strongarm_ppc_write, 823eb2fefbcSAvi Kivity .endianness = DEVICE_NATIVE_ENDIAN, 8245bc95aa2SDmitry Eremin-Solenikov }; 8255bc95aa2SDmitry Eremin-Solenikov 826c71e6732SAndreas Färber static int strongarm_ppc_init(SysBusDevice *sbd) 8275bc95aa2SDmitry Eremin-Solenikov { 828c71e6732SAndreas Färber DeviceState *dev = DEVICE(sbd); 829c71e6732SAndreas Färber StrongARMPPCInfo *s = STRONGARM_PPC(dev); 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 83464bde0f3SPaolo Bonzini memory_region_init_io(&s->iomem, OBJECT(s), &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 return 0; 8405bc95aa2SDmitry Eremin-Solenikov } 8415bc95aa2SDmitry Eremin-Solenikov 8425bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ppc_regs = { 8435bc95aa2SDmitry Eremin-Solenikov .name = "strongarm-ppc", 8445bc95aa2SDmitry Eremin-Solenikov .version_id = 0, 8455bc95aa2SDmitry Eremin-Solenikov .minimum_version_id = 0, 8465bc95aa2SDmitry Eremin-Solenikov .fields = (VMStateField[]) { 8475bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(ilevel, StrongARMPPCInfo), 8485bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(olevel, StrongARMPPCInfo), 8495bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(dir, StrongARMPPCInfo), 8505bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(ppar, StrongARMPPCInfo), 8515bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(psdr, StrongARMPPCInfo), 8525bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT32(ppfr, StrongARMPPCInfo), 853ed657d71SPeter Maydell VMSTATE_UINT32(prev_level, StrongARMPPCInfo), 8545bc95aa2SDmitry Eremin-Solenikov VMSTATE_END_OF_LIST(), 8555bc95aa2SDmitry Eremin-Solenikov }, 8565bc95aa2SDmitry Eremin-Solenikov }; 8575bc95aa2SDmitry Eremin-Solenikov 858999e12bbSAnthony Liguori static void strongarm_ppc_class_init(ObjectClass *klass, void *data) 859999e12bbSAnthony Liguori { 86039bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 861999e12bbSAnthony Liguori SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 862999e12bbSAnthony Liguori 863999e12bbSAnthony Liguori k->init = strongarm_ppc_init; 86439bffca2SAnthony Liguori dc->desc = "StrongARM PPC controller"; 865ed657d71SPeter Maydell dc->vmsd = &vmstate_strongarm_ppc_regs; 866999e12bbSAnthony Liguori } 867999e12bbSAnthony Liguori 8688c43a6f0SAndreas Färber static const TypeInfo strongarm_ppc_info = { 869c71e6732SAndreas Färber .name = TYPE_STRONGARM_PPC, 87039bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 87139bffca2SAnthony Liguori .instance_size = sizeof(StrongARMPPCInfo), 872999e12bbSAnthony Liguori .class_init = strongarm_ppc_class_init, 8735bc95aa2SDmitry Eremin-Solenikov }; 8745bc95aa2SDmitry Eremin-Solenikov 8755bc95aa2SDmitry Eremin-Solenikov /* UART Ports */ 8765bc95aa2SDmitry Eremin-Solenikov #define UTCR0 0x00 8775bc95aa2SDmitry Eremin-Solenikov #define UTCR1 0x04 8785bc95aa2SDmitry Eremin-Solenikov #define UTCR2 0x08 8795bc95aa2SDmitry Eremin-Solenikov #define UTCR3 0x0c 8805bc95aa2SDmitry Eremin-Solenikov #define UTDR 0x14 8815bc95aa2SDmitry Eremin-Solenikov #define UTSR0 0x1c 8825bc95aa2SDmitry Eremin-Solenikov #define UTSR1 0x20 8835bc95aa2SDmitry Eremin-Solenikov 8845bc95aa2SDmitry Eremin-Solenikov #define UTCR0_PE (1 << 0) /* Parity enable */ 8855bc95aa2SDmitry Eremin-Solenikov #define UTCR0_OES (1 << 1) /* Even parity */ 8865bc95aa2SDmitry Eremin-Solenikov #define UTCR0_SBS (1 << 2) /* 2 stop bits */ 8875bc95aa2SDmitry Eremin-Solenikov #define UTCR0_DSS (1 << 3) /* 8-bit data */ 8885bc95aa2SDmitry Eremin-Solenikov 8895bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RXE (1 << 0) /* Rx enable */ 8905bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TXE (1 << 1) /* Tx enable */ 8915bc95aa2SDmitry Eremin-Solenikov #define UTCR3_BRK (1 << 2) /* Force Break */ 8925bc95aa2SDmitry Eremin-Solenikov #define UTCR3_RIE (1 << 3) /* Rx int enable */ 8935bc95aa2SDmitry Eremin-Solenikov #define UTCR3_TIE (1 << 4) /* Tx int enable */ 8945bc95aa2SDmitry Eremin-Solenikov #define UTCR3_LBM (1 << 5) /* Loopback */ 8955bc95aa2SDmitry Eremin-Solenikov 8965bc95aa2SDmitry Eremin-Solenikov #define UTSR0_TFS (1 << 0) /* Tx FIFO nearly empty */ 8975bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RFS (1 << 1) /* Rx FIFO nearly full */ 8985bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RID (1 << 2) /* Receiver Idle */ 8995bc95aa2SDmitry Eremin-Solenikov #define UTSR0_RBB (1 << 3) /* Receiver begin break */ 9005bc95aa2SDmitry Eremin-Solenikov #define UTSR0_REB (1 << 4) /* Receiver end break */ 9015bc95aa2SDmitry Eremin-Solenikov #define UTSR0_EIF (1 << 5) /* Error in FIFO */ 9025bc95aa2SDmitry Eremin-Solenikov 9035bc95aa2SDmitry Eremin-Solenikov #define UTSR1_RNE (1 << 1) /* Receive FIFO not empty */ 9045bc95aa2SDmitry Eremin-Solenikov #define UTSR1_TNF (1 << 2) /* Transmit FIFO not full */ 9055bc95aa2SDmitry Eremin-Solenikov #define UTSR1_PRE (1 << 3) /* Parity error */ 9065bc95aa2SDmitry Eremin-Solenikov #define UTSR1_FRE (1 << 4) /* Frame error */ 9075bc95aa2SDmitry Eremin-Solenikov #define UTSR1_ROR (1 << 5) /* Receive Over Run */ 9085bc95aa2SDmitry Eremin-Solenikov 9095bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_PRE (1 << 8) 9105bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_FRE (1 << 9) 9115bc95aa2SDmitry Eremin-Solenikov #define RX_FIFO_ROR (1 << 10) 9125bc95aa2SDmitry Eremin-Solenikov 913fff3af97SAndreas Färber #define TYPE_STRONGARM_UART "strongarm-uart" 914fff3af97SAndreas Färber #define STRONGARM_UART(obj) \ 915fff3af97SAndreas Färber OBJECT_CHECK(StrongARMUARTState, (obj), TYPE_STRONGARM_UART) 916fff3af97SAndreas Färber 917fff3af97SAndreas Färber typedef struct StrongARMUARTState { 918fff3af97SAndreas Färber SysBusDevice parent_obj; 919fff3af97SAndreas Färber 920eb2fefbcSAvi Kivity MemoryRegion iomem; 9215bc95aa2SDmitry Eremin-Solenikov CharDriverState *chr; 9225bc95aa2SDmitry Eremin-Solenikov qemu_irq irq; 9235bc95aa2SDmitry Eremin-Solenikov 9245bc95aa2SDmitry Eremin-Solenikov uint8_t utcr0; 9255bc95aa2SDmitry Eremin-Solenikov uint16_t brd; 9265bc95aa2SDmitry Eremin-Solenikov uint8_t utcr3; 9275bc95aa2SDmitry Eremin-Solenikov uint8_t utsr0; 9285bc95aa2SDmitry Eremin-Solenikov uint8_t utsr1; 9295bc95aa2SDmitry Eremin-Solenikov 9305bc95aa2SDmitry Eremin-Solenikov uint8_t tx_fifo[8]; 9315bc95aa2SDmitry Eremin-Solenikov uint8_t tx_start; 9325bc95aa2SDmitry Eremin-Solenikov uint8_t tx_len; 9335bc95aa2SDmitry Eremin-Solenikov uint16_t rx_fifo[12]; /* value + error flags in high bits */ 9345bc95aa2SDmitry Eremin-Solenikov uint8_t rx_start; 9355bc95aa2SDmitry Eremin-Solenikov uint8_t rx_len; 9365bc95aa2SDmitry Eremin-Solenikov 9375bc95aa2SDmitry Eremin-Solenikov uint64_t char_transmit_time; /* time to transmit a char in ticks*/ 9385bc95aa2SDmitry Eremin-Solenikov bool wait_break_end; 9395bc95aa2SDmitry Eremin-Solenikov QEMUTimer *rx_timeout_timer; 9405bc95aa2SDmitry Eremin-Solenikov QEMUTimer *tx_timer; 9415bc95aa2SDmitry Eremin-Solenikov } StrongARMUARTState; 9425bc95aa2SDmitry Eremin-Solenikov 9435bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_status(StrongARMUARTState *s) 9445bc95aa2SDmitry Eremin-Solenikov { 9455bc95aa2SDmitry Eremin-Solenikov uint16_t utsr1 = 0; 9465bc95aa2SDmitry Eremin-Solenikov 9475bc95aa2SDmitry Eremin-Solenikov if (s->tx_len != 8) { 9485bc95aa2SDmitry Eremin-Solenikov utsr1 |= UTSR1_TNF; 9495bc95aa2SDmitry Eremin-Solenikov } 9505bc95aa2SDmitry Eremin-Solenikov 9515bc95aa2SDmitry Eremin-Solenikov if (s->rx_len != 0) { 9525bc95aa2SDmitry Eremin-Solenikov uint16_t ent = s->rx_fifo[s->rx_start]; 9535bc95aa2SDmitry Eremin-Solenikov 9545bc95aa2SDmitry Eremin-Solenikov utsr1 |= UTSR1_RNE; 9555bc95aa2SDmitry Eremin-Solenikov if (ent & RX_FIFO_PRE) { 9565bc95aa2SDmitry Eremin-Solenikov s->utsr1 |= UTSR1_PRE; 9575bc95aa2SDmitry Eremin-Solenikov } 9585bc95aa2SDmitry Eremin-Solenikov if (ent & RX_FIFO_FRE) { 9595bc95aa2SDmitry Eremin-Solenikov s->utsr1 |= UTSR1_FRE; 9605bc95aa2SDmitry Eremin-Solenikov } 9615bc95aa2SDmitry Eremin-Solenikov if (ent & RX_FIFO_ROR) { 9625bc95aa2SDmitry Eremin-Solenikov s->utsr1 |= UTSR1_ROR; 9635bc95aa2SDmitry Eremin-Solenikov } 9645bc95aa2SDmitry Eremin-Solenikov } 9655bc95aa2SDmitry Eremin-Solenikov 9665bc95aa2SDmitry Eremin-Solenikov s->utsr1 = utsr1; 9675bc95aa2SDmitry Eremin-Solenikov } 9685bc95aa2SDmitry Eremin-Solenikov 9695bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_int_status(StrongARMUARTState *s) 9705bc95aa2SDmitry Eremin-Solenikov { 9715bc95aa2SDmitry Eremin-Solenikov uint16_t utsr0 = s->utsr0 & 9725bc95aa2SDmitry Eremin-Solenikov (UTSR0_REB | UTSR0_RBB | UTSR0_RID); 9735bc95aa2SDmitry Eremin-Solenikov int i; 9745bc95aa2SDmitry Eremin-Solenikov 9755bc95aa2SDmitry Eremin-Solenikov if ((s->utcr3 & UTCR3_TXE) && 9765bc95aa2SDmitry Eremin-Solenikov (s->utcr3 & UTCR3_TIE) && 9775bc95aa2SDmitry Eremin-Solenikov s->tx_len <= 4) { 9785bc95aa2SDmitry Eremin-Solenikov utsr0 |= UTSR0_TFS; 9795bc95aa2SDmitry Eremin-Solenikov } 9805bc95aa2SDmitry Eremin-Solenikov 9815bc95aa2SDmitry Eremin-Solenikov if ((s->utcr3 & UTCR3_RXE) && 9825bc95aa2SDmitry Eremin-Solenikov (s->utcr3 & UTCR3_RIE) && 9835bc95aa2SDmitry Eremin-Solenikov s->rx_len > 4) { 9845bc95aa2SDmitry Eremin-Solenikov utsr0 |= UTSR0_RFS; 9855bc95aa2SDmitry Eremin-Solenikov } 9865bc95aa2SDmitry Eremin-Solenikov 9875bc95aa2SDmitry Eremin-Solenikov for (i = 0; i < s->rx_len && i < 4; i++) 9885bc95aa2SDmitry Eremin-Solenikov if (s->rx_fifo[(s->rx_start + i) % 12] & ~0xff) { 9895bc95aa2SDmitry Eremin-Solenikov utsr0 |= UTSR0_EIF; 9905bc95aa2SDmitry Eremin-Solenikov break; 9915bc95aa2SDmitry Eremin-Solenikov } 9925bc95aa2SDmitry Eremin-Solenikov 9935bc95aa2SDmitry Eremin-Solenikov s->utsr0 = utsr0; 9945bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->irq, utsr0); 9955bc95aa2SDmitry Eremin-Solenikov } 9965bc95aa2SDmitry Eremin-Solenikov 9975bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_update_parameters(StrongARMUARTState *s) 9985bc95aa2SDmitry Eremin-Solenikov { 9995bc95aa2SDmitry Eremin-Solenikov int speed, parity, data_bits, stop_bits, frame_size; 10005bc95aa2SDmitry Eremin-Solenikov QEMUSerialSetParams ssp; 10015bc95aa2SDmitry Eremin-Solenikov 10025bc95aa2SDmitry Eremin-Solenikov /* Start bit. */ 10035bc95aa2SDmitry Eremin-Solenikov frame_size = 1; 10045bc95aa2SDmitry Eremin-Solenikov if (s->utcr0 & UTCR0_PE) { 10055bc95aa2SDmitry Eremin-Solenikov /* Parity bit. */ 10065bc95aa2SDmitry Eremin-Solenikov frame_size++; 10075bc95aa2SDmitry Eremin-Solenikov if (s->utcr0 & UTCR0_OES) { 10085bc95aa2SDmitry Eremin-Solenikov parity = 'E'; 10095bc95aa2SDmitry Eremin-Solenikov } else { 10105bc95aa2SDmitry Eremin-Solenikov parity = 'O'; 10115bc95aa2SDmitry Eremin-Solenikov } 10125bc95aa2SDmitry Eremin-Solenikov } else { 10135bc95aa2SDmitry Eremin-Solenikov parity = 'N'; 10145bc95aa2SDmitry Eremin-Solenikov } 10155bc95aa2SDmitry Eremin-Solenikov if (s->utcr0 & UTCR0_SBS) { 10165bc95aa2SDmitry Eremin-Solenikov stop_bits = 2; 10175bc95aa2SDmitry Eremin-Solenikov } else { 10185bc95aa2SDmitry Eremin-Solenikov stop_bits = 1; 10195bc95aa2SDmitry Eremin-Solenikov } 10205bc95aa2SDmitry Eremin-Solenikov 10215bc95aa2SDmitry Eremin-Solenikov data_bits = (s->utcr0 & UTCR0_DSS) ? 8 : 7; 10225bc95aa2SDmitry Eremin-Solenikov frame_size += data_bits + stop_bits; 10235bc95aa2SDmitry Eremin-Solenikov speed = 3686400 / 16 / (s->brd + 1); 10245bc95aa2SDmitry Eremin-Solenikov ssp.speed = speed; 10255bc95aa2SDmitry Eremin-Solenikov ssp.parity = parity; 10265bc95aa2SDmitry Eremin-Solenikov ssp.data_bits = data_bits; 10275bc95aa2SDmitry Eremin-Solenikov ssp.stop_bits = stop_bits; 1028*73bcb24dSRutuja Shah s->char_transmit_time = (NANOSECONDS_PER_SECOND / speed) * frame_size; 10295bc95aa2SDmitry Eremin-Solenikov if (s->chr) { 103041084f1bSAnthony Liguori qemu_chr_fe_ioctl(s->chr, CHR_IOCTL_SERIAL_SET_PARAMS, &ssp); 10315bc95aa2SDmitry Eremin-Solenikov } 10325bc95aa2SDmitry Eremin-Solenikov 10335bc95aa2SDmitry Eremin-Solenikov DPRINTF(stderr, "%s speed=%d parity=%c data=%d stop=%d\n", s->chr->label, 10345bc95aa2SDmitry Eremin-Solenikov speed, parity, data_bits, stop_bits); 10355bc95aa2SDmitry Eremin-Solenikov } 10365bc95aa2SDmitry Eremin-Solenikov 10375bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_to(void *opaque) 10385bc95aa2SDmitry Eremin-Solenikov { 10395bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 10405bc95aa2SDmitry Eremin-Solenikov 10415bc95aa2SDmitry Eremin-Solenikov if (s->rx_len) { 10425bc95aa2SDmitry Eremin-Solenikov s->utsr0 |= UTSR0_RID; 10435bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 10445bc95aa2SDmitry Eremin-Solenikov } 10455bc95aa2SDmitry Eremin-Solenikov } 10465bc95aa2SDmitry Eremin-Solenikov 10475bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_rx_push(StrongARMUARTState *s, uint16_t c) 10485bc95aa2SDmitry Eremin-Solenikov { 10495bc95aa2SDmitry Eremin-Solenikov if ((s->utcr3 & UTCR3_RXE) == 0) { 10505bc95aa2SDmitry Eremin-Solenikov /* rx disabled */ 10515bc95aa2SDmitry Eremin-Solenikov return; 10525bc95aa2SDmitry Eremin-Solenikov } 10535bc95aa2SDmitry Eremin-Solenikov 10545bc95aa2SDmitry Eremin-Solenikov if (s->wait_break_end) { 10555bc95aa2SDmitry Eremin-Solenikov s->utsr0 |= UTSR0_REB; 10565bc95aa2SDmitry Eremin-Solenikov s->wait_break_end = false; 10575bc95aa2SDmitry Eremin-Solenikov } 10585bc95aa2SDmitry Eremin-Solenikov 10595bc95aa2SDmitry Eremin-Solenikov if (s->rx_len < 12) { 10605bc95aa2SDmitry Eremin-Solenikov s->rx_fifo[(s->rx_start + s->rx_len) % 12] = c; 10615bc95aa2SDmitry Eremin-Solenikov s->rx_len++; 10625bc95aa2SDmitry Eremin-Solenikov } else 10635bc95aa2SDmitry Eremin-Solenikov s->rx_fifo[(s->rx_start + 11) % 12] |= RX_FIFO_ROR; 10645bc95aa2SDmitry Eremin-Solenikov } 10655bc95aa2SDmitry Eremin-Solenikov 10665bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_can_receive(void *opaque) 10675bc95aa2SDmitry Eremin-Solenikov { 10685bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 10695bc95aa2SDmitry Eremin-Solenikov 10705bc95aa2SDmitry Eremin-Solenikov if (s->rx_len == 12) { 10715bc95aa2SDmitry Eremin-Solenikov return 0; 10725bc95aa2SDmitry Eremin-Solenikov } 10735bc95aa2SDmitry Eremin-Solenikov /* It's best not to get more than 2/3 of RX FIFO, so advertise that much */ 10745bc95aa2SDmitry Eremin-Solenikov if (s->rx_len < 8) { 10755bc95aa2SDmitry Eremin-Solenikov return 8 - s->rx_len; 10765bc95aa2SDmitry Eremin-Solenikov } 10775bc95aa2SDmitry Eremin-Solenikov return 1; 10785bc95aa2SDmitry Eremin-Solenikov } 10795bc95aa2SDmitry Eremin-Solenikov 10805bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_receive(void *opaque, const uint8_t *buf, int size) 10815bc95aa2SDmitry Eremin-Solenikov { 10825bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 10835bc95aa2SDmitry Eremin-Solenikov int i; 10845bc95aa2SDmitry Eremin-Solenikov 10855bc95aa2SDmitry Eremin-Solenikov for (i = 0; i < size; i++) { 10865bc95aa2SDmitry Eremin-Solenikov strongarm_uart_rx_push(s, buf[i]); 10875bc95aa2SDmitry Eremin-Solenikov } 10885bc95aa2SDmitry Eremin-Solenikov 10895bc95aa2SDmitry Eremin-Solenikov /* call the timeout receive callback in 3 char transmit time */ 1090bc72ad67SAlex Bligh timer_mod(s->rx_timeout_timer, 1091bc72ad67SAlex Bligh qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3); 10925bc95aa2SDmitry Eremin-Solenikov 10935bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 10945bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 10955bc95aa2SDmitry Eremin-Solenikov } 10965bc95aa2SDmitry Eremin-Solenikov 10975bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_event(void *opaque, int event) 10985bc95aa2SDmitry Eremin-Solenikov { 10995bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 11005bc95aa2SDmitry Eremin-Solenikov if (event == CHR_EVENT_BREAK) { 11015bc95aa2SDmitry Eremin-Solenikov s->utsr0 |= UTSR0_RBB; 11025bc95aa2SDmitry Eremin-Solenikov strongarm_uart_rx_push(s, RX_FIFO_FRE); 11035bc95aa2SDmitry Eremin-Solenikov s->wait_break_end = true; 11045bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 11055bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 11065bc95aa2SDmitry Eremin-Solenikov } 11075bc95aa2SDmitry Eremin-Solenikov } 11085bc95aa2SDmitry Eremin-Solenikov 11095bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_tx(void *opaque) 11105bc95aa2SDmitry Eremin-Solenikov { 11115bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 1112bc72ad67SAlex Bligh uint64_t new_xmit_ts = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL); 11135bc95aa2SDmitry Eremin-Solenikov 11145bc95aa2SDmitry Eremin-Solenikov if (s->utcr3 & UTCR3_LBM) /* loopback */ { 11155bc95aa2SDmitry Eremin-Solenikov strongarm_uart_receive(s, &s->tx_fifo[s->tx_start], 1); 11165bc95aa2SDmitry Eremin-Solenikov } else if (s->chr) { 11172cc6e0a1SAnthony Liguori qemu_chr_fe_write(s->chr, &s->tx_fifo[s->tx_start], 1); 11185bc95aa2SDmitry Eremin-Solenikov } 11195bc95aa2SDmitry Eremin-Solenikov 11205bc95aa2SDmitry Eremin-Solenikov s->tx_start = (s->tx_start + 1) % 8; 11215bc95aa2SDmitry Eremin-Solenikov s->tx_len--; 11225bc95aa2SDmitry Eremin-Solenikov if (s->tx_len) { 1123bc72ad67SAlex Bligh timer_mod(s->tx_timer, new_xmit_ts + s->char_transmit_time); 11245bc95aa2SDmitry Eremin-Solenikov } 11255bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 11265bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 11275bc95aa2SDmitry Eremin-Solenikov } 11285bc95aa2SDmitry Eremin-Solenikov 1129a8170e5eSAvi Kivity static uint64_t strongarm_uart_read(void *opaque, hwaddr addr, 1130eb2fefbcSAvi Kivity unsigned size) 11315bc95aa2SDmitry Eremin-Solenikov { 11325bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 11335bc95aa2SDmitry Eremin-Solenikov uint16_t ret; 11345bc95aa2SDmitry Eremin-Solenikov 11355bc95aa2SDmitry Eremin-Solenikov switch (addr) { 11365bc95aa2SDmitry Eremin-Solenikov case UTCR0: 11375bc95aa2SDmitry Eremin-Solenikov return s->utcr0; 11385bc95aa2SDmitry Eremin-Solenikov 11395bc95aa2SDmitry Eremin-Solenikov case UTCR1: 11405bc95aa2SDmitry Eremin-Solenikov return s->brd >> 8; 11415bc95aa2SDmitry Eremin-Solenikov 11425bc95aa2SDmitry Eremin-Solenikov case UTCR2: 11435bc95aa2SDmitry Eremin-Solenikov return s->brd & 0xff; 11445bc95aa2SDmitry Eremin-Solenikov 11455bc95aa2SDmitry Eremin-Solenikov case UTCR3: 11465bc95aa2SDmitry Eremin-Solenikov return s->utcr3; 11475bc95aa2SDmitry Eremin-Solenikov 11485bc95aa2SDmitry Eremin-Solenikov case UTDR: 11495bc95aa2SDmitry Eremin-Solenikov if (s->rx_len != 0) { 11505bc95aa2SDmitry Eremin-Solenikov ret = s->rx_fifo[s->rx_start]; 11515bc95aa2SDmitry Eremin-Solenikov s->rx_start = (s->rx_start + 1) % 12; 11525bc95aa2SDmitry Eremin-Solenikov s->rx_len--; 11535bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 11545bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 11555bc95aa2SDmitry Eremin-Solenikov return ret; 11565bc95aa2SDmitry Eremin-Solenikov } 11575bc95aa2SDmitry Eremin-Solenikov return 0; 11585bc95aa2SDmitry Eremin-Solenikov 11595bc95aa2SDmitry Eremin-Solenikov case UTSR0: 11605bc95aa2SDmitry Eremin-Solenikov return s->utsr0; 11615bc95aa2SDmitry Eremin-Solenikov 11625bc95aa2SDmitry Eremin-Solenikov case UTSR1: 11635bc95aa2SDmitry Eremin-Solenikov return s->utsr1; 11645bc95aa2SDmitry Eremin-Solenikov 11655bc95aa2SDmitry Eremin-Solenikov default: 11665bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr); 11675bc95aa2SDmitry Eremin-Solenikov return 0; 11685bc95aa2SDmitry Eremin-Solenikov } 11695bc95aa2SDmitry Eremin-Solenikov } 11705bc95aa2SDmitry Eremin-Solenikov 1171a8170e5eSAvi Kivity static void strongarm_uart_write(void *opaque, hwaddr addr, 1172eb2fefbcSAvi Kivity uint64_t value, unsigned size) 11735bc95aa2SDmitry Eremin-Solenikov { 11745bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 11755bc95aa2SDmitry Eremin-Solenikov 11765bc95aa2SDmitry Eremin-Solenikov switch (addr) { 11775bc95aa2SDmitry Eremin-Solenikov case UTCR0: 11785bc95aa2SDmitry Eremin-Solenikov s->utcr0 = value & 0x7f; 11795bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_parameters(s); 11805bc95aa2SDmitry Eremin-Solenikov break; 11815bc95aa2SDmitry Eremin-Solenikov 11825bc95aa2SDmitry Eremin-Solenikov case UTCR1: 11835bc95aa2SDmitry Eremin-Solenikov s->brd = (s->brd & 0xff) | ((value & 0xf) << 8); 11845bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_parameters(s); 11855bc95aa2SDmitry Eremin-Solenikov break; 11865bc95aa2SDmitry Eremin-Solenikov 11875bc95aa2SDmitry Eremin-Solenikov case UTCR2: 11885bc95aa2SDmitry Eremin-Solenikov s->brd = (s->brd & 0xf00) | (value & 0xff); 11895bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_parameters(s); 11905bc95aa2SDmitry Eremin-Solenikov break; 11915bc95aa2SDmitry Eremin-Solenikov 11925bc95aa2SDmitry Eremin-Solenikov case UTCR3: 11935bc95aa2SDmitry Eremin-Solenikov s->utcr3 = value & 0x3f; 11945bc95aa2SDmitry Eremin-Solenikov if ((s->utcr3 & UTCR3_RXE) == 0) { 11955bc95aa2SDmitry Eremin-Solenikov s->rx_len = 0; 11965bc95aa2SDmitry Eremin-Solenikov } 11975bc95aa2SDmitry Eremin-Solenikov if ((s->utcr3 & UTCR3_TXE) == 0) { 11985bc95aa2SDmitry Eremin-Solenikov s->tx_len = 0; 11995bc95aa2SDmitry Eremin-Solenikov } 12005bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 12015bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 12025bc95aa2SDmitry Eremin-Solenikov break; 12035bc95aa2SDmitry Eremin-Solenikov 12045bc95aa2SDmitry Eremin-Solenikov case UTDR: 12055bc95aa2SDmitry Eremin-Solenikov if ((s->utcr3 & UTCR3_TXE) && s->tx_len != 8) { 12065bc95aa2SDmitry Eremin-Solenikov s->tx_fifo[(s->tx_start + s->tx_len) % 8] = value; 12075bc95aa2SDmitry Eremin-Solenikov s->tx_len++; 12085bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 12095bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 12105bc95aa2SDmitry Eremin-Solenikov if (s->tx_len == 1) { 12115bc95aa2SDmitry Eremin-Solenikov strongarm_uart_tx(s); 12125bc95aa2SDmitry Eremin-Solenikov } 12135bc95aa2SDmitry Eremin-Solenikov } 12145bc95aa2SDmitry Eremin-Solenikov break; 12155bc95aa2SDmitry Eremin-Solenikov 12165bc95aa2SDmitry Eremin-Solenikov case UTSR0: 12175bc95aa2SDmitry Eremin-Solenikov s->utsr0 = s->utsr0 & ~(value & 12185bc95aa2SDmitry Eremin-Solenikov (UTSR0_REB | UTSR0_RBB | UTSR0_RID)); 12195bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 12205bc95aa2SDmitry Eremin-Solenikov break; 12215bc95aa2SDmitry Eremin-Solenikov 12225bc95aa2SDmitry Eremin-Solenikov default: 12235bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr); 12245bc95aa2SDmitry Eremin-Solenikov } 12255bc95aa2SDmitry Eremin-Solenikov } 12265bc95aa2SDmitry Eremin-Solenikov 1227eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_uart_ops = { 1228eb2fefbcSAvi Kivity .read = strongarm_uart_read, 1229eb2fefbcSAvi Kivity .write = strongarm_uart_write, 1230eb2fefbcSAvi Kivity .endianness = DEVICE_NATIVE_ENDIAN, 12315bc95aa2SDmitry Eremin-Solenikov }; 12325bc95aa2SDmitry Eremin-Solenikov 12335bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_init(SysBusDevice *dev) 12345bc95aa2SDmitry Eremin-Solenikov { 1235fff3af97SAndreas Färber StrongARMUARTState *s = STRONGARM_UART(dev); 12365bc95aa2SDmitry Eremin-Solenikov 123764bde0f3SPaolo Bonzini memory_region_init_io(&s->iomem, OBJECT(s), &strongarm_uart_ops, s, 123864bde0f3SPaolo Bonzini "uart", 0x10000); 1239750ecd44SAvi Kivity sysbus_init_mmio(dev, &s->iomem); 12405bc95aa2SDmitry Eremin-Solenikov sysbus_init_irq(dev, &s->irq); 12415bc95aa2SDmitry Eremin-Solenikov 1242bc72ad67SAlex Bligh s->rx_timeout_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_rx_to, s); 1243bc72ad67SAlex Bligh s->tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_tx, s); 12445bc95aa2SDmitry Eremin-Solenikov 12455bc95aa2SDmitry Eremin-Solenikov if (s->chr) { 12465bc95aa2SDmitry Eremin-Solenikov qemu_chr_add_handlers(s->chr, 12475bc95aa2SDmitry Eremin-Solenikov strongarm_uart_can_receive, 12485bc95aa2SDmitry Eremin-Solenikov strongarm_uart_receive, 12495bc95aa2SDmitry Eremin-Solenikov strongarm_uart_event, 12505bc95aa2SDmitry Eremin-Solenikov s); 12515bc95aa2SDmitry Eremin-Solenikov } 12525bc95aa2SDmitry Eremin-Solenikov 12535bc95aa2SDmitry Eremin-Solenikov return 0; 12545bc95aa2SDmitry Eremin-Solenikov } 12555bc95aa2SDmitry Eremin-Solenikov 12565bc95aa2SDmitry Eremin-Solenikov static void strongarm_uart_reset(DeviceState *dev) 12575bc95aa2SDmitry Eremin-Solenikov { 1258fff3af97SAndreas Färber StrongARMUARTState *s = STRONGARM_UART(dev); 12595bc95aa2SDmitry Eremin-Solenikov 12605bc95aa2SDmitry Eremin-Solenikov s->utcr0 = UTCR0_DSS; /* 8 data, no parity */ 12615bc95aa2SDmitry Eremin-Solenikov s->brd = 23; /* 9600 */ 12625bc95aa2SDmitry Eremin-Solenikov /* enable send & recv - this actually violates spec */ 12635bc95aa2SDmitry Eremin-Solenikov s->utcr3 = UTCR3_TXE | UTCR3_RXE; 12645bc95aa2SDmitry Eremin-Solenikov 12655bc95aa2SDmitry Eremin-Solenikov s->rx_len = s->tx_len = 0; 12665bc95aa2SDmitry Eremin-Solenikov 12675bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_parameters(s); 12685bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 12695bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 12705bc95aa2SDmitry Eremin-Solenikov } 12715bc95aa2SDmitry Eremin-Solenikov 12725bc95aa2SDmitry Eremin-Solenikov static int strongarm_uart_post_load(void *opaque, int version_id) 12735bc95aa2SDmitry Eremin-Solenikov { 12745bc95aa2SDmitry Eremin-Solenikov StrongARMUARTState *s = opaque; 12755bc95aa2SDmitry Eremin-Solenikov 12765bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_parameters(s); 12775bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_status(s); 12785bc95aa2SDmitry Eremin-Solenikov strongarm_uart_update_int_status(s); 12795bc95aa2SDmitry Eremin-Solenikov 12805bc95aa2SDmitry Eremin-Solenikov /* tx and restart timer */ 12815bc95aa2SDmitry Eremin-Solenikov if (s->tx_len) { 12825bc95aa2SDmitry Eremin-Solenikov strongarm_uart_tx(s); 12835bc95aa2SDmitry Eremin-Solenikov } 12845bc95aa2SDmitry Eremin-Solenikov 12855bc95aa2SDmitry Eremin-Solenikov /* restart rx timeout timer */ 12865bc95aa2SDmitry Eremin-Solenikov if (s->rx_len) { 1287bc72ad67SAlex Bligh timer_mod(s->rx_timeout_timer, 1288bc72ad67SAlex Bligh qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3); 12895bc95aa2SDmitry Eremin-Solenikov } 12905bc95aa2SDmitry Eremin-Solenikov 12915bc95aa2SDmitry Eremin-Solenikov return 0; 12925bc95aa2SDmitry Eremin-Solenikov } 12935bc95aa2SDmitry Eremin-Solenikov 12945bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_uart_regs = { 12955bc95aa2SDmitry Eremin-Solenikov .name = "strongarm-uart", 12965bc95aa2SDmitry Eremin-Solenikov .version_id = 0, 12975bc95aa2SDmitry Eremin-Solenikov .minimum_version_id = 0, 12985bc95aa2SDmitry Eremin-Solenikov .post_load = strongarm_uart_post_load, 12995bc95aa2SDmitry Eremin-Solenikov .fields = (VMStateField[]) { 13005bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(utcr0, StrongARMUARTState), 13015bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT16(brd, StrongARMUARTState), 13025bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(utcr3, StrongARMUARTState), 13035bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(utsr0, StrongARMUARTState), 13045bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8_ARRAY(tx_fifo, StrongARMUARTState, 8), 13055bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(tx_start, StrongARMUARTState), 13065bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(tx_len, StrongARMUARTState), 13075bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMUARTState, 12), 13085bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(rx_start, StrongARMUARTState), 13095bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(rx_len, StrongARMUARTState), 13105bc95aa2SDmitry Eremin-Solenikov VMSTATE_BOOL(wait_break_end, StrongARMUARTState), 13115bc95aa2SDmitry Eremin-Solenikov VMSTATE_END_OF_LIST(), 13125bc95aa2SDmitry Eremin-Solenikov }, 13135bc95aa2SDmitry Eremin-Solenikov }; 13145bc95aa2SDmitry Eremin-Solenikov 1315999e12bbSAnthony Liguori static Property strongarm_uart_properties[] = { 13165bc95aa2SDmitry Eremin-Solenikov DEFINE_PROP_CHR("chardev", StrongARMUARTState, chr), 13175bc95aa2SDmitry Eremin-Solenikov DEFINE_PROP_END_OF_LIST(), 1318999e12bbSAnthony Liguori }; 1319999e12bbSAnthony Liguori 1320999e12bbSAnthony Liguori static void strongarm_uart_class_init(ObjectClass *klass, void *data) 1321999e12bbSAnthony Liguori { 132239bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 1323999e12bbSAnthony Liguori SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 1324999e12bbSAnthony Liguori 1325999e12bbSAnthony Liguori k->init = strongarm_uart_init; 132639bffca2SAnthony Liguori dc->desc = "StrongARM UART controller"; 132739bffca2SAnthony Liguori dc->reset = strongarm_uart_reset; 132839bffca2SAnthony Liguori dc->vmsd = &vmstate_strongarm_uart_regs; 132939bffca2SAnthony Liguori dc->props = strongarm_uart_properties; 13305bc95aa2SDmitry Eremin-Solenikov } 1331999e12bbSAnthony Liguori 13328c43a6f0SAndreas Färber static const TypeInfo strongarm_uart_info = { 1333fff3af97SAndreas Färber .name = TYPE_STRONGARM_UART, 133439bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 133539bffca2SAnthony Liguori .instance_size = sizeof(StrongARMUARTState), 1336999e12bbSAnthony Liguori .class_init = strongarm_uart_class_init, 13375bc95aa2SDmitry Eremin-Solenikov }; 13385bc95aa2SDmitry Eremin-Solenikov 13395bc95aa2SDmitry Eremin-Solenikov /* Synchronous Serial Ports */ 13400ca81872SAndreas Färber 13410ca81872SAndreas Färber #define TYPE_STRONGARM_SSP "strongarm-ssp" 13420ca81872SAndreas Färber #define STRONGARM_SSP(obj) \ 13430ca81872SAndreas Färber OBJECT_CHECK(StrongARMSSPState, (obj), TYPE_STRONGARM_SSP) 13440ca81872SAndreas Färber 13450ca81872SAndreas Färber typedef struct StrongARMSSPState { 13460ca81872SAndreas Färber SysBusDevice parent_obj; 13470ca81872SAndreas Färber 1348eb2fefbcSAvi Kivity MemoryRegion iomem; 13495bc95aa2SDmitry Eremin-Solenikov qemu_irq irq; 13505bc95aa2SDmitry Eremin-Solenikov SSIBus *bus; 13515bc95aa2SDmitry Eremin-Solenikov 13525bc95aa2SDmitry Eremin-Solenikov uint16_t sscr[2]; 13535bc95aa2SDmitry Eremin-Solenikov uint16_t sssr; 13545bc95aa2SDmitry Eremin-Solenikov 13555bc95aa2SDmitry Eremin-Solenikov uint16_t rx_fifo[8]; 13565bc95aa2SDmitry Eremin-Solenikov uint8_t rx_level; 13575bc95aa2SDmitry Eremin-Solenikov uint8_t rx_start; 13585bc95aa2SDmitry Eremin-Solenikov } StrongARMSSPState; 13595bc95aa2SDmitry Eremin-Solenikov 13605bc95aa2SDmitry Eremin-Solenikov #define SSCR0 0x60 /* SSP Control register 0 */ 13615bc95aa2SDmitry Eremin-Solenikov #define SSCR1 0x64 /* SSP Control register 1 */ 13625bc95aa2SDmitry Eremin-Solenikov #define SSDR 0x6c /* SSP Data register */ 13635bc95aa2SDmitry Eremin-Solenikov #define SSSR 0x74 /* SSP Status register */ 13645bc95aa2SDmitry Eremin-Solenikov 13655bc95aa2SDmitry Eremin-Solenikov /* Bitfields for above registers */ 13665bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SPI(x) (((x) & 0x30) == 0x00) 13675bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSP(x) (((x) & 0x30) == 0x10) 13685bc95aa2SDmitry Eremin-Solenikov #define SSCR0_UWIRE(x) (((x) & 0x30) == 0x20) 13695bc95aa2SDmitry Eremin-Solenikov #define SSCR0_PSP(x) (((x) & 0x30) == 0x30) 13705bc95aa2SDmitry Eremin-Solenikov #define SSCR0_SSE (1 << 7) 13715bc95aa2SDmitry Eremin-Solenikov #define SSCR0_DSS(x) (((x) & 0xf) + 1) 13725bc95aa2SDmitry Eremin-Solenikov #define SSCR1_RIE (1 << 0) 13735bc95aa2SDmitry Eremin-Solenikov #define SSCR1_TIE (1 << 1) 13745bc95aa2SDmitry Eremin-Solenikov #define SSCR1_LBM (1 << 2) 13755bc95aa2SDmitry Eremin-Solenikov #define SSSR_TNF (1 << 2) 13765bc95aa2SDmitry Eremin-Solenikov #define SSSR_RNE (1 << 3) 13775bc95aa2SDmitry Eremin-Solenikov #define SSSR_TFS (1 << 5) 13785bc95aa2SDmitry Eremin-Solenikov #define SSSR_RFS (1 << 6) 13795bc95aa2SDmitry Eremin-Solenikov #define SSSR_ROR (1 << 7) 13805bc95aa2SDmitry Eremin-Solenikov #define SSSR_RW 0x0080 13815bc95aa2SDmitry Eremin-Solenikov 13825bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_int_update(StrongARMSSPState *s) 13835bc95aa2SDmitry Eremin-Solenikov { 13845bc95aa2SDmitry Eremin-Solenikov int level = 0; 13855bc95aa2SDmitry Eremin-Solenikov 13865bc95aa2SDmitry Eremin-Solenikov level |= (s->sssr & SSSR_ROR); 13875bc95aa2SDmitry Eremin-Solenikov level |= (s->sssr & SSSR_RFS) && (s->sscr[1] & SSCR1_RIE); 13885bc95aa2SDmitry Eremin-Solenikov level |= (s->sssr & SSSR_TFS) && (s->sscr[1] & SSCR1_TIE); 13895bc95aa2SDmitry Eremin-Solenikov qemu_set_irq(s->irq, level); 13905bc95aa2SDmitry Eremin-Solenikov } 13915bc95aa2SDmitry Eremin-Solenikov 13925bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_fifo_update(StrongARMSSPState *s) 13935bc95aa2SDmitry Eremin-Solenikov { 13945bc95aa2SDmitry Eremin-Solenikov s->sssr &= ~SSSR_TFS; 13955bc95aa2SDmitry Eremin-Solenikov s->sssr &= ~SSSR_TNF; 13965bc95aa2SDmitry Eremin-Solenikov if (s->sscr[0] & SSCR0_SSE) { 13975bc95aa2SDmitry Eremin-Solenikov if (s->rx_level >= 4) { 13985bc95aa2SDmitry Eremin-Solenikov s->sssr |= SSSR_RFS; 13995bc95aa2SDmitry Eremin-Solenikov } else { 14005bc95aa2SDmitry Eremin-Solenikov s->sssr &= ~SSSR_RFS; 14015bc95aa2SDmitry Eremin-Solenikov } 14025bc95aa2SDmitry Eremin-Solenikov if (s->rx_level) { 14035bc95aa2SDmitry Eremin-Solenikov s->sssr |= SSSR_RNE; 14045bc95aa2SDmitry Eremin-Solenikov } else { 14055bc95aa2SDmitry Eremin-Solenikov s->sssr &= ~SSSR_RNE; 14065bc95aa2SDmitry Eremin-Solenikov } 14075bc95aa2SDmitry Eremin-Solenikov /* TX FIFO is never filled, so it is always in underrun 14085bc95aa2SDmitry Eremin-Solenikov condition if SSP is enabled */ 14095bc95aa2SDmitry Eremin-Solenikov s->sssr |= SSSR_TFS; 14105bc95aa2SDmitry Eremin-Solenikov s->sssr |= SSSR_TNF; 14115bc95aa2SDmitry Eremin-Solenikov } 14125bc95aa2SDmitry Eremin-Solenikov 14135bc95aa2SDmitry Eremin-Solenikov strongarm_ssp_int_update(s); 14145bc95aa2SDmitry Eremin-Solenikov } 14155bc95aa2SDmitry Eremin-Solenikov 1416a8170e5eSAvi Kivity static uint64_t strongarm_ssp_read(void *opaque, hwaddr addr, 1417eb2fefbcSAvi Kivity unsigned size) 14185bc95aa2SDmitry Eremin-Solenikov { 14195bc95aa2SDmitry Eremin-Solenikov StrongARMSSPState *s = opaque; 14205bc95aa2SDmitry Eremin-Solenikov uint32_t retval; 14215bc95aa2SDmitry Eremin-Solenikov 14225bc95aa2SDmitry Eremin-Solenikov switch (addr) { 14235bc95aa2SDmitry Eremin-Solenikov case SSCR0: 14245bc95aa2SDmitry Eremin-Solenikov return s->sscr[0]; 14255bc95aa2SDmitry Eremin-Solenikov case SSCR1: 14265bc95aa2SDmitry Eremin-Solenikov return s->sscr[1]; 14275bc95aa2SDmitry Eremin-Solenikov case SSSR: 14285bc95aa2SDmitry Eremin-Solenikov return s->sssr; 14295bc95aa2SDmitry Eremin-Solenikov case SSDR: 14305bc95aa2SDmitry Eremin-Solenikov if (~s->sscr[0] & SSCR0_SSE) { 14315bc95aa2SDmitry Eremin-Solenikov return 0xffffffff; 14325bc95aa2SDmitry Eremin-Solenikov } 14335bc95aa2SDmitry Eremin-Solenikov if (s->rx_level < 1) { 14345bc95aa2SDmitry Eremin-Solenikov printf("%s: SSP Rx Underrun\n", __func__); 14355bc95aa2SDmitry Eremin-Solenikov return 0xffffffff; 14365bc95aa2SDmitry Eremin-Solenikov } 14375bc95aa2SDmitry Eremin-Solenikov s->rx_level--; 14385bc95aa2SDmitry Eremin-Solenikov retval = s->rx_fifo[s->rx_start++]; 14395bc95aa2SDmitry Eremin-Solenikov s->rx_start &= 0x7; 14405bc95aa2SDmitry Eremin-Solenikov strongarm_ssp_fifo_update(s); 14415bc95aa2SDmitry Eremin-Solenikov return retval; 14425bc95aa2SDmitry Eremin-Solenikov default: 14435bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr); 14445bc95aa2SDmitry Eremin-Solenikov break; 14455bc95aa2SDmitry Eremin-Solenikov } 14465bc95aa2SDmitry Eremin-Solenikov return 0; 14475bc95aa2SDmitry Eremin-Solenikov } 14485bc95aa2SDmitry Eremin-Solenikov 1449a8170e5eSAvi Kivity static void strongarm_ssp_write(void *opaque, hwaddr addr, 1450eb2fefbcSAvi Kivity uint64_t value, unsigned size) 14515bc95aa2SDmitry Eremin-Solenikov { 14525bc95aa2SDmitry Eremin-Solenikov StrongARMSSPState *s = opaque; 14535bc95aa2SDmitry Eremin-Solenikov 14545bc95aa2SDmitry Eremin-Solenikov switch (addr) { 14555bc95aa2SDmitry Eremin-Solenikov case SSCR0: 14565bc95aa2SDmitry Eremin-Solenikov s->sscr[0] = value & 0xffbf; 14575bc95aa2SDmitry Eremin-Solenikov if ((s->sscr[0] & SSCR0_SSE) && SSCR0_DSS(value) < 4) { 14585bc95aa2SDmitry Eremin-Solenikov printf("%s: Wrong data size: %i bits\n", __func__, 1459eb2fefbcSAvi Kivity (int)SSCR0_DSS(value)); 14605bc95aa2SDmitry Eremin-Solenikov } 14615bc95aa2SDmitry Eremin-Solenikov if (!(value & SSCR0_SSE)) { 14625bc95aa2SDmitry Eremin-Solenikov s->sssr = 0; 14635bc95aa2SDmitry Eremin-Solenikov s->rx_level = 0; 14645bc95aa2SDmitry Eremin-Solenikov } 14655bc95aa2SDmitry Eremin-Solenikov strongarm_ssp_fifo_update(s); 14665bc95aa2SDmitry Eremin-Solenikov break; 14675bc95aa2SDmitry Eremin-Solenikov 14685bc95aa2SDmitry Eremin-Solenikov case SSCR1: 14695bc95aa2SDmitry Eremin-Solenikov s->sscr[1] = value & 0x2f; 14705bc95aa2SDmitry Eremin-Solenikov if (value & SSCR1_LBM) { 14715bc95aa2SDmitry Eremin-Solenikov printf("%s: Attempt to use SSP LBM mode\n", __func__); 14725bc95aa2SDmitry Eremin-Solenikov } 14735bc95aa2SDmitry Eremin-Solenikov strongarm_ssp_fifo_update(s); 14745bc95aa2SDmitry Eremin-Solenikov break; 14755bc95aa2SDmitry Eremin-Solenikov 14765bc95aa2SDmitry Eremin-Solenikov case SSSR: 14775bc95aa2SDmitry Eremin-Solenikov s->sssr &= ~(value & SSSR_RW); 14785bc95aa2SDmitry Eremin-Solenikov strongarm_ssp_int_update(s); 14795bc95aa2SDmitry Eremin-Solenikov break; 14805bc95aa2SDmitry Eremin-Solenikov 14815bc95aa2SDmitry Eremin-Solenikov case SSDR: 14825bc95aa2SDmitry Eremin-Solenikov if (SSCR0_UWIRE(s->sscr[0])) { 14835bc95aa2SDmitry Eremin-Solenikov value &= 0xff; 14845bc95aa2SDmitry Eremin-Solenikov } else 14855bc95aa2SDmitry Eremin-Solenikov /* Note how 32bits overflow does no harm here */ 14865bc95aa2SDmitry Eremin-Solenikov value &= (1 << SSCR0_DSS(s->sscr[0])) - 1; 14875bc95aa2SDmitry Eremin-Solenikov 14885bc95aa2SDmitry Eremin-Solenikov /* Data goes from here to the Tx FIFO and is shifted out from 14895bc95aa2SDmitry Eremin-Solenikov * there directly to the slave, no need to buffer it. 14905bc95aa2SDmitry Eremin-Solenikov */ 14915bc95aa2SDmitry Eremin-Solenikov if (s->sscr[0] & SSCR0_SSE) { 14925bc95aa2SDmitry Eremin-Solenikov uint32_t readval; 14935bc95aa2SDmitry Eremin-Solenikov if (s->sscr[1] & SSCR1_LBM) { 14945bc95aa2SDmitry Eremin-Solenikov readval = value; 14955bc95aa2SDmitry Eremin-Solenikov } else { 14965bc95aa2SDmitry Eremin-Solenikov readval = ssi_transfer(s->bus, value); 14975bc95aa2SDmitry Eremin-Solenikov } 14985bc95aa2SDmitry Eremin-Solenikov 14995bc95aa2SDmitry Eremin-Solenikov if (s->rx_level < 0x08) { 15005bc95aa2SDmitry Eremin-Solenikov s->rx_fifo[(s->rx_start + s->rx_level++) & 0x7] = readval; 15015bc95aa2SDmitry Eremin-Solenikov } else { 15025bc95aa2SDmitry Eremin-Solenikov s->sssr |= SSSR_ROR; 15035bc95aa2SDmitry Eremin-Solenikov } 15045bc95aa2SDmitry Eremin-Solenikov } 15055bc95aa2SDmitry Eremin-Solenikov strongarm_ssp_fifo_update(s); 15065bc95aa2SDmitry Eremin-Solenikov break; 15075bc95aa2SDmitry Eremin-Solenikov 15085bc95aa2SDmitry Eremin-Solenikov default: 15095bc95aa2SDmitry Eremin-Solenikov printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr); 15105bc95aa2SDmitry Eremin-Solenikov break; 15115bc95aa2SDmitry Eremin-Solenikov } 15125bc95aa2SDmitry Eremin-Solenikov } 15135bc95aa2SDmitry Eremin-Solenikov 1514eb2fefbcSAvi Kivity static const MemoryRegionOps strongarm_ssp_ops = { 1515eb2fefbcSAvi Kivity .read = strongarm_ssp_read, 1516eb2fefbcSAvi Kivity .write = strongarm_ssp_write, 1517eb2fefbcSAvi Kivity .endianness = DEVICE_NATIVE_ENDIAN, 15185bc95aa2SDmitry Eremin-Solenikov }; 15195bc95aa2SDmitry Eremin-Solenikov 15205bc95aa2SDmitry Eremin-Solenikov static int strongarm_ssp_post_load(void *opaque, int version_id) 15215bc95aa2SDmitry Eremin-Solenikov { 15225bc95aa2SDmitry Eremin-Solenikov StrongARMSSPState *s = opaque; 15235bc95aa2SDmitry Eremin-Solenikov 15245bc95aa2SDmitry Eremin-Solenikov strongarm_ssp_fifo_update(s); 15255bc95aa2SDmitry Eremin-Solenikov 15265bc95aa2SDmitry Eremin-Solenikov return 0; 15275bc95aa2SDmitry Eremin-Solenikov } 15285bc95aa2SDmitry Eremin-Solenikov 15290ca81872SAndreas Färber static int strongarm_ssp_init(SysBusDevice *sbd) 15305bc95aa2SDmitry Eremin-Solenikov { 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 153664bde0f3SPaolo Bonzini memory_region_init_io(&s->iomem, OBJECT(s), &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 return 0; 15425bc95aa2SDmitry Eremin-Solenikov } 15435bc95aa2SDmitry Eremin-Solenikov 15445bc95aa2SDmitry Eremin-Solenikov static void strongarm_ssp_reset(DeviceState *dev) 15455bc95aa2SDmitry Eremin-Solenikov { 15460ca81872SAndreas Färber StrongARMSSPState *s = STRONGARM_SSP(dev); 15470ca81872SAndreas Färber 15485bc95aa2SDmitry Eremin-Solenikov s->sssr = 0x03; /* 3 bit data, SPI, disabled */ 15495bc95aa2SDmitry Eremin-Solenikov s->rx_start = 0; 15505bc95aa2SDmitry Eremin-Solenikov s->rx_level = 0; 15515bc95aa2SDmitry Eremin-Solenikov } 15525bc95aa2SDmitry Eremin-Solenikov 15535bc95aa2SDmitry Eremin-Solenikov static const VMStateDescription vmstate_strongarm_ssp_regs = { 15545bc95aa2SDmitry Eremin-Solenikov .name = "strongarm-ssp", 15555bc95aa2SDmitry Eremin-Solenikov .version_id = 0, 15565bc95aa2SDmitry Eremin-Solenikov .minimum_version_id = 0, 15575bc95aa2SDmitry Eremin-Solenikov .post_load = strongarm_ssp_post_load, 15585bc95aa2SDmitry Eremin-Solenikov .fields = (VMStateField[]) { 15595bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT16_ARRAY(sscr, StrongARMSSPState, 2), 15605bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT16(sssr, StrongARMSSPState), 15615bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMSSPState, 8), 15625bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(rx_start, StrongARMSSPState), 15635bc95aa2SDmitry Eremin-Solenikov VMSTATE_UINT8(rx_level, StrongARMSSPState), 15645bc95aa2SDmitry Eremin-Solenikov VMSTATE_END_OF_LIST(), 15655bc95aa2SDmitry Eremin-Solenikov }, 15665bc95aa2SDmitry Eremin-Solenikov }; 15675bc95aa2SDmitry Eremin-Solenikov 1568999e12bbSAnthony Liguori static void strongarm_ssp_class_init(ObjectClass *klass, void *data) 1569999e12bbSAnthony Liguori { 157039bffca2SAnthony Liguori DeviceClass *dc = DEVICE_CLASS(klass); 1571999e12bbSAnthony Liguori SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass); 1572999e12bbSAnthony Liguori 1573999e12bbSAnthony Liguori k->init = strongarm_ssp_init; 157439bffca2SAnthony Liguori dc->desc = "StrongARM SSP controller"; 157539bffca2SAnthony Liguori dc->reset = strongarm_ssp_reset; 157639bffca2SAnthony Liguori dc->vmsd = &vmstate_strongarm_ssp_regs; 1577999e12bbSAnthony Liguori } 1578999e12bbSAnthony Liguori 15798c43a6f0SAndreas Färber static const TypeInfo strongarm_ssp_info = { 15800ca81872SAndreas Färber .name = TYPE_STRONGARM_SSP, 158139bffca2SAnthony Liguori .parent = TYPE_SYS_BUS_DEVICE, 158239bffca2SAnthony Liguori .instance_size = sizeof(StrongARMSSPState), 1583999e12bbSAnthony Liguori .class_init = strongarm_ssp_class_init, 15845bc95aa2SDmitry Eremin-Solenikov }; 15855bc95aa2SDmitry Eremin-Solenikov 15865bc95aa2SDmitry Eremin-Solenikov /* Main CPU functions */ 1587eb2fefbcSAvi Kivity StrongARMState *sa1110_init(MemoryRegion *sysmem, 1588eb2fefbcSAvi Kivity unsigned int sdram_size, const char *rev) 15895bc95aa2SDmitry Eremin-Solenikov { 15905bc95aa2SDmitry Eremin-Solenikov StrongARMState *s; 15915bc95aa2SDmitry Eremin-Solenikov int i; 15925bc95aa2SDmitry Eremin-Solenikov 1593b45c03f5SMarkus Armbruster s = g_new0(StrongARMState, 1); 15945bc95aa2SDmitry Eremin-Solenikov 15955bc95aa2SDmitry Eremin-Solenikov if (!rev) { 15965bc95aa2SDmitry Eremin-Solenikov rev = "sa1110-b5"; 15975bc95aa2SDmitry Eremin-Solenikov } 15985bc95aa2SDmitry Eremin-Solenikov 15995bc95aa2SDmitry Eremin-Solenikov if (strncmp(rev, "sa1110", 6)) { 16006daf194dSMarkus Armbruster error_report("Machine requires a SA1110 processor."); 16015bc95aa2SDmitry Eremin-Solenikov exit(1); 16025bc95aa2SDmitry Eremin-Solenikov } 16035bc95aa2SDmitry Eremin-Solenikov 16048bf502e2SAndreas Färber s->cpu = cpu_arm_init(rev); 16055bc95aa2SDmitry Eremin-Solenikov 16068bf502e2SAndreas Färber if (!s->cpu) { 16076daf194dSMarkus Armbruster error_report("Unable to find CPU definition"); 16085bc95aa2SDmitry Eremin-Solenikov exit(1); 16095bc95aa2SDmitry Eremin-Solenikov } 16105bc95aa2SDmitry Eremin-Solenikov 1611c8623c02SDirk Müller memory_region_allocate_system_memory(&s->sdram, NULL, "strongarm.sdram", 1612c8623c02SDirk Müller sdram_size); 1613eb2fefbcSAvi Kivity memory_region_add_subregion(sysmem, SA_SDCS0, &s->sdram); 16145bc95aa2SDmitry Eremin-Solenikov 16155bc95aa2SDmitry Eremin-Solenikov s->pic = sysbus_create_varargs("strongarm_pic", 0x90050000, 16164f071cf9SPeter Maydell qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ), 16174f071cf9SPeter Maydell qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_FIQ), 16184f071cf9SPeter Maydell NULL); 16195bc95aa2SDmitry Eremin-Solenikov 16205bc95aa2SDmitry Eremin-Solenikov sysbus_create_varargs("pxa25x-timer", 0x90000000, 16215bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(s->pic, SA_PIC_OSTC0), 16225bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(s->pic, SA_PIC_OSTC1), 16235bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(s->pic, SA_PIC_OSTC2), 16245bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(s->pic, SA_PIC_OSTC3), 16255bc95aa2SDmitry Eremin-Solenikov NULL); 16265bc95aa2SDmitry Eremin-Solenikov 16274e002105SAndreas Färber sysbus_create_simple(TYPE_STRONGARM_RTC, 0x90010000, 16285bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(s->pic, SA_PIC_RTC_ALARM)); 16295bc95aa2SDmitry Eremin-Solenikov 16305bc95aa2SDmitry Eremin-Solenikov s->gpio = strongarm_gpio_init(0x90040000, s->pic); 16315bc95aa2SDmitry Eremin-Solenikov 1632c71e6732SAndreas Färber s->ppc = sysbus_create_varargs(TYPE_STRONGARM_PPC, 0x90060000, NULL); 16335bc95aa2SDmitry Eremin-Solenikov 16345bc95aa2SDmitry Eremin-Solenikov for (i = 0; sa_serial[i].io_base; i++) { 1635fff3af97SAndreas Färber DeviceState *dev = qdev_create(NULL, TYPE_STRONGARM_UART); 16365bc95aa2SDmitry Eremin-Solenikov qdev_prop_set_chr(dev, "chardev", serial_hds[i]); 16375bc95aa2SDmitry Eremin-Solenikov qdev_init_nofail(dev); 16381356b98dSAndreas Färber sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, 16395bc95aa2SDmitry Eremin-Solenikov sa_serial[i].io_base); 16401356b98dSAndreas Färber sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0, 16415bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(s->pic, sa_serial[i].irq)); 16425bc95aa2SDmitry Eremin-Solenikov } 16435bc95aa2SDmitry Eremin-Solenikov 16440ca81872SAndreas Färber s->ssp = sysbus_create_varargs(TYPE_STRONGARM_SSP, 0x80070000, 16455bc95aa2SDmitry Eremin-Solenikov qdev_get_gpio_in(s->pic, SA_PIC_SSP), NULL); 16465bc95aa2SDmitry Eremin-Solenikov s->ssp_bus = (SSIBus *)qdev_get_child_bus(s->ssp, "ssi"); 16475bc95aa2SDmitry Eremin-Solenikov 16485bc95aa2SDmitry Eremin-Solenikov return s; 16495bc95aa2SDmitry Eremin-Solenikov } 16505bc95aa2SDmitry Eremin-Solenikov 165183f7d43aSAndreas Färber static void strongarm_register_types(void) 16525bc95aa2SDmitry Eremin-Solenikov { 165339bffca2SAnthony Liguori type_register_static(&strongarm_pic_info); 165439bffca2SAnthony Liguori type_register_static(&strongarm_rtc_sysbus_info); 165539bffca2SAnthony Liguori type_register_static(&strongarm_gpio_info); 165639bffca2SAnthony Liguori type_register_static(&strongarm_ppc_info); 165739bffca2SAnthony Liguori type_register_static(&strongarm_uart_info); 165839bffca2SAnthony Liguori type_register_static(&strongarm_ssp_info); 16595bc95aa2SDmitry Eremin-Solenikov } 166083f7d43aSAndreas Färber 166183f7d43aSAndreas Färber type_init(strongarm_register_types) 1662