88 lines
1.7 KiB
C
88 lines
1.7 KiB
C
|
/*
|
||
|
|
* Copyright (c) 2011 Zhang, Keguang <keguang.zhang@gmail.com>
|
||
|
|
*
|
||
|
|
* Modified from arch/mips/pnx833x/common/prom.c.
|
||
|
|
*
|
||
|
|
* 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.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include <linux/serial_reg.h>
|
||
|
|
#include <asm/bootinfo.h>
|
||
|
|
|
||
|
|
#include <loongson1.h>
|
||
|
|
#include <prom.h>
|
||
|
|
|
||
|
|
int prom_argc;
|
||
|
|
char **prom_argv, **prom_envp;
|
||
|
|
unsigned long memsize, highmemsize;
|
||
|
|
|
||
|
|
char *prom_getenv(char *envname)
|
||
|
|
{
|
||
|
|
char **env = prom_envp;
|
||
|
|
int i;
|
||
|
|
|
||
|
|
i = strlen(envname);
|
||
|
|
|
||
|
|
while (*env) {
|
||
|
|
if (strncmp(envname, *env, i) == 0 && *(*env+i) == '=')
|
||
|
|
return *env + i + 1;
|
||
|
|
env++;
|
||
|
|
}
|
||
|
|
|
||
|
|
return 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
static inline unsigned long env_or_default(char *env, unsigned long dfl)
|
||
|
|
{
|
||
|
|
char *str = prom_getenv(env);
|
||
|
|
return str ? simple_strtol(str, 0, 0) : dfl;
|
||
|
|
}
|
||
|
|
|
||
|
|
void __init prom_init_cmdline(void)
|
||
|
|
{
|
||
|
|
char *c = &(arcs_cmdline[0]);
|
||
|
|
int i;
|
||
|
|
|
||
|
|
for (i = 1; i < prom_argc; i++) {
|
||
|
|
strcpy(c, prom_argv[i]);
|
||
|
|
c += strlen(prom_argv[i]);
|
||
|
|
if (i < prom_argc-1)
|
||
|
|
*c++ = ' ';
|
||
|
|
}
|
||
|
|
*c = 0;
|
||
|
|
}
|
||
|
|
|
||
|
|
void __init prom_init(void)
|
||
|
|
{
|
||
|
|
prom_argc = fw_arg0;
|
||
|
|
prom_argv = (char **)fw_arg1;
|
||
|
|
prom_envp = (char **)fw_arg2;
|
||
|
|
|
||
|
|
prom_init_cmdline();
|
||
|
|
|
||
|
|
memsize = env_or_default("memsize", DEFAULT_MEMSIZE);
|
||
|
|
highmemsize = env_or_default("highmemsize", 0x0);
|
||
|
|
}
|
||
|
|
|
||
|
|
void __init prom_free_prom_memory(void)
|
||
|
|
{
|
||
|
|
}
|
||
|
|
|
||
|
|
#define PORT(offset) (u8 *)(KSEG1ADDR(LS1X_UART0_BASE + offset))
|
||
|
|
|
||
|
|
void prom_putchar(char c)
|
||
|
|
{
|
||
|
|
int timeout;
|
||
|
|
|
||
|
|
timeout = 1024;
|
||
|
|
|
||
|
|
while (((readb(PORT(UART_LSR)) & UART_LSR_THRE) == 0)
|
||
|
|
&& (timeout-- > 0))
|
||
|
|
;
|
||
|
|
|
||
|
|
writeb(c, PORT(UART_TX));
|
||
|
|
}
|