1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27#include <common.h>
28#include <mpc5xxx.h>
29
30#include "sdram.h"
31
32#ifndef CONFIG_SYS_RAMBOOT
33static void mpc5xxx_sdram_start (sdram_conf_t *sdram_conf, int hi_addr)
34{
35 long hi_addr_bit = hi_addr ? 0x01000000 : 0;
36
37
38 *(vu_long *)MPC5XXX_SDRAM_CTRL = sdram_conf->control | 0x80000000 | hi_addr_bit;
39 __asm__ volatile ("sync");
40
41
42 *(vu_long *)MPC5XXX_SDRAM_CTRL = sdram_conf->control | 0x80000002 | hi_addr_bit;
43 __asm__ volatile ("sync");
44
45 if (sdram_conf->ddr) {
46
47 *(vu_long *)MPC5XXX_SDRAM_MODE = sdram_conf->emode;
48 __asm__ volatile ("sync");
49
50
51 *(vu_long *)MPC5XXX_SDRAM_MODE = sdram_conf->mode | 0x04000000;
52 __asm__ volatile ("sync");
53 }
54
55
56 *(vu_long *)MPC5XXX_SDRAM_CTRL = sdram_conf->control | 0x80000002 | hi_addr_bit;
57 __asm__ volatile ("sync");
58
59
60 *(vu_long *)MPC5XXX_SDRAM_CTRL = sdram_conf->control | 0x80000004 | hi_addr_bit;
61 __asm__ volatile ("sync");
62
63
64 *(vu_long *)MPC5XXX_SDRAM_MODE = sdram_conf->mode;
65 __asm__ volatile ("sync");
66
67
68 *(vu_long *)MPC5XXX_SDRAM_CTRL = sdram_conf->control | hi_addr_bit;
69 __asm__ volatile ("sync");
70}
71#endif
72
73
74
75
76
77
78
79#if defined(CONFIG_MPC5200)
80long int mpc5xxx_sdram_init (sdram_conf_t *sdram_conf)
81{
82 ulong dramsize = 0;
83 ulong dramsize2 = 0;
84#ifndef CONFIG_SYS_RAMBOOT
85 ulong test1, test2;
86
87
88 *(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0x0000001e;
89 *(vu_long *)MPC5XXX_SDRAM_CS1CFG = 0x80000000;
90 __asm__ volatile ("sync");
91
92
93 *(vu_long *)MPC5XXX_SDRAM_CONFIG1 = sdram_conf->config1;
94 *(vu_long *)MPC5XXX_SDRAM_CONFIG2 = sdram_conf->config2;
95 __asm__ volatile ("sync");
96
97 if (sdram_conf->ddr) {
98
99 *(vu_long *)MPC5XXX_CDM_PORCFG = sdram_conf->tapdelay;
100 __asm__ volatile ("sync");
101 }
102
103
104 mpc5xxx_sdram_start(sdram_conf, 0);
105 test1 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x80000000);
106 mpc5xxx_sdram_start(sdram_conf, 1);
107 test2 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x80000000);
108 if (test1 > test2) {
109 mpc5xxx_sdram_start(sdram_conf, 0);
110 dramsize = test1;
111 } else {
112 dramsize = test2;
113 }
114
115
116 if (dramsize < (1 << 20)) {
117 dramsize = 0;
118 }
119
120
121 if (dramsize > 0) {
122 *(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0x13 + __builtin_ffs(dramsize >> 20) - 1;
123 } else {
124 *(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0;
125 }
126
127
128 *(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize + 0x0000001e;
129
130
131 mpc5xxx_sdram_start(sdram_conf, 0);
132 test1 = get_ram_size((long *)(CONFIG_SYS_SDRAM_BASE + dramsize), 0x80000000);
133 mpc5xxx_sdram_start(sdram_conf, 1);
134 test2 = get_ram_size((long *)(CONFIG_SYS_SDRAM_BASE + dramsize), 0x80000000);
135 if (test1 > test2) {
136 mpc5xxx_sdram_start(sdram_conf, 0);
137 dramsize2 = test1;
138 } else {
139 dramsize2 = test2;
140 }
141
142
143 if (dramsize2 < (1 << 20)) {
144 dramsize2 = 0;
145 }
146
147
148 if (dramsize2 > 0) {
149 *(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize
150 | (0x13 + __builtin_ffs(dramsize2 >> 20) - 1);
151 } else {
152 *(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize;
153 }
154
155#else
156
157
158 dramsize = *(vu_long *)MPC5XXX_SDRAM_CS0CFG & 0xFF;
159 if (dramsize >= 0x13) {
160 dramsize = (1 << (dramsize - 0x13)) << 20;
161 } else {
162 dramsize = 0;
163 }
164
165
166 dramsize2 = *(vu_long *)MPC5XXX_SDRAM_CS1CFG & 0xFF;
167 if (dramsize2 >= 0x13) {
168 dramsize2 = (1 << (dramsize2 - 0x13)) << 20;
169 } else {
170 dramsize2 = 0;
171 }
172
173#endif
174
175 return dramsize + dramsize2;
176}
177
178#elif defined(CONFIG_MGT5100)
179
180long int mpc5xxx_sdram_init (sdram_conf_t *sdram_conf)
181{
182 ulong dramsize = 0;
183#ifndef CONFIG_SYS_RAMBOOT
184 ulong test1, test2;
185
186
187 *(vu_long *)MPC5XXX_SDRAM_START = 0x00000000;
188 *(vu_long *)MPC5XXX_SDRAM_STOP = 0x0000ffff;
189 *(vu_long *)MPC5XXX_ADDECR |= (1 << 22);
190 __asm__ volatile ("sync");
191
192
193 *(vu_long *)MPC5XXX_SDRAM_CONFIG1 = sdram_conf->config1;
194 *(vu_long *)MPC5XXX_SDRAM_CONFIG2 = sdram_conf->config2;
195
196
197 *(vu_long *)MPC5XXX_SDRAM_XLBSEL = sdram_conf->addrsel;
198 __asm__ volatile ("sync");
199
200
201 mpc5xxx_sdram_start(sdram_conf, 0);
202 test1 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x80000000);
203 mpc5xxx_sdram_start(sdram_conf, 1);
204 test2 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x80000000);
205 if (test1 > test2) {
206 mpc5xxx_sdram_start(sdram_conf, 0);
207 dramsize = test1;
208 } else {
209 dramsize = test2;
210 }
211
212
213 *(vu_long *)MPC5XXX_SDRAM_STOP = ((dramsize - 1) >> 15);
214
215#else
216
217
218 dramsize = ((*(vu_long *)MPC5XXX_SDRAM_STOP + 1) << 15);
219
220#endif
221
222 return dramsize;
223}
224
225#else
226#error Neither CONFIG_MPC5200 or CONFIG_MGT5100 defined
227#endif
228