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) { 129*d42df0eaSFrank Chang /* timecmp_lo for RV32/RV64 or timecmp for RV64 */ 130cc63a182SAnup Patel uint64_t timecmp = env->timecmp; 131*d42df0eaSFrank Chang return (size == 4) ? (timecmp & 0xFFFFFFFF) : timecmp; 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) { 142*d42df0eaSFrank Chang /* time_lo for RV32/RV64 or timecmp for RV64 */ 143*d42df0eaSFrank Chang uint64_t rtc = cpu_riscv_read_rtc(mtimer->timebase_freq); 144*d42df0eaSFrank Chang return (size == 4) ? (rtc & 0xFFFFFFFF) : rtc; 145b8fb878aSAnup Patel } else if (addr == mtimer->time_base + 4) { 146cc63a182SAnup Patel /* time_hi */ 147b8fb878aSAnup Patel return (cpu_riscv_read_rtc(mtimer->timebase_freq) >> 32) & 0xFFFFFFFF; 148cc63a182SAnup Patel } 149cc63a182SAnup Patel 150b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 151b8fb878aSAnup Patel "aclint-mtimer: invalid read: %08x", (uint32_t)addr); 152cc63a182SAnup Patel return 0; 153cc63a182SAnup Patel } 154cc63a182SAnup Patel 155b8fb878aSAnup Patel /* CPU write MTIMER register */ 156b8fb878aSAnup Patel static void riscv_aclint_mtimer_write(void *opaque, hwaddr addr, 157b8fb878aSAnup Patel uint64_t value, unsigned size) 158cc63a182SAnup Patel { 159b8fb878aSAnup Patel RISCVAclintMTimerState *mtimer = opaque; 160cc63a182SAnup Patel 161b8fb878aSAnup Patel if (addr >= mtimer->timecmp_base && 162b8fb878aSAnup Patel addr < (mtimer->timecmp_base + (mtimer->num_harts << 3))) { 163b8fb878aSAnup Patel size_t hartid = mtimer->hartid_base + 164b8fb878aSAnup Patel ((addr - mtimer->timecmp_base) >> 3); 165cc63a182SAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 166cc63a182SAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 167cc63a182SAnup Patel if (!env) { 168b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 169b8fb878aSAnup Patel "aclint-mtimer: invalid hartid: %zu", hartid); 170cc63a182SAnup Patel } else if ((addr & 0x7) == 0) { 171*d42df0eaSFrank Chang if (size == 4) { 172*d42df0eaSFrank Chang /* timecmp_lo for RV32/RV64 */ 173cc63a182SAnup Patel uint64_t timecmp_hi = env->timecmp >> 32; 174b8fb878aSAnup Patel riscv_aclint_mtimer_write_timecmp(mtimer, RISCV_CPU(cpu), hartid, 175b8fb878aSAnup Patel timecmp_hi << 32 | (value & 0xFFFFFFFF), 176b8fb878aSAnup Patel mtimer->timebase_freq); 177*d42df0eaSFrank Chang } else { 178*d42df0eaSFrank Chang /* timecmp for RV64 */ 179*d42df0eaSFrank Chang riscv_aclint_mtimer_write_timecmp(mtimer, RISCV_CPU(cpu), hartid, 180*d42df0eaSFrank Chang value, mtimer->timebase_freq); 181*d42df0eaSFrank Chang } 182cc63a182SAnup Patel } else if ((addr & 0x7) == 4) { 183*d42df0eaSFrank Chang if (size == 4) { 184*d42df0eaSFrank Chang /* timecmp_hi for RV32/RV64 */ 185cc63a182SAnup Patel uint64_t timecmp_lo = env->timecmp; 186b8fb878aSAnup Patel riscv_aclint_mtimer_write_timecmp(mtimer, RISCV_CPU(cpu), hartid, 187b8fb878aSAnup Patel value << 32 | (timecmp_lo & 0xFFFFFFFF), 188b8fb878aSAnup Patel mtimer->timebase_freq); 189cc63a182SAnup Patel } else { 190*d42df0eaSFrank Chang qemu_log_mask(LOG_GUEST_ERROR, 191*d42df0eaSFrank Chang "aclint-mtimer: invalid timecmp_hi write: %08x", 192*d42df0eaSFrank Chang (uint32_t)addr); 193*d42df0eaSFrank Chang } 194*d42df0eaSFrank Chang } else { 195b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 196b8fb878aSAnup Patel "aclint-mtimer: invalid timecmp write: %08x", 197b8fb878aSAnup Patel (uint32_t)addr); 198cc63a182SAnup Patel } 199cc63a182SAnup Patel return; 200b8fb878aSAnup Patel } else if (addr == mtimer->time_base) { 201cc63a182SAnup Patel /* time_lo */ 202b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 203b8fb878aSAnup Patel "aclint-mtimer: time_lo write not implemented"); 204cc63a182SAnup Patel return; 205b8fb878aSAnup Patel } else if (addr == mtimer->time_base + 4) { 206cc63a182SAnup Patel /* time_hi */ 207b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 208b8fb878aSAnup Patel "aclint-mtimer: time_hi write not implemented"); 209cc63a182SAnup Patel return; 210cc63a182SAnup Patel } 211cc63a182SAnup Patel 212b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 213b8fb878aSAnup Patel "aclint-mtimer: invalid write: %08x", (uint32_t)addr); 214cc63a182SAnup Patel } 215cc63a182SAnup Patel 216b8fb878aSAnup Patel static const MemoryRegionOps riscv_aclint_mtimer_ops = { 217b8fb878aSAnup Patel .read = riscv_aclint_mtimer_read, 218b8fb878aSAnup Patel .write = riscv_aclint_mtimer_write, 219cc63a182SAnup Patel .endianness = DEVICE_LITTLE_ENDIAN, 220cc63a182SAnup Patel .valid = { 221cc63a182SAnup Patel .min_access_size = 4, 222cc63a182SAnup Patel .max_access_size = 8 223231a90c0SFrank Chang }, 224231a90c0SFrank Chang .impl = { 225231a90c0SFrank Chang .min_access_size = 4, 226231a90c0SFrank Chang .max_access_size = 8, 227cc63a182SAnup Patel } 228cc63a182SAnup Patel }; 229cc63a182SAnup Patel 230b8fb878aSAnup Patel static Property riscv_aclint_mtimer_properties[] = { 231b8fb878aSAnup Patel DEFINE_PROP_UINT32("hartid-base", RISCVAclintMTimerState, 232b8fb878aSAnup Patel hartid_base, 0), 233b8fb878aSAnup Patel DEFINE_PROP_UINT32("num-harts", RISCVAclintMTimerState, num_harts, 1), 234b8fb878aSAnup Patel DEFINE_PROP_UINT32("timecmp-base", RISCVAclintMTimerState, 235b8fb878aSAnup Patel timecmp_base, RISCV_ACLINT_DEFAULT_MTIMECMP), 236b8fb878aSAnup Patel DEFINE_PROP_UINT32("time-base", RISCVAclintMTimerState, 237b8fb878aSAnup Patel time_base, RISCV_ACLINT_DEFAULT_MTIME), 238b8fb878aSAnup Patel DEFINE_PROP_UINT32("aperture-size", RISCVAclintMTimerState, 239b8fb878aSAnup Patel aperture_size, RISCV_ACLINT_DEFAULT_MTIMER_SIZE), 240b8fb878aSAnup Patel DEFINE_PROP_UINT32("timebase-freq", RISCVAclintMTimerState, 241b8fb878aSAnup Patel timebase_freq, 0), 242cc63a182SAnup Patel DEFINE_PROP_END_OF_LIST(), 243cc63a182SAnup Patel }; 244cc63a182SAnup Patel 245b8fb878aSAnup Patel static void riscv_aclint_mtimer_realize(DeviceState *dev, Error **errp) 246cc63a182SAnup Patel { 247b8fb878aSAnup Patel RISCVAclintMTimerState *s = RISCV_ACLINT_MTIMER(dev); 248b8fb878aSAnup Patel int i; 249b8fb878aSAnup Patel 250b8fb878aSAnup Patel memory_region_init_io(&s->mmio, OBJECT(dev), &riscv_aclint_mtimer_ops, 251b8fb878aSAnup Patel s, TYPE_RISCV_ACLINT_MTIMER, s->aperture_size); 252cc63a182SAnup Patel sysbus_init_mmio(SYS_BUS_DEVICE(dev), &s->mmio); 253cc63a182SAnup Patel 254b21e2380SMarkus Armbruster s->timer_irqs = g_new(qemu_irq, s->num_harts); 255cc63a182SAnup Patel qdev_init_gpio_out(dev, s->timer_irqs, s->num_harts); 256cc63a182SAnup Patel 257b8fb878aSAnup Patel /* Claim timer interrupt bits */ 258b8fb878aSAnup Patel for (i = 0; i < s->num_harts; i++) { 259b8fb878aSAnup Patel RISCVCPU *cpu = RISCV_CPU(qemu_get_cpu(s->hartid_base + i)); 260b8fb878aSAnup Patel if (riscv_cpu_claim_interrupts(cpu, MIP_MTIP) < 0) { 261b8fb878aSAnup Patel error_report("MTIP already claimed"); 262b8fb878aSAnup Patel exit(1); 263b8fb878aSAnup Patel } 264b8fb878aSAnup Patel } 265cc63a182SAnup Patel } 266cc63a182SAnup Patel 267b8fb878aSAnup Patel static void riscv_aclint_mtimer_class_init(ObjectClass *klass, void *data) 268cc63a182SAnup Patel { 269cc63a182SAnup Patel DeviceClass *dc = DEVICE_CLASS(klass); 270b8fb878aSAnup Patel dc->realize = riscv_aclint_mtimer_realize; 271b8fb878aSAnup Patel device_class_set_props(dc, riscv_aclint_mtimer_properties); 272cc63a182SAnup Patel } 273cc63a182SAnup Patel 274b8fb878aSAnup Patel static const TypeInfo riscv_aclint_mtimer_info = { 275b8fb878aSAnup Patel .name = TYPE_RISCV_ACLINT_MTIMER, 276cc63a182SAnup Patel .parent = TYPE_SYS_BUS_DEVICE, 277b8fb878aSAnup Patel .instance_size = sizeof(RISCVAclintMTimerState), 278b8fb878aSAnup Patel .class_init = riscv_aclint_mtimer_class_init, 279cc63a182SAnup Patel }; 280cc63a182SAnup Patel 281cc63a182SAnup Patel /* 282b8fb878aSAnup Patel * Create ACLINT MTIMER device. 283cc63a182SAnup Patel */ 284b8fb878aSAnup Patel DeviceState *riscv_aclint_mtimer_create(hwaddr addr, hwaddr size, 285b8fb878aSAnup Patel uint32_t hartid_base, uint32_t num_harts, 286cc63a182SAnup Patel uint32_t timecmp_base, uint32_t time_base, uint32_t timebase_freq, 287cc63a182SAnup Patel bool provide_rdtime) 288cc63a182SAnup Patel { 289cc63a182SAnup Patel int i; 290b8fb878aSAnup Patel DeviceState *dev = qdev_new(TYPE_RISCV_ACLINT_MTIMER); 291cc63a182SAnup Patel 292b8fb878aSAnup Patel assert(num_harts <= RISCV_ACLINT_MAX_HARTS); 293b8fb878aSAnup Patel assert(!(addr & 0x7)); 294b8fb878aSAnup Patel assert(!(timecmp_base & 0x7)); 295b8fb878aSAnup Patel assert(!(time_base & 0x7)); 296b8fb878aSAnup Patel 297cc63a182SAnup Patel qdev_prop_set_uint32(dev, "hartid-base", hartid_base); 298cc63a182SAnup Patel qdev_prop_set_uint32(dev, "num-harts", num_harts); 299cc63a182SAnup Patel qdev_prop_set_uint32(dev, "timecmp-base", timecmp_base); 300cc63a182SAnup Patel qdev_prop_set_uint32(dev, "time-base", time_base); 301cc63a182SAnup Patel qdev_prop_set_uint32(dev, "aperture-size", size); 302cc63a182SAnup Patel qdev_prop_set_uint32(dev, "timebase-freq", timebase_freq); 303cc63a182SAnup Patel sysbus_realize_and_unref(SYS_BUS_DEVICE(dev), &error_fatal); 304cc63a182SAnup Patel sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, addr); 305cc63a182SAnup Patel 306cc63a182SAnup Patel for (i = 0; i < num_harts; i++) { 307cc63a182SAnup Patel CPUState *cpu = qemu_get_cpu(hartid_base + i); 308cc63a182SAnup Patel RISCVCPU *rvcpu = RISCV_CPU(cpu); 309cc63a182SAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 310b8fb878aSAnup Patel riscv_aclint_mtimer_callback *cb = 311b21e2380SMarkus Armbruster g_new0(riscv_aclint_mtimer_callback, 1); 312cc63a182SAnup Patel 313cc63a182SAnup Patel if (!env) { 314cc63a182SAnup Patel g_free(cb); 315cc63a182SAnup Patel continue; 316cc63a182SAnup Patel } 317cc63a182SAnup Patel if (provide_rdtime) { 318cc63a182SAnup Patel riscv_cpu_set_rdtime_fn(env, cpu_riscv_read_rtc, timebase_freq); 319cc63a182SAnup Patel } 320cc63a182SAnup Patel 321b8fb878aSAnup Patel cb->s = RISCV_ACLINT_MTIMER(dev); 322cc63a182SAnup Patel cb->num = i; 323cc63a182SAnup Patel env->timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, 324b8fb878aSAnup Patel &riscv_aclint_mtimer_cb, cb); 325cc63a182SAnup Patel env->timecmp = 0; 326cc63a182SAnup Patel 327cc63a182SAnup Patel qdev_connect_gpio_out(dev, i, 328cc63a182SAnup Patel qdev_get_gpio_in(DEVICE(rvcpu), IRQ_M_TIMER)); 329cc63a182SAnup Patel } 330cc63a182SAnup Patel 331cc63a182SAnup Patel return dev; 332cc63a182SAnup Patel } 333b8fb878aSAnup Patel 334b8fb878aSAnup Patel /* CPU read [M|S]SWI register */ 335b8fb878aSAnup Patel static uint64_t riscv_aclint_swi_read(void *opaque, hwaddr addr, 336b8fb878aSAnup Patel unsigned size) 337b8fb878aSAnup Patel { 338b8fb878aSAnup Patel RISCVAclintSwiState *swi = opaque; 339b8fb878aSAnup Patel 340b8fb878aSAnup Patel if (addr < (swi->num_harts << 2)) { 341b8fb878aSAnup Patel size_t hartid = swi->hartid_base + (addr >> 2); 342b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 343b8fb878aSAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 344b8fb878aSAnup Patel if (!env) { 345b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 346b8fb878aSAnup Patel "aclint-swi: invalid hartid: %zu", hartid); 347b8fb878aSAnup Patel } else if ((addr & 0x3) == 0) { 348b8fb878aSAnup Patel return (swi->sswi) ? 0 : ((env->mip & MIP_MSIP) > 0); 349b8fb878aSAnup Patel } 350b8fb878aSAnup Patel } 351b8fb878aSAnup Patel 352b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 353b8fb878aSAnup Patel "aclint-swi: invalid read: %08x", (uint32_t)addr); 354b8fb878aSAnup Patel return 0; 355b8fb878aSAnup Patel } 356b8fb878aSAnup Patel 357b8fb878aSAnup Patel /* CPU write [M|S]SWI register */ 358b8fb878aSAnup Patel static void riscv_aclint_swi_write(void *opaque, hwaddr addr, uint64_t value, 359b8fb878aSAnup Patel unsigned size) 360b8fb878aSAnup Patel { 361b8fb878aSAnup Patel RISCVAclintSwiState *swi = opaque; 362b8fb878aSAnup Patel 363b8fb878aSAnup Patel if (addr < (swi->num_harts << 2)) { 364b8fb878aSAnup Patel size_t hartid = swi->hartid_base + (addr >> 2); 365b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 366b8fb878aSAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 367b8fb878aSAnup Patel if (!env) { 368b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 369b8fb878aSAnup Patel "aclint-swi: invalid hartid: %zu", hartid); 370b8fb878aSAnup Patel } else if ((addr & 0x3) == 0) { 371b8fb878aSAnup Patel if (value & 0x1) { 372b8fb878aSAnup Patel qemu_irq_raise(swi->soft_irqs[hartid - swi->hartid_base]); 373b8fb878aSAnup Patel } else { 374b8fb878aSAnup Patel if (!swi->sswi) { 375b8fb878aSAnup Patel qemu_irq_lower(swi->soft_irqs[hartid - swi->hartid_base]); 376b8fb878aSAnup Patel } 377b8fb878aSAnup Patel } 378b8fb878aSAnup Patel return; 379b8fb878aSAnup Patel } 380b8fb878aSAnup Patel } 381b8fb878aSAnup Patel 382b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 383b8fb878aSAnup Patel "aclint-swi: invalid write: %08x", (uint32_t)addr); 384b8fb878aSAnup Patel } 385b8fb878aSAnup Patel 386b8fb878aSAnup Patel static const MemoryRegionOps riscv_aclint_swi_ops = { 387b8fb878aSAnup Patel .read = riscv_aclint_swi_read, 388b8fb878aSAnup Patel .write = riscv_aclint_swi_write, 389b8fb878aSAnup Patel .endianness = DEVICE_LITTLE_ENDIAN, 390b8fb878aSAnup Patel .valid = { 391b8fb878aSAnup Patel .min_access_size = 4, 392b8fb878aSAnup Patel .max_access_size = 4 393b8fb878aSAnup Patel } 394b8fb878aSAnup Patel }; 395b8fb878aSAnup Patel 396b8fb878aSAnup Patel static Property riscv_aclint_swi_properties[] = { 397b8fb878aSAnup Patel DEFINE_PROP_UINT32("hartid-base", RISCVAclintSwiState, hartid_base, 0), 398b8fb878aSAnup Patel DEFINE_PROP_UINT32("num-harts", RISCVAclintSwiState, num_harts, 1), 399b8fb878aSAnup Patel DEFINE_PROP_UINT32("sswi", RISCVAclintSwiState, sswi, false), 400b8fb878aSAnup Patel DEFINE_PROP_END_OF_LIST(), 401b8fb878aSAnup Patel }; 402b8fb878aSAnup Patel 403b8fb878aSAnup Patel static void riscv_aclint_swi_realize(DeviceState *dev, Error **errp) 404b8fb878aSAnup Patel { 405b8fb878aSAnup Patel RISCVAclintSwiState *swi = RISCV_ACLINT_SWI(dev); 406b8fb878aSAnup Patel int i; 407b8fb878aSAnup Patel 408b8fb878aSAnup Patel memory_region_init_io(&swi->mmio, OBJECT(dev), &riscv_aclint_swi_ops, swi, 409b8fb878aSAnup Patel TYPE_RISCV_ACLINT_SWI, RISCV_ACLINT_SWI_SIZE); 410b8fb878aSAnup Patel sysbus_init_mmio(SYS_BUS_DEVICE(dev), &swi->mmio); 411b8fb878aSAnup Patel 412b21e2380SMarkus Armbruster swi->soft_irqs = g_new(qemu_irq, swi->num_harts); 413b8fb878aSAnup Patel qdev_init_gpio_out(dev, swi->soft_irqs, swi->num_harts); 414b8fb878aSAnup Patel 415b8fb878aSAnup Patel /* Claim software interrupt bits */ 416b8fb878aSAnup Patel for (i = 0; i < swi->num_harts; i++) { 417b8fb878aSAnup Patel RISCVCPU *cpu = RISCV_CPU(qemu_get_cpu(swi->hartid_base + i)); 418b8fb878aSAnup Patel /* We don't claim mip.SSIP because it is writeable by software */ 419b8fb878aSAnup Patel if (riscv_cpu_claim_interrupts(cpu, swi->sswi ? 0 : MIP_MSIP) < 0) { 420b8fb878aSAnup Patel error_report("MSIP already claimed"); 421b8fb878aSAnup Patel exit(1); 422b8fb878aSAnup Patel } 423b8fb878aSAnup Patel } 424b8fb878aSAnup Patel } 425b8fb878aSAnup Patel 426b8fb878aSAnup Patel static void riscv_aclint_swi_class_init(ObjectClass *klass, void *data) 427b8fb878aSAnup Patel { 428b8fb878aSAnup Patel DeviceClass *dc = DEVICE_CLASS(klass); 429b8fb878aSAnup Patel dc->realize = riscv_aclint_swi_realize; 430b8fb878aSAnup Patel device_class_set_props(dc, riscv_aclint_swi_properties); 431b8fb878aSAnup Patel } 432b8fb878aSAnup Patel 433b8fb878aSAnup Patel static const TypeInfo riscv_aclint_swi_info = { 434b8fb878aSAnup Patel .name = TYPE_RISCV_ACLINT_SWI, 435b8fb878aSAnup Patel .parent = TYPE_SYS_BUS_DEVICE, 436b8fb878aSAnup Patel .instance_size = sizeof(RISCVAclintSwiState), 437b8fb878aSAnup Patel .class_init = riscv_aclint_swi_class_init, 438b8fb878aSAnup Patel }; 439b8fb878aSAnup Patel 440b8fb878aSAnup Patel /* 441b8fb878aSAnup Patel * Create ACLINT [M|S]SWI device. 442b8fb878aSAnup Patel */ 443b8fb878aSAnup Patel DeviceState *riscv_aclint_swi_create(hwaddr addr, uint32_t hartid_base, 444b8fb878aSAnup Patel uint32_t num_harts, bool sswi) 445b8fb878aSAnup Patel { 446b8fb878aSAnup Patel int i; 447b8fb878aSAnup Patel DeviceState *dev = qdev_new(TYPE_RISCV_ACLINT_SWI); 448b8fb878aSAnup Patel 449b8fb878aSAnup Patel assert(num_harts <= RISCV_ACLINT_MAX_HARTS); 450b8fb878aSAnup Patel assert(!(addr & 0x3)); 451b8fb878aSAnup Patel 452b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "hartid-base", hartid_base); 453b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "num-harts", num_harts); 454b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "sswi", sswi ? true : false); 455b8fb878aSAnup Patel sysbus_realize_and_unref(SYS_BUS_DEVICE(dev), &error_fatal); 456b8fb878aSAnup Patel sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, addr); 457b8fb878aSAnup Patel 458b8fb878aSAnup Patel for (i = 0; i < num_harts; i++) { 459b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid_base + i); 460b8fb878aSAnup Patel RISCVCPU *rvcpu = RISCV_CPU(cpu); 461b8fb878aSAnup Patel 462b8fb878aSAnup Patel qdev_connect_gpio_out(dev, i, 463b8fb878aSAnup Patel qdev_get_gpio_in(DEVICE(rvcpu), 464b8fb878aSAnup Patel (sswi) ? IRQ_S_SOFT : IRQ_M_SOFT)); 465b8fb878aSAnup Patel } 466b8fb878aSAnup Patel 467b8fb878aSAnup Patel return dev; 468b8fb878aSAnup Patel } 469b8fb878aSAnup Patel 470b8fb878aSAnup Patel static void riscv_aclint_register_types(void) 471b8fb878aSAnup Patel { 472b8fb878aSAnup Patel type_register_static(&riscv_aclint_mtimer_info); 473b8fb878aSAnup Patel type_register_static(&riscv_aclint_swi_info); 474b8fb878aSAnup Patel } 475b8fb878aSAnup Patel 476b8fb878aSAnup Patel type_init(riscv_aclint_register_types) 477