xref: /OK3568_Linux_fs/kernel/arch/mips/alchemy/common/prom.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun  *
3*4882a593Smuzhiyun  * BRIEF MODULE DESCRIPTION
4*4882a593Smuzhiyun  *    PROM library initialisation code, supports YAMON and U-Boot.
5*4882a593Smuzhiyun  *
6*4882a593Smuzhiyun  * Copyright 2000-2001, 2006, 2008 MontaVista Software Inc.
7*4882a593Smuzhiyun  * Author: MontaVista Software, Inc. <source@mvista.com>
8*4882a593Smuzhiyun  *
9*4882a593Smuzhiyun  * This file was derived from Carsten Langgaard's
10*4882a593Smuzhiyun  * arch/mips/mips-boards/xx files.
11*4882a593Smuzhiyun  *
12*4882a593Smuzhiyun  * Carsten Langgaard, carstenl@mips.com
13*4882a593Smuzhiyun  * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
14*4882a593Smuzhiyun  *
15*4882a593Smuzhiyun  *  This program is free software; you can redistribute  it and/or modify it
16*4882a593Smuzhiyun  *  under  the terms of  the GNU General  Public License as published by the
17*4882a593Smuzhiyun  *  Free Software Foundation;  either version 2 of the  License, or (at your
18*4882a593Smuzhiyun  *  option) any later version.
19*4882a593Smuzhiyun  *
20*4882a593Smuzhiyun  *  THIS  SOFTWARE  IS PROVIDED   ``AS  IS'' AND   ANY  EXPRESS OR IMPLIED
21*4882a593Smuzhiyun  *  WARRANTIES,   INCLUDING, BUT NOT  LIMITED  TO, THE IMPLIED WARRANTIES OF
22*4882a593Smuzhiyun  *  MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.  IN
23*4882a593Smuzhiyun  *  NO  EVENT  SHALL   THE AUTHOR  BE    LIABLE FOR ANY   DIRECT, INDIRECT,
24*4882a593Smuzhiyun  *  INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
25*4882a593Smuzhiyun  *  NOT LIMITED   TO, PROCUREMENT OF  SUBSTITUTE GOODS  OR SERVICES; LOSS OF
26*4882a593Smuzhiyun  *  USE, DATA,  OR PROFITS; OR  BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON
27*4882a593Smuzhiyun  *  ANY THEORY OF LIABILITY, WHETHER IN  CONTRACT, STRICT LIABILITY, OR TORT
28*4882a593Smuzhiyun  *  (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
29*4882a593Smuzhiyun  *  THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
30*4882a593Smuzhiyun  *
31*4882a593Smuzhiyun  *  You should have received a copy of the  GNU General Public License along
32*4882a593Smuzhiyun  *  with this program; if not, write  to the Free Software Foundation, Inc.,
33*4882a593Smuzhiyun  *  675 Mass Ave, Cambridge, MA 02139, USA.
34*4882a593Smuzhiyun  */
35*4882a593Smuzhiyun 
36*4882a593Smuzhiyun #include <linux/init.h>
37*4882a593Smuzhiyun #include <linux/kernel.h>
38*4882a593Smuzhiyun #include <linux/memblock.h>
39*4882a593Smuzhiyun #include <linux/sizes.h>
40*4882a593Smuzhiyun #include <linux/string.h>
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun #include <asm/bootinfo.h>
43*4882a593Smuzhiyun 
44*4882a593Smuzhiyun int prom_argc;
45*4882a593Smuzhiyun char **prom_argv;
46*4882a593Smuzhiyun char **prom_envp;
47*4882a593Smuzhiyun 
prom_init_cmdline(void)48*4882a593Smuzhiyun void __init prom_init_cmdline(void)
49*4882a593Smuzhiyun {
50*4882a593Smuzhiyun 	int i;
51*4882a593Smuzhiyun 
52*4882a593Smuzhiyun 	for (i = 1; i < prom_argc; i++) {
53*4882a593Smuzhiyun 		strlcat(arcs_cmdline, prom_argv[i], COMMAND_LINE_SIZE);
54*4882a593Smuzhiyun 		if (i < (prom_argc - 1))
55*4882a593Smuzhiyun 			strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE);
56*4882a593Smuzhiyun 	}
57*4882a593Smuzhiyun }
58*4882a593Smuzhiyun 
prom_getenv(char * envname)59*4882a593Smuzhiyun char *prom_getenv(char *envname)
60*4882a593Smuzhiyun {
61*4882a593Smuzhiyun 	/*
62*4882a593Smuzhiyun 	 * Return a pointer to the given environment variable.
63*4882a593Smuzhiyun 	 * YAMON uses "name", "value" pairs, while U-Boot uses "name=value".
64*4882a593Smuzhiyun 	 */
65*4882a593Smuzhiyun 
66*4882a593Smuzhiyun 	char **env = prom_envp;
67*4882a593Smuzhiyun 	int i = strlen(envname);
68*4882a593Smuzhiyun 	int yamon = (*env && strchr(*env, '=') == NULL);
69*4882a593Smuzhiyun 
70*4882a593Smuzhiyun 	while (*env) {
71*4882a593Smuzhiyun 		if (yamon) {
72*4882a593Smuzhiyun 			if (strcmp(envname, *env++) == 0)
73*4882a593Smuzhiyun 				return *env;
74*4882a593Smuzhiyun 		} else if (strncmp(envname, *env, i) == 0 && (*env)[i] == '=')
75*4882a593Smuzhiyun 			return *env + i + 1;
76*4882a593Smuzhiyun 		env++;
77*4882a593Smuzhiyun 	}
78*4882a593Smuzhiyun 
79*4882a593Smuzhiyun 	return NULL;
80*4882a593Smuzhiyun }
81*4882a593Smuzhiyun 
prom_init(void)82*4882a593Smuzhiyun void __init prom_init(void)
83*4882a593Smuzhiyun {
84*4882a593Smuzhiyun 	unsigned char *memsize_str;
85*4882a593Smuzhiyun 	unsigned long memsize;
86*4882a593Smuzhiyun 
87*4882a593Smuzhiyun 	prom_argc = (int)fw_arg0;
88*4882a593Smuzhiyun 	prom_argv = (char **)fw_arg1;
89*4882a593Smuzhiyun 	prom_envp = (char **)fw_arg2;
90*4882a593Smuzhiyun 
91*4882a593Smuzhiyun 	prom_init_cmdline();
92*4882a593Smuzhiyun 
93*4882a593Smuzhiyun 	memsize_str = prom_getenv("memsize");
94*4882a593Smuzhiyun 	if (!memsize_str || kstrtoul(memsize_str, 0, &memsize))
95*4882a593Smuzhiyun 		memsize = SZ_64M; /* minimum memsize is 64MB RAM */
96*4882a593Smuzhiyun 
97*4882a593Smuzhiyun 	memblock_add(0, memsize);
98*4882a593Smuzhiyun }
99*4882a593Smuzhiyun 
str2hexnum(unsigned char c)100*4882a593Smuzhiyun static inline unsigned char str2hexnum(unsigned char c)
101*4882a593Smuzhiyun {
102*4882a593Smuzhiyun 	if (c >= '0' && c <= '9')
103*4882a593Smuzhiyun 		return c - '0';
104*4882a593Smuzhiyun 	if (c >= 'a' && c <= 'f')
105*4882a593Smuzhiyun 		return c - 'a' + 10;
106*4882a593Smuzhiyun 	if (c >= 'A' && c <= 'F')
107*4882a593Smuzhiyun 		return c - 'A' + 10;
108*4882a593Smuzhiyun 
109*4882a593Smuzhiyun 	return 0; /* foo */
110*4882a593Smuzhiyun }
111*4882a593Smuzhiyun 
str2eaddr(unsigned char * ea,unsigned char * str)112*4882a593Smuzhiyun static inline void str2eaddr(unsigned char *ea, unsigned char *str)
113*4882a593Smuzhiyun {
114*4882a593Smuzhiyun 	int i;
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 	for (i = 0; i < 6; i++) {
117*4882a593Smuzhiyun 		unsigned char num;
118*4882a593Smuzhiyun 
119*4882a593Smuzhiyun 		if ((*str == '.') || (*str == ':'))
120*4882a593Smuzhiyun 			str++;
121*4882a593Smuzhiyun 		num  = str2hexnum(*str++) << 4;
122*4882a593Smuzhiyun 		num |= str2hexnum(*str++);
123*4882a593Smuzhiyun 		ea[i] = num;
124*4882a593Smuzhiyun 	}
125*4882a593Smuzhiyun }
126*4882a593Smuzhiyun 
prom_get_ethernet_addr(char * ethernet_addr)127*4882a593Smuzhiyun int __init prom_get_ethernet_addr(char *ethernet_addr)
128*4882a593Smuzhiyun {
129*4882a593Smuzhiyun 	char *ethaddr_str;
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun 	/* Check the environment variables first */
132*4882a593Smuzhiyun 	ethaddr_str = prom_getenv("ethaddr");
133*4882a593Smuzhiyun 	if (!ethaddr_str) {
134*4882a593Smuzhiyun 		/* Check command line */
135*4882a593Smuzhiyun 		ethaddr_str = strstr(arcs_cmdline, "ethaddr=");
136*4882a593Smuzhiyun 		if (!ethaddr_str)
137*4882a593Smuzhiyun 			return -1;
138*4882a593Smuzhiyun 
139*4882a593Smuzhiyun 		ethaddr_str += strlen("ethaddr=");
140*4882a593Smuzhiyun 	}
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	str2eaddr(ethernet_addr, ethaddr_str);
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 	return 0;
145*4882a593Smuzhiyun }
146*4882a593Smuzhiyun 
prom_free_prom_memory(void)147*4882a593Smuzhiyun void __init prom_free_prom_memory(void)
148*4882a593Smuzhiyun {
149*4882a593Smuzhiyun }
150