xref: /qemu/hw/ppc/ppc4xx_devs.c (revision 64552b6b)
1 /*
2  * QEMU PowerPC 4xx embedded processors shared devices emulation
3  *
4  * Copyright (c) 2007 Jocelyn Mayer
5  *
6  * Permission is hereby granted, free of charge, to any person obtaining a copy
7  * of this software and associated documentation files (the "Software"), to deal
8  * in the Software without restriction, including without limitation the rights
9  * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
10  * copies of the Software, and to permit persons to whom the Software is
11  * furnished to do so, subject to the following conditions:
12  *
13  * The above copyright notice and this permission notice shall be included in
14  * all copies or substantial portions of the Software.
15  *
16  * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
17  * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
18  * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL
19  * THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
20  * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
21  * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
22  * THE SOFTWARE.
23  */
24 
25 #include "qemu/osdep.h"
26 #include "qemu/units.h"
27 #include "sysemu/reset.h"
28 #include "cpu.h"
29 #include "hw/hw.h"
30 #include "hw/irq.h"
31 #include "hw/ppc/ppc.h"
32 #include "hw/ppc/ppc4xx.h"
33 #include "hw/boards.h"
34 #include "qemu/log.h"
35 #include "exec/address-spaces.h"
36 #include "qemu/error-report.h"
37 
38 /*#define DEBUG_UIC*/
39 
40 #ifdef DEBUG_UIC
41 #  define LOG_UIC(...) qemu_log_mask(CPU_LOG_INT, ## __VA_ARGS__)
42 #else
43 #  define LOG_UIC(...) do { } while (0)
44 #endif
45 
46 static void ppc4xx_reset(void *opaque)
47 {
48     PowerPCCPU *cpu = opaque;
49 
50     cpu_reset(CPU(cpu));
51 }
52 
53 /*****************************************************************************/
54 /* Generic PowerPC 4xx processor instantiation */
55 PowerPCCPU *ppc4xx_init(const char *cpu_type,
56                         clk_setup_t *cpu_clk, clk_setup_t *tb_clk,
57                         uint32_t sysclk)
58 {
59     PowerPCCPU *cpu;
60     CPUPPCState *env;
61 
62     /* init CPUs */
63     cpu = POWERPC_CPU(cpu_create(cpu_type));
64     env = &cpu->env;
65 
66     cpu_clk->cb = NULL; /* We don't care about CPU clock frequency changes */
67     cpu_clk->opaque = env;
68     /* Set time-base frequency to sysclk */
69     tb_clk->cb = ppc_40x_timers_init(env, sysclk, PPC_INTERRUPT_PIT);
70     tb_clk->opaque = env;
71     ppc_dcr_init(env, NULL, NULL);
72     /* Register qemu callbacks */
73     qemu_register_reset(ppc4xx_reset, cpu);
74 
75     return cpu;
76 }
77 
78 /*****************************************************************************/
79 /* "Universal" Interrupt controller */
80 enum {
81     DCR_UICSR  = 0x000,
82     DCR_UICSRS = 0x001,
83     DCR_UICER  = 0x002,
84     DCR_UICCR  = 0x003,
85     DCR_UICPR  = 0x004,
86     DCR_UICTR  = 0x005,
87     DCR_UICMSR = 0x006,
88     DCR_UICVR  = 0x007,
89     DCR_UICVCR = 0x008,
90     DCR_UICMAX = 0x009,
91 };
92 
93 #define UIC_MAX_IRQ 32
94 typedef struct ppcuic_t ppcuic_t;
95 struct ppcuic_t {
96     uint32_t dcr_base;
97     int use_vectors;
98     uint32_t level;  /* Remembers the state of level-triggered interrupts. */
99     uint32_t uicsr;  /* Status register */
100     uint32_t uicer;  /* Enable register */
101     uint32_t uiccr;  /* Critical register */
102     uint32_t uicpr;  /* Polarity register */
103     uint32_t uictr;  /* Triggering register */
104     uint32_t uicvcr; /* Vector configuration register */
105     uint32_t uicvr;
106     qemu_irq *irqs;
107 };
108 
109 static void ppcuic_trigger_irq (ppcuic_t *uic)
110 {
111     uint32_t ir, cr;
112     int start, end, inc, i;
113 
114     /* Trigger interrupt if any is pending */
115     ir = uic->uicsr & uic->uicer & (~uic->uiccr);
116     cr = uic->uicsr & uic->uicer & uic->uiccr;
117     LOG_UIC("%s: uicsr %08" PRIx32 " uicer %08" PRIx32
118                 " uiccr %08" PRIx32 "\n"
119                 "   %08" PRIx32 " ir %08" PRIx32 " cr %08" PRIx32 "\n",
120                 __func__, uic->uicsr, uic->uicer, uic->uiccr,
121                 uic->uicsr & uic->uicer, ir, cr);
122     if (ir != 0x0000000) {
123         LOG_UIC("Raise UIC interrupt\n");
124         qemu_irq_raise(uic->irqs[PPCUIC_OUTPUT_INT]);
125     } else {
126         LOG_UIC("Lower UIC interrupt\n");
127         qemu_irq_lower(uic->irqs[PPCUIC_OUTPUT_INT]);
128     }
129     /* Trigger critical interrupt if any is pending and update vector */
130     if (cr != 0x0000000) {
131         qemu_irq_raise(uic->irqs[PPCUIC_OUTPUT_CINT]);
132         if (uic->use_vectors) {
133             /* Compute critical IRQ vector */
134             if (uic->uicvcr & 1) {
135                 start = 31;
136                 end = 0;
137                 inc = -1;
138             } else {
139                 start = 0;
140                 end = 31;
141                 inc = 1;
142             }
143             uic->uicvr = uic->uicvcr & 0xFFFFFFFC;
144             for (i = start; i <= end; i += inc) {
145                 if (cr & (1 << i)) {
146                     uic->uicvr += (i - start) * 512 * inc;
147                     break;
148                 }
149             }
150         }
151         LOG_UIC("Raise UIC critical interrupt - "
152                     "vector %08" PRIx32 "\n", uic->uicvr);
153     } else {
154         LOG_UIC("Lower UIC critical interrupt\n");
155         qemu_irq_lower(uic->irqs[PPCUIC_OUTPUT_CINT]);
156         uic->uicvr = 0x00000000;
157     }
158 }
159 
160 static void ppcuic_set_irq (void *opaque, int irq_num, int level)
161 {
162     ppcuic_t *uic;
163     uint32_t mask, sr;
164 
165     uic = opaque;
166     mask = 1U << (31-irq_num);
167     LOG_UIC("%s: irq %d level %d uicsr %08" PRIx32
168                 " mask %08" PRIx32 " => %08" PRIx32 " %08" PRIx32 "\n",
169                 __func__, irq_num, level,
170                 uic->uicsr, mask, uic->uicsr & mask, level << irq_num);
171     if (irq_num < 0 || irq_num > 31)
172         return;
173     sr = uic->uicsr;
174 
175     /* Update status register */
176     if (uic->uictr & mask) {
177         /* Edge sensitive interrupt */
178         if (level == 1)
179             uic->uicsr |= mask;
180     } else {
181         /* Level sensitive interrupt */
182         if (level == 1) {
183             uic->uicsr |= mask;
184             uic->level |= mask;
185         } else {
186             uic->uicsr &= ~mask;
187             uic->level &= ~mask;
188         }
189     }
190     LOG_UIC("%s: irq %d level %d sr %" PRIx32 " => "
191                 "%08" PRIx32 "\n", __func__, irq_num, level, uic->uicsr, sr);
192     if (sr != uic->uicsr)
193         ppcuic_trigger_irq(uic);
194 }
195 
196 static uint32_t dcr_read_uic (void *opaque, int dcrn)
197 {
198     ppcuic_t *uic;
199     uint32_t ret;
200 
201     uic = opaque;
202     dcrn -= uic->dcr_base;
203     switch (dcrn) {
204     case DCR_UICSR:
205     case DCR_UICSRS:
206         ret = uic->uicsr;
207         break;
208     case DCR_UICER:
209         ret = uic->uicer;
210         break;
211     case DCR_UICCR:
212         ret = uic->uiccr;
213         break;
214     case DCR_UICPR:
215         ret = uic->uicpr;
216         break;
217     case DCR_UICTR:
218         ret = uic->uictr;
219         break;
220     case DCR_UICMSR:
221         ret = uic->uicsr & uic->uicer;
222         break;
223     case DCR_UICVR:
224         if (!uic->use_vectors)
225             goto no_read;
226         ret = uic->uicvr;
227         break;
228     case DCR_UICVCR:
229         if (!uic->use_vectors)
230             goto no_read;
231         ret = uic->uicvcr;
232         break;
233     default:
234     no_read:
235         ret = 0x00000000;
236         break;
237     }
238 
239     return ret;
240 }
241 
242 static void dcr_write_uic (void *opaque, int dcrn, uint32_t val)
243 {
244     ppcuic_t *uic;
245 
246     uic = opaque;
247     dcrn -= uic->dcr_base;
248     LOG_UIC("%s: dcr %d val 0x%x\n", __func__, dcrn, val);
249     switch (dcrn) {
250     case DCR_UICSR:
251         uic->uicsr &= ~val;
252         uic->uicsr |= uic->level;
253         ppcuic_trigger_irq(uic);
254         break;
255     case DCR_UICSRS:
256         uic->uicsr |= val;
257         ppcuic_trigger_irq(uic);
258         break;
259     case DCR_UICER:
260         uic->uicer = val;
261         ppcuic_trigger_irq(uic);
262         break;
263     case DCR_UICCR:
264         uic->uiccr = val;
265         ppcuic_trigger_irq(uic);
266         break;
267     case DCR_UICPR:
268         uic->uicpr = val;
269         break;
270     case DCR_UICTR:
271         uic->uictr = val;
272         ppcuic_trigger_irq(uic);
273         break;
274     case DCR_UICMSR:
275         break;
276     case DCR_UICVR:
277         break;
278     case DCR_UICVCR:
279         uic->uicvcr = val & 0xFFFFFFFD;
280         ppcuic_trigger_irq(uic);
281         break;
282     }
283 }
284 
285 static void ppcuic_reset (void *opaque)
286 {
287     ppcuic_t *uic;
288 
289     uic = opaque;
290     uic->uiccr = 0x00000000;
291     uic->uicer = 0x00000000;
292     uic->uicpr = 0x00000000;
293     uic->uicsr = 0x00000000;
294     uic->uictr = 0x00000000;
295     if (uic->use_vectors) {
296         uic->uicvcr = 0x00000000;
297         uic->uicvr = 0x0000000;
298     }
299 }
300 
301 qemu_irq *ppcuic_init (CPUPPCState *env, qemu_irq *irqs,
302                        uint32_t dcr_base, int has_ssr, int has_vr)
303 {
304     ppcuic_t *uic;
305     int i;
306 
307     uic = g_malloc0(sizeof(ppcuic_t));
308     uic->dcr_base = dcr_base;
309     uic->irqs = irqs;
310     if (has_vr)
311         uic->use_vectors = 1;
312     for (i = 0; i < DCR_UICMAX; i++) {
313         ppc_dcr_register(env, dcr_base + i, uic,
314                          &dcr_read_uic, &dcr_write_uic);
315     }
316     qemu_register_reset(ppcuic_reset, uic);
317 
318     return qemu_allocate_irqs(&ppcuic_set_irq, uic, UIC_MAX_IRQ);
319 }
320 
321 /*****************************************************************************/
322 /* SDRAM controller */
323 typedef struct ppc4xx_sdram_t ppc4xx_sdram_t;
324 struct ppc4xx_sdram_t {
325     uint32_t addr;
326     int nbanks;
327     MemoryRegion containers[4]; /* used for clipping */
328     MemoryRegion *ram_memories;
329     hwaddr ram_bases[4];
330     hwaddr ram_sizes[4];
331     uint32_t besr0;
332     uint32_t besr1;
333     uint32_t bear;
334     uint32_t cfg;
335     uint32_t status;
336     uint32_t rtr;
337     uint32_t pmit;
338     uint32_t bcr[4];
339     uint32_t tr;
340     uint32_t ecccfg;
341     uint32_t eccesr;
342     qemu_irq irq;
343 };
344 
345 enum {
346     SDRAM0_CFGADDR = 0x010,
347     SDRAM0_CFGDATA = 0x011,
348 };
349 
350 /* XXX: TOFIX: some patches have made this code become inconsistent:
351  *      there are type inconsistencies, mixing hwaddr, target_ulong
352  *      and uint32_t
353  */
354 static uint32_t sdram_bcr (hwaddr ram_base,
355                            hwaddr ram_size)
356 {
357     uint32_t bcr;
358 
359     switch (ram_size) {
360     case 4 * MiB:
361         bcr = 0x00000000;
362         break;
363     case 8 * MiB:
364         bcr = 0x00020000;
365         break;
366     case 16 * MiB:
367         bcr = 0x00040000;
368         break;
369     case 32 * MiB:
370         bcr = 0x00060000;
371         break;
372     case 64 * MiB:
373         bcr = 0x00080000;
374         break;
375     case 128 * MiB:
376         bcr = 0x000A0000;
377         break;
378     case 256 * MiB:
379         bcr = 0x000C0000;
380         break;
381     default:
382         printf("%s: invalid RAM size " TARGET_FMT_plx "\n", __func__,
383                ram_size);
384         return 0x00000000;
385     }
386     bcr |= ram_base & 0xFF800000;
387     bcr |= 1;
388 
389     return bcr;
390 }
391 
392 static inline hwaddr sdram_base(uint32_t bcr)
393 {
394     return bcr & 0xFF800000;
395 }
396 
397 static target_ulong sdram_size (uint32_t bcr)
398 {
399     target_ulong size;
400     int sh;
401 
402     sh = (bcr >> 17) & 0x7;
403     if (sh == 7)
404         size = -1;
405     else
406         size = (4 * MiB) << sh;
407 
408     return size;
409 }
410 
411 static void sdram_set_bcr(ppc4xx_sdram_t *sdram, int i,
412                           uint32_t bcr, int enabled)
413 {
414     if (sdram->bcr[i] & 0x00000001) {
415         /* Unmap RAM */
416 #ifdef DEBUG_SDRAM
417         printf("%s: unmap RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
418                __func__, sdram_base(sdram->bcr[i]), sdram_size(sdram->bcr[i]));
419 #endif
420         memory_region_del_subregion(get_system_memory(),
421                                     &sdram->containers[i]);
422         memory_region_del_subregion(&sdram->containers[i],
423                                     &sdram->ram_memories[i]);
424         object_unparent(OBJECT(&sdram->containers[i]));
425     }
426     sdram->bcr[i] = bcr & 0xFFDEE001;
427     if (enabled && (bcr & 0x00000001)) {
428 #ifdef DEBUG_SDRAM
429         printf("%s: Map RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
430                __func__, sdram_base(bcr), sdram_size(bcr));
431 #endif
432         memory_region_init(&sdram->containers[i], NULL, "sdram-containers",
433                            sdram_size(bcr));
434         memory_region_add_subregion(&sdram->containers[i], 0,
435                                     &sdram->ram_memories[i]);
436         memory_region_add_subregion(get_system_memory(),
437                                     sdram_base(bcr),
438                                     &sdram->containers[i]);
439     }
440 }
441 
442 static void sdram_map_bcr (ppc4xx_sdram_t *sdram)
443 {
444     int i;
445 
446     for (i = 0; i < sdram->nbanks; i++) {
447         if (sdram->ram_sizes[i] != 0) {
448             sdram_set_bcr(sdram, i, sdram_bcr(sdram->ram_bases[i],
449                                               sdram->ram_sizes[i]), 1);
450         } else {
451             sdram_set_bcr(sdram, i, 0x00000000, 0);
452         }
453     }
454 }
455 
456 static void sdram_unmap_bcr (ppc4xx_sdram_t *sdram)
457 {
458     int i;
459 
460     for (i = 0; i < sdram->nbanks; i++) {
461 #ifdef DEBUG_SDRAM
462         printf("%s: Unmap RAM area " TARGET_FMT_plx " " TARGET_FMT_lx "\n",
463                __func__, sdram_base(sdram->bcr[i]), sdram_size(sdram->bcr[i]));
464 #endif
465         memory_region_del_subregion(get_system_memory(),
466                                     &sdram->ram_memories[i]);
467     }
468 }
469 
470 static uint32_t dcr_read_sdram (void *opaque, int dcrn)
471 {
472     ppc4xx_sdram_t *sdram;
473     uint32_t ret;
474 
475     sdram = opaque;
476     switch (dcrn) {
477     case SDRAM0_CFGADDR:
478         ret = sdram->addr;
479         break;
480     case SDRAM0_CFGDATA:
481         switch (sdram->addr) {
482         case 0x00: /* SDRAM_BESR0 */
483             ret = sdram->besr0;
484             break;
485         case 0x08: /* SDRAM_BESR1 */
486             ret = sdram->besr1;
487             break;
488         case 0x10: /* SDRAM_BEAR */
489             ret = sdram->bear;
490             break;
491         case 0x20: /* SDRAM_CFG */
492             ret = sdram->cfg;
493             break;
494         case 0x24: /* SDRAM_STATUS */
495             ret = sdram->status;
496             break;
497         case 0x30: /* SDRAM_RTR */
498             ret = sdram->rtr;
499             break;
500         case 0x34: /* SDRAM_PMIT */
501             ret = sdram->pmit;
502             break;
503         case 0x40: /* SDRAM_B0CR */
504             ret = sdram->bcr[0];
505             break;
506         case 0x44: /* SDRAM_B1CR */
507             ret = sdram->bcr[1];
508             break;
509         case 0x48: /* SDRAM_B2CR */
510             ret = sdram->bcr[2];
511             break;
512         case 0x4C: /* SDRAM_B3CR */
513             ret = sdram->bcr[3];
514             break;
515         case 0x80: /* SDRAM_TR */
516             ret = -1; /* ? */
517             break;
518         case 0x94: /* SDRAM_ECCCFG */
519             ret = sdram->ecccfg;
520             break;
521         case 0x98: /* SDRAM_ECCESR */
522             ret = sdram->eccesr;
523             break;
524         default: /* Error */
525             ret = -1;
526             break;
527         }
528         break;
529     default:
530         /* Avoid gcc warning */
531         ret = 0x00000000;
532         break;
533     }
534 
535     return ret;
536 }
537 
538 static void dcr_write_sdram (void *opaque, int dcrn, uint32_t val)
539 {
540     ppc4xx_sdram_t *sdram;
541 
542     sdram = opaque;
543     switch (dcrn) {
544     case SDRAM0_CFGADDR:
545         sdram->addr = val;
546         break;
547     case SDRAM0_CFGDATA:
548         switch (sdram->addr) {
549         case 0x00: /* SDRAM_BESR0 */
550             sdram->besr0 &= ~val;
551             break;
552         case 0x08: /* SDRAM_BESR1 */
553             sdram->besr1 &= ~val;
554             break;
555         case 0x10: /* SDRAM_BEAR */
556             sdram->bear = val;
557             break;
558         case 0x20: /* SDRAM_CFG */
559             val &= 0xFFE00000;
560             if (!(sdram->cfg & 0x80000000) && (val & 0x80000000)) {
561 #ifdef DEBUG_SDRAM
562                 printf("%s: enable SDRAM controller\n", __func__);
563 #endif
564                 /* validate all RAM mappings */
565                 sdram_map_bcr(sdram);
566                 sdram->status &= ~0x80000000;
567             } else if ((sdram->cfg & 0x80000000) && !(val & 0x80000000)) {
568 #ifdef DEBUG_SDRAM
569                 printf("%s: disable SDRAM controller\n", __func__);
570 #endif
571                 /* invalidate all RAM mappings */
572                 sdram_unmap_bcr(sdram);
573                 sdram->status |= 0x80000000;
574             }
575             if (!(sdram->cfg & 0x40000000) && (val & 0x40000000))
576                 sdram->status |= 0x40000000;
577             else if ((sdram->cfg & 0x40000000) && !(val & 0x40000000))
578                 sdram->status &= ~0x40000000;
579             sdram->cfg = val;
580             break;
581         case 0x24: /* SDRAM_STATUS */
582             /* Read-only register */
583             break;
584         case 0x30: /* SDRAM_RTR */
585             sdram->rtr = val & 0x3FF80000;
586             break;
587         case 0x34: /* SDRAM_PMIT */
588             sdram->pmit = (val & 0xF8000000) | 0x07C00000;
589             break;
590         case 0x40: /* SDRAM_B0CR */
591             sdram_set_bcr(sdram, 0, val, sdram->cfg & 0x80000000);
592             break;
593         case 0x44: /* SDRAM_B1CR */
594             sdram_set_bcr(sdram, 1, val, sdram->cfg & 0x80000000);
595             break;
596         case 0x48: /* SDRAM_B2CR */
597             sdram_set_bcr(sdram, 2, val, sdram->cfg & 0x80000000);
598             break;
599         case 0x4C: /* SDRAM_B3CR */
600             sdram_set_bcr(sdram, 3, val, sdram->cfg & 0x80000000);
601             break;
602         case 0x80: /* SDRAM_TR */
603             sdram->tr = val & 0x018FC01F;
604             break;
605         case 0x94: /* SDRAM_ECCCFG */
606             sdram->ecccfg = val & 0x00F00000;
607             break;
608         case 0x98: /* SDRAM_ECCESR */
609             val &= 0xFFF0F000;
610             if (sdram->eccesr == 0 && val != 0)
611                 qemu_irq_raise(sdram->irq);
612             else if (sdram->eccesr != 0 && val == 0)
613                 qemu_irq_lower(sdram->irq);
614             sdram->eccesr = val;
615             break;
616         default: /* Error */
617             break;
618         }
619         break;
620     }
621 }
622 
623 static void sdram_reset (void *opaque)
624 {
625     ppc4xx_sdram_t *sdram;
626 
627     sdram = opaque;
628     sdram->addr = 0x00000000;
629     sdram->bear = 0x00000000;
630     sdram->besr0 = 0x00000000; /* No error */
631     sdram->besr1 = 0x00000000; /* No error */
632     sdram->cfg = 0x00000000;
633     sdram->ecccfg = 0x00000000; /* No ECC */
634     sdram->eccesr = 0x00000000; /* No error */
635     sdram->pmit = 0x07C00000;
636     sdram->rtr = 0x05F00000;
637     sdram->tr = 0x00854009;
638     /* We pre-initialize RAM banks */
639     sdram->status = 0x00000000;
640     sdram->cfg = 0x00800000;
641 }
642 
643 void ppc4xx_sdram_init (CPUPPCState *env, qemu_irq irq, int nbanks,
644                         MemoryRegion *ram_memories,
645                         hwaddr *ram_bases,
646                         hwaddr *ram_sizes,
647                         int do_init)
648 {
649     ppc4xx_sdram_t *sdram;
650 
651     sdram = g_malloc0(sizeof(ppc4xx_sdram_t));
652     sdram->irq = irq;
653     sdram->nbanks = nbanks;
654     sdram->ram_memories = ram_memories;
655     memset(sdram->ram_bases, 0, 4 * sizeof(hwaddr));
656     memcpy(sdram->ram_bases, ram_bases,
657            nbanks * sizeof(hwaddr));
658     memset(sdram->ram_sizes, 0, 4 * sizeof(hwaddr));
659     memcpy(sdram->ram_sizes, ram_sizes,
660            nbanks * sizeof(hwaddr));
661     qemu_register_reset(&sdram_reset, sdram);
662     ppc_dcr_register(env, SDRAM0_CFGADDR,
663                      sdram, &dcr_read_sdram, &dcr_write_sdram);
664     ppc_dcr_register(env, SDRAM0_CFGDATA,
665                      sdram, &dcr_read_sdram, &dcr_write_sdram);
666     if (do_init)
667         sdram_map_bcr(sdram);
668 }
669 
670 /* Fill in consecutive SDRAM banks with 'ram_size' bytes of memory.
671  *
672  * sdram_bank_sizes[] must be 0-terminated.
673  *
674  * The 4xx SDRAM controller supports a small number of banks, and each bank
675  * must be one of a small set of sizes. The number of banks and the supported
676  * sizes varies by SoC. */
677 ram_addr_t ppc4xx_sdram_adjust(ram_addr_t ram_size, int nr_banks,
678                                MemoryRegion ram_memories[],
679                                hwaddr ram_bases[],
680                                hwaddr ram_sizes[],
681                                const ram_addr_t sdram_bank_sizes[])
682 {
683     MemoryRegion *ram = g_malloc0(sizeof(*ram));
684     ram_addr_t size_left = ram_size;
685     ram_addr_t base = 0;
686     ram_addr_t bank_size;
687     int i;
688     int j;
689 
690     for (i = 0; i < nr_banks; i++) {
691         for (j = 0; sdram_bank_sizes[j] != 0; j++) {
692             bank_size = sdram_bank_sizes[j];
693             if (bank_size <= size_left) {
694                 size_left -= bank_size;
695             }
696         }
697         if (!size_left) {
698             /* No need to use the remaining banks. */
699             break;
700         }
701     }
702 
703     ram_size -= size_left;
704     if (size_left) {
705         error_report("Truncating memory to %" PRId64 " MiB to fit SDRAM"
706                      " controller limits", ram_size / MiB);
707     }
708 
709     memory_region_allocate_system_memory(ram, NULL, "ppc4xx.sdram", ram_size);
710 
711     size_left = ram_size;
712     for (i = 0; i < nr_banks && size_left; i++) {
713         for (j = 0; sdram_bank_sizes[j] != 0; j++) {
714             bank_size = sdram_bank_sizes[j];
715 
716             if (bank_size <= size_left) {
717                 char name[32];
718                 snprintf(name, sizeof(name), "ppc4xx.sdram%d", i);
719                 memory_region_init_alias(&ram_memories[i], NULL, name, ram,
720                                          base, bank_size);
721                 ram_bases[i] = base;
722                 ram_sizes[i] = bank_size;
723                 base += bank_size;
724                 size_left -= bank_size;
725                 break;
726             }
727         }
728     }
729 
730     return ram_size;
731 }
732 
733 /*****************************************************************************/
734 /* MAL */
735 
736 enum {
737     MAL0_CFG      = 0x180,
738     MAL0_ESR      = 0x181,
739     MAL0_IER      = 0x182,
740     MAL0_TXCASR   = 0x184,
741     MAL0_TXCARR   = 0x185,
742     MAL0_TXEOBISR = 0x186,
743     MAL0_TXDEIR   = 0x187,
744     MAL0_RXCASR   = 0x190,
745     MAL0_RXCARR   = 0x191,
746     MAL0_RXEOBISR = 0x192,
747     MAL0_RXDEIR   = 0x193,
748     MAL0_TXCTP0R  = 0x1A0,
749     MAL0_RXCTP0R  = 0x1C0,
750     MAL0_RCBS0    = 0x1E0,
751     MAL0_RCBS1    = 0x1E1,
752 };
753 
754 typedef struct ppc4xx_mal_t ppc4xx_mal_t;
755 struct ppc4xx_mal_t {
756     qemu_irq irqs[4];
757     uint32_t cfg;
758     uint32_t esr;
759     uint32_t ier;
760     uint32_t txcasr;
761     uint32_t txcarr;
762     uint32_t txeobisr;
763     uint32_t txdeir;
764     uint32_t rxcasr;
765     uint32_t rxcarr;
766     uint32_t rxeobisr;
767     uint32_t rxdeir;
768     uint32_t *txctpr;
769     uint32_t *rxctpr;
770     uint32_t *rcbs;
771     uint8_t  txcnum;
772     uint8_t  rxcnum;
773 };
774 
775 static void ppc4xx_mal_reset(void *opaque)
776 {
777     ppc4xx_mal_t *mal;
778 
779     mal = opaque;
780     mal->cfg = 0x0007C000;
781     mal->esr = 0x00000000;
782     mal->ier = 0x00000000;
783     mal->rxcasr = 0x00000000;
784     mal->rxdeir = 0x00000000;
785     mal->rxeobisr = 0x00000000;
786     mal->txcasr = 0x00000000;
787     mal->txdeir = 0x00000000;
788     mal->txeobisr = 0x00000000;
789 }
790 
791 static uint32_t dcr_read_mal(void *opaque, int dcrn)
792 {
793     ppc4xx_mal_t *mal;
794     uint32_t ret;
795 
796     mal = opaque;
797     switch (dcrn) {
798     case MAL0_CFG:
799         ret = mal->cfg;
800         break;
801     case MAL0_ESR:
802         ret = mal->esr;
803         break;
804     case MAL0_IER:
805         ret = mal->ier;
806         break;
807     case MAL0_TXCASR:
808         ret = mal->txcasr;
809         break;
810     case MAL0_TXCARR:
811         ret = mal->txcarr;
812         break;
813     case MAL0_TXEOBISR:
814         ret = mal->txeobisr;
815         break;
816     case MAL0_TXDEIR:
817         ret = mal->txdeir;
818         break;
819     case MAL0_RXCASR:
820         ret = mal->rxcasr;
821         break;
822     case MAL0_RXCARR:
823         ret = mal->rxcarr;
824         break;
825     case MAL0_RXEOBISR:
826         ret = mal->rxeobisr;
827         break;
828     case MAL0_RXDEIR:
829         ret = mal->rxdeir;
830         break;
831     default:
832         ret = 0;
833         break;
834     }
835     if (dcrn >= MAL0_TXCTP0R && dcrn < MAL0_TXCTP0R + mal->txcnum) {
836         ret = mal->txctpr[dcrn - MAL0_TXCTP0R];
837     }
838     if (dcrn >= MAL0_RXCTP0R && dcrn < MAL0_RXCTP0R + mal->rxcnum) {
839         ret = mal->rxctpr[dcrn - MAL0_RXCTP0R];
840     }
841     if (dcrn >= MAL0_RCBS0 && dcrn < MAL0_RCBS0 + mal->rxcnum) {
842         ret = mal->rcbs[dcrn - MAL0_RCBS0];
843     }
844 
845     return ret;
846 }
847 
848 static void dcr_write_mal(void *opaque, int dcrn, uint32_t val)
849 {
850     ppc4xx_mal_t *mal;
851 
852     mal = opaque;
853     switch (dcrn) {
854     case MAL0_CFG:
855         if (val & 0x80000000) {
856             ppc4xx_mal_reset(mal);
857         }
858         mal->cfg = val & 0x00FFC087;
859         break;
860     case MAL0_ESR:
861         /* Read/clear */
862         mal->esr &= ~val;
863         break;
864     case MAL0_IER:
865         mal->ier = val & 0x0000001F;
866         break;
867     case MAL0_TXCASR:
868         mal->txcasr = val & 0xF0000000;
869         break;
870     case MAL0_TXCARR:
871         mal->txcarr = val & 0xF0000000;
872         break;
873     case MAL0_TXEOBISR:
874         /* Read/clear */
875         mal->txeobisr &= ~val;
876         break;
877     case MAL0_TXDEIR:
878         /* Read/clear */
879         mal->txdeir &= ~val;
880         break;
881     case MAL0_RXCASR:
882         mal->rxcasr = val & 0xC0000000;
883         break;
884     case MAL0_RXCARR:
885         mal->rxcarr = val & 0xC0000000;
886         break;
887     case MAL0_RXEOBISR:
888         /* Read/clear */
889         mal->rxeobisr &= ~val;
890         break;
891     case MAL0_RXDEIR:
892         /* Read/clear */
893         mal->rxdeir &= ~val;
894         break;
895     }
896     if (dcrn >= MAL0_TXCTP0R && dcrn < MAL0_TXCTP0R + mal->txcnum) {
897         mal->txctpr[dcrn - MAL0_TXCTP0R] = val;
898     }
899     if (dcrn >= MAL0_RXCTP0R && dcrn < MAL0_RXCTP0R + mal->rxcnum) {
900         mal->rxctpr[dcrn - MAL0_RXCTP0R] = val;
901     }
902     if (dcrn >= MAL0_RCBS0 && dcrn < MAL0_RCBS0 + mal->rxcnum) {
903         mal->rcbs[dcrn - MAL0_RCBS0] = val & 0x000000FF;
904     }
905 }
906 
907 void ppc4xx_mal_init(CPUPPCState *env, uint8_t txcnum, uint8_t rxcnum,
908                      qemu_irq irqs[4])
909 {
910     ppc4xx_mal_t *mal;
911     int i;
912 
913     assert(txcnum <= 32 && rxcnum <= 32);
914     mal = g_malloc0(sizeof(*mal));
915     mal->txcnum = txcnum;
916     mal->rxcnum = rxcnum;
917     mal->txctpr = g_new0(uint32_t, txcnum);
918     mal->rxctpr = g_new0(uint32_t, rxcnum);
919     mal->rcbs = g_new0(uint32_t, rxcnum);
920     for (i = 0; i < 4; i++) {
921         mal->irqs[i] = irqs[i];
922     }
923     qemu_register_reset(&ppc4xx_mal_reset, mal);
924     ppc_dcr_register(env, MAL0_CFG,
925                      mal, &dcr_read_mal, &dcr_write_mal);
926     ppc_dcr_register(env, MAL0_ESR,
927                      mal, &dcr_read_mal, &dcr_write_mal);
928     ppc_dcr_register(env, MAL0_IER,
929                      mal, &dcr_read_mal, &dcr_write_mal);
930     ppc_dcr_register(env, MAL0_TXCASR,
931                      mal, &dcr_read_mal, &dcr_write_mal);
932     ppc_dcr_register(env, MAL0_TXCARR,
933                      mal, &dcr_read_mal, &dcr_write_mal);
934     ppc_dcr_register(env, MAL0_TXEOBISR,
935                      mal, &dcr_read_mal, &dcr_write_mal);
936     ppc_dcr_register(env, MAL0_TXDEIR,
937                      mal, &dcr_read_mal, &dcr_write_mal);
938     ppc_dcr_register(env, MAL0_RXCASR,
939                      mal, &dcr_read_mal, &dcr_write_mal);
940     ppc_dcr_register(env, MAL0_RXCARR,
941                      mal, &dcr_read_mal, &dcr_write_mal);
942     ppc_dcr_register(env, MAL0_RXEOBISR,
943                      mal, &dcr_read_mal, &dcr_write_mal);
944     ppc_dcr_register(env, MAL0_RXDEIR,
945                      mal, &dcr_read_mal, &dcr_write_mal);
946     for (i = 0; i < txcnum; i++) {
947         ppc_dcr_register(env, MAL0_TXCTP0R + i,
948                          mal, &dcr_read_mal, &dcr_write_mal);
949     }
950     for (i = 0; i < rxcnum; i++) {
951         ppc_dcr_register(env, MAL0_RXCTP0R + i,
952                          mal, &dcr_read_mal, &dcr_write_mal);
953     }
954     for (i = 0; i < rxcnum; i++) {
955         ppc_dcr_register(env, MAL0_RCBS0 + i,
956                          mal, &dcr_read_mal, &dcr_write_mal);
957     }
958 }
959