1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20#include <linux/init.h>
21#include <linux/kernel.h>
22#include <linux/serial_reg.h>
23#include <linux/spinlock.h>
24#include <linux/module.h>
25#include <linux/string.h>
26#include <linux/io.h>
27#include <asm/bootinfo.h>
28
29#include <asm/mach-ar7/ar7.h>
30#include <asm/mach-ar7/prom.h>
31
32#define MAX_ENTRY 80
33
34struct env_var {
35 char *name;
36 char *value;
37};
38
39static struct env_var adam2_env[MAX_ENTRY];
40
41char *prom_getenv(const char *name)
42{
43 int i;
44
45 for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)
46 if (!strcmp(name, adam2_env[i].name))
47 return adam2_env[i].value;
48
49 return NULL;
50}
51EXPORT_SYMBOL(prom_getenv);
52
53static void __init ar7_init_cmdline(int argc, char *argv[])
54{
55 int i;
56
57 for (i = 1; i < argc; i++) {
58 strlcat(arcs_cmdline, argv[i], COMMAND_LINE_SIZE);
59 if (i < (argc - 1))
60 strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE);
61 }
62}
63
64struct psbl_rec {
65 u32 psbl_size;
66 u32 env_base;
67 u32 env_size;
68 u32 ffs_base;
69 u32 ffs_size;
70};
71
72static const char psp_env_version[] __initconst = "TIENV0.8";
73
74struct psp_env_chunk {
75 u8 num;
76 u8 ctrl;
77 u16 csum;
78 u8 len;
79 char data[11];
80} __packed;
81
82struct psp_var_map_entry {
83 u8 num;
84 char *value;
85};
86
87static const struct psp_var_map_entry psp_var_map[] = {
88 { 1, "cpufrequency" },
89 { 2, "memsize" },
90 { 3, "flashsize" },
91 { 4, "modetty0" },
92 { 5, "modetty1" },
93 { 8, "maca" },
94 { 9, "macb" },
95 { 28, "sysfrequency" },
96 { 38, "mipsfrequency" },
97};
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125#define PSP_ENV_SIZE 4096
126
127static char psp_env_data[PSP_ENV_SIZE] = { 0, };
128
129static char * __init lookup_psp_var_map(u8 num)
130{
131 int i;
132
133 for (i = 0; i < ARRAY_SIZE(psp_var_map); i++)
134 if (psp_var_map[i].num == num)
135 return psp_var_map[i].value;
136
137 return NULL;
138}
139
140static void __init add_adam2_var(char *name, char *value)
141{
142 int i;
143
144 for (i = 0; i < MAX_ENTRY; i++) {
145 if (!adam2_env[i].name) {
146 adam2_env[i].name = name;
147 adam2_env[i].value = value;
148 return;
149 } else if (!strcmp(adam2_env[i].name, name)) {
150 adam2_env[i].value = value;
151 return;
152 }
153 }
154}
155
156static int __init parse_psp_env(void *psp_env_base)
157{
158 int i, n;
159 char *name, *value;
160 struct psp_env_chunk *chunks = (struct psp_env_chunk *)psp_env_data;
161
162 memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE);
163
164 i = 1;
165 n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk);
166 while (i < n) {
167 if ((chunks[i].num == 0xff) || ((i + chunks[i].len) > n))
168 break;
169 value = chunks[i].data;
170 if (chunks[i].num) {
171 name = lookup_psp_var_map(chunks[i].num);
172 } else {
173 name = value;
174 value += strlen(name) + 1;
175 }
176 if (name)
177 add_adam2_var(name, value);
178 i += chunks[i].len;
179 }
180 return 0;
181}
182
183static void __init ar7_init_env(struct env_var *env)
184{
185 int i;
186 struct psbl_rec *psbl = (struct psbl_rec *)(KSEG1ADDR(0x14000300));
187 void *psp_env = (void *)KSEG1ADDR(psbl->env_base);
188
189 if (strcmp(psp_env, psp_env_version) == 0) {
190 parse_psp_env(psp_env);
191 } else {
192 for (i = 0; i < MAX_ENTRY; i++, env++)
193 if (env->name)
194 add_adam2_var(env->name, env->value);
195 }
196}
197
198static void __init console_config(void)
199{
200#ifdef CONFIG_SERIAL_8250_CONSOLE
201 char console_string[40];
202 int baud = 0;
203 char parity = '\0', bits = '\0', flow = '\0';
204 char *s, *p;
205
206 if (strstr(arcs_cmdline, "console="))
207 return;
208
209 s = prom_getenv("modetty0");
210 if (s) {
211 baud = simple_strtoul(s, &p, 10);
212 s = p;
213 if (*s == ',')
214 s++;
215 if (*s)
216 parity = *s++;
217 if (*s == ',')
218 s++;
219 if (*s)
220 bits = *s++;
221 if (*s == ',')
222 s++;
223 if (*s == 'h')
224 flow = 'r';
225 }
226
227 if (baud == 0)
228 baud = 38400;
229 if (parity != 'n' && parity != 'o' && parity != 'e')
230 parity = 'n';
231 if (bits != '7' && bits != '8')
232 bits = '8';
233
234 if (flow == 'r')
235 sprintf(console_string, " console=ttyS0,%d%c%c%c", baud,
236 parity, bits, flow);
237 else
238 sprintf(console_string, " console=ttyS0,%d%c%c", baud, parity,
239 bits);
240 strlcat(arcs_cmdline, console_string, COMMAND_LINE_SIZE);
241#endif
242}
243
244void __init prom_init(void)
245{
246 ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
247 ar7_init_env((struct env_var *)fw_arg2);
248 console_config();
249
250 ar7_gpio_init();
251}
252
253#define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))
254static inline unsigned int serial_in(int offset)
255{
256 return readl((void *)PORT(offset));
257}
258
259static inline void serial_out(int offset, int value)
260{
261 writel(value, (void *)PORT(offset));
262}
263
264int prom_putchar(char c)
265{
266 while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0)
267 ;
268 serial_out(UART_TX, c);
269 return 1;
270}
271
