diff --git a/cpu/ppc4xx/sdram.c b/cpu/ppc4xx/sdram.c index 7c931f0..d1ad212 100644 --- a/cpu/ppc4xx/sdram.c +++ b/cpu/ppc4xx/sdram.c @@ -1,5 +1,5 @@ /* - * (C) Copyright 2002 + * (C) Copyright 2002-2004 * Stefan Roese, esd gmbh germany, stefan.roese@esd-electronics.com * * See file CREDITS for list of people who contributed to this @@ -24,49 +24,41 @@ #include #include #include -#include #ifdef CONFIG_SDRAM_BANK0 -#define MAGIC0 0x00000000 -#define MAGIC1 0x11111111 -#define MAGIC2 0x22222222 -#define MAGIC3 0x33333333 -#define MAGIC4 0x44444444 -#define MAGIC5 0x55555555 -#define MAGIC6 0x66666666 +#define mtsdram0(reg, data) mtdcr(memcfga,reg);mtdcr(memcfgd,data) -#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) +struct sdram_conf_s { + unsigned long size; + unsigned long reg; +}; + +typedef struct sdram_conf_s sdram_conf_t; + +sdram_conf_t mb0cf[] = { + {(128 << 20), 0x000A4001}, /* (0-128MB) Address Mode 3, 13x10(4) */ + {(64 << 20), 0x00084001}, /* (0-64MB) Address Mode 3, 13x9(4) */ + {(32 << 20), 0x00062001}, /* (0-32MB) Address Mode 2, 12x9(4) */ + {(16 << 20), 0x00046001}, /* (0-16MB) Address Mode 4, 12x8(4) */ + {(4 << 20), 0x00008001}, /* (0-4MB) Address Mode 5, 11x8(2) */ +}; +#define N_MB0CF (sizeof(mb0cf) / sizeof(mb0cf[0])) -/*----------------------------------------------------------------------- - */ void sdram_init(void) { - ulong speed; ulong sdtr1; ulong rtr; - - /* - * Determine SDRAM speed - */ - speed = get_bus_freq(0); /* parameter not used on ppc4xx */ + int i; /* * Support for 100MHz and 133MHz SDRAM */ - if (speed > 100000000) { + if (get_bus_freq(0) > 100000000) { /* * 133 MHz SDRAM */ @@ -80,218 +72,37 @@ void sdram_init(void) rtr = 0x05f00000; } - /* - * Disable memory controller. - */ - mtsdram0(mem_mcopt1, 0x00000000); - - /* - * 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)) { + for (i=0; i all done + * Disable memory controller. */ - return; - } + mtsdram0(mem_mcopt1, 0x00000000); - /* - * 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); - - 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 64 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; - - if ((*(volatile ulong *)ADDR_ZERO == MAGIC0) && - (*(volatile ulong *)ADDR_08MB == MAGIC1) && - (*(volatile ulong *)ADDR_16MB == MAGIC2)) { /* - * OK, 64MB detected -> all done + * Set MB0CF for bank 0. */ - return; - } + mtsdram0(mem_mb0cf, mb0cf[i].reg); + mtsdram0(mem_sdtr1, sdtr1); + mtsdram0(mem_rtr, rtr); - /* - * Now test for 32 MByte... - */ - - /* - * Disable memory controller. - */ - mtsdram0(mem_mcopt1, 0x00000000); - - /* - * Set MB0CF for bank 0. (0-32MB) Address Mode 2 since 12x9(4) - */ - mtsdram0(mem_mb0cf, 0x00062001); - - /* - * 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 32 MByte are equipped (mirror test) - */ - *(volatile ulong *)ADDR_ZERO = MAGIC0; - *(volatile ulong *)ADDR_400 = MAGIC1; - *(volatile ulong *)ADDR_08MB = MAGIC2; - *(volatile ulong *)ADDR_16MB = MAGIC3; + udelay(200); - if ((*(volatile ulong *)ADDR_ZERO == MAGIC0) && - (*(volatile ulong *)ADDR_400 == MAGIC1) && - (*(volatile ulong *)ADDR_08MB == MAGIC2)) { /* - * OK, 32MB detected -> all done + * Set memory controller options reg, MCOPT1. + * Set DC_EN to '1' and BRD_PRF to '01' for 16 byte PLB Burst + * read/prefetch. */ - return; - } + mtsdram0(mem_mcopt1, 0x80800000); - /* - * Now test for 16 MByte... - */ - /* - * Disable memory controller. - */ - mtsdram0(mem_mcopt1, 0x00000000); - - /* - * Set MB0CF for bank 0. (0-16MB) Address Mode 4 since 12x8(4) - */ - mtsdram0(mem_mb0cf, 0x00046001); + udelay(10000); - /* - * 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 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; + if (get_ram_size(0, mb0cf[i].size) == mb0cf[i].size) { + /* + * OK, size 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 */