You cannot select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
freshtomato-arm/release/src-rt-6.x.4708/shared/hndsoc.c

152 lines
3.3 KiB
C

/*
* Broadcom HNDSoC utlities, only for AP router
* File: hndsoc.c
*
* Copyright (C) 2013, Broadcom Corporation. All Rights Reserved.
*
* Permission to use, copy, modify, and/or distribute this software for any
* purpose with or without fee is hereby granted, provided that the above
* copyright notice and this permission notice appear in all copies.
*
* THE SOFTWARE IS PROVIDED "AS IS" AND THE AUTHOR DISCLAIMS ALL WARRANTIES
* WITH REGARD TO THIS SOFTWARE INCLUDING ALL IMPLIED WARRANTIES OF
* MERCHANTABILITY AND FITNESS. IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY
* SPECIAL, DIRECT, INDIRECT, OR CONSEQUENTIAL DAMAGES OR ANY DAMAGES
* WHATSOEVER RESULTING FROM LOSS OF USE, DATA OR PROFITS, WHETHER IN AN ACTION
* OF CONTRACT, NEGLIGENCE OR OTHER TORTIOUS ACTION, ARISING OUT OF OR IN
* CONNECTION WITH THE USE OR PERFORMANCE OF THIS SOFTWARE.
*
* $Id$
*/
#include <typedefs.h>
#include <osl.h>
#include <siutils.h>
#include <hndsoc.h>
#include <sbchipc.h>
#include <bcmdevs.h>
#include <bcmnvram.h>
#include <nand_core.h>
static int bootdev = -1;
static int knldev = -1;
int
soc_boot_dev(void *socp)
{
si_t *sih = (si_t *)socp;
int bootfrom = SOC_BOOTDEV_SFLASH;
uint32 origidx;
uint32 option;
if (bootdev != -1)
return bootdev;
origidx = si_coreidx(sih);
/* Check 4707 (NorthStar) */
if (sih->ccrev == 42) {
if (si_setcore(sih, NS_ROM_CORE_ID, 0) != NULL) {
option = si_core_sflags(sih, 0, 0) & SISF_NS_BOOTDEV_MASK;
if (option == SISF_NS_BOOTDEV_NOR) {
bootfrom = SOC_BOOTDEV_SFLASH;
}
else if (option == SISF_NS_BOOTDEV_NAND) {
bootfrom = SOC_BOOTDEV_NANDFLASH;
}
else {
/* This must be SISF_NS_BOOTDEV_ROM */
bootfrom = SOC_BOOTDEV_ROM;
}
}
}
else {
chipcregs_t *cc;
/* Check 5357 */
if (sih->ccrev == 38) {
if ((sih->chipst & (1 << 4)) != 0) {
bootfrom = SOC_BOOTDEV_NANDFLASH;
goto found;
}
else if ((sih->chipst & (1 << 5)) != 0) {
bootfrom = SOC_BOOTDEV_ROM;
goto found;
}
}
/* Handle old soc, 4704, 4718 */
if ((cc = (chipcregs_t *)si_setcoreidx(sih, SI_CC_IDX))) {
option = R_REG(NULL, &cc->capabilities) & CC_CAP_FLASH_MASK;
if (option == PFLASH)
bootfrom = SOC_BOOTDEV_PFLASH;
else
bootfrom = SOC_BOOTDEV_SFLASH;
}
}
found:
si_setcoreidx(sih, origidx);
bootdev = bootfrom;
return bootdev;
}
int
soc_knl_dev(void *socp)
{
si_t *sih = (si_t *)socp;
char *val;
int knlfrom = SOC_KNLDEV_NORFLASH;
if (knldev != -1)
return knldev;
if (soc_boot_dev(socp) == SOC_BOOTDEV_NANDFLASH) {
knlfrom = SOC_KNLDEV_NANDFLASH;
goto found;
}
if (((CHIPID(sih->chip) == BCM4706_CHIP_ID) || sih->ccrev == 38) &&
(sih->cccaps & CC_CAP_NFLASH)) {
goto check_nv;
}
else if (sih->ccrev == 42) {
uint32 origidx;
nandregs_t *nc;
uint32 id = 0;
origidx = si_coreidx(sih);
if ((nc = (nandregs_t *)si_setcore(sih, NS_NAND_CORE_ID, 0)) != NULL) {
id = R_REG(NULL, &nc->flash_device_id);
}
si_setcoreidx(sih, origidx);
if (id != 0)
goto check_nv;
}
else {
/* Break through */
}
/* Default set to nor boot */
goto found;
check_nv:
/* Check NVRAM here */
if ((val = nvram_get("bootflags")) != NULL) {
int bootflags;
#ifdef linux
bootflags = simple_strtol(val, NULL, 0);
#else
bootflags = atoi(val);
#endif
if (bootflags & FLASH_KERNEL_NFLASH)
knlfrom = SOC_KNLDEV_NANDFLASH;
}
found:
knldev = knlfrom;
return knldev;
}