]>
Commit | Line | Data |
---|---|---|
2a6c2d7a KG |
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; | |
6d0f6bcf | 21 | volatile ccsr_ddr_t *ddr = (void *)CONFIG_SYS_MPC85xx_DDR_ADDR; |
2a6c2d7a KG |
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; | |
6d0f6bcf | 82 | volatile ccsr_ddr_t *ddr= (void *)(CONFIG_SYS_MPC85xx_DDR_ADDR); |
2a6c2d7a KG |
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 */ |