11c77c410SMichael Clark /* 2b8fb878aSAnup Patel * RISC-V ACLINT (Advanced Core Local Interruptor) 3b8fb878aSAnup Patel * URL: https://github.com/riscv/riscv-aclint 41c77c410SMichael Clark * 51c77c410SMichael Clark * Copyright (c) 2016-2017 Sagar Karandikar, sagark@eecs.berkeley.edu 61c77c410SMichael Clark * Copyright (c) 2017 SiFive, Inc. 7b8fb878aSAnup Patel * Copyright (c) 2021 Western Digital Corporation or its affiliates. 81c77c410SMichael Clark * 91c77c410SMichael Clark * This provides real-time clock, timer and interprocessor interrupts. 101c77c410SMichael Clark * 111c77c410SMichael Clark * This program is free software; you can redistribute it and/or modify it 121c77c410SMichael Clark * under the terms and conditions of the GNU General Public License, 131c77c410SMichael Clark * version 2 or later, as published by the Free Software Foundation. 141c77c410SMichael Clark * 151c77c410SMichael Clark * This program is distributed in the hope it will be useful, but WITHOUT 161c77c410SMichael Clark * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or 171c77c410SMichael Clark * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License for 181c77c410SMichael Clark * more details. 191c77c410SMichael Clark * 201c77c410SMichael Clark * You should have received a copy of the GNU General Public License along with 211c77c410SMichael Clark * this program. If not, see <http://www.gnu.org/licenses/>. 221c77c410SMichael Clark */ 231c77c410SMichael Clark 241c77c410SMichael Clark #include "qemu/osdep.h" 253e80f690SMarkus Armbruster #include "qapi/error.h" 261c77c410SMichael Clark #include "qemu/error-report.h" 27b8fb878aSAnup Patel #include "qemu/log.h" 280b8fa32fSMarkus Armbruster #include "qemu/module.h" 291c77c410SMichael Clark #include "hw/sysbus.h" 301c77c410SMichael Clark #include "target/riscv/cpu.h" 31a27bd6c7SMarkus Armbruster #include "hw/qdev-properties.h" 32cc63a182SAnup Patel #include "hw/intc/riscv_aclint.h" 331c77c410SMichael Clark #include "qemu/timer.h" 34a714b8aaSAlistair Francis #include "hw/irq.h" 35a714b8aaSAlistair Francis 36b8fb878aSAnup Patel typedef struct riscv_aclint_mtimer_callback { 37b8fb878aSAnup Patel RISCVAclintMTimerState *s; 38a714b8aaSAlistair Francis int num; 39b8fb878aSAnup Patel } riscv_aclint_mtimer_callback; 401c77c410SMichael Clark 41a47ef6e9SBin Meng static uint64_t cpu_riscv_read_rtc(uint32_t timebase_freq) 421c77c410SMichael Clark { 432a8756edSMichael Clark return muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL), 44a47ef6e9SBin Meng timebase_freq, NANOSECONDS_PER_SECOND); 451c77c410SMichael Clark } 461c77c410SMichael Clark 471c77c410SMichael Clark /* 481c77c410SMichael Clark * Called when timecmp is written to update the QEMU timer or immediately 491c77c410SMichael Clark * trigger timer interrupt if mtimecmp <= current timer value. 501c77c410SMichael Clark */ 51b8fb878aSAnup Patel static void riscv_aclint_mtimer_write_timecmp(RISCVAclintMTimerState *mtimer, 52b8fb878aSAnup Patel RISCVCPU *cpu, 53a714b8aaSAlistair Francis int hartid, 54a714b8aaSAlistair Francis uint64_t value, 55a47ef6e9SBin Meng uint32_t timebase_freq) 561c77c410SMichael Clark { 571c77c410SMichael Clark uint64_t next; 581c77c410SMichael Clark uint64_t diff; 591c77c410SMichael Clark 60a47ef6e9SBin Meng uint64_t rtc_r = cpu_riscv_read_rtc(timebase_freq); 611c77c410SMichael Clark 621c77c410SMichael Clark cpu->env.timecmp = value; 631c77c410SMichael Clark 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]); 691c77c410SMichael Clark return; 701c77c410SMichael Clark } 711c77c410SMichael Clark 721c77c410SMichael Clark /* otherwise, set up the future timer interrupt */ 73b8fb878aSAnup Patel qemu_irq_lower(mtimer->timer_irqs[hartid - mtimer->hartid_base]); 741c77c410SMichael Clark diff = cpu->env.timecmp - rtc_r; 751c77c410SMichael Clark /* back to ns (note args switched in muldiv64) */ 764dc06bb8SDavid Hoppenbrouwers uint64_t ns_diff = muldiv64(diff, NANOSECONDS_PER_SECOND, timebase_freq); 774dc06bb8SDavid Hoppenbrouwers 784dc06bb8SDavid Hoppenbrouwers /* 794dc06bb8SDavid Hoppenbrouwers * check if ns_diff overflowed and check if the addition would potentially 804dc06bb8SDavid Hoppenbrouwers * overflow 814dc06bb8SDavid Hoppenbrouwers */ 824dc06bb8SDavid Hoppenbrouwers if ((NANOSECONDS_PER_SECOND > timebase_freq && ns_diff < diff) || 834dc06bb8SDavid Hoppenbrouwers ns_diff > INT64_MAX) { 844dc06bb8SDavid Hoppenbrouwers next = INT64_MAX; 854dc06bb8SDavid Hoppenbrouwers } else { 864dc06bb8SDavid Hoppenbrouwers /* 874dc06bb8SDavid Hoppenbrouwers * as it is very unlikely qemu_clock_get_ns will return a value 884dc06bb8SDavid Hoppenbrouwers * greater than INT64_MAX, no additional check is needed for an 894dc06bb8SDavid Hoppenbrouwers * unsigned integer overflow. 904dc06bb8SDavid Hoppenbrouwers */ 914dc06bb8SDavid Hoppenbrouwers next = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + ns_diff; 924dc06bb8SDavid Hoppenbrouwers /* 934dc06bb8SDavid Hoppenbrouwers * if ns_diff is INT64_MAX next may still be outside the range 944dc06bb8SDavid Hoppenbrouwers * of a signed integer. 954dc06bb8SDavid Hoppenbrouwers */ 964dc06bb8SDavid Hoppenbrouwers next = MIN(next, INT64_MAX); 974dc06bb8SDavid Hoppenbrouwers } 984dc06bb8SDavid Hoppenbrouwers 991c77c410SMichael Clark timer_mod(cpu->env.timer, next); 1001c77c410SMichael Clark } 1011c77c410SMichael Clark 1021c77c410SMichael Clark /* 1031c77c410SMichael Clark * Callback used when the timer set using timer_mod expires. 1041c77c410SMichael Clark * Should raise the timer interrupt line 1051c77c410SMichael Clark */ 106b8fb878aSAnup Patel static void riscv_aclint_mtimer_cb(void *opaque) 1071c77c410SMichael Clark { 108b8fb878aSAnup Patel riscv_aclint_mtimer_callback *state = opaque; 109a714b8aaSAlistair Francis 110a714b8aaSAlistair Francis qemu_irq_raise(state->s->timer_irqs[state->num]); 1111c77c410SMichael Clark } 1121c77c410SMichael Clark 113b8fb878aSAnup Patel /* CPU read MTIMER register */ 114b8fb878aSAnup Patel static uint64_t riscv_aclint_mtimer_read(void *opaque, hwaddr addr, 115b8fb878aSAnup Patel unsigned size) 1161c77c410SMichael Clark { 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); 1231c77c410SMichael Clark CPUState *cpu = qemu_get_cpu(hartid); 1241c77c410SMichael Clark CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 1251c77c410SMichael Clark if (!env) { 126b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 127b8fb878aSAnup Patel "aclint-mtimer: invalid hartid: %zu", hartid); 1281c77c410SMichael Clark } else if ((addr & 0x7) == 0) { 1291c77c410SMichael Clark /* timecmp_lo */ 1301c77c410SMichael Clark uint64_t timecmp = env->timecmp; 1311c77c410SMichael Clark return timecmp & 0xFFFFFFFF; 1321c77c410SMichael Clark } else if ((addr & 0x7) == 4) { 1331c77c410SMichael Clark /* timecmp_hi */ 1341c77c410SMichael Clark uint64_t timecmp = env->timecmp; 1351c77c410SMichael Clark return (timecmp >> 32) & 0xFFFFFFFF; 1361c77c410SMichael Clark } else { 137b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 138b8fb878aSAnup Patel "aclint-mtimer: invalid read: %08x", (uint32_t)addr); 1391c77c410SMichael Clark return 0; 1401c77c410SMichael Clark } 141b8fb878aSAnup Patel } else if (addr == mtimer->time_base) { 1421c77c410SMichael Clark /* time_lo */ 143b8fb878aSAnup Patel return cpu_riscv_read_rtc(mtimer->timebase_freq) & 0xFFFFFFFF; 144b8fb878aSAnup Patel } else if (addr == mtimer->time_base + 4) { 1451c77c410SMichael Clark /* time_hi */ 146b8fb878aSAnup Patel return (cpu_riscv_read_rtc(mtimer->timebase_freq) >> 32) & 0xFFFFFFFF; 1471c77c410SMichael Clark } 1481c77c410SMichael Clark 149b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 150b8fb878aSAnup Patel "aclint-mtimer: invalid read: %08x", (uint32_t)addr); 1511c77c410SMichael Clark return 0; 1521c77c410SMichael Clark } 1531c77c410SMichael Clark 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) 1571c77c410SMichael Clark { 158b8fb878aSAnup Patel RISCVAclintMTimerState *mtimer = opaque; 1591c77c410SMichael Clark 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); 1641c77c410SMichael Clark CPUState *cpu = qemu_get_cpu(hartid); 1651c77c410SMichael Clark CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 1661c77c410SMichael Clark if (!env) { 167b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 168b8fb878aSAnup Patel "aclint-mtimer: invalid hartid: %zu", hartid); 1691c77c410SMichael Clark } else if ((addr & 0x7) == 0) { 1701c77c410SMichael Clark /* timecmp_lo */ 171ef9e41dfSMichael Clark 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); 1751c77c410SMichael Clark return; 1761c77c410SMichael Clark } else if ((addr & 0x7) == 4) { 1771c77c410SMichael Clark /* timecmp_hi */ 178ef9e41dfSMichael Clark 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); 1821c77c410SMichael Clark } else { 183b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 184b8fb878aSAnup Patel "aclint-mtimer: invalid timecmp write: %08x", 185b8fb878aSAnup Patel (uint32_t)addr); 1861c77c410SMichael Clark } 1871c77c410SMichael Clark return; 188b8fb878aSAnup Patel } else if (addr == mtimer->time_base) { 1891c77c410SMichael Clark /* time_lo */ 190b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 191b8fb878aSAnup Patel "aclint-mtimer: time_lo write not implemented"); 1921c77c410SMichael Clark return; 193b8fb878aSAnup Patel } else if (addr == mtimer->time_base + 4) { 1941c77c410SMichael Clark /* time_hi */ 195b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 196b8fb878aSAnup Patel "aclint-mtimer: time_hi write not implemented"); 1971c77c410SMichael Clark return; 1981c77c410SMichael Clark } 1991c77c410SMichael Clark 200b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 201b8fb878aSAnup Patel "aclint-mtimer: invalid write: %08x", (uint32_t)addr); 2021c77c410SMichael Clark } 2031c77c410SMichael Clark 204b8fb878aSAnup Patel static const MemoryRegionOps riscv_aclint_mtimer_ops = { 205b8fb878aSAnup Patel .read = riscv_aclint_mtimer_read, 206b8fb878aSAnup Patel .write = riscv_aclint_mtimer_write, 2071c77c410SMichael Clark .endianness = DEVICE_LITTLE_ENDIAN, 2081c77c410SMichael Clark .valid = { 2091c77c410SMichael Clark .min_access_size = 4, 21070b78d4eSAlistair Francis .max_access_size = 8 211*231a90c0SFrank Chang }, 212*231a90c0SFrank Chang .impl = { 213*231a90c0SFrank Chang .min_access_size = 4, 214*231a90c0SFrank Chang .max_access_size = 8, 2151c77c410SMichael Clark } 2161c77c410SMichael Clark }; 2171c77c410SMichael Clark 218b8fb878aSAnup Patel static Property riscv_aclint_mtimer_properties[] = { 219b8fb878aSAnup Patel DEFINE_PROP_UINT32("hartid-base", RISCVAclintMTimerState, 220b8fb878aSAnup Patel hartid_base, 0), 221b8fb878aSAnup Patel DEFINE_PROP_UINT32("num-harts", RISCVAclintMTimerState, num_harts, 1), 222b8fb878aSAnup Patel DEFINE_PROP_UINT32("timecmp-base", RISCVAclintMTimerState, 223b8fb878aSAnup Patel timecmp_base, RISCV_ACLINT_DEFAULT_MTIMECMP), 224b8fb878aSAnup Patel DEFINE_PROP_UINT32("time-base", RISCVAclintMTimerState, 225b8fb878aSAnup Patel time_base, RISCV_ACLINT_DEFAULT_MTIME), 226b8fb878aSAnup Patel DEFINE_PROP_UINT32("aperture-size", RISCVAclintMTimerState, 227b8fb878aSAnup Patel aperture_size, RISCV_ACLINT_DEFAULT_MTIMER_SIZE), 228b8fb878aSAnup Patel DEFINE_PROP_UINT32("timebase-freq", RISCVAclintMTimerState, 229b8fb878aSAnup Patel timebase_freq, 0), 2301c77c410SMichael Clark DEFINE_PROP_END_OF_LIST(), 2311c77c410SMichael Clark }; 2321c77c410SMichael Clark 233b8fb878aSAnup Patel static void riscv_aclint_mtimer_realize(DeviceState *dev, Error **errp) 2341c77c410SMichael Clark { 235b8fb878aSAnup Patel RISCVAclintMTimerState *s = RISCV_ACLINT_MTIMER(dev); 236b8fb878aSAnup Patel int i; 237b8fb878aSAnup Patel 238b8fb878aSAnup Patel memory_region_init_io(&s->mmio, OBJECT(dev), &riscv_aclint_mtimer_ops, 239b8fb878aSAnup Patel s, TYPE_RISCV_ACLINT_MTIMER, s->aperture_size); 2401c77c410SMichael Clark sysbus_init_mmio(SYS_BUS_DEVICE(dev), &s->mmio); 241a714b8aaSAlistair Francis 242b21e2380SMarkus Armbruster s->timer_irqs = g_new(qemu_irq, s->num_harts); 243a714b8aaSAlistair Francis qdev_init_gpio_out(dev, s->timer_irqs, s->num_harts); 244a714b8aaSAlistair Francis 245b8fb878aSAnup Patel /* Claim timer interrupt bits */ 246b8fb878aSAnup Patel for (i = 0; i < s->num_harts; i++) { 247b8fb878aSAnup Patel RISCVCPU *cpu = RISCV_CPU(qemu_get_cpu(s->hartid_base + i)); 248b8fb878aSAnup Patel if (riscv_cpu_claim_interrupts(cpu, MIP_MTIP) < 0) { 249b8fb878aSAnup Patel error_report("MTIP already claimed"); 250b8fb878aSAnup Patel exit(1); 251b8fb878aSAnup Patel } 252b8fb878aSAnup Patel } 2531c77c410SMichael Clark } 2541c77c410SMichael Clark 255b8fb878aSAnup Patel static void riscv_aclint_mtimer_class_init(ObjectClass *klass, void *data) 2561c77c410SMichael Clark { 2571c77c410SMichael Clark DeviceClass *dc = DEVICE_CLASS(klass); 258b8fb878aSAnup Patel dc->realize = riscv_aclint_mtimer_realize; 259b8fb878aSAnup Patel device_class_set_props(dc, riscv_aclint_mtimer_properties); 2601c77c410SMichael Clark } 2611c77c410SMichael Clark 262b8fb878aSAnup Patel static const TypeInfo riscv_aclint_mtimer_info = { 263b8fb878aSAnup Patel .name = TYPE_RISCV_ACLINT_MTIMER, 2641c77c410SMichael Clark .parent = TYPE_SYS_BUS_DEVICE, 265b8fb878aSAnup Patel .instance_size = sizeof(RISCVAclintMTimerState), 266b8fb878aSAnup Patel .class_init = riscv_aclint_mtimer_class_init, 2671c77c410SMichael Clark }; 2681c77c410SMichael Clark 2691c77c410SMichael Clark /* 270b8fb878aSAnup Patel * Create ACLINT MTIMER device. 2711c77c410SMichael Clark */ 272b8fb878aSAnup Patel DeviceState *riscv_aclint_mtimer_create(hwaddr addr, hwaddr size, 273b8fb878aSAnup Patel uint32_t hartid_base, uint32_t num_harts, 274a47ef6e9SBin Meng uint32_t timecmp_base, uint32_t time_base, uint32_t timebase_freq, 275a47ef6e9SBin Meng bool provide_rdtime) 2761c77c410SMichael Clark { 2771c77c410SMichael Clark int i; 278b8fb878aSAnup Patel DeviceState *dev = qdev_new(TYPE_RISCV_ACLINT_MTIMER); 2791c77c410SMichael Clark 280b8fb878aSAnup Patel assert(num_harts <= RISCV_ACLINT_MAX_HARTS); 281b8fb878aSAnup Patel assert(!(addr & 0x7)); 282b8fb878aSAnup Patel assert(!(timecmp_base & 0x7)); 283b8fb878aSAnup Patel assert(!(time_base & 0x7)); 284b8fb878aSAnup Patel 2853bf03f08SAnup Patel qdev_prop_set_uint32(dev, "hartid-base", hartid_base); 2861c77c410SMichael Clark qdev_prop_set_uint32(dev, "num-harts", num_harts); 2871c77c410SMichael Clark qdev_prop_set_uint32(dev, "timecmp-base", timecmp_base); 2881c77c410SMichael Clark qdev_prop_set_uint32(dev, "time-base", time_base); 2891c77c410SMichael Clark qdev_prop_set_uint32(dev, "aperture-size", size); 290a47ef6e9SBin Meng qdev_prop_set_uint32(dev, "timebase-freq", timebase_freq); 2913c6ef471SMarkus Armbruster sysbus_realize_and_unref(SYS_BUS_DEVICE(dev), &error_fatal); 2921c77c410SMichael Clark sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, addr); 293a714b8aaSAlistair Francis 294a714b8aaSAlistair Francis for (i = 0; i < num_harts; i++) { 295a714b8aaSAlistair Francis CPUState *cpu = qemu_get_cpu(hartid_base + i); 296a714b8aaSAlistair Francis RISCVCPU *rvcpu = RISCV_CPU(cpu); 297a714b8aaSAlistair Francis CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 298b8fb878aSAnup Patel riscv_aclint_mtimer_callback *cb = 299b21e2380SMarkus Armbruster g_new0(riscv_aclint_mtimer_callback, 1); 300a714b8aaSAlistair Francis 301a714b8aaSAlistair Francis if (!env) { 302a714b8aaSAlistair Francis g_free(cb); 303a714b8aaSAlistair Francis continue; 304a714b8aaSAlistair Francis } 305a714b8aaSAlistair Francis if (provide_rdtime) { 306a714b8aaSAlistair Francis riscv_cpu_set_rdtime_fn(env, cpu_riscv_read_rtc, timebase_freq); 307a714b8aaSAlistair Francis } 308a714b8aaSAlistair Francis 309b8fb878aSAnup Patel cb->s = RISCV_ACLINT_MTIMER(dev); 310a714b8aaSAlistair Francis cb->num = i; 311a714b8aaSAlistair Francis env->timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, 312b8fb878aSAnup Patel &riscv_aclint_mtimer_cb, cb); 313a714b8aaSAlistair Francis env->timecmp = 0; 314a714b8aaSAlistair Francis 315a714b8aaSAlistair Francis qdev_connect_gpio_out(dev, i, 316a714b8aaSAlistair Francis qdev_get_gpio_in(DEVICE(rvcpu), IRQ_M_TIMER)); 317a714b8aaSAlistair Francis } 318a714b8aaSAlistair Francis 3191c77c410SMichael Clark return dev; 3201c77c410SMichael Clark } 321b8fb878aSAnup Patel 322b8fb878aSAnup Patel /* CPU read [M|S]SWI register */ 323b8fb878aSAnup Patel static uint64_t riscv_aclint_swi_read(void *opaque, hwaddr addr, 324b8fb878aSAnup Patel unsigned size) 325b8fb878aSAnup Patel { 326b8fb878aSAnup Patel RISCVAclintSwiState *swi = opaque; 327b8fb878aSAnup Patel 328b8fb878aSAnup Patel if (addr < (swi->num_harts << 2)) { 329b8fb878aSAnup Patel size_t hartid = swi->hartid_base + (addr >> 2); 330b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 331b8fb878aSAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 332b8fb878aSAnup Patel if (!env) { 333b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 334b8fb878aSAnup Patel "aclint-swi: invalid hartid: %zu", hartid); 335b8fb878aSAnup Patel } else if ((addr & 0x3) == 0) { 336b8fb878aSAnup Patel return (swi->sswi) ? 0 : ((env->mip & MIP_MSIP) > 0); 337b8fb878aSAnup Patel } 338b8fb878aSAnup Patel } 339b8fb878aSAnup Patel 340b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 341b8fb878aSAnup Patel "aclint-swi: invalid read: %08x", (uint32_t)addr); 342b8fb878aSAnup Patel return 0; 343b8fb878aSAnup Patel } 344b8fb878aSAnup Patel 345b8fb878aSAnup Patel /* CPU write [M|S]SWI register */ 346b8fb878aSAnup Patel static void riscv_aclint_swi_write(void *opaque, hwaddr addr, uint64_t value, 347b8fb878aSAnup Patel unsigned size) 348b8fb878aSAnup Patel { 349b8fb878aSAnup Patel RISCVAclintSwiState *swi = opaque; 350b8fb878aSAnup Patel 351b8fb878aSAnup Patel if (addr < (swi->num_harts << 2)) { 352b8fb878aSAnup Patel size_t hartid = swi->hartid_base + (addr >> 2); 353b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid); 354b8fb878aSAnup Patel CPURISCVState *env = cpu ? cpu->env_ptr : NULL; 355b8fb878aSAnup Patel if (!env) { 356b8fb878aSAnup Patel qemu_log_mask(LOG_GUEST_ERROR, 357b8fb878aSAnup Patel "aclint-swi: invalid hartid: %zu", hartid); 358b8fb878aSAnup Patel } else if ((addr & 0x3) == 0) { 359b8fb878aSAnup Patel if (value & 0x1) { 360b8fb878aSAnup Patel qemu_irq_raise(swi->soft_irqs[hartid - swi->hartid_base]); 361b8fb878aSAnup Patel } else { 362b8fb878aSAnup Patel if (!swi->sswi) { 363b8fb878aSAnup Patel qemu_irq_lower(swi->soft_irqs[hartid - swi->hartid_base]); 364b8fb878aSAnup Patel } 365b8fb878aSAnup Patel } 366b8fb878aSAnup Patel return; 367b8fb878aSAnup Patel } 368b8fb878aSAnup Patel } 369b8fb878aSAnup Patel 370b8fb878aSAnup Patel qemu_log_mask(LOG_UNIMP, 371b8fb878aSAnup Patel "aclint-swi: invalid write: %08x", (uint32_t)addr); 372b8fb878aSAnup Patel } 373b8fb878aSAnup Patel 374b8fb878aSAnup Patel static const MemoryRegionOps riscv_aclint_swi_ops = { 375b8fb878aSAnup Patel .read = riscv_aclint_swi_read, 376b8fb878aSAnup Patel .write = riscv_aclint_swi_write, 377b8fb878aSAnup Patel .endianness = DEVICE_LITTLE_ENDIAN, 378b8fb878aSAnup Patel .valid = { 379b8fb878aSAnup Patel .min_access_size = 4, 380b8fb878aSAnup Patel .max_access_size = 4 381b8fb878aSAnup Patel } 382b8fb878aSAnup Patel }; 383b8fb878aSAnup Patel 384b8fb878aSAnup Patel static Property riscv_aclint_swi_properties[] = { 385b8fb878aSAnup Patel DEFINE_PROP_UINT32("hartid-base", RISCVAclintSwiState, hartid_base, 0), 386b8fb878aSAnup Patel DEFINE_PROP_UINT32("num-harts", RISCVAclintSwiState, num_harts, 1), 387b8fb878aSAnup Patel DEFINE_PROP_UINT32("sswi", RISCVAclintSwiState, sswi, false), 388b8fb878aSAnup Patel DEFINE_PROP_END_OF_LIST(), 389b8fb878aSAnup Patel }; 390b8fb878aSAnup Patel 391b8fb878aSAnup Patel static void riscv_aclint_swi_realize(DeviceState *dev, Error **errp) 392b8fb878aSAnup Patel { 393b8fb878aSAnup Patel RISCVAclintSwiState *swi = RISCV_ACLINT_SWI(dev); 394b8fb878aSAnup Patel int i; 395b8fb878aSAnup Patel 396b8fb878aSAnup Patel memory_region_init_io(&swi->mmio, OBJECT(dev), &riscv_aclint_swi_ops, swi, 397b8fb878aSAnup Patel TYPE_RISCV_ACLINT_SWI, RISCV_ACLINT_SWI_SIZE); 398b8fb878aSAnup Patel sysbus_init_mmio(SYS_BUS_DEVICE(dev), &swi->mmio); 399b8fb878aSAnup Patel 400b21e2380SMarkus Armbruster swi->soft_irqs = g_new(qemu_irq, swi->num_harts); 401b8fb878aSAnup Patel qdev_init_gpio_out(dev, swi->soft_irqs, swi->num_harts); 402b8fb878aSAnup Patel 403b8fb878aSAnup Patel /* Claim software interrupt bits */ 404b8fb878aSAnup Patel for (i = 0; i < swi->num_harts; i++) { 405b8fb878aSAnup Patel RISCVCPU *cpu = RISCV_CPU(qemu_get_cpu(swi->hartid_base + i)); 406b8fb878aSAnup Patel /* We don't claim mip.SSIP because it is writeable by software */ 407b8fb878aSAnup Patel if (riscv_cpu_claim_interrupts(cpu, swi->sswi ? 0 : MIP_MSIP) < 0) { 408b8fb878aSAnup Patel error_report("MSIP already claimed"); 409b8fb878aSAnup Patel exit(1); 410b8fb878aSAnup Patel } 411b8fb878aSAnup Patel } 412b8fb878aSAnup Patel } 413b8fb878aSAnup Patel 414b8fb878aSAnup Patel static void riscv_aclint_swi_class_init(ObjectClass *klass, void *data) 415b8fb878aSAnup Patel { 416b8fb878aSAnup Patel DeviceClass *dc = DEVICE_CLASS(klass); 417b8fb878aSAnup Patel dc->realize = riscv_aclint_swi_realize; 418b8fb878aSAnup Patel device_class_set_props(dc, riscv_aclint_swi_properties); 419b8fb878aSAnup Patel } 420b8fb878aSAnup Patel 421b8fb878aSAnup Patel static const TypeInfo riscv_aclint_swi_info = { 422b8fb878aSAnup Patel .name = TYPE_RISCV_ACLINT_SWI, 423b8fb878aSAnup Patel .parent = TYPE_SYS_BUS_DEVICE, 424b8fb878aSAnup Patel .instance_size = sizeof(RISCVAclintSwiState), 425b8fb878aSAnup Patel .class_init = riscv_aclint_swi_class_init, 426b8fb878aSAnup Patel }; 427b8fb878aSAnup Patel 428b8fb878aSAnup Patel /* 429b8fb878aSAnup Patel * Create ACLINT [M|S]SWI device. 430b8fb878aSAnup Patel */ 431b8fb878aSAnup Patel DeviceState *riscv_aclint_swi_create(hwaddr addr, uint32_t hartid_base, 432b8fb878aSAnup Patel uint32_t num_harts, bool sswi) 433b8fb878aSAnup Patel { 434b8fb878aSAnup Patel int i; 435b8fb878aSAnup Patel DeviceState *dev = qdev_new(TYPE_RISCV_ACLINT_SWI); 436b8fb878aSAnup Patel 437b8fb878aSAnup Patel assert(num_harts <= RISCV_ACLINT_MAX_HARTS); 438b8fb878aSAnup Patel assert(!(addr & 0x3)); 439b8fb878aSAnup Patel 440b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "hartid-base", hartid_base); 441b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "num-harts", num_harts); 442b8fb878aSAnup Patel qdev_prop_set_uint32(dev, "sswi", sswi ? true : false); 443b8fb878aSAnup Patel sysbus_realize_and_unref(SYS_BUS_DEVICE(dev), &error_fatal); 444b8fb878aSAnup Patel sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, addr); 445b8fb878aSAnup Patel 446b8fb878aSAnup Patel for (i = 0; i < num_harts; i++) { 447b8fb878aSAnup Patel CPUState *cpu = qemu_get_cpu(hartid_base + i); 448b8fb878aSAnup Patel RISCVCPU *rvcpu = RISCV_CPU(cpu); 449b8fb878aSAnup Patel 450b8fb878aSAnup Patel qdev_connect_gpio_out(dev, i, 451b8fb878aSAnup Patel qdev_get_gpio_in(DEVICE(rvcpu), 452b8fb878aSAnup Patel (sswi) ? IRQ_S_SOFT : IRQ_M_SOFT)); 453b8fb878aSAnup Patel } 454b8fb878aSAnup Patel 455b8fb878aSAnup Patel return dev; 456b8fb878aSAnup Patel } 457b8fb878aSAnup Patel 458b8fb878aSAnup Patel static void riscv_aclint_register_types(void) 459b8fb878aSAnup Patel { 460b8fb878aSAnup Patel type_register_static(&riscv_aclint_mtimer_info); 461b8fb878aSAnup Patel type_register_static(&riscv_aclint_swi_info); 462b8fb878aSAnup Patel } 463b8fb878aSAnup Patel 464b8fb878aSAnup Patel type_init(riscv_aclint_register_types) 465