PPC: e500: msync is 440 only, e500 has real sync
[qemu.git] / hw / pxa2xx.c
1 /*
2 * Intel XScale PXA255/270 processor support.
3 *
4 * Copyright (c) 2006 Openedhand Ltd.
5 * Written by Andrzej Zaborowski <balrog@zabor.org>
6 *
7 * This code is licensed under the GPL.
8 */
9
10 #include "sysbus.h"
11 #include "pxa.h"
12 #include "sysemu.h"
13 #include "pc.h"
14 #include "i2c.h"
15 #include "ssi.h"
16 #include "qemu-char.h"
17 #include "blockdev.h"
18
19 static struct {
20 target_phys_addr_t io_base;
21 int irqn;
22 } pxa255_serial[] = {
23 { 0x40100000, PXA2XX_PIC_FFUART },
24 { 0x40200000, PXA2XX_PIC_BTUART },
25 { 0x40700000, PXA2XX_PIC_STUART },
26 { 0x41600000, PXA25X_PIC_HWUART },
27 { 0, 0 }
28 }, pxa270_serial[] = {
29 { 0x40100000, PXA2XX_PIC_FFUART },
30 { 0x40200000, PXA2XX_PIC_BTUART },
31 { 0x40700000, PXA2XX_PIC_STUART },
32 { 0, 0 }
33 };
34
35 typedef struct PXASSPDef {
36 target_phys_addr_t io_base;
37 int irqn;
38 } PXASSPDef;
39
40 #if 0
41 static PXASSPDef pxa250_ssp[] = {
42 { 0x41000000, PXA2XX_PIC_SSP },
43 { 0, 0 }
44 };
45 #endif
46
47 static PXASSPDef pxa255_ssp[] = {
48 { 0x41000000, PXA2XX_PIC_SSP },
49 { 0x41400000, PXA25X_PIC_NSSP },
50 { 0, 0 }
51 };
52
53 #if 0
54 static PXASSPDef pxa26x_ssp[] = {
55 { 0x41000000, PXA2XX_PIC_SSP },
56 { 0x41400000, PXA25X_PIC_NSSP },
57 { 0x41500000, PXA26X_PIC_ASSP },
58 { 0, 0 }
59 };
60 #endif
61
62 static PXASSPDef pxa27x_ssp[] = {
63 { 0x41000000, PXA2XX_PIC_SSP },
64 { 0x41700000, PXA27X_PIC_SSP2 },
65 { 0x41900000, PXA2XX_PIC_SSP3 },
66 { 0, 0 }
67 };
68
69 #define PMCR 0x00 /* Power Manager Control register */
70 #define PSSR 0x04 /* Power Manager Sleep Status register */
71 #define PSPR 0x08 /* Power Manager Scratch-Pad register */
72 #define PWER 0x0c /* Power Manager Wake-Up Enable register */
73 #define PRER 0x10 /* Power Manager Rising-Edge Detect Enable register */
74 #define PFER 0x14 /* Power Manager Falling-Edge Detect Enable register */
75 #define PEDR 0x18 /* Power Manager Edge-Detect Status register */
76 #define PCFR 0x1c /* Power Manager General Configuration register */
77 #define PGSR0 0x20 /* Power Manager GPIO Sleep-State register 0 */
78 #define PGSR1 0x24 /* Power Manager GPIO Sleep-State register 1 */
79 #define PGSR2 0x28 /* Power Manager GPIO Sleep-State register 2 */
80 #define PGSR3 0x2c /* Power Manager GPIO Sleep-State register 3 */
81 #define RCSR 0x30 /* Reset Controller Status register */
82 #define PSLR 0x34 /* Power Manager Sleep Configuration register */
83 #define PTSR 0x38 /* Power Manager Standby Configuration register */
84 #define PVCR 0x40 /* Power Manager Voltage Change Control register */
85 #define PUCR 0x4c /* Power Manager USIM Card Control/Status register */
86 #define PKWR 0x50 /* Power Manager Keyboard Wake-Up Enable register */
87 #define PKSR 0x54 /* Power Manager Keyboard Level-Detect Status */
88 #define PCMD0 0x80 /* Power Manager I2C Command register File 0 */
89 #define PCMD31 0xfc /* Power Manager I2C Command register File 31 */
90
91 static uint64_t pxa2xx_pm_read(void *opaque, target_phys_addr_t addr,
92 unsigned size)
93 {
94 PXA2xxState *s = (PXA2xxState *) opaque;
95
96 switch (addr) {
97 case PMCR ... PCMD31:
98 if (addr & 3)
99 goto fail;
100
101 return s->pm_regs[addr >> 2];
102 default:
103 fail:
104 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
105 break;
106 }
107 return 0;
108 }
109
110 static void pxa2xx_pm_write(void *opaque, target_phys_addr_t addr,
111 uint64_t value, unsigned size)
112 {
113 PXA2xxState *s = (PXA2xxState *) opaque;
114
115 switch (addr) {
116 case PMCR:
117 /* Clear the write-one-to-clear bits... */
118 s->pm_regs[addr >> 2] &= ~(value & 0x2a);
119 /* ...and set the plain r/w bits */
120 s->pm_regs[addr >> 2] &= ~0x15;
121 s->pm_regs[addr >> 2] |= value & 0x15;
122 break;
123
124 case PSSR: /* Read-clean registers */
125 case RCSR:
126 case PKSR:
127 s->pm_regs[addr >> 2] &= ~value;
128 break;
129
130 default: /* Read-write registers */
131 if (!(addr & 3)) {
132 s->pm_regs[addr >> 2] = value;
133 break;
134 }
135
136 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
137 break;
138 }
139 }
140
141 static const MemoryRegionOps pxa2xx_pm_ops = {
142 .read = pxa2xx_pm_read,
143 .write = pxa2xx_pm_write,
144 .endianness = DEVICE_NATIVE_ENDIAN,
145 };
146
147 static const VMStateDescription vmstate_pxa2xx_pm = {
148 .name = "pxa2xx_pm",
149 .version_id = 0,
150 .minimum_version_id = 0,
151 .minimum_version_id_old = 0,
152 .fields = (VMStateField[]) {
153 VMSTATE_UINT32_ARRAY(pm_regs, PXA2xxState, 0x40),
154 VMSTATE_END_OF_LIST()
155 }
156 };
157
158 #define CCCR 0x00 /* Core Clock Configuration register */
159 #define CKEN 0x04 /* Clock Enable register */
160 #define OSCC 0x08 /* Oscillator Configuration register */
161 #define CCSR 0x0c /* Core Clock Status register */
162
163 static uint64_t pxa2xx_cm_read(void *opaque, target_phys_addr_t addr,
164 unsigned size)
165 {
166 PXA2xxState *s = (PXA2xxState *) opaque;
167
168 switch (addr) {
169 case CCCR:
170 case CKEN:
171 case OSCC:
172 return s->cm_regs[addr >> 2];
173
174 case CCSR:
175 return s->cm_regs[CCCR >> 2] | (3 << 28);
176
177 default:
178 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
179 break;
180 }
181 return 0;
182 }
183
184 static void pxa2xx_cm_write(void *opaque, target_phys_addr_t addr,
185 uint64_t value, unsigned size)
186 {
187 PXA2xxState *s = (PXA2xxState *) opaque;
188
189 switch (addr) {
190 case CCCR:
191 case CKEN:
192 s->cm_regs[addr >> 2] = value;
193 break;
194
195 case OSCC:
196 s->cm_regs[addr >> 2] &= ~0x6c;
197 s->cm_regs[addr >> 2] |= value & 0x6e;
198 if ((value >> 1) & 1) /* OON */
199 s->cm_regs[addr >> 2] |= 1 << 0; /* Oscillator is now stable */
200 break;
201
202 default:
203 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
204 break;
205 }
206 }
207
208 static const MemoryRegionOps pxa2xx_cm_ops = {
209 .read = pxa2xx_cm_read,
210 .write = pxa2xx_cm_write,
211 .endianness = DEVICE_NATIVE_ENDIAN,
212 };
213
214 static const VMStateDescription vmstate_pxa2xx_cm = {
215 .name = "pxa2xx_cm",
216 .version_id = 0,
217 .minimum_version_id = 0,
218 .minimum_version_id_old = 0,
219 .fields = (VMStateField[]) {
220 VMSTATE_UINT32_ARRAY(cm_regs, PXA2xxState, 4),
221 VMSTATE_UINT32(clkcfg, PXA2xxState),
222 VMSTATE_UINT32(pmnc, PXA2xxState),
223 VMSTATE_END_OF_LIST()
224 }
225 };
226
227 static uint32_t pxa2xx_clkpwr_read(void *opaque, int op2, int reg, int crm)
228 {
229 PXA2xxState *s = (PXA2xxState *) opaque;
230
231 switch (reg) {
232 case 6: /* Clock Configuration register */
233 return s->clkcfg;
234
235 case 7: /* Power Mode register */
236 return 0;
237
238 default:
239 printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
240 break;
241 }
242 return 0;
243 }
244
245 static void pxa2xx_clkpwr_write(void *opaque, int op2, int reg, int crm,
246 uint32_t value)
247 {
248 PXA2xxState *s = (PXA2xxState *) opaque;
249 static const char *pwrmode[8] = {
250 "Normal", "Idle", "Deep-idle", "Standby",
251 "Sleep", "reserved (!)", "reserved (!)", "Deep-sleep",
252 };
253
254 switch (reg) {
255 case 6: /* Clock Configuration register */
256 s->clkcfg = value & 0xf;
257 if (value & 2)
258 printf("%s: CPU frequency change attempt\n", __FUNCTION__);
259 break;
260
261 case 7: /* Power Mode register */
262 if (value & 8)
263 printf("%s: CPU voltage change attempt\n", __FUNCTION__);
264 switch (value & 7) {
265 case 0:
266 /* Do nothing */
267 break;
268
269 case 1:
270 /* Idle */
271 if (!(s->cm_regs[CCCR >> 2] & (1 << 31))) { /* CPDIS */
272 cpu_interrupt(s->env, CPU_INTERRUPT_HALT);
273 break;
274 }
275 /* Fall through. */
276
277 case 2:
278 /* Deep-Idle */
279 cpu_interrupt(s->env, CPU_INTERRUPT_HALT);
280 s->pm_regs[RCSR >> 2] |= 0x8; /* Set GPR */
281 goto message;
282
283 case 3:
284 s->env->uncached_cpsr =
285 ARM_CPU_MODE_SVC | CPSR_A | CPSR_F | CPSR_I;
286 s->env->cp15.c1_sys = 0;
287 s->env->cp15.c1_coproc = 0;
288 s->env->cp15.c2_base0 = 0;
289 s->env->cp15.c3 = 0;
290 s->pm_regs[PSSR >> 2] |= 0x8; /* Set STS */
291 s->pm_regs[RCSR >> 2] |= 0x8; /* Set GPR */
292
293 /*
294 * The scratch-pad register is almost universally used
295 * for storing the return address on suspend. For the
296 * lack of a resuming bootloader, perform a jump
297 * directly to that address.
298 */
299 memset(s->env->regs, 0, 4 * 15);
300 s->env->regs[15] = s->pm_regs[PSPR >> 2];
301
302 #if 0
303 buffer = 0xe59ff000; /* ldr pc, [pc, #0] */
304 cpu_physical_memory_write(0, &buffer, 4);
305 buffer = s->pm_regs[PSPR >> 2];
306 cpu_physical_memory_write(8, &buffer, 4);
307 #endif
308
309 /* Suspend */
310 cpu_interrupt(cpu_single_env, CPU_INTERRUPT_HALT);
311
312 goto message;
313
314 default:
315 message:
316 printf("%s: machine entered %s mode\n", __FUNCTION__,
317 pwrmode[value & 7]);
318 }
319 break;
320
321 default:
322 printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
323 break;
324 }
325 }
326
327 /* Performace Monitoring Registers */
328 #define CPPMNC 0 /* Performance Monitor Control register */
329 #define CPCCNT 1 /* Clock Counter register */
330 #define CPINTEN 4 /* Interrupt Enable register */
331 #define CPFLAG 5 /* Overflow Flag register */
332 #define CPEVTSEL 8 /* Event Selection register */
333
334 #define CPPMN0 0 /* Performance Count register 0 */
335 #define CPPMN1 1 /* Performance Count register 1 */
336 #define CPPMN2 2 /* Performance Count register 2 */
337 #define CPPMN3 3 /* Performance Count register 3 */
338
339 static uint32_t pxa2xx_perf_read(void *opaque, int op2, int reg, int crm)
340 {
341 PXA2xxState *s = (PXA2xxState *) opaque;
342
343 switch (reg) {
344 case CPPMNC:
345 return s->pmnc;
346 case CPCCNT:
347 if (s->pmnc & 1)
348 return qemu_get_clock_ns(vm_clock);
349 else
350 return 0;
351 case CPINTEN:
352 case CPFLAG:
353 case CPEVTSEL:
354 return 0;
355
356 default:
357 printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
358 break;
359 }
360 return 0;
361 }
362
363 static void pxa2xx_perf_write(void *opaque, int op2, int reg, int crm,
364 uint32_t value)
365 {
366 PXA2xxState *s = (PXA2xxState *) opaque;
367
368 switch (reg) {
369 case CPPMNC:
370 s->pmnc = value;
371 break;
372
373 case CPCCNT:
374 case CPINTEN:
375 case CPFLAG:
376 case CPEVTSEL:
377 break;
378
379 default:
380 printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
381 break;
382 }
383 }
384
385 static uint32_t pxa2xx_cp14_read(void *opaque, int op2, int reg, int crm)
386 {
387 switch (crm) {
388 case 0:
389 return pxa2xx_clkpwr_read(opaque, op2, reg, crm);
390 case 1:
391 return pxa2xx_perf_read(opaque, op2, reg, crm);
392 case 2:
393 switch (reg) {
394 case CPPMN0:
395 case CPPMN1:
396 case CPPMN2:
397 case CPPMN3:
398 return 0;
399 }
400 /* Fall through */
401 default:
402 printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
403 break;
404 }
405 return 0;
406 }
407
408 static void pxa2xx_cp14_write(void *opaque, int op2, int reg, int crm,
409 uint32_t value)
410 {
411 switch (crm) {
412 case 0:
413 pxa2xx_clkpwr_write(opaque, op2, reg, crm, value);
414 break;
415 case 1:
416 pxa2xx_perf_write(opaque, op2, reg, crm, value);
417 break;
418 case 2:
419 switch (reg) {
420 case CPPMN0:
421 case CPPMN1:
422 case CPPMN2:
423 case CPPMN3:
424 return;
425 }
426 /* Fall through */
427 default:
428 printf("%s: Bad register 0x%x\n", __FUNCTION__, reg);
429 break;
430 }
431 }
432
433 #define MDCNFG 0x00 /* SDRAM Configuration register */
434 #define MDREFR 0x04 /* SDRAM Refresh Control register */
435 #define MSC0 0x08 /* Static Memory Control register 0 */
436 #define MSC1 0x0c /* Static Memory Control register 1 */
437 #define MSC2 0x10 /* Static Memory Control register 2 */
438 #define MECR 0x14 /* Expansion Memory Bus Config register */
439 #define SXCNFG 0x1c /* Synchronous Static Memory Config register */
440 #define MCMEM0 0x28 /* PC Card Memory Socket 0 Timing register */
441 #define MCMEM1 0x2c /* PC Card Memory Socket 1 Timing register */
442 #define MCATT0 0x30 /* PC Card Attribute Socket 0 register */
443 #define MCATT1 0x34 /* PC Card Attribute Socket 1 register */
444 #define MCIO0 0x38 /* PC Card I/O Socket 0 Timing register */
445 #define MCIO1 0x3c /* PC Card I/O Socket 1 Timing register */
446 #define MDMRS 0x40 /* SDRAM Mode Register Set Config register */
447 #define BOOT_DEF 0x44 /* Boot-time Default Configuration register */
448 #define ARB_CNTL 0x48 /* Arbiter Control register */
449 #define BSCNTR0 0x4c /* Memory Buffer Strength Control register 0 */
450 #define BSCNTR1 0x50 /* Memory Buffer Strength Control register 1 */
451 #define LCDBSCNTR 0x54 /* LCD Buffer Strength Control register */
452 #define MDMRSLP 0x58 /* Low Power SDRAM Mode Set Config register */
453 #define BSCNTR2 0x5c /* Memory Buffer Strength Control register 2 */
454 #define BSCNTR3 0x60 /* Memory Buffer Strength Control register 3 */
455 #define SA1110 0x64 /* SA-1110 Memory Compatibility register */
456
457 static uint64_t pxa2xx_mm_read(void *opaque, target_phys_addr_t addr,
458 unsigned size)
459 {
460 PXA2xxState *s = (PXA2xxState *) opaque;
461
462 switch (addr) {
463 case MDCNFG ... SA1110:
464 if ((addr & 3) == 0)
465 return s->mm_regs[addr >> 2];
466
467 default:
468 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
469 break;
470 }
471 return 0;
472 }
473
474 static void pxa2xx_mm_write(void *opaque, target_phys_addr_t addr,
475 uint64_t value, unsigned size)
476 {
477 PXA2xxState *s = (PXA2xxState *) opaque;
478
479 switch (addr) {
480 case MDCNFG ... SA1110:
481 if ((addr & 3) == 0) {
482 s->mm_regs[addr >> 2] = value;
483 break;
484 }
485
486 default:
487 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
488 break;
489 }
490 }
491
492 static const MemoryRegionOps pxa2xx_mm_ops = {
493 .read = pxa2xx_mm_read,
494 .write = pxa2xx_mm_write,
495 .endianness = DEVICE_NATIVE_ENDIAN,
496 };
497
498 static const VMStateDescription vmstate_pxa2xx_mm = {
499 .name = "pxa2xx_mm",
500 .version_id = 0,
501 .minimum_version_id = 0,
502 .minimum_version_id_old = 0,
503 .fields = (VMStateField[]) {
504 VMSTATE_UINT32_ARRAY(mm_regs, PXA2xxState, 0x1a),
505 VMSTATE_END_OF_LIST()
506 }
507 };
508
509 /* Synchronous Serial Ports */
510 typedef struct {
511 SysBusDevice busdev;
512 MemoryRegion iomem;
513 qemu_irq irq;
514 int enable;
515 SSIBus *bus;
516
517 uint32_t sscr[2];
518 uint32_t sspsp;
519 uint32_t ssto;
520 uint32_t ssitr;
521 uint32_t sssr;
522 uint8_t sstsa;
523 uint8_t ssrsa;
524 uint8_t ssacd;
525
526 uint32_t rx_fifo[16];
527 int rx_level;
528 int rx_start;
529 } PXA2xxSSPState;
530
531 #define SSCR0 0x00 /* SSP Control register 0 */
532 #define SSCR1 0x04 /* SSP Control register 1 */
533 #define SSSR 0x08 /* SSP Status register */
534 #define SSITR 0x0c /* SSP Interrupt Test register */
535 #define SSDR 0x10 /* SSP Data register */
536 #define SSTO 0x28 /* SSP Time-Out register */
537 #define SSPSP 0x2c /* SSP Programmable Serial Protocol register */
538 #define SSTSA 0x30 /* SSP TX Time Slot Active register */
539 #define SSRSA 0x34 /* SSP RX Time Slot Active register */
540 #define SSTSS 0x38 /* SSP Time Slot Status register */
541 #define SSACD 0x3c /* SSP Audio Clock Divider register */
542
543 /* Bitfields for above registers */
544 #define SSCR0_SPI(x) (((x) & 0x30) == 0x00)
545 #define SSCR0_SSP(x) (((x) & 0x30) == 0x10)
546 #define SSCR0_UWIRE(x) (((x) & 0x30) == 0x20)
547 #define SSCR0_PSP(x) (((x) & 0x30) == 0x30)
548 #define SSCR0_SSE (1 << 7)
549 #define SSCR0_RIM (1 << 22)
550 #define SSCR0_TIM (1 << 23)
551 #define SSCR0_MOD (1 << 31)
552 #define SSCR0_DSS(x) (((((x) >> 16) & 0x10) | ((x) & 0xf)) + 1)
553 #define SSCR1_RIE (1 << 0)
554 #define SSCR1_TIE (1 << 1)
555 #define SSCR1_LBM (1 << 2)
556 #define SSCR1_MWDS (1 << 5)
557 #define SSCR1_TFT(x) ((((x) >> 6) & 0xf) + 1)
558 #define SSCR1_RFT(x) ((((x) >> 10) & 0xf) + 1)
559 #define SSCR1_EFWR (1 << 14)
560 #define SSCR1_PINTE (1 << 18)
561 #define SSCR1_TINTE (1 << 19)
562 #define SSCR1_RSRE (1 << 20)
563 #define SSCR1_TSRE (1 << 21)
564 #define SSCR1_EBCEI (1 << 29)
565 #define SSITR_INT (7 << 5)
566 #define SSSR_TNF (1 << 2)
567 #define SSSR_RNE (1 << 3)
568 #define SSSR_TFS (1 << 5)
569 #define SSSR_RFS (1 << 6)
570 #define SSSR_ROR (1 << 7)
571 #define SSSR_PINT (1 << 18)
572 #define SSSR_TINT (1 << 19)
573 #define SSSR_EOC (1 << 20)
574 #define SSSR_TUR (1 << 21)
575 #define SSSR_BCE (1 << 23)
576 #define SSSR_RW 0x00bc0080
577
578 static void pxa2xx_ssp_int_update(PXA2xxSSPState *s)
579 {
580 int level = 0;
581
582 level |= s->ssitr & SSITR_INT;
583 level |= (s->sssr & SSSR_BCE) && (s->sscr[1] & SSCR1_EBCEI);
584 level |= (s->sssr & SSSR_TUR) && !(s->sscr[0] & SSCR0_TIM);
585 level |= (s->sssr & SSSR_EOC) && (s->sssr & (SSSR_TINT | SSSR_PINT));
586 level |= (s->sssr & SSSR_TINT) && (s->sscr[1] & SSCR1_TINTE);
587 level |= (s->sssr & SSSR_PINT) && (s->sscr[1] & SSCR1_PINTE);
588 level |= (s->sssr & SSSR_ROR) && !(s->sscr[0] & SSCR0_RIM);
589 level |= (s->sssr & SSSR_RFS) && (s->sscr[1] & SSCR1_RIE);
590 level |= (s->sssr & SSSR_TFS) && (s->sscr[1] & SSCR1_TIE);
591 qemu_set_irq(s->irq, !!level);
592 }
593
594 static void pxa2xx_ssp_fifo_update(PXA2xxSSPState *s)
595 {
596 s->sssr &= ~(0xf << 12); /* Clear RFL */
597 s->sssr &= ~(0xf << 8); /* Clear TFL */
598 s->sssr &= ~SSSR_TFS;
599 s->sssr &= ~SSSR_TNF;
600 if (s->enable) {
601 s->sssr |= ((s->rx_level - 1) & 0xf) << 12;
602 if (s->rx_level >= SSCR1_RFT(s->sscr[1]))
603 s->sssr |= SSSR_RFS;
604 else
605 s->sssr &= ~SSSR_RFS;
606 if (s->rx_level)
607 s->sssr |= SSSR_RNE;
608 else
609 s->sssr &= ~SSSR_RNE;
610 /* TX FIFO is never filled, so it is always in underrun
611 condition if SSP is enabled */
612 s->sssr |= SSSR_TFS;
613 s->sssr |= SSSR_TNF;
614 }
615
616 pxa2xx_ssp_int_update(s);
617 }
618
619 static uint64_t pxa2xx_ssp_read(void *opaque, target_phys_addr_t addr,
620 unsigned size)
621 {
622 PXA2xxSSPState *s = (PXA2xxSSPState *) opaque;
623 uint32_t retval;
624
625 switch (addr) {
626 case SSCR0:
627 return s->sscr[0];
628 case SSCR1:
629 return s->sscr[1];
630 case SSPSP:
631 return s->sspsp;
632 case SSTO:
633 return s->ssto;
634 case SSITR:
635 return s->ssitr;
636 case SSSR:
637 return s->sssr | s->ssitr;
638 case SSDR:
639 if (!s->enable)
640 return 0xffffffff;
641 if (s->rx_level < 1) {
642 printf("%s: SSP Rx Underrun\n", __FUNCTION__);
643 return 0xffffffff;
644 }
645 s->rx_level --;
646 retval = s->rx_fifo[s->rx_start ++];
647 s->rx_start &= 0xf;
648 pxa2xx_ssp_fifo_update(s);
649 return retval;
650 case SSTSA:
651 return s->sstsa;
652 case SSRSA:
653 return s->ssrsa;
654 case SSTSS:
655 return 0;
656 case SSACD:
657 return s->ssacd;
658 default:
659 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
660 break;
661 }
662 return 0;
663 }
664
665 static void pxa2xx_ssp_write(void *opaque, target_phys_addr_t addr,
666 uint64_t value64, unsigned size)
667 {
668 PXA2xxSSPState *s = (PXA2xxSSPState *) opaque;
669 uint32_t value = value64;
670
671 switch (addr) {
672 case SSCR0:
673 s->sscr[0] = value & 0xc7ffffff;
674 s->enable = value & SSCR0_SSE;
675 if (value & SSCR0_MOD)
676 printf("%s: Attempt to use network mode\n", __FUNCTION__);
677 if (s->enable && SSCR0_DSS(value) < 4)
678 printf("%s: Wrong data size: %i bits\n", __FUNCTION__,
679 SSCR0_DSS(value));
680 if (!(value & SSCR0_SSE)) {
681 s->sssr = 0;
682 s->ssitr = 0;
683 s->rx_level = 0;
684 }
685 pxa2xx_ssp_fifo_update(s);
686 break;
687
688 case SSCR1:
689 s->sscr[1] = value;
690 if (value & (SSCR1_LBM | SSCR1_EFWR))
691 printf("%s: Attempt to use SSP test mode\n", __FUNCTION__);
692 pxa2xx_ssp_fifo_update(s);
693 break;
694
695 case SSPSP:
696 s->sspsp = value;
697 break;
698
699 case SSTO:
700 s->ssto = value;
701 break;
702
703 case SSITR:
704 s->ssitr = value & SSITR_INT;
705 pxa2xx_ssp_int_update(s);
706 break;
707
708 case SSSR:
709 s->sssr &= ~(value & SSSR_RW);
710 pxa2xx_ssp_int_update(s);
711 break;
712
713 case SSDR:
714 if (SSCR0_UWIRE(s->sscr[0])) {
715 if (s->sscr[1] & SSCR1_MWDS)
716 value &= 0xffff;
717 else
718 value &= 0xff;
719 } else
720 /* Note how 32bits overflow does no harm here */
721 value &= (1 << SSCR0_DSS(s->sscr[0])) - 1;
722
723 /* Data goes from here to the Tx FIFO and is shifted out from
724 * there directly to the slave, no need to buffer it.
725 */
726 if (s->enable) {
727 uint32_t readval;
728 readval = ssi_transfer(s->bus, value);
729 if (s->rx_level < 0x10) {
730 s->rx_fifo[(s->rx_start + s->rx_level ++) & 0xf] = readval;
731 } else {
732 s->sssr |= SSSR_ROR;
733 }
734 }
735 pxa2xx_ssp_fifo_update(s);
736 break;
737
738 case SSTSA:
739 s->sstsa = value;
740 break;
741
742 case SSRSA:
743 s->ssrsa = value;
744 break;
745
746 case SSACD:
747 s->ssacd = value;
748 break;
749
750 default:
751 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
752 break;
753 }
754 }
755
756 static const MemoryRegionOps pxa2xx_ssp_ops = {
757 .read = pxa2xx_ssp_read,
758 .write = pxa2xx_ssp_write,
759 .endianness = DEVICE_NATIVE_ENDIAN,
760 };
761
762 static void pxa2xx_ssp_save(QEMUFile *f, void *opaque)
763 {
764 PXA2xxSSPState *s = (PXA2xxSSPState *) opaque;
765 int i;
766
767 qemu_put_be32(f, s->enable);
768
769 qemu_put_be32s(f, &s->sscr[0]);
770 qemu_put_be32s(f, &s->sscr[1]);
771 qemu_put_be32s(f, &s->sspsp);
772 qemu_put_be32s(f, &s->ssto);
773 qemu_put_be32s(f, &s->ssitr);
774 qemu_put_be32s(f, &s->sssr);
775 qemu_put_8s(f, &s->sstsa);
776 qemu_put_8s(f, &s->ssrsa);
777 qemu_put_8s(f, &s->ssacd);
778
779 qemu_put_byte(f, s->rx_level);
780 for (i = 0; i < s->rx_level; i ++)
781 qemu_put_byte(f, s->rx_fifo[(s->rx_start + i) & 0xf]);
782 }
783
784 static int pxa2xx_ssp_load(QEMUFile *f, void *opaque, int version_id)
785 {
786 PXA2xxSSPState *s = (PXA2xxSSPState *) opaque;
787 int i;
788
789 s->enable = qemu_get_be32(f);
790
791 qemu_get_be32s(f, &s->sscr[0]);
792 qemu_get_be32s(f, &s->sscr[1]);
793 qemu_get_be32s(f, &s->sspsp);
794 qemu_get_be32s(f, &s->ssto);
795 qemu_get_be32s(f, &s->ssitr);
796 qemu_get_be32s(f, &s->sssr);
797 qemu_get_8s(f, &s->sstsa);
798 qemu_get_8s(f, &s->ssrsa);
799 qemu_get_8s(f, &s->ssacd);
800
801 s->rx_level = qemu_get_byte(f);
802 s->rx_start = 0;
803 for (i = 0; i < s->rx_level; i ++)
804 s->rx_fifo[i] = qemu_get_byte(f);
805
806 return 0;
807 }
808
809 static int pxa2xx_ssp_init(SysBusDevice *dev)
810 {
811 PXA2xxSSPState *s = FROM_SYSBUS(PXA2xxSSPState, dev);
812
813 sysbus_init_irq(dev, &s->irq);
814
815 memory_region_init_io(&s->iomem, &pxa2xx_ssp_ops, s, "pxa2xx-ssp", 0x1000);
816 sysbus_init_mmio(dev, &s->iomem);
817 register_savevm(&dev->qdev, "pxa2xx_ssp", -1, 0,
818 pxa2xx_ssp_save, pxa2xx_ssp_load, s);
819
820 s->bus = ssi_create_bus(&dev->qdev, "ssi");
821 return 0;
822 }
823
824 /* Real-Time Clock */
825 #define RCNR 0x00 /* RTC Counter register */
826 #define RTAR 0x04 /* RTC Alarm register */
827 #define RTSR 0x08 /* RTC Status register */
828 #define RTTR 0x0c /* RTC Timer Trim register */
829 #define RDCR 0x10 /* RTC Day Counter register */
830 #define RYCR 0x14 /* RTC Year Counter register */
831 #define RDAR1 0x18 /* RTC Wristwatch Day Alarm register 1 */
832 #define RYAR1 0x1c /* RTC Wristwatch Year Alarm register 1 */
833 #define RDAR2 0x20 /* RTC Wristwatch Day Alarm register 2 */
834 #define RYAR2 0x24 /* RTC Wristwatch Year Alarm register 2 */
835 #define SWCR 0x28 /* RTC Stopwatch Counter register */
836 #define SWAR1 0x2c /* RTC Stopwatch Alarm register 1 */
837 #define SWAR2 0x30 /* RTC Stopwatch Alarm register 2 */
838 #define RTCPICR 0x34 /* RTC Periodic Interrupt Counter register */
839 #define PIAR 0x38 /* RTC Periodic Interrupt Alarm register */
840
841 typedef struct {
842 SysBusDevice busdev;
843 MemoryRegion iomem;
844 uint32_t rttr;
845 uint32_t rtsr;
846 uint32_t rtar;
847 uint32_t rdar1;
848 uint32_t rdar2;
849 uint32_t ryar1;
850 uint32_t ryar2;
851 uint32_t swar1;
852 uint32_t swar2;
853 uint32_t piar;
854 uint32_t last_rcnr;
855 uint32_t last_rdcr;
856 uint32_t last_rycr;
857 uint32_t last_swcr;
858 uint32_t last_rtcpicr;
859 int64_t last_hz;
860 int64_t last_sw;
861 int64_t last_pi;
862 QEMUTimer *rtc_hz;
863 QEMUTimer *rtc_rdal1;
864 QEMUTimer *rtc_rdal2;
865 QEMUTimer *rtc_swal1;
866 QEMUTimer *rtc_swal2;
867 QEMUTimer *rtc_pi;
868 qemu_irq rtc_irq;
869 } PXA2xxRTCState;
870
871 static inline void pxa2xx_rtc_int_update(PXA2xxRTCState *s)
872 {
873 qemu_set_irq(s->rtc_irq, !!(s->rtsr & 0x2553));
874 }
875
876 static void pxa2xx_rtc_hzupdate(PXA2xxRTCState *s)
877 {
878 int64_t rt = qemu_get_clock_ms(rt_clock);
879 s->last_rcnr += ((rt - s->last_hz) << 15) /
880 (1000 * ((s->rttr & 0xffff) + 1));
881 s->last_rdcr += ((rt - s->last_hz) << 15) /
882 (1000 * ((s->rttr & 0xffff) + 1));
883 s->last_hz = rt;
884 }
885
886 static void pxa2xx_rtc_swupdate(PXA2xxRTCState *s)
887 {
888 int64_t rt = qemu_get_clock_ms(rt_clock);
889 if (s->rtsr & (1 << 12))
890 s->last_swcr += (rt - s->last_sw) / 10;
891 s->last_sw = rt;
892 }
893
894 static void pxa2xx_rtc_piupdate(PXA2xxRTCState *s)
895 {
896 int64_t rt = qemu_get_clock_ms(rt_clock);
897 if (s->rtsr & (1 << 15))
898 s->last_swcr += rt - s->last_pi;
899 s->last_pi = rt;
900 }
901
902 static inline void pxa2xx_rtc_alarm_update(PXA2xxRTCState *s,
903 uint32_t rtsr)
904 {
905 if ((rtsr & (1 << 2)) && !(rtsr & (1 << 0)))
906 qemu_mod_timer(s->rtc_hz, s->last_hz +
907 (((s->rtar - s->last_rcnr) * 1000 *
908 ((s->rttr & 0xffff) + 1)) >> 15));
909 else
910 qemu_del_timer(s->rtc_hz);
911
912 if ((rtsr & (1 << 5)) && !(rtsr & (1 << 4)))
913 qemu_mod_timer(s->rtc_rdal1, s->last_hz +
914 (((s->rdar1 - s->last_rdcr) * 1000 *
915 ((s->rttr & 0xffff) + 1)) >> 15)); /* TODO: fixup */
916 else
917 qemu_del_timer(s->rtc_rdal1);
918
919 if ((rtsr & (1 << 7)) && !(rtsr & (1 << 6)))
920 qemu_mod_timer(s->rtc_rdal2, s->last_hz +
921 (((s->rdar2 - s->last_rdcr) * 1000 *
922 ((s->rttr & 0xffff) + 1)) >> 15)); /* TODO: fixup */
923 else
924 qemu_del_timer(s->rtc_rdal2);
925
926 if ((rtsr & 0x1200) == 0x1200 && !(rtsr & (1 << 8)))
927 qemu_mod_timer(s->rtc_swal1, s->last_sw +
928 (s->swar1 - s->last_swcr) * 10); /* TODO: fixup */
929 else
930 qemu_del_timer(s->rtc_swal1);
931
932 if ((rtsr & 0x1800) == 0x1800 && !(rtsr & (1 << 10)))
933 qemu_mod_timer(s->rtc_swal2, s->last_sw +
934 (s->swar2 - s->last_swcr) * 10); /* TODO: fixup */
935 else
936 qemu_del_timer(s->rtc_swal2);
937
938 if ((rtsr & 0xc000) == 0xc000 && !(rtsr & (1 << 13)))
939 qemu_mod_timer(s->rtc_pi, s->last_pi +
940 (s->piar & 0xffff) - s->last_rtcpicr);
941 else
942 qemu_del_timer(s->rtc_pi);
943 }
944
945 static inline void pxa2xx_rtc_hz_tick(void *opaque)
946 {
947 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
948 s->rtsr |= (1 << 0);
949 pxa2xx_rtc_alarm_update(s, s->rtsr);
950 pxa2xx_rtc_int_update(s);
951 }
952
953 static inline void pxa2xx_rtc_rdal1_tick(void *opaque)
954 {
955 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
956 s->rtsr |= (1 << 4);
957 pxa2xx_rtc_alarm_update(s, s->rtsr);
958 pxa2xx_rtc_int_update(s);
959 }
960
961 static inline void pxa2xx_rtc_rdal2_tick(void *opaque)
962 {
963 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
964 s->rtsr |= (1 << 6);
965 pxa2xx_rtc_alarm_update(s, s->rtsr);
966 pxa2xx_rtc_int_update(s);
967 }
968
969 static inline void pxa2xx_rtc_swal1_tick(void *opaque)
970 {
971 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
972 s->rtsr |= (1 << 8);
973 pxa2xx_rtc_alarm_update(s, s->rtsr);
974 pxa2xx_rtc_int_update(s);
975 }
976
977 static inline void pxa2xx_rtc_swal2_tick(void *opaque)
978 {
979 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
980 s->rtsr |= (1 << 10);
981 pxa2xx_rtc_alarm_update(s, s->rtsr);
982 pxa2xx_rtc_int_update(s);
983 }
984
985 static inline void pxa2xx_rtc_pi_tick(void *opaque)
986 {
987 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
988 s->rtsr |= (1 << 13);
989 pxa2xx_rtc_piupdate(s);
990 s->last_rtcpicr = 0;
991 pxa2xx_rtc_alarm_update(s, s->rtsr);
992 pxa2xx_rtc_int_update(s);
993 }
994
995 static uint64_t pxa2xx_rtc_read(void *opaque, target_phys_addr_t addr,
996 unsigned size)
997 {
998 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
999
1000 switch (addr) {
1001 case RTTR:
1002 return s->rttr;
1003 case RTSR:
1004 return s->rtsr;
1005 case RTAR:
1006 return s->rtar;
1007 case RDAR1:
1008 return s->rdar1;
1009 case RDAR2:
1010 return s->rdar2;
1011 case RYAR1:
1012 return s->ryar1;
1013 case RYAR2:
1014 return s->ryar2;
1015 case SWAR1:
1016 return s->swar1;
1017 case SWAR2:
1018 return s->swar2;
1019 case PIAR:
1020 return s->piar;
1021 case RCNR:
1022 return s->last_rcnr + ((qemu_get_clock_ms(rt_clock) - s->last_hz) << 15) /
1023 (1000 * ((s->rttr & 0xffff) + 1));
1024 case RDCR:
1025 return s->last_rdcr + ((qemu_get_clock_ms(rt_clock) - s->last_hz) << 15) /
1026 (1000 * ((s->rttr & 0xffff) + 1));
1027 case RYCR:
1028 return s->last_rycr;
1029 case SWCR:
1030 if (s->rtsr & (1 << 12))
1031 return s->last_swcr + (qemu_get_clock_ms(rt_clock) - s->last_sw) / 10;
1032 else
1033 return s->last_swcr;
1034 default:
1035 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1036 break;
1037 }
1038 return 0;
1039 }
1040
1041 static void pxa2xx_rtc_write(void *opaque, target_phys_addr_t addr,
1042 uint64_t value64, unsigned size)
1043 {
1044 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
1045 uint32_t value = value64;
1046
1047 switch (addr) {
1048 case RTTR:
1049 if (!(s->rttr & (1 << 31))) {
1050 pxa2xx_rtc_hzupdate(s);
1051 s->rttr = value;
1052 pxa2xx_rtc_alarm_update(s, s->rtsr);
1053 }
1054 break;
1055
1056 case RTSR:
1057 if ((s->rtsr ^ value) & (1 << 15))
1058 pxa2xx_rtc_piupdate(s);
1059
1060 if ((s->rtsr ^ value) & (1 << 12))
1061 pxa2xx_rtc_swupdate(s);
1062
1063 if (((s->rtsr ^ value) & 0x4aac) | (value & ~0xdaac))
1064 pxa2xx_rtc_alarm_update(s, value);
1065
1066 s->rtsr = (value & 0xdaac) | (s->rtsr & ~(value & ~0xdaac));
1067 pxa2xx_rtc_int_update(s);
1068 break;
1069
1070 case RTAR:
1071 s->rtar = value;
1072 pxa2xx_rtc_alarm_update(s, s->rtsr);
1073 break;
1074
1075 case RDAR1:
1076 s->rdar1 = value;
1077 pxa2xx_rtc_alarm_update(s, s->rtsr);
1078 break;
1079
1080 case RDAR2:
1081 s->rdar2 = value;
1082 pxa2xx_rtc_alarm_update(s, s->rtsr);
1083 break;
1084
1085 case RYAR1:
1086 s->ryar1 = value;
1087 pxa2xx_rtc_alarm_update(s, s->rtsr);
1088 break;
1089
1090 case RYAR2:
1091 s->ryar2 = value;
1092 pxa2xx_rtc_alarm_update(s, s->rtsr);
1093 break;
1094
1095 case SWAR1:
1096 pxa2xx_rtc_swupdate(s);
1097 s->swar1 = value;
1098 s->last_swcr = 0;
1099 pxa2xx_rtc_alarm_update(s, s->rtsr);
1100 break;
1101
1102 case SWAR2:
1103 s->swar2 = value;
1104 pxa2xx_rtc_alarm_update(s, s->rtsr);
1105 break;
1106
1107 case PIAR:
1108 s->piar = value;
1109 pxa2xx_rtc_alarm_update(s, s->rtsr);
1110 break;
1111
1112 case RCNR:
1113 pxa2xx_rtc_hzupdate(s);
1114 s->last_rcnr = value;
1115 pxa2xx_rtc_alarm_update(s, s->rtsr);
1116 break;
1117
1118 case RDCR:
1119 pxa2xx_rtc_hzupdate(s);
1120 s->last_rdcr = value;
1121 pxa2xx_rtc_alarm_update(s, s->rtsr);
1122 break;
1123
1124 case RYCR:
1125 s->last_rycr = value;
1126 break;
1127
1128 case SWCR:
1129 pxa2xx_rtc_swupdate(s);
1130 s->last_swcr = value;
1131 pxa2xx_rtc_alarm_update(s, s->rtsr);
1132 break;
1133
1134 case RTCPICR:
1135 pxa2xx_rtc_piupdate(s);
1136 s->last_rtcpicr = value & 0xffff;
1137 pxa2xx_rtc_alarm_update(s, s->rtsr);
1138 break;
1139
1140 default:
1141 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1142 }
1143 }
1144
1145 static const MemoryRegionOps pxa2xx_rtc_ops = {
1146 .read = pxa2xx_rtc_read,
1147 .write = pxa2xx_rtc_write,
1148 .endianness = DEVICE_NATIVE_ENDIAN,
1149 };
1150
1151 static int pxa2xx_rtc_init(SysBusDevice *dev)
1152 {
1153 PXA2xxRTCState *s = FROM_SYSBUS(PXA2xxRTCState, dev);
1154 struct tm tm;
1155 int wom;
1156
1157 s->rttr = 0x7fff;
1158 s->rtsr = 0;
1159
1160 qemu_get_timedate(&tm, 0);
1161 wom = ((tm.tm_mday - 1) / 7) + 1;
1162
1163 s->last_rcnr = (uint32_t) mktimegm(&tm);
1164 s->last_rdcr = (wom << 20) | ((tm.tm_wday + 1) << 17) |
1165 (tm.tm_hour << 12) | (tm.tm_min << 6) | tm.tm_sec;
1166 s->last_rycr = ((tm.tm_year + 1900) << 9) |
1167 ((tm.tm_mon + 1) << 5) | tm.tm_mday;
1168 s->last_swcr = (tm.tm_hour << 19) |
1169 (tm.tm_min << 13) | (tm.tm_sec << 7);
1170 s->last_rtcpicr = 0;
1171 s->last_hz = s->last_sw = s->last_pi = qemu_get_clock_ms(rt_clock);
1172
1173 s->rtc_hz = qemu_new_timer_ms(rt_clock, pxa2xx_rtc_hz_tick, s);
1174 s->rtc_rdal1 = qemu_new_timer_ms(rt_clock, pxa2xx_rtc_rdal1_tick, s);
1175 s->rtc_rdal2 = qemu_new_timer_ms(rt_clock, pxa2xx_rtc_rdal2_tick, s);
1176 s->rtc_swal1 = qemu_new_timer_ms(rt_clock, pxa2xx_rtc_swal1_tick, s);
1177 s->rtc_swal2 = qemu_new_timer_ms(rt_clock, pxa2xx_rtc_swal2_tick, s);
1178 s->rtc_pi = qemu_new_timer_ms(rt_clock, pxa2xx_rtc_pi_tick, s);
1179
1180 sysbus_init_irq(dev, &s->rtc_irq);
1181
1182 memory_region_init_io(&s->iomem, &pxa2xx_rtc_ops, s, "pxa2xx-rtc", 0x10000);
1183 sysbus_init_mmio(dev, &s->iomem);
1184
1185 return 0;
1186 }
1187
1188 static void pxa2xx_rtc_pre_save(void *opaque)
1189 {
1190 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
1191
1192 pxa2xx_rtc_hzupdate(s);
1193 pxa2xx_rtc_piupdate(s);
1194 pxa2xx_rtc_swupdate(s);
1195 }
1196
1197 static int pxa2xx_rtc_post_load(void *opaque, int version_id)
1198 {
1199 PXA2xxRTCState *s = (PXA2xxRTCState *) opaque;
1200
1201 pxa2xx_rtc_alarm_update(s, s->rtsr);
1202
1203 return 0;
1204 }
1205
1206 static const VMStateDescription vmstate_pxa2xx_rtc_regs = {
1207 .name = "pxa2xx_rtc",
1208 .version_id = 0,
1209 .minimum_version_id = 0,
1210 .minimum_version_id_old = 0,
1211 .pre_save = pxa2xx_rtc_pre_save,
1212 .post_load = pxa2xx_rtc_post_load,
1213 .fields = (VMStateField[]) {
1214 VMSTATE_UINT32(rttr, PXA2xxRTCState),
1215 VMSTATE_UINT32(rtsr, PXA2xxRTCState),
1216 VMSTATE_UINT32(rtar, PXA2xxRTCState),
1217 VMSTATE_UINT32(rdar1, PXA2xxRTCState),
1218 VMSTATE_UINT32(rdar2, PXA2xxRTCState),
1219 VMSTATE_UINT32(ryar1, PXA2xxRTCState),
1220 VMSTATE_UINT32(ryar2, PXA2xxRTCState),
1221 VMSTATE_UINT32(swar1, PXA2xxRTCState),
1222 VMSTATE_UINT32(swar2, PXA2xxRTCState),
1223 VMSTATE_UINT32(piar, PXA2xxRTCState),
1224 VMSTATE_UINT32(last_rcnr, PXA2xxRTCState),
1225 VMSTATE_UINT32(last_rdcr, PXA2xxRTCState),
1226 VMSTATE_UINT32(last_rycr, PXA2xxRTCState),
1227 VMSTATE_UINT32(last_swcr, PXA2xxRTCState),
1228 VMSTATE_UINT32(last_rtcpicr, PXA2xxRTCState),
1229 VMSTATE_INT64(last_hz, PXA2xxRTCState),
1230 VMSTATE_INT64(last_sw, PXA2xxRTCState),
1231 VMSTATE_INT64(last_pi, PXA2xxRTCState),
1232 VMSTATE_END_OF_LIST(),
1233 },
1234 };
1235
1236 static void pxa2xx_rtc_sysbus_class_init(ObjectClass *klass, void *data)
1237 {
1238 SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
1239
1240 k->init = pxa2xx_rtc_init;
1241 }
1242
1243 static DeviceInfo pxa2xx_rtc_sysbus_info = {
1244 .name = "pxa2xx_rtc",
1245 .desc = "PXA2xx RTC Controller",
1246 .size = sizeof(PXA2xxRTCState),
1247 .vmsd = &vmstate_pxa2xx_rtc_regs,
1248 .class_init = pxa2xx_rtc_sysbus_class_init,
1249 };
1250
1251 /* I2C Interface */
1252 typedef struct {
1253 I2CSlave i2c;
1254 PXA2xxI2CState *host;
1255 } PXA2xxI2CSlaveState;
1256
1257 struct PXA2xxI2CState {
1258 SysBusDevice busdev;
1259 MemoryRegion iomem;
1260 PXA2xxI2CSlaveState *slave;
1261 i2c_bus *bus;
1262 qemu_irq irq;
1263 uint32_t offset;
1264 uint32_t region_size;
1265
1266 uint16_t control;
1267 uint16_t status;
1268 uint8_t ibmr;
1269 uint8_t data;
1270 };
1271
1272 #define IBMR 0x80 /* I2C Bus Monitor register */
1273 #define IDBR 0x88 /* I2C Data Buffer register */
1274 #define ICR 0x90 /* I2C Control register */
1275 #define ISR 0x98 /* I2C Status register */
1276 #define ISAR 0xa0 /* I2C Slave Address register */
1277
1278 static void pxa2xx_i2c_update(PXA2xxI2CState *s)
1279 {
1280 uint16_t level = 0;
1281 level |= s->status & s->control & (1 << 10); /* BED */
1282 level |= (s->status & (1 << 7)) && (s->control & (1 << 9)); /* IRF */
1283 level |= (s->status & (1 << 6)) && (s->control & (1 << 8)); /* ITE */
1284 level |= s->status & (1 << 9); /* SAD */
1285 qemu_set_irq(s->irq, !!level);
1286 }
1287
1288 /* These are only stubs now. */
1289 static void pxa2xx_i2c_event(I2CSlave *i2c, enum i2c_event event)
1290 {
1291 PXA2xxI2CSlaveState *slave = FROM_I2C_SLAVE(PXA2xxI2CSlaveState, i2c);
1292 PXA2xxI2CState *s = slave->host;
1293
1294 switch (event) {
1295 case I2C_START_SEND:
1296 s->status |= (1 << 9); /* set SAD */
1297 s->status &= ~(1 << 0); /* clear RWM */
1298 break;
1299 case I2C_START_RECV:
1300 s->status |= (1 << 9); /* set SAD */
1301 s->status |= 1 << 0; /* set RWM */
1302 break;
1303 case I2C_FINISH:
1304 s->status |= (1 << 4); /* set SSD */
1305 break;
1306 case I2C_NACK:
1307 s->status |= 1 << 1; /* set ACKNAK */
1308 break;
1309 }
1310 pxa2xx_i2c_update(s);
1311 }
1312
1313 static int pxa2xx_i2c_rx(I2CSlave *i2c)
1314 {
1315 PXA2xxI2CSlaveState *slave = FROM_I2C_SLAVE(PXA2xxI2CSlaveState, i2c);
1316 PXA2xxI2CState *s = slave->host;
1317 if ((s->control & (1 << 14)) || !(s->control & (1 << 6)))
1318 return 0;
1319
1320 if (s->status & (1 << 0)) { /* RWM */
1321 s->status |= 1 << 6; /* set ITE */
1322 }
1323 pxa2xx_i2c_update(s);
1324
1325 return s->data;
1326 }
1327
1328 static int pxa2xx_i2c_tx(I2CSlave *i2c, uint8_t data)
1329 {
1330 PXA2xxI2CSlaveState *slave = FROM_I2C_SLAVE(PXA2xxI2CSlaveState, i2c);
1331 PXA2xxI2CState *s = slave->host;
1332 if ((s->control & (1 << 14)) || !(s->control & (1 << 6)))
1333 return 1;
1334
1335 if (!(s->status & (1 << 0))) { /* RWM */
1336 s->status |= 1 << 7; /* set IRF */
1337 s->data = data;
1338 }
1339 pxa2xx_i2c_update(s);
1340
1341 return 1;
1342 }
1343
1344 static uint64_t pxa2xx_i2c_read(void *opaque, target_phys_addr_t addr,
1345 unsigned size)
1346 {
1347 PXA2xxI2CState *s = (PXA2xxI2CState *) opaque;
1348
1349 addr -= s->offset;
1350 switch (addr) {
1351 case ICR:
1352 return s->control;
1353 case ISR:
1354 return s->status | (i2c_bus_busy(s->bus) << 2);
1355 case ISAR:
1356 return s->slave->i2c.address;
1357 case IDBR:
1358 return s->data;
1359 case IBMR:
1360 if (s->status & (1 << 2))
1361 s->ibmr ^= 3; /* Fake SCL and SDA pin changes */
1362 else
1363 s->ibmr = 0;
1364 return s->ibmr;
1365 default:
1366 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1367 break;
1368 }
1369 return 0;
1370 }
1371
1372 static void pxa2xx_i2c_write(void *opaque, target_phys_addr_t addr,
1373 uint64_t value64, unsigned size)
1374 {
1375 PXA2xxI2CState *s = (PXA2xxI2CState *) opaque;
1376 uint32_t value = value64;
1377 int ack;
1378
1379 addr -= s->offset;
1380 switch (addr) {
1381 case ICR:
1382 s->control = value & 0xfff7;
1383 if ((value & (1 << 3)) && (value & (1 << 6))) { /* TB and IUE */
1384 /* TODO: slave mode */
1385 if (value & (1 << 0)) { /* START condition */
1386 if (s->data & 1)
1387 s->status |= 1 << 0; /* set RWM */
1388 else
1389 s->status &= ~(1 << 0); /* clear RWM */
1390 ack = !i2c_start_transfer(s->bus, s->data >> 1, s->data & 1);
1391 } else {
1392 if (s->status & (1 << 0)) { /* RWM */
1393 s->data = i2c_recv(s->bus);
1394 if (value & (1 << 2)) /* ACKNAK */
1395 i2c_nack(s->bus);
1396 ack = 1;
1397 } else
1398 ack = !i2c_send(s->bus, s->data);
1399 }
1400
1401 if (value & (1 << 1)) /* STOP condition */
1402 i2c_end_transfer(s->bus);
1403
1404 if (ack) {
1405 if (value & (1 << 0)) /* START condition */
1406 s->status |= 1 << 6; /* set ITE */
1407 else
1408 if (s->status & (1 << 0)) /* RWM */
1409 s->status |= 1 << 7; /* set IRF */
1410 else
1411 s->status |= 1 << 6; /* set ITE */
1412 s->status &= ~(1 << 1); /* clear ACKNAK */
1413 } else {
1414 s->status |= 1 << 6; /* set ITE */
1415 s->status |= 1 << 10; /* set BED */
1416 s->status |= 1 << 1; /* set ACKNAK */
1417 }
1418 }
1419 if (!(value & (1 << 3)) && (value & (1 << 6))) /* !TB and IUE */
1420 if (value & (1 << 4)) /* MA */
1421 i2c_end_transfer(s->bus);
1422 pxa2xx_i2c_update(s);
1423 break;
1424
1425 case ISR:
1426 s->status &= ~(value & 0x07f0);
1427 pxa2xx_i2c_update(s);
1428 break;
1429
1430 case ISAR:
1431 i2c_set_slave_address(&s->slave->i2c, value & 0x7f);
1432 break;
1433
1434 case IDBR:
1435 s->data = value & 0xff;
1436 break;
1437
1438 default:
1439 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1440 }
1441 }
1442
1443 static const MemoryRegionOps pxa2xx_i2c_ops = {
1444 .read = pxa2xx_i2c_read,
1445 .write = pxa2xx_i2c_write,
1446 .endianness = DEVICE_NATIVE_ENDIAN,
1447 };
1448
1449 static const VMStateDescription vmstate_pxa2xx_i2c_slave = {
1450 .name = "pxa2xx_i2c_slave",
1451 .version_id = 1,
1452 .minimum_version_id = 1,
1453 .minimum_version_id_old = 1,
1454 .fields = (VMStateField []) {
1455 VMSTATE_I2C_SLAVE(i2c, PXA2xxI2CSlaveState),
1456 VMSTATE_END_OF_LIST()
1457 }
1458 };
1459
1460 static const VMStateDescription vmstate_pxa2xx_i2c = {
1461 .name = "pxa2xx_i2c",
1462 .version_id = 1,
1463 .minimum_version_id = 1,
1464 .minimum_version_id_old = 1,
1465 .fields = (VMStateField []) {
1466 VMSTATE_UINT16(control, PXA2xxI2CState),
1467 VMSTATE_UINT16(status, PXA2xxI2CState),
1468 VMSTATE_UINT8(ibmr, PXA2xxI2CState),
1469 VMSTATE_UINT8(data, PXA2xxI2CState),
1470 VMSTATE_STRUCT_POINTER(slave, PXA2xxI2CState,
1471 vmstate_pxa2xx_i2c_slave, PXA2xxI2CSlaveState *),
1472 VMSTATE_END_OF_LIST()
1473 }
1474 };
1475
1476 static int pxa2xx_i2c_slave_init(I2CSlave *i2c)
1477 {
1478 /* Nothing to do. */
1479 return 0;
1480 }
1481
1482 static void pxa2xx_i2c_slave_class_init(ObjectClass *klass, void *data)
1483 {
1484 I2CSlaveClass *k = I2C_SLAVE_CLASS(klass);
1485
1486 k->init = pxa2xx_i2c_slave_init;
1487 k->event = pxa2xx_i2c_event;
1488 k->recv = pxa2xx_i2c_rx;
1489 k->send = pxa2xx_i2c_tx;
1490 }
1491
1492 static DeviceInfo pxa2xx_i2c_slave_info = {
1493 .name = "pxa2xx-i2c-slave",
1494 .size = sizeof(PXA2xxI2CSlaveState),
1495 .class_init = pxa2xx_i2c_slave_class_init,
1496 };
1497
1498 PXA2xxI2CState *pxa2xx_i2c_init(target_phys_addr_t base,
1499 qemu_irq irq, uint32_t region_size)
1500 {
1501 DeviceState *dev;
1502 SysBusDevice *i2c_dev;
1503 PXA2xxI2CState *s;
1504
1505 i2c_dev = sysbus_from_qdev(qdev_create(NULL, "pxa2xx_i2c"));
1506 qdev_prop_set_uint32(&i2c_dev->qdev, "size", region_size + 1);
1507 qdev_prop_set_uint32(&i2c_dev->qdev, "offset",
1508 base - (base & (~region_size) & TARGET_PAGE_MASK));
1509
1510 qdev_init_nofail(&i2c_dev->qdev);
1511
1512 sysbus_mmio_map(i2c_dev, 0, base & ~region_size);
1513 sysbus_connect_irq(i2c_dev, 0, irq);
1514
1515 s = FROM_SYSBUS(PXA2xxI2CState, i2c_dev);
1516 /* FIXME: Should the slave device really be on a separate bus? */
1517 dev = i2c_create_slave(i2c_init_bus(NULL, "dummy"), "pxa2xx-i2c-slave", 0);
1518 s->slave = FROM_I2C_SLAVE(PXA2xxI2CSlaveState, I2C_SLAVE_FROM_QDEV(dev));
1519 s->slave->host = s;
1520
1521 return s;
1522 }
1523
1524 static int pxa2xx_i2c_initfn(SysBusDevice *dev)
1525 {
1526 PXA2xxI2CState *s = FROM_SYSBUS(PXA2xxI2CState, dev);
1527
1528 s->bus = i2c_init_bus(&dev->qdev, "i2c");
1529
1530 memory_region_init_io(&s->iomem, &pxa2xx_i2c_ops, s,
1531 "pxa2xx-i2x", s->region_size);
1532 sysbus_init_mmio(dev, &s->iomem);
1533 sysbus_init_irq(dev, &s->irq);
1534
1535 return 0;
1536 }
1537
1538 i2c_bus *pxa2xx_i2c_bus(PXA2xxI2CState *s)
1539 {
1540 return s->bus;
1541 }
1542
1543 static Property pxa2xx_i2c_properties[] = {
1544 DEFINE_PROP_UINT32("size", PXA2xxI2CState, region_size, 0x10000),
1545 DEFINE_PROP_UINT32("offset", PXA2xxI2CState, offset, 0),
1546 DEFINE_PROP_END_OF_LIST(),
1547 };
1548
1549 static void pxa2xx_i2c_class_init(ObjectClass *klass, void *data)
1550 {
1551 SysBusDeviceClass *k = SYS_BUS_DEVICE_CLASS(klass);
1552
1553 k->init = pxa2xx_i2c_initfn;
1554 }
1555
1556 static DeviceInfo pxa2xx_i2c_info = {
1557 .name = "pxa2xx_i2c",
1558 .desc = "PXA2xx I2C Bus Controller",
1559 .size = sizeof(PXA2xxI2CState),
1560 .vmsd = &vmstate_pxa2xx_i2c,
1561 .props = pxa2xx_i2c_properties,
1562 .class_init = pxa2xx_i2c_class_init,
1563 };
1564
1565 /* PXA Inter-IC Sound Controller */
1566 static void pxa2xx_i2s_reset(PXA2xxI2SState *i2s)
1567 {
1568 i2s->rx_len = 0;
1569 i2s->tx_len = 0;
1570 i2s->fifo_len = 0;
1571 i2s->clk = 0x1a;
1572 i2s->control[0] = 0x00;
1573 i2s->control[1] = 0x00;
1574 i2s->status = 0x00;
1575 i2s->mask = 0x00;
1576 }
1577
1578 #define SACR_TFTH(val) ((val >> 8) & 0xf)
1579 #define SACR_RFTH(val) ((val >> 12) & 0xf)
1580 #define SACR_DREC(val) (val & (1 << 3))
1581 #define SACR_DPRL(val) (val & (1 << 4))
1582
1583 static inline void pxa2xx_i2s_update(PXA2xxI2SState *i2s)
1584 {
1585 int rfs, tfs;
1586 rfs = SACR_RFTH(i2s->control[0]) < i2s->rx_len &&
1587 !SACR_DREC(i2s->control[1]);
1588 tfs = (i2s->tx_len || i2s->fifo_len < SACR_TFTH(i2s->control[0])) &&
1589 i2s->enable && !SACR_DPRL(i2s->control[1]);
1590
1591 qemu_set_irq(i2s->rx_dma, rfs);
1592 qemu_set_irq(i2s->tx_dma, tfs);
1593
1594 i2s->status &= 0xe0;
1595 if (i2s->fifo_len < 16 || !i2s->enable)
1596 i2s->status |= 1 << 0; /* TNF */
1597 if (i2s->rx_len)
1598 i2s->status |= 1 << 1; /* RNE */
1599 if (i2s->enable)
1600 i2s->status |= 1 << 2; /* BSY */
1601 if (tfs)
1602 i2s->status |= 1 << 3; /* TFS */
1603 if (rfs)
1604 i2s->status |= 1 << 4; /* RFS */
1605 if (!(i2s->tx_len && i2s->enable))
1606 i2s->status |= i2s->fifo_len << 8; /* TFL */
1607 i2s->status |= MAX(i2s->rx_len, 0xf) << 12; /* RFL */
1608
1609 qemu_set_irq(i2s->irq, i2s->status & i2s->mask);
1610 }
1611
1612 #define SACR0 0x00 /* Serial Audio Global Control register */
1613 #define SACR1 0x04 /* Serial Audio I2S/MSB-Justified Control register */
1614 #define SASR0 0x0c /* Serial Audio Interface and FIFO Status register */
1615 #define SAIMR 0x14 /* Serial Audio Interrupt Mask register */
1616 #define SAICR 0x18 /* Serial Audio Interrupt Clear register */
1617 #define SADIV 0x60 /* Serial Audio Clock Divider register */
1618 #define SADR 0x80 /* Serial Audio Data register */
1619
1620 static uint64_t pxa2xx_i2s_read(void *opaque, target_phys_addr_t addr,
1621 unsigned size)
1622 {
1623 PXA2xxI2SState *s = (PXA2xxI2SState *) opaque;
1624
1625 switch (addr) {
1626 case SACR0:
1627 return s->control[0];
1628 case SACR1:
1629 return s->control[1];
1630 case SASR0:
1631 return s->status;
1632 case SAIMR:
1633 return s->mask;
1634 case SAICR:
1635 return 0;
1636 case SADIV:
1637 return s->clk;
1638 case SADR:
1639 if (s->rx_len > 0) {
1640 s->rx_len --;
1641 pxa2xx_i2s_update(s);
1642 return s->codec_in(s->opaque);
1643 }
1644 return 0;
1645 default:
1646 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1647 break;
1648 }
1649 return 0;
1650 }
1651
1652 static void pxa2xx_i2s_write(void *opaque, target_phys_addr_t addr,
1653 uint64_t value, unsigned size)
1654 {
1655 PXA2xxI2SState *s = (PXA2xxI2SState *) opaque;
1656 uint32_t *sample;
1657
1658 switch (addr) {
1659 case SACR0:
1660 if (value & (1 << 3)) /* RST */
1661 pxa2xx_i2s_reset(s);
1662 s->control[0] = value & 0xff3d;
1663 if (!s->enable && (value & 1) && s->tx_len) { /* ENB */
1664 for (sample = s->fifo; s->fifo_len > 0; s->fifo_len --, sample ++)
1665 s->codec_out(s->opaque, *sample);
1666 s->status &= ~(1 << 7); /* I2SOFF */
1667 }
1668 if (value & (1 << 4)) /* EFWR */
1669 printf("%s: Attempt to use special function\n", __FUNCTION__);
1670 s->enable = (value & 9) == 1; /* ENB && !RST*/
1671 pxa2xx_i2s_update(s);
1672 break;
1673 case SACR1:
1674 s->control[1] = value & 0x0039;
1675 if (value & (1 << 5)) /* ENLBF */
1676 printf("%s: Attempt to use loopback function\n", __FUNCTION__);
1677 if (value & (1 << 4)) /* DPRL */
1678 s->fifo_len = 0;
1679 pxa2xx_i2s_update(s);
1680 break;
1681 case SAIMR:
1682 s->mask = value & 0x0078;
1683 pxa2xx_i2s_update(s);
1684 break;
1685 case SAICR:
1686 s->status &= ~(value & (3 << 5));
1687 pxa2xx_i2s_update(s);
1688 break;
1689 case SADIV:
1690 s->clk = value & 0x007f;
1691 break;
1692 case SADR:
1693 if (s->tx_len && s->enable) {
1694 s->tx_len --;
1695 pxa2xx_i2s_update(s);
1696 s->codec_out(s->opaque, value);
1697 } else if (s->fifo_len < 16) {
1698 s->fifo[s->fifo_len ++] = value;
1699 pxa2xx_i2s_update(s);
1700 }
1701 break;
1702 default:
1703 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1704 }
1705 }
1706
1707 static const MemoryRegionOps pxa2xx_i2s_ops = {
1708 .read = pxa2xx_i2s_read,
1709 .write = pxa2xx_i2s_write,
1710 .endianness = DEVICE_NATIVE_ENDIAN,
1711 };
1712
1713 static const VMStateDescription vmstate_pxa2xx_i2s = {
1714 .name = "pxa2xx_i2s",
1715 .version_id = 0,
1716 .minimum_version_id = 0,
1717 .minimum_version_id_old = 0,
1718 .fields = (VMStateField[]) {
1719 VMSTATE_UINT32_ARRAY(control, PXA2xxI2SState, 2),
1720 VMSTATE_UINT32(status, PXA2xxI2SState),
1721 VMSTATE_UINT32(mask, PXA2xxI2SState),
1722 VMSTATE_UINT32(clk, PXA2xxI2SState),
1723 VMSTATE_INT32(enable, PXA2xxI2SState),
1724 VMSTATE_INT32(rx_len, PXA2xxI2SState),
1725 VMSTATE_INT32(tx_len, PXA2xxI2SState),
1726 VMSTATE_INT32(fifo_len, PXA2xxI2SState),
1727 VMSTATE_END_OF_LIST()
1728 }
1729 };
1730
1731 static void pxa2xx_i2s_data_req(void *opaque, int tx, int rx)
1732 {
1733 PXA2xxI2SState *s = (PXA2xxI2SState *) opaque;
1734 uint32_t *sample;
1735
1736 /* Signal FIFO errors */
1737 if (s->enable && s->tx_len)
1738 s->status |= 1 << 5; /* TUR */
1739 if (s->enable && s->rx_len)
1740 s->status |= 1 << 6; /* ROR */
1741
1742 /* Should be tx - MIN(tx, s->fifo_len) but we don't really need to
1743 * handle the cases where it makes a difference. */
1744 s->tx_len = tx - s->fifo_len;
1745 s->rx_len = rx;
1746 /* Note that is s->codec_out wasn't set, we wouldn't get called. */
1747 if (s->enable)
1748 for (sample = s->fifo; s->fifo_len; s->fifo_len --, sample ++)
1749 s->codec_out(s->opaque, *sample);
1750 pxa2xx_i2s_update(s);
1751 }
1752
1753 static PXA2xxI2SState *pxa2xx_i2s_init(MemoryRegion *sysmem,
1754 target_phys_addr_t base,
1755 qemu_irq irq, qemu_irq rx_dma, qemu_irq tx_dma)
1756 {
1757 PXA2xxI2SState *s = (PXA2xxI2SState *)
1758 g_malloc0(sizeof(PXA2xxI2SState));
1759
1760 s->irq = irq;
1761 s->rx_dma = rx_dma;
1762 s->tx_dma = tx_dma;
1763 s->data_req = pxa2xx_i2s_data_req;
1764
1765 pxa2xx_i2s_reset(s);
1766
1767 memory_region_init_io(&s->iomem, &pxa2xx_i2s_ops, s,
1768 "pxa2xx-i2s", 0x100000);
1769 memory_region_add_subregion(sysmem, base, &s->iomem);
1770
1771 vmstate_register(NULL, base, &vmstate_pxa2xx_i2s, s);
1772
1773 return s;
1774 }
1775
1776 /* PXA Fast Infra-red Communications Port */
1777 struct PXA2xxFIrState {
1778 MemoryRegion iomem;
1779 qemu_irq irq;
1780 qemu_irq rx_dma;
1781 qemu_irq tx_dma;
1782 int enable;
1783 CharDriverState *chr;
1784
1785 uint8_t control[3];
1786 uint8_t status[2];
1787
1788 int rx_len;
1789 int rx_start;
1790 uint8_t rx_fifo[64];
1791 };
1792
1793 static void pxa2xx_fir_reset(PXA2xxFIrState *s)
1794 {
1795 s->control[0] = 0x00;
1796 s->control[1] = 0x00;
1797 s->control[2] = 0x00;
1798 s->status[0] = 0x00;
1799 s->status[1] = 0x00;
1800 s->enable = 0;
1801 }
1802
1803 static inline void pxa2xx_fir_update(PXA2xxFIrState *s)
1804 {
1805 static const int tresh[4] = { 8, 16, 32, 0 };
1806 int intr = 0;
1807 if ((s->control[0] & (1 << 4)) && /* RXE */
1808 s->rx_len >= tresh[s->control[2] & 3]) /* TRIG */
1809 s->status[0] |= 1 << 4; /* RFS */
1810 else
1811 s->status[0] &= ~(1 << 4); /* RFS */
1812 if (s->control[0] & (1 << 3)) /* TXE */
1813 s->status[0] |= 1 << 3; /* TFS */
1814 else
1815 s->status[0] &= ~(1 << 3); /* TFS */
1816 if (s->rx_len)
1817 s->status[1] |= 1 << 2; /* RNE */
1818 else
1819 s->status[1] &= ~(1 << 2); /* RNE */
1820 if (s->control[0] & (1 << 4)) /* RXE */
1821 s->status[1] |= 1 << 0; /* RSY */
1822 else
1823 s->status[1] &= ~(1 << 0); /* RSY */
1824
1825 intr |= (s->control[0] & (1 << 5)) && /* RIE */
1826 (s->status[0] & (1 << 4)); /* RFS */
1827 intr |= (s->control[0] & (1 << 6)) && /* TIE */
1828 (s->status[0] & (1 << 3)); /* TFS */
1829 intr |= (s->control[2] & (1 << 4)) && /* TRAIL */
1830 (s->status[0] & (1 << 6)); /* EOC */
1831 intr |= (s->control[0] & (1 << 2)) && /* TUS */
1832 (s->status[0] & (1 << 1)); /* TUR */
1833 intr |= s->status[0] & 0x25; /* FRE, RAB, EIF */
1834
1835 qemu_set_irq(s->rx_dma, (s->status[0] >> 4) & 1);
1836 qemu_set_irq(s->tx_dma, (s->status[0] >> 3) & 1);
1837
1838 qemu_set_irq(s->irq, intr && s->enable);
1839 }
1840
1841 #define ICCR0 0x00 /* FICP Control register 0 */
1842 #define ICCR1 0x04 /* FICP Control register 1 */
1843 #define ICCR2 0x08 /* FICP Control register 2 */
1844 #define ICDR 0x0c /* FICP Data register */
1845 #define ICSR0 0x14 /* FICP Status register 0 */
1846 #define ICSR1 0x18 /* FICP Status register 1 */
1847 #define ICFOR 0x1c /* FICP FIFO Occupancy Status register */
1848
1849 static uint64_t pxa2xx_fir_read(void *opaque, target_phys_addr_t addr,
1850 unsigned size)
1851 {
1852 PXA2xxFIrState *s = (PXA2xxFIrState *) opaque;
1853 uint8_t ret;
1854
1855 switch (addr) {
1856 case ICCR0:
1857 return s->control[0];
1858 case ICCR1:
1859 return s->control[1];
1860 case ICCR2:
1861 return s->control[2];
1862 case ICDR:
1863 s->status[0] &= ~0x01;
1864 s->status[1] &= ~0x72;
1865 if (s->rx_len) {
1866 s->rx_len --;
1867 ret = s->rx_fifo[s->rx_start ++];
1868 s->rx_start &= 63;
1869 pxa2xx_fir_update(s);
1870 return ret;
1871 }
1872 printf("%s: Rx FIFO underrun.\n", __FUNCTION__);
1873 break;
1874 case ICSR0:
1875 return s->status[0];
1876 case ICSR1:
1877 return s->status[1] | (1 << 3); /* TNF */
1878 case ICFOR:
1879 return s->rx_len;
1880 default:
1881 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1882 break;
1883 }
1884 return 0;
1885 }
1886
1887 static void pxa2xx_fir_write(void *opaque, target_phys_addr_t addr,
1888 uint64_t value64, unsigned size)
1889 {
1890 PXA2xxFIrState *s = (PXA2xxFIrState *) opaque;
1891 uint32_t value = value64;
1892 uint8_t ch;
1893
1894 switch (addr) {
1895 case ICCR0:
1896 s->control[0] = value;
1897 if (!(value & (1 << 4))) /* RXE */
1898 s->rx_len = s->rx_start = 0;
1899 if (!(value & (1 << 3))) { /* TXE */
1900 /* Nop */
1901 }
1902 s->enable = value & 1; /* ITR */
1903 if (!s->enable)
1904 s->status[0] = 0;
1905 pxa2xx_fir_update(s);
1906 break;
1907 case ICCR1:
1908 s->control[1] = value;
1909 break;
1910 case ICCR2:
1911 s->control[2] = value & 0x3f;
1912 pxa2xx_fir_update(s);
1913 break;
1914 case ICDR:
1915 if (s->control[2] & (1 << 2)) /* TXP */
1916 ch = value;
1917 else
1918 ch = ~value;
1919 if (s->chr && s->enable && (s->control[0] & (1 << 3))) /* TXE */
1920 qemu_chr_fe_write(s->chr, &ch, 1);
1921 break;
1922 case ICSR0:
1923 s->status[0] &= ~(value & 0x66);
1924 pxa2xx_fir_update(s);
1925 break;
1926 case ICFOR:
1927 break;
1928 default:
1929 printf("%s: Bad register " REG_FMT "\n", __FUNCTION__, addr);
1930 }
1931 }
1932
1933 static const MemoryRegionOps pxa2xx_fir_ops = {
1934 .read = pxa2xx_fir_read,
1935 .write = pxa2xx_fir_write,
1936 .endianness = DEVICE_NATIVE_ENDIAN,
1937 };
1938
1939 static int pxa2xx_fir_is_empty(void *opaque)
1940 {
1941 PXA2xxFIrState *s = (PXA2xxFIrState *) opaque;
1942 return (s->rx_len < 64);
1943 }
1944
1945 static void pxa2xx_fir_rx(void *opaque, const uint8_t *buf, int size)
1946 {
1947 PXA2xxFIrState *s = (PXA2xxFIrState *) opaque;
1948 if (!(s->control[0] & (1 << 4))) /* RXE */
1949 return;
1950
1951 while (size --) {
1952 s->status[1] |= 1 << 4; /* EOF */
1953 if (s->rx_len >= 64) {
1954 s->status[1] |= 1 << 6; /* ROR */
1955 break;
1956 }
1957
1958 if (s->control[2] & (1 << 3)) /* RXP */
1959 s->rx_fifo[(s->rx_start + s->rx_len ++) & 63] = *(buf ++);
1960 else
1961 s->rx_fifo[(s->rx_start + s->rx_len ++) & 63] = ~*(buf ++);
1962 }
1963
1964 pxa2xx_fir_update(s);
1965 }
1966
1967 static void pxa2xx_fir_event(void *opaque, int event)
1968 {
1969 }
1970
1971 static void pxa2xx_fir_save(QEMUFile *f, void *opaque)
1972 {
1973 PXA2xxFIrState *s = (PXA2xxFIrState *) opaque;
1974 int i;
1975
1976 qemu_put_be32(f, s->enable);
1977
1978 qemu_put_8s(f, &s->control[0]);
1979 qemu_put_8s(f, &s->control[1]);
1980 qemu_put_8s(f, &s->control[2]);
1981 qemu_put_8s(f, &s->status[0]);
1982 qemu_put_8s(f, &s->status[1]);
1983
1984 qemu_put_byte(f, s->rx_len);
1985 for (i = 0; i < s->rx_len; i ++)
1986 qemu_put_byte(f, s->rx_fifo[(s->rx_start + i) & 63]);
1987 }
1988
1989 static int pxa2xx_fir_load(QEMUFile *f, void *opaque, int version_id)
1990 {
1991 PXA2xxFIrState *s = (PXA2xxFIrState *) opaque;
1992 int i;
1993
1994 s->enable = qemu_get_be32(f);
1995
1996 qemu_get_8s(f, &s->control[0]);
1997 qemu_get_8s(f, &s->control[1]);
1998 qemu_get_8s(f, &s->control[2]);
1999 qemu_get_8s(f, &s->status[0]);
2000 qemu_get_8s(f, &s->status[1]);
2001
2002 s->rx_len = qemu_get_byte(f);
2003 s->rx_start = 0;
2004 for (i = 0; i < s->rx_len; i ++)
2005 s->rx_fifo[i] = qemu_get_byte(f);
2006
2007 return 0;
2008 }
2009
2010 static PXA2xxFIrState *pxa2xx_fir_init(MemoryRegion *sysmem,
2011 target_phys_addr_t base,
2012 qemu_irq irq, qemu_irq rx_dma, qemu_irq tx_dma,
2013 CharDriverState *chr)
2014 {
2015 PXA2xxFIrState *s = (PXA2xxFIrState *)
2016 g_malloc0(sizeof(PXA2xxFIrState));
2017
2018 s->irq = irq;
2019 s->rx_dma = rx_dma;
2020 s->tx_dma = tx_dma;
2021 s->chr = chr;
2022
2023 pxa2xx_fir_reset(s);
2024
2025 memory_region_init_io(&s->iomem, &pxa2xx_fir_ops, s, "pxa2xx-fir", 0x1000);
2026 memory_region_add_subregion(sysmem, base, &s->iomem);
2027
2028 if (chr)
2029 qemu_chr_add_handlers(chr, pxa2xx_fir_is_empty,
2030 pxa2xx_fir_rx, pxa2xx_fir_event, s);
2031
2032 register_savevm(NULL, "pxa2xx_fir", 0, 0, pxa2xx_fir_save,
2033 pxa2xx_fir_load, s);
2034
2035 return s;
2036 }
2037
2038 static void pxa2xx_reset(void *opaque, int line, int level)
2039 {
2040 PXA2xxState *s = (PXA2xxState *) opaque;
2041
2042 if (level && (s->pm_regs[PCFR >> 2] & 0x10)) { /* GPR_EN */
2043 cpu_reset(s->env);
2044 /* TODO: reset peripherals */
2045 }
2046 }
2047
2048 /* Initialise a PXA270 integrated chip (ARM based core). */
2049 PXA2xxState *pxa270_init(MemoryRegion *address_space,
2050 unsigned int sdram_size, const char *revision)
2051 {
2052 PXA2xxState *s;
2053 int i;
2054 DriveInfo *dinfo;
2055 s = (PXA2xxState *) g_malloc0(sizeof(PXA2xxState));
2056
2057 if (revision && strncmp(revision, "pxa27", 5)) {
2058 fprintf(stderr, "Machine requires a PXA27x processor.\n");
2059 exit(1);
2060 }
2061 if (!revision)
2062 revision = "pxa270";
2063
2064 s->env = cpu_init(revision);
2065 if (!s->env) {
2066 fprintf(stderr, "Unable to find CPU definition\n");
2067 exit(1);
2068 }
2069 s->reset = qemu_allocate_irqs(pxa2xx_reset, s, 1)[0];
2070
2071 /* SDRAM & Internal Memory Storage */
2072 memory_region_init_ram(&s->sdram, "pxa270.sdram", sdram_size);
2073 vmstate_register_ram_global(&s->sdram);
2074 memory_region_add_subregion(address_space, PXA2XX_SDRAM_BASE, &s->sdram);
2075 memory_region_init_ram(&s->internal, "pxa270.internal", 0x40000);
2076 vmstate_register_ram_global(&s->internal);
2077 memory_region_add_subregion(address_space, PXA2XX_INTERNAL_BASE,
2078 &s->internal);
2079
2080 s->pic = pxa2xx_pic_init(0x40d00000, s->env);
2081
2082 s->dma = pxa27x_dma_init(0x40000000,
2083 qdev_get_gpio_in(s->pic, PXA2XX_PIC_DMA));
2084
2085 sysbus_create_varargs("pxa27x-timer", 0x40a00000,
2086 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 0),
2087 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 1),
2088 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 2),
2089 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 3),
2090 qdev_get_gpio_in(s->pic, PXA27X_PIC_OST_4_11),
2091 NULL);
2092
2093 s->gpio = pxa2xx_gpio_init(0x40e00000, s->env, s->pic, 121);
2094
2095 dinfo = drive_get(IF_SD, 0, 0);
2096 if (!dinfo) {
2097 fprintf(stderr, "qemu: missing SecureDigital device\n");
2098 exit(1);
2099 }
2100 s->mmc = pxa2xx_mmci_init(address_space, 0x41100000, dinfo->bdrv,
2101 qdev_get_gpio_in(s->pic, PXA2XX_PIC_MMC),
2102 qdev_get_gpio_in(s->dma, PXA2XX_RX_RQ_MMCI),
2103 qdev_get_gpio_in(s->dma, PXA2XX_TX_RQ_MMCI));
2104
2105 for (i = 0; pxa270_serial[i].io_base; i++) {
2106 if (serial_hds[i]) {
2107 serial_mm_init(address_space, pxa270_serial[i].io_base, 2,
2108 qdev_get_gpio_in(s->pic, pxa270_serial[i].irqn),
2109 14857000 / 16, serial_hds[i],
2110 DEVICE_NATIVE_ENDIAN);
2111 } else {
2112 break;
2113 }
2114 }
2115 if (serial_hds[i])
2116 s->fir = pxa2xx_fir_init(address_space, 0x40800000,
2117 qdev_get_gpio_in(s->pic, PXA2XX_PIC_ICP),
2118 qdev_get_gpio_in(s->dma, PXA2XX_RX_RQ_ICP),
2119 qdev_get_gpio_in(s->dma, PXA2XX_TX_RQ_ICP),
2120 serial_hds[i]);
2121
2122 s->lcd = pxa2xx_lcdc_init(address_space, 0x44000000,
2123 qdev_get_gpio_in(s->pic, PXA2XX_PIC_LCD));
2124
2125 s->cm_base = 0x41300000;
2126 s->cm_regs[CCCR >> 2] = 0x02000210; /* 416.0 MHz */
2127 s->clkcfg = 0x00000009; /* Turbo mode active */
2128 memory_region_init_io(&s->cm_iomem, &pxa2xx_cm_ops, s, "pxa2xx-cm", 0x1000);
2129 memory_region_add_subregion(address_space, s->cm_base, &s->cm_iomem);
2130 vmstate_register(NULL, 0, &vmstate_pxa2xx_cm, s);
2131
2132 cpu_arm_set_cp_io(s->env, 14, pxa2xx_cp14_read, pxa2xx_cp14_write, s);
2133
2134 s->mm_base = 0x48000000;
2135 s->mm_regs[MDMRS >> 2] = 0x00020002;
2136 s->mm_regs[MDREFR >> 2] = 0x03ca4000;
2137 s->mm_regs[MECR >> 2] = 0x00000001; /* Two PC Card sockets */
2138 memory_region_init_io(&s->mm_iomem, &pxa2xx_mm_ops, s, "pxa2xx-mm", 0x1000);
2139 memory_region_add_subregion(address_space, s->mm_base, &s->mm_iomem);
2140 vmstate_register(NULL, 0, &vmstate_pxa2xx_mm, s);
2141
2142 s->pm_base = 0x40f00000;
2143 memory_region_init_io(&s->pm_iomem, &pxa2xx_pm_ops, s, "pxa2xx-pm", 0x100);
2144 memory_region_add_subregion(address_space, s->pm_base, &s->pm_iomem);
2145 vmstate_register(NULL, 0, &vmstate_pxa2xx_pm, s);
2146
2147 for (i = 0; pxa27x_ssp[i].io_base; i ++);
2148 s->ssp = (SSIBus **)g_malloc0(sizeof(SSIBus *) * i);
2149 for (i = 0; pxa27x_ssp[i].io_base; i ++) {
2150 DeviceState *dev;
2151 dev = sysbus_create_simple("pxa2xx-ssp", pxa27x_ssp[i].io_base,
2152 qdev_get_gpio_in(s->pic, pxa27x_ssp[i].irqn));
2153 s->ssp[i] = (SSIBus *)qdev_get_child_bus(dev, "ssi");
2154 }
2155
2156 if (usb_enabled) {
2157 sysbus_create_simple("sysbus-ohci", 0x4c000000,
2158 qdev_get_gpio_in(s->pic, PXA2XX_PIC_USBH1));
2159 }
2160
2161 s->pcmcia[0] = pxa2xx_pcmcia_init(address_space, 0x20000000);
2162 s->pcmcia[1] = pxa2xx_pcmcia_init(address_space, 0x30000000);
2163
2164 sysbus_create_simple("pxa2xx_rtc", 0x40900000,
2165 qdev_get_gpio_in(s->pic, PXA2XX_PIC_RTCALARM));
2166
2167 s->i2c[0] = pxa2xx_i2c_init(0x40301600,
2168 qdev_get_gpio_in(s->pic, PXA2XX_PIC_I2C), 0xffff);
2169 s->i2c[1] = pxa2xx_i2c_init(0x40f00100,
2170 qdev_get_gpio_in(s->pic, PXA2XX_PIC_PWRI2C), 0xff);
2171
2172 s->i2s = pxa2xx_i2s_init(address_space, 0x40400000,
2173 qdev_get_gpio_in(s->pic, PXA2XX_PIC_I2S),
2174 qdev_get_gpio_in(s->dma, PXA2XX_RX_RQ_I2S),
2175 qdev_get_gpio_in(s->dma, PXA2XX_TX_RQ_I2S));
2176
2177 s->kp = pxa27x_keypad_init(address_space, 0x41500000,
2178 qdev_get_gpio_in(s->pic, PXA2XX_PIC_KEYPAD));
2179
2180 /* GPIO1 resets the processor */
2181 /* The handler can be overridden by board-specific code */
2182 qdev_connect_gpio_out(s->gpio, 1, s->reset);
2183 return s;
2184 }
2185
2186 /* Initialise a PXA255 integrated chip (ARM based core). */
2187 PXA2xxState *pxa255_init(MemoryRegion *address_space, unsigned int sdram_size)
2188 {
2189 PXA2xxState *s;
2190 int i;
2191 DriveInfo *dinfo;
2192
2193 s = (PXA2xxState *) g_malloc0(sizeof(PXA2xxState));
2194
2195 s->env = cpu_init("pxa255");
2196 if (!s->env) {
2197 fprintf(stderr, "Unable to find CPU definition\n");
2198 exit(1);
2199 }
2200 s->reset = qemu_allocate_irqs(pxa2xx_reset, s, 1)[0];
2201
2202 /* SDRAM & Internal Memory Storage */
2203 memory_region_init_ram(&s->sdram, "pxa255.sdram", sdram_size);
2204 vmstate_register_ram_global(&s->sdram);
2205 memory_region_add_subregion(address_space, PXA2XX_SDRAM_BASE, &s->sdram);
2206 memory_region_init_ram(&s->internal, "pxa255.internal",
2207 PXA2XX_INTERNAL_SIZE);
2208 vmstate_register_ram_global(&s->internal);
2209 memory_region_add_subregion(address_space, PXA2XX_INTERNAL_BASE,
2210 &s->internal);
2211
2212 s->pic = pxa2xx_pic_init(0x40d00000, s->env);
2213
2214 s->dma = pxa255_dma_init(0x40000000,
2215 qdev_get_gpio_in(s->pic, PXA2XX_PIC_DMA));
2216
2217 sysbus_create_varargs("pxa25x-timer", 0x40a00000,
2218 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 0),
2219 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 1),
2220 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 2),
2221 qdev_get_gpio_in(s->pic, PXA2XX_PIC_OST_0 + 3),
2222 NULL);
2223
2224 s->gpio = pxa2xx_gpio_init(0x40e00000, s->env, s->pic, 85);
2225
2226 dinfo = drive_get(IF_SD, 0, 0);
2227 if (!dinfo) {
2228 fprintf(stderr, "qemu: missing SecureDigital device\n");
2229 exit(1);
2230 }
2231 s->mmc = pxa2xx_mmci_init(address_space, 0x41100000, dinfo->bdrv,
2232 qdev_get_gpio_in(s->pic, PXA2XX_PIC_MMC),
2233 qdev_get_gpio_in(s->dma, PXA2XX_RX_RQ_MMCI),
2234 qdev_get_gpio_in(s->dma, PXA2XX_TX_RQ_MMCI));
2235
2236 for (i = 0; pxa255_serial[i].io_base; i++) {
2237 if (serial_hds[i]) {
2238 serial_mm_init(address_space, pxa255_serial[i].io_base, 2,
2239 qdev_get_gpio_in(s->pic, pxa255_serial[i].irqn),
2240 14745600 / 16, serial_hds[i],
2241 DEVICE_NATIVE_ENDIAN);
2242 } else {
2243 break;
2244 }
2245 }
2246 if (serial_hds[i])
2247 s->fir = pxa2xx_fir_init(address_space, 0x40800000,
2248 qdev_get_gpio_in(s->pic, PXA2XX_PIC_ICP),
2249 qdev_get_gpio_in(s->dma, PXA2XX_RX_RQ_ICP),
2250 qdev_get_gpio_in(s->dma, PXA2XX_TX_RQ_ICP),
2251 serial_hds[i]);
2252
2253 s->lcd = pxa2xx_lcdc_init(address_space, 0x44000000,
2254 qdev_get_gpio_in(s->pic, PXA2XX_PIC_LCD));
2255
2256 s->cm_base = 0x41300000;
2257 s->cm_regs[CCCR >> 2] = 0x02000210; /* 416.0 MHz */
2258 s->clkcfg = 0x00000009; /* Turbo mode active */
2259 memory_region_init_io(&s->cm_iomem, &pxa2xx_cm_ops, s, "pxa2xx-cm", 0x1000);
2260 memory_region_add_subregion(address_space, s->cm_base, &s->cm_iomem);
2261 vmstate_register(NULL, 0, &vmstate_pxa2xx_cm, s);
2262
2263 cpu_arm_set_cp_io(s->env, 14, pxa2xx_cp14_read, pxa2xx_cp14_write, s);
2264
2265 s->mm_base = 0x48000000;
2266 s->mm_regs[MDMRS >> 2] = 0x00020002;
2267 s->mm_regs[MDREFR >> 2] = 0x03ca4000;
2268 s->mm_regs[MECR >> 2] = 0x00000001; /* Two PC Card sockets */
2269 memory_region_init_io(&s->mm_iomem, &pxa2xx_mm_ops, s, "pxa2xx-mm", 0x1000);
2270 memory_region_add_subregion(address_space, s->mm_base, &s->mm_iomem);
2271 vmstate_register(NULL, 0, &vmstate_pxa2xx_mm, s);
2272
2273 s->pm_base = 0x40f00000;
2274 memory_region_init_io(&s->pm_iomem, &pxa2xx_pm_ops, s, "pxa2xx-pm", 0x100);
2275 memory_region_add_subregion(address_space, s->pm_base, &s->pm_iomem);
2276 vmstate_register(NULL, 0, &vmstate_pxa2xx_pm, s);
2277
2278 for (i = 0; pxa255_ssp[i].io_base; i ++);
2279 s->ssp = (SSIBus **)g_malloc0(sizeof(SSIBus *) * i);
2280 for (i = 0; pxa255_ssp[i].io_base; i ++) {
2281 DeviceState *dev;
2282 dev = sysbus_create_simple("pxa2xx-ssp", pxa255_ssp[i].io_base,
2283 qdev_get_gpio_in(s->pic, pxa255_ssp[i].irqn));
2284 s->ssp[i] = (SSIBus *)qdev_get_child_bus(dev, "ssi");
2285 }
2286
2287 if (usb_enabled) {
2288 sysbus_create_simple("sysbus-ohci", 0x4c000000,
2289 qdev_get_gpio_in(s->pic, PXA2XX_PIC_USBH1));
2290 }
2291
2292 s->pcmcia[0] = pxa2xx_pcmcia_init(address_space, 0x20000000);
2293 s->pcmcia[1] = pxa2xx_pcmcia_init(address_space, 0x30000000);
2294
2295 sysbus_create_simple("pxa2xx_rtc", 0x40900000,
2296 qdev_get_gpio_in(s->pic, PXA2XX_PIC_RTCALARM));
2297
2298 s->i2c[0] = pxa2xx_i2c_init(0x40301600,
2299 qdev_get_gpio_in(s->pic, PXA2XX_PIC_I2C), 0xffff);
2300 s->i2c[1] = pxa2xx_i2c_init(0x40f00100,
2301 qdev_get_gpio_in(s->pic, PXA2XX_PIC_PWRI2C), 0xff);
2302
2303 s->i2s = pxa2xx_i2s_init(address_space, 0x40400000,
2304 qdev_get_gpio_in(s->pic, PXA2XX_PIC_I2S),
2305 qdev_get_gpio_in(s->dma, PXA2XX_RX_RQ_I2S),
2306 qdev_get_gpio_in(s->dma, PXA2XX_TX_RQ_I2S));
2307
2308 /* GPIO1 resets the processor */
2309 /* The handler can be overridden by board-specific code */
2310 qdev_connect_gpio_out(s->gpio, 1, s->reset);
2311 return s;
2312 }
2313
2314 static void pxa2xx_ssp_class_init(ObjectClass *klass, void *data)
2315 {
2316 SysBusDeviceClass *sdc = SYS_BUS_DEVICE_CLASS(klass);
2317
2318 sdc->init = pxa2xx_ssp_init;
2319 }
2320
2321 static DeviceInfo pxa2xx_ssp_info = {
2322 .name = "pxa2xx-ssp",
2323 .size = sizeof(PXA2xxSSPState),
2324 .class_init = pxa2xx_ssp_class_init,
2325 };
2326
2327 static void pxa2xx_register_devices(void)
2328 {
2329 i2c_register_slave(&pxa2xx_i2c_slave_info);
2330 sysbus_qdev_register(&pxa2xx_ssp_info);
2331 sysbus_register_withprop(&pxa2xx_i2c_info);
2332 sysbus_register_withprop(&pxa2xx_rtc_sysbus_info);
2333 }
2334
2335 device_init(pxa2xx_register_devices)