]> git.proxmox.com Git - mirror_qemu.git/blame - hw/arm/strongarm.c
checkpatch: do not warn for multiline parenthesized returned value
[mirror_qemu.git] / hw / arm / strongarm.c
CommitLineData
5bc95aa2
DES
1/*
2 * StrongARM SA-1100/SA-1110 emulation
3 *
4 * Copyright (C) 2011 Dmitry Eremin-Solenikov
5 *
6 * Largely based on StrongARM emulation:
7 * Copyright (c) 2006 Openedhand Ltd.
8 * Written by Andrzej Zaborowski <balrog@zabor.org>
9 *
10 * UART code based on QEMU 16550A UART emulation
11 * Copyright (c) 2003-2004 Fabrice Bellard
12 * Copyright (c) 2008 Citrix Systems, Inc.
13 *
14 * This program is free software; you can redistribute it and/or modify
15 * it under the terms of the GNU General Public License version 2 as
16 * published by the Free Software Foundation.
17 *
18 * This program is distributed in the hope that it will be useful,
19 * but WITHOUT ANY WARRANTY; without even the implied warranty of
20 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 * GNU General Public License for more details.
22 *
23 * You should have received a copy of the GNU General Public License along
24 * with this program; if not, see <http://www.gnu.org/licenses/>.
6b620ca3
PB
25 *
26 * Contributions after 2012-01-13 are licensed under the terms of the
27 * GNU GPL, version 2 or (at your option) any later version.
5bc95aa2 28 */
c8623c02 29
12b16722 30#include "qemu/osdep.h"
a8d25326 31#include "qemu-common.h"
4771d756 32#include "cpu.h"
c8623c02 33#include "hw/boards.h"
83c9f4ca 34#include "hw/sysbus.h"
47b43a1f 35#include "strongarm.h"
1de7afc9 36#include "qemu/error-report.h"
12ec8bd5 37#include "hw/arm/boot.h"
4d43a603 38#include "chardev/char-fe.h"
7566c6ef 39#include "chardev/char-serial.h"
9c17d615 40#include "sysemu/sysemu.h"
8fd06719 41#include "hw/ssi/ssi.h"
f348b6d1 42#include "qemu/cutils.h"
03dd024f 43#include "qemu/log.h"
5bc95aa2
DES
44
45//#define DEBUG
46
47/*
48 TODO
49 - Implement cp15, c14 ?
50 - Implement cp15, c15 !!! (idle used in L)
51 - Implement idle mode handling/DIM
52 - Implement sleep mode/Wake sources
53 - Implement reset control
54 - Implement memory control regs
55 - PCMCIA handling
56 - Maybe support MBGNT/MBREQ
57 - DMA channels
58 - GPCLK
59 - IrDA
60 - MCP
61 - Enhance UART with modem signals
62 */
63
64#ifdef DEBUG
65# define DPRINTF(format, ...) printf(format , ## __VA_ARGS__)
66#else
67# define DPRINTF(format, ...) do { } while (0)
68#endif
69
70static struct {
a8170e5e 71 hwaddr io_base;
5bc95aa2
DES
72 int irq;
73} sa_serial[] = {
74 { 0x80010000, SA_PIC_UART1 },
75 { 0x80030000, SA_PIC_UART2 },
76 { 0x80050000, SA_PIC_UART3 },
77 { 0, 0 }
78};
79
80/* Interrupt Controller */
74e075f6
AF
81
82#define TYPE_STRONGARM_PIC "strongarm_pic"
83#define STRONGARM_PIC(obj) \
84 OBJECT_CHECK(StrongARMPICState, (obj), TYPE_STRONGARM_PIC)
85
86typedef struct StrongARMPICState {
87 SysBusDevice parent_obj;
88
eb2fefbc 89 MemoryRegion iomem;
5bc95aa2
DES
90 qemu_irq irq;
91 qemu_irq fiq;
92
93 uint32_t pending;
94 uint32_t enabled;
95 uint32_t is_fiq;
96 uint32_t int_idle;
97} StrongARMPICState;
98
99#define ICIP 0x00
100#define ICMR 0x04
101#define ICLR 0x08
102#define ICFP 0x10
103#define ICPR 0x20
104#define ICCR 0x0c
105
106#define SA_PIC_SRCS 32
107
108
109static void strongarm_pic_update(void *opaque)
110{
111 StrongARMPICState *s = opaque;
112
113 /* FIXME: reflect DIM */
114 qemu_set_irq(s->fiq, s->pending & s->enabled & s->is_fiq);
115 qemu_set_irq(s->irq, s->pending & s->enabled & ~s->is_fiq);
116}
117
118static void strongarm_pic_set_irq(void *opaque, int irq, int level)
119{
120 StrongARMPICState *s = opaque;
121
122 if (level) {
123 s->pending |= 1 << irq;
124 } else {
125 s->pending &= ~(1 << irq);
126 }
127
128 strongarm_pic_update(s);
129}
130
a8170e5e 131static uint64_t strongarm_pic_mem_read(void *opaque, hwaddr offset,
eb2fefbc 132 unsigned size)
5bc95aa2
DES
133{
134 StrongARMPICState *s = opaque;
135
136 switch (offset) {
137 case ICIP:
138 return s->pending & ~s->is_fiq & s->enabled;
139 case ICMR:
140 return s->enabled;
141 case ICLR:
142 return s->is_fiq;
143 case ICCR:
144 return s->int_idle == 0;
145 case ICFP:
146 return s->pending & s->is_fiq & s->enabled;
147 case ICPR:
148 return s->pending;
149 default:
150 printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
151 __func__, offset);
152 return 0;
153 }
154}
155
a8170e5e 156static void strongarm_pic_mem_write(void *opaque, hwaddr offset,
eb2fefbc 157 uint64_t value, unsigned size)
5bc95aa2
DES
158{
159 StrongARMPICState *s = opaque;
160
161 switch (offset) {
162 case ICMR:
163 s->enabled = value;
164 break;
165 case ICLR:
166 s->is_fiq = value;
167 break;
168 case ICCR:
169 s->int_idle = (value & 1) ? 0 : ~0;
170 break;
171 default:
172 printf("%s: Bad register offset 0x" TARGET_FMT_plx "\n",
173 __func__, offset);
174 break;
175 }
176 strongarm_pic_update(s);
177}
178
eb2fefbc
AK
179static const MemoryRegionOps strongarm_pic_ops = {
180 .read = strongarm_pic_mem_read,
181 .write = strongarm_pic_mem_write,
182 .endianness = DEVICE_NATIVE_ENDIAN,
5bc95aa2
DES
183};
184
5a67508c 185static void strongarm_pic_initfn(Object *obj)
5bc95aa2 186{
5a67508c
XZ
187 DeviceState *dev = DEVICE(obj);
188 StrongARMPICState *s = STRONGARM_PIC(obj);
189 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
5bc95aa2 190
74e075f6 191 qdev_init_gpio_in(dev, strongarm_pic_set_irq, SA_PIC_SRCS);
5a67508c 192 memory_region_init_io(&s->iomem, obj, &strongarm_pic_ops, s,
64bde0f3 193 "pic", 0x1000);
74e075f6
AF
194 sysbus_init_mmio(sbd, &s->iomem);
195 sysbus_init_irq(sbd, &s->irq);
196 sysbus_init_irq(sbd, &s->fiq);
5bc95aa2
DES
197}
198
199static int strongarm_pic_post_load(void *opaque, int version_id)
200{
201 strongarm_pic_update(opaque);
202 return 0;
203}
204
205static VMStateDescription vmstate_strongarm_pic_regs = {
206 .name = "strongarm_pic",
207 .version_id = 0,
208 .minimum_version_id = 0,
5bc95aa2
DES
209 .post_load = strongarm_pic_post_load,
210 .fields = (VMStateField[]) {
211 VMSTATE_UINT32(pending, StrongARMPICState),
212 VMSTATE_UINT32(enabled, StrongARMPICState),
213 VMSTATE_UINT32(is_fiq, StrongARMPICState),
214 VMSTATE_UINT32(int_idle, StrongARMPICState),
215 VMSTATE_END_OF_LIST(),
216 },
217};
218
999e12bb
AL
219static void strongarm_pic_class_init(ObjectClass *klass, void *data)
220{
39bffca2 221 DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb 222
39bffca2
AL
223 dc->desc = "StrongARM PIC";
224 dc->vmsd = &vmstate_strongarm_pic_regs;
999e12bb
AL
225}
226
8c43a6f0 227static const TypeInfo strongarm_pic_info = {
74e075f6 228 .name = TYPE_STRONGARM_PIC,
39bffca2
AL
229 .parent = TYPE_SYS_BUS_DEVICE,
230 .instance_size = sizeof(StrongARMPICState),
5a67508c 231 .instance_init = strongarm_pic_initfn,
39bffca2 232 .class_init = strongarm_pic_class_init,
5bc95aa2
DES
233};
234
235/* Real-Time Clock */
236#define RTAR 0x00 /* RTC Alarm register */
237#define RCNR 0x04 /* RTC Counter register */
238#define RTTR 0x08 /* RTC Timer Trim register */
239#define RTSR 0x10 /* RTC Status register */
240
241#define RTSR_AL (1 << 0) /* RTC Alarm detected */
242#define RTSR_HZ (1 << 1) /* RTC 1Hz detected */
243#define RTSR_ALE (1 << 2) /* RTC Alarm enable */
244#define RTSR_HZE (1 << 3) /* RTC 1Hz enable */
245
246/* 16 LSB of RTTR are clockdiv for internal trim logic,
247 * trim delete isn't emulated, so
248 * f = 32 768 / (RTTR_trim + 1) */
249
4e002105
AF
250#define TYPE_STRONGARM_RTC "strongarm-rtc"
251#define STRONGARM_RTC(obj) \
252 OBJECT_CHECK(StrongARMRTCState, (obj), TYPE_STRONGARM_RTC)
253
254typedef struct StrongARMRTCState {
255 SysBusDevice parent_obj;
256
eb2fefbc 257 MemoryRegion iomem;
5bc95aa2
DES
258 uint32_t rttr;
259 uint32_t rtsr;
260 uint32_t rtar;
261 uint32_t last_rcnr;
262 int64_t last_hz;
263 QEMUTimer *rtc_alarm;
264 QEMUTimer *rtc_hz;
265 qemu_irq rtc_irq;
266 qemu_irq rtc_hz_irq;
267} StrongARMRTCState;
268
269static inline void strongarm_rtc_int_update(StrongARMRTCState *s)
270{
271 qemu_set_irq(s->rtc_irq, s->rtsr & RTSR_AL);
272 qemu_set_irq(s->rtc_hz_irq, s->rtsr & RTSR_HZ);
273}
274
275static void strongarm_rtc_hzupdate(StrongARMRTCState *s)
276{
884f17c2 277 int64_t rt = qemu_clock_get_ms(rtc_clock);
5bc95aa2
DES
278 s->last_rcnr += ((rt - s->last_hz) << 15) /
279 (1000 * ((s->rttr & 0xffff) + 1));
280 s->last_hz = rt;
281}
282
283static inline void strongarm_rtc_timer_update(StrongARMRTCState *s)
284{
285 if ((s->rtsr & RTSR_HZE) && !(s->rtsr & RTSR_HZ)) {
bc72ad67 286 timer_mod(s->rtc_hz, s->last_hz + 1000);
5bc95aa2 287 } else {
bc72ad67 288 timer_del(s->rtc_hz);
5bc95aa2
DES
289 }
290
291 if ((s->rtsr & RTSR_ALE) && !(s->rtsr & RTSR_AL)) {
bc72ad67 292 timer_mod(s->rtc_alarm, s->last_hz +
5bc95aa2
DES
293 (((s->rtar - s->last_rcnr) * 1000 *
294 ((s->rttr & 0xffff) + 1)) >> 15));
295 } else {
bc72ad67 296 timer_del(s->rtc_alarm);
5bc95aa2
DES
297 }
298}
299
300static inline void strongarm_rtc_alarm_tick(void *opaque)
301{
302 StrongARMRTCState *s = opaque;
303 s->rtsr |= RTSR_AL;
304 strongarm_rtc_timer_update(s);
305 strongarm_rtc_int_update(s);
306}
307
308static inline void strongarm_rtc_hz_tick(void *opaque)
309{
310 StrongARMRTCState *s = opaque;
311 s->rtsr |= RTSR_HZ;
312 strongarm_rtc_timer_update(s);
313 strongarm_rtc_int_update(s);
314}
315
a8170e5e 316static uint64_t strongarm_rtc_read(void *opaque, hwaddr addr,
eb2fefbc 317 unsigned size)
5bc95aa2
DES
318{
319 StrongARMRTCState *s = opaque;
320
321 switch (addr) {
322 case RTTR:
323 return s->rttr;
324 case RTSR:
325 return s->rtsr;
326 case RTAR:
327 return s->rtar;
328 case RCNR:
329 return s->last_rcnr +
884f17c2 330 ((qemu_clock_get_ms(rtc_clock) - s->last_hz) << 15) /
5bc95aa2
DES
331 (1000 * ((s->rttr & 0xffff) + 1));
332 default:
333 printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
334 return 0;
335 }
336}
337
a8170e5e 338static void strongarm_rtc_write(void *opaque, hwaddr addr,
eb2fefbc 339 uint64_t value, unsigned size)
5bc95aa2
DES
340{
341 StrongARMRTCState *s = opaque;
342 uint32_t old_rtsr;
343
344 switch (addr) {
345 case RTTR:
346 strongarm_rtc_hzupdate(s);
347 s->rttr = value;
348 strongarm_rtc_timer_update(s);
349 break;
350
351 case RTSR:
352 old_rtsr = s->rtsr;
353 s->rtsr = (value & (RTSR_ALE | RTSR_HZE)) |
354 (s->rtsr & ~(value & (RTSR_AL | RTSR_HZ)));
355
356 if (s->rtsr != old_rtsr) {
357 strongarm_rtc_timer_update(s);
358 }
359
360 strongarm_rtc_int_update(s);
361 break;
362
363 case RTAR:
364 s->rtar = value;
365 strongarm_rtc_timer_update(s);
366 break;
367
368 case RCNR:
369 strongarm_rtc_hzupdate(s);
370 s->last_rcnr = value;
371 strongarm_rtc_timer_update(s);
372 break;
373
374 default:
375 printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
376 }
377}
378
eb2fefbc
AK
379static const MemoryRegionOps strongarm_rtc_ops = {
380 .read = strongarm_rtc_read,
381 .write = strongarm_rtc_write,
382 .endianness = DEVICE_NATIVE_ENDIAN,
5bc95aa2
DES
383};
384
5a67508c 385static void strongarm_rtc_init(Object *obj)
5bc95aa2 386{
5a67508c
XZ
387 StrongARMRTCState *s = STRONGARM_RTC(obj);
388 SysBusDevice *dev = SYS_BUS_DEVICE(obj);
5bc95aa2 389 struct tm tm;
5bc95aa2
DES
390
391 s->rttr = 0x0;
392 s->rtsr = 0;
393
394 qemu_get_timedate(&tm, 0);
395
396 s->last_rcnr = (uint32_t) mktimegm(&tm);
884f17c2 397 s->last_hz = qemu_clock_get_ms(rtc_clock);
5bc95aa2 398
884f17c2
AB
399 s->rtc_alarm = timer_new_ms(rtc_clock, strongarm_rtc_alarm_tick, s);
400 s->rtc_hz = timer_new_ms(rtc_clock, strongarm_rtc_hz_tick, s);
5bc95aa2
DES
401
402 sysbus_init_irq(dev, &s->rtc_irq);
403 sysbus_init_irq(dev, &s->rtc_hz_irq);
404
5a67508c 405 memory_region_init_io(&s->iomem, obj, &strongarm_rtc_ops, s,
64bde0f3 406 "rtc", 0x10000);
750ecd44 407 sysbus_init_mmio(dev, &s->iomem);
5bc95aa2
DES
408}
409
44b1ff31 410static int strongarm_rtc_pre_save(void *opaque)
5bc95aa2
DES
411{
412 StrongARMRTCState *s = opaque;
413
414 strongarm_rtc_hzupdate(s);
44b1ff31
DDAG
415
416 return 0;
5bc95aa2
DES
417}
418
419static int strongarm_rtc_post_load(void *opaque, int version_id)
420{
421 StrongARMRTCState *s = opaque;
422
423 strongarm_rtc_timer_update(s);
424 strongarm_rtc_int_update(s);
425
426 return 0;
427}
428
429static const VMStateDescription vmstate_strongarm_rtc_regs = {
430 .name = "strongarm-rtc",
431 .version_id = 0,
432 .minimum_version_id = 0,
5bc95aa2
DES
433 .pre_save = strongarm_rtc_pre_save,
434 .post_load = strongarm_rtc_post_load,
435 .fields = (VMStateField[]) {
436 VMSTATE_UINT32(rttr, StrongARMRTCState),
437 VMSTATE_UINT32(rtsr, StrongARMRTCState),
438 VMSTATE_UINT32(rtar, StrongARMRTCState),
439 VMSTATE_UINT32(last_rcnr, StrongARMRTCState),
440 VMSTATE_INT64(last_hz, StrongARMRTCState),
441 VMSTATE_END_OF_LIST(),
442 },
443};
444
999e12bb
AL
445static void strongarm_rtc_sysbus_class_init(ObjectClass *klass, void *data)
446{
39bffca2 447 DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb 448
39bffca2
AL
449 dc->desc = "StrongARM RTC Controller";
450 dc->vmsd = &vmstate_strongarm_rtc_regs;
999e12bb
AL
451}
452
8c43a6f0 453static const TypeInfo strongarm_rtc_sysbus_info = {
4e002105 454 .name = TYPE_STRONGARM_RTC,
39bffca2
AL
455 .parent = TYPE_SYS_BUS_DEVICE,
456 .instance_size = sizeof(StrongARMRTCState),
5a67508c 457 .instance_init = strongarm_rtc_init,
39bffca2 458 .class_init = strongarm_rtc_sysbus_class_init,
5bc95aa2
DES
459};
460
461/* GPIO */
462#define GPLR 0x00
463#define GPDR 0x04
464#define GPSR 0x08
465#define GPCR 0x0c
466#define GRER 0x10
467#define GFER 0x14
468#define GEDR 0x18
469#define GAFR 0x1c
470
f55beb84
AF
471#define TYPE_STRONGARM_GPIO "strongarm-gpio"
472#define STRONGARM_GPIO(obj) \
473 OBJECT_CHECK(StrongARMGPIOInfo, (obj), TYPE_STRONGARM_GPIO)
474
5bc95aa2
DES
475typedef struct StrongARMGPIOInfo StrongARMGPIOInfo;
476struct StrongARMGPIOInfo {
477 SysBusDevice busdev;
eb2fefbc 478 MemoryRegion iomem;
5bc95aa2
DES
479 qemu_irq handler[28];
480 qemu_irq irqs[11];
481 qemu_irq irqX;
482
483 uint32_t ilevel;
484 uint32_t olevel;
485 uint32_t dir;
486 uint32_t rising;
487 uint32_t falling;
488 uint32_t status;
5bc95aa2
DES
489 uint32_t gafr;
490
491 uint32_t prev_level;
492};
493
494
495static void strongarm_gpio_irq_update(StrongARMGPIOInfo *s)
496{
497 int i;
498 for (i = 0; i < 11; i++) {
499 qemu_set_irq(s->irqs[i], s->status & (1 << i));
500 }
501
502 qemu_set_irq(s->irqX, (s->status & ~0x7ff));
503}
504
505static void strongarm_gpio_set(void *opaque, int line, int level)
506{
507 StrongARMGPIOInfo *s = opaque;
508 uint32_t mask;
509
510 mask = 1 << line;
511
512 if (level) {
513 s->status |= s->rising & mask &
514 ~s->ilevel & ~s->dir;
515 s->ilevel |= mask;
516 } else {
517 s->status |= s->falling & mask &
518 s->ilevel & ~s->dir;
519 s->ilevel &= ~mask;
520 }
521
522 if (s->status & mask) {
523 strongarm_gpio_irq_update(s);
524 }
525}
526
527static void strongarm_gpio_handler_update(StrongARMGPIOInfo *s)
528{
529 uint32_t level, diff;
530 int bit;
531
532 level = s->olevel & s->dir;
533
534 for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
786a4ea8 535 bit = ctz32(diff);
5bc95aa2
DES
536 qemu_set_irq(s->handler[bit], (level >> bit) & 1);
537 }
538
539 s->prev_level = level;
540}
541
a8170e5e 542static uint64_t strongarm_gpio_read(void *opaque, hwaddr offset,
eb2fefbc 543 unsigned size)
5bc95aa2
DES
544{
545 StrongARMGPIOInfo *s = opaque;
546
547 switch (offset) {
548 case GPDR: /* GPIO Pin-Direction registers */
549 return s->dir;
550
551 case GPSR: /* GPIO Pin-Output Set registers */
92335a0d
PM
552 qemu_log_mask(LOG_GUEST_ERROR,
553 "strongarm GPIO: read from write only register GPSR\n");
554 return 0;
5bc95aa2
DES
555
556 case GPCR: /* GPIO Pin-Output Clear registers */
92335a0d
PM
557 qemu_log_mask(LOG_GUEST_ERROR,
558 "strongarm GPIO: read from write only register GPCR\n");
559 return 0;
5bc95aa2
DES
560
561 case GRER: /* GPIO Rising-Edge Detect Enable registers */
562 return s->rising;
563
564 case GFER: /* GPIO Falling-Edge Detect Enable registers */
565 return s->falling;
566
567 case GAFR: /* GPIO Alternate Function registers */
568 return s->gafr;
569
570 case GPLR: /* GPIO Pin-Level registers */
571 return (s->olevel & s->dir) |
572 (s->ilevel & ~s->dir);
573
574 case GEDR: /* GPIO Edge Detect Status registers */
575 return s->status;
576
577 default:
578 printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
579 }
580
581 return 0;
582}
583
a8170e5e 584static void strongarm_gpio_write(void *opaque, hwaddr offset,
eb2fefbc 585 uint64_t value, unsigned size)
5bc95aa2
DES
586{
587 StrongARMGPIOInfo *s = opaque;
588
589 switch (offset) {
590 case GPDR: /* GPIO Pin-Direction registers */
9a93b2fa 591 s->dir = value & 0x0fffffff;
5bc95aa2
DES
592 strongarm_gpio_handler_update(s);
593 break;
594
595 case GPSR: /* GPIO Pin-Output Set registers */
9a93b2fa 596 s->olevel |= value & 0x0fffffff;
5bc95aa2 597 strongarm_gpio_handler_update(s);
5bc95aa2
DES
598 break;
599
600 case GPCR: /* GPIO Pin-Output Clear registers */
601 s->olevel &= ~value;
602 strongarm_gpio_handler_update(s);
603 break;
604
605 case GRER: /* GPIO Rising-Edge Detect Enable registers */
606 s->rising = value;
607 break;
608
609 case GFER: /* GPIO Falling-Edge Detect Enable registers */
610 s->falling = value;
611 break;
612
613 case GAFR: /* GPIO Alternate Function registers */
614 s->gafr = value;
615 break;
616
617 case GEDR: /* GPIO Edge Detect Status registers */
618 s->status &= ~value;
619 strongarm_gpio_irq_update(s);
620 break;
621
622 default:
623 printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
624 }
625}
626
eb2fefbc
AK
627static const MemoryRegionOps strongarm_gpio_ops = {
628 .read = strongarm_gpio_read,
629 .write = strongarm_gpio_write,
630 .endianness = DEVICE_NATIVE_ENDIAN,
5bc95aa2
DES
631};
632
a8170e5e 633static DeviceState *strongarm_gpio_init(hwaddr base,
5bc95aa2
DES
634 DeviceState *pic)
635{
636 DeviceState *dev;
637 int i;
638
f55beb84 639 dev = qdev_create(NULL, TYPE_STRONGARM_GPIO);
5bc95aa2
DES
640 qdev_init_nofail(dev);
641
1356b98d 642 sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0, base);
5bc95aa2 643 for (i = 0; i < 12; i++)
1356b98d 644 sysbus_connect_irq(SYS_BUS_DEVICE(dev), i,
5bc95aa2
DES
645 qdev_get_gpio_in(pic, SA_PIC_GPIO0_EDGE + i));
646
647 return dev;
648}
649
5a67508c 650static void strongarm_gpio_initfn(Object *obj)
5bc95aa2 651{
5a67508c
XZ
652 DeviceState *dev = DEVICE(obj);
653 StrongARMGPIOInfo *s = STRONGARM_GPIO(obj);
654 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
5bc95aa2
DES
655 int i;
656
f55beb84
AF
657 qdev_init_gpio_in(dev, strongarm_gpio_set, 28);
658 qdev_init_gpio_out(dev, s->handler, 28);
5bc95aa2 659
5a67508c 660 memory_region_init_io(&s->iomem, obj, &strongarm_gpio_ops, s,
64bde0f3 661 "gpio", 0x1000);
5bc95aa2 662
f55beb84 663 sysbus_init_mmio(sbd, &s->iomem);
5bc95aa2 664 for (i = 0; i < 11; i++) {
f55beb84 665 sysbus_init_irq(sbd, &s->irqs[i]);
5bc95aa2 666 }
f55beb84 667 sysbus_init_irq(sbd, &s->irqX);
5bc95aa2
DES
668}
669
670static const VMStateDescription vmstate_strongarm_gpio_regs = {
671 .name = "strongarm-gpio",
672 .version_id = 0,
673 .minimum_version_id = 0,
5bc95aa2
DES
674 .fields = (VMStateField[]) {
675 VMSTATE_UINT32(ilevel, StrongARMGPIOInfo),
676 VMSTATE_UINT32(olevel, StrongARMGPIOInfo),
677 VMSTATE_UINT32(dir, StrongARMGPIOInfo),
678 VMSTATE_UINT32(rising, StrongARMGPIOInfo),
679 VMSTATE_UINT32(falling, StrongARMGPIOInfo),
680 VMSTATE_UINT32(status, StrongARMGPIOInfo),
681 VMSTATE_UINT32(gafr, StrongARMGPIOInfo),
ed657d71 682 VMSTATE_UINT32(prev_level, StrongARMGPIOInfo),
5bc95aa2
DES
683 VMSTATE_END_OF_LIST(),
684 },
685};
686
999e12bb
AL
687static void strongarm_gpio_class_init(ObjectClass *klass, void *data)
688{
39bffca2 689 DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb 690
39bffca2 691 dc->desc = "StrongARM GPIO controller";
ed657d71 692 dc->vmsd = &vmstate_strongarm_gpio_regs;
999e12bb
AL
693}
694
8c43a6f0 695static const TypeInfo strongarm_gpio_info = {
f55beb84 696 .name = TYPE_STRONGARM_GPIO,
39bffca2
AL
697 .parent = TYPE_SYS_BUS_DEVICE,
698 .instance_size = sizeof(StrongARMGPIOInfo),
5a67508c 699 .instance_init = strongarm_gpio_initfn,
39bffca2 700 .class_init = strongarm_gpio_class_init,
5bc95aa2
DES
701};
702
703/* Peripheral Pin Controller */
704#define PPDR 0x00
705#define PPSR 0x04
706#define PPAR 0x08
707#define PSDR 0x0c
708#define PPFR 0x10
709
c71e6732
AF
710#define TYPE_STRONGARM_PPC "strongarm-ppc"
711#define STRONGARM_PPC(obj) \
712 OBJECT_CHECK(StrongARMPPCInfo, (obj), TYPE_STRONGARM_PPC)
713
5bc95aa2
DES
714typedef struct StrongARMPPCInfo StrongARMPPCInfo;
715struct StrongARMPPCInfo {
c71e6732
AF
716 SysBusDevice parent_obj;
717
eb2fefbc 718 MemoryRegion iomem;
5bc95aa2
DES
719 qemu_irq handler[28];
720
721 uint32_t ilevel;
722 uint32_t olevel;
723 uint32_t dir;
724 uint32_t ppar;
725 uint32_t psdr;
726 uint32_t ppfr;
727
728 uint32_t prev_level;
729};
730
731static void strongarm_ppc_set(void *opaque, int line, int level)
732{
733 StrongARMPPCInfo *s = opaque;
734
735 if (level) {
736 s->ilevel |= 1 << line;
737 } else {
738 s->ilevel &= ~(1 << line);
739 }
740}
741
742static void strongarm_ppc_handler_update(StrongARMPPCInfo *s)
743{
744 uint32_t level, diff;
745 int bit;
746
747 level = s->olevel & s->dir;
748
749 for (diff = s->prev_level ^ level; diff; diff ^= 1 << bit) {
786a4ea8 750 bit = ctz32(diff);
5bc95aa2
DES
751 qemu_set_irq(s->handler[bit], (level >> bit) & 1);
752 }
753
754 s->prev_level = level;
755}
756
a8170e5e 757static uint64_t strongarm_ppc_read(void *opaque, hwaddr offset,
eb2fefbc 758 unsigned size)
5bc95aa2
DES
759{
760 StrongARMPPCInfo *s = opaque;
761
762 switch (offset) {
763 case PPDR: /* PPC Pin Direction registers */
764 return s->dir | ~0x3fffff;
765
766 case PPSR: /* PPC Pin State registers */
767 return (s->olevel & s->dir) |
768 (s->ilevel & ~s->dir) |
769 ~0x3fffff;
770
771 case PPAR:
772 return s->ppar | ~0x41000;
773
774 case PSDR:
775 return s->psdr;
776
777 case PPFR:
778 return s->ppfr | ~0x7f001;
779
780 default:
781 printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
782 }
783
784 return 0;
785}
786
a8170e5e 787static void strongarm_ppc_write(void *opaque, hwaddr offset,
eb2fefbc 788 uint64_t value, unsigned size)
5bc95aa2
DES
789{
790 StrongARMPPCInfo *s = opaque;
791
792 switch (offset) {
793 case PPDR: /* PPC Pin Direction registers */
794 s->dir = value & 0x3fffff;
795 strongarm_ppc_handler_update(s);
796 break;
797
798 case PPSR: /* PPC Pin State registers */
799 s->olevel = value & s->dir & 0x3fffff;
800 strongarm_ppc_handler_update(s);
801 break;
802
803 case PPAR:
804 s->ppar = value & 0x41000;
805 break;
806
807 case PSDR:
808 s->psdr = value & 0x3fffff;
809 break;
810
811 case PPFR:
812 s->ppfr = value & 0x7f001;
813 break;
814
815 default:
816 printf("%s: Bad offset 0x" TARGET_FMT_plx "\n", __func__, offset);
817 }
818}
819
eb2fefbc
AK
820static const MemoryRegionOps strongarm_ppc_ops = {
821 .read = strongarm_ppc_read,
822 .write = strongarm_ppc_write,
823 .endianness = DEVICE_NATIVE_ENDIAN,
5bc95aa2
DES
824};
825
5a67508c 826static void strongarm_ppc_init(Object *obj)
5bc95aa2 827{
5a67508c
XZ
828 DeviceState *dev = DEVICE(obj);
829 StrongARMPPCInfo *s = STRONGARM_PPC(obj);
830 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
5bc95aa2 831
c71e6732
AF
832 qdev_init_gpio_in(dev, strongarm_ppc_set, 22);
833 qdev_init_gpio_out(dev, s->handler, 22);
5bc95aa2 834
5a67508c 835 memory_region_init_io(&s->iomem, obj, &strongarm_ppc_ops, s,
64bde0f3 836 "ppc", 0x1000);
5bc95aa2 837
c71e6732 838 sysbus_init_mmio(sbd, &s->iomem);
5bc95aa2
DES
839}
840
841static const VMStateDescription vmstate_strongarm_ppc_regs = {
842 .name = "strongarm-ppc",
843 .version_id = 0,
844 .minimum_version_id = 0,
5bc95aa2
DES
845 .fields = (VMStateField[]) {
846 VMSTATE_UINT32(ilevel, StrongARMPPCInfo),
847 VMSTATE_UINT32(olevel, StrongARMPPCInfo),
848 VMSTATE_UINT32(dir, StrongARMPPCInfo),
849 VMSTATE_UINT32(ppar, StrongARMPPCInfo),
850 VMSTATE_UINT32(psdr, StrongARMPPCInfo),
851 VMSTATE_UINT32(ppfr, StrongARMPPCInfo),
ed657d71 852 VMSTATE_UINT32(prev_level, StrongARMPPCInfo),
5bc95aa2
DES
853 VMSTATE_END_OF_LIST(),
854 },
855};
856
999e12bb
AL
857static void strongarm_ppc_class_init(ObjectClass *klass, void *data)
858{
39bffca2 859 DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb 860
39bffca2 861 dc->desc = "StrongARM PPC controller";
ed657d71 862 dc->vmsd = &vmstate_strongarm_ppc_regs;
999e12bb
AL
863}
864
8c43a6f0 865static const TypeInfo strongarm_ppc_info = {
c71e6732 866 .name = TYPE_STRONGARM_PPC,
39bffca2
AL
867 .parent = TYPE_SYS_BUS_DEVICE,
868 .instance_size = sizeof(StrongARMPPCInfo),
5a67508c 869 .instance_init = strongarm_ppc_init,
39bffca2 870 .class_init = strongarm_ppc_class_init,
5bc95aa2
DES
871};
872
873/* UART Ports */
874#define UTCR0 0x00
875#define UTCR1 0x04
876#define UTCR2 0x08
877#define UTCR3 0x0c
878#define UTDR 0x14
879#define UTSR0 0x1c
880#define UTSR1 0x20
881
882#define UTCR0_PE (1 << 0) /* Parity enable */
883#define UTCR0_OES (1 << 1) /* Even parity */
884#define UTCR0_SBS (1 << 2) /* 2 stop bits */
885#define UTCR0_DSS (1 << 3) /* 8-bit data */
886
887#define UTCR3_RXE (1 << 0) /* Rx enable */
888#define UTCR3_TXE (1 << 1) /* Tx enable */
889#define UTCR3_BRK (1 << 2) /* Force Break */
890#define UTCR3_RIE (1 << 3) /* Rx int enable */
891#define UTCR3_TIE (1 << 4) /* Tx int enable */
892#define UTCR3_LBM (1 << 5) /* Loopback */
893
894#define UTSR0_TFS (1 << 0) /* Tx FIFO nearly empty */
895#define UTSR0_RFS (1 << 1) /* Rx FIFO nearly full */
896#define UTSR0_RID (1 << 2) /* Receiver Idle */
897#define UTSR0_RBB (1 << 3) /* Receiver begin break */
898#define UTSR0_REB (1 << 4) /* Receiver end break */
899#define UTSR0_EIF (1 << 5) /* Error in FIFO */
900
901#define UTSR1_RNE (1 << 1) /* Receive FIFO not empty */
902#define UTSR1_TNF (1 << 2) /* Transmit FIFO not full */
903#define UTSR1_PRE (1 << 3) /* Parity error */
904#define UTSR1_FRE (1 << 4) /* Frame error */
905#define UTSR1_ROR (1 << 5) /* Receive Over Run */
906
907#define RX_FIFO_PRE (1 << 8)
908#define RX_FIFO_FRE (1 << 9)
909#define RX_FIFO_ROR (1 << 10)
910
fff3af97
AF
911#define TYPE_STRONGARM_UART "strongarm-uart"
912#define STRONGARM_UART(obj) \
913 OBJECT_CHECK(StrongARMUARTState, (obj), TYPE_STRONGARM_UART)
914
915typedef struct StrongARMUARTState {
916 SysBusDevice parent_obj;
917
eb2fefbc 918 MemoryRegion iomem;
becdfa00 919 CharBackend chr;
5bc95aa2
DES
920 qemu_irq irq;
921
922 uint8_t utcr0;
923 uint16_t brd;
924 uint8_t utcr3;
925 uint8_t utsr0;
926 uint8_t utsr1;
927
928 uint8_t tx_fifo[8];
929 uint8_t tx_start;
930 uint8_t tx_len;
931 uint16_t rx_fifo[12]; /* value + error flags in high bits */
932 uint8_t rx_start;
933 uint8_t rx_len;
934
935 uint64_t char_transmit_time; /* time to transmit a char in ticks*/
936 bool wait_break_end;
937 QEMUTimer *rx_timeout_timer;
938 QEMUTimer *tx_timer;
939} StrongARMUARTState;
940
941static void strongarm_uart_update_status(StrongARMUARTState *s)
942{
943 uint16_t utsr1 = 0;
944
945 if (s->tx_len != 8) {
946 utsr1 |= UTSR1_TNF;
947 }
948
949 if (s->rx_len != 0) {
950 uint16_t ent = s->rx_fifo[s->rx_start];
951
952 utsr1 |= UTSR1_RNE;
953 if (ent & RX_FIFO_PRE) {
954 s->utsr1 |= UTSR1_PRE;
955 }
956 if (ent & RX_FIFO_FRE) {
957 s->utsr1 |= UTSR1_FRE;
958 }
959 if (ent & RX_FIFO_ROR) {
960 s->utsr1 |= UTSR1_ROR;
961 }
962 }
963
964 s->utsr1 = utsr1;
965}
966
967static void strongarm_uart_update_int_status(StrongARMUARTState *s)
968{
969 uint16_t utsr0 = s->utsr0 &
970 (UTSR0_REB | UTSR0_RBB | UTSR0_RID);
971 int i;
972
973 if ((s->utcr3 & UTCR3_TXE) &&
974 (s->utcr3 & UTCR3_TIE) &&
975 s->tx_len <= 4) {
976 utsr0 |= UTSR0_TFS;
977 }
978
979 if ((s->utcr3 & UTCR3_RXE) &&
980 (s->utcr3 & UTCR3_RIE) &&
981 s->rx_len > 4) {
982 utsr0 |= UTSR0_RFS;
983 }
984
985 for (i = 0; i < s->rx_len && i < 4; i++)
986 if (s->rx_fifo[(s->rx_start + i) % 12] & ~0xff) {
987 utsr0 |= UTSR0_EIF;
988 break;
989 }
990
991 s->utsr0 = utsr0;
992 qemu_set_irq(s->irq, utsr0);
993}
994
995static void strongarm_uart_update_parameters(StrongARMUARTState *s)
996{
997 int speed, parity, data_bits, stop_bits, frame_size;
998 QEMUSerialSetParams ssp;
999
1000 /* Start bit. */
1001 frame_size = 1;
1002 if (s->utcr0 & UTCR0_PE) {
1003 /* Parity bit. */
1004 frame_size++;
1005 if (s->utcr0 & UTCR0_OES) {
1006 parity = 'E';
1007 } else {
1008 parity = 'O';
1009 }
1010 } else {
1011 parity = 'N';
1012 }
1013 if (s->utcr0 & UTCR0_SBS) {
1014 stop_bits = 2;
1015 } else {
1016 stop_bits = 1;
1017 }
1018
1019 data_bits = (s->utcr0 & UTCR0_DSS) ? 8 : 7;
1020 frame_size += data_bits + stop_bits;
1021 speed = 3686400 / 16 / (s->brd + 1);
1022 ssp.speed = speed;
1023 ssp.parity = parity;
1024 ssp.data_bits = data_bits;
1025 ssp.stop_bits = stop_bits;
73bcb24d 1026 s->char_transmit_time = (NANOSECONDS_PER_SECOND / speed) * frame_size;
fa394ed6 1027 qemu_chr_fe_ioctl(&s->chr, CHR_IOCTL_SERIAL_SET_PARAMS, &ssp);
5bc95aa2
DES
1028
1029 DPRINTF(stderr, "%s speed=%d parity=%c data=%d stop=%d\n", s->chr->label,
1030 speed, parity, data_bits, stop_bits);
1031}
1032
1033static void strongarm_uart_rx_to(void *opaque)
1034{
1035 StrongARMUARTState *s = opaque;
1036
1037 if (s->rx_len) {
1038 s->utsr0 |= UTSR0_RID;
1039 strongarm_uart_update_int_status(s);
1040 }
1041}
1042
1043static void strongarm_uart_rx_push(StrongARMUARTState *s, uint16_t c)
1044{
1045 if ((s->utcr3 & UTCR3_RXE) == 0) {
1046 /* rx disabled */
1047 return;
1048 }
1049
1050 if (s->wait_break_end) {
1051 s->utsr0 |= UTSR0_REB;
1052 s->wait_break_end = false;
1053 }
1054
1055 if (s->rx_len < 12) {
1056 s->rx_fifo[(s->rx_start + s->rx_len) % 12] = c;
1057 s->rx_len++;
1058 } else
1059 s->rx_fifo[(s->rx_start + 11) % 12] |= RX_FIFO_ROR;
1060}
1061
1062static int strongarm_uart_can_receive(void *opaque)
1063{
1064 StrongARMUARTState *s = opaque;
1065
1066 if (s->rx_len == 12) {
1067 return 0;
1068 }
1069 /* It's best not to get more than 2/3 of RX FIFO, so advertise that much */
1070 if (s->rx_len < 8) {
1071 return 8 - s->rx_len;
1072 }
1073 return 1;
1074}
1075
1076static void strongarm_uart_receive(void *opaque, const uint8_t *buf, int size)
1077{
1078 StrongARMUARTState *s = opaque;
1079 int i;
1080
1081 for (i = 0; i < size; i++) {
1082 strongarm_uart_rx_push(s, buf[i]);
1083 }
1084
1085 /* call the timeout receive callback in 3 char transmit time */
bc72ad67
AB
1086 timer_mod(s->rx_timeout_timer,
1087 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
5bc95aa2
DES
1088
1089 strongarm_uart_update_status(s);
1090 strongarm_uart_update_int_status(s);
1091}
1092
1093static void strongarm_uart_event(void *opaque, int event)
1094{
1095 StrongARMUARTState *s = opaque;
1096 if (event == CHR_EVENT_BREAK) {
1097 s->utsr0 |= UTSR0_RBB;
1098 strongarm_uart_rx_push(s, RX_FIFO_FRE);
1099 s->wait_break_end = true;
1100 strongarm_uart_update_status(s);
1101 strongarm_uart_update_int_status(s);
1102 }
1103}
1104
1105static void strongarm_uart_tx(void *opaque)
1106{
1107 StrongARMUARTState *s = opaque;
bc72ad67 1108 uint64_t new_xmit_ts = qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL);
5bc95aa2
DES
1109
1110 if (s->utcr3 & UTCR3_LBM) /* loopback */ {
1111 strongarm_uart_receive(s, &s->tx_fifo[s->tx_start], 1);
30650701 1112 } else if (qemu_chr_fe_backend_connected(&s->chr)) {
6ab3fc32
DB
1113 /* XXX this blocks entire thread. Rewrite to use
1114 * qemu_chr_fe_write and background I/O callbacks */
5345fdb4 1115 qemu_chr_fe_write_all(&s->chr, &s->tx_fifo[s->tx_start], 1);
5bc95aa2
DES
1116 }
1117
1118 s->tx_start = (s->tx_start + 1) % 8;
1119 s->tx_len--;
1120 if (s->tx_len) {
bc72ad67 1121 timer_mod(s->tx_timer, new_xmit_ts + s->char_transmit_time);
5bc95aa2
DES
1122 }
1123 strongarm_uart_update_status(s);
1124 strongarm_uart_update_int_status(s);
1125}
1126
a8170e5e 1127static uint64_t strongarm_uart_read(void *opaque, hwaddr addr,
eb2fefbc 1128 unsigned size)
5bc95aa2
DES
1129{
1130 StrongARMUARTState *s = opaque;
1131 uint16_t ret;
1132
1133 switch (addr) {
1134 case UTCR0:
1135 return s->utcr0;
1136
1137 case UTCR1:
1138 return s->brd >> 8;
1139
1140 case UTCR2:
1141 return s->brd & 0xff;
1142
1143 case UTCR3:
1144 return s->utcr3;
1145
1146 case UTDR:
1147 if (s->rx_len != 0) {
1148 ret = s->rx_fifo[s->rx_start];
1149 s->rx_start = (s->rx_start + 1) % 12;
1150 s->rx_len--;
1151 strongarm_uart_update_status(s);
1152 strongarm_uart_update_int_status(s);
1153 return ret;
1154 }
1155 return 0;
1156
1157 case UTSR0:
1158 return s->utsr0;
1159
1160 case UTSR1:
1161 return s->utsr1;
1162
1163 default:
1164 printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1165 return 0;
1166 }
1167}
1168
a8170e5e 1169static void strongarm_uart_write(void *opaque, hwaddr addr,
eb2fefbc 1170 uint64_t value, unsigned size)
5bc95aa2
DES
1171{
1172 StrongARMUARTState *s = opaque;
1173
1174 switch (addr) {
1175 case UTCR0:
1176 s->utcr0 = value & 0x7f;
1177 strongarm_uart_update_parameters(s);
1178 break;
1179
1180 case UTCR1:
1181 s->brd = (s->brd & 0xff) | ((value & 0xf) << 8);
1182 strongarm_uart_update_parameters(s);
1183 break;
1184
1185 case UTCR2:
1186 s->brd = (s->brd & 0xf00) | (value & 0xff);
1187 strongarm_uart_update_parameters(s);
1188 break;
1189
1190 case UTCR3:
1191 s->utcr3 = value & 0x3f;
1192 if ((s->utcr3 & UTCR3_RXE) == 0) {
1193 s->rx_len = 0;
1194 }
1195 if ((s->utcr3 & UTCR3_TXE) == 0) {
1196 s->tx_len = 0;
1197 }
1198 strongarm_uart_update_status(s);
1199 strongarm_uart_update_int_status(s);
1200 break;
1201
1202 case UTDR:
1203 if ((s->utcr3 & UTCR3_TXE) && s->tx_len != 8) {
1204 s->tx_fifo[(s->tx_start + s->tx_len) % 8] = value;
1205 s->tx_len++;
1206 strongarm_uart_update_status(s);
1207 strongarm_uart_update_int_status(s);
1208 if (s->tx_len == 1) {
1209 strongarm_uart_tx(s);
1210 }
1211 }
1212 break;
1213
1214 case UTSR0:
1215 s->utsr0 = s->utsr0 & ~(value &
1216 (UTSR0_REB | UTSR0_RBB | UTSR0_RID));
1217 strongarm_uart_update_int_status(s);
1218 break;
1219
1220 default:
1221 printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1222 }
1223}
1224
eb2fefbc
AK
1225static const MemoryRegionOps strongarm_uart_ops = {
1226 .read = strongarm_uart_read,
1227 .write = strongarm_uart_write,
1228 .endianness = DEVICE_NATIVE_ENDIAN,
5bc95aa2
DES
1229};
1230
5a67508c 1231static void strongarm_uart_init(Object *obj)
5bc95aa2 1232{
5a67508c
XZ
1233 StrongARMUARTState *s = STRONGARM_UART(obj);
1234 SysBusDevice *dev = SYS_BUS_DEVICE(obj);
5bc95aa2 1235
5a67508c 1236 memory_region_init_io(&s->iomem, obj, &strongarm_uart_ops, s,
64bde0f3 1237 "uart", 0x10000);
750ecd44 1238 sysbus_init_mmio(dev, &s->iomem);
5bc95aa2
DES
1239 sysbus_init_irq(dev, &s->irq);
1240
bc72ad67
AB
1241 s->rx_timeout_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_rx_to, s);
1242 s->tx_timer = timer_new_ns(QEMU_CLOCK_VIRTUAL, strongarm_uart_tx, s);
8934515a
XZ
1243}
1244
1245static void strongarm_uart_realize(DeviceState *dev, Error **errp)
1246{
1247 StrongARMUARTState *s = STRONGARM_UART(dev);
5bc95aa2 1248
fa394ed6
MAL
1249 qemu_chr_fe_set_handlers(&s->chr,
1250 strongarm_uart_can_receive,
1251 strongarm_uart_receive,
1252 strongarm_uart_event,
81517ba3 1253 NULL, s, NULL, true);
5bc95aa2
DES
1254}
1255
1256static void strongarm_uart_reset(DeviceState *dev)
1257{
fff3af97 1258 StrongARMUARTState *s = STRONGARM_UART(dev);
5bc95aa2
DES
1259
1260 s->utcr0 = UTCR0_DSS; /* 8 data, no parity */
1261 s->brd = 23; /* 9600 */
1262 /* enable send & recv - this actually violates spec */
1263 s->utcr3 = UTCR3_TXE | UTCR3_RXE;
1264
1265 s->rx_len = s->tx_len = 0;
1266
1267 strongarm_uart_update_parameters(s);
1268 strongarm_uart_update_status(s);
1269 strongarm_uart_update_int_status(s);
1270}
1271
1272static int strongarm_uart_post_load(void *opaque, int version_id)
1273{
1274 StrongARMUARTState *s = opaque;
1275
1276 strongarm_uart_update_parameters(s);
1277 strongarm_uart_update_status(s);
1278 strongarm_uart_update_int_status(s);
1279
1280 /* tx and restart timer */
1281 if (s->tx_len) {
1282 strongarm_uart_tx(s);
1283 }
1284
1285 /* restart rx timeout timer */
1286 if (s->rx_len) {
bc72ad67
AB
1287 timer_mod(s->rx_timeout_timer,
1288 qemu_clock_get_ns(QEMU_CLOCK_VIRTUAL) + s->char_transmit_time * 3);
5bc95aa2
DES
1289 }
1290
1291 return 0;
1292}
1293
1294static const VMStateDescription vmstate_strongarm_uart_regs = {
1295 .name = "strongarm-uart",
1296 .version_id = 0,
1297 .minimum_version_id = 0,
5bc95aa2
DES
1298 .post_load = strongarm_uart_post_load,
1299 .fields = (VMStateField[]) {
1300 VMSTATE_UINT8(utcr0, StrongARMUARTState),
1301 VMSTATE_UINT16(brd, StrongARMUARTState),
1302 VMSTATE_UINT8(utcr3, StrongARMUARTState),
1303 VMSTATE_UINT8(utsr0, StrongARMUARTState),
1304 VMSTATE_UINT8_ARRAY(tx_fifo, StrongARMUARTState, 8),
1305 VMSTATE_UINT8(tx_start, StrongARMUARTState),
1306 VMSTATE_UINT8(tx_len, StrongARMUARTState),
1307 VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMUARTState, 12),
1308 VMSTATE_UINT8(rx_start, StrongARMUARTState),
1309 VMSTATE_UINT8(rx_len, StrongARMUARTState),
1310 VMSTATE_BOOL(wait_break_end, StrongARMUARTState),
1311 VMSTATE_END_OF_LIST(),
1312 },
1313};
1314
999e12bb
AL
1315static Property strongarm_uart_properties[] = {
1316 DEFINE_PROP_CHR("chardev", StrongARMUARTState, chr),
1317 DEFINE_PROP_END_OF_LIST(),
1318};
1319
1320static void strongarm_uart_class_init(ObjectClass *klass, void *data)
1321{
39bffca2 1322 DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb 1323
39bffca2
AL
1324 dc->desc = "StrongARM UART controller";
1325 dc->reset = strongarm_uart_reset;
1326 dc->vmsd = &vmstate_strongarm_uart_regs;
1327 dc->props = strongarm_uart_properties;
8934515a 1328 dc->realize = strongarm_uart_realize;
999e12bb
AL
1329}
1330
8c43a6f0 1331static const TypeInfo strongarm_uart_info = {
fff3af97 1332 .name = TYPE_STRONGARM_UART,
39bffca2
AL
1333 .parent = TYPE_SYS_BUS_DEVICE,
1334 .instance_size = sizeof(StrongARMUARTState),
5a67508c 1335 .instance_init = strongarm_uart_init,
39bffca2 1336 .class_init = strongarm_uart_class_init,
5bc95aa2
DES
1337};
1338
1339/* Synchronous Serial Ports */
0ca81872
AF
1340
1341#define TYPE_STRONGARM_SSP "strongarm-ssp"
1342#define STRONGARM_SSP(obj) \
1343 OBJECT_CHECK(StrongARMSSPState, (obj), TYPE_STRONGARM_SSP)
1344
1345typedef struct StrongARMSSPState {
1346 SysBusDevice parent_obj;
1347
eb2fefbc 1348 MemoryRegion iomem;
5bc95aa2
DES
1349 qemu_irq irq;
1350 SSIBus *bus;
1351
1352 uint16_t sscr[2];
1353 uint16_t sssr;
1354
1355 uint16_t rx_fifo[8];
1356 uint8_t rx_level;
1357 uint8_t rx_start;
1358} StrongARMSSPState;
1359
1360#define SSCR0 0x60 /* SSP Control register 0 */
1361#define SSCR1 0x64 /* SSP Control register 1 */
1362#define SSDR 0x6c /* SSP Data register */
1363#define SSSR 0x74 /* SSP Status register */
1364
1365/* Bitfields for above registers */
1366#define SSCR0_SPI(x) (((x) & 0x30) == 0x00)
1367#define SSCR0_SSP(x) (((x) & 0x30) == 0x10)
1368#define SSCR0_UWIRE(x) (((x) & 0x30) == 0x20)
1369#define SSCR0_PSP(x) (((x) & 0x30) == 0x30)
1370#define SSCR0_SSE (1 << 7)
1371#define SSCR0_DSS(x) (((x) & 0xf) + 1)
1372#define SSCR1_RIE (1 << 0)
1373#define SSCR1_TIE (1 << 1)
1374#define SSCR1_LBM (1 << 2)
1375#define SSSR_TNF (1 << 2)
1376#define SSSR_RNE (1 << 3)
1377#define SSSR_TFS (1 << 5)
1378#define SSSR_RFS (1 << 6)
1379#define SSSR_ROR (1 << 7)
1380#define SSSR_RW 0x0080
1381
1382static void strongarm_ssp_int_update(StrongARMSSPState *s)
1383{
1384 int level = 0;
1385
1386 level |= (s->sssr & SSSR_ROR);
1387 level |= (s->sssr & SSSR_RFS) && (s->sscr[1] & SSCR1_RIE);
1388 level |= (s->sssr & SSSR_TFS) && (s->sscr[1] & SSCR1_TIE);
1389 qemu_set_irq(s->irq, level);
1390}
1391
1392static void strongarm_ssp_fifo_update(StrongARMSSPState *s)
1393{
1394 s->sssr &= ~SSSR_TFS;
1395 s->sssr &= ~SSSR_TNF;
1396 if (s->sscr[0] & SSCR0_SSE) {
1397 if (s->rx_level >= 4) {
1398 s->sssr |= SSSR_RFS;
1399 } else {
1400 s->sssr &= ~SSSR_RFS;
1401 }
1402 if (s->rx_level) {
1403 s->sssr |= SSSR_RNE;
1404 } else {
1405 s->sssr &= ~SSSR_RNE;
1406 }
1407 /* TX FIFO is never filled, so it is always in underrun
1408 condition if SSP is enabled */
1409 s->sssr |= SSSR_TFS;
1410 s->sssr |= SSSR_TNF;
1411 }
1412
1413 strongarm_ssp_int_update(s);
1414}
1415
a8170e5e 1416static uint64_t strongarm_ssp_read(void *opaque, hwaddr addr,
eb2fefbc 1417 unsigned size)
5bc95aa2
DES
1418{
1419 StrongARMSSPState *s = opaque;
1420 uint32_t retval;
1421
1422 switch (addr) {
1423 case SSCR0:
1424 return s->sscr[0];
1425 case SSCR1:
1426 return s->sscr[1];
1427 case SSSR:
1428 return s->sssr;
1429 case SSDR:
1430 if (~s->sscr[0] & SSCR0_SSE) {
1431 return 0xffffffff;
1432 }
1433 if (s->rx_level < 1) {
1434 printf("%s: SSP Rx Underrun\n", __func__);
1435 return 0xffffffff;
1436 }
1437 s->rx_level--;
1438 retval = s->rx_fifo[s->rx_start++];
1439 s->rx_start &= 0x7;
1440 strongarm_ssp_fifo_update(s);
1441 return retval;
1442 default:
1443 printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1444 break;
1445 }
1446 return 0;
1447}
1448
a8170e5e 1449static void strongarm_ssp_write(void *opaque, hwaddr addr,
eb2fefbc 1450 uint64_t value, unsigned size)
5bc95aa2
DES
1451{
1452 StrongARMSSPState *s = opaque;
1453
1454 switch (addr) {
1455 case SSCR0:
1456 s->sscr[0] = value & 0xffbf;
1457 if ((s->sscr[0] & SSCR0_SSE) && SSCR0_DSS(value) < 4) {
1458 printf("%s: Wrong data size: %i bits\n", __func__,
eb2fefbc 1459 (int)SSCR0_DSS(value));
5bc95aa2
DES
1460 }
1461 if (!(value & SSCR0_SSE)) {
1462 s->sssr = 0;
1463 s->rx_level = 0;
1464 }
1465 strongarm_ssp_fifo_update(s);
1466 break;
1467
1468 case SSCR1:
1469 s->sscr[1] = value & 0x2f;
1470 if (value & SSCR1_LBM) {
1471 printf("%s: Attempt to use SSP LBM mode\n", __func__);
1472 }
1473 strongarm_ssp_fifo_update(s);
1474 break;
1475
1476 case SSSR:
1477 s->sssr &= ~(value & SSSR_RW);
1478 strongarm_ssp_int_update(s);
1479 break;
1480
1481 case SSDR:
1482 if (SSCR0_UWIRE(s->sscr[0])) {
1483 value &= 0xff;
1484 } else
1485 /* Note how 32bits overflow does no harm here */
1486 value &= (1 << SSCR0_DSS(s->sscr[0])) - 1;
1487
1488 /* Data goes from here to the Tx FIFO and is shifted out from
1489 * there directly to the slave, no need to buffer it.
1490 */
1491 if (s->sscr[0] & SSCR0_SSE) {
1492 uint32_t readval;
1493 if (s->sscr[1] & SSCR1_LBM) {
1494 readval = value;
1495 } else {
1496 readval = ssi_transfer(s->bus, value);
1497 }
1498
1499 if (s->rx_level < 0x08) {
1500 s->rx_fifo[(s->rx_start + s->rx_level++) & 0x7] = readval;
1501 } else {
1502 s->sssr |= SSSR_ROR;
1503 }
1504 }
1505 strongarm_ssp_fifo_update(s);
1506 break;
1507
1508 default:
1509 printf("%s: Bad register 0x" TARGET_FMT_plx "\n", __func__, addr);
1510 break;
1511 }
1512}
1513
eb2fefbc
AK
1514static const MemoryRegionOps strongarm_ssp_ops = {
1515 .read = strongarm_ssp_read,
1516 .write = strongarm_ssp_write,
1517 .endianness = DEVICE_NATIVE_ENDIAN,
5bc95aa2
DES
1518};
1519
1520static int strongarm_ssp_post_load(void *opaque, int version_id)
1521{
1522 StrongARMSSPState *s = opaque;
1523
1524 strongarm_ssp_fifo_update(s);
1525
1526 return 0;
1527}
1528
8934515a 1529static void strongarm_ssp_init(Object *obj)
5bc95aa2 1530{
8934515a 1531 SysBusDevice *sbd = SYS_BUS_DEVICE(obj);
0ca81872
AF
1532 DeviceState *dev = DEVICE(sbd);
1533 StrongARMSSPState *s = STRONGARM_SSP(dev);
5bc95aa2 1534
0ca81872 1535 sysbus_init_irq(sbd, &s->irq);
5bc95aa2 1536
8934515a 1537 memory_region_init_io(&s->iomem, obj, &strongarm_ssp_ops, s,
64bde0f3 1538 "ssp", 0x1000);
0ca81872 1539 sysbus_init_mmio(sbd, &s->iomem);
5bc95aa2 1540
0ca81872 1541 s->bus = ssi_create_bus(dev, "ssi");
5bc95aa2
DES
1542}
1543
1544static void strongarm_ssp_reset(DeviceState *dev)
1545{
0ca81872
AF
1546 StrongARMSSPState *s = STRONGARM_SSP(dev);
1547
5bc95aa2
DES
1548 s->sssr = 0x03; /* 3 bit data, SPI, disabled */
1549 s->rx_start = 0;
1550 s->rx_level = 0;
1551}
1552
1553static const VMStateDescription vmstate_strongarm_ssp_regs = {
1554 .name = "strongarm-ssp",
1555 .version_id = 0,
1556 .minimum_version_id = 0,
5bc95aa2
DES
1557 .post_load = strongarm_ssp_post_load,
1558 .fields = (VMStateField[]) {
1559 VMSTATE_UINT16_ARRAY(sscr, StrongARMSSPState, 2),
1560 VMSTATE_UINT16(sssr, StrongARMSSPState),
1561 VMSTATE_UINT16_ARRAY(rx_fifo, StrongARMSSPState, 8),
1562 VMSTATE_UINT8(rx_start, StrongARMSSPState),
1563 VMSTATE_UINT8(rx_level, StrongARMSSPState),
1564 VMSTATE_END_OF_LIST(),
1565 },
1566};
1567
999e12bb
AL
1568static void strongarm_ssp_class_init(ObjectClass *klass, void *data)
1569{
39bffca2 1570 DeviceClass *dc = DEVICE_CLASS(klass);
999e12bb 1571
39bffca2
AL
1572 dc->desc = "StrongARM SSP controller";
1573 dc->reset = strongarm_ssp_reset;
1574 dc->vmsd = &vmstate_strongarm_ssp_regs;
999e12bb
AL
1575}
1576
8c43a6f0 1577static const TypeInfo strongarm_ssp_info = {
0ca81872 1578 .name = TYPE_STRONGARM_SSP,
39bffca2
AL
1579 .parent = TYPE_SYS_BUS_DEVICE,
1580 .instance_size = sizeof(StrongARMSSPState),
8934515a 1581 .instance_init = strongarm_ssp_init,
39bffca2 1582 .class_init = strongarm_ssp_class_init,
5bc95aa2
DES
1583};
1584
1585/* Main CPU functions */
eb2fefbc 1586StrongARMState *sa1110_init(MemoryRegion *sysmem,
ba1ba5cc 1587 unsigned int sdram_size, const char *cpu_type)
5bc95aa2
DES
1588{
1589 StrongARMState *s;
5bc95aa2
DES
1590 int i;
1591
b45c03f5 1592 s = g_new0(StrongARMState, 1);
5bc95aa2 1593
ba1ba5cc 1594 if (strncmp(cpu_type, "sa1110", 6)) {
6daf194d 1595 error_report("Machine requires a SA1110 processor.");
5bc95aa2
DES
1596 exit(1);
1597 }
1598
ba1ba5cc 1599 s->cpu = ARM_CPU(cpu_create(cpu_type));
5bc95aa2 1600
c8623c02
DM
1601 memory_region_allocate_system_memory(&s->sdram, NULL, "strongarm.sdram",
1602 sdram_size);
eb2fefbc 1603 memory_region_add_subregion(sysmem, SA_SDCS0, &s->sdram);
5bc95aa2 1604
5bc95aa2 1605 s->pic = sysbus_create_varargs("strongarm_pic", 0x90050000,
4f071cf9
PM
1606 qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_IRQ),
1607 qdev_get_gpio_in(DEVICE(s->cpu), ARM_CPU_FIQ),
1608 NULL);
5bc95aa2
DES
1609
1610 sysbus_create_varargs("pxa25x-timer", 0x90000000,
1611 qdev_get_gpio_in(s->pic, SA_PIC_OSTC0),
1612 qdev_get_gpio_in(s->pic, SA_PIC_OSTC1),
1613 qdev_get_gpio_in(s->pic, SA_PIC_OSTC2),
1614 qdev_get_gpio_in(s->pic, SA_PIC_OSTC3),
1615 NULL);
1616
4e002105 1617 sysbus_create_simple(TYPE_STRONGARM_RTC, 0x90010000,
5bc95aa2
DES
1618 qdev_get_gpio_in(s->pic, SA_PIC_RTC_ALARM));
1619
1620 s->gpio = strongarm_gpio_init(0x90040000, s->pic);
1621
c71e6732 1622 s->ppc = sysbus_create_varargs(TYPE_STRONGARM_PPC, 0x90060000, NULL);
5bc95aa2
DES
1623
1624 for (i = 0; sa_serial[i].io_base; i++) {
fff3af97 1625 DeviceState *dev = qdev_create(NULL, TYPE_STRONGARM_UART);
9bca0edb 1626 qdev_prop_set_chr(dev, "chardev", serial_hd(i));
5bc95aa2 1627 qdev_init_nofail(dev);
1356b98d 1628 sysbus_mmio_map(SYS_BUS_DEVICE(dev), 0,
5bc95aa2 1629 sa_serial[i].io_base);
1356b98d 1630 sysbus_connect_irq(SYS_BUS_DEVICE(dev), 0,
5bc95aa2
DES
1631 qdev_get_gpio_in(s->pic, sa_serial[i].irq));
1632 }
1633
0ca81872 1634 s->ssp = sysbus_create_varargs(TYPE_STRONGARM_SSP, 0x80070000,
5bc95aa2
DES
1635 qdev_get_gpio_in(s->pic, SA_PIC_SSP), NULL);
1636 s->ssp_bus = (SSIBus *)qdev_get_child_bus(s->ssp, "ssi");
1637
1638 return s;
1639}
1640
83f7d43a 1641static void strongarm_register_types(void)
5bc95aa2 1642{
39bffca2
AL
1643 type_register_static(&strongarm_pic_info);
1644 type_register_static(&strongarm_rtc_sysbus_info);
1645 type_register_static(&strongarm_gpio_info);
1646 type_register_static(&strongarm_ppc_info);
1647 type_register_static(&strongarm_uart_info);
1648 type_register_static(&strongarm_ssp_info);
5bc95aa2 1649}
83f7d43a
AF
1650
1651type_init(strongarm_register_types)