1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include "qemu/osdep.h"
23#include "qemu/error-report.h"
24#include "qemu/module.h"
25#include "hw/sysbus.h"
26#include "target/riscv/cpu.h"
27#include "hw/qdev-properties.h"
28#include "hw/riscv/sifive_clint.h"
29#include "qemu/timer.h"
30
31static uint64_t cpu_riscv_read_rtc(void)
32{
33 return muldiv64(qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL),
34 SIFIVE_CLINT_TIMEBASE_FREQ, NANOSECONDS_PER_SECOND);
35}
36
37
38
39
40
41static void sifive_clint_write_timecmp(RISCVCPU *cpu, uint64_t value)
42{
43 uint64_t next;
44 uint64_t diff;
45
46 uint64_t rtc_r = cpu_riscv_read_rtc();
47
48 cpu->env.timecmp = value;
49 if (cpu->env.timecmp <= rtc_r) {
50
51
52 riscv_cpu_update_mip(cpu, MIP_MTIP, BOOL_TO_MASK(1));
53 return;
54 }
55
56
57 riscv_cpu_update_mip(cpu, MIP_MTIP, BOOL_TO_MASK(0));
58 diff = cpu->env.timecmp - rtc_r;
59
60 next = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) +
61 muldiv64(diff, NANOSECONDS_PER_SECOND, SIFIVE_CLINT_TIMEBASE_FREQ);
62 timer_mod(cpu->env.timer, next);
63}
64
65
66
67
68
69static void sifive_clint_timer_cb(void *opaque)
70{
71 RISCVCPU *cpu = opaque;
72 riscv_cpu_update_mip(cpu, MIP_MTIP, BOOL_TO_MASK(1));
73}
74
75
76static uint64_t sifive_clint_read(void *opaque, hwaddr addr, unsigned size)
77{
78 SiFiveCLINTState *clint = opaque;
79 if (addr >= clint->sip_base &&
80 addr < clint->sip_base + (clint->num_harts << 2)) {
81 size_t hartid = (addr - clint->sip_base) >> 2;
82 CPUState *cpu = qemu_get_cpu(hartid);
83 CPURISCVState *env = cpu ? cpu->env_ptr : NULL;
84 if (!env) {
85 error_report("clint: invalid timecmp hartid: %zu", hartid);
86 } else if ((addr & 0x3) == 0) {
87 return (env->mip & MIP_MSIP) > 0;
88 } else {
89 error_report("clint: invalid read: %08x", (uint32_t)addr);
90 return 0;
91 }
92 } else if (addr >= clint->timecmp_base &&
93 addr < clint->timecmp_base + (clint->num_harts << 3)) {
94 size_t hartid = (addr - clint->timecmp_base) >> 3;
95 CPUState *cpu = qemu_get_cpu(hartid);
96 CPURISCVState *env = cpu ? cpu->env_ptr : NULL;
97 if (!env) {
98 error_report("clint: invalid timecmp hartid: %zu", hartid);
99 } else if ((addr & 0x7) == 0) {
100
101 uint64_t timecmp = env->timecmp;
102 return timecmp & 0xFFFFFFFF;
103 } else if ((addr & 0x7) == 4) {
104
105 uint64_t timecmp = env->timecmp;
106 return (timecmp >> 32) & 0xFFFFFFFF;
107 } else {
108 error_report("clint: invalid read: %08x", (uint32_t)addr);
109 return 0;
110 }
111 } else if (addr == clint->time_base) {
112
113 return cpu_riscv_read_rtc() & 0xFFFFFFFF;
114 } else if (addr == clint->time_base + 4) {
115
116 return (cpu_riscv_read_rtc() >> 32) & 0xFFFFFFFF;
117 }
118
119 error_report("clint: invalid read: %08x", (uint32_t)addr);
120 return 0;
121}
122
123
124static void sifive_clint_write(void *opaque, hwaddr addr, uint64_t value,
125 unsigned size)
126{
127 SiFiveCLINTState *clint = opaque;
128
129 if (addr >= clint->sip_base &&
130 addr < clint->sip_base + (clint->num_harts << 2)) {
131 size_t hartid = (addr - clint->sip_base) >> 2;
132 CPUState *cpu = qemu_get_cpu(hartid);
133 CPURISCVState *env = cpu ? cpu->env_ptr : NULL;
134 if (!env) {
135 error_report("clint: invalid timecmp hartid: %zu", hartid);
136 } else if ((addr & 0x3) == 0) {
137 riscv_cpu_update_mip(RISCV_CPU(cpu), MIP_MSIP, BOOL_TO_MASK(value));
138 } else {
139 error_report("clint: invalid sip write: %08x", (uint32_t)addr);
140 }
141 return;
142 } else if (addr >= clint->timecmp_base &&
143 addr < clint->timecmp_base + (clint->num_harts << 3)) {
144 size_t hartid = (addr - clint->timecmp_base) >> 3;
145 CPUState *cpu = qemu_get_cpu(hartid);
146 CPURISCVState *env = cpu ? cpu->env_ptr : NULL;
147 if (!env) {
148 error_report("clint: invalid timecmp hartid: %zu", hartid);
149 } else if ((addr & 0x7) == 0) {
150
151 uint64_t timecmp_hi = env->timecmp >> 32;
152 sifive_clint_write_timecmp(RISCV_CPU(cpu),
153 timecmp_hi << 32 | (value & 0xFFFFFFFF));
154 return;
155 } else if ((addr & 0x7) == 4) {
156
157 uint64_t timecmp_lo = env->timecmp;
158 sifive_clint_write_timecmp(RISCV_CPU(cpu),
159 value << 32 | (timecmp_lo & 0xFFFFFFFF));
160 } else {
161 error_report("clint: invalid timecmp write: %08x", (uint32_t)addr);
162 }
163 return;
164 } else if (addr == clint->time_base) {
165
166 error_report("clint: time_lo write not implemented");
167 return;
168 } else if (addr == clint->time_base + 4) {
169
170 error_report("clint: time_hi write not implemented");
171 return;
172 }
173
174 error_report("clint: invalid write: %08x", (uint32_t)addr);
175}
176
177static const MemoryRegionOps sifive_clint_ops = {
178 .read = sifive_clint_read,
179 .write = sifive_clint_write,
180 .endianness = DEVICE_LITTLE_ENDIAN,
181 .valid = {
182 .min_access_size = 4,
183 .max_access_size = 4
184 }
185};
186
187static Property sifive_clint_properties[] = {
188 DEFINE_PROP_UINT32("num-harts", SiFiveCLINTState, num_harts, 0),
189 DEFINE_PROP_UINT32("sip-base", SiFiveCLINTState, sip_base, 0),
190 DEFINE_PROP_UINT32("timecmp-base", SiFiveCLINTState, timecmp_base, 0),
191 DEFINE_PROP_UINT32("time-base", SiFiveCLINTState, time_base, 0),
192 DEFINE_PROP_UINT32("aperture-size", SiFiveCLINTState, aperture_size, 0),
193 DEFINE_PROP_END_OF_LIST(),
194};
195
196static void sifive_clint_realize(DeviceState *dev, Error **errp)
197{
198 SiFiveCLINTState *s = SIFIVE_CLINT(dev);
199 memory_region_init_io(&s->mmio, OBJECT(dev), &sifive_clint_ops, s,
200 TYPE_SIFIVE_CLINT, s->aperture_size);
201 sysbus_init_mmio(SYS_BUS_DEVICE(dev), &s->mmio);
202}
203
204static void sifive_clint_class_init(ObjectClass *klass, void *data)
205{
206 DeviceClass *dc = DEVICE_CLASS(klass);
207 dc->realize = sifive_clint_realize;
208 dc->props = sifive_clint_properties;
209}
210
211static const TypeInfo sifive_clint_info = {
212 .name = TYPE_SIFIVE_CLINT,
213 .parent = TYPE_SYS_BUS_DEVICE,
214 .instance_size = sizeof(SiFiveCLINTState),
215 .class_init = sifive_clint_class_init,
216};
217
218static void sifive_clint_register_types(void)
219{
220 type_register_static(&sifive_clint_info);
221}
222
223type_init(sifive_clint_register_types)
224
225
226
227
228
229DeviceState *sifive_clint_create(hwaddr addr, hwaddr size, uint32_t num_harts,
230 uint32_t sip_base, uint32_t timecmp_base, uint32_t time_base)
231{
232 int i;
233 for (i = 0; i < num_harts; i++) {
234 CPUState *cpu = qemu_get_cpu(i);
235 CPURISCVState *env = cpu ? cpu->env_ptr : NULL;
236 if (!env) {
237 continue;
238 }
239 env->timer = timer_new_ns(QEMU_CLOCK_VIRTUAL,
240 &sifive_clint_timer_cb, cpu);
241 env->timecmp = 0;
242 }
243
244 DeviceState *dev = qdev_create(NULL, TYPE_SIFIVE_CLINT);
245 qdev_prop_set_uint32(dev, "num-harts", num_harts);
246 qdev_prop_set_uint32(dev, "sip-base", sip_base);
247 qdev_prop_set_uint32(dev, "timecmp-base", timecmp_base);
248 qdev_prop_set_uint32(dev, "time-base", time_base);
249 qdev_prop_set_uint32(dev, "aperture-size", size);
250 qdev_init_nofail(dev);
251 sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, addr);
252 return dev;
253}
254