1 /*
2 * Raspberry Pi emulation (c) 2012 Gregory Estrade
3 * Refactoring for Pi2 Copyright (c) 2015, Microsoft. Written by Andrew Baumann.
4 * Heavily based on pl190.c, copyright terms below:
5 *
6 * Arm PrimeCell PL190 Vector Interrupt Controller
7 *
8 * Copyright (c) 2006 CodeSourcery.
9 * Written by Paul Brook
10 *
11 * This work is licensed under the terms of the GNU GPL, version 2 or later.
12 * See the COPYING file in the top-level directory.
13 */
14
15 #include "qemu/osdep.h"
16 #include "hw/intc/bcm2835_ic.h"
17 #include "hw/irq.h"
18 #include "migration/vmstate.h"
19 #include "qemu/log.h"
20 #include "qemu/module.h"
21 #include "trace.h"
22
23 #define GPU_IRQS 64
24 #define ARM_IRQS 8
25
26 #define IRQ_PENDING_BASIC 0x00 /* IRQ basic pending */
27 #define IRQ_PENDING_1 0x04 /* IRQ pending 1 */
28 #define IRQ_PENDING_2 0x08 /* IRQ pending 2 */
29 #define FIQ_CONTROL 0x0C /* FIQ register */
30 #define IRQ_ENABLE_1 0x10 /* Interrupt enable register 1 */
31 #define IRQ_ENABLE_2 0x14 /* Interrupt enable register 2 */
32 #define IRQ_ENABLE_BASIC 0x18 /* Base interrupt enable register */
33 #define IRQ_DISABLE_1 0x1C /* Interrupt disable register 1 */
34 #define IRQ_DISABLE_2 0x20 /* Interrupt disable register 2 */
35 #define IRQ_DISABLE_BASIC 0x24 /* Base interrupt disable register */
36
37 /* Update interrupts. */
bcm2835_ic_update(BCM2835ICState * s)38 static void bcm2835_ic_update(BCM2835ICState *s)
39 {
40 bool set = false;
41
42 if (s->fiq_enable) {
43 if (s->fiq_select >= GPU_IRQS) {
44 /* ARM IRQ */
45 set = extract32(s->arm_irq_level, s->fiq_select - GPU_IRQS, 1);
46 } else {
47 set = extract64(s->gpu_irq_level, s->fiq_select, 1);
48 }
49 }
50 qemu_set_irq(s->fiq, set);
51
52 set = (s->gpu_irq_level & s->gpu_irq_enable)
53 || (s->arm_irq_level & s->arm_irq_enable);
54 qemu_set_irq(s->irq, set);
55 }
56
bcm2835_ic_set_gpu_irq(void * opaque,int irq,int level)57 static void bcm2835_ic_set_gpu_irq(void *opaque, int irq, int level)
58 {
59 BCM2835ICState *s = opaque;
60
61 assert(irq >= 0 && irq < 64);
62 trace_bcm2835_ic_set_gpu_irq(irq, level);
63 s->gpu_irq_level = deposit64(s->gpu_irq_level, irq, 1, level != 0);
64 bcm2835_ic_update(s);
65 }
66
bcm2835_ic_set_arm_irq(void * opaque,int irq,int level)67 static void bcm2835_ic_set_arm_irq(void *opaque, int irq, int level)
68 {
69 BCM2835ICState *s = opaque;
70
71 assert(irq >= 0 && irq < 8);
72 trace_bcm2835_ic_set_cpu_irq(irq, level);
73 s->arm_irq_level = deposit32(s->arm_irq_level, irq, 1, level != 0);
74 bcm2835_ic_update(s);
75 }
76
77 static const int irq_dups[] = { 7, 9, 10, 18, 19, 53, 54, 55, 56, 57, 62 };
78
bcm2835_ic_read(void * opaque,hwaddr offset,unsigned size)79 static uint64_t bcm2835_ic_read(void *opaque, hwaddr offset, unsigned size)
80 {
81 BCM2835ICState *s = opaque;
82 uint32_t res = 0;
83 uint64_t gpu_pending = s->gpu_irq_level & s->gpu_irq_enable;
84 int i;
85
86 switch (offset) {
87 case IRQ_PENDING_BASIC:
88 /* bits 0-7: ARM irqs */
89 res = s->arm_irq_level & s->arm_irq_enable;
90
91 /* bits 8 & 9: pending registers 1 & 2 */
92 res |= (((uint32_t)gpu_pending) != 0) << 8;
93 res |= ((gpu_pending >> 32) != 0) << 9;
94
95 /* bits 10-20: selected GPU IRQs */
96 for (i = 0; i < ARRAY_SIZE(irq_dups); i++) {
97 res |= extract64(gpu_pending, irq_dups[i], 1) << (i + 10);
98 }
99 break;
100 case IRQ_PENDING_1:
101 res = gpu_pending;
102 break;
103 case IRQ_PENDING_2:
104 res = gpu_pending >> 32;
105 break;
106 case FIQ_CONTROL:
107 res = (s->fiq_enable << 7) | s->fiq_select;
108 break;
109 case IRQ_ENABLE_1:
110 res = s->gpu_irq_enable;
111 break;
112 case IRQ_ENABLE_2:
113 res = s->gpu_irq_enable >> 32;
114 break;
115 case IRQ_ENABLE_BASIC:
116 res = s->arm_irq_enable;
117 break;
118 case IRQ_DISABLE_1:
119 res = ~s->gpu_irq_enable;
120 break;
121 case IRQ_DISABLE_2:
122 res = ~s->gpu_irq_enable >> 32;
123 break;
124 case IRQ_DISABLE_BASIC:
125 res = ~s->arm_irq_enable;
126 break;
127 default:
128 qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset %"HWADDR_PRIx"\n",
129 __func__, offset);
130 return 0;
131 }
132
133 return res;
134 }
135
bcm2835_ic_write(void * opaque,hwaddr offset,uint64_t val,unsigned size)136 static void bcm2835_ic_write(void *opaque, hwaddr offset, uint64_t val,
137 unsigned size)
138 {
139 BCM2835ICState *s = opaque;
140
141 switch (offset) {
142 case FIQ_CONTROL:
143 s->fiq_select = extract32(val, 0, 7);
144 s->fiq_enable = extract32(val, 7, 1);
145 break;
146 case IRQ_ENABLE_1:
147 s->gpu_irq_enable |= val;
148 break;
149 case IRQ_ENABLE_2:
150 s->gpu_irq_enable |= val << 32;
151 break;
152 case IRQ_ENABLE_BASIC:
153 s->arm_irq_enable |= val & 0xff;
154 break;
155 case IRQ_DISABLE_1:
156 s->gpu_irq_enable &= ~val;
157 break;
158 case IRQ_DISABLE_2:
159 s->gpu_irq_enable &= ~(val << 32);
160 break;
161 case IRQ_DISABLE_BASIC:
162 s->arm_irq_enable &= ~val & 0xff;
163 break;
164 default:
165 qemu_log_mask(LOG_GUEST_ERROR, "%s: Bad offset %"HWADDR_PRIx"\n",
166 __func__, offset);
167 return;
168 }
169 bcm2835_ic_update(s);
170 }
171
172 static const MemoryRegionOps bcm2835_ic_ops = {
173 .read = bcm2835_ic_read,
174 .write = bcm2835_ic_write,
175 .endianness = DEVICE_NATIVE_ENDIAN,
176 .valid.min_access_size = 4,
177 .valid.max_access_size = 4,
178 };
179
bcm2835_ic_reset(DeviceState * d)180 static void bcm2835_ic_reset(DeviceState *d)
181 {
182 BCM2835ICState *s = BCM2835_IC(d);
183
184 s->gpu_irq_enable = 0;
185 s->arm_irq_enable = 0;
186 s->fiq_enable = false;
187 s->fiq_select = 0;
188 }
189
bcm2835_ic_init(Object * obj)190 static void bcm2835_ic_init(Object *obj)
191 {
192 BCM2835ICState *s = BCM2835_IC(obj);
193
194 memory_region_init_io(&s->iomem, obj, &bcm2835_ic_ops, s, TYPE_BCM2835_IC,
195 0x200);
196 sysbus_init_mmio(SYS_BUS_DEVICE(s), &s->iomem);
197
198 qdev_init_gpio_in_named(DEVICE(s), bcm2835_ic_set_gpu_irq,
199 BCM2835_IC_GPU_IRQ, GPU_IRQS);
200 qdev_init_gpio_in_named(DEVICE(s), bcm2835_ic_set_arm_irq,
201 BCM2835_IC_ARM_IRQ, ARM_IRQS);
202
203 sysbus_init_irq(SYS_BUS_DEVICE(s), &s->irq);
204 sysbus_init_irq(SYS_BUS_DEVICE(s), &s->fiq);
205 }
206
207 static const VMStateDescription vmstate_bcm2835_ic = {
208 .name = TYPE_BCM2835_IC,
209 .version_id = 1,
210 .minimum_version_id = 1,
211 .fields = (const VMStateField[]) {
212 VMSTATE_UINT64(gpu_irq_level, BCM2835ICState),
213 VMSTATE_UINT64(gpu_irq_enable, BCM2835ICState),
214 VMSTATE_UINT8(arm_irq_level, BCM2835ICState),
215 VMSTATE_UINT8(arm_irq_enable, BCM2835ICState),
216 VMSTATE_BOOL(fiq_enable, BCM2835ICState),
217 VMSTATE_UINT8(fiq_select, BCM2835ICState),
218 VMSTATE_END_OF_LIST()
219 }
220 };
221
bcm2835_ic_class_init(ObjectClass * klass,void * data)222 static void bcm2835_ic_class_init(ObjectClass *klass, void *data)
223 {
224 DeviceClass *dc = DEVICE_CLASS(klass);
225
226 dc->reset = bcm2835_ic_reset;
227 dc->vmsd = &vmstate_bcm2835_ic;
228 }
229
230 static const TypeInfo bcm2835_ic_info = {
231 .name = TYPE_BCM2835_IC,
232 .parent = TYPE_SYS_BUS_DEVICE,
233 .instance_size = sizeof(BCM2835ICState),
234 .class_init = bcm2835_ic_class_init,
235 .instance_init = bcm2835_ic_init,
236 };
237
bcm2835_ic_register_types(void)238 static void bcm2835_ic_register_types(void)
239 {
240 type_register_static(&bcm2835_ic_info);
241 }
242
243 type_init(bcm2835_ic_register_types)
244