board/bf537-stamp/post-memory.c - github/trini/u-boot - Gitiles

 #include <common.h>
 #include <asm/io.h>

 #include <post.h>
 #include <watchdog.h>

 #if CONFIG_POST & CONFIG_SYS_POST_MEMORY
 #define CLKIN 25000000
 #define PATTERN1 0x5A5A5A5A
 #define PATTERN2 0xAAAAAAAA

 #define CCLK_NUM	4
 #define SCLK_NUM	3

 void post_out_buff(char *buff);
 void post_init_pll(int mult, int div);
 int post_init_sdram(int sclk);
 void post_init_uart(int sclk);

 const int pll[CCLK_NUM][SCLK_NUM][2] = {
 	{ {20, 4}, {20, 5}, {20, 10} },	/* CCLK = 500M */
 	{ {16, 4}, {16, 5}, {16, 8} },	/* CCLK = 400M */
 	{ {8, 2}, {8, 4}, {8, 5} },	/* CCLK = 200M */
 	{ {4, 1}, {4, 2}, {4, 4} }	/* CCLK = 100M */
 };
 const char *const log[CCLK_NUM][SCLK_NUM] = {
 	{"CCLK-500MHz SCLK-125MHz:    Writing...\0",
 	 "CCLK-500MHz SCLK-100MHz:    Writing...\0",
 	 "CCLK-500MHz SCLK- 50MHz:    Writing...\0",},
 	{"CCLK-400MHz SCLK-100MHz:    Writing...\0",
 	 "CCLK-400MHz SCLK- 80MHz:    Writing...\0",
 	 "CCLK-400MHz SCLK- 50MHz:    Writing...\0",},
 	{"CCLK-200MHz SCLK-100MHz:    Writing...\0",
 	 "CCLK-200MHz SCLK- 50MHz:    Writing...\0",
 	 "CCLK-200MHz SCLK- 40MHz:    Writing...\0",},
 	{"CCLK-100MHz SCLK-100MHz:    Writing...\0",
 	 "CCLK-100MHz SCLK- 50MHz:    Writing...\0",
 	 "CCLK-100MHz SCLK- 25MHz:    Writing...\0",},
 };

 int memory_post_test(int flags)
 {
 	int addr;
 	int m, n;
 	int sclk, sclk_temp;
 	int ret = 1;

 	sclk_temp = CLKIN / 1000000;
 	sclk_temp = sclk_temp * CONFIG_VCO_MULT;
 	for (sclk = 0; sclk_temp > 0; sclk++)
 		sclk_temp -= CONFIG_SCLK_DIV;
 	sclk = sclk * 1000000;
 	post_init_uart(sclk);
 	if (post_hotkeys_pressed() == 0)
 		return 0;

 	for (m = 0; m < CCLK_NUM; m++) {
 		for (n = 0; n < SCLK_NUM; n++) {
 			/* Calculate the sclk */
 			sclk_temp = CLKIN / 1000000;
 			sclk_temp = sclk_temp * pll[m][n][0];
 			for (sclk = 0; sclk_temp > 0; sclk++)
 				sclk_temp -= pll[m][n][1];
 			sclk = sclk * 1000000;

 			post_init_pll(pll[m][n][0], pll[m][n][1]);
 			post_init_sdram(sclk);
 			post_init_uart(sclk);
 			post_out_buff("\n\r\0");
 			post_out_buff(log[m][n]);
 			for (addr = 0x0; addr < CONFIG_SYS_MAX_RAM_SIZE; addr += 4)
 				*(unsigned long *)addr = PATTERN1;
 			post_out_buff("Reading...\0");
 			for (addr = 0x0; addr < CONFIG_SYS_MAX_RAM_SIZE; addr += 4) {
 				if ((*(unsigned long *)addr) != PATTERN1) {
 					post_out_buff("Error\n\r\0");
 					ret = 0;
 				}
 			}
 			post_out_buff("OK\n\r\0");
 		}
 	}
 	if (ret)
 		post_out_buff("memory POST passed\n\r\0");
 	else
 		post_out_buff("memory POST failed\n\r\0");

 	post_out_buff("\n\r\n\r\0");
 	return 1;
 }

 void post_init_uart(int sclk)
 {
 	int divisor;

 	for (divisor = 0; sclk > 0; divisor++)
 		sclk -= 57600 * 16;

 	bfin_write_PORTF_FER(0x000F);
 	bfin_write_PORTH_FER(0xFFFF);

 	bfin_write_UART_GCTL(0x00);
 	bfin_write_UART_LCR(0x83);
 	SSYNC();
 	bfin_write_UART_DLL(divisor & 0xFF);
 	SSYNC();
 	bfin_write_UART_DLH((divisor >> 8) & 0xFF);
 	SSYNC();
 	bfin_write_UART_LCR(0x03);
 	SSYNC();
 	bfin_write_UART_GCTL(0x01);
 	SSYNC();
 }

 void post_out_buff(char *buff)
 {

 	int i = 0;
 	for (i = 0; i < 0x80000; i++)
 		;
 	i = 0;
 	while ((buff[i] != '\0') && (i != 100)) {
 		while (!(bfin_read_pUART_LSR() & 0x20)) ;
 		bfin_write_UART_THR(buff[i]);
 		SSYNC();
 		i++;
 	}
 	for (i = 0; i < 0x80000; i++)
 		;
 }

 void post_init_pll(int mult, int div)
 {

 	bfin_write_SIC_IWR(0x01);
 	bfin_write_PLL_CTL((mult << 9));
 	bfin_write_PLL_DIV(div);
 	asm("CLI R2;");
 	asm("IDLE;");
 	asm("STI R2;");
 	while (!(bfin_read_PLL_STAT() & 0x20)) ;
 }

 int post_init_sdram(int sclk)
 {
 	int SDRAM_tRP, SDRAM_tRP_num, SDRAM_tRAS, SDRAM_tRAS_num, SDRAM_tRCD,
 	    SDRAM_tWR;
 	int SDRAM_Tref, SDRAM_NRA, SDRAM_CL, SDRAM_SIZE, SDRAM_WIDTH,
 	    mem_SDGCTL, mem_SDBCTL, mem_SDRRC;

 	if ((sclk > 119402985)) {
 		SDRAM_tRP = TRP_2;
 		SDRAM_tRP_num = 2;
 		SDRAM_tRAS = TRAS_7;
 		SDRAM_tRAS_num = 7;
 		SDRAM_tRCD = TRCD_2;
 		SDRAM_tWR = TWR_2;
 	} else if ((sclk > 104477612) && (sclk <= 119402985)) {
 		SDRAM_tRP = TRP_2;
 		SDRAM_tRP_num = 2;
 		SDRAM_tRAS = TRAS_6;
 		SDRAM_tRAS_num = 6;
 		SDRAM_tRCD = TRCD_2;
 		SDRAM_tWR = TWR_2;
 	} else if ((sclk > 89552239) && (sclk <= 104477612)) {
 		SDRAM_tRP = TRP_2;
 		SDRAM_tRP_num = 2;
 		SDRAM_tRAS = TRAS_5;
 		SDRAM_tRAS_num = 5;
 		SDRAM_tRCD = TRCD_2;
 		SDRAM_tWR = TWR_2;
 	} else if ((sclk > 74626866) && (sclk <= 89552239)) {
 		SDRAM_tRP = TRP_2;
 		SDRAM_tRP_num = 2;
 		SDRAM_tRAS = TRAS_4;
 		SDRAM_tRAS_num = 4;
 		SDRAM_tRCD = TRCD_2;
 		SDRAM_tWR = TWR_2;
 	} else if ((sclk > 66666667) && (sclk <= 74626866)) {
 		SDRAM_tRP = TRP_2;
 		SDRAM_tRP_num = 2;
 		SDRAM_tRAS = TRAS_3;
 		SDRAM_tRAS_num = 3;
 		SDRAM_tRCD = TRCD_2;
 		SDRAM_tWR = TWR_2;
 	} else if ((sclk > 59701493) && (sclk <= 66666667)) {
 		SDRAM_tRP = TRP_1;
 		SDRAM_tRP_num = 1;
 		SDRAM_tRAS = TRAS_4;
 		SDRAM_tRAS_num = 4;
 		SDRAM_tRCD = TRCD_1;
 		SDRAM_tWR = TWR_2;
 	} else if ((sclk > 44776119) && (sclk <= 59701493)) {
 		SDRAM_tRP = TRP_1;
 		SDRAM_tRP_num = 1;
 		SDRAM_tRAS = TRAS_3;
 		SDRAM_tRAS_num = 3;
 		SDRAM_tRCD = TRCD_1;
 		SDRAM_tWR = TWR_2;
 	} else if ((sclk > 29850746) && (sclk <= 44776119)) {
 		SDRAM_tRP = TRP_1;
 		SDRAM_tRP_num = 1;
 		SDRAM_tRAS = TRAS_2;
 		SDRAM_tRAS_num = 2;
 		SDRAM_tRCD = TRCD_1;
 		SDRAM_tWR = TWR_2;
 	} else if (sclk <= 29850746) {
 		SDRAM_tRP = TRP_1;
 		SDRAM_tRP_num = 1;
 		SDRAM_tRAS = TRAS_1;
 		SDRAM_tRAS_num = 1;
 		SDRAM_tRCD = TRCD_1;
 		SDRAM_tWR = TWR_2;
 	} else {
 		SDRAM_tRP = TRP_1;
 		SDRAM_tRP_num = 1;
 		SDRAM_tRAS = TRAS_1;
 		SDRAM_tRAS_num = 1;
 		SDRAM_tRCD = TRCD_1;
 		SDRAM_tWR = TWR_2;
 	}
 	/*SDRAM INFORMATION: */
 	SDRAM_Tref = 64;	/* Refresh period in milliseconds */
 	SDRAM_NRA = 4096;	/* Number of row addresses in SDRAM */
 	SDRAM_CL = CL_3;	/* 2 */

 	SDRAM_SIZE = EBSZ_64;
 	SDRAM_WIDTH = EBCAW_10;

 	mem_SDBCTL = SDRAM_WIDTH | SDRAM_SIZE | EBE;

 	/* Equation from section 17 (p17-46) of BF533 HRM */
 	mem_SDRRC =
 	    (((CONFIG_SCLK_HZ / 1000) * SDRAM_Tref) / SDRAM_NRA) -
 	    (SDRAM_tRAS_num + SDRAM_tRP_num);

 	/* Enable SCLK Out */
 	mem_SDGCTL =
 	    (SCTLE | SDRAM_CL | SDRAM_tRAS | SDRAM_tRP | SDRAM_tRCD | SDRAM_tWR
 	     | PSS);

 	SSYNC();

 	bfin_write_EBIU_SDGCTL(bfin_write_EBIU_SDGCTL() | 0x1000000);
 	/* Set the SDRAM Refresh Rate control register based on SSCLK value */
 	bfin_write_EBIU_SDRRC(mem_SDRRC);

 	/* SDRAM Memory Bank Control Register */
 	bfin_write_EBIU_SDBCTL(mem_SDBCTL);

 	/* SDRAM Memory Global Control Register */
 	bfin_write_EBIU_SDGCTL(mem_SDGCTL);
 	SSYNC();
 	return mem_SDRRC;
 }

 #endif				/* CONFIG_POST & CONFIG_SYS_POST_MEMORY */
	#include <common.h>
	#include <asm/io.h>

	#include <post.h>
	#include <watchdog.h>

	#if CONFIG_POST & CONFIG_SYS_POST_MEMORY
	#define CLKIN 25000000
	#define PATTERN1 0x5A5A5A5A
	#define PATTERN2 0xAAAAAAAA

	#define CCLK_NUM 4
	#define SCLK_NUM 3

	void post_out_buff(char *buff);
	void post_init_pll(int mult, int div);
	int post_init_sdram(int sclk);
	void post_init_uart(int sclk);

	const int pll[CCLK_NUM][SCLK_NUM][2] = {
	{ {20, 4}, {20, 5}, {20, 10} }, /* CCLK = 500M */
	{ {16, 4}, {16, 5}, {16, 8} }, /* CCLK = 400M */
	{ {8, 2}, {8, 4}, {8, 5} }, /* CCLK = 200M */
	{ {4, 1}, {4, 2}, {4, 4} } /* CCLK = 100M */
	};
	const char *const log[CCLK_NUM][SCLK_NUM] = {
	{"CCLK-500MHz SCLK-125MHz: Writing...\0",
	"CCLK-500MHz SCLK-100MHz: Writing...\0",
	"CCLK-500MHz SCLK- 50MHz: Writing...\0",},
	{"CCLK-400MHz SCLK-100MHz: Writing...\0",
	"CCLK-400MHz SCLK- 80MHz: Writing...\0",
	"CCLK-400MHz SCLK- 50MHz: Writing...\0",},
	{"CCLK-200MHz SCLK-100MHz: Writing...\0",
	"CCLK-200MHz SCLK- 50MHz: Writing...\0",
	"CCLK-200MHz SCLK- 40MHz: Writing...\0",},
	{"CCLK-100MHz SCLK-100MHz: Writing...\0",
	"CCLK-100MHz SCLK- 50MHz: Writing...\0",
	"CCLK-100MHz SCLK- 25MHz: Writing...\0",},
	};

	int memory_post_test(int flags)
	{
	int addr;
	int m, n;
	int sclk, sclk_temp;
	int ret = 1;

	sclk_temp = CLKIN / 1000000;
	sclk_temp = sclk_temp * CONFIG_VCO_MULT;
	for (sclk = 0; sclk_temp > 0; sclk++)
	sclk_temp -= CONFIG_SCLK_DIV;
	sclk = sclk * 1000000;
	post_init_uart(sclk);
	if (post_hotkeys_pressed() == 0)
	return 0;

	for (m = 0; m < CCLK_NUM; m++) {
	for (n = 0; n < SCLK_NUM; n++) {
	/* Calculate the sclk */
	sclk_temp = CLKIN / 1000000;
	sclk_temp = sclk_temp * pll[m][n][0];
	for (sclk = 0; sclk_temp > 0; sclk++)
	sclk_temp -= pll[m][n][1];
	sclk = sclk * 1000000;

	post_init_pll(pll[m][n][0], pll[m][n][1]);
	post_init_sdram(sclk);
	post_init_uart(sclk);
	post_out_buff("\n\r\0");
	post_out_buff(log[m][n]);
	for (addr = 0x0; addr < CONFIG_SYS_MAX_RAM_SIZE; addr += 4)
	(unsigned long )addr = PATTERN1;
	post_out_buff("Reading...\0");
	for (addr = 0x0; addr < CONFIG_SYS_MAX_RAM_SIZE; addr += 4) {
	if (((unsigned long )addr) != PATTERN1) {
	post_out_buff("Error\n\r\0");
	ret = 0;
	}
	}
	post_out_buff("OK\n\r\0");
	}
	}
	if (ret)
	post_out_buff("memory POST passed\n\r\0");
	else
	post_out_buff("memory POST failed\n\r\0");

	post_out_buff("\n\r\n\r\0");
	return 1;
	}

	void post_init_uart(int sclk)
	{
	int divisor;

	for (divisor = 0; sclk > 0; divisor++)
	sclk -= 57600 * 16;

	bfin_write_PORTF_FER(0x000F);
	bfin_write_PORTH_FER(0xFFFF);

	bfin_write_UART_GCTL(0x00);
	bfin_write_UART_LCR(0x83);
	SSYNC();
	bfin_write_UART_DLL(divisor & 0xFF);
	SSYNC();
	bfin_write_UART_DLH((divisor >> 8) & 0xFF);
	SSYNC();
	bfin_write_UART_LCR(0x03);
	SSYNC();
	bfin_write_UART_GCTL(0x01);
	SSYNC();
	}

	void post_out_buff(char *buff)
	{

	int i = 0;
	for (i = 0; i < 0x80000; i++)
	;
	i = 0;
	while ((buff[i] != '\0') && (i != 100)) {
	while (!(bfin_read_pUART_LSR() & 0x20)) ;
	bfin_write_UART_THR(buff[i]);
	SSYNC();
	i++;
	}
	for (i = 0; i < 0x80000; i++)
	;
	}

	void post_init_pll(int mult, int div)
	{

	bfin_write_SIC_IWR(0x01);
	bfin_write_PLL_CTL((mult << 9));
	bfin_write_PLL_DIV(div);
	asm("CLI R2;");
	asm("IDLE;");
	asm("STI R2;");
	while (!(bfin_read_PLL_STAT() & 0x20)) ;
	}

	int post_init_sdram(int sclk)
	{
	int SDRAM_tRP, SDRAM_tRP_num, SDRAM_tRAS, SDRAM_tRAS_num, SDRAM_tRCD,
	SDRAM_tWR;
	int SDRAM_Tref, SDRAM_NRA, SDRAM_CL, SDRAM_SIZE, SDRAM_WIDTH,
	mem_SDGCTL, mem_SDBCTL, mem_SDRRC;

	if ((sclk > 119402985)) {
	SDRAM_tRP = TRP_2;
	SDRAM_tRP_num = 2;
	SDRAM_tRAS = TRAS_7;
	SDRAM_tRAS_num = 7;
	SDRAM_tRCD = TRCD_2;
	SDRAM_tWR = TWR_2;
	} else if ((sclk > 104477612) && (sclk <= 119402985)) {
	SDRAM_tRP = TRP_2;
	SDRAM_tRP_num = 2;
	SDRAM_tRAS = TRAS_6;
	SDRAM_tRAS_num = 6;
	SDRAM_tRCD = TRCD_2;
	SDRAM_tWR = TWR_2;
	} else if ((sclk > 89552239) && (sclk <= 104477612)) {
	SDRAM_tRP = TRP_2;
	SDRAM_tRP_num = 2;
	SDRAM_tRAS = TRAS_5;
	SDRAM_tRAS_num = 5;
	SDRAM_tRCD = TRCD_2;
	SDRAM_tWR = TWR_2;
	} else if ((sclk > 74626866) && (sclk <= 89552239)) {
	SDRAM_tRP = TRP_2;
	SDRAM_tRP_num = 2;
	SDRAM_tRAS = TRAS_4;
	SDRAM_tRAS_num = 4;
	SDRAM_tRCD = TRCD_2;
	SDRAM_tWR = TWR_2;
	} else if ((sclk > 66666667) && (sclk <= 74626866)) {
	SDRAM_tRP = TRP_2;
	SDRAM_tRP_num = 2;
	SDRAM_tRAS = TRAS_3;
	SDRAM_tRAS_num = 3;
	SDRAM_tRCD = TRCD_2;
	SDRAM_tWR = TWR_2;
	} else if ((sclk > 59701493) && (sclk <= 66666667)) {
	SDRAM_tRP = TRP_1;
	SDRAM_tRP_num = 1;
	SDRAM_tRAS = TRAS_4;
	SDRAM_tRAS_num = 4;
	SDRAM_tRCD = TRCD_1;
	SDRAM_tWR = TWR_2;
	} else if ((sclk > 44776119) && (sclk <= 59701493)) {
	SDRAM_tRP = TRP_1;
	SDRAM_tRP_num = 1;
	SDRAM_tRAS = TRAS_3;
	SDRAM_tRAS_num = 3;
	SDRAM_tRCD = TRCD_1;
	SDRAM_tWR = TWR_2;
	} else if ((sclk > 29850746) && (sclk <= 44776119)) {
	SDRAM_tRP = TRP_1;
	SDRAM_tRP_num = 1;
	SDRAM_tRAS = TRAS_2;
	SDRAM_tRAS_num = 2;
	SDRAM_tRCD = TRCD_1;
	SDRAM_tWR = TWR_2;
	} else if (sclk <= 29850746) {
	SDRAM_tRP = TRP_1;
	SDRAM_tRP_num = 1;
	SDRAM_tRAS = TRAS_1;
	SDRAM_tRAS_num = 1;
	SDRAM_tRCD = TRCD_1;
	SDRAM_tWR = TWR_2;
	} else {
	SDRAM_tRP = TRP_1;
	SDRAM_tRP_num = 1;
	SDRAM_tRAS = TRAS_1;
	SDRAM_tRAS_num = 1;
	SDRAM_tRCD = TRCD_1;
	SDRAM_tWR = TWR_2;
	}
	/SDRAM INFORMATION: /
	SDRAM_Tref = 64; /* Refresh period in milliseconds */
	SDRAM_NRA = 4096; /* Number of row addresses in SDRAM */
	SDRAM_CL = CL_3; /* 2 */

	SDRAM_SIZE = EBSZ_64;
	SDRAM_WIDTH = EBCAW_10;

	mem_SDBCTL = SDRAM_WIDTH \| SDRAM_SIZE \| EBE;

	/* Equation from section 17 (p17-46) of BF533 HRM */
	mem_SDRRC =
	(((CONFIG_SCLK_HZ / 1000) * SDRAM_Tref) / SDRAM_NRA) -
	(SDRAM_tRAS_num + SDRAM_tRP_num);

	/* Enable SCLK Out */
	mem_SDGCTL =
	(SCTLE \| SDRAM_CL \| SDRAM_tRAS \| SDRAM_tRP \| SDRAM_tRCD \| SDRAM_tWR
	\| PSS);

	SSYNC();

	bfin_write_EBIU_SDGCTL(bfin_write_EBIU_SDGCTL() \| 0x1000000);
	/* Set the SDRAM Refresh Rate control register based on SSCLK value */
	bfin_write_EBIU_SDRRC(mem_SDRRC);

	/* SDRAM Memory Bank Control Register */
	bfin_write_EBIU_SDBCTL(mem_SDBCTL);

	/* SDRAM Memory Global Control Register */
	bfin_write_EBIU_SDGCTL(mem_SDGCTL);
	SSYNC();
	return mem_SDRRC;
	}

	#endif /* CONFIG_POST & CONFIG_SYS_POST_MEMORY */