| /* | 
 |  * (C) Copyright 2003-2006 | 
 |  * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | 
 |  * | 
 |  * (C) Copyright 2004 | 
 |  * Mark Jonas, Freescale Semiconductor, mark.jonas@motorola.com. | 
 |  * | 
 |  * SPDX-License-Identifier:	GPL-2.0+ | 
 |  */ | 
 |  | 
 | #include <common.h> | 
 | #include <mpc5xxx.h> | 
 | #include <net.h> | 
 | #include <asm/processor.h> | 
 |  | 
 |  | 
 | #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 /* SDRAM_DDR */ | 
 |  | 
 | 	/* 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 /* !CONFIG_SYS_RAMBOOT */ | 
 |  | 
 |  | 
 | phys_size_t initdram(int board_type) | 
 | { | 
 | 	ulong dramsize = 0; | 
 | 	ulong dramsize2 = 0; | 
 | 	uint svr, pvr; | 
 |  | 
 | #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 /* SDRAM_DDR */ | 
 |  | 
 | 	/* 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 */ | 
 |  | 
 | 	/* | 
 | 	 * On MPC5200B we need to set the special configuration delay in the | 
 | 	 * DDR controller. Please refer to Freescale's AN3221 "MPC5200B SDRAM | 
 | 	 * Initialization and Configuration", 3.3.1 SDelay--MBAR + 0x0190: | 
 | 	 * | 
 | 	 * "The SDelay should be written to a value of 0x00000004. It is | 
 | 	 * required to account for changes caused by normal wafer processing | 
 | 	 * parameters." | 
 | 	 */ | 
 | 	svr = get_svr(); | 
 | 	pvr = get_pvr(); | 
 | 	if ((SVR_MJREV(svr) >= 2) && | 
 | 		(PVR_MAJ(pvr) == 1) && (PVR_MIN(pvr) == 4)) { | 
 |  | 
 | 		*(vu_long *) MPC5XXX_SDRAM_SDELAY = 0x04; | 
 | 		__asm__ volatile ("sync"); | 
 | 	} | 
 |  | 
 | 	return dramsize + dramsize2; | 
 | } | 
 |  | 
 |  | 
 | int checkboard (void) | 
 | { | 
 | 	puts("Board: MarelV38B\n"); | 
 | 	return 0; | 
 | } | 
 |  | 
 | int board_early_init_f(void) | 
 | { | 
 | #ifdef CONFIG_HW_WATCHDOG | 
 | 	/* | 
 | 	 * Enable and configure the direction (output) of PSC3_9 - watchdog | 
 | 	 * reset input. Refer to 7.3.2.2.[1,3,4] of the MPC5200B User's | 
 | 	 * Manual. | 
 | 	 */ | 
 | 	*(vu_long *) MPC5XXX_WU_GPIO_ENABLE |= GPIO_PSC3_9; | 
 | 	*(vu_long *) MPC5XXX_WU_GPIO_DIR |= GPIO_PSC3_9; | 
 | #endif /* CONFIG_HW_WATCHDOG */ | 
 | 	return 0; | 
 | } | 
 |  | 
 | int board_early_init_r(void) | 
 | { | 
 | 	/* | 
 | 	 * Now, when we are in RAM, enable flash write access for the | 
 | 	 * detection process.  Note that CS_BOOT cannot be cleared when | 
 | 	 * executing in flash. | 
 | 	 */ | 
 | 	*(vu_long *) MPC5XXX_BOOTCS_CFG &= ~0x1; /* clear RO */ | 
 |  | 
 | 	/* | 
 | 	 * Enable GPIO_WKUP_7 to "read the status of the actual power | 
 | 	 * situation". Default direction is input, so no need to set it | 
 | 	 * explicitly. | 
 | 	 */ | 
 | 	*(vu_long *) MPC5XXX_WU_GPIO_ENABLE |= GPIO_WKUP_7; | 
 | 	return 0; | 
 | } | 
 |  | 
 | extern void board_get_enetaddr(uchar *enetaddr); | 
 | int misc_init_r(void) | 
 | { | 
 | 	uchar enetaddr[6]; | 
 |  | 
 | 	if (!eth_getenv_enetaddr("ethaddr", enetaddr)) { | 
 | 		board_get_enetaddr(enetaddr); | 
 | 		eth_setenv_enetaddr("ethaddr", enetaddr); | 
 | 	} | 
 |  | 
 | 	return 0; | 
 | } | 
 |  | 
 | #if defined(CONFIG_CMD_IDE) && defined(CONFIG_IDE_RESET) | 
 | void init_ide_reset(void) | 
 | { | 
 | 	debug("init_ide_reset\n"); | 
 |  | 
 | 	/* Configure PSC1_4 as GPIO output for ATA reset */ | 
 | 	*(vu_long *) MPC5XXX_WU_GPIO_ENABLE |= GPIO_PSC1_4; | 
 | 	*(vu_long *) MPC5XXX_WU_GPIO_DIR |= GPIO_PSC1_4; | 
 | 	/* Deassert reset */ | 
 | 	*(vu_long *) MPC5XXX_WU_GPIO_DATA_O |= GPIO_PSC1_4; | 
 | } | 
 |  | 
 |  | 
 | void ide_set_reset(int idereset) | 
 | { | 
 | 	debug("ide_reset(%d)\n", idereset); | 
 |  | 
 | 	if (idereset) { | 
 | 		*(vu_long *) MPC5XXX_WU_GPIO_DATA_O &= ~GPIO_PSC1_4; | 
 | 		/* Make a delay. MPC5200 spec says 25 usec min */ | 
 | 		udelay(500000); | 
 | 	} else | 
 | 		*(vu_long *) MPC5XXX_WU_GPIO_DATA_O |=  GPIO_PSC1_4; | 
 | } | 
 | #endif | 
 |  | 
 |  | 
 | #ifdef CONFIG_HW_WATCHDOG | 
 | void hw_watchdog_reset(void) | 
 | { | 
 | 	/* | 
 | 	 * MarelV38B has a TPS3705 watchdog. Spec says that to kick the dog | 
 | 	 * we need a positive or negative transition on WDI i.e., our PSC3_9. | 
 | 	 */ | 
 | 	*(vu_long *) MPC5XXX_WU_GPIO_DATA_O ^= GPIO_PSC3_9; | 
 | } | 
 | #endif /* CONFIG_HW_WATCHDOG */ |