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