1
2
3
4
5
6
7
8
9
10
11
12
13
14#include "qemu/osdep.h"
15#include "hw/irq.h"
16#include "hw/sysbus.h"
17#include "migration/vmstate.h"
18#include "qemu/module.h"
19#include "qom/object.h"
20
21
22#define FPGA_GPIO_PIN 0
23#define MST_NUM_IRQS 16
24#define MST_LEDDAT1 0x10
25#define MST_LEDDAT2 0x14
26#define MST_LEDCTRL 0x40
27#define MST_GPSWR 0x60
28#define MST_MSCWR1 0x80
29#define MST_MSCWR2 0x84
30#define MST_MSCWR3 0x88
31#define MST_MSCRD 0x90
32#define MST_INTMSKENA 0xc0
33#define MST_INTSETCLR 0xd0
34#define MST_PCMCIA0 0xe0
35#define MST_PCMCIA1 0xe4
36
37#define MST_PCMCIAx_READY (1 << 10)
38#define MST_PCMCIAx_nCD (1 << 5)
39
40#define MST_PCMCIA_CD0_IRQ 9
41#define MST_PCMCIA_CD1_IRQ 13
42
43#define TYPE_MAINSTONE_FPGA "mainstone-fpga"
44OBJECT_DECLARE_SIMPLE_TYPE(mst_irq_state, MAINSTONE_FPGA)
45
46struct mst_irq_state {
47 SysBusDevice parent_obj;
48
49 MemoryRegion iomem;
50
51 qemu_irq parent;
52
53 uint32_t prev_level;
54 uint32_t leddat1;
55 uint32_t leddat2;
56 uint32_t ledctrl;
57 uint32_t gpswr;
58 uint32_t mscwr1;
59 uint32_t mscwr2;
60 uint32_t mscwr3;
61 uint32_t mscrd;
62 uint32_t intmskena;
63 uint32_t intsetclr;
64 uint32_t pcmcia0;
65 uint32_t pcmcia1;
66};
67
68static void
69mst_fpga_set_irq(void *opaque, int irq, int level)
70{
71 mst_irq_state *s = (mst_irq_state *)opaque;
72 uint32_t oldint = s->intsetclr & s->intmskena;
73
74 if (level)
75 s->prev_level |= 1u << irq;
76 else
77 s->prev_level &= ~(1u << irq);
78
79 switch(irq) {
80 case MST_PCMCIA_CD0_IRQ:
81 if (level)
82 s->pcmcia0 &= ~MST_PCMCIAx_nCD;
83 else
84 s->pcmcia0 |= MST_PCMCIAx_nCD;
85 break;
86 case MST_PCMCIA_CD1_IRQ:
87 if (level)
88 s->pcmcia1 &= ~MST_PCMCIAx_nCD;
89 else
90 s->pcmcia1 |= MST_PCMCIAx_nCD;
91 break;
92 }
93
94 if ((s->intmskena & (1u << irq)) && level)
95 s->intsetclr |= 1u << irq;
96
97 if (oldint != (s->intsetclr & s->intmskena))
98 qemu_set_irq(s->parent, s->intsetclr & s->intmskena);
99}
100
101
102static uint64_t
103mst_fpga_readb(void *opaque, hwaddr addr, unsigned size)
104{
105 mst_irq_state *s = (mst_irq_state *) opaque;
106
107 switch (addr) {
108 case MST_LEDDAT1:
109 return s->leddat1;
110 case MST_LEDDAT2:
111 return s->leddat2;
112 case MST_LEDCTRL:
113 return s->ledctrl;
114 case MST_GPSWR:
115 return s->gpswr;
116 case MST_MSCWR1:
117 return s->mscwr1;
118 case MST_MSCWR2:
119 return s->mscwr2;
120 case MST_MSCWR3:
121 return s->mscwr3;
122 case MST_MSCRD:
123 return s->mscrd;
124 case MST_INTMSKENA:
125 return s->intmskena;
126 case MST_INTSETCLR:
127 return s->intsetclr;
128 case MST_PCMCIA0:
129 return s->pcmcia0;
130 case MST_PCMCIA1:
131 return s->pcmcia1;
132 default:
133 printf("Mainstone - mst_fpga_readb: Bad register offset "
134 "0x" HWADDR_FMT_plx "\n", addr);
135 }
136 return 0;
137}
138
139static void
140mst_fpga_writeb(void *opaque, hwaddr addr, uint64_t value,
141 unsigned size)
142{
143 mst_irq_state *s = (mst_irq_state *) opaque;
144 value &= 0xffffffff;
145
146 switch (addr) {
147 case MST_LEDDAT1:
148 s->leddat1 = value;
149 break;
150 case MST_LEDDAT2:
151 s->leddat2 = value;
152 break;
153 case MST_LEDCTRL:
154 s->ledctrl = value;
155 break;
156 case MST_GPSWR:
157 s->gpswr = value;
158 break;
159 case MST_MSCWR1:
160 s->mscwr1 = value;
161 break;
162 case MST_MSCWR2:
163 s->mscwr2 = value;
164 break;
165 case MST_MSCWR3:
166 s->mscwr3 = value;
167 break;
168 case MST_MSCRD:
169 s->mscrd = value;
170 break;
171 case MST_INTMSKENA:
172 s->intmskena = (value & 0xFEEFF);
173 qemu_set_irq(s->parent, s->intsetclr & s->intmskena);
174 break;
175 case MST_INTSETCLR:
176 s->intsetclr = (value & 0xFEEFF);
177 qemu_set_irq(s->parent, s->intsetclr & s->intmskena);
178 break;
179
180 case MST_PCMCIA0:
181 s->pcmcia0 = (value & 0x1f) | (s->pcmcia0 & ~0x1f);
182 break;
183 case MST_PCMCIA1:
184 s->pcmcia1 = (value & 0x1f) | (s->pcmcia1 & ~0x1f);
185 break;
186 default:
187 printf("Mainstone - mst_fpga_writeb: Bad register offset "
188 "0x" HWADDR_FMT_plx "\n", addr);
189 }
190}
191
192static const MemoryRegionOps mst_fpga_ops = {
193 .read = mst_fpga_readb,
194 .write = mst_fpga_writeb,
195 .endianness = DEVICE_NATIVE_ENDIAN,
196};
197
198static int mst_fpga_post_load(void *opaque, int version_id)
199{
200 mst_irq_state *s = (mst_irq_state *) opaque;
201
202 qemu_set_irq(s->parent, s->intsetclr & s->intmskena);
203 return 0;
204}
205
206static void mst_fpga_init(Object *obj)
207{
208 DeviceState *dev = DEVICE(obj);
209 mst_irq_state *s = MAINSTONE_FPGA(obj);
210 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
211
212 s->pcmcia0 = MST_PCMCIAx_READY | MST_PCMCIAx_nCD;
213 s->pcmcia1 = MST_PCMCIAx_READY | MST_PCMCIAx_nCD;
214
215 sysbus_init_irq(sbd, &s->parent);
216
217
218 qdev_init_gpio_in(dev, mst_fpga_set_irq, MST_NUM_IRQS);
219
220 memory_region_init_io(&s->iomem, obj, &mst_fpga_ops, s,
221 "fpga", 0x00100000);
222 sysbus_init_mmio(sbd, &s->iomem);
223}
224
225static const VMStateDescription vmstate_mst_fpga_regs = {
226 .name = "mainstone_fpga",
227 .version_id = 0,
228 .minimum_version_id = 0,
229 .post_load = mst_fpga_post_load,
230 .fields = (VMStateField[]) {
231 VMSTATE_UINT32(prev_level, mst_irq_state),
232 VMSTATE_UINT32(leddat1, mst_irq_state),
233 VMSTATE_UINT32(leddat2, mst_irq_state),
234 VMSTATE_UINT32(ledctrl, mst_irq_state),
235 VMSTATE_UINT32(gpswr, mst_irq_state),
236 VMSTATE_UINT32(mscwr1, mst_irq_state),
237 VMSTATE_UINT32(mscwr2, mst_irq_state),
238 VMSTATE_UINT32(mscwr3, mst_irq_state),
239 VMSTATE_UINT32(mscrd, mst_irq_state),
240 VMSTATE_UINT32(intmskena, mst_irq_state),
241 VMSTATE_UINT32(intsetclr, mst_irq_state),
242 VMSTATE_UINT32(pcmcia0, mst_irq_state),
243 VMSTATE_UINT32(pcmcia1, mst_irq_state),
244 VMSTATE_END_OF_LIST(),
245 },
246};
247
248static void mst_fpga_class_init(ObjectClass *klass, void *data)
249{
250 DeviceClass *dc = DEVICE_CLASS(klass);
251
252 dc->desc = "Mainstone II FPGA";
253 dc->vmsd = &vmstate_mst_fpga_regs;
254}
255
256static const TypeInfo mst_fpga_info = {
257 .name = TYPE_MAINSTONE_FPGA,
258 .parent = TYPE_SYS_BUS_DEVICE,
259 .instance_size = sizeof(mst_irq_state),
260 .instance_init = mst_fpga_init,
261 .class_init = mst_fpga_class_init,
262};
263
264static void mst_fpga_register_types(void)
265{
266 type_register_static(&mst_fpga_info);
267}
268
269type_init(mst_fpga_register_types)
270
