1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include "qemu/osdep.h"
26#include "hw/irq.h"
27#include "hw/qdev-properties.h"
28#include "hw/sparc/sun4m_iommu.h"
29#include "hw/sysbus.h"
30#include "migration/vmstate.h"
31#include "qemu/module.h"
32#include "exec/address-spaces.h"
33#include "trace.h"
34
35
36
37
38
39
40
41
42
43#define IOMMU_CTRL (0x0000 >> 2)
44#define IOMMU_CTRL_IMPL 0xf0000000
45#define IOMMU_CTRL_VERS 0x0f000000
46#define IOMMU_CTRL_RNGE 0x0000001c
47#define IOMMU_RNGE_16MB 0x00000000
48#define IOMMU_RNGE_32MB 0x00000004
49#define IOMMU_RNGE_64MB 0x00000008
50#define IOMMU_RNGE_128MB 0x0000000c
51#define IOMMU_RNGE_256MB 0x00000010
52#define IOMMU_RNGE_512MB 0x00000014
53#define IOMMU_RNGE_1GB 0x00000018
54#define IOMMU_RNGE_2GB 0x0000001c
55#define IOMMU_CTRL_ENAB 0x00000001
56#define IOMMU_CTRL_MASK 0x0000001d
57
58#define IOMMU_BASE (0x0004 >> 2)
59#define IOMMU_BASE_MASK 0x07fffc00
60
61#define IOMMU_TLBFLUSH (0x0014 >> 2)
62#define IOMMU_TLBFLUSH_MASK 0xffffffff
63
64#define IOMMU_PGFLUSH (0x0018 >> 2)
65#define IOMMU_PGFLUSH_MASK 0xffffffff
66
67#define IOMMU_AFSR (0x1000 >> 2)
68#define IOMMU_AFSR_ERR 0x80000000
69#define IOMMU_AFSR_LE 0x40000000
70
71#define IOMMU_AFSR_TO 0x20000000
72
73#define IOMMU_AFSR_BE 0x10000000
74
75#define IOMMU_AFSR_SIZE 0x0e000000
76#define IOMMU_AFSR_S 0x01000000
77#define IOMMU_AFSR_RESV 0x00800000
78
79#define IOMMU_AFSR_ME 0x00080000
80#define IOMMU_AFSR_RD 0x00040000
81#define IOMMU_AFSR_FAV 0x00020000
82#define IOMMU_AFSR_MASK 0xff0fffff
83
84#define IOMMU_AFAR (0x1004 >> 2)
85
86#define IOMMU_AER (0x1008 >> 2)
87#define IOMMU_AER_EN_P0_ARB 0x00000001
88#define IOMMU_AER_EN_P1_ARB 0x00000002
89#define IOMMU_AER_EN_P2_ARB 0x00000004
90#define IOMMU_AER_EN_P3_ARB 0x00000008
91#define IOMMU_AER_EN_0 0x00010000
92#define IOMMU_AER_EN_1 0x00020000
93#define IOMMU_AER_EN_2 0x00040000
94#define IOMMU_AER_EN_3 0x00080000
95#define IOMMU_AER_EN_F 0x00100000
96#define IOMMU_AER_SBW 0x80000000
97#define IOMMU_AER_MASK 0x801f000f
98
99#define IOMMU_SBCFG0 (0x1010 >> 2)
100#define IOMMU_SBCFG1 (0x1014 >> 2)
101#define IOMMU_SBCFG2 (0x1018 >> 2)
102#define IOMMU_SBCFG3 (0x101c >> 2)
103#define IOMMU_SBCFG_SAB30 0x00010000
104
105#define IOMMU_SBCFG_BA16 0x00000004
106#define IOMMU_SBCFG_BA8 0x00000002
107#define IOMMU_SBCFG_BYPASS 0x00000001
108
109
110#define IOMMU_SBCFG_MASK 0x00010003
111
112#define IOMMU_ARBEN (0x2000 >> 2)
113#define IOMMU_ARBEN_MASK 0x001f0000
114#define IOMMU_MID 0x00000008
115
116#define IOMMU_MASK_ID (0x3018 >> 2)
117#define IOMMU_MASK_ID_MASK 0x00ffffff
118
119#define IOMMU_MSII_MASK 0x26000000
120#define IOMMU_TS_MASK 0x23000000
121
122
123#define IOPTE_PAGE 0xffffff00
124#define IOPTE_CACHE 0x00000080
125
126#define IOPTE_WRITE 0x00000004
127#define IOPTE_VALID 0x00000002
128#define IOPTE_WAZ 0x00000001
129
130#define IOMMU_PAGE_SHIFT 12
131#define IOMMU_PAGE_SIZE (1 << IOMMU_PAGE_SHIFT)
132#define IOMMU_PAGE_MASK (~(IOMMU_PAGE_SIZE - 1))
133
134static uint64_t iommu_mem_read(void *opaque, hwaddr addr,
135 unsigned size)
136{
137 IOMMUState *s = opaque;
138 hwaddr saddr;
139 uint32_t ret;
140
141 saddr = addr >> 2;
142 switch (saddr) {
143 default:
144 ret = s->regs[saddr];
145 break;
146 case IOMMU_AFAR:
147 case IOMMU_AFSR:
148 ret = s->regs[saddr];
149 qemu_irq_lower(s->irq);
150 break;
151 }
152 trace_sun4m_iommu_mem_readl(saddr, ret);
153 return ret;
154}
155
156static void iommu_mem_write(void *opaque, hwaddr addr,
157 uint64_t val, unsigned size)
158{
159 IOMMUState *s = opaque;
160 hwaddr saddr;
161
162 saddr = addr >> 2;
163 trace_sun4m_iommu_mem_writel(saddr, val);
164 switch (saddr) {
165 case IOMMU_CTRL:
166 switch (val & IOMMU_CTRL_RNGE) {
167 case IOMMU_RNGE_16MB:
168 s->iostart = 0xffffffffff000000ULL;
169 break;
170 case IOMMU_RNGE_32MB:
171 s->iostart = 0xfffffffffe000000ULL;
172 break;
173 case IOMMU_RNGE_64MB:
174 s->iostart = 0xfffffffffc000000ULL;
175 break;
176 case IOMMU_RNGE_128MB:
177 s->iostart = 0xfffffffff8000000ULL;
178 break;
179 case IOMMU_RNGE_256MB:
180 s->iostart = 0xfffffffff0000000ULL;
181 break;
182 case IOMMU_RNGE_512MB:
183 s->iostart = 0xffffffffe0000000ULL;
184 break;
185 case IOMMU_RNGE_1GB:
186 s->iostart = 0xffffffffc0000000ULL;
187 break;
188 default:
189 case IOMMU_RNGE_2GB:
190 s->iostart = 0xffffffff80000000ULL;
191 break;
192 }
193 trace_sun4m_iommu_mem_writel_ctrl(s->iostart);
194 s->regs[saddr] = ((val & IOMMU_CTRL_MASK) | s->version);
195 break;
196 case IOMMU_BASE:
197 s->regs[saddr] = val & IOMMU_BASE_MASK;
198 break;
199 case IOMMU_TLBFLUSH:
200 trace_sun4m_iommu_mem_writel_tlbflush(val);
201 s->regs[saddr] = val & IOMMU_TLBFLUSH_MASK;
202 break;
203 case IOMMU_PGFLUSH:
204 trace_sun4m_iommu_mem_writel_pgflush(val);
205 s->regs[saddr] = val & IOMMU_PGFLUSH_MASK;
206 break;
207 case IOMMU_AFAR:
208 s->regs[saddr] = val;
209 qemu_irq_lower(s->irq);
210 break;
211 case IOMMU_AER:
212 s->regs[saddr] = (val & IOMMU_AER_MASK) | IOMMU_AER_EN_P0_ARB;
213 break;
214 case IOMMU_AFSR:
215 s->regs[saddr] = (val & IOMMU_AFSR_MASK) | IOMMU_AFSR_RESV;
216 qemu_irq_lower(s->irq);
217 break;
218 case IOMMU_SBCFG0:
219 case IOMMU_SBCFG1:
220 case IOMMU_SBCFG2:
221 case IOMMU_SBCFG3:
222 s->regs[saddr] = val & IOMMU_SBCFG_MASK;
223 break;
224 case IOMMU_ARBEN:
225
226
227 s->regs[saddr] = (val & IOMMU_ARBEN_MASK) | IOMMU_MID;
228 break;
229 case IOMMU_MASK_ID:
230 s->regs[saddr] |= val & IOMMU_MASK_ID_MASK;
231 break;
232 default:
233 s->regs[saddr] = val;
234 break;
235 }
236}
237
238static const MemoryRegionOps iommu_mem_ops = {
239 .read = iommu_mem_read,
240 .write = iommu_mem_write,
241 .endianness = DEVICE_NATIVE_ENDIAN,
242 .valid = {
243 .min_access_size = 4,
244 .max_access_size = 4,
245 },
246};
247
248static uint32_t iommu_page_get_flags(IOMMUState *s, hwaddr addr)
249{
250 uint32_t ret;
251 hwaddr iopte;
252 hwaddr pa = addr;
253
254 iopte = s->regs[IOMMU_BASE] << 4;
255 addr &= ~s->iostart;
256 iopte += (addr >> (IOMMU_PAGE_SHIFT - 2)) & ~3;
257 ret = address_space_ldl_be(&address_space_memory, iopte,
258 MEMTXATTRS_UNSPECIFIED, NULL);
259 trace_sun4m_iommu_page_get_flags(pa, iopte, ret);
260 return ret;
261}
262
263static hwaddr iommu_translate_pa(hwaddr addr,
264 uint32_t pte)
265{
266 hwaddr pa;
267
268 pa = ((pte & IOPTE_PAGE) << 4) + (addr & ~IOMMU_PAGE_MASK);
269 trace_sun4m_iommu_translate_pa(addr, pa, pte);
270 return pa;
271}
272
273static void iommu_bad_addr(IOMMUState *s, hwaddr addr,
274 int is_write)
275{
276 trace_sun4m_iommu_bad_addr(addr);
277 s->regs[IOMMU_AFSR] = IOMMU_AFSR_ERR | IOMMU_AFSR_LE | IOMMU_AFSR_RESV |
278 IOMMU_AFSR_FAV;
279 if (!is_write) {
280 s->regs[IOMMU_AFSR] |= IOMMU_AFSR_RD;
281 }
282 s->regs[IOMMU_AFAR] = addr;
283 qemu_irq_raise(s->irq);
284}
285
286
287static IOMMUTLBEntry sun4m_translate_iommu(IOMMUMemoryRegion *iommu,
288 hwaddr addr,
289 IOMMUAccessFlags flags,
290 int iommu_idx)
291{
292 IOMMUState *is = container_of(iommu, IOMMUState, iommu);
293 hwaddr page, pa;
294 int is_write = (flags & IOMMU_WO) ? 1 : 0;
295 uint32_t pte;
296 IOMMUTLBEntry ret = {
297 .target_as = &address_space_memory,
298 .iova = 0,
299 .translated_addr = 0,
300 .addr_mask = ~(hwaddr)0,
301 .perm = IOMMU_NONE,
302 };
303
304 page = addr & IOMMU_PAGE_MASK;
305 pte = iommu_page_get_flags(is, page);
306 if (!(pte & IOPTE_VALID)) {
307 iommu_bad_addr(is, page, is_write);
308 return ret;
309 }
310
311 pa = iommu_translate_pa(addr, pte);
312 if (is_write && !(pte & IOPTE_WRITE)) {
313 iommu_bad_addr(is, page, is_write);
314 return ret;
315 }
316
317 if (pte & IOPTE_WRITE) {
318 ret.perm = IOMMU_RW;
319 } else {
320 ret.perm = IOMMU_RO;
321 }
322
323 ret.iova = page;
324 ret.translated_addr = pa;
325 ret.addr_mask = ~IOMMU_PAGE_MASK;
326
327 return ret;
328}
329
330static const VMStateDescription vmstate_iommu = {
331 .name = "iommu",
332 .version_id = 2,
333 .minimum_version_id = 2,
334 .fields = (VMStateField[]) {
335 VMSTATE_UINT32_ARRAY(regs, IOMMUState, IOMMU_NREGS),
336 VMSTATE_UINT64(iostart, IOMMUState),
337 VMSTATE_END_OF_LIST()
338 }
339};
340
341static void iommu_reset(DeviceState *d)
342{
343 IOMMUState *s = SUN4M_IOMMU(d);
344
345 memset(s->regs, 0, IOMMU_NREGS * 4);
346 s->iostart = 0;
347 s->regs[IOMMU_CTRL] = s->version;
348 s->regs[IOMMU_ARBEN] = IOMMU_MID;
349 s->regs[IOMMU_AFSR] = IOMMU_AFSR_RESV;
350 s->regs[IOMMU_AER] = IOMMU_AER_EN_P0_ARB | IOMMU_AER_EN_P1_ARB;
351 s->regs[IOMMU_MASK_ID] = IOMMU_TS_MASK;
352}
353
354static void iommu_init(Object *obj)
355{
356 IOMMUState *s = SUN4M_IOMMU(obj);
357 SysBusDevice *dev = SYS_BUS_DEVICE(obj);
358
359 memory_region_init_iommu(&s->iommu, sizeof(s->iommu),
360 TYPE_SUN4M_IOMMU_MEMORY_REGION, OBJECT(dev),
361 "iommu-sun4m", UINT64_MAX);
362 address_space_init(&s->iommu_as, MEMORY_REGION(&s->iommu), "iommu-as");
363
364 sysbus_init_irq(dev, &s->irq);
365
366 memory_region_init_io(&s->iomem, obj, &iommu_mem_ops, s, "iommu",
367 IOMMU_NREGS * sizeof(uint32_t));
368 sysbus_init_mmio(dev, &s->iomem);
369}
370
371static Property iommu_properties[] = {
372 DEFINE_PROP_UINT32("version", IOMMUState, version, 0),
373 DEFINE_PROP_END_OF_LIST(),
374};
375
376static void iommu_class_init(ObjectClass *klass, void *data)
377{
378 DeviceClass *dc = DEVICE_CLASS(klass);
379
380 dc->reset = iommu_reset;
381 dc->vmsd = &vmstate_iommu;
382 device_class_set_props(dc, iommu_properties);
383}
384
385static const TypeInfo iommu_info = {
386 .name = TYPE_SUN4M_IOMMU,
387 .parent = TYPE_SYS_BUS_DEVICE,
388 .instance_size = sizeof(IOMMUState),
389 .instance_init = iommu_init,
390 .class_init = iommu_class_init,
391};
392
393static void sun4m_iommu_memory_region_class_init(ObjectClass *klass, void *data)
394{
395 IOMMUMemoryRegionClass *imrc = IOMMU_MEMORY_REGION_CLASS(klass);
396
397 imrc->translate = sun4m_translate_iommu;
398}
399
400static const TypeInfo sun4m_iommu_memory_region_info = {
401 .parent = TYPE_IOMMU_MEMORY_REGION,
402 .name = TYPE_SUN4M_IOMMU_MEMORY_REGION,
403 .class_init = sun4m_iommu_memory_region_class_init,
404};
405
406static void iommu_register_types(void)
407{
408 type_register_static(&iommu_info);
409 type_register_static(&sun4m_iommu_memory_region_info);
410}
411
412type_init(iommu_register_types)
413