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