1 // SPDX-License-Identifier: GPL-2.0-only 2 /* 3 * Carsten Langgaard, carstenl@mips.com 4 * Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved. 5 * 6 * Putting things on the screen/serial line using YAMONs facilities. 7 */ 8 #include <linux/init.h> 9 #include <linux/kernel.h> 10 #include <linux/serial_reg.h> 11 #include <linux/spinlock.h> 12 #include <linux/export.h> 13 #include <linux/string.h> 14 #include <linux/io.h> 15 #include <asm/bootinfo.h> 16 #include <asm/setup.h> 17 18 #include <asm/mach-ar7/ar7.h> 19 #include <asm/mach-ar7/prom.h> 20 21 #define MAX_ENTRY 80 22 23 struct env_var { 24 char *name; 25 char *value; 26 }; 27 28 static struct env_var adam2_env[MAX_ENTRY]; 29 prom_getenv(const char * name)30 char *prom_getenv(const char *name) 31 { 32 int i; 33 34 for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++) 35 if (!strcmp(name, adam2_env[i].name)) 36 return adam2_env[i].value; 37 38 return NULL; 39 } 40 EXPORT_SYMBOL(prom_getenv); 41 ar7_init_cmdline(int argc,char * argv[])42 static void __init ar7_init_cmdline(int argc, char *argv[]) 43 { 44 int i; 45 46 for (i = 1; i < argc; i++) { 47 strlcat(arcs_cmdline, argv[i], COMMAND_LINE_SIZE); 48 if (i < (argc - 1)) 49 strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE); 50 } 51 } 52 53 struct psbl_rec { 54 u32 psbl_size; 55 u32 env_base; 56 u32 env_size; 57 u32 ffs_base; 58 u32 ffs_size; 59 }; 60 61 static const char psp_env_version[] __initconst = "TIENV0.8"; 62 63 struct psp_env_chunk { 64 u8 num; 65 u8 ctrl; 66 u16 csum; 67 u8 len; 68 char data[11]; 69 } __packed; 70 71 struct psp_var_map_entry { 72 u8 num; 73 char *value; 74 }; 75 76 static const struct psp_var_map_entry psp_var_map[] = { 77 { 1, "cpufrequency" }, 78 { 2, "memsize" }, 79 { 3, "flashsize" }, 80 { 4, "modetty0" }, 81 { 5, "modetty1" }, 82 { 8, "maca" }, 83 { 9, "macb" }, 84 { 28, "sysfrequency" }, 85 { 38, "mipsfrequency" }, 86 }; 87 88 /* 89 90 Well-known variable (num is looked up in table above for matching variable name) 91 Example: cpufrequency=211968000 92 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 93 | 01 |CTRL|CHECKSUM | 01 | _2 | _1 | _1 | _9 | _6 | _8 | _0 | _0 | _0 | \0 | FF 94 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 95 96 Name=Value pair in a single chunk 97 Example: NAME=VALUE 98 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 99 | 00 |CTRL|CHECKSUM | 01 | _N | _A | _M | _E | _0 | _V | _A | _L | _U | _E | \0 100 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 101 102 Name=Value pair in 2 chunks (len is the number of chunks) 103 Example: bootloaderVersion=1.3.7.15 104 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 105 | 00 |CTRL|CHECKSUM | 02 | _b | _o | _o | _t | _l | _o | _a | _d | _e | _r | _V 106 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 107 | _e | _r | _s | _i | _o | _n | \0 | _1 | _. | _3 | _. | _7 | _. | _1 | _5 | \0 108 +----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 109 110 Data is padded with 0xFF 111 112 */ 113 114 #define PSP_ENV_SIZE 4096 115 116 static char psp_env_data[PSP_ENV_SIZE] = { 0, }; 117 lookup_psp_var_map(u8 num)118 static char * __init lookup_psp_var_map(u8 num) 119 { 120 int i; 121 122 for (i = 0; i < ARRAY_SIZE(psp_var_map); i++) 123 if (psp_var_map[i].num == num) 124 return psp_var_map[i].value; 125 126 return NULL; 127 } 128 add_adam2_var(char * name,char * value)129 static void __init add_adam2_var(char *name, char *value) 130 { 131 int i; 132 133 for (i = 0; i < MAX_ENTRY; i++) { 134 if (!adam2_env[i].name) { 135 adam2_env[i].name = name; 136 adam2_env[i].value = value; 137 return; 138 } else if (!strcmp(adam2_env[i].name, name)) { 139 adam2_env[i].value = value; 140 return; 141 } 142 } 143 } 144 parse_psp_env(void * psp_env_base)145 static int __init parse_psp_env(void *psp_env_base) 146 { 147 int i, n; 148 char *name, *value; 149 struct psp_env_chunk *chunks = (struct psp_env_chunk *)psp_env_data; 150 151 memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE); 152 153 i = 1; 154 n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk); 155 while (i < n) { 156 if ((chunks[i].num == 0xff) || ((i + chunks[i].len) > n)) 157 break; 158 value = chunks[i].data; 159 if (chunks[i].num) { 160 name = lookup_psp_var_map(chunks[i].num); 161 } else { 162 name = value; 163 value += strlen(name) + 1; 164 } 165 if (name) 166 add_adam2_var(name, value); 167 i += chunks[i].len; 168 } 169 return 0; 170 } 171 ar7_init_env(struct env_var * env)172 static void __init ar7_init_env(struct env_var *env) 173 { 174 int i; 175 struct psbl_rec *psbl = (struct psbl_rec *)(KSEG1ADDR(0x14000300)); 176 void *psp_env = (void *)KSEG1ADDR(psbl->env_base); 177 178 if (strcmp(psp_env, psp_env_version) == 0) { 179 parse_psp_env(psp_env); 180 } else { 181 for (i = 0; i < MAX_ENTRY; i++, env++) 182 if (env->name) 183 add_adam2_var(env->name, env->value); 184 } 185 } 186 console_config(void)187 static void __init console_config(void) 188 { 189 #ifdef CONFIG_SERIAL_8250_CONSOLE 190 char console_string[40]; 191 int baud = 0; 192 char parity = '\0', bits = '\0', flow = '\0'; 193 char *s, *p; 194 195 if (strstr(arcs_cmdline, "console=")) 196 return; 197 198 s = prom_getenv("modetty0"); 199 if (s) { 200 baud = simple_strtoul(s, &p, 10); 201 s = p; 202 if (*s == ',') 203 s++; 204 if (*s) 205 parity = *s++; 206 if (*s == ',') 207 s++; 208 if (*s) 209 bits = *s++; 210 if (*s == ',') 211 s++; 212 if (*s == 'h') 213 flow = 'r'; 214 } 215 216 if (baud == 0) 217 baud = 38400; 218 if (parity != 'n' && parity != 'o' && parity != 'e') 219 parity = 'n'; 220 if (bits != '7' && bits != '8') 221 bits = '8'; 222 223 if (flow == 'r') 224 sprintf(console_string, " console=ttyS0,%d%c%c%c", baud, 225 parity, bits, flow); 226 else 227 sprintf(console_string, " console=ttyS0,%d%c%c", baud, parity, 228 bits); 229 strlcat(arcs_cmdline, console_string, COMMAND_LINE_SIZE); 230 #endif 231 } 232 prom_init(void)233 void __init prom_init(void) 234 { 235 ar7_init_cmdline(fw_arg0, (char **)fw_arg1); 236 ar7_init_env((struct env_var *)fw_arg2); 237 console_config(); 238 } 239 240 #define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4))) serial_in(int offset)241 static inline unsigned int serial_in(int offset) 242 { 243 return readl((void *)PORT(offset)); 244 } 245 serial_out(int offset,int value)246 static inline void serial_out(int offset, int value) 247 { 248 writel(value, (void *)PORT(offset)); 249 } 250 prom_putchar(char c)251 void prom_putchar(char c) 252 { 253 while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0) 254 ; 255 serial_out(UART_TX, c); 256 } 257