@samitouri / QOSamiQemu
Code Commits Issues Pulls Sessions CI/CD
master
master
c 221 lines 5.53 KB
Raw
1 /*
2 * ColdFire Interrupt Controller emulation.
3 *
4 * Copyright (c) 2007 CodeSourcery.
5 *
6 * This code is licensed under the GPL
7 */
8
9 #include "qemu/osdep.h"
10 #include "qapi/error.h"
11 #include "qemu/module.h"
12 #include "qemu/log.h"
13 #include "target/m68k/cpu.h"
14 #include "hw/core/irq.h"
15 #include "hw/core/sysbus.h"
16 #include "hw/m68k/mcf.h"
17 #include "hw/core/qdev-properties.h"
18 #include "qom/object.h"
19
20 #define TYPE_MCF_INTC "mcf-intc"
21 OBJECT_DECLARE_SIMPLE_TYPE(mcf_intc_state, MCF_INTC)
22
23 struct mcf_intc_state {
24 SysBusDevice parent_obj;
25
26 MemoryRegion iomem;
27 uint64_t ipr;
28 uint64_t imr;
29 uint64_t ifr;
30 uint64_t enabled;
31 uint8_t icr[64];
32 M68kCPU *cpu;
33 int active_vector;
34 };
35
36 static void mcf_intc_update(mcf_intc_state *s)
37 {
38 uint64_t active;
39 int i;
40 int best;
41 int best_level;
42
43 active = (s->ipr | s->ifr) & s->enabled & ~s->imr;
44 best_level = 0;
45 best = 64;
46 if (active) {
47 for (i = 0; i < 64; i++) {
48 if ((active & 1) != 0 && s->icr[i] >= best_level) {
49 best_level = s->icr[i];
50 best = i;
51 }
52 active >>= 1;
53 }
54 }
55 s->active_vector = ((best == 64) ? 24 : (best + 64));
56 m68k_set_irq_level(s->cpu, best_level, s->active_vector);
57 }
58
59 static uint64_t mcf_intc_read(void *opaque, hwaddr addr,
60 unsigned size)
61 {
62 int offset;
63 mcf_intc_state *s = (mcf_intc_state *)opaque;
64 offset = addr & 0xff;
65 if (offset >= 0x40 && offset < 0x80) {
66 return s->icr[offset - 0x40];
67 }
68 switch (offset) {
69 case 0x00:
70 return (uint32_t)(s->ipr >> 32);
71 case 0x04:
72 return (uint32_t)s->ipr;
73 case 0x08:
74 return (uint32_t)(s->imr >> 32);
75 case 0x0c:
76 return (uint32_t)s->imr;
77 case 0x10:
78 return (uint32_t)(s->ifr >> 32);
79 case 0x14:
80 return (uint32_t)s->ifr;
81 case 0xe0: /* SWIACK. */
82 return s->active_vector;
83 case 0xe1: case 0xe2: case 0xe3: case 0xe4:
84 case 0xe5: case 0xe6: case 0xe7:
85 /* LnIACK */
86 qemu_log_mask(LOG_UNIMP, "%s: LnIACK not implemented (offset 0x%02x)\n",
87 __func__, offset);
88 /* fallthru */
89 default:
90 return 0;
91 }
92 }
93
94 static void mcf_intc_write(void *opaque, hwaddr addr,
95 uint64_t val, unsigned size)
96 {
97 int offset;
98 mcf_intc_state *s = (mcf_intc_state *)opaque;
99 offset = addr & 0xff;
100 if (offset >= 0x40 && offset < 0x80) {
101 int n = offset - 0x40;
102 s->icr[n] = val;
103 if (val == 0)
104 s->enabled &= ~(1ull << n);
105 else
106 s->enabled |= (1ull << n);
107 mcf_intc_update(s);
108 return;
109 }
110 switch (offset) {
111 case 0x00: case 0x04:
112 /* Ignore IPR writes. */
113 return;
114 case 0x08:
115 s->imr = (s->imr & 0xffffffff) | ((uint64_t)val << 32);
116 break;
117 case 0x0c:
118 s->imr = (s->imr & 0xffffffff00000000ull) | (uint32_t)val;
119 break;
120 case 0x1c:
121 if (val & 0x40) {
122 s->imr = ~0ull;
123 } else {
124 s->imr |= (0x1ull << (val & 0x3f));
125 }
126 break;
127 case 0x1d:
128 if (val & 0x40) {
129 s->imr = 0ull;
130 } else {
131 s->imr &= ~(0x1ull << (val & 0x3f));
132 }
133 break;
134 default:
135 qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset 0x%02x\n",
136 __func__, offset);
137 return;
138 }
139 mcf_intc_update(s);
140 }
141
142 static void mcf_intc_set_irq(void *opaque, int irq, int level)
143 {
144 mcf_intc_state *s = (mcf_intc_state *)opaque;
145 if (irq >= 64)
146 return;
147 if (level)
148 s->ipr |= 1ull << irq;
149 else
150 s->ipr &= ~(1ull << irq);
151 mcf_intc_update(s);
152 }
153
154 static void mcf_intc_reset(DeviceState *dev)
155 {
156 mcf_intc_state *s = MCF_INTC(dev);
157
158 s->imr = ~0ull;
159 s->ipr = 0;
160 s->ifr = 0;
161 s->enabled = 0;
162 memset(s->icr, 0, 64);
163 s->active_vector = 24;
164 }
165
166 static const MemoryRegionOps mcf_intc_ops = {
167 .read = mcf_intc_read,
168 .write = mcf_intc_write,
169 .endianness = DEVICE_BIG_ENDIAN,
170 };
171
172 static void mcf_intc_instance_init(Object *obj)
173 {
174 mcf_intc_state *s = MCF_INTC(obj);
175
176 memory_region_init_io(&s->iomem, obj, &mcf_intc_ops, s, "mcf", 0x100);
177 sysbus_init_mmio(SYS_BUS_DEVICE(obj), &s->iomem);
178 qdev_init_gpio_in(DEVICE(s), mcf_intc_set_irq, 64);
179 }
180
181 static const Property mcf_intc_properties[] = {
182 DEFINE_PROP_LINK("m68k-cpu", mcf_intc_state, cpu,
183 TYPE_M68K_CPU, M68kCPU *),
184 };
185
186 static void mcf_intc_class_init(ObjectClass *oc, const void *data)
187 {
188 DeviceClass *dc = DEVICE_CLASS(oc);
189
190 device_class_set_props(dc, mcf_intc_properties);
191 set_bit(DEVICE_CATEGORY_MISC, dc->categories);
192 device_class_set_legacy_reset(dc, mcf_intc_reset);
193 }
194
195 static const TypeInfo mcf_intc_gate_info = {
196 .name = TYPE_MCF_INTC,
197 .parent = TYPE_SYS_BUS_DEVICE,
198 .instance_size = sizeof(mcf_intc_state),
199 .instance_init = mcf_intc_instance_init,
200 .class_init = mcf_intc_class_init,
201 };
202
203 static void mcf_intc_register_types(void)
204 {
205 type_register_static(&mcf_intc_gate_info);
206 }
207
208 type_init(mcf_intc_register_types)
209
210 DeviceState *mcf_intc_init(MemoryRegion *sysmem, hwaddr base, M68kCPU *cpu)
211 {
212 DeviceState *dev;
213
214 dev = qdev_new(TYPE_MCF_INTC);
215 object_property_set_link(OBJECT(dev), "m68k-cpu",
216 OBJECT(cpu), &error_abort);
217 sysbus_realize_and_unref(SYS_BUS_DEVICE(dev), &error_fatal);
218 memory_region_add_subregion(sysmem, base,
219 sysbus_mmio_get_region(SYS_BUS_DEVICE(dev), 0));
220 return dev;
221 }