mirror of
https://github.com/brain-hackers/u-boot-brain
synced 2024-08-15 06:33:45 +09:00
0049053ff3
The old MMR defines are being scrubbed, so convert the driver to use the new standard helper macros. For the GPIO MMR usage, convert to the new GPIO framework. Signed-off-by: Mike Frysinger <vapier@gentoo.org>
319 lines
7.6 KiB
C
319 lines
7.6 KiB
C
#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);
|
|
int post_key_pressed(void);
|
|
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_key_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++)
|
|
;
|
|
}
|
|
|
|
/* Using sw10-PF5 as the hotkey */
|
|
#define KEY_LOOP 0x80000
|
|
#define KEY_DELAY 0x80
|
|
int post_key_pressed(void)
|
|
{
|
|
int i, n;
|
|
unsigned short value;
|
|
|
|
bfin_write_PORTF_FER(bfin_read_PORTF_FER() & ~PF5);
|
|
bfin_write_PORTFIO_DIR(bfin_read_PORTFIO_DIR() & ~PF5);
|
|
bfin_write_PORTFIO_INEN(bfin_read_PORTFIO_INEN() | PF5);
|
|
SSYNC();
|
|
|
|
post_out_buff("########Press SW10 to enter Memory POST########: 3\0");
|
|
for (i = 0; i < KEY_LOOP; i++) {
|
|
value = bfin_read_PORTFIO() & PF5;
|
|
if (bfin_read_UART0_RBR() == 0x0D) {
|
|
value = 0;
|
|
goto key_pressed;
|
|
}
|
|
if (value != 0)
|
|
goto key_pressed;
|
|
for (n = 0; n < KEY_DELAY; n++)
|
|
asm("nop");
|
|
}
|
|
post_out_buff("\b2\0");
|
|
|
|
for (i = 0; i < KEY_LOOP; i++) {
|
|
value = bfin_read_PORTFIO() & PF5;
|
|
if (bfin_read_UART0_RBR() == 0x0D) {
|
|
value = 0;
|
|
goto key_pressed;
|
|
}
|
|
if (value != 0)
|
|
goto key_pressed;
|
|
for (n = 0; n < KEY_DELAY; n++)
|
|
asm("nop");
|
|
}
|
|
post_out_buff("\b1\0");
|
|
|
|
for (i = 0; i < KEY_LOOP; i++) {
|
|
value = bfin_read_PORTFIO() & PF5;
|
|
if (bfin_read_UART0_RBR() == 0x0D) {
|
|
value = 0;
|
|
goto key_pressed;
|
|
}
|
|
if (value != 0)
|
|
goto key_pressed;
|
|
for (n = 0; n < KEY_DELAY; n++)
|
|
asm("nop");
|
|
}
|
|
key_pressed:
|
|
post_out_buff("\b0");
|
|
post_out_buff("\n\r\0");
|
|
if (value == 0)
|
|
return 0;
|
|
post_out_buff("Hotkey has been pressed, Enter POST . . . . . .\n\r\0");
|
|
return 1;
|
|
}
|
|
|
|
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 */
|