2 * Copyright (C) 2006, 2007 OpenWrt.org
4 * Carsten Langgaard, carstenl@mips.com
5 * Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved.
7 * This program is free software; you can distribute it and/or modify it
8 * under the terms of the GNU General Public License (Version 2) as
9 * published by the Free Software Foundation.
11 * This program is distributed in the hope it will be useful, but WITHOUT
12 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
13 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
16 * You should have received a copy of the GNU General Public License along
17 * with this program; if not, write to the Free Software Foundation, Inc.,
18 * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
20 * Putting things on the screen/serial line using YAMONs facilities.
22 #include <linux/init.h>
23 #include <linux/kernel.h>
24 #include <linux/serial_reg.h>
25 #include <linux/spinlock.h>
26 #include <linux/module.h>
27 #include <linux/string.h>
29 #include <asm/bootinfo.h>
30 #include <asm/gdb-stub.h>
32 #include <asm/ar7/ar7.h>
33 #include <asm/ar7/prom.h>
42 static struct env_var adam2_env[MAX_ENTRY] = { { 0, }, };
44 char *prom_getenv(char *name)
47 for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)
48 if (!strcmp(name, adam2_env[i].name))
49 return adam2_env[i].value;
53 EXPORT_SYMBOL(prom_getenv);
55 char * __init prom_getcmdline(void)
57 return &(arcs_cmdline[0]);
60 static void __init ar7_init_cmdline(int argc, char *argv[])
65 actr = 1; /* Always ignore argv[0] */
67 cp = &(arcs_cmdline[0]);
69 strcpy(cp, argv[actr]);
70 cp += strlen(argv[actr]);
74 if (cp != &(arcs_cmdline[0])) {
75 /* get rid of trailing space */
89 static __initdata char psp_env_version[] = "TIENV0.8";
91 struct psp_env_chunk {
97 } __attribute__ ((packed));
99 struct psp_var_map_entry {
104 static struct psp_var_map_entry psp_var_map[] = {
105 { 1, "cpufrequency" },
112 { 28, "sysfrequency" },
113 { 38, "mipsfrequency" },
118 Well-known variable (num is looked up in table above for matching variable name)
119 Example: cpufrequency=211968000
120 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
121 | 01 |CTRL|CHECKSUM | 01 | _2 | _1 | _1 | _9 | _6 | _8 | _0 | _0 | _0 | \0 | FF
122 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
124 Name=Value pair in a single chunk
126 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
127 | 00 |CTRL|CHECKSUM | 01 | _N | _A | _M | _E | _0 | _V | _A | _L | _U | _E | \0
128 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
130 Name=Value pair in 2 chunks (len is the number of chunks)
131 Example: bootloaderVersion=1.3.7.15
132 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
133 | 00 |CTRL|CHECKSUM | 02 | _b | _o | _o | _t | _l | _o | _a | _d | _e | _r | _V
134 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
135 | _e | _r | _s | _i | _o | _n | \0 | _1 | _. | _3 | _. | _7 | _. | _1 | _5 | \0
136 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
138 Data is padded with 0xFF
142 #define PSP_ENV_SIZE 4096
144 static char psp_env_data[PSP_ENV_SIZE] = { 0, };
146 static char * __init lookup_psp_var_map(u8 num)
150 for (i = 0; i < sizeof(psp_var_map); i++)
151 if (psp_var_map[i].num == num)
152 return psp_var_map[i].value;
157 static void __init add_adam2_var(char *name, char *value)
160 for (i = 0; i < MAX_ENTRY; i++) {
161 if (!adam2_env[i].name) {
162 adam2_env[i].name = name;
163 adam2_env[i].value = value;
165 } else if (!strcmp(adam2_env[i].name, name)) {
166 adam2_env[i].value = value;
172 static int __init parse_psp_env(void *psp_env_base)
176 struct psp_env_chunk *chunks = (struct psp_env_chunk *)psp_env_data;
178 memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE);
181 n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk);
183 if ((chunks[i].num == 0xff) || ((i + chunks[i].len) > n))
185 value = chunks[i].data;
187 name = lookup_psp_var_map(chunks[i].num);
190 value += strlen(name) + 1;
193 add_adam2_var(name, value);
199 static void __init ar7_init_env(struct env_var *env)
202 struct psbl_rec *psbl = (struct psbl_rec *)(KSEG1ADDR(0x14000300));
203 void *psp_env = (void *)KSEG1ADDR(psbl->env_base);
205 if (strcmp(psp_env, psp_env_version) == 0) {
206 parse_psp_env(psp_env);
208 for (i = 0; i < MAX_ENTRY; i++, env++)
210 add_adam2_var(env->name, env->value);
214 static void __init console_config(void)
216 #ifdef CONFIG_SERIAL_8250_CONSOLE
217 char console_string[40];
219 char parity = '\0', bits = '\0', flow = '\0';
222 if (strstr(prom_getcmdline(), "console="))
226 if (!strstr(prom_getcmdline(), "nokgdb")) {
227 strcat(prom_getcmdline(), " console=kgdb");
233 if ((s = prom_getenv("modetty0"))) {
234 baud = simple_strtoul(s, &p, 10);
237 if (*s) parity = *s++;
241 if (*s == 'h') flow = 'r';
246 if (parity != 'n' && parity != 'o' && parity != 'e')
248 if (bits != '7' && bits != '8')
253 sprintf(console_string, " console=ttyS0,%d%c%c%c", baud,
255 strcat(prom_getcmdline(), console_string);
259 void __init prom_init(void)
261 ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
262 ar7_init_env((struct env_var *)fw_arg2);
266 #define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))
267 static inline unsigned int serial_in(int offset)
269 return readb((void *)PORT(offset));
272 static inline void serial_out(int offset, int value)
274 writeb(value, (void *)PORT(offset));
277 char prom_getchar(void)
279 while (!(serial_in(UART_LSR) & UART_LSR_DR));
280 return serial_in(UART_RX);
283 int prom_putchar(char c)
285 while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0);
286 serial_out(UART_TX, c);
290 /* from adm5120/prom.c */
291 void prom_printf(char *fmt, ...)
299 l = vsprintf(buf, fmt, args); /* hopefully i < sizeof(buf) */
304 for (p = buf; p < buf_end; p++) {
305 /* Crude cr/nl handling is better than none */
313 int putDebugChar(char c)
315 return prom_putchar(c);
318 char getDebugChar(void)
320 return prom_getchar();