Fix merge problems
[platform/kernel/u-boot.git] / cpu / ppc4xx / 44x_spd_ddr2.c
index 3ac2cdc..1c36324 100644 (file)
@@ -1,8 +1,14 @@
 /*
  * cpu/ppc4xx/44x_spd_ddr2.c
  * This SPD SDRAM detection code supports AMCC PPC44x cpu's with a
- * DDR2 controller (non Denali Core). Those are 440SP/SPe.
+ * DDR2 controller (non Denali Core). Those currently are:
  *
+ * 405:                405EX(r)
+ * 440/460:    440SP/440SPe/460EX/460GT
+ *
+ * Copyright (c) 2008 Nuovation System Designs, LLC
+ *   Grant Erickson <gerickson@nuovations.com>
+
  * (C) Copyright 2007-2008
  * Stefan Roese, DENX Software Engineering, sr@denx.de.
  *
 #include <asm/io.h>
 #include <asm/processor.h>
 #include <asm/mmu.h>
+#include <asm/cache.h>
+
+#include "ecc.h"
+
+#if defined(CONFIG_SDRAM_PPC4xx_IBM_DDR2)
+
+#define PPC4xx_IBM_DDR2_DUMP_REGISTER(mnemonic)                                \
+       do {                                                            \
+               u32 data;                                               \
+               mfsdram(SDRAM_##mnemonic, data);                        \
+               printf("%20s[%02x] = 0x%08X\n",                         \
+                      "SDRAM_" #mnemonic, SDRAM_##mnemonic, data);     \
+       } while (0)
+
+static inline void ppc4xx_ibm_ddr2_register_dump(void);
 
-#if defined(CONFIG_SPD_EEPROM) &&                              \
-       (defined(CONFIG_440SP) || defined(CONFIG_440SPE))
+#if defined(CONFIG_SPD_EEPROM)
 
 /*-----------------------------------------------------------------------------+
  * Defines
 #endif
 
 /*
+ * Newer PPC's like 440SPe, 460EX/GT can be equipped with more than 2GB of SDRAM.
+ * To support such configurations, we "only" map the first 2GB via the TLB's. We
+ * need some free virtual address space for the remaining peripherals like, SoC
+ * devices, FLASH etc.
+ *
+ * Note that ECC is currently not supported on configurations with more than 2GB
+ * SDRAM. This is because we only map the first 2GB on such systems, and therefore
+ * the ECC parity byte of the remaining area can't be written.
+ */
+#ifndef CONFIG_MAX_MEM_MAPPED
+#define CONFIG_MAX_MEM_MAPPED  ((phys_size_t)2 << 30)
+#endif
+
+/*
  * Board-specific Platform code can reimplement spd_ddr_init_hang () if needed
  */
 void __spd_ddr_init_hang (void)
@@ -171,7 +205,7 @@ typedef enum ddr_cas_id {
 /*-----------------------------------------------------------------------------+
  * Prototypes
  *-----------------------------------------------------------------------------*/
-static unsigned long sdram_memsize(void);
+static phys_size_t sdram_memsize(void);
 static void get_spd_info(unsigned long *dimm_populated,
                         unsigned char *iic0_dimm_addr,
                         unsigned long num_dimm_banks);
@@ -233,10 +267,8 @@ static void        test(void);
 #else
 static void    DQS_calibration_process(void);
 #endif
-static void ppc440sp_sdram_register_dump(void);
 int do_reset (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]);
 void dcbz_area(u32 start_address, u32 num_bytes);
-void dflush(void);
 
 static u32 mfdcr_any(u32 dcr)
 {
@@ -297,9 +329,9 @@ static unsigned char spd_read(uchar chip, uint addr)
 /*-----------------------------------------------------------------------------+
  * sdram_memsize
  *-----------------------------------------------------------------------------*/
-static unsigned long sdram_memsize(void)
+static phys_size_t sdram_memsize(void)
 {
-       unsigned long mem_size;
+       phys_size_t mem_size;
        unsigned long mcopt2;
        unsigned long mcstat;
        unsigned long mb0cf;
@@ -355,6 +387,8 @@ static unsigned long sdram_memsize(void)
                                        mem_size+=4096;
                                        break;
                                default:
+                                       printf("WARNING: Unsupported bank size (SDSZ=0x%lx)!\n"
+                                              , sdsz);
                                        mem_size=0;
                                        break;
                                }
@@ -362,8 +396,7 @@ static unsigned long sdram_memsize(void)
                }
        }
 
-       mem_size *= 1024 * 1024;
-       return(mem_size);
+       return mem_size << 20;
 }
 
 /*-----------------------------------------------------------------------------+
@@ -380,18 +413,18 @@ static unsigned long sdram_memsize(void)
  *              banks appropriately. If Auto Memory Configuration is
  *              not used, it is assumed that no DIMM is plugged
  *-----------------------------------------------------------------------------*/
-long int initdram(int board_type)
+phys_size_t initdram(int board_type)
 {
        unsigned char iic0_dimm_addr[] = SPD_EEPROM_ADDRESS;
        unsigned char spd0[MAX_SPD_BYTES];
        unsigned char spd1[MAX_SPD_BYTES];
        unsigned char *dimm_spd[MAXDIMMS];
        unsigned long dimm_populated[MAXDIMMS];
-       unsigned long num_dimm_banks;               /* on board dimm banks */
+       unsigned long num_dimm_banks;           /* on board dimm banks */
        unsigned long val;
-       ddr_cas_id_t  selected_cas;
+       ddr_cas_id_t selected_cas = DDR_CAS_5;  /* preset to silence compiler */
        int write_recovery;
-       unsigned long dram_size = 0;
+       phys_size_t dram_size = 0;
 
        num_dimm_banks = sizeof(iic0_dimm_addr);
 
@@ -549,6 +582,12 @@ long int initdram(int board_type)
        /* get installed memory size */
        dram_size = sdram_memsize();
 
+       /*
+        * Limit size to 2GB
+        */
+       if (dram_size > CONFIG_MAX_MEM_MAPPED)
+               dram_size = CONFIG_MAX_MEM_MAPPED;
+
        /* and program tlb entries for this size (dynamic) */
 
        /*
@@ -577,9 +616,16 @@ long int initdram(int board_type)
        remove_tlb(0, dram_size);
        program_tlb(0, 0, dram_size, MY_TLB_WORD2_I_ENABLE);
 
-       ppc440sp_sdram_register_dump();
+       ppc4xx_ibm_ddr2_register_dump();
+
+       /*
+        * Clear potential errors resulting from auto-calibration.
+        * If not done, then we could get an interrupt later on when
+        * exceptions are enabled.
+        */
+       set_mcsr(get_mcsr());
 
-       return dram_size;
+       return sdram_memsize();
 }
 
 static void get_spd_info(unsigned long *dimm_populated,
@@ -823,8 +869,8 @@ static void check_rank_number(unsigned long *dimm_populated,
 
 
                        if (dimm_rank > MAXRANKS) {
-                               printf("ERROR: DRAM DIMM detected with %d ranks in "
-                                      "slot %d is not supported.\n", dimm_rank, dimm_num);
+                               printf("ERROR: DRAM DIMM detected with %lu ranks in "
+                                      "slot %lu is not supported.\n", dimm_rank, dimm_num);
                                printf("Only %d ranks are supported for all DIMM.\n", MAXRANKS);
                                printf("Replace the DIMM module with a supported DIMM.\n\n");
                                spd_ddr_init_hang ();
@@ -1025,7 +1071,7 @@ static void program_copt1(unsigned long *dimm_populated,
                                dimm_32bit = TRUE;
                                break;
                        default:
-                               printf("WARNING: Detected a DIMM with a data width of %d bits.\n",
+                               printf("WARNING: Detected a DIMM with a data width of %lu bits.\n",
                                       data_width);
                                printf("Only DIMMs with 32 or 64 bit DDR-SDRAM widths are supported.\n");
                                break;
@@ -1113,50 +1159,50 @@ static void program_codt(unsigned long *dimm_populated,
        if (dimm_type == SDRAM_DDR2) {
                codt |= SDRAM_CODT_DQS_1_8_V_DDR2;
                if ((total_dimm == 1) && (firstSlot == TRUE)) {
-                       if (total_rank == 1) {
+                       if (total_rank == 1) {  /* PUUU */
                                codt |= CALC_ODT_R(0);
                                modt0 = CALC_ODT_W(0);
                                modt1 = 0x00000000;
                                modt2 = 0x00000000;
                                modt3 = 0x00000000;
                        }
-                       if (total_rank == 2) {
+                       if (total_rank == 2) {  /* PPUU */
                                codt |= CALC_ODT_R(0) | CALC_ODT_R(1);
-                               modt0 = CALC_ODT_W(0);
-                               modt1 = CALC_ODT_W(0);
+                               modt0 = CALC_ODT_W(0) | CALC_ODT_W(1);
+                               modt1 = 0x00000000;
                                modt2 = 0x00000000;
                                modt3 = 0x00000000;
                        }
                } else if ((total_dimm == 1) && (firstSlot != TRUE)) {
-                       if (total_rank == 1) {
+                       if (total_rank == 1) {  /* UUPU */
                                codt |= CALC_ODT_R(2);
                                modt0 = 0x00000000;
                                modt1 = 0x00000000;
                                modt2 = CALC_ODT_W(2);
                                modt3 = 0x00000000;
                        }
-                       if (total_rank == 2) {
+                       if (total_rank == 2) {  /* UUPP */
                                codt |= CALC_ODT_R(2) | CALC_ODT_R(3);
                                modt0 = 0x00000000;
                                modt1 = 0x00000000;
-                               modt2 = CALC_ODT_W(2);
-                               modt3 = CALC_ODT_W(2);
+                               modt2 = CALC_ODT_W(2) | CALC_ODT_W(3);
+                               modt3 = 0x00000000;
                        }
                }
                if (total_dimm == 2) {
-                       if (total_rank == 2) {
+                       if (total_rank == 2) {  /* PUPU */
                                codt |= CALC_ODT_R(0) | CALC_ODT_R(2);
                                modt0 = CALC_ODT_RW(2);
                                modt1 = 0x00000000;
                                modt2 = CALC_ODT_RW(0);
                                modt3 = 0x00000000;
                        }
-                       if (total_rank == 4) {
+                       if (total_rank == 4) {  /* PPPP */
                                codt |= CALC_ODT_R(0) | CALC_ODT_R(1) |
                                        CALC_ODT_R(2) | CALC_ODT_R(3);
-                               modt0 = CALC_ODT_RW(2);
+                               modt0 = CALC_ODT_RW(2) | CALC_ODT_RW(3);
                                modt1 = 0x00000000;
-                               modt2 = CALC_ODT_RW(0);
+                               modt2 = CALC_ODT_RW(0) | CALC_ODT_RW(1);
                                modt3 = 0x00000000;
                        }
                }
@@ -1578,7 +1624,7 @@ static void program_mode(unsigned long *dimm_populated,
                        printf("Make sure the PLB speed is within the supported range of the DIMMs.\n");
                        printf("cas3=%d cas4=%d cas5=%d\n",
                               cas_3_0_available, cas_4_0_available, cas_5_0_available);
-                       printf("sdram_freq=%d cycle3=%d cycle4=%d cycle5=%d\n\n",
+                       printf("sdram_freq=%lu cycle3=%lu cycle4=%lu cycle5=%lu\n\n",
                               sdram_freq, cycle_3_0_clk, cycle_4_0_clk, cycle_5_0_clk);
                        spd_ddr_init_hang ();
                }
@@ -2070,7 +2116,7 @@ static void program_bxcf(unsigned long *dimm_populated,
                                if (num_banks == 4)
                                        ind = 0;
                                else
-                                       ind = 5;
+                                       ind = 5 << 8;
                                switch (num_col_addr) {
                                case 0x08:
                                        mode |= (SDRAM_BXCF_M_AM_0 + ind);
@@ -2117,14 +2163,15 @@ static void program_memory_queue(unsigned long *dimm_populated,
                                 unsigned long num_dimm_banks)
 {
        unsigned long dimm_num;
-       unsigned long rank_base_addr;
+       phys_size_t rank_base_addr;
        unsigned long rank_reg;
-       unsigned long rank_size_bytes;
+       phys_size_t rank_size_bytes;
        unsigned long rank_size_id;
        unsigned long num_ranks;
        unsigned long baseadd_size;
        unsigned long i;
        unsigned long bank_0_populated = 0;
+       phys_size_t total_size = 0;
 
        /*------------------------------------------------------------------
         * Reset the rank_base_address.
@@ -2147,28 +2194,38 @@ static void program_memory_queue(unsigned long *dimm_populated,
                         * Set the sizes
                         *-----------------------------------------------------------------*/
                        baseadd_size = 0;
-                       rank_size_bytes = 4 * 1024 * 1024 * rank_size_id;
                        switch (rank_size_id) {
+                       case 0x01:
+                               baseadd_size |= SDRAM_RXBAS_SDSZ_1024;
+                               total_size = 1024;
+                               break;
                        case 0x02:
-                               baseadd_size |= SDRAM_RXBAS_SDSZ_8;
+                               baseadd_size |= SDRAM_RXBAS_SDSZ_2048;
+                               total_size = 2048;
                                break;
                        case 0x04:
-                               baseadd_size |= SDRAM_RXBAS_SDSZ_16;
+                               baseadd_size |= SDRAM_RXBAS_SDSZ_4096;
+                               total_size = 4096;
                                break;
                        case 0x08:
                                baseadd_size |= SDRAM_RXBAS_SDSZ_32;
+                               total_size = 32;
                                break;
                        case 0x10:
                                baseadd_size |= SDRAM_RXBAS_SDSZ_64;
+                               total_size = 64;
                                break;
                        case 0x20:
                                baseadd_size |= SDRAM_RXBAS_SDSZ_128;
+                               total_size = 128;
                                break;
                        case 0x40:
                                baseadd_size |= SDRAM_RXBAS_SDSZ_256;
+                               total_size = 256;
                                break;
                        case 0x80:
                                baseadd_size |= SDRAM_RXBAS_SDSZ_512;
+                               total_size = 512;
                                break;
                        default:
                                printf("DDR-SDRAM: DIMM %d memory queue configuration.\n",
@@ -2178,6 +2235,7 @@ static void program_memory_queue(unsigned long *dimm_populated,
                                printf("Replace the DIMM module with a supported DIMM.\n\n");
                                spd_ddr_init_hang ();
                        }
+                       rank_size_bytes = total_size << 20;
 
                        if ((dimm_populated[dimm_num] != SDRAM_NONE) && (dimm_num == 1))
                                bank_0_populated = 1;
@@ -2190,6 +2248,19 @@ static void program_memory_queue(unsigned long *dimm_populated,
                        }
                }
        }
+
+#if defined(CONFIG_460EX) || defined(CONFIG_460GT)
+       /*
+        * Enable high bandwidth access on 460EX/GT.
+        * This should/could probably be done on other
+        * PPC's too, like 440SPe.
+        * This is currently not used, but with this setup
+        * it is possible to use it later on in e.g. the Linux
+        * EMAC driver for performance gain.
+        */
+       mtdcr(SDRAM_PLBADDULL, 0x00000000); /* MQ0_BAUL */
+       mtdcr(SDRAM_PLBADDUHB, 0x00000008); /* MQ0_BAUH */
+#endif
 }
 
 /*-----------------------------------------------------------------------------+
@@ -2248,6 +2319,11 @@ static void program_ecc(unsigned long *dimm_populated,
        if (ecc == 0)
                return;
 
+       if (sdram_memsize() > CONFIG_MAX_MEM_MAPPED) {
+               printf("\nWarning: Can't enable ECC on systems with more than 2GB of SDRAM!\n");
+               return;
+       }
+
        mfsdram(SDRAM_MCOPT1, mcopt1);
        mfsdram(SDRAM_MCOPT2, mcopt2);
 
@@ -2322,7 +2398,8 @@ static void program_ecc_addr(unsigned long start_address,
                } else {
                        /* ECC bit set method for cached memory */
                        dcbz_area(start_address, num_bytes);
-                       dflush();
+                       /* Write modified dcache lines back to memory */
+                       clean_dcache_range(start_address, start_address + num_bytes);
                }
 
                blank_string(strlen(str));
@@ -2399,6 +2476,7 @@ static int short_mem_test(void)
        u32 bxcf;
        int i;
        int j;
+       phys_size_t base_addr;
        u32 test[NUMMEMTESTS][NUMMEMWORDS] = {
                {0x00000000, 0x00000000, 0xFFFFFFFF, 0xFFFFFFFF,
                 0x00000000, 0x00000000, 0xFFFFFFFF, 0xFFFFFFFF},
@@ -2425,10 +2503,17 @@ static int short_mem_test(void)
                if ((bxcf & SDRAM_BXCF_M_BE_MASK) == SDRAM_BXCF_M_BE_ENABLE) {
                        /* Bank is enabled */
 
+                       /*
+                        * Only run test on accessable memory (below 2GB)
+                        */
+                       base_addr = SDRAM_RXBAS_SDBA_DECODE(mfdcr_any(SDRAM_R0BAS+bxcr_num));
+                       if (base_addr >= CONFIG_MAX_MEM_MAPPED)
+                               continue;
+
                        /*------------------------------------------------------------------
                         * Run the short memory test.
                         *-----------------------------------------------------------------*/
-                       membase = (u32 *)(SDRAM_RXBAS_SDBA_DECODE(mfdcr_any(SDRAM_R0BAS+bxcr_num)));
+                       membase = (u32 *)(u32)base_addr;
 
                        for (i = 0; i < NUMMEMTESTS; i++) {
                                for (j = 0; j < NUMMEMWORDS; j++) {
@@ -2684,7 +2769,7 @@ calibration_loop:
                printf("\nERROR: Cannot determine a common read delay for the "
                       "DIMM(s) installed.\n");
                debug("%s[%d] ERROR : \n", __FUNCTION__,__LINE__);
-               ppc440sp_sdram_register_dump();
+               ppc4xx_ibm_ddr2_register_dump();
                spd_ddr_init_hang ();
        }
 
@@ -2870,166 +2955,211 @@ static void test(void)
 }
 #endif
 
-#if defined(DEBUG)
-static void ppc440sp_sdram_register_dump(void)
+#else /* CONFIG_SPD_EEPROM */
+
+/*-----------------------------------------------------------------------------
+ * Function:   initdram
+ * Description: Configures the PPC405EX(r) DDR1/DDR2 SDRAM memory
+ *             banks. The configuration is performed using static, compile-
+ *             time parameters.
+ *---------------------------------------------------------------------------*/
+phys_size_t initdram(int board_type)
 {
-       unsigned int sdram_reg;
-       unsigned int sdram_data;
-       unsigned int dcr_data;
-
-       printf("\n  Register Dump:\n");
-       sdram_reg = SDRAM_MCSTAT;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MCSTAT    = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_MCOPT1;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MCOPT1    = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_MCOPT2;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MCOPT2    = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_MODT0;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MODT0     = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_MODT1;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MODT1     = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_MODT2;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MODT2     = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_MODT3;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MODT3     = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_CODT;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_CODT      = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_VVPR;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_VVPR      = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_OPARS;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_OPARS     = 0x%08X\n", sdram_data);
        /*
-        * OPAR2 is only used as a trigger register.
-        * No data is contained in this register, and reading or writing
-        * to is can cause bad things to happen (hangs).  Just skip it
-        * and report NA
-        * sdram_reg = SDRAM_OPAR2;
-        * mfsdram(sdram_reg, sdram_data);
-        * printf("        SDRAM_OPAR2     = 0x%08X\n", sdram_data);
+        * Only run this SDRAM init code once. For NAND booting
+        * targets like Kilauea, we call initdram() early from the
+        * 4k NAND booting image (CONFIG_NAND_SPL) from nand_boot().
+        * Later on the NAND U-Boot image runs (CONFIG_NAND_U_BOOT)
+        * which calls initdram() again. This time the controller
+        * mustn't be reconfigured again since we're already running
+        * from SDRAM.
         */
-       printf("        SDRAM_OPART     = N/A       ");
-       sdram_reg = SDRAM_RTR;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_RTR       = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_MB0CF;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MB0CF     = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_MB1CF;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MB1CF     = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_MB2CF;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MB2CF     = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_MB3CF;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MB3CF     = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR0;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR0  = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR1;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR1  = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR2;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR2  = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR3;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR3  = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR4;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR4  = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR5;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR5  = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR6;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR6  = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR7;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR7  = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR8;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR8  = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR9;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR9  = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR10;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR10 = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR11;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR11 = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR12;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR12 = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR13;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR13 = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_INITPLR14;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR14 = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_INITPLR15;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_INITPLR15 = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_RQDC;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_RQDC      = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_RFDC;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_RFDC      = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_RDCC;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_RDCC      = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_DLCR;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_DLCR      = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_CLKTR;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_CLKTR     = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_WRDTR;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_WRDTR     = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_SDTR1;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_SDTR1     = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_SDTR2;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_SDTR2     = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_SDTR3;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_SDTR3     = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_MMODE;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MMODE     = 0x%08X\n", sdram_data);
-       sdram_reg = SDRAM_MEMODE;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_MEMODE    = 0x%08X", sdram_data);
-       sdram_reg = SDRAM_ECCCR;
-       mfsdram(sdram_reg, sdram_data);
-       printf("        SDRAM_ECCCR     = 0x%08X\n\n", sdram_data);
-
-       dcr_data = mfdcr(SDRAM_R0BAS);
-       printf("        MQ0_B0BAS       = 0x%08X", dcr_data);
-       dcr_data = mfdcr(SDRAM_R1BAS);
-       printf("        MQ1_B0BAS       = 0x%08X\n", dcr_data);
-       dcr_data = mfdcr(SDRAM_R2BAS);
-       printf("        MQ2_B0BAS       = 0x%08X", dcr_data);
-       dcr_data = mfdcr(SDRAM_R3BAS);
-       printf("        MQ3_B0BAS       = 0x%08X\n", dcr_data);
+#if !defined(CONFIG_NAND_U_BOOT) || defined(CONFIG_NAND_SPL)
+       unsigned long val;
+
+       /* Set Memory Bank Configuration Registers */
+
+       mtsdram(SDRAM_MB0CF, CFG_SDRAM0_MB0CF);
+       mtsdram(SDRAM_MB1CF, CFG_SDRAM0_MB1CF);
+       mtsdram(SDRAM_MB2CF, CFG_SDRAM0_MB2CF);
+       mtsdram(SDRAM_MB3CF, CFG_SDRAM0_MB3CF);
+
+       /* Set Memory Clock Timing Register */
+
+       mtsdram(SDRAM_CLKTR, CFG_SDRAM0_CLKTR);
+
+       /* Set Refresh Time Register */
+
+       mtsdram(SDRAM_RTR, CFG_SDRAM0_RTR);
+
+       /* Set SDRAM Timing Registers */
+
+       mtsdram(SDRAM_SDTR1, CFG_SDRAM0_SDTR1);
+       mtsdram(SDRAM_SDTR2, CFG_SDRAM0_SDTR2);
+       mtsdram(SDRAM_SDTR3, CFG_SDRAM0_SDTR3);
+
+       /* Set Mode and Extended Mode Registers */
+
+       mtsdram(SDRAM_MMODE, CFG_SDRAM0_MMODE);
+       mtsdram(SDRAM_MEMODE, CFG_SDRAM0_MEMODE);
+
+       /* Set Memory Controller Options 1 Register */
+
+       mtsdram(SDRAM_MCOPT1, CFG_SDRAM0_MCOPT1);
+
+       /* Set Manual Initialization Control Registers */
+
+       mtsdram(SDRAM_INITPLR0, CFG_SDRAM0_INITPLR0);
+       mtsdram(SDRAM_INITPLR1, CFG_SDRAM0_INITPLR1);
+       mtsdram(SDRAM_INITPLR2, CFG_SDRAM0_INITPLR2);
+       mtsdram(SDRAM_INITPLR3, CFG_SDRAM0_INITPLR3);
+       mtsdram(SDRAM_INITPLR4, CFG_SDRAM0_INITPLR4);
+       mtsdram(SDRAM_INITPLR5, CFG_SDRAM0_INITPLR5);
+       mtsdram(SDRAM_INITPLR6, CFG_SDRAM0_INITPLR6);
+       mtsdram(SDRAM_INITPLR7, CFG_SDRAM0_INITPLR7);
+       mtsdram(SDRAM_INITPLR8, CFG_SDRAM0_INITPLR8);
+       mtsdram(SDRAM_INITPLR9, CFG_SDRAM0_INITPLR9);
+       mtsdram(SDRAM_INITPLR10, CFG_SDRAM0_INITPLR10);
+       mtsdram(SDRAM_INITPLR11, CFG_SDRAM0_INITPLR11);
+       mtsdram(SDRAM_INITPLR12, CFG_SDRAM0_INITPLR12);
+       mtsdram(SDRAM_INITPLR13, CFG_SDRAM0_INITPLR13);
+       mtsdram(SDRAM_INITPLR14, CFG_SDRAM0_INITPLR14);
+       mtsdram(SDRAM_INITPLR15, CFG_SDRAM0_INITPLR15);
+
+       /* Set On-Die Termination Registers */
+
+       mtsdram(SDRAM_CODT, CFG_SDRAM0_CODT);
+       mtsdram(SDRAM_MODT0, CFG_SDRAM0_MODT0);
+       mtsdram(SDRAM_MODT1, CFG_SDRAM0_MODT1);
+
+       /* Set Write Timing Register */
+
+       mtsdram(SDRAM_WRDTR, CFG_SDRAM0_WRDTR);
+
+       /*
+        * Start Initialization by SDRAM0_MCOPT2[SREN] = 0 and
+        * SDRAM0_MCOPT2[IPTR] = 1
+        */
+
+       mtsdram(SDRAM_MCOPT2, (SDRAM_MCOPT2_SREN_EXIT |
+                              SDRAM_MCOPT2_IPTR_EXECUTE));
+
+       /*
+        * Poll SDRAM0_MCSTAT[MIC] for assertion to indicate the
+        * completion of initialization.
+        */
+
+       do {
+               mfsdram(SDRAM_MCSTAT, val);
+       } while ((val & SDRAM_MCSTAT_MIC_MASK) != SDRAM_MCSTAT_MIC_COMP);
+
+       /* Set Delay Control Registers */
+
+       mtsdram(SDRAM_DLCR, CFG_SDRAM0_DLCR);
+       mtsdram(SDRAM_RDCC, CFG_SDRAM0_RDCC);
+       mtsdram(SDRAM_RQDC, CFG_SDRAM0_RQDC);
+       mtsdram(SDRAM_RFDC, CFG_SDRAM0_RFDC);
+
+       /*
+        * Enable Controller by SDRAM0_MCOPT2[DCEN] = 1:
+        */
+
+       mfsdram(SDRAM_MCOPT2, val);
+       mtsdram(SDRAM_MCOPT2, val | SDRAM_MCOPT2_DCEN_ENABLE);
+
+#if defined(CONFIG_DDR_ECC)
+       ecc_init(CFG_SDRAM_BASE, CFG_MBYTES_SDRAM << 20);
+#endif /* defined(CONFIG_DDR_ECC) */
+
+       ppc4xx_ibm_ddr2_register_dump();
+#endif /* !defined(CONFIG_NAND_U_BOOT) || defined(CONFIG_NAND_SPL) */
+
+       return (CFG_MBYTES_SDRAM << 20);
 }
-#else
-static void ppc440sp_sdram_register_dump(void)
+#endif /* CONFIG_SPD_EEPROM */
+
+static inline void ppc4xx_ibm_ddr2_register_dump(void)
 {
+#if defined(DEBUG)
+       printf("\nPPC4xx IBM DDR2 Register Dump:\n");
+
+#if (defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
+     defined(CONFIG_460EX) || defined(CONFIG_460GT))
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(R0BAS);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(R1BAS);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(R2BAS);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(R3BAS);
+#endif /* (defined(CONFIG_440SP) || ... */
+#if defined(CONFIG_405EX)
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(BESR);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(BEARL);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(BEARH);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(WMIRQ);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(PLBOPT);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(PUABA);
+#endif /* defined(CONFIG_405EX) */
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MB0CF);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MB1CF);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MB2CF);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MB3CF);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MCSTAT);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MCOPT1);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MCOPT2);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MODT0);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MODT1);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MODT2);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MODT3);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(CODT);
+#if (defined(CONFIG_440SP) || defined(CONFIG_440SPE) ||        \
+     defined(CONFIG_460EX) || defined(CONFIG_460GT))
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(VVPR);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(OPARS);
+       /*
+        * OPART is only used as a trigger register.
+        *
+        * No data is contained in this register, and reading or writing
+        * to is can cause bad things to happen (hangs). Just skip it and
+        * report "N/A".
+        */
+       printf("%20s = N/A\n", "SDRAM_OPART");
+#endif /* defined(CONFIG_440SP) || ... */
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(RTR);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR0);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR1);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR2);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR3);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR4);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR5);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR6);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR7);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR8);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR9);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR10);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR11);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR12);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR13);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR14);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(INITPLR15);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(RQDC);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(RFDC);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(RDCC);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(DLCR);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(CLKTR);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(WRDTR);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(SDTR1);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(SDTR2);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(SDTR3);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MMODE);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(MEMODE);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(ECCCR);
+#if (defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \
+     defined(CONFIG_460EX) || defined(CONFIG_460GT))
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(CID);
+#endif /* defined(CONFIG_440SP) || ... */
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(RID);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(FCSR);
+       PPC4xx_IBM_DDR2_DUMP_REGISTER(RTSR);
+#endif /* defined(DEBUG) */
 }
-#endif
-#endif /* CONFIG_SPD_EEPROM */
+
+#endif /* CONFIG_SDRAM_PPC4xx_IBM_DDR2 */