124 lines
3 KiB
C
124 lines
3 KiB
C
/*****************************************************************************
|
|
* Carsten Langgaard, carstenl@mips.com
|
|
* Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved.
|
|
* Copyright (C) 2003 ADMtek Incorporated.
|
|
* daniell@admtek.com.tw
|
|
* Copyright (C) 2007 OpenWrt.org
|
|
*
|
|
* This program is free software; you can distribute it and/or modify it
|
|
* under the terms of the GNU General Public License (Version 2) as
|
|
* published by the Free Software Foundation.
|
|
*
|
|
* This program is distributed in the hope 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/autoconf.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/string.h>
|
|
#include <linux/mm.h>
|
|
#include <linux/bootmem.h>
|
|
|
|
#include <asm/bootinfo.h>
|
|
#include <asm/addrspace.h>
|
|
|
|
#include <asm/mach-adm5120/adm5120_info.h>
|
|
|
|
static char **prom_envp;
|
|
|
|
void setup_prom_printf(int);
|
|
void prom_printf(char *, ...);
|
|
void prom_meminit(void);
|
|
|
|
|
|
#define READCSR(r) *(volatile unsigned long *)(0xB2600000+(r))
|
|
#define WRITECSR(r,v) *(volatile unsigned long *)(0xB2600000+(r)) = v
|
|
|
|
#define UART_DR_REG 0x00
|
|
#define UART_FR_REG 0x18
|
|
#define UART_TX_FIFO_FULL 0x20
|
|
|
|
int putPromChar(char c)
|
|
{
|
|
WRITECSR(UART_DR_REG, c);
|
|
while ( (READCSR(UART_FR_REG) & UART_TX_FIFO_FULL) );
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Ugly prom_printf used for debugging
|
|
*/
|
|
|
|
void prom_printf(char *fmt, ...)
|
|
{
|
|
va_list args;
|
|
int l;
|
|
char *p, *buf_end;
|
|
char buf[1024];
|
|
|
|
va_start(args, fmt);
|
|
l = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf) */
|
|
va_end(args);
|
|
|
|
buf_end = buf + l;
|
|
|
|
for (p = buf; p < buf_end; p++) {
|
|
/* Crude cr/nl handling is better than none */
|
|
if (*p == '\n')
|
|
putPromChar('\r');
|
|
putPromChar(*p);
|
|
}
|
|
}
|
|
|
|
char *prom_getenv(char *envname)
|
|
{
|
|
char **env;
|
|
char *ret;
|
|
|
|
ret = NULL;
|
|
|
|
if (prom_envp== NULL)
|
|
return NULL;
|
|
|
|
for (env = prom_envp; *env != NULL; env++) {
|
|
if (strcmp(envname, *env++) == 0) {
|
|
ret = *env;
|
|
break;
|
|
}
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
extern char _image_cmdline;
|
|
/*
|
|
* initialize the prom module.
|
|
*/
|
|
void __init prom_init(void)
|
|
{
|
|
char *cmd;
|
|
|
|
prom_envp = (char **)fw_arg2;
|
|
|
|
adm5120_info_init();
|
|
|
|
/* you should these macros defined in include/asm/bootinfo.h */
|
|
mips_machgroup = MACH_GROUP_ADM5120;
|
|
mips_machtype = adm5120_board.mach_type;
|
|
|
|
/* init command line, register a default kernel command line */
|
|
cmd = &_image_cmdline + 8;
|
|
if( strlen(cmd) > 0) strcpy( &(arcs_cmdline[0]), cmd);
|
|
else strcpy(&(arcs_cmdline[0]), CONFIG_CMDLINE);
|
|
|
|
/* init memory map */
|
|
prom_meminit();
|
|
}
|