root / hw / sun4c_intctl.c @ a8a358bf
History | View | Annotate | Download (5.9 kB)
1 | ee76f82e | blueswir1 | /*
|
---|---|---|---|
2 | ee76f82e | blueswir1 | * QEMU Sparc Sun4c interrupt controller emulation
|
3 | ee76f82e | blueswir1 | *
|
4 | ee76f82e | blueswir1 | * Based on slavio_intctl, copyright (c) 2003-2005 Fabrice Bellard
|
5 | ee76f82e | blueswir1 | *
|
6 | ee76f82e | blueswir1 | * Permission is hereby granted, free of charge, to any person obtaining a copy
|
7 | ee76f82e | blueswir1 | * of this software and associated documentation files (the "Software"), to deal
|
8 | ee76f82e | blueswir1 | * in the Software without restriction, including without limitation the rights
|
9 | ee76f82e | blueswir1 | * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
|
10 | ee76f82e | blueswir1 | * copies of the Software, and to permit persons to whom the Software is
|
11 | ee76f82e | blueswir1 | * furnished to do so, subject to the following conditions:
|
12 | ee76f82e | blueswir1 | *
|
13 | ee76f82e | blueswir1 | * The above copyright notice and this permission notice shall be included in
|
14 | ee76f82e | blueswir1 | * all copies or substantial portions of the Software.
|
15 | ee76f82e | blueswir1 | *
|
16 | ee76f82e | blueswir1 | * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
|
17 | ee76f82e | blueswir1 | * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
|
18 | ee76f82e | blueswir1 | * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
|
19 | ee76f82e | blueswir1 | * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
|
20 | ee76f82e | blueswir1 | * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
|
21 | ee76f82e | blueswir1 | * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
|
22 | ee76f82e | blueswir1 | * THE SOFTWARE.
|
23 | ee76f82e | blueswir1 | */
|
24 | e32cba29 | Blue Swirl | |
25 | ee76f82e | blueswir1 | #include "hw.h" |
26 | ee76f82e | blueswir1 | #include "sun4m.h" |
27 | 376253ec | aliguori | #include "monitor.h" |
28 | e32cba29 | Blue Swirl | #include "sysbus.h" |
29 | e32cba29 | Blue Swirl | |
30 | ee76f82e | blueswir1 | //#define DEBUG_IRQ_COUNT
|
31 | ee76f82e | blueswir1 | //#define DEBUG_IRQ
|
32 | ee76f82e | blueswir1 | |
33 | ee76f82e | blueswir1 | #ifdef DEBUG_IRQ
|
34 | 001faf32 | Blue Swirl | #define DPRINTF(fmt, ...) \
|
35 | 001faf32 | Blue Swirl | do { printf("IRQ: " fmt , ## __VA_ARGS__); } while (0) |
36 | ee76f82e | blueswir1 | #else
|
37 | 001faf32 | Blue Swirl | #define DPRINTF(fmt, ...)
|
38 | ee76f82e | blueswir1 | #endif
|
39 | ee76f82e | blueswir1 | |
40 | ee76f82e | blueswir1 | /*
|
41 | ee76f82e | blueswir1 | * Registers of interrupt controller in sun4c.
|
42 | ee76f82e | blueswir1 | *
|
43 | ee76f82e | blueswir1 | */
|
44 | ee76f82e | blueswir1 | |
45 | ee76f82e | blueswir1 | #define MAX_PILS 16 |
46 | ee76f82e | blueswir1 | |
47 | ee76f82e | blueswir1 | typedef struct Sun4c_INTCTLState { |
48 | e32cba29 | Blue Swirl | SysBusDevice busdev; |
49 | ee76f82e | blueswir1 | #ifdef DEBUG_IRQ_COUNT
|
50 | ee76f82e | blueswir1 | uint64_t irq_count; |
51 | ee76f82e | blueswir1 | #endif
|
52 | e32cba29 | Blue Swirl | qemu_irq cpu_irqs[MAX_PILS]; |
53 | ee76f82e | blueswir1 | const uint32_t *intbit_to_level;
|
54 | ee76f82e | blueswir1 | uint32_t pil_out; |
55 | ee76f82e | blueswir1 | uint8_t reg; |
56 | ee76f82e | blueswir1 | uint8_t pending; |
57 | ee76f82e | blueswir1 | } Sun4c_INTCTLState; |
58 | ee76f82e | blueswir1 | |
59 | e64d7d59 | blueswir1 | #define INTCTL_SIZE 1 |
60 | ee76f82e | blueswir1 | |
61 | ee76f82e | blueswir1 | static void sun4c_check_interrupts(void *opaque); |
62 | ee76f82e | blueswir1 | |
63 | ee76f82e | blueswir1 | static uint32_t sun4c_intctl_mem_readb(void *opaque, target_phys_addr_t addr) |
64 | ee76f82e | blueswir1 | { |
65 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
66 | ee76f82e | blueswir1 | uint32_t ret; |
67 | ee76f82e | blueswir1 | |
68 | ee76f82e | blueswir1 | ret = s->reg; |
69 | ee76f82e | blueswir1 | DPRINTF("read reg 0x" TARGET_FMT_plx " = %x\n", addr, ret); |
70 | ee76f82e | blueswir1 | |
71 | ee76f82e | blueswir1 | return ret;
|
72 | ee76f82e | blueswir1 | } |
73 | ee76f82e | blueswir1 | |
74 | 77f193da | blueswir1 | static void sun4c_intctl_mem_writeb(void *opaque, target_phys_addr_t addr, |
75 | 77f193da | blueswir1 | uint32_t val) |
76 | ee76f82e | blueswir1 | { |
77 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
78 | ee76f82e | blueswir1 | |
79 | ee76f82e | blueswir1 | DPRINTF("write reg 0x" TARGET_FMT_plx " = %x\n", addr, val); |
80 | ee76f82e | blueswir1 | val &= 0xbf;
|
81 | ee76f82e | blueswir1 | s->reg = val; |
82 | ee76f82e | blueswir1 | sun4c_check_interrupts(s); |
83 | ee76f82e | blueswir1 | } |
84 | ee76f82e | blueswir1 | |
85 | d60efc6b | Blue Swirl | static CPUReadMemoryFunc * const sun4c_intctl_mem_read[3] = { |
86 | ee76f82e | blueswir1 | sun4c_intctl_mem_readb, |
87 | 7c560456 | blueswir1 | NULL,
|
88 | 7c560456 | blueswir1 | NULL,
|
89 | ee76f82e | blueswir1 | }; |
90 | ee76f82e | blueswir1 | |
91 | d60efc6b | Blue Swirl | static CPUWriteMemoryFunc * const sun4c_intctl_mem_write[3] = { |
92 | ee76f82e | blueswir1 | sun4c_intctl_mem_writeb, |
93 | 7c560456 | blueswir1 | NULL,
|
94 | 7c560456 | blueswir1 | NULL,
|
95 | ee76f82e | blueswir1 | }; |
96 | ee76f82e | blueswir1 | |
97 | 376253ec | aliguori | void sun4c_pic_info(Monitor *mon, void *opaque) |
98 | ee76f82e | blueswir1 | { |
99 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
100 | ee76f82e | blueswir1 | |
101 | 376253ec | aliguori | monitor_printf(mon, "master: pending 0x%2.2x, enabled 0x%2.2x\n",
|
102 | 376253ec | aliguori | s->pending, s->reg); |
103 | ee76f82e | blueswir1 | } |
104 | ee76f82e | blueswir1 | |
105 | 376253ec | aliguori | void sun4c_irq_info(Monitor *mon, void *opaque) |
106 | ee76f82e | blueswir1 | { |
107 | ee76f82e | blueswir1 | #ifndef DEBUG_IRQ_COUNT
|
108 | 376253ec | aliguori | monitor_printf(mon, "irq statistic code not compiled.\n");
|
109 | ee76f82e | blueswir1 | #else
|
110 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
111 | ee76f82e | blueswir1 | int64_t count; |
112 | ee76f82e | blueswir1 | |
113 | 376253ec | aliguori | monitor_printf(mon, "IRQ statistics:\n");
|
114 | 0bf9e31a | Blue Swirl | count = s->irq_count; |
115 | ee76f82e | blueswir1 | if (count > 0) |
116 | 0bf9e31a | Blue Swirl | monitor_printf(mon, " %" PRId64 "\n", count); |
117 | ee76f82e | blueswir1 | #endif
|
118 | ee76f82e | blueswir1 | } |
119 | ee76f82e | blueswir1 | |
120 | ee76f82e | blueswir1 | static const uint32_t intbit_to_level[] = { 0, 1, 4, 6, 8, 10, 0, 14, }; |
121 | ee76f82e | blueswir1 | |
122 | ee76f82e | blueswir1 | static void sun4c_check_interrupts(void *opaque) |
123 | ee76f82e | blueswir1 | { |
124 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
125 | ee76f82e | blueswir1 | uint32_t pil_pending; |
126 | ee76f82e | blueswir1 | unsigned int i; |
127 | ee76f82e | blueswir1 | |
128 | ee76f82e | blueswir1 | pil_pending = 0;
|
129 | ee76f82e | blueswir1 | if (s->pending && !(s->reg & 0x80000000)) { |
130 | ee76f82e | blueswir1 | for (i = 0; i < 8; i++) { |
131 | ee76f82e | blueswir1 | if (s->pending & (1 << i)) |
132 | ee76f82e | blueswir1 | pil_pending |= 1 << intbit_to_level[i];
|
133 | ee76f82e | blueswir1 | } |
134 | ee76f82e | blueswir1 | } |
135 | ee76f82e | blueswir1 | |
136 | ee76f82e | blueswir1 | for (i = 0; i < MAX_PILS; i++) { |
137 | ee76f82e | blueswir1 | if (pil_pending & (1 << i)) { |
138 | ee76f82e | blueswir1 | if (!(s->pil_out & (1 << i))) |
139 | ee76f82e | blueswir1 | qemu_irq_raise(s->cpu_irqs[i]); |
140 | ee76f82e | blueswir1 | } else {
|
141 | ee76f82e | blueswir1 | if (s->pil_out & (1 << i)) |
142 | ee76f82e | blueswir1 | qemu_irq_lower(s->cpu_irqs[i]); |
143 | ee76f82e | blueswir1 | } |
144 | ee76f82e | blueswir1 | } |
145 | ee76f82e | blueswir1 | s->pil_out = pil_pending; |
146 | ee76f82e | blueswir1 | } |
147 | ee76f82e | blueswir1 | |
148 | ee76f82e | blueswir1 | /*
|
149 | ee76f82e | blueswir1 | * "irq" here is the bit number in the system interrupt register
|
150 | ee76f82e | blueswir1 | */
|
151 | ee76f82e | blueswir1 | static void sun4c_set_irq(void *opaque, int irq, int level) |
152 | ee76f82e | blueswir1 | { |
153 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
154 | ee76f82e | blueswir1 | uint32_t mask = 1 << irq;
|
155 | ee76f82e | blueswir1 | uint32_t pil = intbit_to_level[irq]; |
156 | ee76f82e | blueswir1 | |
157 | ee76f82e | blueswir1 | DPRINTF("Set irq %d -> pil %d level %d\n", irq, pil,
|
158 | ee76f82e | blueswir1 | level); |
159 | ee76f82e | blueswir1 | if (pil > 0) { |
160 | ee76f82e | blueswir1 | if (level) {
|
161 | ee76f82e | blueswir1 | #ifdef DEBUG_IRQ_COUNT
|
162 | 0bf9e31a | Blue Swirl | s->irq_count++; |
163 | ee76f82e | blueswir1 | #endif
|
164 | ee76f82e | blueswir1 | s->pending |= mask; |
165 | ee76f82e | blueswir1 | } else {
|
166 | ee76f82e | blueswir1 | s->pending &= ~mask; |
167 | ee76f82e | blueswir1 | } |
168 | ee76f82e | blueswir1 | sun4c_check_interrupts(s); |
169 | ee76f82e | blueswir1 | } |
170 | ee76f82e | blueswir1 | } |
171 | ee76f82e | blueswir1 | |
172 | ee76f82e | blueswir1 | static void sun4c_intctl_save(QEMUFile *f, void *opaque) |
173 | ee76f82e | blueswir1 | { |
174 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
175 | ee76f82e | blueswir1 | |
176 | ee76f82e | blueswir1 | qemu_put_8s(f, &s->reg); |
177 | ee76f82e | blueswir1 | qemu_put_8s(f, &s->pending); |
178 | ee76f82e | blueswir1 | } |
179 | ee76f82e | blueswir1 | |
180 | ee76f82e | blueswir1 | static int sun4c_intctl_load(QEMUFile *f, void *opaque, int version_id) |
181 | ee76f82e | blueswir1 | { |
182 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
183 | ee76f82e | blueswir1 | |
184 | ee76f82e | blueswir1 | if (version_id != 1) |
185 | ee76f82e | blueswir1 | return -EINVAL;
|
186 | ee76f82e | blueswir1 | |
187 | ee76f82e | blueswir1 | qemu_get_8s(f, &s->reg); |
188 | ee76f82e | blueswir1 | qemu_get_8s(f, &s->pending); |
189 | ee76f82e | blueswir1 | |
190 | ee76f82e | blueswir1 | return 0; |
191 | ee76f82e | blueswir1 | } |
192 | ee76f82e | blueswir1 | |
193 | ee76f82e | blueswir1 | static void sun4c_intctl_reset(void *opaque) |
194 | ee76f82e | blueswir1 | { |
195 | ee76f82e | blueswir1 | Sun4c_INTCTLState *s = opaque; |
196 | ee76f82e | blueswir1 | |
197 | ee76f82e | blueswir1 | s->reg = 1;
|
198 | ee76f82e | blueswir1 | s->pending = 0;
|
199 | ee76f82e | blueswir1 | } |
200 | ee76f82e | blueswir1 | |
201 | e32cba29 | Blue Swirl | static void sun4c_intctl_init1(SysBusDevice *dev) |
202 | e32cba29 | Blue Swirl | { |
203 | e32cba29 | Blue Swirl | Sun4c_INTCTLState *s = FROM_SYSBUS(Sun4c_INTCTLState, dev); |
204 | e32cba29 | Blue Swirl | int io_memory;
|
205 | e32cba29 | Blue Swirl | unsigned int i; |
206 | ee76f82e | blueswir1 | |
207 | e32cba29 | Blue Swirl | io_memory = cpu_register_io_memory(sun4c_intctl_mem_read, |
208 | e32cba29 | Blue Swirl | sun4c_intctl_mem_write, s); |
209 | e32cba29 | Blue Swirl | sysbus_init_mmio(dev, INTCTL_SIZE, io_memory); |
210 | e32cba29 | Blue Swirl | qdev_init_gpio_in(&dev->qdev, sun4c_set_irq, 8);
|
211 | e32cba29 | Blue Swirl | |
212 | e32cba29 | Blue Swirl | for (i = 0; i < MAX_PILS; i++) { |
213 | e32cba29 | Blue Swirl | sysbus_init_irq(dev, &s->cpu_irqs[i]); |
214 | e32cba29 | Blue Swirl | } |
215 | e32cba29 | Blue Swirl | register_savevm("sun4c_intctl", -1, 1, sun4c_intctl_save, |
216 | e32cba29 | Blue Swirl | sun4c_intctl_load, s); |
217 | e32cba29 | Blue Swirl | qemu_register_reset(sun4c_intctl_reset, s); |
218 | ee76f82e | blueswir1 | sun4c_intctl_reset(s); |
219 | ee76f82e | blueswir1 | } |
220 | e32cba29 | Blue Swirl | |
221 | e32cba29 | Blue Swirl | static SysBusDeviceInfo sun4c_intctl_info = {
|
222 | e32cba29 | Blue Swirl | .init = sun4c_intctl_init1, |
223 | e32cba29 | Blue Swirl | .qdev.name = "sun4c_intctl",
|
224 | e32cba29 | Blue Swirl | .qdev.size = sizeof(Sun4c_INTCTLState),
|
225 | e32cba29 | Blue Swirl | }; |
226 | e32cba29 | Blue Swirl | |
227 | e32cba29 | Blue Swirl | static void sun4c_intctl_register_devices(void) |
228 | e32cba29 | Blue Swirl | { |
229 | e32cba29 | Blue Swirl | sysbus_register_withprop(&sun4c_intctl_info); |
230 | e32cba29 | Blue Swirl | } |
231 | e32cba29 | Blue Swirl | |
232 | e32cba29 | Blue Swirl | device_init(sun4c_intctl_register_devices) |