Add qemu 2.4.0
[kvmfornfv.git] / qemu / hw / timer / milkymist-sysctl.c
1 /*
2  *  QEMU model of the Milkymist System Controller.
3  *
4  *  Copyright (c) 2010-2012 Michael Walle <michael@walle.cc>
5  *
6  * This library is free software; you can redistribute it and/or
7  * modify it under the terms of the GNU Lesser General Public
8  * License as published by the Free Software Foundation; either
9  * version 2 of the License, or (at your option) any later version.
10  *
11  * This library is distributed in the hope that it will be useful,
12  * but WITHOUT ANY WARRANTY; without even the implied warranty of
13  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
14  * Lesser General Public License for more details.
15  *
16  * You should have received a copy of the GNU Lesser General Public
17  * License along with this library; if not, see <http://www.gnu.org/licenses/>.
18  *
19  *
20  * Specification available at:
21  *   http://www.milkymist.org/socdoc/sysctl.pdf
22  */
23
24 #include "hw/hw.h"
25 #include "hw/sysbus.h"
26 #include "sysemu/sysemu.h"
27 #include "trace.h"
28 #include "qemu/timer.h"
29 #include "hw/ptimer.h"
30 #include "qemu/error-report.h"
31
32 enum {
33     CTRL_ENABLE      = (1<<0),
34     CTRL_AUTORESTART = (1<<1),
35 };
36
37 enum {
38     ICAP_READY       = (1<<0),
39 };
40
41 enum {
42     R_GPIO_IN         = 0,
43     R_GPIO_OUT,
44     R_GPIO_INTEN,
45     R_TIMER0_CONTROL  = 4,
46     R_TIMER0_COMPARE,
47     R_TIMER0_COUNTER,
48     R_TIMER1_CONTROL  = 8,
49     R_TIMER1_COMPARE,
50     R_TIMER1_COUNTER,
51     R_ICAP = 16,
52     R_DBG_SCRATCHPAD  = 20,
53     R_DBG_WRITE_LOCK,
54     R_CLK_FREQUENCY   = 29,
55     R_CAPABILITIES,
56     R_SYSTEM_ID,
57     R_MAX
58 };
59
60 #define TYPE_MILKYMIST_SYSCTL "milkymist-sysctl"
61 #define MILKYMIST_SYSCTL(obj) \
62     OBJECT_CHECK(MilkymistSysctlState, (obj), TYPE_MILKYMIST_SYSCTL)
63
64 struct MilkymistSysctlState {
65     SysBusDevice parent_obj;
66
67     MemoryRegion regs_region;
68
69     QEMUBH *bh0;
70     QEMUBH *bh1;
71     ptimer_state *ptimer0;
72     ptimer_state *ptimer1;
73
74     uint32_t freq_hz;
75     uint32_t capabilities;
76     uint32_t systemid;
77     uint32_t strappings;
78
79     uint32_t regs[R_MAX];
80
81     qemu_irq gpio_irq;
82     qemu_irq timer0_irq;
83     qemu_irq timer1_irq;
84 };
85 typedef struct MilkymistSysctlState MilkymistSysctlState;
86
87 static void sysctl_icap_write(MilkymistSysctlState *s, uint32_t value)
88 {
89     trace_milkymist_sysctl_icap_write(value);
90     switch (value & 0xffff) {
91     case 0x000e:
92         qemu_system_shutdown_request();
93         break;
94     }
95 }
96
97 static uint64_t sysctl_read(void *opaque, hwaddr addr,
98                             unsigned size)
99 {
100     MilkymistSysctlState *s = opaque;
101     uint32_t r = 0;
102
103     addr >>= 2;
104     switch (addr) {
105     case R_TIMER0_COUNTER:
106         r = (uint32_t)ptimer_get_count(s->ptimer0);
107         /* milkymist timer counts up */
108         r = s->regs[R_TIMER0_COMPARE] - r;
109         break;
110     case R_TIMER1_COUNTER:
111         r = (uint32_t)ptimer_get_count(s->ptimer1);
112         /* milkymist timer counts up */
113         r = s->regs[R_TIMER1_COMPARE] - r;
114         break;
115     case R_GPIO_IN:
116     case R_GPIO_OUT:
117     case R_GPIO_INTEN:
118     case R_TIMER0_CONTROL:
119     case R_TIMER0_COMPARE:
120     case R_TIMER1_CONTROL:
121     case R_TIMER1_COMPARE:
122     case R_ICAP:
123     case R_DBG_SCRATCHPAD:
124     case R_DBG_WRITE_LOCK:
125     case R_CLK_FREQUENCY:
126     case R_CAPABILITIES:
127     case R_SYSTEM_ID:
128         r = s->regs[addr];
129         break;
130
131     default:
132         error_report("milkymist_sysctl: read access to unknown register 0x"
133                 TARGET_FMT_plx, addr << 2);
134         break;
135     }
136
137     trace_milkymist_sysctl_memory_read(addr << 2, r);
138
139     return r;
140 }
141
142 static void sysctl_write(void *opaque, hwaddr addr, uint64_t value,
143                          unsigned size)
144 {
145     MilkymistSysctlState *s = opaque;
146
147     trace_milkymist_sysctl_memory_write(addr, value);
148
149     addr >>= 2;
150     switch (addr) {
151     case R_GPIO_OUT:
152     case R_GPIO_INTEN:
153     case R_TIMER0_COUNTER:
154     case R_TIMER1_COUNTER:
155     case R_DBG_SCRATCHPAD:
156         s->regs[addr] = value;
157         break;
158     case R_TIMER0_COMPARE:
159         ptimer_set_limit(s->ptimer0, value, 0);
160         s->regs[addr] = value;
161         break;
162     case R_TIMER1_COMPARE:
163         ptimer_set_limit(s->ptimer1, value, 0);
164         s->regs[addr] = value;
165         break;
166     case R_TIMER0_CONTROL:
167         s->regs[addr] = value;
168         if (s->regs[R_TIMER0_CONTROL] & CTRL_ENABLE) {
169             trace_milkymist_sysctl_start_timer0();
170             ptimer_set_count(s->ptimer0,
171                     s->regs[R_TIMER0_COMPARE] - s->regs[R_TIMER0_COUNTER]);
172             ptimer_run(s->ptimer0, 0);
173         } else {
174             trace_milkymist_sysctl_stop_timer0();
175             ptimer_stop(s->ptimer0);
176         }
177         break;
178     case R_TIMER1_CONTROL:
179         s->regs[addr] = value;
180         if (s->regs[R_TIMER1_CONTROL] & CTRL_ENABLE) {
181             trace_milkymist_sysctl_start_timer1();
182             ptimer_set_count(s->ptimer1,
183                     s->regs[R_TIMER1_COMPARE] - s->regs[R_TIMER1_COUNTER]);
184             ptimer_run(s->ptimer1, 0);
185         } else {
186             trace_milkymist_sysctl_stop_timer1();
187             ptimer_stop(s->ptimer1);
188         }
189         break;
190     case R_ICAP:
191         sysctl_icap_write(s, value);
192         break;
193     case R_DBG_WRITE_LOCK:
194         s->regs[addr] = 1;
195         break;
196     case R_SYSTEM_ID:
197         qemu_system_reset_request();
198         break;
199
200     case R_GPIO_IN:
201     case R_CLK_FREQUENCY:
202     case R_CAPABILITIES:
203         error_report("milkymist_sysctl: write to read-only register 0x"
204                 TARGET_FMT_plx, addr << 2);
205         break;
206
207     default:
208         error_report("milkymist_sysctl: write access to unknown register 0x"
209                 TARGET_FMT_plx, addr << 2);
210         break;
211     }
212 }
213
214 static const MemoryRegionOps sysctl_mmio_ops = {
215     .read = sysctl_read,
216     .write = sysctl_write,
217     .valid = {
218         .min_access_size = 4,
219         .max_access_size = 4,
220     },
221     .endianness = DEVICE_NATIVE_ENDIAN,
222 };
223
224 static void timer0_hit(void *opaque)
225 {
226     MilkymistSysctlState *s = opaque;
227
228     if (!(s->regs[R_TIMER0_CONTROL] & CTRL_AUTORESTART)) {
229         s->regs[R_TIMER0_CONTROL] &= ~CTRL_ENABLE;
230         trace_milkymist_sysctl_stop_timer0();
231         ptimer_stop(s->ptimer0);
232     }
233
234     trace_milkymist_sysctl_pulse_irq_timer0();
235     qemu_irq_pulse(s->timer0_irq);
236 }
237
238 static void timer1_hit(void *opaque)
239 {
240     MilkymistSysctlState *s = opaque;
241
242     if (!(s->regs[R_TIMER1_CONTROL] & CTRL_AUTORESTART)) {
243         s->regs[R_TIMER1_CONTROL] &= ~CTRL_ENABLE;
244         trace_milkymist_sysctl_stop_timer1();
245         ptimer_stop(s->ptimer1);
246     }
247
248     trace_milkymist_sysctl_pulse_irq_timer1();
249     qemu_irq_pulse(s->timer1_irq);
250 }
251
252 static void milkymist_sysctl_reset(DeviceState *d)
253 {
254     MilkymistSysctlState *s = MILKYMIST_SYSCTL(d);
255     int i;
256
257     for (i = 0; i < R_MAX; i++) {
258         s->regs[i] = 0;
259     }
260
261     ptimer_stop(s->ptimer0);
262     ptimer_stop(s->ptimer1);
263
264     /* defaults */
265     s->regs[R_ICAP] = ICAP_READY;
266     s->regs[R_SYSTEM_ID] = s->systemid;
267     s->regs[R_CLK_FREQUENCY] = s->freq_hz;
268     s->regs[R_CAPABILITIES] = s->capabilities;
269     s->regs[R_GPIO_IN] = s->strappings;
270 }
271
272 static int milkymist_sysctl_init(SysBusDevice *dev)
273 {
274     MilkymistSysctlState *s = MILKYMIST_SYSCTL(dev);
275
276     sysbus_init_irq(dev, &s->gpio_irq);
277     sysbus_init_irq(dev, &s->timer0_irq);
278     sysbus_init_irq(dev, &s->timer1_irq);
279
280     s->bh0 = qemu_bh_new(timer0_hit, s);
281     s->bh1 = qemu_bh_new(timer1_hit, s);
282     s->ptimer0 = ptimer_init(s->bh0);
283     s->ptimer1 = ptimer_init(s->bh1);
284     ptimer_set_freq(s->ptimer0, s->freq_hz);
285     ptimer_set_freq(s->ptimer1, s->freq_hz);
286
287     memory_region_init_io(&s->regs_region, OBJECT(s), &sysctl_mmio_ops, s,
288             "milkymist-sysctl", R_MAX * 4);
289     sysbus_init_mmio(dev, &s->regs_region);
290
291     return 0;
292 }
293
294 static const VMStateDescription vmstate_milkymist_sysctl = {
295     .name = "milkymist-sysctl",
296     .version_id = 1,
297     .minimum_version_id = 1,
298     .fields = (VMStateField[]) {
299         VMSTATE_UINT32_ARRAY(regs, MilkymistSysctlState, R_MAX),
300         VMSTATE_PTIMER(ptimer0, MilkymistSysctlState),
301         VMSTATE_PTIMER(ptimer1, MilkymistSysctlState),
302         VMSTATE_END_OF_LIST()
303     }
304 };
305
306 static Property milkymist_sysctl_properties[] = {
307     DEFINE_PROP_UINT32("frequency", MilkymistSysctlState,
308     freq_hz, 80000000),
309     DEFINE_PROP_UINT32("capabilities", MilkymistSysctlState,
310     capabilities, 0x00000000),
311     DEFINE_PROP_UINT32("systemid", MilkymistSysctlState,
312     systemid, 0x10014d31),
313     DEFINE_PROP_UINT32("gpio_strappings", MilkymistSysctlState,
314     strappings, 0x00000001),
315     DEFINE_PROP_END_OF_LIST(),
316 };
317
318 static void milkymist_sysctl_class_init(ObjectClass *klass, void *data)
319 {
320     DeviceClass *dc = DEVICE_CLASS(klass);
321     SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
322
323     k->init = milkymist_sysctl_init;
324     dc->reset = milkymist_sysctl_reset;
325     dc->vmsd = &vmstate_milkymist_sysctl;
326     dc->props = milkymist_sysctl_properties;
327 }
328
329 static const TypeInfo milkymist_sysctl_info = {
330     .name          = TYPE_MILKYMIST_SYSCTL,
331     .parent        = TYPE_SYS_BUS_DEVICE,
332     .instance_size = sizeof(MilkymistSysctlState),
333     .class_init    = milkymist_sysctl_class_init,
334 };
335
336 static void milkymist_sysctl_register_types(void)
337 {
338     type_register_static(&milkymist_sysctl_info);
339 }
340
341 type_init(milkymist_sysctl_register_types)