]> git.sur5r.net Git - u-boot/blob - cpu/mpc85xx/ddr-gen1.c
powerpc: Fix bootm to boot up again with a Ramdisk
[u-boot] / cpu / mpc85xx / ddr-gen1.c
1 /*
2  * Copyright 2008 Freescale Semiconductor, Inc.
3  *
4  * This program is free software; you can redistribute it and/or
5  * modify it under the terms of the GNU General Public License
6  * Version 2 as published by the Free Software Foundation.
7  */
8
9 #include <common.h>
10 #include <asm/io.h>
11 #include <asm/fsl_ddr_sdram.h>
12
13 #if (CONFIG_CHIP_SELECTS_PER_CTRL > 4)
14 #error Invalid setting for CONFIG_CHIP_SELECTS_PER_CTRL
15 #endif
16
17 void fsl_ddr_set_memctl_regs(const fsl_ddr_cfg_regs_t *regs,
18                              unsigned int ctrl_num)
19 {
20         unsigned int i;
21         volatile ccsr_ddr_t *ddr = (void *)CFG_MPC85xx_DDR_ADDR;
22
23         if (ctrl_num != 0) {
24                 printf("%s unexpected ctrl_num = %u\n", __FUNCTION__, ctrl_num);
25                 return;
26         }
27
28         for (i = 0; i < CONFIG_CHIP_SELECTS_PER_CTRL; i++) {
29                 if (i == 0) {
30                         out_be32(&ddr->cs0_bnds, regs->cs[i].bnds);
31                         out_be32(&ddr->cs0_config, regs->cs[i].config);
32
33                 } else if (i == 1) {
34                         out_be32(&ddr->cs1_bnds, regs->cs[i].bnds);
35                         out_be32(&ddr->cs1_config, regs->cs[i].config);
36
37                 } else if (i == 2) {
38                         out_be32(&ddr->cs2_bnds, regs->cs[i].bnds);
39                         out_be32(&ddr->cs2_config, regs->cs[i].config);
40
41                 } else if (i == 3) {
42                         out_be32(&ddr->cs3_bnds, regs->cs[i].bnds);
43                         out_be32(&ddr->cs3_config, regs->cs[i].config);
44                 }
45         }
46
47         out_be32(&ddr->timing_cfg_1, regs->timing_cfg_1);
48         out_be32(&ddr->timing_cfg_2, regs->timing_cfg_2);
49         out_be32(&ddr->sdram_mode, regs->ddr_sdram_mode);
50         out_be32(&ddr->sdram_interval, regs->ddr_sdram_interval);
51 #if defined(CONFIG_MPC8555) || defined(CONFIG_MPC8541)
52         out_be32(&ddr->sdram_clk_cntl, regs->ddr_sdram_clk_cntl);
53 #endif
54
55         /*
56          * 200 painful micro-seconds must elapse between
57          * the DDR clock setup and the DDR config enable.
58          */
59         udelay(200);
60         asm volatile("sync;isync");
61
62         out_be32(&ddr->sdram_cfg, regs->ddr_sdram_cfg);
63
64         asm("sync;isync;msync");
65         udelay(500);
66 }
67
68 #if defined(CONFIG_DDR_ECC) && !defined(CONFIG_ECC_INIT_VIA_DDRCONTROLLER)
69 extern void dma_init(void);
70 extern uint dma_check(void);
71 extern int dma_xfer(void *dest, uint count, void *src);
72
73 /*
74  * Initialize all of memory for ECC, then enable errors.
75  */
76
77 void
78 ddr_enable_ecc(unsigned int dram_size)
79 {
80         uint *p = 0;
81         uint i = 0;
82         volatile ccsr_ddr_t *ddr= (void *)(CFG_MPC85xx_DDR_ADDR);
83
84         dma_init();
85
86         for (*p = 0; p < (uint *)(8 * 1024); p++) {
87                 if (((unsigned int)p & 0x1f) == 0) {
88                         ppcDcbz((unsigned long) p);
89                 }
90                 *p = (unsigned int)CONFIG_MEM_INIT_VALUE;
91                 if (((unsigned int)p & 0x1c) == 0x1c) {
92                         ppcDcbf((unsigned long) p);
93                 }
94         }
95
96         dma_xfer((uint *)0x002000, 0x002000, (uint *)0); /* 8K */
97         dma_xfer((uint *)0x004000, 0x004000, (uint *)0); /* 16K */
98         dma_xfer((uint *)0x008000, 0x008000, (uint *)0); /* 32K */
99         dma_xfer((uint *)0x010000, 0x010000, (uint *)0); /* 64K */
100         dma_xfer((uint *)0x020000, 0x020000, (uint *)0); /* 128k */
101         dma_xfer((uint *)0x040000, 0x040000, (uint *)0); /* 256k */
102         dma_xfer((uint *)0x080000, 0x080000, (uint *)0); /* 512k */
103         dma_xfer((uint *)0x100000, 0x100000, (uint *)0); /* 1M */
104         dma_xfer((uint *)0x200000, 0x200000, (uint *)0); /* 2M */
105         dma_xfer((uint *)0x400000, 0x400000, (uint *)0); /* 4M */
106
107         for (i = 1; i < dram_size / 0x800000; i++) {
108                 dma_xfer((uint *)(0x800000*i), 0x800000, (uint *)0);
109         }
110
111         /*
112          * Enable errors for ECC.
113          */
114         debug("DMA DDR: err_disable = 0x%08x\n", ddr->err_disable);
115         ddr->err_disable = 0x00000000;
116         asm("sync;isync;msync");
117         debug("DMA DDR: err_disable = 0x%08x\n", ddr->err_disable);
118 }
119
120 #endif  /* CONFIG_DDR_ECC  && ! CONFIG_ECC_INIT_VIA_DDRCONTROLLER */