1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36#include <linux/init.h>
37#include <linux/kernel.h>
38#include <linux/memblock.h>
39#include <linux/sizes.h>
40#include <linux/string.h>
41
42#include <asm/bootinfo.h>
43
44int prom_argc;
45char **prom_argv;
46char **prom_envp;
47
48void __init prom_init_cmdline(void)
49{
50 int i;
51
52 for (i = 1; i < prom_argc; i++) {
53 strlcat(arcs_cmdline, prom_argv[i], COMMAND_LINE_SIZE);
54 if (i < (prom_argc - 1))
55 strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE);
56 }
57}
58
59char *prom_getenv(char *envname)
60{
61
62
63
64
65
66 char **env = prom_envp;
67 int i = strlen(envname);
68 int yamon = (*env && strchr(*env, '=') == NULL);
69
70 while (*env) {
71 if (yamon) {
72 if (strcmp(envname, *env++) == 0)
73 return *env;
74 } else if (strncmp(envname, *env, i) == 0 && (*env)[i] == '=')
75 return *env + i + 1;
76 env++;
77 }
78
79 return NULL;
80}
81
82void __init prom_init(void)
83{
84 unsigned char *memsize_str;
85 unsigned long memsize;
86
87 prom_argc = (int)fw_arg0;
88 prom_argv = (char **)fw_arg1;
89 prom_envp = (char **)fw_arg2;
90
91 prom_init_cmdline();
92
93 memsize_str = prom_getenv("memsize");
94 if (!memsize_str || kstrtoul(memsize_str, 0, &memsize))
95 memsize = SZ_64M;
96
97 memblock_add(0, memsize);
98}
99
100static inline unsigned char str2hexnum(unsigned char c)
101{
102 if (c >= '0' && c <= '9')
103 return c - '0';
104 if (c >= 'a' && c <= 'f')
105 return c - 'a' + 10;
106 if (c >= 'A' && c <= 'F')
107 return c - 'A' + 10;
108
109 return 0;
110}
111
112static inline void str2eaddr(unsigned char *ea, unsigned char *str)
113{
114 int i;
115
116 for (i = 0; i < 6; i++) {
117 unsigned char num;
118
119 if ((*str == '.') || (*str == ':'))
120 str++;
121 num = str2hexnum(*str++) << 4;
122 num |= str2hexnum(*str++);
123 ea[i] = num;
124 }
125}
126
127int __init prom_get_ethernet_addr(char *ethernet_addr)
128{
129 char *ethaddr_str;
130
131
132 ethaddr_str = prom_getenv("ethaddr");
133 if (!ethaddr_str) {
134
135 ethaddr_str = strstr(arcs_cmdline, "ethaddr=");
136 if (!ethaddr_str)
137 return -1;
138
139 ethaddr_str += strlen("ethaddr=");
140 }
141
142 str2eaddr(ethernet_addr, ethaddr_str);
143
144 return 0;
145}
146