1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include "qemu/osdep.h"
21
22#include "hw/hw.h"
23#include "monitor/monitor.h"
24#include "qemu/module.h"
25#include "hw/sysbus.h"
26#include "trace.h"
27#include "hw/lm32/lm32_pic.h"
28#include "hw/intc/intc.h"
29
30#define TYPE_LM32_PIC "lm32-pic"
31#define LM32_PIC(obj) OBJECT_CHECK(LM32PicState, (obj), TYPE_LM32_PIC)
32
33struct LM32PicState {
34 SysBusDevice parent_obj;
35
36 qemu_irq parent_irq;
37 uint32_t im;
38 uint32_t ip;
39 uint32_t irq_state;
40
41
42 uint64_t stats_irq_count[32];
43};
44typedef struct LM32PicState LM32PicState;
45
46static void update_irq(LM32PicState *s)
47{
48 s->ip |= s->irq_state;
49
50 if (s->ip & s->im) {
51 trace_lm32_pic_raise_irq();
52 qemu_irq_raise(s->parent_irq);
53 } else {
54 trace_lm32_pic_lower_irq();
55 qemu_irq_lower(s->parent_irq);
56 }
57}
58
59static void irq_handler(void *opaque, int irq, int level)
60{
61 LM32PicState *s = opaque;
62
63 assert(irq < 32);
64 trace_lm32_pic_interrupt(irq, level);
65
66 if (level) {
67 s->irq_state |= (1 << irq);
68 s->stats_irq_count[irq]++;
69 } else {
70 s->irq_state &= ~(1 << irq);
71 }
72
73 update_irq(s);
74}
75
76void lm32_pic_set_im(DeviceState *d, uint32_t im)
77{
78 LM32PicState *s = LM32_PIC(d);
79
80 trace_lm32_pic_set_im(im);
81 s->im = im;
82
83 update_irq(s);
84}
85
86void lm32_pic_set_ip(DeviceState *d, uint32_t ip)
87{
88 LM32PicState *s = LM32_PIC(d);
89
90 trace_lm32_pic_set_ip(ip);
91
92
93 s->ip &= ~ip;
94
95 update_irq(s);
96}
97
98uint32_t lm32_pic_get_im(DeviceState *d)
99{
100 LM32PicState *s = LM32_PIC(d);
101
102 trace_lm32_pic_get_im(s->im);
103 return s->im;
104}
105
106uint32_t lm32_pic_get_ip(DeviceState *d)
107{
108 LM32PicState *s = LM32_PIC(d);
109
110 trace_lm32_pic_get_ip(s->ip);
111 return s->ip;
112}
113
114static void pic_reset(DeviceState *d)
115{
116 LM32PicState *s = LM32_PIC(d);
117 int i;
118
119 s->im = 0;
120 s->ip = 0;
121 s->irq_state = 0;
122 for (i = 0; i < 32; i++) {
123 s->stats_irq_count[i] = 0;
124 }
125}
126
127static bool lm32_get_statistics(InterruptStatsProvider *obj,
128 uint64_t **irq_counts, unsigned int *nb_irqs)
129{
130 LM32PicState *s = LM32_PIC(obj);
131 *irq_counts = s->stats_irq_count;
132 *nb_irqs = ARRAY_SIZE(s->stats_irq_count);
133 return true;
134}
135
136static void lm32_print_info(InterruptStatsProvider *obj, Monitor *mon)
137{
138 LM32PicState *s = LM32_PIC(obj);
139 monitor_printf(mon, "lm32-pic: im=%08x ip=%08x irq_state=%08x\n",
140 s->im, s->ip, s->irq_state);
141}
142
143static void lm32_pic_init(Object *obj)
144{
145 DeviceState *dev = DEVICE(obj);
146 LM32PicState *s = LM32_PIC(obj);
147 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
148
149 qdev_init_gpio_in(dev, irq_handler, 32);
150 sysbus_init_irq(sbd, &s->parent_irq);
151}
152
153static const VMStateDescription vmstate_lm32_pic = {
154 .name = "lm32-pic",
155 .version_id = 2,
156 .minimum_version_id = 2,
157 .fields = (VMStateField[]) {
158 VMSTATE_UINT32(im, LM32PicState),
159 VMSTATE_UINT32(ip, LM32PicState),
160 VMSTATE_UINT32(irq_state, LM32PicState),
161 VMSTATE_UINT64_ARRAY(stats_irq_count, LM32PicState, 32),
162 VMSTATE_END_OF_LIST()
163 }
164};
165
166static void lm32_pic_class_init(ObjectClass *klass, void *data)
167{
168 DeviceClass *dc = DEVICE_CLASS(klass);
169 InterruptStatsProviderClass *ic = INTERRUPT_STATS_PROVIDER_CLASS(klass);
170
171 dc->reset = pic_reset;
172 dc->vmsd = &vmstate_lm32_pic;
173 ic->get_statistics = lm32_get_statistics;
174 ic->print_info = lm32_print_info;
175}
176
177static const TypeInfo lm32_pic_info = {
178 .name = TYPE_LM32_PIC,
179 .parent = TYPE_SYS_BUS_DEVICE,
180 .instance_size = sizeof(LM32PicState),
181 .instance_init = lm32_pic_init,
182 .class_init = lm32_pic_class_init,
183 .interfaces = (InterfaceInfo[]) {
184 { TYPE_INTERRUPT_STATS_PROVIDER },
185 { }
186 },
187};
188
189static void lm32_pic_register_types(void)
190{
191 type_register_static(&lm32_pic_info);
192}
193
194type_init(lm32_pic_register_types)
195