1cc63a182SAnup Patel /* 2b8fb878aSAnup Patel * RISC-V ACLINT (Advanced Core Local Interruptor) 3b8fb878aSAnup Patel * URL: https://github.com/riscv/riscv-aclint 4cc63a182SAnup Patel * 5cc63a182SAnup Patel * Copyright (c) 2016-2017 Sagar Karandikar, sagark@eecs.berkeley.edu 6cc63a182SAnup Patel * Copyright (c) 2017 SiFive, Inc. 7b8fb878aSAnup Patel * Copyright (c) 2021 Western Digital Corporation or its affiliates. 8cc63a182SAnup Patel * 9cc63a182SAnup Patel * This provides real-time clock, timer and interprocessor interrupts. 10cc63a182SAnup Patel * 11cc63a182SAnup Patel * This program is free software; you can redistribute it and/or modify it 12cc63a182SAnup Patel * under the terms and conditions of the GNU General Public License, 13cc63a182SAnup Patel * version 2 or later, as published by the Free Software Foundation. 14cc63a182SAnup Patel * 15cc63a182SAnup Patel * This program is distributed in the hope it will be useful, but WITHOUT 16cc63a182SAnup Patel * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 17cc63a182SAnup Patel * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 18cc63a182SAnup Patel * more details. 19cc63a182SAnup Patel * 20cc63a182SAnup Patel * You should have received a copy of the GNU General Public License along with 21cc63a182SAnup Patel * this program. If not, see <http://www.gnu.org/licenses/>. 22cc63a182SAnup Patel */ 23cc63a182SAnup Patel 24cc63a182SAnup Patel #include "qemu/osdep.h" 25cc63a182SAnup Patel #include "qapi/error.h" 26cc63a182SAnup Patel #include "qemu/error-report.h" 27b8fb878aSAnup Patel #include "qemu/log.h" 28cc63a182SAnup Patel #include "qemu/module.h" 29cc63a182SAnup Patel #include "hw/sysbus.h" 30cc63a182SAnup Patel #include "target/riscv/cpu.h" 31cc63a182SAnup Patel #include "hw/qdev-properties.h" 32cc63a182SAnup Patel #include "hw/intc/riscv_aclint.h" 33cc63a182SAnup Patel #include "qemu/timer.h" 34cc63a182SAnup Patel #include "hw/irq.h" 35cc63a182SAnup Patel 36b8fb878aSAnup Patel typedef struct riscv_aclint_mtimer_callback { 37b8fb878aSAnup Patel RISCVAclintMTimerState *s; 38cc63a182SAnup Patel int num; 39b8fb878aSAnup Patel } riscv_aclint_mtimer_callback; 40cc63a182SAnup Patel 41cc63a182SAnup Patel static uint64_t cpu_riscv_read_rtc(uint32_t timebase_freq) 42cc63a182SAnup Patel { 43cc63a182SAnup Patel return muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), 44cc63a182SAnup Patel timebase_freq, NANOSECONDS_PER_SECOND); 45cc63a182SAnup Patel } 46cc63a182SAnup Patel 47cc63a182SAnup Patel /* 48cc63a182SAnup Patel * Called when timecmp is written to update the QEMU timer or immediately 49cc63a182SAnup Patel * trigger timer interrupt if mtimecmp <= current timer value. 50cc63a182SAnup Patel */ 51b8fb878aSAnup Patel static void riscv_aclint_mtimer_write_timecmp(RISCVAclintMTimerState *mtimer, 52b8fb878aSAnup Patel RISCVCPU *cpu, 53cc63a182SAnup Patel int hartid, 54cc63a182SAnup Patel uint64_t value, 55cc63a182SAnup Patel uint32_t timebase_freq) 56cc63a182SAnup Patel { 57cc63a182SAnup Patel uint64_t next; 58cc63a182SAnup Patel uint64_t diff; 59cc63a182SAnup Patel 60cc63a182SAnup Patel uint64_t rtc_r = cpu_riscv_read_rtc(timebase_freq); 61cc63a182SAnup Patel 62cc63a182SAnup Patel cpu->env.timecmp = value; 63cc63a182SAnup Patel if (cpu->env.timecmp <= rtc_r) { 64b8fb878aSAnup Patel /* 65b8fb878aSAnup Patel * If we're setting an MTIMECMP value in the "past", 66b8fb878aSAnup Patel * immediately raise the timer interrupt 67b8fb878aSAnup Patel */ 68b8fb878aSAnup Patel qemu_irq_raise(mtimer->timer_irqs[hartid - mtimer->hartid_base]); 69cc63a182SAnup Patel return; 70cc63a182SAnup Patel } 71cc63a182SAnup Patel 72cc63a182SAnup Patel /* otherwise, set up the future timer interrupt */ 73b8fb878aSAnup Patel qemu_irq_lower(mtimer->timer_irqs[hartid - mtimer->hartid_base]); 74cc63a182SAnup Patel diff = cpu->env.timecmp - rtc_r; 75cc63a182SAnup Patel /* back to ns (note args switched in muldiv64) */ 76cc63a182SAnup Patel uint64_t ns_diff = muldiv64(diff, NANOSECONDS_PER_SECOND, timebase_freq); 77cc63a182SAnup Patel 78cc63a182SAnup Patel /* 79cc63a182SAnup Patel * check if ns_diff overflowed and check if the addition would potentially 80cc63a182SAnup Patel * overflow 81cc63a182SAnup Patel */ 82cc63a182SAnup Patel if ((NANOSECONDS_PER_SECOND > timebase_freq && ns_diff < diff) || 83cc63a182SAnup Patel ns_diff > INT64_MAX) { 84cc63a182SAnup Patel next = INT64_MAX; 85cc63a182SAnup Patel } else { 86cc63a182SAnup Patel /* 87cc63a182SAnup Patel * as it is very unlikely qemu_clock_get_ns will return a value 88cc63a182SAnup Patel * greater than INT64_MAX, no additional check is needed for an 89cc63a182SAnup Patel * unsigned integer overflow. 90cc63a182SAnup Patel */ 91cc63a182SAnup Patel next = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + ns_diff; 92cc63a182SAnup Patel /* 93cc63a182SAnup Patel * if ns_diff is INT64_MAX next may still be outside the range 94cc63a182SAnup Patel * of a signed integer. 95cc63a182SAnup Patel */ 96cc63a182SAnup Patel next = MIN(next, INT64_MAX); 97cc63a182SAnup Patel } 98cc63a182SAnup Patel 99cc63a182SAnup Patel timer_mod(cpu->env.timer, next); 100cc63a182SAnup Patel } 101cc63a182SAnup Patel 102cc63a182SAnup Patel /* 103cc63a182SAnup Patel * Callback used when the timer set using timer_mod expires. 104cc63a182SAnup Patel * Should raise the timer interrupt line 105cc63a182SAnup Patel */ 106b8fb878aSAnup Patel static void riscv_aclint_mtimer_cb(void *opaque) 107cc63a182SAnup Patel { 108b8fb878aSAnup Patel riscv_aclint_mtimer_callback *state = opaque; 109cc63a182SAnup Patel 110cc63a182SAnup Patel qemu_irq_raise(state->s->timer_irqs[state->num]); 111cc63a182SAnup Patel } 112cc63a182SAnup Patel 113b8fb878aSAnup Patel /* CPU read MTIMER register */ 114b8fb878aSAnup Patel static uint64_t riscv_aclint_mtimer_read(void *opaque, hwaddr addr, 115b8fb878aSAnup Patel unsigned size) 116cc63a182SAnup Patel { 117b8fb878aSAnup Patel RISCVAclintMTimerState *mtimer = opaque; 118b8fb878aSAnup Patel 119b8fb878aSAnup Patel if (addr >= mtimer->timecmp_base && 120b8fb878aSAnup Patel addr < (mtimer->timecmp_base + (mtimer->num_harts << 3))) { 121b8fb878aSAnup Patel size_t hartid = mtimer->hartid_base + 122b8fb878aSAnup Patel ((addr - mtimer->timecmp_base) >> 3); 123cc63a182SAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 124cc63a182SAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 125cc63a182SAnup Patel if (!env) { 126b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 127b8fb878aSAnup Patel "aclint-mtimer: invalid hartid: %zu", hartid); 128cc63a182SAnup Patel } else if ((addr & 0x7) == 0) { 129cc63a182SAnup Patel /* timecmp_lo */ 130cc63a182SAnup Patel uint64_t timecmp = env->timecmp; 131cc63a182SAnup Patel return timecmp & 0xFFFFFFFF; 132cc63a182SAnup Patel } else if ((addr & 0x7) == 4) { 133cc63a182SAnup Patel /* timecmp_hi */ 134cc63a182SAnup Patel uint64_t timecmp = env->timecmp; 135cc63a182SAnup Patel return (timecmp >> 32) & 0xFFFFFFFF; 136cc63a182SAnup Patel } else { 137b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 138b8fb878aSAnup Patel "aclint-mtimer: invalid read: %08x", (uint32_t)addr); 139cc63a182SAnup Patel return 0; 140cc63a182SAnup Patel } 141b8fb878aSAnup Patel } else if (addr == mtimer->time_base) { 142cc63a182SAnup Patel /* time_lo */ 143b8fb878aSAnup Patel return cpu_riscv_read_rtc(mtimer->timebase_freq) & 0xFFFFFFFF; 144b8fb878aSAnup Patel } else if (addr == mtimer->time_base + 4) { 145cc63a182SAnup Patel /* time_hi */ 146b8fb878aSAnup Patel return (cpu_riscv_read_rtc(mtimer->timebase_freq) >> 32) & 0xFFFFFFFF; 147cc63a182SAnup Patel } 148cc63a182SAnup Patel 149b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 150b8fb878aSAnup Patel "aclint-mtimer: invalid read: %08x", (uint32_t)addr); 151cc63a182SAnup Patel return 0; 152cc63a182SAnup Patel } 153cc63a182SAnup Patel 154b8fb878aSAnup Patel /* CPU write MTIMER register */ 155b8fb878aSAnup Patel static void riscv_aclint_mtimer_write(void *opaque, hwaddr addr, 156b8fb878aSAnup Patel uint64_t value, unsigned size) 157cc63a182SAnup Patel { 158b8fb878aSAnup Patel RISCVAclintMTimerState *mtimer = opaque; 159cc63a182SAnup Patel 160b8fb878aSAnup Patel if (addr >= mtimer->timecmp_base && 161b8fb878aSAnup Patel addr < (mtimer->timecmp_base + (mtimer->num_harts << 3))) { 162b8fb878aSAnup Patel size_t hartid = mtimer->hartid_base + 163b8fb878aSAnup Patel ((addr - mtimer->timecmp_base) >> 3); 164cc63a182SAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 165cc63a182SAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 166cc63a182SAnup Patel if (!env) { 167b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 168b8fb878aSAnup Patel "aclint-mtimer: invalid hartid: %zu", hartid); 169cc63a182SAnup Patel } else if ((addr & 0x7) == 0) { 170cc63a182SAnup Patel /* timecmp_lo */ 171cc63a182SAnup Patel uint64_t timecmp_hi = env->timecmp >> 32; 172b8fb878aSAnup Patel riscv_aclint_mtimer_write_timecmp(mtimer, RISCV_CPU(cpu), hartid, 173b8fb878aSAnup Patel timecmp_hi << 32 | (value & 0xFFFFFFFF), 174b8fb878aSAnup Patel mtimer->timebase_freq); 175cc63a182SAnup Patel return; 176cc63a182SAnup Patel } else if ((addr & 0x7) == 4) { 177cc63a182SAnup Patel /* timecmp_hi */ 178cc63a182SAnup Patel uint64_t timecmp_lo = env->timecmp; 179b8fb878aSAnup Patel riscv_aclint_mtimer_write_timecmp(mtimer, RISCV_CPU(cpu), hartid, 180b8fb878aSAnup Patel value << 32 | (timecmp_lo & 0xFFFFFFFF), 181b8fb878aSAnup Patel mtimer->timebase_freq); 182cc63a182SAnup Patel } else { 183b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 184b8fb878aSAnup Patel "aclint-mtimer: invalid timecmp write: %08x", 185b8fb878aSAnup Patel (uint32_t)addr); 186cc63a182SAnup Patel } 187cc63a182SAnup Patel return; 188b8fb878aSAnup Patel } else if (addr == mtimer->time_base) { 189cc63a182SAnup Patel /* time_lo */ 190b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 191b8fb878aSAnup Patel "aclint-mtimer: time_lo write not implemented"); 192cc63a182SAnup Patel return; 193b8fb878aSAnup Patel } else if (addr == mtimer->time_base + 4) { 194cc63a182SAnup Patel /* time_hi */ 195b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 196b8fb878aSAnup Patel "aclint-mtimer: time_hi write not implemented"); 197cc63a182SAnup Patel return; 198cc63a182SAnup Patel } 199cc63a182SAnup Patel 200b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 201b8fb878aSAnup Patel "aclint-mtimer: invalid write: %08x", (uint32_t)addr); 202cc63a182SAnup Patel } 203cc63a182SAnup Patel 204b8fb878aSAnup Patel static const MemoryRegionOps riscv_aclint_mtimer_ops = { 205b8fb878aSAnup Patel .read = riscv_aclint_mtimer_read, 206b8fb878aSAnup Patel .write = riscv_aclint_mtimer_write, 207cc63a182SAnup Patel .endianness = DEVICE_LITTLE_ENDIAN, 208cc63a182SAnup Patel .valid = { 209cc63a182SAnup Patel .min_access_size = 4, 210cc63a182SAnup Patel .max_access_size = 8 211cc63a182SAnup Patel } 212cc63a182SAnup Patel }; 213cc63a182SAnup Patel 214b8fb878aSAnup Patel static Property riscv_aclint_mtimer_properties[] = { 215b8fb878aSAnup Patel DEFINE_PROP_UINT32("hartid-base", RISCVAclintMTimerState, 216b8fb878aSAnup Patel hartid_base, 0), 217b8fb878aSAnup Patel DEFINE_PROP_UINT32("num-harts", RISCVAclintMTimerState, num_harts, 1), 218b8fb878aSAnup Patel DEFINE_PROP_UINT32("timecmp-base", RISCVAclintMTimerState, 219b8fb878aSAnup Patel timecmp_base, RISCV_ACLINT_DEFAULT_MTIMECMP), 220b8fb878aSAnup Patel DEFINE_PROP_UINT32("time-base", RISCVAclintMTimerState, 221b8fb878aSAnup Patel time_base, RISCV_ACLINT_DEFAULT_MTIME), 222b8fb878aSAnup Patel DEFINE_PROP_UINT32("aperture-size", RISCVAclintMTimerState, 223b8fb878aSAnup Patel aperture_size, RISCV_ACLINT_DEFAULT_MTIMER_SIZE), 224b8fb878aSAnup Patel DEFINE_PROP_UINT32("timebase-freq", RISCVAclintMTimerState, 225b8fb878aSAnup Patel timebase_freq, 0), 226cc63a182SAnup Patel DEFINE_PROP_END_OF_LIST(), 227cc63a182SAnup Patel }; 228cc63a182SAnup Patel 229b8fb878aSAnup Patel static void riscv_aclint_mtimer_realize(DeviceState *dev, Error **errp) 230cc63a182SAnup Patel { 231b8fb878aSAnup Patel RISCVAclintMTimerState *s = RISCV_ACLINT_MTIMER(dev); 232b8fb878aSAnup Patel int i; 233b8fb878aSAnup Patel 234b8fb878aSAnup Patel memory_region_init_io(&s->mmio, OBJECT(dev), &riscv_aclint_mtimer_ops, 235b8fb878aSAnup Patel s, TYPE_RISCV_ACLINT_MTIMER, s->aperture_size); 236cc63a182SAnup Patel sysbus_init_mmio(SYS_BUS_DEVICE(dev), &s->mmio); 237cc63a182SAnup Patel 238*b21e2380SMarkus Armbruster s->timer_irqs = g_new(qemu_irq, s->num_harts); 239cc63a182SAnup Patel qdev_init_gpio_out(dev, s->timer_irqs, s->num_harts); 240cc63a182SAnup Patel 241b8fb878aSAnup Patel /* Claim timer interrupt bits */ 242b8fb878aSAnup Patel for (i = 0; i < s->num_harts; i++) { 243b8fb878aSAnup Patel RISCVCPU *cpu = RISCV_CPU(qemu_get_cpu(s->hartid_base + i)); 244b8fb878aSAnup Patel if (riscv_cpu_claim_interrupts(cpu, MIP_MTIP) < 0) { 245b8fb878aSAnup Patel error_report("MTIP already claimed"); 246b8fb878aSAnup Patel exit(1); 247b8fb878aSAnup Patel } 248b8fb878aSAnup Patel } 249cc63a182SAnup Patel } 250cc63a182SAnup Patel 251b8fb878aSAnup Patel static void riscv_aclint_mtimer_class_init(ObjectClass *klass, void *data) 252cc63a182SAnup Patel { 253cc63a182SAnup Patel DeviceClass *dc = DEVICE_CLASS(klass); 254b8fb878aSAnup Patel dc->realize = riscv_aclint_mtimer_realize; 255b8fb878aSAnup Patel device_class_set_props(dc, riscv_aclint_mtimer_properties); 256cc63a182SAnup Patel } 257cc63a182SAnup Patel 258b8fb878aSAnup Patel static const TypeInfo riscv_aclint_mtimer_info = { 259b8fb878aSAnup Patel .name = TYPE_RISCV_ACLINT_MTIMER, 260cc63a182SAnup Patel .parent = TYPE_SYS_BUS_DEVICE, 261b8fb878aSAnup Patel .instance_size = sizeof(RISCVAclintMTimerState), 262b8fb878aSAnup Patel .class_init = riscv_aclint_mtimer_class_init, 263cc63a182SAnup Patel }; 264cc63a182SAnup Patel 265cc63a182SAnup Patel /* 266b8fb878aSAnup Patel * Create ACLINT MTIMER device. 267cc63a182SAnup Patel */ 268b8fb878aSAnup Patel DeviceState *riscv_aclint_mtimer_create(hwaddr addr, hwaddr size, 269b8fb878aSAnup Patel uint32_t hartid_base, uint32_t num_harts, 270cc63a182SAnup Patel uint32_t timecmp_base, uint32_t time_base, uint32_t timebase_freq, 271cc63a182SAnup Patel bool provide_rdtime) 272cc63a182SAnup Patel { 273cc63a182SAnup Patel int i; 274b8fb878aSAnup Patel DeviceState *dev = qdev_new(TYPE_RISCV_ACLINT_MTIMER); 275cc63a182SAnup Patel 276b8fb878aSAnup Patel assert(num_harts <= RISCV_ACLINT_MAX_HARTS); 277b8fb878aSAnup Patel assert(!(addr & 0x7)); 278b8fb878aSAnup Patel assert(!(timecmp_base & 0x7)); 279b8fb878aSAnup Patel assert(!(time_base & 0x7)); 280b8fb878aSAnup Patel 281cc63a182SAnup Patel qdev_prop_set_uint32(dev, "hartid-base", hartid_base); 282cc63a182SAnup Patel qdev_prop_set_uint32(dev, "num-harts", num_harts); 283cc63a182SAnup Patel qdev_prop_set_uint32(dev, "timecmp-base", timecmp_base); 284cc63a182SAnup Patel qdev_prop_set_uint32(dev, "time-base", time_base); 285cc63a182SAnup Patel qdev_prop_set_uint32(dev, "aperture-size", size); 286cc63a182SAnup Patel qdev_prop_set_uint32(dev, "timebase-freq", timebase_freq); 287cc63a182SAnup Patel sysbus_realize_and_unref(SYS_BUS_DEVICE(dev), &error_fatal); 288cc63a182SAnup Patel sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, addr); 289cc63a182SAnup Patel 290cc63a182SAnup Patel for (i = 0; i < num_harts; i++) { 291cc63a182SAnup Patel CPUState *cpu = qemu_get_cpu(hartid_base + i); 292cc63a182SAnup Patel RISCVCPU *rvcpu = RISCV_CPU(cpu); 293cc63a182SAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 294b8fb878aSAnup Patel riscv_aclint_mtimer_callback *cb = 295*b21e2380SMarkus Armbruster g_new0(riscv_aclint_mtimer_callback, 1); 296cc63a182SAnup Patel 297cc63a182SAnup Patel if (!env) { 298cc63a182SAnup Patel g_free(cb); 299cc63a182SAnup Patel continue; 300cc63a182SAnup Patel } 301cc63a182SAnup Patel if (provide_rdtime) { 302cc63a182SAnup Patel riscv_cpu_set_rdtime_fn(env, cpu_riscv_read_rtc, timebase_freq); 303cc63a182SAnup Patel } 304cc63a182SAnup Patel 305b8fb878aSAnup Patel cb->s = RISCV_ACLINT_MTIMER(dev); 306cc63a182SAnup Patel cb->num = i; 307cc63a182SAnup Patel env->timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, 308b8fb878aSAnup Patel &riscv_aclint_mtimer_cb, cb); 309cc63a182SAnup Patel env->timecmp = 0; 310cc63a182SAnup Patel 311cc63a182SAnup Patel qdev_connect_gpio_out(dev, i, 312cc63a182SAnup Patel qdev_get_gpio_in(DEVICE(rvcpu), IRQ_M_TIMER)); 313cc63a182SAnup Patel } 314cc63a182SAnup Patel 315cc63a182SAnup Patel return dev; 316cc63a182SAnup Patel } 317b8fb878aSAnup Patel 318b8fb878aSAnup Patel /* CPU read [M|S]SWI register */ 319b8fb878aSAnup Patel static uint64_t riscv_aclint_swi_read(void *opaque, hwaddr addr, 320b8fb878aSAnup Patel unsigned size) 321b8fb878aSAnup Patel { 322b8fb878aSAnup Patel RISCVAclintSwiState *swi = opaque; 323b8fb878aSAnup Patel 324b8fb878aSAnup Patel if (addr < (swi->num_harts << 2)) { 325b8fb878aSAnup Patel size_t hartid = swi->hartid_base + (addr >> 2); 326b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 327b8fb878aSAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 328b8fb878aSAnup Patel if (!env) { 329b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 330b8fb878aSAnup Patel "aclint-swi: invalid hartid: %zu", hartid); 331b8fb878aSAnup Patel } else if ((addr & 0x3) == 0) { 332b8fb878aSAnup Patel return (swi->sswi) ? 0 : ((env->mip & MIP_MSIP) > 0); 333b8fb878aSAnup Patel } 334b8fb878aSAnup Patel } 335b8fb878aSAnup Patel 336b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 337b8fb878aSAnup Patel "aclint-swi: invalid read: %08x", (uint32_t)addr); 338b8fb878aSAnup Patel return 0; 339b8fb878aSAnup Patel } 340b8fb878aSAnup Patel 341b8fb878aSAnup Patel /* CPU write [M|S]SWI register */ 342b8fb878aSAnup Patel static void riscv_aclint_swi_write(void *opaque, hwaddr addr, uint64_t value, 343b8fb878aSAnup Patel unsigned size) 344b8fb878aSAnup Patel { 345b8fb878aSAnup Patel RISCVAclintSwiState *swi = opaque; 346b8fb878aSAnup Patel 347b8fb878aSAnup Patel if (addr < (swi->num_harts << 2)) { 348b8fb878aSAnup Patel size_t hartid = swi->hartid_base + (addr >> 2); 349b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 350b8fb878aSAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 351b8fb878aSAnup Patel if (!env) { 352b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 353b8fb878aSAnup Patel "aclint-swi: invalid hartid: %zu", hartid); 354b8fb878aSAnup Patel } else if ((addr & 0x3) == 0) { 355b8fb878aSAnup Patel if (value & 0x1) { 356b8fb878aSAnup Patel qemu_irq_raise(swi->soft_irqs[hartid - swi->hartid_base]); 357b8fb878aSAnup Patel } else { 358b8fb878aSAnup Patel if (!swi->sswi) { 359b8fb878aSAnup Patel qemu_irq_lower(swi->soft_irqs[hartid - swi->hartid_base]); 360b8fb878aSAnup Patel } 361b8fb878aSAnup Patel } 362b8fb878aSAnup Patel return; 363b8fb878aSAnup Patel } 364b8fb878aSAnup Patel } 365b8fb878aSAnup Patel 366b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 367b8fb878aSAnup Patel "aclint-swi: invalid write: %08x", (uint32_t)addr); 368b8fb878aSAnup Patel } 369b8fb878aSAnup Patel 370b8fb878aSAnup Patel static const MemoryRegionOps riscv_aclint_swi_ops = { 371b8fb878aSAnup Patel .read = riscv_aclint_swi_read, 372b8fb878aSAnup Patel .write = riscv_aclint_swi_write, 373b8fb878aSAnup Patel .endianness = DEVICE_LITTLE_ENDIAN, 374b8fb878aSAnup Patel .valid = { 375b8fb878aSAnup Patel .min_access_size = 4, 376b8fb878aSAnup Patel .max_access_size = 4 377b8fb878aSAnup Patel } 378b8fb878aSAnup Patel }; 379b8fb878aSAnup Patel 380b8fb878aSAnup Patel static Property riscv_aclint_swi_properties[] = { 381b8fb878aSAnup Patel DEFINE_PROP_UINT32("hartid-base", RISCVAclintSwiState, hartid_base, 0), 382b8fb878aSAnup Patel DEFINE_PROP_UINT32("num-harts", RISCVAclintSwiState, num_harts, 1), 383b8fb878aSAnup Patel DEFINE_PROP_UINT32("sswi", RISCVAclintSwiState, sswi, false), 384b8fb878aSAnup Patel DEFINE_PROP_END_OF_LIST(), 385b8fb878aSAnup Patel }; 386b8fb878aSAnup Patel 387b8fb878aSAnup Patel static void riscv_aclint_swi_realize(DeviceState *dev, Error **errp) 388b8fb878aSAnup Patel { 389b8fb878aSAnup Patel RISCVAclintSwiState *swi = RISCV_ACLINT_SWI(dev); 390b8fb878aSAnup Patel int i; 391b8fb878aSAnup Patel 392b8fb878aSAnup Patel memory_region_init_io(&swi->mmio, OBJECT(dev), &riscv_aclint_swi_ops, swi, 393b8fb878aSAnup Patel TYPE_RISCV_ACLINT_SWI, RISCV_ACLINT_SWI_SIZE); 394b8fb878aSAnup Patel sysbus_init_mmio(SYS_BUS_DEVICE(dev), &swi->mmio); 395b8fb878aSAnup Patel 396*b21e2380SMarkus Armbruster swi->soft_irqs = g_new(qemu_irq, swi->num_harts); 397b8fb878aSAnup Patel qdev_init_gpio_out(dev, swi->soft_irqs, swi->num_harts); 398b8fb878aSAnup Patel 399b8fb878aSAnup Patel /* Claim software interrupt bits */ 400b8fb878aSAnup Patel for (i = 0; i < swi->num_harts; i++) { 401b8fb878aSAnup Patel RISCVCPU *cpu = RISCV_CPU(qemu_get_cpu(swi->hartid_base + i)); 402b8fb878aSAnup Patel /* We don't claim mip.SSIP because it is writeable by software */ 403b8fb878aSAnup Patel if (riscv_cpu_claim_interrupts(cpu, swi->sswi ? 0 : MIP_MSIP) < 0) { 404b8fb878aSAnup Patel error_report("MSIP already claimed"); 405b8fb878aSAnup Patel exit(1); 406b8fb878aSAnup Patel } 407b8fb878aSAnup Patel } 408b8fb878aSAnup Patel } 409b8fb878aSAnup Patel 410b8fb878aSAnup Patel static void riscv_aclint_swi_class_init(ObjectClass *klass, void *data) 411b8fb878aSAnup Patel { 412b8fb878aSAnup Patel DeviceClass *dc = DEVICE_CLASS(klass); 413b8fb878aSAnup Patel dc->realize = riscv_aclint_swi_realize; 414b8fb878aSAnup Patel device_class_set_props(dc, riscv_aclint_swi_properties); 415b8fb878aSAnup Patel } 416b8fb878aSAnup Patel 417b8fb878aSAnup Patel static const TypeInfo riscv_aclint_swi_info = { 418b8fb878aSAnup Patel .name = TYPE_RISCV_ACLINT_SWI, 419b8fb878aSAnup Patel .parent = TYPE_SYS_BUS_DEVICE, 420b8fb878aSAnup Patel .instance_size = sizeof(RISCVAclintSwiState), 421b8fb878aSAnup Patel .class_init = riscv_aclint_swi_class_init, 422b8fb878aSAnup Patel }; 423b8fb878aSAnup Patel 424b8fb878aSAnup Patel /* 425b8fb878aSAnup Patel * Create ACLINT [M|S]SWI device. 426b8fb878aSAnup Patel */ 427b8fb878aSAnup Patel DeviceState *riscv_aclint_swi_create(hwaddr addr, uint32_t hartid_base, 428b8fb878aSAnup Patel uint32_t num_harts, bool sswi) 429b8fb878aSAnup Patel { 430b8fb878aSAnup Patel int i; 431b8fb878aSAnup Patel DeviceState *dev = qdev_new(TYPE_RISCV_ACLINT_SWI); 432b8fb878aSAnup Patel 433b8fb878aSAnup Patel assert(num_harts <= RISCV_ACLINT_MAX_HARTS); 434b8fb878aSAnup Patel assert(!(addr & 0x3)); 435b8fb878aSAnup Patel 436b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "hartid-base", hartid_base); 437b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "num-harts", num_harts); 438b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "sswi", sswi ? true : false); 439b8fb878aSAnup Patel sysbus_realize_and_unref(SYS_BUS_DEVICE(dev), &error_fatal); 440b8fb878aSAnup Patel sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, addr); 441b8fb878aSAnup Patel 442b8fb878aSAnup Patel for (i = 0; i < num_harts; i++) { 443b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid_base + i); 444b8fb878aSAnup Patel RISCVCPU *rvcpu = RISCV_CPU(cpu); 445b8fb878aSAnup Patel 446b8fb878aSAnup Patel qdev_connect_gpio_out(dev, i, 447b8fb878aSAnup Patel qdev_get_gpio_in(DEVICE(rvcpu), 448b8fb878aSAnup Patel (sswi) ? IRQ_S_SOFT : IRQ_M_SOFT)); 449b8fb878aSAnup Patel } 450b8fb878aSAnup Patel 451b8fb878aSAnup Patel return dev; 452b8fb878aSAnup Patel } 453b8fb878aSAnup Patel 454b8fb878aSAnup Patel static void riscv_aclint_register_types(void) 455b8fb878aSAnup Patel { 456b8fb878aSAnup Patel type_register_static(&riscv_aclint_mtimer_info); 457b8fb878aSAnup Patel type_register_static(&riscv_aclint_swi_info); 458b8fb878aSAnup Patel } 459b8fb878aSAnup Patel 460b8fb878aSAnup Patel type_init(riscv_aclint_register_types) 461