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