]> git.ipfire.org Git - people/ms/u-boot.git/blame - arch/powerpc/cpu/ppc4xx/44x_spd_ddr.c
drivers, block: remove sil680 driver
[people/ms/u-boot.git] / arch / powerpc / cpu / ppc4xx / 44x_spd_ddr.c
CommitLineData
fe8c2806 1/*
a47a12be 2 * arch/powerpc/cpu/ppc4xx/44x_spd_ddr.c
36d830c9
SR
3 * This SPD DDR detection code supports IBM/AMCC PPC44x cpu with a
4 * DDR controller. Those are 440GP/GX/EP/GR.
5 *
fe8c2806
WD
6 * (C) Copyright 2001
7 * Bill Hunter, Wave 7 Optics, williamhunter@attbi.com
8 *
9 * Based on code by:
10 *
db2f721f
WD
11 * Kenneth Johansson ,Ericsson AB.
12 * kenneth.johansson@etx.ericsson.se
fe8c2806
WD
13 *
14 * hacked up by bill hunter. fixed so we could run before
15 * serial_init and console_init. previous version avoided this by
16 * running out of cache memory during serial/console init, then running
17 * this code later.
18 *
19 * (C) Copyright 2002
20 * Jun Gu, Artesyn Technology, jung@artesyncp.com
0c8721a4 21 * Support for AMCC 440 based on OpenBIOS draminit.c from IBM.
fe8c2806 22 *
d2d43276 23 * (C) Copyright 2005-2007
c157d8e2
SR
24 * Stefan Roese, DENX Software Engineering, sr@denx.de.
25 *
3765b3e7 26 * SPDX-License-Identifier: GPL-2.0+
fe8c2806
WD
27 */
28
d2d43276
SR
29/* define DEBUG for debugging output (obviously ;-)) */
30#if 0
31#define DEBUG
32#endif
33
fe8c2806
WD
34#include <common.h>
35#include <asm/processor.h>
36#include <i2c.h>
b36df561 37#include <asm/ppc4xx.h>
e2ebe696 38#include <asm/mmu.h>
fe8c2806 39
c821b5f1
GE
40#include "ecc.h"
41
36d830c9
SR
42#if defined(CONFIG_SPD_EEPROM) && \
43 (defined(CONFIG_440GP) || defined(CONFIG_440GX) || \
44 defined(CONFIG_440EP) || defined(CONFIG_440GR))
fe8c2806
WD
45
46/*
47 * Set default values
48 */
f013dacf 49#define ONE_BILLION 1000000000
c157d8e2 50
a5d71e29
HS
51/*
52 * Board-specific Platform code can reimplement spd_ddr_init_hang () if needed
53 */
54void __spd_ddr_init_hang (void)
55{
56 hang ();
57}
58void spd_ddr_init_hang (void) __attribute__((weak, alias("__spd_ddr_init_hang")));
566a494f 59
fe8c2806 60/*-----------------------------------------------------------------------------+
c157d8e2
SR
61 | General Definition
62 +-----------------------------------------------------------------------------*/
f013dacf
WD
63#define DEFAULT_SPD_ADDR1 0x53
64#define DEFAULT_SPD_ADDR2 0x52
65#define MAXBANKS 4 /* at most 4 dimm banks */
66#define MAX_SPD_BYTES 256
67#define NUMHALFCYCLES 4
68#define NUMMEMTESTS 8
69#define NUMMEMWORDS 8
70#define MAXBXCR 4
fe8c2806 71
e2ebe696
SR
72/*
73 * This DDR2 setup code can dynamically setup the TLB entries for the DDR2 memory
74 * region. Right now the cache should still be disabled in U-Boot because of the
75 * EMAC driver, that need it's buffer descriptor to be located in non cached
76 * memory.
77 *
78 * If at some time this restriction doesn't apply anymore, just define
ea2e1428 79 * CONFIG_4xx_DCACHE in the board config file and this code should setup
e2ebe696
SR
80 * everything correctly.
81 */
ea2e1428 82#ifdef CONFIG_4xx_DCACHE
e2ebe696
SR
83#define MY_TLB_WORD2_I_ENABLE 0 /* enable caching on SDRAM */
84#else
85#define MY_TLB_WORD2_I_ENABLE TLB_WORD2_I_ENABLE /* disable caching on SDRAM */
86#endif
87
fd49bf02
SR
88/* bank_parms is used to sort the bank sizes by descending order */
89struct bank_param {
90 unsigned long cr;
91 unsigned long bank_size_bytes;
92};
93
94typedef struct bank_param BANKPARMS;
95
6d0f6bcf 96#ifdef CONFIG_SYS_SIMULATE_SPD_EEPROM
d2f68006 97extern const unsigned char cfg_simulate_spd_eeprom[128];
fd49bf02 98#endif
fe8c2806 99
d2d43276
SR
100static unsigned char spd_read(uchar chip, uint addr);
101static void get_spd_info(unsigned long *dimm_populated,
102 unsigned char *iic0_dimm_addr,
103 unsigned long num_dimm_banks);
104static void check_mem_type(unsigned long *dimm_populated,
105 unsigned char *iic0_dimm_addr,
106 unsigned long num_dimm_banks);
107static void check_volt_type(unsigned long *dimm_populated,
108 unsigned char *iic0_dimm_addr,
109 unsigned long num_dimm_banks);
110static void program_cfg0(unsigned long *dimm_populated,
111 unsigned char *iic0_dimm_addr,
112 unsigned long num_dimm_banks);
113static void program_cfg1(unsigned long *dimm_populated,
114 unsigned char *iic0_dimm_addr,
115 unsigned long num_dimm_banks);
116static void program_rtr(unsigned long *dimm_populated,
117 unsigned char *iic0_dimm_addr,
118 unsigned long num_dimm_banks);
119static void program_tr0(unsigned long *dimm_populated,
120 unsigned char *iic0_dimm_addr,
121 unsigned long num_dimm_banks);
122static void program_tr1(void);
123
d2d43276
SR
124static unsigned long program_bxcr(unsigned long *dimm_populated,
125 unsigned char *iic0_dimm_addr,
126 unsigned long num_dimm_banks);
fe8c2806
WD
127
128/*
129 * This function is reading data from the DIMM module EEPROM over the SPD bus
130 * and uses that to program the sdram controller.
131 *
0c8721a4 132 * This works on boards that has the same schematics that the AMCC walnut has.
fe8c2806
WD
133 *
134 * BUG: Don't handle ECC memory
135 * BUG: A few values in the TR register is currently hardcoded
136 */
fe8c2806 137long int spd_sdram(void) {
c157d8e2
SR
138 unsigned char iic0_dimm_addr[] = SPD_EEPROM_ADDRESS;
139 unsigned long dimm_populated[sizeof(iic0_dimm_addr)];
140 unsigned long total_size;
141 unsigned long cfg0;
142 unsigned long mcsts;
f013dacf 143 unsigned long num_dimm_banks; /* on board dimm banks */
fe8c2806 144
c157d8e2 145 num_dimm_banks = sizeof(iic0_dimm_addr);
fe8c2806
WD
146
147 /*
148 * Make sure I2C controller is initialized
149 * before continuing.
150 */
880540de 151 i2c_set_bus_num(CONFIG_SYS_SPD_BUS_NUM);
fe8c2806 152
c157d8e2
SR
153 /*
154 * Read the SPD information using I2C interface. Check to see if the
155 * DIMM slots are populated.
156 */
157 get_spd_info(dimm_populated, iic0_dimm_addr, num_dimm_banks);
fe8c2806 158
c157d8e2
SR
159 /*
160 * Check the memory type for the dimms plugged.
161 */
162 check_mem_type(dimm_populated, iic0_dimm_addr, num_dimm_banks);
fe8c2806 163
c157d8e2
SR
164 /*
165 * Check the voltage type for the dimms plugged.
166 */
167 check_volt_type(dimm_populated, iic0_dimm_addr, num_dimm_banks);
fe8c2806 168
ea2e1428 169#if defined(CONFIG_440GX) || defined(CONFIG_440EP) || defined(CONFIG_440GR)
c157d8e2
SR
170 /*
171 * Soft-reset SDRAM controller.
172 */
d1c3b275
SR
173 mtsdr(SDR0_SRST, SDR0_SRST_DMC);
174 mtsdr(SDR0_SRST, 0x00000000);
63153492
WD
175#endif
176
c157d8e2
SR
177 /*
178 * program 440GP SDRAM controller options (SDRAM0_CFG0)
179 */
180 program_cfg0(dimm_populated, iic0_dimm_addr, num_dimm_banks);
181
182 /*
183 * program 440GP SDRAM controller options (SDRAM0_CFG1)
184 */
185 program_cfg1(dimm_populated, iic0_dimm_addr, num_dimm_banks);
186
187 /*
188 * program SDRAM refresh register (SDRAM0_RTR)
189 */
190 program_rtr(dimm_populated, iic0_dimm_addr, num_dimm_banks);
191
192 /*
193 * program SDRAM Timing Register 0 (SDRAM0_TR0)
194 */
195 program_tr0(dimm_populated, iic0_dimm_addr, num_dimm_banks);
196
197 /*
198 * program the BxCR registers to find out total sdram installed
199 */
200 total_size = program_bxcr(dimm_populated, iic0_dimm_addr,
201 num_dimm_banks);
202
e2ebe696
SR
203#ifdef CONFIG_PROG_SDRAM_TLB /* this define should eventually be removed */
204 /* and program tlb entries for this size (dynamic) */
dbca2085 205 program_tlb(0, 0, total_size, MY_TLB_WORD2_I_ENABLE);
e2ebe696
SR
206#endif
207
c157d8e2
SR
208 /*
209 * program SDRAM Clock Timing Register (SDRAM0_CLKTR)
210 */
95b602ba 211 mtsdram(SDRAM0_CLKTR, 0x40000000);
c157d8e2
SR
212
213 /*
214 * delay to ensure 200 usec has elapsed
215 */
216 udelay(400);
217
218 /*
219 * enable the memory controller
220 */
95b602ba
SR
221 mfsdram(SDRAM0_CFG0, cfg0);
222 mtsdram(SDRAM0_CFG0, cfg0 | SDRAM_CFG0_DCEN);
c157d8e2
SR
223
224 /*
225 * wait for SDRAM_CFG0_DC_EN to complete
226 */
227 while (1) {
95b602ba 228 mfsdram(SDRAM0_MCSTS, mcsts);
d2d43276 229 if ((mcsts & SDRAM_MCSTS_MRSC) != 0)
c157d8e2 230 break;
8bde7f77 231 }
fe8c2806 232
c157d8e2
SR
233 /*
234 * program SDRAM Timing Register 1, adding some delays
235 */
236 program_tr1();
fe8c2806 237
d2d43276 238#ifdef CONFIG_DDR_ECC
c157d8e2 239 /*
d2d43276 240 * If ecc is enabled, initialize the parity bits.
c157d8e2 241 */
6d0f6bcf 242 ecc_init(CONFIG_SYS_SDRAM_BASE, total_size);
d2d43276 243#endif
fe8c2806
WD
244
245 return total_size;
246}
247
d2d43276 248static unsigned char spd_read(uchar chip, uint addr)
fd49bf02 249{
fe8c2806
WD
250 unsigned char data[2];
251
6d0f6bcf
JCPV
252#ifdef CONFIG_SYS_SIMULATE_SPD_EEPROM
253 if (chip == CONFIG_SYS_SIMULATE_SPD_EEPROM) {
fd49bf02
SR
254 /*
255 * Onboard spd eeprom requested -> simulate values
256 */
257 return cfg_simulate_spd_eeprom[addr];
258 }
6d0f6bcf 259#endif /* CONFIG_SYS_SIMULATE_SPD_EEPROM */
fd49bf02 260
c157d8e2
SR
261 if (i2c_probe(chip) == 0) {
262 if (i2c_read(chip, addr, 1, data, 1) == 0) {
263 return data[0];
264 }
265 }
266
267 return 0;
fe8c2806
WD
268}
269
d2d43276
SR
270static void get_spd_info(unsigned long *dimm_populated,
271 unsigned char *iic0_dimm_addr,
272 unsigned long num_dimm_banks)
fe8c2806 273{
c157d8e2
SR
274 unsigned long dimm_num;
275 unsigned long dimm_found;
276 unsigned char num_of_bytes;
277 unsigned char total_size;
278
472d5460 279 dimm_found = false;
c157d8e2
SR
280 for (dimm_num = 0; dimm_num < num_dimm_banks; dimm_num++) {
281 num_of_bytes = 0;
282 total_size = 0;
283
284 num_of_bytes = spd_read(iic0_dimm_addr[dimm_num], 0);
285 total_size = spd_read(iic0_dimm_addr[dimm_num], 1);
286
287 if ((num_of_bytes != 0) && (total_size != 0)) {
472d5460
YS
288 dimm_populated[dimm_num] = true;
289 dimm_found = true;
d2d43276 290 debug("DIMM slot %lu: populated\n", dimm_num);
c157d8e2 291 } else {
472d5460 292 dimm_populated[dimm_num] = false;
d2d43276 293 debug("DIMM slot %lu: Not populated\n", dimm_num);
c157d8e2 294 }
8bde7f77 295 }
fe8c2806 296
472d5460 297 if (dimm_found == false) {
c157d8e2 298 printf("ERROR - No memory installed. Install a DDR-SDRAM DIMM.\n\n");
a5d71e29 299 spd_ddr_init_hang ();
c157d8e2 300 }
fe8c2806
WD
301}
302
d2d43276
SR
303static void check_mem_type(unsigned long *dimm_populated,
304 unsigned char *iic0_dimm_addr,
305 unsigned long num_dimm_banks)
fe8c2806 306{
c157d8e2
SR
307 unsigned long dimm_num;
308 unsigned char dimm_type;
309
310 for (dimm_num = 0; dimm_num < num_dimm_banks; dimm_num++) {
472d5460 311 if (dimm_populated[dimm_num] == true) {
c157d8e2
SR
312 dimm_type = spd_read(iic0_dimm_addr[dimm_num], 2);
313 switch (dimm_type) {
314 case 7:
d2d43276 315 debug("DIMM slot %lu: DDR SDRAM detected\n", dimm_num);
c157d8e2
SR
316 break;
317 default:
318 printf("ERROR: Unsupported DIMM detected in slot %lu.\n",
319 dimm_num);
320 printf("Only DDR SDRAM DIMMs are supported.\n");
321 printf("Replace the DIMM module with a supported DIMM.\n\n");
a5d71e29 322 spd_ddr_init_hang ();
c157d8e2
SR
323 break;
324 }
325 }
8bde7f77 326 }
fe8c2806
WD
327}
328
d2d43276
SR
329static void check_volt_type(unsigned long *dimm_populated,
330 unsigned char *iic0_dimm_addr,
331 unsigned long num_dimm_banks)
fe8c2806 332{
c157d8e2
SR
333 unsigned long dimm_num;
334 unsigned long voltage_type;
335
336 for (dimm_num = 0; dimm_num < num_dimm_banks; dimm_num++) {
472d5460 337 if (dimm_populated[dimm_num] == true) {
c157d8e2
SR
338 voltage_type = spd_read(iic0_dimm_addr[dimm_num], 8);
339 if (voltage_type != 0x04) {
340 printf("ERROR: DIMM %lu with unsupported voltage level.\n",
341 dimm_num);
a5d71e29 342 spd_ddr_init_hang ();
c157d8e2 343 } else {
d2d43276 344 debug("DIMM %lu voltage level supported.\n", dimm_num);
c157d8e2
SR
345 }
346 break;
347 }
8bde7f77 348 }
fe8c2806
WD
349}
350
d2d43276
SR
351static void program_cfg0(unsigned long *dimm_populated,
352 unsigned char *iic0_dimm_addr,
353 unsigned long num_dimm_banks)
fe8c2806 354{
c157d8e2
SR
355 unsigned long dimm_num;
356 unsigned long cfg0;
357 unsigned long ecc_enabled;
358 unsigned char ecc;
359 unsigned char attributes;
360 unsigned long data_width;
c157d8e2
SR
361
362 /*
363 * get Memory Controller Options 0 data
364 */
95b602ba 365 mfsdram(SDRAM0_CFG0, cfg0);
c157d8e2
SR
366
367 /*
368 * clear bits
369 */
370 cfg0 &= ~(SDRAM_CFG0_DCEN | SDRAM_CFG0_MCHK_MASK |
371 SDRAM_CFG0_RDEN | SDRAM_CFG0_PMUD |
372 SDRAM_CFG0_DMWD_MASK |
373 SDRAM_CFG0_UIOS_MASK | SDRAM_CFG0_PDP);
374
375
376 /*
377 * FIXME: assume the DDR SDRAMs in both banks are the same
378 */
472d5460 379 ecc_enabled = true;
c157d8e2 380 for (dimm_num = 0; dimm_num < num_dimm_banks; dimm_num++) {
472d5460 381 if (dimm_populated[dimm_num] == true) {
c157d8e2
SR
382 ecc = spd_read(iic0_dimm_addr[dimm_num], 11);
383 if (ecc != 0x02) {
472d5460 384 ecc_enabled = false;
c157d8e2
SR
385 }
386
387 /*
388 * program Registered DIMM Enable
389 */
390 attributes = spd_read(iic0_dimm_addr[dimm_num], 21);
391 if ((attributes & 0x02) != 0x00) {
392 cfg0 |= SDRAM_CFG0_RDEN;
393 }
394
395 /*
396 * program DDR SDRAM Data Width
397 */
398 data_width =
399 (unsigned long)spd_read(iic0_dimm_addr[dimm_num],6) +
400 (((unsigned long)spd_read(iic0_dimm_addr[dimm_num],7)) << 8);
401 if (data_width == 64 || data_width == 72) {
c157d8e2
SR
402 cfg0 |= SDRAM_CFG0_DMWD_64;
403 } else if (data_width == 32 || data_width == 40) {
c157d8e2
SR
404 cfg0 |= SDRAM_CFG0_DMWD_32;
405 } else {
406 printf("WARNING: DIMM with datawidth of %lu bits.\n",
407 data_width);
408 printf("Only DIMMs with 32 or 64 bit datawidths supported.\n");
a5d71e29 409 spd_ddr_init_hang ();
c157d8e2
SR
410 }
411 break;
412 }
8bde7f77 413 }
c157d8e2
SR
414
415 /*
416 * program Memory Data Error Checking
417 */
472d5460 418 if (ecc_enabled == true) {
c157d8e2
SR
419 cfg0 |= SDRAM_CFG0_MCHK_GEN;
420 } else {
421 cfg0 |= SDRAM_CFG0_MCHK_NON;
422 }
423
424 /*
a2c95a72 425 * program Page Management Unit (0 == enabled)
c157d8e2 426 */
a2c95a72 427 cfg0 &= ~SDRAM_CFG0_PMUD;
c157d8e2
SR
428
429 /*
430 * program Memory Controller Options 0
431 * Note: DCEN must be enabled after all DDR SDRAM controller
432 * configuration registers get initialized.
433 */
95b602ba 434 mtsdram(SDRAM0_CFG0, cfg0);
fe8c2806
WD
435}
436
d2d43276
SR
437static void program_cfg1(unsigned long *dimm_populated,
438 unsigned char *iic0_dimm_addr,
439 unsigned long num_dimm_banks)
fe8c2806 440{
c157d8e2 441 unsigned long cfg1;
95b602ba 442 mfsdram(SDRAM0_CFG1, cfg1);
c157d8e2
SR
443
444 /*
445 * Self-refresh exit, disable PM
446 */
447 cfg1 &= ~(SDRAM_CFG1_SRE | SDRAM_CFG1_PMEN);
448
449 /*
450 * program Memory Controller Options 1
451 */
95b602ba 452 mtsdram(SDRAM0_CFG1, cfg1);
fe8c2806
WD
453}
454
d2d43276
SR
455static void program_rtr(unsigned long *dimm_populated,
456 unsigned char *iic0_dimm_addr,
457 unsigned long num_dimm_banks)
fe8c2806 458{
c157d8e2
SR
459 unsigned long dimm_num;
460 unsigned long bus_period_x_10;
461 unsigned long refresh_rate = 0;
462 unsigned char refresh_rate_type;
463 unsigned long refresh_interval;
464 unsigned long sdram_rtr;
087dfdb7 465 PPC4xx_SYS_INFO sys_info;
c157d8e2
SR
466
467 /*
468 * get the board info
469 */
470 get_sys_info(&sys_info);
471 bus_period_x_10 = ONE_BILLION / (sys_info.freqPLB / 10);
472
c157d8e2 473 for (dimm_num = 0; dimm_num < num_dimm_banks; dimm_num++) {
472d5460 474 if (dimm_populated[dimm_num] == true) {
c157d8e2
SR
475 refresh_rate_type = 0x7F & spd_read(iic0_dimm_addr[dimm_num], 12);
476 switch (refresh_rate_type) {
477 case 0x00:
478 refresh_rate = 15625;
479 break;
480 case 0x01:
481 refresh_rate = 15625/4;
482 break;
483 case 0x02:
484 refresh_rate = 15625/2;
485 break;
486 case 0x03:
487 refresh_rate = 15626*2;
488 break;
489 case 0x04:
490 refresh_rate = 15625*4;
491 break;
492 case 0x05:
493 refresh_rate = 15625*8;
494 break;
495 default:
496 printf("ERROR: DIMM %lu, unsupported refresh rate/type.\n",
497 dimm_num);
498 printf("Replace the DIMM module with a supported DIMM.\n");
499 break;
500 }
501
502 break;
503 }
8bde7f77 504 }
fe8c2806 505
c157d8e2
SR
506 refresh_interval = refresh_rate * 10 / bus_period_x_10;
507 sdram_rtr = (refresh_interval & 0x3ff8) << 16;
fe8c2806 508
c157d8e2
SR
509 /*
510 * program Refresh Timer Register (SDRAM0_RTR)
511 */
95b602ba 512 mtsdram(SDRAM0_RTR, sdram_rtr);
fe8c2806
WD
513}
514
d2d43276
SR
515static void program_tr0(unsigned long *dimm_populated,
516 unsigned char *iic0_dimm_addr,
517 unsigned long num_dimm_banks)
fe8c2806 518{
c157d8e2
SR
519 unsigned long dimm_num;
520 unsigned long tr0;
521 unsigned char wcsbc;
522 unsigned char t_rp_ns;
523 unsigned char t_rcd_ns;
524 unsigned char t_ras_ns;
525 unsigned long t_rp_clk;
526 unsigned long t_ras_rcd_clk;
527 unsigned long t_rcd_clk;
528 unsigned long t_rfc_clk;
529 unsigned long plb_check;
530 unsigned char cas_bit;
531 unsigned long cas_index;
532 unsigned char cas_2_0_available;
533 unsigned char cas_2_5_available;
534 unsigned char cas_3_0_available;
535 unsigned long cycle_time_ns_x_10[3];
536 unsigned long tcyc_3_0_ns_x_10;
537 unsigned long tcyc_2_5_ns_x_10;
538 unsigned long tcyc_2_0_ns_x_10;
539 unsigned long tcyc_reg;
540 unsigned long bus_period_x_10;
087dfdb7 541 PPC4xx_SYS_INFO sys_info;
c157d8e2 542 unsigned long residue;
8bde7f77 543
c157d8e2
SR
544 /*
545 * get the board info
546 */
547 get_sys_info(&sys_info);
548 bus_period_x_10 = ONE_BILLION / (sys_info.freqPLB / 10);
8bde7f77 549
c157d8e2
SR
550 /*
551 * get SDRAM Timing Register 0 (SDRAM_TR0) and clear bits
552 */
95b602ba 553 mfsdram(SDRAM0_TR0, tr0);
c157d8e2
SR
554 tr0 &= ~(SDRAM_TR0_SDWR_MASK | SDRAM_TR0_SDWD_MASK |
555 SDRAM_TR0_SDCL_MASK | SDRAM_TR0_SDPA_MASK |
556 SDRAM_TR0_SDCP_MASK | SDRAM_TR0_SDLD_MASK |
557 SDRAM_TR0_SDRA_MASK | SDRAM_TR0_SDRD_MASK);
558
559 /*
560 * initialization
561 */
562 wcsbc = 0;
563 t_rp_ns = 0;
564 t_rcd_ns = 0;
565 t_ras_ns = 0;
472d5460
YS
566 cas_2_0_available = true;
567 cas_2_5_available = true;
568 cas_3_0_available = true;
c157d8e2
SR
569 tcyc_2_0_ns_x_10 = 0;
570 tcyc_2_5_ns_x_10 = 0;
571 tcyc_3_0_ns_x_10 = 0;
572
573 for (dimm_num = 0; dimm_num < num_dimm_banks; dimm_num++) {
472d5460 574 if (dimm_populated[dimm_num] == true) {
c157d8e2 575 wcsbc = spd_read(iic0_dimm_addr[dimm_num], 15);
f013dacf 576 t_rp_ns = spd_read(iic0_dimm_addr[dimm_num], 27) >> 2;
c157d8e2
SR
577 t_rcd_ns = spd_read(iic0_dimm_addr[dimm_num], 29) >> 2;
578 t_ras_ns = spd_read(iic0_dimm_addr[dimm_num], 30);
579 cas_bit = spd_read(iic0_dimm_addr[dimm_num], 18);
580
581 for (cas_index = 0; cas_index < 3; cas_index++) {
582 switch (cas_index) {
583 case 0:
584 tcyc_reg = spd_read(iic0_dimm_addr[dimm_num], 9);
585 break;
586 case 1:
587 tcyc_reg = spd_read(iic0_dimm_addr[dimm_num], 23);
588 break;
589 default:
590 tcyc_reg = spd_read(iic0_dimm_addr[dimm_num], 25);
591 break;
592 }
593
594 if ((tcyc_reg & 0x0F) >= 10) {
595 printf("ERROR: Tcyc incorrect for DIMM in slot %lu\n",
596 dimm_num);
a5d71e29 597 spd_ddr_init_hang ();
c157d8e2
SR
598 }
599
600 cycle_time_ns_x_10[cas_index] =
601 (((tcyc_reg & 0xF0) >> 4) * 10) + (tcyc_reg & 0x0F);
602 }
603
604 cas_index = 0;
605
606 if ((cas_bit & 0x80) != 0) {
607 cas_index += 3;
608 } else if ((cas_bit & 0x40) != 0) {
609 cas_index += 2;
610 } else if ((cas_bit & 0x20) != 0) {
611 cas_index += 1;
612 }
613
614 if (((cas_bit & 0x10) != 0) && (cas_index < 3)) {
615 tcyc_3_0_ns_x_10 = cycle_time_ns_x_10[cas_index];
616 cas_index++;
617 } else {
618 if (cas_index != 0) {
619 cas_index++;
620 }
472d5460 621 cas_3_0_available = false;
c157d8e2
SR
622 }
623
624 if (((cas_bit & 0x08) != 0) || (cas_index < 3)) {
625 tcyc_2_5_ns_x_10 = cycle_time_ns_x_10[cas_index];
626 cas_index++;
627 } else {
628 if (cas_index != 0) {
629 cas_index++;
630 }
472d5460 631 cas_2_5_available = false;
c157d8e2
SR
632 }
633
634 if (((cas_bit & 0x04) != 0) || (cas_index < 3)) {
635 tcyc_2_0_ns_x_10 = cycle_time_ns_x_10[cas_index];
636 cas_index++;
637 } else {
638 if (cas_index != 0) {
639 cas_index++;
640 }
472d5460 641 cas_2_0_available = false;
c157d8e2
SR
642 }
643
644 break;
8bde7f77 645 }
c157d8e2
SR
646 }
647
648 /*
649 * Program SD_WR and SD_WCSBC fields
650 */
f013dacf 651 tr0 |= SDRAM_TR0_SDWR_2_CLK; /* Write Recovery: 2 CLK */
c157d8e2
SR
652 switch (wcsbc) {
653 case 0:
654 tr0 |= SDRAM_TR0_SDWD_0_CLK;
655 break;
656 default:
657 tr0 |= SDRAM_TR0_SDWD_1_CLK;
658 break;
659 }
660
661 /*
662 * Program SD_CASL field
663 */
472d5460 664 if ((cas_2_0_available == true) &&
c157d8e2
SR
665 (bus_period_x_10 >= tcyc_2_0_ns_x_10)) {
666 tr0 |= SDRAM_TR0_SDCL_2_0_CLK;
472d5460 667 } else if ((cas_2_5_available == true) &&
c157d8e2
SR
668 (bus_period_x_10 >= tcyc_2_5_ns_x_10)) {
669 tr0 |= SDRAM_TR0_SDCL_2_5_CLK;
472d5460 670 } else if ((cas_3_0_available == true) &&
c157d8e2
SR
671 (bus_period_x_10 >= tcyc_3_0_ns_x_10)) {
672 tr0 |= SDRAM_TR0_SDCL_3_0_CLK;
673 } else {
674 printf("ERROR: No supported CAS latency with the installed DIMMs.\n");
675 printf("Only CAS latencies of 2.0, 2.5, and 3.0 are supported.\n");
676 printf("Make sure the PLB speed is within the supported range.\n");
a5d71e29 677 spd_ddr_init_hang ();
c157d8e2
SR
678 }
679
680 /*
681 * Calculate Trp in clock cycles and round up if necessary
682 * Program SD_PTA field
683 */
684 t_rp_clk = sys_info.freqPLB * t_rp_ns / ONE_BILLION;
685 plb_check = ONE_BILLION * t_rp_clk / t_rp_ns;
686 if (sys_info.freqPLB != plb_check) {
687 t_rp_clk++;
688 }
689 switch ((unsigned long)t_rp_clk) {
690 case 0:
691 case 1:
692 case 2:
693 tr0 |= SDRAM_TR0_SDPA_2_CLK;
694 break;
695 case 3:
696 tr0 |= SDRAM_TR0_SDPA_3_CLK;
697 break;
698 default:
699 tr0 |= SDRAM_TR0_SDPA_4_CLK;
700 break;
701 }
702
703 /*
704 * Program SD_CTP field
705 */
706 t_ras_rcd_clk = sys_info.freqPLB * (t_ras_ns - t_rcd_ns) / ONE_BILLION;
707 plb_check = ONE_BILLION * t_ras_rcd_clk / (t_ras_ns - t_rcd_ns);
708 if (sys_info.freqPLB != plb_check) {
709 t_ras_rcd_clk++;
710 }
711 switch (t_ras_rcd_clk) {
712 case 0:
713 case 1:
714 case 2:
715 tr0 |= SDRAM_TR0_SDCP_2_CLK;
716 break;
717 case 3:
718 tr0 |= SDRAM_TR0_SDCP_3_CLK;
719 break;
720 case 4:
721 tr0 |= SDRAM_TR0_SDCP_4_CLK;
722 break;
723 default:
724 tr0 |= SDRAM_TR0_SDCP_5_CLK;
725 break;
726 }
727
728 /*
729 * Program SD_LDF field
730 */
731 tr0 |= SDRAM_TR0_SDLD_2_CLK;
732
733 /*
734 * Program SD_RFTA field
735 * FIXME tRFC hardcoded as 75 nanoseconds
736 */
737 t_rfc_clk = sys_info.freqPLB / (ONE_BILLION / 75);
738 residue = sys_info.freqPLB % (ONE_BILLION / 75);
739 if (residue >= (ONE_BILLION / 150)) {
740 t_rfc_clk++;
741 }
742 switch (t_rfc_clk) {
743 case 0:
744 case 1:
745 case 2:
746 case 3:
747 case 4:
748 case 5:
749 case 6:
750 tr0 |= SDRAM_TR0_SDRA_6_CLK;
751 break;
752 case 7:
753 tr0 |= SDRAM_TR0_SDRA_7_CLK;
754 break;
755 case 8:
756 tr0 |= SDRAM_TR0_SDRA_8_CLK;
757 break;
758 case 9:
759 tr0 |= SDRAM_TR0_SDRA_9_CLK;
760 break;
761 case 10:
762 tr0 |= SDRAM_TR0_SDRA_10_CLK;
763 break;
764 case 11:
765 tr0 |= SDRAM_TR0_SDRA_11_CLK;
766 break;
767 case 12:
768 tr0 |= SDRAM_TR0_SDRA_12_CLK;
769 break;
770 default:
771 tr0 |= SDRAM_TR0_SDRA_13_CLK;
772 break;
773 }
8bde7f77 774
c157d8e2
SR
775 /*
776 * Program SD_RCD field
777 */
778 t_rcd_clk = sys_info.freqPLB * t_rcd_ns / ONE_BILLION;
779 plb_check = ONE_BILLION * t_rcd_clk / t_rcd_ns;
780 if (sys_info.freqPLB != plb_check) {
781 t_rcd_clk++;
782 }
783 switch (t_rcd_clk) {
784 case 0:
785 case 1:
786 case 2:
787 tr0 |= SDRAM_TR0_SDRD_2_CLK;
788 break;
789 case 3:
790 tr0 |= SDRAM_TR0_SDRD_3_CLK;
791 break;
792 default:
793 tr0 |= SDRAM_TR0_SDRD_4_CLK;
794 break;
8bde7f77 795 }
fe8c2806 796
73dc3075 797 debug("tr0: %lx\n", tr0);
95b602ba 798 mtsdram(SDRAM0_TR0, tr0);
fe8c2806
WD
799}
800
d2d43276
SR
801static int short_mem_test(void)
802{
803 unsigned long i, j;
804 unsigned long bxcr_num;
805 unsigned long *membase;
806 const unsigned long test[NUMMEMTESTS][NUMMEMWORDS] = {
807 {0x00000000, 0x00000000, 0xFFFFFFFF, 0xFFFFFFFF,
808 0x00000000, 0x00000000, 0xFFFFFFFF, 0xFFFFFFFF},
809 {0xFFFFFFFF, 0xFFFFFFFF, 0x00000000, 0x00000000,
810 0xFFFFFFFF, 0xFFFFFFFF, 0x00000000, 0x00000000},
811 {0xAAAAAAAA, 0xAAAAAAAA, 0x55555555, 0x55555555,
812 0xAAAAAAAA, 0xAAAAAAAA, 0x55555555, 0x55555555},
813 {0x55555555, 0x55555555, 0xAAAAAAAA, 0xAAAAAAAA,
814 0x55555555, 0x55555555, 0xAAAAAAAA, 0xAAAAAAAA},
815 {0xA5A5A5A5, 0xA5A5A5A5, 0x5A5A5A5A, 0x5A5A5A5A,
816 0xA5A5A5A5, 0xA5A5A5A5, 0x5A5A5A5A, 0x5A5A5A5A},
817 {0x5A5A5A5A, 0x5A5A5A5A, 0xA5A5A5A5, 0xA5A5A5A5,
818 0x5A5A5A5A, 0x5A5A5A5A, 0xA5A5A5A5, 0xA5A5A5A5},
819 {0xAA55AA55, 0xAA55AA55, 0x55AA55AA, 0x55AA55AA,
820 0xAA55AA55, 0xAA55AA55, 0x55AA55AA, 0x55AA55AA},
821 {0x55AA55AA, 0x55AA55AA, 0xAA55AA55, 0xAA55AA55,
822 0x55AA55AA, 0x55AA55AA, 0xAA55AA55, 0xAA55AA55}};
823
824 for (bxcr_num = 0; bxcr_num < MAXBXCR; bxcr_num++) {
95b602ba 825 mtdcr(SDRAM0_CFGADDR, SDRAM0_B0CR + (bxcr_num << 2));
d1c3b275 826 if ((mfdcr(SDRAM0_CFGDATA) & SDRAM_BXCR_SDBE) == SDRAM_BXCR_SDBE) {
d2d43276
SR
827 /* Bank is enabled */
828 membase = (unsigned long*)
d1c3b275 829 (mfdcr(SDRAM0_CFGDATA) & SDRAM_BXCR_SDBA_MASK);
d2d43276
SR
830
831 /*
832 * Run the short memory test
833 */
834 for (i = 0; i < NUMMEMTESTS; i++) {
835 for (j = 0; j < NUMMEMWORDS; j++) {
239f05ee 836 /* printf("bank enabled base:%x\n", &membase[j]); */
d2d43276
SR
837 membase[j] = test[i][j];
838 ppcDcbf((unsigned long)&(membase[j]));
839 }
840
841 for (j = 0; j < NUMMEMWORDS; j++) {
842 if (membase[j] != test[i][j]) {
843 ppcDcbf((unsigned long)&(membase[j]));
844 return 0;
845 }
846 ppcDcbf((unsigned long)&(membase[j]));
847 }
848
849 if (j < NUMMEMWORDS)
850 return 0;
851 }
852
853 /*
854 * see if the rdclt value passed
855 */
856 if (i < NUMMEMTESTS)
857 return 0;
858 }
859 }
860
861 return 1;
862}
863
864static void program_tr1(void)
fe8c2806 865{
c157d8e2
SR
866 unsigned long tr0;
867 unsigned long tr1;
868 unsigned long cfg0;
869 unsigned long ecc_temp;
870 unsigned long dlycal;
871 unsigned long dly_val;
d2d43276 872 unsigned long k;
c157d8e2
SR
873 unsigned long max_pass_length;
874 unsigned long current_pass_length;
875 unsigned long current_fail_length;
876 unsigned long current_start;
877 unsigned long rdclt;
878 unsigned long rdclt_offset;
879 long max_start;
880 long max_end;
881 long rdclt_average;
882 unsigned char window_found;
883 unsigned char fail_found;
884 unsigned char pass_found;
087dfdb7 885 PPC4xx_SYS_INFO sys_info;
c157d8e2
SR
886
887 /*
888 * get the board info
889 */
890 get_sys_info(&sys_info);
891
892 /*
893 * get SDRAM Timing Register 0 (SDRAM_TR0) and clear bits
894 */
95b602ba 895 mfsdram(SDRAM0_TR1, tr1);
c157d8e2
SR
896 tr1 &= ~(SDRAM_TR1_RDSS_MASK | SDRAM_TR1_RDSL_MASK |
897 SDRAM_TR1_RDCD_MASK | SDRAM_TR1_RDCT_MASK);
898
95b602ba 899 mfsdram(SDRAM0_TR0, tr0);
c157d8e2
SR
900 if (((tr0 & SDRAM_TR0_SDCL_MASK) == SDRAM_TR0_SDCL_2_5_CLK) &&
901 (sys_info.freqPLB > 100000000)) {
902 tr1 |= SDRAM_TR1_RDSS_TR2;
903 tr1 |= SDRAM_TR1_RDSL_STAGE3;
904 tr1 |= SDRAM_TR1_RDCD_RCD_1_2;
905 } else {
906 tr1 |= SDRAM_TR1_RDSS_TR1;
907 tr1 |= SDRAM_TR1_RDSL_STAGE2;
908 tr1 |= SDRAM_TR1_RDCD_RCD_0_0;
909 }
910
911 /*
912 * save CFG0 ECC setting to a temporary variable and turn ECC off
913 */
95b602ba 914 mfsdram(SDRAM0_CFG0, cfg0);
c157d8e2 915 ecc_temp = cfg0 & SDRAM_CFG0_MCHK_MASK;
95b602ba 916 mtsdram(SDRAM0_CFG0, (cfg0 & ~SDRAM_CFG0_MCHK_MASK) | SDRAM_CFG0_MCHK_NON);
c157d8e2
SR
917
918 /*
919 * get the delay line calibration register value
920 */
95b602ba 921 mfsdram(SDRAM0_DLYCAL, dlycal);
c157d8e2
SR
922 dly_val = SDRAM_DLYCAL_DLCV_DECODE(dlycal) << 2;
923
924 max_pass_length = 0;
925 max_start = 0;
926 max_end = 0;
927 current_pass_length = 0;
928 current_fail_length = 0;
929 current_start = 0;
930 rdclt_offset = 0;
472d5460
YS
931 window_found = false;
932 fail_found = false;
933 pass_found = false;
d2d43276
SR
934 debug("Starting memory test ");
935
c157d8e2 936 for (k = 0; k < NUMHALFCYCLES; k++) {
d2d43276 937 for (rdclt = 0; rdclt < dly_val; rdclt++) {
c157d8e2
SR
938 /*
939 * Set the timing reg for the test.
940 */
95b602ba 941 mtsdram(SDRAM0_TR1, (tr1 | SDRAM_TR1_RDCT_ENCODE(rdclt)));
c157d8e2 942
d2d43276 943 if (short_mem_test()) {
472d5460
YS
944 if (fail_found == true) {
945 pass_found = true;
c157d8e2
SR
946 if (current_pass_length == 0) {
947 current_start = rdclt_offset + rdclt;
948 }
949
950 current_fail_length = 0;
951 current_pass_length++;
952
953 if (current_pass_length > max_pass_length) {
954 max_pass_length = current_pass_length;
955 max_start = current_start;
956 max_end = rdclt_offset + rdclt;
957 }
958 }
959 } else {
960 current_pass_length = 0;
961 current_fail_length++;
962
963 if (current_fail_length >= (dly_val>>2)) {
472d5460
YS
964 if (fail_found == false) {
965 fail_found = true;
966 } else if (pass_found == true) {
967 window_found = true;
c157d8e2
SR
968 break;
969 }
970 }
8bde7f77 971 }
8bde7f77 972 }
d2d43276
SR
973 debug(".");
974
472d5460 975 if (window_found == true)
8bde7f77 976 break;
c157d8e2
SR
977
978 tr1 = tr1 ^ SDRAM_TR1_RDCD_MASK;
979 rdclt_offset += dly_val;
8bde7f77 980 }
d2d43276 981 debug("\n");
c157d8e2
SR
982
983 /*
984 * make sure we find the window
985 */
472d5460 986 if (window_found == false) {
c157d8e2 987 printf("ERROR: Cannot determine a common read delay.\n");
a5d71e29 988 spd_ddr_init_hang ();
8bde7f77 989 }
fe8c2806 990
c157d8e2
SR
991 /*
992 * restore the orignal ECC setting
993 */
95b602ba 994 mtsdram(SDRAM0_CFG0, (cfg0 & ~SDRAM_CFG0_MCHK_MASK) | ecc_temp);
c157d8e2
SR
995
996 /*
997 * set the SDRAM TR1 RDCD value
998 */
999 tr1 &= ~SDRAM_TR1_RDCD_MASK;
1000 if ((tr0 & SDRAM_TR0_SDCL_MASK) == SDRAM_TR0_SDCL_2_5_CLK) {
1001 tr1 |= SDRAM_TR1_RDCD_RCD_1_2;
1002 } else {
1003 tr1 |= SDRAM_TR1_RDCD_RCD_0_0;
1004 }
fe8c2806 1005
c157d8e2
SR
1006 /*
1007 * set the SDRAM TR1 RDCLT value
1008 */
1009 tr1 &= ~SDRAM_TR1_RDCT_MASK;
1010 while (max_end >= (dly_val << 1)) {
1011 max_end -= (dly_val << 1);
1012 max_start -= (dly_val << 1);
1013 }
1014
1015 rdclt_average = ((max_start + max_end) >> 1);
c157d8e2
SR
1016
1017 if (rdclt_average < 0) {
1018 rdclt_average = 0;
1019 }
1020
1021 if (rdclt_average >= dly_val) {
1022 rdclt_average -= dly_val;
1023 tr1 = tr1 ^ SDRAM_TR1_RDCD_MASK;
1024 }
1025 tr1 |= SDRAM_TR1_RDCT_ENCODE(rdclt_average);
fe8c2806 1026
73dc3075 1027 debug("tr1: %lx\n", tr1);
d2d43276 1028
c157d8e2
SR
1029 /*
1030 * program SDRAM Timing Register 1 TR1
1031 */
95b602ba 1032 mtsdram(SDRAM0_TR1, tr1);
fe8c2806
WD
1033}
1034
d2d43276
SR
1035static unsigned long program_bxcr(unsigned long *dimm_populated,
1036 unsigned char *iic0_dimm_addr,
1037 unsigned long num_dimm_banks)
fe8c2806 1038{
c157d8e2 1039 unsigned long dimm_num;
c157d8e2 1040 unsigned long bank_base_addr;
c157d8e2
SR
1041 unsigned long cr;
1042 unsigned long i;
fd49bf02 1043 unsigned long j;
c157d8e2
SR
1044 unsigned long temp;
1045 unsigned char num_row_addr;
1046 unsigned char num_col_addr;
1047 unsigned char num_banks;
1048 unsigned char bank_size_id;
fd49bf02
SR
1049 unsigned long ctrl_bank_num[MAXBANKS];
1050 unsigned long bx_cr_num;
1051 unsigned long largest_size_index;
f013dacf
WD
1052 unsigned long largest_size;
1053 unsigned long current_size_index;
fd49bf02
SR
1054 BANKPARMS bank_parms[MAXBXCR];
1055 unsigned long sorted_bank_num[MAXBXCR]; /* DDR Controller bank number table (sorted by size) */
1056 unsigned long sorted_bank_size[MAXBXCR]; /* DDR Controller bank size table (sorted by size)*/
c157d8e2
SR
1057
1058 /*
1059 * Set the BxCR regs. First, wipe out the bank config registers.
1060 */
fd49bf02 1061 for (bx_cr_num = 0; bx_cr_num < MAXBXCR; bx_cr_num++) {
95b602ba 1062 mtdcr(SDRAM0_CFGADDR, SDRAM0_B0CR + (bx_cr_num << 2));
d1c3b275 1063 mtdcr(SDRAM0_CFGDATA, 0x00000000);
fd49bf02 1064 bank_parms[bx_cr_num].bank_size_bytes = 0;
c157d8e2 1065 }
fd49bf02
SR
1066
1067#ifdef CONFIG_BAMBOO
1068 /*
1069 * This next section is hardware dependent and must be programmed
d2d43276
SR
1070 * to match the hardware. For bamboo, the following holds...
1071 * 1. SDRAM0_B0CR: Bank 0 of dimm 0 ctrl_bank_num : 0 (soldered onboard)
fd49bf02
SR
1072 * 2. SDRAM0_B1CR: Bank 0 of dimm 1 ctrl_bank_num : 1
1073 * 3. SDRAM0_B2CR: Bank 1 of dimm 1 ctrl_bank_num : 1
1074 * 4. SDRAM0_B3CR: Bank 0 of dimm 2 ctrl_bank_num : 3
1075 * ctrl_bank_num corresponds to the first usable DDR controller bank number by DIMM
1076 */
1077 ctrl_bank_num[0] = 0;
1078 ctrl_bank_num[1] = 1;
1079 ctrl_bank_num[2] = 3;
1080#else
d2d43276
SR
1081 /*
1082 * Ocotea, Ebony and the other IBM/AMCC eval boards have
1083 * 2 DIMM slots with each max 2 banks
1084 */
fd49bf02 1085 ctrl_bank_num[0] = 0;
d2d43276 1086 ctrl_bank_num[1] = 2;
17f50f22 1087#endif
c157d8e2
SR
1088
1089 /*
1090 * reset the bank_base address
1091 */
6d0f6bcf 1092 bank_base_addr = CONFIG_SYS_SDRAM_BASE;
c157d8e2
SR
1093
1094 for (dimm_num = 0; dimm_num < num_dimm_banks; dimm_num++) {
472d5460 1095 if (dimm_populated[dimm_num] == true) {
c157d8e2
SR
1096 num_row_addr = spd_read(iic0_dimm_addr[dimm_num], 3);
1097 num_col_addr = spd_read(iic0_dimm_addr[dimm_num], 4);
1098 num_banks = spd_read(iic0_dimm_addr[dimm_num], 5);
1099 bank_size_id = spd_read(iic0_dimm_addr[dimm_num], 31);
73dc3075 1100 debug("DIMM%ld: row=%d col=%d banks=%d\n", dimm_num,
d2d43276 1101 num_row_addr, num_col_addr, num_banks);
c157d8e2
SR
1102
1103 /*
1104 * Set the SDRAM0_BxCR regs
1105 */
1106 cr = 0;
c157d8e2
SR
1107 switch (bank_size_id) {
1108 case 0x02:
1109 cr |= SDRAM_BXCR_SDSZ_8;
1110 break;
1111 case 0x04:
1112 cr |= SDRAM_BXCR_SDSZ_16;
1113 break;
1114 case 0x08:
1115 cr |= SDRAM_BXCR_SDSZ_32;
1116 break;
1117 case 0x10:
1118 cr |= SDRAM_BXCR_SDSZ_64;
1119 break;
1120 case 0x20:
1121 cr |= SDRAM_BXCR_SDSZ_128;
1122 break;
1123 case 0x40:
1124 cr |= SDRAM_BXCR_SDSZ_256;
1125 break;
1126 case 0x80:
1127 cr |= SDRAM_BXCR_SDSZ_512;
1128 break;
1129 default:
1130 printf("DDR-SDRAM: DIMM %lu BxCR configuration.\n",
1131 dimm_num);
1132 printf("ERROR: Unsupported value for the banksize: %d.\n",
1133 bank_size_id);
1134 printf("Replace the DIMM module with a supported DIMM.\n\n");
a5d71e29 1135 spd_ddr_init_hang ();
c157d8e2
SR
1136 }
1137
1138 switch (num_col_addr) {
1139 case 0x08:
1140 cr |= SDRAM_BXCR_SDAM_1;
1141 break;
1142 case 0x09:
1143 cr |= SDRAM_BXCR_SDAM_2;
1144 break;
1145 case 0x0A:
1146 cr |= SDRAM_BXCR_SDAM_3;
1147 break;
1148 case 0x0B:
1149 cr |= SDRAM_BXCR_SDAM_4;
1150 break;
1151 default:
1152 printf("DDR-SDRAM: DIMM %lu BxCR configuration.\n",
1153 dimm_num);
1154 printf("ERROR: Unsupported value for number of "
1155 "column addresses: %d.\n", num_col_addr);
1156 printf("Replace the DIMM module with a supported DIMM.\n\n");
a5d71e29 1157 spd_ddr_init_hang ();
c157d8e2
SR
1158 }
1159
1160 /*
1161 * enable the bank
1162 */
1163 cr |= SDRAM_BXCR_SDBE;
1164
1636d1c8 1165 for (i = 0; i < num_banks; i++) {
d2d43276
SR
1166 bank_parms[ctrl_bank_num[dimm_num]+i].bank_size_bytes =
1167 (4 << 20) * bank_size_id;
1168 bank_parms[ctrl_bank_num[dimm_num]+i].cr = cr;
73dc3075
MV
1169 debug("DIMM%ld-bank %ld (SDRAM0_B%ldCR): "
1170 "bank_size_bytes=%ld\n",
1171 dimm_num, i,
1172 ctrl_bank_num[dimm_num] + i,
1173 bank_parms[ctrl_bank_num[dimm_num] + i].bank_size_bytes);
1636d1c8 1174 }
8bde7f77 1175 }
8bde7f77 1176 }
fe8c2806 1177
fd49bf02
SR
1178 /* Initialize sort tables */
1179 for (i = 0; i < MAXBXCR; i++) {
1180 sorted_bank_num[i] = i;
1181 sorted_bank_size[i] = bank_parms[i].bank_size_bytes;
1182 }
1183
1184 for (i = 0; i < MAXBXCR-1; i++) {
1185 largest_size = sorted_bank_size[i];
1186 largest_size_index = 255;
1187
1188 /* Find the largest remaining value */
1189 for (j = i + 1; j < MAXBXCR; j++) {
1190 if (sorted_bank_size[j] > largest_size) {
1191 /* Save largest remaining value and its index */
1192 largest_size = sorted_bank_size[j];
1193 largest_size_index = j;
1194 }
1195 }
1196
1197 if (largest_size_index != 255) {
1198 /* Swap the current and largest values */
1199 current_size_index = sorted_bank_num[largest_size_index];
1200 sorted_bank_size[largest_size_index] = sorted_bank_size[i];
1201 sorted_bank_size[i] = largest_size;
1202 sorted_bank_num[largest_size_index] = sorted_bank_num[i];
1203 sorted_bank_num[i] = current_size_index;
1204 }
1205 }
1206
1207 /* Set the SDRAM0_BxCR regs thanks to sort tables */
1208 for (bx_cr_num = 0, bank_base_addr = 0; bx_cr_num < MAXBXCR; bx_cr_num++) {
1209 if (bank_parms[sorted_bank_num[bx_cr_num]].bank_size_bytes) {
95b602ba 1210 mtdcr(SDRAM0_CFGADDR, SDRAM0_B0CR + (sorted_bank_num[bx_cr_num] << 2));
d1c3b275 1211 temp = mfdcr(SDRAM0_CFGDATA) & ~(SDRAM_BXCR_SDBA_MASK | SDRAM_BXCR_SDSZ_MASK |
fd49bf02
SR
1212 SDRAM_BXCR_SDAM_MASK | SDRAM_BXCR_SDBE);
1213 temp = temp | (bank_base_addr & SDRAM_BXCR_SDBA_MASK) |
1214 bank_parms[sorted_bank_num[bx_cr_num]].cr;
d1c3b275 1215 mtdcr(SDRAM0_CFGDATA, temp);
fd49bf02 1216 bank_base_addr += bank_parms[sorted_bank_num[bx_cr_num]].bank_size_bytes;
73dc3075
MV
1217 debug("SDRAM0_B%ldCR=0x%08lx\n",
1218 sorted_bank_num[bx_cr_num], temp);
fd49bf02
SR
1219 }
1220 }
1221
c157d8e2 1222 return(bank_base_addr);
fe8c2806 1223}
fe8c2806 1224#endif /* CONFIG_SPD_EEPROM */