| 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 |  | 
| Manuel Lauss | 2b877a3 | 2010-08-19 13:37:13 +0200 | [diff] [blame] | 46 | void __init prom_init_cmdline(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 47 | { | 
| Yoichi Yuasa | 10229f3 | 2010-02-01 22:06:56 +0900 | [diff] [blame] | 48 | 	int i; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 49 |  | 
| Yoichi Yuasa | 10229f3 | 2010-02-01 22:06:56 +0900 | [diff] [blame] | 50 | 	for (i = 1; i < prom_argc; i++) { | 
 | 51 | 		strlcat(arcs_cmdline, prom_argv[i], COMMAND_LINE_SIZE); | 
 | 52 | 		if (i < (prom_argc - 1)) | 
 | 53 | 			strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 54 | 	} | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 55 | } | 
 | 56 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 57 | char *prom_getenv(char *envname) | 
 | 58 | { | 
 | 59 | 	/* | 
 | 60 | 	 * Return a pointer to the given environment variable. | 
| Domen Puncer | 6fe725c | 2006-07-03 08:17:09 +0200 | [diff] [blame] | 61 | 	 * YAMON uses "name", "value" pairs, while U-Boot uses "name=value". | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 62 | 	 */ | 
 | 63 |  | 
| Domen Puncer | 6fe725c | 2006-07-03 08:17:09 +0200 | [diff] [blame] | 64 | 	char **env = prom_envp; | 
 | 65 | 	int i = strlen(envname); | 
 | 66 | 	int yamon = (*env && strchr(*env, '=') == NULL); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 67 |  | 
| Domen Puncer | 6fe725c | 2006-07-03 08:17:09 +0200 | [diff] [blame] | 68 | 	while (*env) { | 
 | 69 | 		if (yamon) { | 
 | 70 | 			if (strcmp(envname, *env++) == 0) | 
 | 71 | 				return *env; | 
| Sergei Shtylyov | c1dcb14 | 2008-04-30 23:18:41 +0400 | [diff] [blame] | 72 | 		} else if (strncmp(envname, *env, i) == 0 && (*env)[i] == '=') | 
 | 73 | 			return *env + i + 1; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 74 | 		env++; | 
 | 75 | 	} | 
| Yoichi Yuasa | 25b31cb | 2007-10-15 19:11:24 +0900 | [diff] [blame] | 76 |  | 
| Sergei Shtylyov | fef6d6a | 2006-05-27 23:36:41 +0400 | [diff] [blame] | 77 | 	return NULL; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 78 | } | 
 | 79 |  | 
| Yoichi Yuasa | 2de8892 | 2007-10-15 19:06:20 +0900 | [diff] [blame] | 80 | static inline unsigned char str2hexnum(unsigned char c) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 81 | { | 
| Yoichi Yuasa | 25b31cb | 2007-10-15 19:11:24 +0900 | [diff] [blame] | 82 | 	if (c >= '0' && c <= '9') | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 83 | 		return c - '0'; | 
| Yoichi Yuasa | 25b31cb | 2007-10-15 19:11:24 +0900 | [diff] [blame] | 84 | 	if (c >= 'a' && c <= 'f') | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 85 | 		return c - 'a' + 10; | 
| Yoichi Yuasa | 25b31cb | 2007-10-15 19:11:24 +0900 | [diff] [blame] | 86 | 	if (c >= 'A' && c <= 'F') | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 87 | 		return c - 'A' + 10; | 
| Yoichi Yuasa | 25b31cb | 2007-10-15 19:11:24 +0900 | [diff] [blame] | 88 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 89 | 	return 0; /* foo */ | 
 | 90 | } | 
 | 91 |  | 
| Yoichi Yuasa | 2de8892 | 2007-10-15 19:06:20 +0900 | [diff] [blame] | 92 | static inline void str2eaddr(unsigned char *ea, unsigned char *str) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 93 | { | 
 | 94 | 	int i; | 
 | 95 |  | 
| Sergei Shtylyov | c1dcb14 | 2008-04-30 23:18:41 +0400 | [diff] [blame] | 96 | 	for (i = 0; i < 6; i++) { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 97 | 		unsigned char num; | 
 | 98 |  | 
| Sergei Shtylyov | c1dcb14 | 2008-04-30 23:18:41 +0400 | [diff] [blame] | 99 | 		if ((*str == '.') || (*str == ':')) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 100 | 			str++; | 
| Sergei Shtylyov | c1dcb14 | 2008-04-30 23:18:41 +0400 | [diff] [blame] | 101 | 		num  = str2hexnum(*str++) << 4; | 
 | 102 | 		num |= str2hexnum(*str++); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 103 | 		ea[i] = num; | 
 | 104 | 	} | 
 | 105 | } | 
 | 106 |  | 
| Manuel Lauss | 2b877a3 | 2010-08-19 13:37:13 +0200 | [diff] [blame] | 107 | int __init prom_get_ethernet_addr(char *ethernet_addr) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 108 | { | 
| Yoichi Yuasa | 2de8892 | 2007-10-15 19:06:20 +0900 | [diff] [blame] | 109 | 	char *ethaddr_str; | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 110 |  | 
| Yoichi Yuasa | 2de8892 | 2007-10-15 19:06:20 +0900 | [diff] [blame] | 111 | 	/* Check the environment variables first */ | 
 | 112 | 	ethaddr_str = prom_getenv("ethaddr"); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 113 | 	if (!ethaddr_str) { | 
| Yoichi Yuasa | 2de8892 | 2007-10-15 19:06:20 +0900 | [diff] [blame] | 114 | 		/* Check command line */ | 
| Yoichi Yuasa | ae7cbef | 2010-02-01 22:05:57 +0900 | [diff] [blame] | 115 | 		ethaddr_str = strstr(arcs_cmdline, "ethaddr="); | 
| Yoichi Yuasa | 2de8892 | 2007-10-15 19:06:20 +0900 | [diff] [blame] | 116 | 		if (!ethaddr_str) | 
 | 117 | 			return -1; | 
 | 118 |  | 
 | 119 | 		ethaddr_str += strlen("ethaddr="); | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 120 | 	} | 
| Yoichi Yuasa | 2de8892 | 2007-10-15 19:06:20 +0900 | [diff] [blame] | 121 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 122 | 	str2eaddr(ethernet_addr, ethaddr_str); | 
 | 123 |  | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 124 | 	return 0; | 
 | 125 | } | 
 | 126 |  | 
| Atsushi Nemoto | c44e8d5 | 2006-12-30 00:43:59 +0900 | [diff] [blame] | 127 | void __init prom_free_prom_memory(void) | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 128 | { | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 129 | } |