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