130 lines
2.4 KiB
C
130 lines
2.4 KiB
C
|
/*
|
||
|
*
|
||
|
* Per Hallsmark, per.hallsmark@mvista.com
|
||
|
*
|
||
|
* Based on jmr3927/common/prom.c
|
||
|
*
|
||
|
* 2004 (c) MontaVista Software, Inc. This file is licensed under the
|
||
|
* terms of the GNU General Public License version 2. This program is
|
||
|
* licensed "as is" without any warranty of any kind, whether express
|
||
|
* or implied.
|
||
|
*/
|
||
|
#include <linux/module.h>
|
||
|
#include <linux/kernel.h>
|
||
|
#include <linux/init.h>
|
||
|
#include <linux/string.h>
|
||
|
#include <linux/serial_pnx8xxx.h>
|
||
|
|
||
|
#include <asm/bootinfo.h>
|
||
|
#include <uart.h>
|
||
|
|
||
|
/* #define DEBUG_CMDLINE */
|
||
|
|
||
|
extern int prom_argc;
|
||
|
extern char **prom_argv, **prom_envp;
|
||
|
|
||
|
typedef struct
|
||
|
{
|
||
|
char *name;
|
||
|
/* char *val; */
|
||
|
}t_env_var;
|
||
|
|
||
|
|
||
|
char * prom_getcmdline(void)
|
||
|
{
|
||
|
return &(arcs_cmdline[0]);
|
||
|
}
|
||
|
|
||
|
void __init prom_init_cmdline(void)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
arcs_cmdline[0] = '\0';
|
||
|
for (i = 0; i < prom_argc; i++) {
|
||
|
strcat(arcs_cmdline, prom_argv[i]);
|
||
|
strcat(arcs_cmdline, " ");
|
||
|
}
|
||
|
}
|
||
|
|
||
|
char *prom_getenv(char *envname)
|
||
|
{
|
||
|
/*
|
||
|
* Return a pointer to the given environment variable.
|
||
|
* Environment variables are stored in the form of "memsize=64".
|
||
|
*/
|
||
|
|
||
|
t_env_var *env = (t_env_var *)prom_envp;
|
||
|
int i;
|
||
|
|
||
|
i = strlen(envname);
|
||
|
|
||
|
while(env->name) {
|
||
|
if(strncmp(envname, env->name, i) == 0) {
|
||
|
return(env->name + strlen(envname) + 1);
|
||
|
}
|
||
|
env++;
|
||
|
}
|
||
|
return(NULL);
|
||
|
}
|
||
|
|
||
|
inline unsigned char str2hexnum(unsigned char c)
|
||
|
{
|
||
|
if(c >= '0' && c <= '9')
|
||
|
return c - '0';
|
||
|
if(c >= 'a' && c <= 'f')
|
||
|
return c - 'a' + 10;
|
||
|
if(c >= 'A' && c <= 'F')
|
||
|
return c - 'A' + 10;
|
||
|
return 0; /* foo */
|
||
|
}
|
||
|
|
||
|
inline void str2eaddr(unsigned char *ea, unsigned char *str)
|
||
|
{
|
||
|
int i;
|
||
|
|
||
|
for(i = 0; i < 6; i++) {
|
||
|
unsigned char num;
|
||
|
|
||
|
if((*str == '.') || (*str == ':'))
|
||
|
str++;
|
||
|
num = str2hexnum(*str++) << 4;
|
||
|
num |= (str2hexnum(*str++));
|
||
|
ea[i] = num;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
int get_ethernet_addr(char *ethernet_addr)
|
||
|
{
|
||
|
char *ethaddr_str;
|
||
|
|
||
|
ethaddr_str = prom_getenv("ethaddr");
|
||
|
if (!ethaddr_str) {
|
||
|
printk("ethaddr not set in boot prom\n");
|
||
|
return -1;
|
||
|
}
|
||
|
str2eaddr(ethernet_addr, ethaddr_str);
|
||
|
return 0;
|
||
|
}
|
||
|
|
||
|
void __init prom_free_prom_memory(void)
|
||
|
{
|
||
|
}
|
||
|
|
||
|
extern int pnx8550_console_port;
|
||
|
|
||
|
/* used by early printk */
|
||
|
void prom_putchar(char c)
|
||
|
{
|
||
|
if (pnx8550_console_port != -1) {
|
||
|
/* Wait until FIFO not full */
|
||
|
while( ((ip3106_fifo(UART_BASE, pnx8550_console_port) & PNX8XXX_UART_FIFO_TXFIFO) >> 16) >= 16)
|
||
|
;
|
||
|
/* Send one char */
|
||
|
ip3106_fifo(UART_BASE, pnx8550_console_port) = c;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
EXPORT_SYMBOL(prom_getcmdline);
|
||
|
EXPORT_SYMBOL(get_ethernet_addr);
|
||
|
EXPORT_SYMBOL(str2eaddr);
|