/*
* board_final_init()
*
* Do any final initialization, such as adding commands to the
* user interface.
*
* If you don't want a user interface, put the startup code here.
* This routine is called just before CFE starts its user interface.
*
* Input parameters:
* nothing
*
* Return value:
* nothing
*/
void
board_final_init(void)
{
char *addr, *mask, *wait_time;
char buf[512], *cur = buf;
#ifdef CFG_ROMBOOT
char *laddr = NULL;
#endif
#if !CFG_SIM
char *boot_cfg = NULL;
char *go_cmd = "go;";
#endif
int commit = 0;
uint32 ncdl;
#if CFG_WL && CFG_WLU && CFG_SIM
char *ssid;
#endif
ui_init_bcm947xxcmds();
/* Force commit of embedded NVRAM */
commit = restore_defaults;
/* Set the SDRAM NCDL value into NVRAM if not already done */
if ((getintvar(NULL, "sdram_ncdl") == 0) &&
((ncdl = si_memc_get_ncdl(sih)) != 0)) {
sprintf(buf, "0x%x", ncdl);
nvram_set("sdram_ncdl", buf);
commit = 1;
}
/* Set the bootloader version string if not already done */
sprintf(buf, "CFE %s", EPI_VERSION_STR);
if (strcmp(nvram_safe_get("pmon_ver"), buf) != 0) {
nvram_set("pmon_ver", buf);
commit = 1;
}
/* Set the size of the nvram area if not already done */
sprintf(buf, "%d", MAX_NVRAM_SPACE);
if (strcmp(nvram_safe_get("nvram_space"), buf) != 0) {
nvram_set("nvram_space", buf);
commit = 1;
}
#ifdef RTL8365MB
int ret = -1, retry = 0;
rtk_port_mac_ability_t pa;
GPIO_INIT();
for(retry = 0; ret && retry < 10; ++retry)
{
ret = rtk_switch_init();
if(ret) cfe_usleep(10000);
else break;
}
printf("rtl8354mb initialized(%d)(retry %d) %s\n", ret, retry, ret?"failed":"");
ret = rtk_port_phyEnableAll_set(1);
if(ret) printf("rtk port_phyEnableAll Failed!(%d)\n", ret);
else printf("rtk port_phyEnableAll ok\n");
/* configure & set GMAC ports */
pa.forcemode = MAC_FORCE;
pa.speed = SPD_1000M;
pa.duplex = FULL_DUPLEX;
pa.link = 1;
pa.nway = 0;
pa.rxpause = 0;
pa.txpause = 0;
ret = rtk_port_macForceLinkExt_set(EXT_PORT0, MODE_EXT_RGMII, &pa);
if(ret) printf("rtk port_macForceLink_set ext_Port0 Failed!(%d)\n", ret);
else printf("rtk port_macForceLink_set ext_Port0 ok\n");
/* asic chk */
rtk_uint32 retVal, retVal2;
rtk_uint32 data, data2;
if((retVal = rtl8367c_getAsicReg(0x1311, &data)) != RT_ERR_OK || (retVal2 = rtl8367c_getAsicReg(0x1305, &data2)) != RT_ERR_OK) {
printf("get failed(%d)(%d). (%x)(supposed to be 0x1016)\n", retVal, retVal2, data);
}
else { /* get ok, then chk reg*/
printf("get ok, chk 0x1311:%x(0x1016), 0x1305:%x(b4~b7:0x1)\n", data, data2);
if(data != 0x1016){
printf("\n!! rtl reg 0x1311 error: (%d)(get %x)\n", retVal, data);
}
if((data2 & 0xf0) != 0x10) {
printf("\n!! rtl reg 0x1305 error: (%d)(get %x)\n", retVal, data2);
}
}
/* reset tx/rx delay */
retVal = rtk_port_rgmiiDelayExt_set(EXT_PORT0, 1, 4);
if (retVal != RT_ERR_OK)
printf("\n!! rtl set delay failed (%d)\n", retVal);
#endif
#if CFG_FLASH || CFG_SFLASH || CFG_NFLASH
#if !CFG_SIM
/* Commit NVRAM only if in FLASH */
if (
#ifdef BCMNVRAMW
!nvram_inotp() &&
#endif
commit) {
printf("Committing NVRAM...");
nvram_commit();
printf("done\n");
if (restore_defaults) {
#ifdef BCM_DEVINFO
/* devinfo nvram hash table sync */
devinfo_nvram_sync();
#endif
printf("Waiting for wps button release...");
reset_release_wait();
printf("done\n");
}
}
/* Reboot after restoring defaults */
if (restore_defaults)
si_watchdog(sih, 1);
#endif /* !CFG_SIM */
#else
if (commit)
printf("Flash not configured, not commiting NVRAM...\n");
#endif /* CFG_FLASH || CFG_SFLASH || CFG_NFLASH */
/*
* Read the wait_time NVRAM variable and set the tftp max retries.
* Assumption: tftp_rrq_timeout & tftp_recv_timeout are set to 1sec.
*/
if ((wait_time = nvram_get("wait_time")) != NULL) {
tftp_max_retries = atoi(wait_time);
if (tftp_max_retries > MAX_WAIT_TIME)
tftp_max_retries = MAX_WAIT_TIME;
else if (tftp_max_retries < MIN_WAIT_TIME)
tftp_max_retries = MIN_WAIT_TIME;
}
#ifdef CFG_ROMBOOT
else if (board_bootdev_rom(sih)) {
tftp_max_retries = 10;
}
#endif
/* Configure network */
if (cfe_finddev("eth0")) {
int res;
if ((addr = nvram_get("lan_ipaddr")) &&
(mask = nvram_get("lan_netmask")))
sprintf(buf, "ifconfig eth0 -addr=%s -mask=%s",
addr, mask);
else
sprintf(buf, "ifconfig eth0 -auto");
res = ui_docommand(buf);
#ifdef CFG_ROMBOOT
/* Try indefinite netboot only while booting from ROM
* and we are sure that we dont have valid nvram in FLASH
*/
while (board_bootdev_rom(sih) && !addr) {
char ch;
cur = buf;
/* Check if something typed at console */
if (console_status()) {
console_read(&ch, 1);
/* Check for Ctrl-C */
if (ch == 3) {
if (laddr)
MFREE(osh, laddr, MAX_SCRIPT_FSIZE);
xprintf("Stopped auto netboot!!!\n");
return;
}
}
if (!res) {
char *bserver, *bfile, *load_ptr;
if (!laddr)
laddr = MALLOC(osh, MAX_SCRIPT_FSIZE);
if (!laddr) {
load_ptr = (char *) 0x00008000;
xprintf("Failed malloc for boot_script, Using :0x%x\n",
(unsigned int)laddr);
}
else {
load_ptr = laddr;
}
bserver = (bserver = env_getenv("BOOT_SERVER"))
? bserver:"192.168.1.1";
if ((bfile = env_getenv("BOOT_FILE"))) {
int len;
if (((len = strlen(bfile)) > 5) &&
!strncmp((bfile + len - 5), "cfesh", 5)) {
cur += sprintf(cur,
"batch -raw -tftp -addr=0x%x -max=0x%x %s:%s;",
(unsigned int)load_ptr,
MAX_SCRIPT_FSIZE, bserver, bfile);
}
if (((len = strlen(bfile)) > 3)) {
if (!strncmp((bfile + len - 3), "elf", 3)) {
cur += sprintf(cur,
"boot -elf -tftp -max=0x5000000 %s:%s;",
bserver, bfile);
}
if (!strncmp((bfile + len - 3), "raw", 3)) {
cur += sprintf(cur,
"boot -raw -z -tftp -addr=0x00008000"
" -max=0x5000000 %s:%s;",
bserver, bfile);
}
}
}
else { /* Make last effort */
cur += sprintf(cur,
"batch -raw -tftp -addr=0x%x -max=0x%x %s:%s;",
(unsigned int)load_ptr, MAX_SCRIPT_FSIZE,
bserver, "cfe_script.cfesh");
cur += sprintf(cur,
"boot -elf -tftp -max=0x5000000 %s:%s;",
bserver, "boot_file.elf");
cur += sprintf(cur,
"boot -raw -z -tftp -addr=0x00008000"
" -max=0x5000000 %s:%s;",
bserver, "boot_file.raw");
}
ui_docommand(buf);
cfe_sleep(3*CFE_HZ);
}
sprintf(buf, "ifconfig eth0 -auto");
res = ui_docommand(buf);
}
#endif /* CFG_ROMBOOT */
}
#if CFG_WL && CFG_WLU && CFG_SIM
if ((ssid = nvram_get("wl0_ssid"))) {
sprintf(buf, "wl join %s", ssid);
ui_docommand(buf);
}
#endif
#if !CFG_SIM
/* Try to run boot_config command if configured.
* make sure to leave space for "go" command.
*/
if ((boot_cfg = nvram_get("boot_config"))) {
if (strlen(boot_cfg) < (sizeof(buf) - sizeof(go_cmd)))
cur += sprintf(cur, "%s;", boot_cfg);
else
printf("boot_config too long, skipping to autoboot\n");
}
/* Boot image */
cur += sprintf(cur, go_cmd);
#endif /* !CFG_SIM */
/* Startup */
if (cur > buf)
env_setenv("STARTUP", buf, ENV_FLG_NORMAL);
}
static int
dev_nvram_init(void)
{
int order = 0, ret = 0;
struct page *page, *end;
unsigned int i;
osl_t *osh;
/* Allocate and reserve memory to mmap() */
while ((PAGE_SIZE << order) < NVRAM_SPACE)
order++;
end = virt_to_page(nvram_buf + (PAGE_SIZE << order) - 1);
for (page = virt_to_page(nvram_buf); page <= end; page++) {
SetPageReserved(page);
}
#if defined(CONFIG_MTD) || defined(CONFIG_MTD_MODULE)
/* Find associated MTD device */
for (i = 0; i < MAX_MTD_DEVICES; i++) {
nvram_mtd = get_mtd_device(NULL, i);
if (!IS_ERR(nvram_mtd)) {
if (!strcmp(nvram_mtd->name, "nvram") &&
nvram_mtd->size >= NVRAM_SPACE) {
break;
}
put_mtd_device(nvram_mtd);
}
}
if (i >= MAX_MTD_DEVICES)
nvram_mtd = NULL;
#endif
#ifdef RTN66U_NVRAM_64K_SUPPORT
int ret32;
char *log_buf;
u_int32_t offset_t;
size_t log_len;
DECLARE_WAITQUEUE(wait, current);
wait_queue_head_t wait_q;
struct erase_info erase;
offset_t = 0x18000;
ret32 = nvram_mtd->read(nvram_mtd, offset_t, 4, &log_len, &log_buf);
if(log_buf==0xffffffff) {
/* Erase sector blocks */
init_waitqueue_head(&wait_q);
erase.mtd = nvram_mtd;
erase.addr = 0;
erase.len = nvram_mtd->erasesize;
erase.callback = erase_callback;
erase.priv = (u_long) &wait_q;
set_current_state(TASK_INTERRUPTIBLE);
add_wait_queue(&wait_q, &wait);
/* Unlock sector blocks */
if (nvram_mtd->unlock)
nvram_mtd->unlock(nvram_mtd, 0, nvram_mtd->erasesize);
if ((ret = nvram_mtd->erase(nvram_mtd, &erase))) {
set_current_state(TASK_RUNNING);
remove_wait_queue(&wait_q, &wait);
printk("nvram mtd erase error\n");
}
/* Wait for erase to finish */
schedule();
remove_wait_queue(&wait_q, &wait);
}
#endif
/* Initialize hash table lock */
spin_lock_init(&nvram_lock);
/* Initialize commit semaphore */
init_MUTEX(&nvram_sem);
/* Register char device */
if ((nvram_major = register_chrdev(0, "nvram", &dev_nvram_fops)) < 0) {
ret = nvram_major;
goto err;
}
if (si_osh(sih) == NULL) {
osh = osl_attach(NULL, SI_BUS, FALSE);
if (osh == NULL) {
printk("Error allocating osh\n");
unregister_chrdev(nvram_major, "nvram");
goto err;
}
si_setosh(sih, osh);
}
/* Initialize hash table */
_nvram_init(sih);
/* Create /dev/nvram handle */
nvram_class = class_create(THIS_MODULE, "nvram");
if (IS_ERR(nvram_class)) {
printk("Error creating nvram class\n");
goto err;
}
/* Add the device nvram0 */
class_device_create(nvram_class, NULL, MKDEV(nvram_major, 0), NULL, "nvram");
/* reserve commit read buffer */
/* Backup sector blocks to be erased */
if (!(nvram_commit_buf = kmalloc(ROUNDUP(NVRAM_SPACE, nvram_mtd->erasesize), GFP_KERNEL))) {
printk("dev_nvram_init: nvram_commit_buf out of memory\n");
goto err;
}
/* Set the SDRAM NCDL value into NVRAM if not already done */
if (getintvar(NULL, "sdram_ncdl") == 0) {
unsigned int ncdl;
char buf[] = "0x00000000";
if ((ncdl = si_memc_get_ncdl(sih))) {
sprintf(buf, "0x%08x", ncdl);
nvram_set("sdram_ncdl", buf);
nvram_commit();
}
}
return 0;
err:
dev_nvram_exit();
return ret;
}
static int
dev_nvram_init(void)
{
int order = 0, ret = 0;
struct page *page, *end;
unsigned int i;
osl_t *osh;
/* Allocate and reserve memory to mmap() */
while ((PAGE_SIZE << order) < nvram_space)
order++;
end = virt_to_page(nvram_buf + (PAGE_SIZE << order) - 1);
for (page = virt_to_page(nvram_buf); page <= end; page++) {
SetPageReserved(page);
}
#if defined(CONFIG_MTD) || defined(CONFIG_MTD_MODULE)
/* Find associated MTD device */
for (i = 0; i < MAX_MTD_DEVICES; i++) {
nvram_mtd = get_mtd_device(NULL, i);
if (!IS_ERR(nvram_mtd)) {
if (!strcmp(nvram_mtd->name, "nvram") &&
nvram_mtd->size >= nvram_space) {
break;
}
put_mtd_device(nvram_mtd);
}
}
if (i >= MAX_MTD_DEVICES)
nvram_mtd = NULL;
#endif
/* Initialize hash table lock */
spin_lock_init(&nvram_lock);
/* Initialize commit semaphore */
init_MUTEX(&nvram_sem);
/* Register char device */
if ((nvram_major = register_chrdev(0, "nvram", &dev_nvram_fops)) < 0) {
ret = nvram_major;
goto err;
}
if (si_osh(sih) == NULL) {
osh = osl_attach(NULL, SI_BUS, FALSE);
if (osh == NULL) {
printk("Error allocating osh\n");
unregister_chrdev(nvram_major, "nvram");
goto err;
}
si_setosh(sih, osh);
}
printk("dev_nvram_init: _nvram_init\n");
/* Initialize hash table */
_nvram_init((void *)sih);
/* Create /dev/nvram handle */
nvram_class = class_create(THIS_MODULE, "nvram");
if (IS_ERR(nvram_class)) {
printk("Error creating nvram class\n");
goto err;
}
/* Add the device nvram0 */
class_device_create(nvram_class, NULL, MKDEV(nvram_major, 0), NULL, "nvram");
/* reserve commit read buffer */
/* Backup sector blocks to be erased */
if (!(nvram_commit_buf = kmalloc(ROUNDUP(nvram_space, nvram_mtd->erasesize), GFP_KERNEL))) {
printk("dev_nvram_init: nvram_commit_buf out of memory\n");
goto err;
}
/* Set the SDRAM NCDL value into NVRAM if not already done */
if (getintvar(NULL, "sdram_ncdl") == 0) {
unsigned int ncdl;
char buf[] = "0x00000000";
if ((ncdl = si_memc_get_ncdl(sih))) {
sprintf(buf, "0x%08x", ncdl);
nvram_set("sdram_ncdl", buf);
nvram_commit();
}
}
return 0;
err:
dev_nvram_exit();
return ret;
}
/*
* board_final_init()
*
* Do any final initialization, such as adding commands to the
* user interface.
*
* If you don't want a user interface, put the startup code here.
* This routine is called just before CFE starts its user interface.
*
* Input parameters:
* nothing
*
* Return value:
* nothing
*/
void
board_final_init(void)
{
char *addr, *mask, *wait_time;
char buf[512], *cur = buf;
#ifdef CFG_ROMBOOT
char *laddr = NULL;
#endif
#if !CFG_SIM
char *boot_cfg = NULL;
char *go_cmd = "go;";
#endif
int commit = 0;
uint32 ncdl;
#if CFG_WL && CFG_WLU && CFG_SIM
char *ssid;
#endif
ui_init_bcm947xxcmds();
/* Force commit of embedded NVRAM */
// commit = restore_defaults;
commit = 0;
/* Set the SDRAM NCDL value into NVRAM if not already done */
if ((getintvar(NULL, "sdram_ncdl") == 0) &&
((ncdl = si_memc_get_ncdl(sih)) != 0)) {
sprintf(buf, "0x%x", ncdl);
nvram_set("sdram_ncdl", buf);
commit = 1;
}
/* Set the bootloader version string if not already done */
sprintf(buf, "CFE %s", EPI_VERSION_STR);
if (strcmp(nvram_safe_get("pmon_ver"), buf) != 0) {
nvram_set("pmon_ver", buf);
commit = 1;
}
/* Set the size of the nvram area if not already done */
sprintf(buf, "%d", MAX_NVRAM_SPACE);
if (strcmp(nvram_safe_get("nvram_space"), buf) != 0) {
nvram_set("nvram_space", buf);
commit = 1;
}
#if CFG_FLASH || CFG_SFLASH || CFG_NFLASH
#if !CFG_SIM
/* Commit NVRAM only if in FLASH */
if (
#ifdef BCMNVRAMW
!nvram_inotp() &&
#endif
commit) {
printf("Committing NVRAM...");
nvram_commit();
printf("done\n");
if (restore_defaults) {
printf("Waiting for reset button release...");
reset_release_wait();
printf("done\n");
}
}
/* Reboot after restoring defaults */
if (restore_defaults)
si_watchdog(sih, 1);
#endif /* !CFG_SIM */
#else
if (commit)
printf("Flash not configured, not commiting NVRAM...\n");
#endif /* CFG_FLASH || CFG_SFLASH || CFG_NFLASH */
/*
* Read the wait_time NVRAM variable and set the tftp max retries.
* Assumption: tftp_rrq_timeout & tftp_recv_timeout are set to 1sec.
*/
if ((wait_time = nvram_get("wait_time")) != NULL) {
tftp_max_retries = atoi(wait_time);
if (tftp_max_retries > MAX_WAIT_TIME)
tftp_max_retries = MAX_WAIT_TIME;
else if (tftp_max_retries < MIN_WAIT_TIME)
tftp_max_retries = MIN_WAIT_TIME;
}
#ifdef CFG_ROMBOOT
else if (board_bootdev_rom(sih)) {
tftp_max_retries = 10;
}
#endif
/* Configure network */
if (cfe_finddev("eth0")) {
int res;
if ((addr = nvram_get("lan_ipaddr")) &&
(mask = nvram_get("lan_netmask")))
sprintf(buf, "ifconfig eth0 -addr=%s -mask=%s",
addr, mask);
else
sprintf(buf, "ifconfig eth0 -auto");
res = ui_docommand(buf);
#ifdef CFG_ROMBOOT
/* Try indefinite netboot only while booting from ROM
* and we are sure that we dont have valid nvram in FLASH
*/
while (board_bootdev_rom(sih) && !addr) {
char ch;
cur = buf;
/* Check if something typed at console */
if (console_status()) {
console_read(&ch, 1);
/* Check for Ctrl-C */
if (ch == 3) {
if (laddr)
MFREE(osh, laddr, MAX_SCRIPT_FSIZE);
xprintf("Stopped auto netboot!!!\n");
return;
}
}
if (!res) {
char *bserver, *bfile, *load_ptr;
if (!laddr)
laddr = MALLOC(osh, MAX_SCRIPT_FSIZE);
if (!laddr) {
load_ptr = (char *) 0x00008000;
xprintf("Failed malloc for boot_script, Using :0x%x\n",
(unsigned int)laddr);
}
else {
load_ptr = laddr;
}
bserver = (bserver = env_getenv("BOOT_SERVER"))
? bserver:"192.168.1.1";
if ((bfile = env_getenv("BOOT_FILE"))) {
int len;
if (((len = strlen(bfile)) > 5) &&
!strncmp((bfile + len - 5), "cfesh", 5)) {
cur += sprintf(cur,
"batch -raw -tftp -addr=0x%x -max=0x%x %s:%s;",
(unsigned int)load_ptr,
MAX_SCRIPT_FSIZE, bserver, bfile);
}
if (((len = strlen(bfile)) > 3)) {
if (!strncmp((bfile + len - 3), "elf", 3)) {
cur += sprintf(cur,
"boot -elf -tftp -max=0x5000000 %s:%s;",
bserver, bfile);
}
if (!strncmp((bfile + len - 3), "raw", 3)) {
cur += sprintf(cur,
"boot -raw -z -tftp -addr=0x00008000"
" -max=0x5000000 %s:%s;",
bserver, bfile);
}
}
}
else { /* Make last effort */
cur += sprintf(cur,
"batch -raw -tftp -addr=0x%x -max=0x%x %s:%s;",
(unsigned int)load_ptr, MAX_SCRIPT_FSIZE,
bserver, "cfe_script.cfesh");
cur += sprintf(cur,
"boot -elf -tftp -max=0x5000000 %s:%s;",
bserver, "boot_file.elf");
cur += sprintf(cur,
"boot -raw -z -tftp -addr=0x00008000"
" -max=0x5000000 %s:%s;",
bserver, "boot_file.raw");
}
ui_docommand(buf);
cfe_sleep(3*CFE_HZ);
}
sprintf(buf, "ifconfig eth0 -auto");
res = ui_docommand(buf);
}
#endif /* CFG_ROMBOOT */
}
#if CFG_WL && CFG_WLU && CFG_SIM
if ((ssid = nvram_get("wl0_ssid"))) {
sprintf(buf, "wl join %s", ssid);
ui_docommand(buf);
}
#endif
#if !CFG_SIM
/* Try to run boot_config command if configured.
* make sure to leave space for "go" command.
*/
if ((boot_cfg = nvram_get("boot_config"))) {
if (strlen(boot_cfg) < (sizeof(buf) - sizeof(go_cmd)))
cur += sprintf(cur, "%s;", boot_cfg);
else
printf("boot_config too long, skipping to autoboot\n");
}
/* Boot image */
cur += sprintf(cur, go_cmd);
#endif /* !CFG_SIM */
/* Startup */
if (cur > buf)
env_setenv("STARTUP", buf, ENV_FLG_NORMAL);
}
