| /* | 
 |  * (C) Copyright 2003-2004 | 
 |  * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | 
 |  * | 
 |  * (C) Copyright 2004 | 
 |  * Mark Jonas, Freescale Semiconductor, mark.jonas@motorola.com. | 
 |  * | 
 |  * See file CREDITS for list of people who contributed to this | 
 |  * project. | 
 |  * | 
 |  * This program is free software; you can redistribute it and/or | 
 |  * modify it under the terms of the GNU General Public License as | 
 |  * published by the Free Software Foundation; either version 2 of | 
 |  * the License, or (at your option) any later version. | 
 |  * | 
 |  * This program is distributed in the hope that it will be useful, | 
 |  * but WITHOUT ANY WARRANTY; without even the implied warranty of | 
 |  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the | 
 |  * GNU General Public License for more details. | 
 |  * | 
 |  * You should have received a copy of the GNU General Public License | 
 |  * along with this program; if not, write to the Free Software | 
 |  * Foundation, Inc., 59 Temple Place, Suite 330, Boston, | 
 |  * MA 02111-1307 USA | 
 |  */ | 
 |  | 
 | #include <common.h> | 
 | #include <mpc5xxx.h> | 
 | #include <pci.h> | 
 | #include <netdev.h> | 
 |  | 
 | #if defined(CONFIG_MPC5200_DDR) | 
 | #include "mt46v16m16-75.h" | 
 | #else | 
 | #include "mt48lc16m16a2-75.h" | 
 | #endif | 
 |  | 
 | DECLARE_GLOBAL_DATA_PTR; | 
 |  | 
 | #ifndef CONFIG_SYS_RAMBOOT | 
 | static void sdram_start (int hi_addr) | 
 | { | 
 | 	long hi_addr_bit = hi_addr ? 0x01000000 : 0; | 
 |  | 
 | 	/* unlock mode register */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000000 | hi_addr_bit; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* precharge all banks */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000002 | hi_addr_bit; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | #if SDRAM_DDR | 
 | 	/* set mode register: extended mode */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_MODE = SDRAM_EMODE; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* set mode register: reset DLL */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_MODE = SDRAM_MODE | 0x04000000; | 
 | 	__asm__ volatile ("sync"); | 
 | #endif | 
 |  | 
 | 	/* precharge all banks */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000002 | hi_addr_bit; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* auto refresh */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | 0x80000004 | hi_addr_bit; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* set mode register */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_MODE = SDRAM_MODE; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* normal operation */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CTRL = SDRAM_CONTROL | hi_addr_bit; | 
 | 	__asm__ volatile ("sync"); | 
 | } | 
 | #endif | 
 |  | 
 | /* | 
 |  * ATTENTION: Although partially referenced initdram does NOT make real use | 
 |  *            use of CONFIG_SYS_SDRAM_BASE. The code does not work if CONFIG_SYS_SDRAM_BASE | 
 |  *            is something else than 0x00000000. | 
 |  */ | 
 |  | 
 | #if defined(CONFIG_MPC5200) | 
 | phys_size_t initdram (int board_type) | 
 | { | 
 | 	ulong dramsize = 0; | 
 | 	ulong dramsize2 = 0; | 
 | #ifndef CONFIG_SYS_RAMBOOT | 
 | 	ulong test1, test2; | 
 |  | 
 | 	/* setup SDRAM chip selects */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0x0000001e;/* 2G at 0x0 */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CS1CFG = 0x80000000;/* disabled */ | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* setup config registers */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CONFIG1 = SDRAM_CONFIG1; | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CONFIG2 = SDRAM_CONFIG2; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | #if SDRAM_DDR | 
 | 	/* set tap delay */ | 
 | 	*(vu_long *)MPC5XXX_CDM_PORCFG = SDRAM_TAPDELAY; | 
 | 	__asm__ volatile ("sync"); | 
 | #endif | 
 |  | 
 | 	/* find RAM size using SDRAM CS0 only */ | 
 | 	sdram_start(0); | 
 | 	test1 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x80000000); | 
 | 	sdram_start(1); | 
 | 	test2 = get_ram_size((long *)CONFIG_SYS_SDRAM_BASE, 0x80000000); | 
 | 	if (test1 > test2) { | 
 | 		sdram_start(0); | 
 | 		dramsize = test1; | 
 | 	} else { | 
 | 		dramsize = test2; | 
 | 	} | 
 |  | 
 | 	/* memory smaller than 1MB is impossible */ | 
 | 	if (dramsize < (1 << 20)) { | 
 | 		dramsize = 0; | 
 | 	} | 
 |  | 
 | 	/* set SDRAM CS0 size according to the amount of RAM found */ | 
 | 	if (dramsize > 0) { | 
 | 		*(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0x13 + __builtin_ffs(dramsize >> 20) - 1; | 
 | 	} else { | 
 | 		*(vu_long *)MPC5XXX_SDRAM_CS0CFG = 0; /* disabled */ | 
 | 	} | 
 |  | 
 | 	/* let SDRAM CS1 start right after CS0 */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize + 0x0000001e;/* 2G */ | 
 |  | 
 | 	/* find RAM size using SDRAM CS1 only */ | 
 | 	if (!dramsize) | 
 | 		sdram_start(0); | 
 | 	test2 = test1 = get_ram_size((long *)(CONFIG_SYS_SDRAM_BASE + dramsize), 0x80000000); | 
 | 	if (!dramsize) { | 
 | 		sdram_start(1); | 
 | 		test2 = get_ram_size((long *)(CONFIG_SYS_SDRAM_BASE + dramsize), 0x80000000); | 
 | 	} | 
 | 	if (test1 > test2) { | 
 | 		sdram_start(0); | 
 | 		dramsize2 = test1; | 
 | 	} else { | 
 | 		dramsize2 = test2; | 
 | 	} | 
 |  | 
 | 	/* memory smaller than 1MB is impossible */ | 
 | 	if (dramsize2 < (1 << 20)) { | 
 | 		dramsize2 = 0; | 
 | 	} | 
 |  | 
 | 	/* set SDRAM CS1 size according to the amount of RAM found */ | 
 | 	if (dramsize2 > 0) { | 
 | 		*(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize | 
 | 			| (0x13 + __builtin_ffs(dramsize2 >> 20) - 1); | 
 | 	} else { | 
 | 		*(vu_long *)MPC5XXX_SDRAM_CS1CFG = dramsize; /* disabled */ | 
 | 	} | 
 |  | 
 | #else /* CONFIG_SYS_RAMBOOT */ | 
 |  | 
 | 	/* retrieve size of memory connected to SDRAM CS0 */ | 
 | 	dramsize = *(vu_long *)MPC5XXX_SDRAM_CS0CFG & 0xFF; | 
 | 	if (dramsize >= 0x13) { | 
 | 		dramsize = (1 << (dramsize - 0x13)) << 20; | 
 | 	} else { | 
 | 		dramsize = 0; | 
 | 	} | 
 |  | 
 | 	/* retrieve size of memory connected to SDRAM CS1 */ | 
 | 	dramsize2 = *(vu_long *)MPC5XXX_SDRAM_CS1CFG & 0xFF; | 
 | 	if (dramsize2 >= 0x13) { | 
 | 		dramsize2 = (1 << (dramsize2 - 0x13)) << 20; | 
 | 	} else { | 
 | 		dramsize2 = 0; | 
 | 	} | 
 |  | 
 | #endif /* CONFIG_SYS_RAMBOOT */ | 
 |  | 
 | 	return dramsize + dramsize2; | 
 | } | 
 |  | 
 | #elif defined(CONFIG_MGT5100) | 
 |  | 
 | phys_size_t initdram (int board_type) | 
 | { | 
 | 	ulong dramsize = 0; | 
 | #ifndef CONFIG_SYS_RAMBOOT | 
 | 	ulong test1, test2; | 
 |  | 
 | 	/* setup and enable SDRAM chip selects */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_START = 0x00000000; | 
 | 	*(vu_long *)MPC5XXX_SDRAM_STOP = 0x0000ffff;/* 2G */ | 
 | 	*(vu_long *)MPC5XXX_ADDECR |= (1 << 22); /* Enable SDRAM */ | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* setup config registers */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CONFIG1 = SDRAM_CONFIG1; | 
 | 	*(vu_long *)MPC5XXX_SDRAM_CONFIG2 = SDRAM_CONFIG2; | 
 |  | 
 | 	/* address select register */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_XLBSEL = SDRAM_ADDRSEL; | 
 | 	__asm__ volatile ("sync"); | 
 |  | 
 | 	/* find RAM size */ | 
 | 	sdram_start(0); | 
 | 	test1 = get_ram_size((ulong *)CONFIG_SYS_SDRAM_BASE, 0x80000000); | 
 | 	sdram_start(1); | 
 | 	test2 = get_ram_size((ulong *)CONFIG_SYS_SDRAM_BASE, 0x80000000); | 
 | 	if (test1 > test2) { | 
 | 		sdram_start(0); | 
 | 		dramsize = test1; | 
 | 	} else { | 
 | 		dramsize = test2; | 
 | 	} | 
 |  | 
 | 	/* set SDRAM end address according to size */ | 
 | 	*(vu_long *)MPC5XXX_SDRAM_STOP = ((dramsize - 1) >> 15); | 
 |  | 
 | #else /* CONFIG_SYS_RAMBOOT */ | 
 |  | 
 | 	/* Retrieve amount of SDRAM available */ | 
 | 	dramsize = ((*(vu_long *)MPC5XXX_SDRAM_STOP + 1) << 15); | 
 |  | 
 | #endif /* CONFIG_SYS_RAMBOOT */ | 
 |  | 
 | 	return dramsize; | 
 | } | 
 |  | 
 | #else | 
 | #error Neither CONFIG_MPC5200 or CONFIG_MGT5100 defined | 
 | #endif | 
 |  | 
 | int checkboard (void) | 
 | { | 
 | #if defined(CONFIG_MPC5200) | 
 | 	puts ("Board: MicroSys PM520 \n"); | 
 | #elif defined(CONFIG_MGT5100) | 
 | 	puts ("Board: MicroSys PM510 \n"); | 
 | #endif | 
 | 	return 0; | 
 | } | 
 |  | 
 | void flash_preinit(void) | 
 | { | 
 | 	/* | 
 | 	 * Now, when we are in RAM, enable flash write | 
 | 	 * access for detection process. | 
 | 	 * Note that CS_BOOT cannot be cleared when | 
 | 	 * executing in flash. | 
 | 	 */ | 
 | #if defined(CONFIG_MGT5100) | 
 | 	*(vu_long *)MPC5XXX_ADDECR &= ~(1 << 25); /* disable CS_BOOT */ | 
 | 	*(vu_long *)MPC5XXX_ADDECR |= (1 << 16); /* enable CS0 */ | 
 | #endif | 
 | 	*(vu_long *)MPC5XXX_BOOTCS_CFG &= ~0x1; /* clear RO */ | 
 | } | 
 |  | 
 | void flash_afterinit(ulong start, ulong size) | 
 | { | 
 | #if defined(CONFIG_BOOT_ROM) | 
 | 	/* adjust mapping */ | 
 | 	*(vu_long *)MPC5XXX_CS1_START = | 
 | 			START_REG(start); | 
 | 	*(vu_long *)MPC5XXX_CS1_STOP = | 
 | 			STOP_REG(start, size); | 
 | #else | 
 | 	/* adjust mapping */ | 
 | 	*(vu_long *)MPC5XXX_BOOTCS_START = *(vu_long *)MPC5XXX_CS0_START = | 
 | 			START_REG(start); | 
 | 	*(vu_long *)MPC5XXX_BOOTCS_STOP = *(vu_long *)MPC5XXX_CS0_STOP = | 
 | 			STOP_REG(start, size); | 
 | #endif | 
 | } | 
 |  | 
 |  | 
 | extern flash_info_t flash_info[];	/* info for FLASH chips */ | 
 |  | 
 | int misc_init_r (void) | 
 | { | 
 | 	/* adjust flash start */ | 
 | 	gd->bd->bi_flashstart = flash_info[0].start[0]; | 
 | 	return (0); | 
 | } | 
 |  | 
 | #ifdef	CONFIG_PCI | 
 | static struct pci_controller hose; | 
 |  | 
 | extern void pci_mpc5xxx_init(struct pci_controller *); | 
 |  | 
 | void pci_init_board(void) | 
 | { | 
 | 	pci_mpc5xxx_init(&hose); | 
 | } | 
 | #endif | 
 |  | 
 | #if defined(CONFIG_CMD_IDE) && defined(CONFIG_IDE_RESET) | 
 |  | 
 | void init_ide_reset (void) | 
 | { | 
 | 	debug ("init_ide_reset\n"); | 
 |  | 
 | } | 
 |  | 
 | void ide_set_reset (int idereset) | 
 | { | 
 | 	debug ("ide_reset(%d)\n", idereset); | 
 |  | 
 | } | 
 | #endif | 
 |  | 
 | #if defined(CONFIG_CMD_DOC) | 
 | void doc_init (void) | 
 | { | 
 | 	doc_probe (CONFIG_SYS_DOC_BASE); | 
 | } | 
 | #endif | 
 |  | 
 | int board_eth_init(bd_t *bis) | 
 | { | 
 | 	cpu_eth_init(bis); /* Built in FEC comes first */ | 
 | 	return pci_eth_init(bis); | 
 | } |