forked from luck/tmp_suning_uos_patched
345 lines
8.2 KiB
C
345 lines
8.2 KiB
C
/*
|
|
* Copyright (C) 2000, 2001, 2002, 2003 Broadcom Corporation
|
|
*
|
|
* This program is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU General Public License
|
|
* as published by the Free Software Foundation; either version 2
|
|
* of the License, or (at your option) any later version.
|
|
*
|
|
* This program is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
* GNU General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU General Public License
|
|
* along with this program; if not, write to the Free Software
|
|
* Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
|
|
*/
|
|
|
|
#include <linux/init.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/linkage.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/blkdev.h>
|
|
#include <linux/bootmem.h>
|
|
#include <linux/pm.h>
|
|
#include <linux/smp.h>
|
|
|
|
#include <asm/bootinfo.h>
|
|
#include <asm/reboot.h>
|
|
#include <asm/sibyte/board.h>
|
|
#include <asm/smp-ops.h>
|
|
|
|
#include <asm/fw/cfe/cfe_api.h>
|
|
#include <asm/fw/cfe/cfe_error.h>
|
|
|
|
/* Max ram addressable in 32-bit segments */
|
|
#ifdef CONFIG_64BIT
|
|
#define MAX_RAM_SIZE (~0ULL)
|
|
#else
|
|
#ifdef CONFIG_HIGHMEM
|
|
#ifdef CONFIG_PHYS_ADDR_T_64BIT
|
|
#define MAX_RAM_SIZE (~0ULL)
|
|
#else
|
|
#define MAX_RAM_SIZE (0xffffffffULL)
|
|
#endif
|
|
#else
|
|
#define MAX_RAM_SIZE (0x1fffffffULL)
|
|
#endif
|
|
#endif
|
|
|
|
#define SIBYTE_MAX_MEM_REGIONS 8
|
|
phys_addr_t board_mem_region_addrs[SIBYTE_MAX_MEM_REGIONS];
|
|
phys_addr_t board_mem_region_sizes[SIBYTE_MAX_MEM_REGIONS];
|
|
unsigned int board_mem_region_count;
|
|
|
|
int cfe_cons_handle;
|
|
|
|
#ifdef CONFIG_BLK_DEV_INITRD
|
|
extern unsigned long initrd_start, initrd_end;
|
|
#endif
|
|
|
|
static void __noreturn cfe_linux_exit(void *arg)
|
|
{
|
|
int warm = *(int *)arg;
|
|
|
|
if (smp_processor_id()) {
|
|
static int reboot_smp;
|
|
|
|
/* Don't repeat the process from another CPU */
|
|
if (!reboot_smp) {
|
|
/* Get CPU 0 to do the cfe_exit */
|
|
reboot_smp = 1;
|
|
smp_call_function(cfe_linux_exit, arg, 0);
|
|
}
|
|
} else {
|
|
printk("Passing control back to CFE...\n");
|
|
cfe_exit(warm, 0);
|
|
printk("cfe_exit returned??\n");
|
|
}
|
|
while (1);
|
|
}
|
|
|
|
static void __noreturn cfe_linux_restart(char *command)
|
|
{
|
|
static const int zero;
|
|
|
|
cfe_linux_exit((void *)&zero);
|
|
}
|
|
|
|
static void __noreturn cfe_linux_halt(void)
|
|
{
|
|
static const int one = 1;
|
|
|
|
cfe_linux_exit((void *)&one);
|
|
}
|
|
|
|
static __init void prom_meminit(void)
|
|
{
|
|
u64 addr, size, type; /* regardless of PHYS_ADDR_T_64BIT */
|
|
int mem_flags = 0;
|
|
unsigned int idx;
|
|
int rd_flag;
|
|
#ifdef CONFIG_BLK_DEV_INITRD
|
|
unsigned long initrd_pstart;
|
|
unsigned long initrd_pend;
|
|
|
|
initrd_pstart = CPHYSADDR(initrd_start);
|
|
initrd_pend = CPHYSADDR(initrd_end);
|
|
if (initrd_start &&
|
|
((initrd_pstart > MAX_RAM_SIZE)
|
|
|| (initrd_pend > MAX_RAM_SIZE))) {
|
|
panic("initrd out of addressable memory");
|
|
}
|
|
|
|
#endif /* INITRD */
|
|
|
|
for (idx = 0; cfe_enummem(idx, mem_flags, &addr, &size, &type) != CFE_ERR_NOMORE;
|
|
idx++) {
|
|
rd_flag = 0;
|
|
if (type == CFE_MI_AVAILABLE) {
|
|
/*
|
|
* See if this block contains (any portion of) the
|
|
* ramdisk
|
|
*/
|
|
#ifdef CONFIG_BLK_DEV_INITRD
|
|
if (initrd_start) {
|
|
if ((initrd_pstart > addr) &&
|
|
(initrd_pstart < (addr + size))) {
|
|
add_memory_region(addr,
|
|
initrd_pstart - addr,
|
|
BOOT_MEM_RAM);
|
|
rd_flag = 1;
|
|
}
|
|
if ((initrd_pend > addr) &&
|
|
(initrd_pend < (addr + size))) {
|
|
add_memory_region(initrd_pend,
|
|
(addr + size) - initrd_pend,
|
|
BOOT_MEM_RAM);
|
|
rd_flag = 1;
|
|
}
|
|
}
|
|
#endif
|
|
if (!rd_flag) {
|
|
if (addr > MAX_RAM_SIZE)
|
|
continue;
|
|
if (addr+size > MAX_RAM_SIZE)
|
|
size = MAX_RAM_SIZE - (addr+size) + 1;
|
|
/*
|
|
* memcpy/__copy_user prefetch, which
|
|
* will cause a bus error for
|
|
* KSEG/KUSEG addrs not backed by RAM.
|
|
* Hence, reserve some padding for the
|
|
* prefetch distance.
|
|
*/
|
|
if (size > 512)
|
|
size -= 512;
|
|
add_memory_region(addr, size, BOOT_MEM_RAM);
|
|
}
|
|
board_mem_region_addrs[board_mem_region_count] = addr;
|
|
board_mem_region_sizes[board_mem_region_count] = size;
|
|
board_mem_region_count++;
|
|
if (board_mem_region_count ==
|
|
SIBYTE_MAX_MEM_REGIONS) {
|
|
/*
|
|
* Too many regions. Need to configure more
|
|
*/
|
|
while(1);
|
|
}
|
|
}
|
|
}
|
|
#ifdef CONFIG_BLK_DEV_INITRD
|
|
if (initrd_start) {
|
|
add_memory_region(initrd_pstart, initrd_pend - initrd_pstart,
|
|
BOOT_MEM_RESERVED);
|
|
}
|
|
#endif
|
|
}
|
|
|
|
#ifdef CONFIG_BLK_DEV_INITRD
|
|
static int __init initrd_setup(char *str)
|
|
{
|
|
char rdarg[64];
|
|
int idx;
|
|
char *tmp, *endptr;
|
|
unsigned long initrd_size;
|
|
|
|
/* Make a copy of the initrd argument so we can smash it up here */
|
|
for (idx = 0; idx < sizeof(rdarg)-1; idx++) {
|
|
if (!str[idx] || (str[idx] == ' ')) break;
|
|
rdarg[idx] = str[idx];
|
|
}
|
|
|
|
rdarg[idx] = 0;
|
|
str = rdarg;
|
|
|
|
/*
|
|
*Initrd location comes in the form "<hex size of ramdisk in bytes>@<location in memory>"
|
|
* e.g. initrd=3abfd@80010000. This is set up by the loader.
|
|
*/
|
|
for (tmp = str; *tmp != '@'; tmp++) {
|
|
if (!*tmp) {
|
|
goto fail;
|
|
}
|
|
}
|
|
*tmp = 0;
|
|
tmp++;
|
|
if (!*tmp) {
|
|
goto fail;
|
|
}
|
|
initrd_size = simple_strtoul(str, &endptr, 16);
|
|
if (*endptr) {
|
|
*(tmp-1) = '@';
|
|
goto fail;
|
|
}
|
|
*(tmp-1) = '@';
|
|
initrd_start = simple_strtoul(tmp, &endptr, 16);
|
|
if (*endptr) {
|
|
goto fail;
|
|
}
|
|
initrd_end = initrd_start + initrd_size;
|
|
printk("Found initrd of %lx@%lx\n", initrd_size, initrd_start);
|
|
return 1;
|
|
fail:
|
|
printk("Bad initrd argument. Disabling initrd\n");
|
|
initrd_start = 0;
|
|
initrd_end = 0;
|
|
return 1;
|
|
}
|
|
|
|
#endif
|
|
|
|
extern struct plat_smp_ops sb_smp_ops;
|
|
extern struct plat_smp_ops bcm1480_smp_ops;
|
|
|
|
/*
|
|
* prom_init is called just after the cpu type is determined, from setup_arch()
|
|
*/
|
|
void __init prom_init(void)
|
|
{
|
|
uint64_t cfe_ept, cfe_handle;
|
|
unsigned int cfe_eptseal;
|
|
int argc = fw_arg0;
|
|
char **envp = (char **) fw_arg2;
|
|
int *prom_vec = (int *) fw_arg3;
|
|
|
|
_machine_restart = cfe_linux_restart;
|
|
_machine_halt = cfe_linux_halt;
|
|
pm_power_off = cfe_linux_halt;
|
|
|
|
/*
|
|
* Check if a loader was used; if NOT, the 4 arguments are
|
|
* what CFE gives us (handle, 0, EPT and EPTSEAL)
|
|
*/
|
|
if (argc < 0) {
|
|
cfe_handle = (uint64_t)(long)argc;
|
|
cfe_ept = (long)envp;
|
|
cfe_eptseal = (uint32_t)(unsigned long)prom_vec;
|
|
} else {
|
|
if ((int32_t)(long)prom_vec < 0) {
|
|
/*
|
|
* Old loader; all it gives us is the handle,
|
|
* so use the "known" entrypoint and assume
|
|
* the seal.
|
|
*/
|
|
cfe_handle = (uint64_t)(long)prom_vec;
|
|
cfe_ept = (uint64_t)((int32_t)0x9fc00500);
|
|
cfe_eptseal = CFE_EPTSEAL;
|
|
} else {
|
|
/*
|
|
* Newer loaders bundle the handle/ept/eptseal
|
|
* Note: prom_vec is in the loader's useg
|
|
* which is still alive in the TLB.
|
|
*/
|
|
cfe_handle = (uint64_t)((int32_t *)prom_vec)[0];
|
|
cfe_ept = (uint64_t)((int32_t *)prom_vec)[2];
|
|
cfe_eptseal = (unsigned int)((uint32_t *)prom_vec)[3];
|
|
}
|
|
}
|
|
if (cfe_eptseal != CFE_EPTSEAL) {
|
|
/* too early for panic to do any good */
|
|
printk("CFE's entrypoint seal doesn't match. Spinning.");
|
|
while (1) ;
|
|
}
|
|
cfe_init(cfe_handle, cfe_ept);
|
|
/*
|
|
* Get the handle for (at least) prom_putchar, possibly for
|
|
* boot console
|
|
*/
|
|
cfe_cons_handle = cfe_getstdhandle(CFE_STDHANDLE_CONSOLE);
|
|
if (cfe_getenv("LINUX_CMDLINE", arcs_cmdline, COMMAND_LINE_SIZE) < 0) {
|
|
if (argc >= 0) {
|
|
/* The loader should have set the command line */
|
|
/* too early for panic to do any good */
|
|
printk("LINUX_CMDLINE not defined in cfe.");
|
|
while (1) ;
|
|
}
|
|
}
|
|
|
|
#ifdef CONFIG_BLK_DEV_INITRD
|
|
{
|
|
char *ptr;
|
|
/* Need to find out early whether we've got an initrd. So scan
|
|
the list looking now */
|
|
for (ptr = arcs_cmdline; *ptr; ptr++) {
|
|
while (*ptr == ' ') {
|
|
ptr++;
|
|
}
|
|
if (!strncmp(ptr, "initrd=", 7)) {
|
|
initrd_setup(ptr+7);
|
|
break;
|
|
} else {
|
|
while (*ptr && (*ptr != ' ')) {
|
|
ptr++;
|
|
}
|
|
}
|
|
}
|
|
}
|
|
#endif /* CONFIG_BLK_DEV_INITRD */
|
|
|
|
/* Not sure this is needed, but it's the safe way. */
|
|
arcs_cmdline[COMMAND_LINE_SIZE-1] = 0;
|
|
|
|
prom_meminit();
|
|
|
|
#if defined(CONFIG_SIBYTE_BCM112X) || defined(CONFIG_SIBYTE_SB1250)
|
|
register_smp_ops(&sb_smp_ops);
|
|
#endif
|
|
#if defined(CONFIG_SIBYTE_BCM1x55) || defined(CONFIG_SIBYTE_BCM1x80)
|
|
register_smp_ops(&bcm1480_smp_ops);
|
|
#endif
|
|
}
|
|
|
|
void __init prom_free_prom_memory(void)
|
|
{
|
|
/* Not sure what I'm supposed to do here. Nothing, I think */
|
|
}
|
|
|
|
void prom_putchar(char c)
|
|
{
|
|
int ret;
|
|
|
|
while ((ret = cfe_write(cfe_cons_handle, &c, 1)) == 0)
|
|
;
|
|
}
|