diff --git a/cpu/ppc4xx/sdram.c b/cpu/ppc4xx/sdram.c
index d64bf96..a77448e 100644
--- a/cpu/ppc4xx/sdram.c
+++ b/cpu/ppc4xx/sdram.c
@@ -35,13 +35,17 @@
 #define MAGIC2 0x22222222
 #define MAGIC3 0x33333333
 #define MAGIC4 0x44444444
+#define MAGIC5 0x55555555
+#define MAGIC6 0x66666666
 
 #define ADDR_ZERO 0x00000000
 #define ADDR_400  0x00000400
+#define ADDR_01MB 0x00100000
 #define ADDR_08MB 0x00800000
 #define ADDR_16MB 0x01000000
 #define ADDR_32MB 0x02000000
 #define ADDR_64MB 0x04000000
+#define ADDR_128MB 0x08000000
 
 #define mtsdram0(reg, data)  mtdcr(memcfga,reg);mtdcr(memcfgd,data)
 
@@ -77,6 +81,59 @@ void sdram_init(void)
 	}
 
 	/*
+	 * Set MB0CF for bank 0. (0-128MB) Address Mode 3 since 13x10(4)
+	 */
+	mtsdram0(mem_mb0cf, 0x000A4001);
+
+	mtsdram0(mem_sdtr1, sdtr1);
+	mtsdram0(mem_rtr, rtr);
+
+	/*
+	 * Wait for 200us
+	 */
+	udelay(200);
+
+	/*
+	 * Set memory controller options reg, MCOPT1.
+	 * Set DC_EN to '1' and BRD_PRF to '01' for 16 byte PLB Burst
+	 * read/prefetch.
+	 */
+	mtsdram0(mem_mcopt1, 0x80800000);
+
+	/*
+	 * Wait for 10ms
+	 */
+	udelay(10000);
+
+	/*
+	 * Test if 128 MByte are equipped (mirror test)
+	 */
+	*(volatile ulong *)ADDR_ZERO = MAGIC0;
+	*(volatile ulong *)ADDR_08MB = MAGIC1;
+	*(volatile ulong *)ADDR_16MB = MAGIC2;
+	*(volatile ulong *)ADDR_32MB = MAGIC3;
+	*(volatile ulong *)ADDR_64MB = MAGIC4;
+
+	if ((*(volatile ulong *)ADDR_ZERO == MAGIC0) &&
+	    (*(volatile ulong *)ADDR_08MB == MAGIC1) &&
+	    (*(volatile ulong *)ADDR_16MB == MAGIC2) &&
+	    (*(volatile ulong *)ADDR_32MB == MAGIC3)) {
+		/*
+		 * OK, 128MB detected -> all done
+		 */
+		return;
+	}
+	
+	/*
+	 * Now test for 64 MByte...
+	 */
+		
+        /*
+	 * Disable memory controller.
+	 */
+	mtsdram0(mem_mcopt1, 0x00000000);
+
+	/*
 	 * Set MB0CF for bank 0. (0-64MB) Address Mode 3 since 13x9(4)
 	 */
 	mtsdram0(mem_mb0cf, 0x00084001);
@@ -117,11 +174,11 @@ void sdram_init(void)
 		 */
 		return;
 	}
-
+	
 	/*
 	 * Now test for 32 MByte...
 	 */
-
+		
         /*
 	 * Disable memory controller.
 	 */
@@ -162,9 +219,8 @@ void sdram_init(void)
 	}
 
 	/*
-	 * Setup for 16 MByte...
+	 * Now test for 16 MByte...
 	 */
-
         /*
 	 * Disable memory controller.
 	 */
@@ -186,6 +242,51 @@ void sdram_init(void)
 	 * Wait for 10ms
 	 */
 	udelay(10000);
+
+	/*
+	 * Test if 16 MByte are equipped (mirror test)
+	 */
+	*(volatile ulong *)ADDR_ZERO = MAGIC0;
+	*(volatile ulong *)ADDR_400  = MAGIC1;
+	*(volatile ulong *)ADDR_01MB = MAGIC5;
+	*(volatile ulong *)ADDR_08MB = MAGIC2;
+/*	*(volatile ulong *)ADDR_16MB = MAGIC3;*/
+
+	if ((*(volatile ulong *)ADDR_ZERO == MAGIC0) &&
+	    (*(volatile ulong *)ADDR_400  == MAGIC1) &&
+	    (*(volatile ulong *)ADDR_01MB == MAGIC5) &&
+	    (*(volatile ulong *)ADDR_08MB == MAGIC2)) {
+		/*
+		 * OK, 16MB detected -> all done
+		 */
+		return;
+	}
+
+	/*
+	 * Setup for 4 MByte...
+	 */
+		
+        /*
+	 * Disable memory controller.
+	 */
+	mtsdram0(mem_mcopt1, 0x00000000);
+
+	/*
+	 * Set MB0CF for bank 0. (0-4MB) Address Mode 5 since 11x8(2)
+	 */
+	mtsdram0(mem_mb0cf, 0x00008001);
+
+	/*
+	 * Set memory controller options reg, MCOPT1.
+	 * Set DC_EN to '1' and BRD_PRF to '01' for 16 byte PLB Burst
+	 * read/prefetch.
+	 */
+	mtsdram0(mem_mcopt1, 0x80800000);
+
+	/*
+	 * Wait for 10ms
+	 */
+	udelay(10000);
 }
 
 #endif /* CONFIG_SDRAM_BANK0 */