powerpc/p2041rdb: add more ddr frequencies support

[u-boot] / board / rmu / rmu.c

diff --git a/board/rmu/rmu.c b/board/rmu/rmu.c
index c9925d09a36e049bfe69d7e1674462cbf6578144..cd02b9c6e0f8568e0ca9af192cb6a46befc8aa37 100644 (file)
--- a/board/rmu/rmu.c
+++ b/board/rmu/rmu.c
@@ -69,7 +69,7 @@ const uint sdram_table[] =
         */
        0x0FF0CC24, 0xFFFFCC24, _NOT_USED_, _NOT_USED_,
        _NOT_USED_, _NOT_USED_, 0xEFFB8C34, 0x0FF74C34,
-       0x0FFACCB4, 0x0FF5CC34, 0x0FFCC34, 0x0FFFCCB4,
+       0x0FFACCB4, 0x0FF5CC34, 0x0FFFCC34, 0x0FFFCCB4,
 
        /*
         * Exception. (Offset 3Ch in UPMA RAM)
@@ -92,43 +92,52 @@ int checkboard (void)
 
 /* ------------------------------------------------------------------------- */
 
-long int initdram (int board_type)
+phys_size_t initdram (int board_type)
 {
-    volatile immap_t     *immap  = (immap_t *)CFG_IMMR;
-    volatile memctl8xx_t *memctl = &immap->im_memctl;
-    long int size10 ;
+       volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
+       volatile memctl8xx_t *memctl = &immap->im_memctl;
+       long int size9;
 
-    upmconfig(UPMA, (uint *)sdram_table, sizeof(sdram_table)/sizeof(uint));
+       upmconfig (UPMA, (uint *) sdram_table,
+                  sizeof (sdram_table) / sizeof (uint));
 
        /* Refresh clock prescalar */
-    memctl->memc_mptpr = CFG_MPTPR ;
+       memctl->memc_mptpr = CONFIG_SYS_MPTPR;
 
-    memctl->memc_mar  = 0x00000088;
+       memctl->memc_mar = 0x00000088;
 
        /* Map controller banks 1 to the SDRAM bank */
-    memctl->memc_or1 = CFG_OR1_PRELIM;
-    memctl->memc_br1 = CFG_BR1_PRELIM;
+       memctl->memc_or1 = CONFIG_SYS_OR1_PRELIM;
+       memctl->memc_br1 = CONFIG_SYS_BR1_PRELIM;
 
-    memctl->memc_mamr = CFG_MAMR_10COL & (~(MAMR_PTAE)); /* no refresh yet */
+       memctl->memc_mamr = CONFIG_SYS_MAMR_9COL & (~(MAMR_PTAE));      /* no refresh yet */
 
-    udelay(200);
+       udelay (200);
 
-    /* perform SDRAM initializsation sequence */
+       /* perform SDRAM initializsation sequence */
 
-       memctl->memc_mcr  = 0x80002136 ; /* SDRAM bank 0 */
-    udelay(1);
+       memctl->memc_mcr = 0x80002136;  /* SDRAM bank 0 */
+       udelay (1);
 
-    memctl->memc_mamr |= MAMR_PTAE;    /* enable refresh */
+       memctl->memc_mamr |= MAMR_PTAE; /* enable refresh */
 
-    udelay (1000);
+       udelay (1000);
 
-       /* Check Bank 0 Memory Size
-        * try 10 column mode
+       /* Check Bank 0 Memory Size,
+        * 9 column mode
         */
 
-       size10 = dram_size (CFG_MAMR_10COL, (ulong *)SDRAM_BASE_PRELIM, SDRAM_MAX_SIZE) ;
+       size9 = dram_size (CONFIG_SYS_MAMR_9COL, (long *) SDRAM_BASE_PRELIM,
+                          SDRAM_MAX_SIZE);
 
-    return (size10);
+       /*
+        * Final mapping:
+        */
+
+       memctl->memc_or1 = ((-size9) & 0xFFFF0000) | CONFIG_SYS_OR_TIMING_SDRAM;
+       udelay (1000);
+
+       return (size9);
 }
 
 /* ------------------------------------------------------------------------- */
@@ -141,44 +150,13 @@ long int initdram (int board_type)
  * - short between data lines
  */
 
-static long int dram_size (long int mamr_value, long int *base, long int maxsize)
+static long int dram_size (long int mamr_value, long int *base,
+                          long int maxsize)
 {
-    volatile immap_t     *immap  = (immap_t *)CFG_IMMR;
-    volatile memctl8xx_t *memctl = &immap->im_memctl;
-    volatile long int   *addr;
-    ulong                cnt, val;
-    ulong                save[32];     /* to make test non-destructive */
-    unsigned char        i = 0;
-
-    memctl->memc_mamr = mamr_value;
-
-    for (cnt = maxsize/sizeof(long); cnt > 0; cnt >>= 1) {
-       addr = base + cnt;      /* pointer arith! */
-
-       save[i++] = *addr;
-       *addr = ~cnt;
-    }
-
-    /* write 0 to base address */
-    addr = base;
-    save[i] = *addr;
-    *addr = 0;
-
-    /* check at base address */
-    if ((val = *addr) != 0) {
-       *addr = save[i];
-       return (0);
-    }
-
-    for (cnt = 1; cnt <= maxsize/sizeof(long); cnt <<= 1) {
-       addr = base + cnt;      /* pointer arith! */
-
-       val = *addr;
-       *addr = save[--i];
-
-       if (val != (~cnt)) {
-           return (cnt * sizeof(long));
-       }
-    }
-    return (maxsize);
+       volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
+       volatile memctl8xx_t *memctl = &immap->im_memctl;
+
+       memctl->memc_mamr = mamr_value;
+
+       return (get_ram_size(base, maxsize));
 }