18c2ecf20Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only 28c2ecf20Sopenharmony_ci/* 38c2ecf20Sopenharmony_ci * Carsten Langgaard, carstenl@mips.com 48c2ecf20Sopenharmony_ci * Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved. 58c2ecf20Sopenharmony_ci * 68c2ecf20Sopenharmony_ci * Putting things on the screen/serial line using YAMONs facilities. 78c2ecf20Sopenharmony_ci */ 88c2ecf20Sopenharmony_ci#include <linux/init.h> 98c2ecf20Sopenharmony_ci#include <linux/kernel.h> 108c2ecf20Sopenharmony_ci#include <linux/serial_reg.h> 118c2ecf20Sopenharmony_ci#include <linux/spinlock.h> 128c2ecf20Sopenharmony_ci#include <linux/export.h> 138c2ecf20Sopenharmony_ci#include <linux/string.h> 148c2ecf20Sopenharmony_ci#include <linux/io.h> 158c2ecf20Sopenharmony_ci#include <asm/bootinfo.h> 168c2ecf20Sopenharmony_ci#include <asm/setup.h> 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_ci#include <asm/mach-ar7/ar7.h> 198c2ecf20Sopenharmony_ci#include <asm/mach-ar7/prom.h> 208c2ecf20Sopenharmony_ci 218c2ecf20Sopenharmony_ci#define MAX_ENTRY 80 228c2ecf20Sopenharmony_ci 238c2ecf20Sopenharmony_cistruct env_var { 248c2ecf20Sopenharmony_ci char *name; 258c2ecf20Sopenharmony_ci char *value; 268c2ecf20Sopenharmony_ci}; 278c2ecf20Sopenharmony_ci 288c2ecf20Sopenharmony_cistatic struct env_var adam2_env[MAX_ENTRY]; 298c2ecf20Sopenharmony_ci 308c2ecf20Sopenharmony_cichar *prom_getenv(const char *name) 318c2ecf20Sopenharmony_ci{ 328c2ecf20Sopenharmony_ci int i; 338c2ecf20Sopenharmony_ci 348c2ecf20Sopenharmony_ci for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++) 358c2ecf20Sopenharmony_ci if (!strcmp(name, adam2_env[i].name)) 368c2ecf20Sopenharmony_ci return adam2_env[i].value; 378c2ecf20Sopenharmony_ci 388c2ecf20Sopenharmony_ci return NULL; 398c2ecf20Sopenharmony_ci} 408c2ecf20Sopenharmony_ciEXPORT_SYMBOL(prom_getenv); 418c2ecf20Sopenharmony_ci 428c2ecf20Sopenharmony_cistatic void __init ar7_init_cmdline(int argc, char *argv[]) 438c2ecf20Sopenharmony_ci{ 448c2ecf20Sopenharmony_ci int i; 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_ci for (i = 1; i < argc; i++) { 478c2ecf20Sopenharmony_ci strlcat(arcs_cmdline, argv[i], COMMAND_LINE_SIZE); 488c2ecf20Sopenharmony_ci if (i < (argc - 1)) 498c2ecf20Sopenharmony_ci strlcat(arcs_cmdline, " ", COMMAND_LINE_SIZE); 508c2ecf20Sopenharmony_ci } 518c2ecf20Sopenharmony_ci} 528c2ecf20Sopenharmony_ci 538c2ecf20Sopenharmony_cistruct psbl_rec { 548c2ecf20Sopenharmony_ci u32 psbl_size; 558c2ecf20Sopenharmony_ci u32 env_base; 568c2ecf20Sopenharmony_ci u32 env_size; 578c2ecf20Sopenharmony_ci u32 ffs_base; 588c2ecf20Sopenharmony_ci u32 ffs_size; 598c2ecf20Sopenharmony_ci}; 608c2ecf20Sopenharmony_ci 618c2ecf20Sopenharmony_cistatic const char psp_env_version[] __initconst = "TIENV0.8"; 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_cistruct psp_env_chunk { 648c2ecf20Sopenharmony_ci u8 num; 658c2ecf20Sopenharmony_ci u8 ctrl; 668c2ecf20Sopenharmony_ci u16 csum; 678c2ecf20Sopenharmony_ci u8 len; 688c2ecf20Sopenharmony_ci char data[11]; 698c2ecf20Sopenharmony_ci} __packed; 708c2ecf20Sopenharmony_ci 718c2ecf20Sopenharmony_cistruct psp_var_map_entry { 728c2ecf20Sopenharmony_ci u8 num; 738c2ecf20Sopenharmony_ci char *value; 748c2ecf20Sopenharmony_ci}; 758c2ecf20Sopenharmony_ci 768c2ecf20Sopenharmony_cistatic const struct psp_var_map_entry psp_var_map[] = { 778c2ecf20Sopenharmony_ci { 1, "cpufrequency" }, 788c2ecf20Sopenharmony_ci { 2, "memsize" }, 798c2ecf20Sopenharmony_ci { 3, "flashsize" }, 808c2ecf20Sopenharmony_ci { 4, "modetty0" }, 818c2ecf20Sopenharmony_ci { 5, "modetty1" }, 828c2ecf20Sopenharmony_ci { 8, "maca" }, 838c2ecf20Sopenharmony_ci { 9, "macb" }, 848c2ecf20Sopenharmony_ci { 28, "sysfrequency" }, 858c2ecf20Sopenharmony_ci { 38, "mipsfrequency" }, 868c2ecf20Sopenharmony_ci}; 878c2ecf20Sopenharmony_ci 888c2ecf20Sopenharmony_ci/* 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_ciWell-known variable (num is looked up in table above for matching variable name) 918c2ecf20Sopenharmony_ciExample: cpufrequency=211968000 928c2ecf20Sopenharmony_ci+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 938c2ecf20Sopenharmony_ci| 01 |CTRL|CHECKSUM | 01 | _2 | _1 | _1 | _9 | _6 | _8 | _0 | _0 | _0 | \0 | FF 948c2ecf20Sopenharmony_ci+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 958c2ecf20Sopenharmony_ci 968c2ecf20Sopenharmony_ciName=Value pair in a single chunk 978c2ecf20Sopenharmony_ciExample: NAME=VALUE 988c2ecf20Sopenharmony_ci+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 998c2ecf20Sopenharmony_ci| 00 |CTRL|CHECKSUM | 01 | _N | _A | _M | _E | _0 | _V | _A | _L | _U | _E | \0 1008c2ecf20Sopenharmony_ci+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 1018c2ecf20Sopenharmony_ci 1028c2ecf20Sopenharmony_ciName=Value pair in 2 chunks (len is the number of chunks) 1038c2ecf20Sopenharmony_ciExample: bootloaderVersion=1.3.7.15 1048c2ecf20Sopenharmony_ci+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 1058c2ecf20Sopenharmony_ci| 00 |CTRL|CHECKSUM | 02 | _b | _o | _o | _t | _l | _o | _a | _d | _e | _r | _V 1068c2ecf20Sopenharmony_ci+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 1078c2ecf20Sopenharmony_ci| _e | _r | _s | _i | _o | _n | \0 | _1 | _. | _3 | _. | _7 | _. | _1 | _5 | \0 1088c2ecf20Sopenharmony_ci+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+--- 1098c2ecf20Sopenharmony_ci 1108c2ecf20Sopenharmony_ciData is padded with 0xFF 1118c2ecf20Sopenharmony_ci 1128c2ecf20Sopenharmony_ci*/ 1138c2ecf20Sopenharmony_ci 1148c2ecf20Sopenharmony_ci#define PSP_ENV_SIZE 4096 1158c2ecf20Sopenharmony_ci 1168c2ecf20Sopenharmony_cistatic char psp_env_data[PSP_ENV_SIZE] = { 0, }; 1178c2ecf20Sopenharmony_ci 1188c2ecf20Sopenharmony_cistatic char * __init lookup_psp_var_map(u8 num) 1198c2ecf20Sopenharmony_ci{ 1208c2ecf20Sopenharmony_ci int i; 1218c2ecf20Sopenharmony_ci 1228c2ecf20Sopenharmony_ci for (i = 0; i < ARRAY_SIZE(psp_var_map); i++) 1238c2ecf20Sopenharmony_ci if (psp_var_map[i].num == num) 1248c2ecf20Sopenharmony_ci return psp_var_map[i].value; 1258c2ecf20Sopenharmony_ci 1268c2ecf20Sopenharmony_ci return NULL; 1278c2ecf20Sopenharmony_ci} 1288c2ecf20Sopenharmony_ci 1298c2ecf20Sopenharmony_cistatic void __init add_adam2_var(char *name, char *value) 1308c2ecf20Sopenharmony_ci{ 1318c2ecf20Sopenharmony_ci int i; 1328c2ecf20Sopenharmony_ci 1338c2ecf20Sopenharmony_ci for (i = 0; i < MAX_ENTRY; i++) { 1348c2ecf20Sopenharmony_ci if (!adam2_env[i].name) { 1358c2ecf20Sopenharmony_ci adam2_env[i].name = name; 1368c2ecf20Sopenharmony_ci adam2_env[i].value = value; 1378c2ecf20Sopenharmony_ci return; 1388c2ecf20Sopenharmony_ci } else if (!strcmp(adam2_env[i].name, name)) { 1398c2ecf20Sopenharmony_ci adam2_env[i].value = value; 1408c2ecf20Sopenharmony_ci return; 1418c2ecf20Sopenharmony_ci } 1428c2ecf20Sopenharmony_ci } 1438c2ecf20Sopenharmony_ci} 1448c2ecf20Sopenharmony_ci 1458c2ecf20Sopenharmony_cistatic int __init parse_psp_env(void *psp_env_base) 1468c2ecf20Sopenharmony_ci{ 1478c2ecf20Sopenharmony_ci int i, n; 1488c2ecf20Sopenharmony_ci char *name, *value; 1498c2ecf20Sopenharmony_ci struct psp_env_chunk *chunks = (struct psp_env_chunk *)psp_env_data; 1508c2ecf20Sopenharmony_ci 1518c2ecf20Sopenharmony_ci memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE); 1528c2ecf20Sopenharmony_ci 1538c2ecf20Sopenharmony_ci i = 1; 1548c2ecf20Sopenharmony_ci n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk); 1558c2ecf20Sopenharmony_ci while (i < n) { 1568c2ecf20Sopenharmony_ci if ((chunks[i].num == 0xff) || ((i + chunks[i].len) > n)) 1578c2ecf20Sopenharmony_ci break; 1588c2ecf20Sopenharmony_ci value = chunks[i].data; 1598c2ecf20Sopenharmony_ci if (chunks[i].num) { 1608c2ecf20Sopenharmony_ci name = lookup_psp_var_map(chunks[i].num); 1618c2ecf20Sopenharmony_ci } else { 1628c2ecf20Sopenharmony_ci name = value; 1638c2ecf20Sopenharmony_ci value += strlen(name) + 1; 1648c2ecf20Sopenharmony_ci } 1658c2ecf20Sopenharmony_ci if (name) 1668c2ecf20Sopenharmony_ci add_adam2_var(name, value); 1678c2ecf20Sopenharmony_ci i += chunks[i].len; 1688c2ecf20Sopenharmony_ci } 1698c2ecf20Sopenharmony_ci return 0; 1708c2ecf20Sopenharmony_ci} 1718c2ecf20Sopenharmony_ci 1728c2ecf20Sopenharmony_cistatic void __init ar7_init_env(struct env_var *env) 1738c2ecf20Sopenharmony_ci{ 1748c2ecf20Sopenharmony_ci int i; 1758c2ecf20Sopenharmony_ci struct psbl_rec *psbl = (struct psbl_rec *)(KSEG1ADDR(0x14000300)); 1768c2ecf20Sopenharmony_ci void *psp_env = (void *)KSEG1ADDR(psbl->env_base); 1778c2ecf20Sopenharmony_ci 1788c2ecf20Sopenharmony_ci if (strcmp(psp_env, psp_env_version) == 0) { 1798c2ecf20Sopenharmony_ci parse_psp_env(psp_env); 1808c2ecf20Sopenharmony_ci } else { 1818c2ecf20Sopenharmony_ci for (i = 0; i < MAX_ENTRY; i++, env++) 1828c2ecf20Sopenharmony_ci if (env->name) 1838c2ecf20Sopenharmony_ci add_adam2_var(env->name, env->value); 1848c2ecf20Sopenharmony_ci } 1858c2ecf20Sopenharmony_ci} 1868c2ecf20Sopenharmony_ci 1878c2ecf20Sopenharmony_cistatic void __init console_config(void) 1888c2ecf20Sopenharmony_ci{ 1898c2ecf20Sopenharmony_ci#ifdef CONFIG_SERIAL_8250_CONSOLE 1908c2ecf20Sopenharmony_ci char console_string[40]; 1918c2ecf20Sopenharmony_ci int baud = 0; 1928c2ecf20Sopenharmony_ci char parity = '\0', bits = '\0', flow = '\0'; 1938c2ecf20Sopenharmony_ci char *s, *p; 1948c2ecf20Sopenharmony_ci 1958c2ecf20Sopenharmony_ci if (strstr(arcs_cmdline, "console=")) 1968c2ecf20Sopenharmony_ci return; 1978c2ecf20Sopenharmony_ci 1988c2ecf20Sopenharmony_ci s = prom_getenv("modetty0"); 1998c2ecf20Sopenharmony_ci if (s) { 2008c2ecf20Sopenharmony_ci baud = simple_strtoul(s, &p, 10); 2018c2ecf20Sopenharmony_ci s = p; 2028c2ecf20Sopenharmony_ci if (*s == ',') 2038c2ecf20Sopenharmony_ci s++; 2048c2ecf20Sopenharmony_ci if (*s) 2058c2ecf20Sopenharmony_ci parity = *s++; 2068c2ecf20Sopenharmony_ci if (*s == ',') 2078c2ecf20Sopenharmony_ci s++; 2088c2ecf20Sopenharmony_ci if (*s) 2098c2ecf20Sopenharmony_ci bits = *s++; 2108c2ecf20Sopenharmony_ci if (*s == ',') 2118c2ecf20Sopenharmony_ci s++; 2128c2ecf20Sopenharmony_ci if (*s == 'h') 2138c2ecf20Sopenharmony_ci flow = 'r'; 2148c2ecf20Sopenharmony_ci } 2158c2ecf20Sopenharmony_ci 2168c2ecf20Sopenharmony_ci if (baud == 0) 2178c2ecf20Sopenharmony_ci baud = 38400; 2188c2ecf20Sopenharmony_ci if (parity != 'n' && parity != 'o' && parity != 'e') 2198c2ecf20Sopenharmony_ci parity = 'n'; 2208c2ecf20Sopenharmony_ci if (bits != '7' && bits != '8') 2218c2ecf20Sopenharmony_ci bits = '8'; 2228c2ecf20Sopenharmony_ci 2238c2ecf20Sopenharmony_ci if (flow == 'r') 2248c2ecf20Sopenharmony_ci sprintf(console_string, " console=ttyS0,%d%c%c%c", baud, 2258c2ecf20Sopenharmony_ci parity, bits, flow); 2268c2ecf20Sopenharmony_ci else 2278c2ecf20Sopenharmony_ci sprintf(console_string, " console=ttyS0,%d%c%c", baud, parity, 2288c2ecf20Sopenharmony_ci bits); 2298c2ecf20Sopenharmony_ci strlcat(arcs_cmdline, console_string, COMMAND_LINE_SIZE); 2308c2ecf20Sopenharmony_ci#endif 2318c2ecf20Sopenharmony_ci} 2328c2ecf20Sopenharmony_ci 2338c2ecf20Sopenharmony_civoid __init prom_init(void) 2348c2ecf20Sopenharmony_ci{ 2358c2ecf20Sopenharmony_ci ar7_init_cmdline(fw_arg0, (char **)fw_arg1); 2368c2ecf20Sopenharmony_ci ar7_init_env((struct env_var *)fw_arg2); 2378c2ecf20Sopenharmony_ci console_config(); 2388c2ecf20Sopenharmony_ci} 2398c2ecf20Sopenharmony_ci 2408c2ecf20Sopenharmony_ci#define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4))) 2418c2ecf20Sopenharmony_cistatic inline unsigned int serial_in(int offset) 2428c2ecf20Sopenharmony_ci{ 2438c2ecf20Sopenharmony_ci return readl((void *)PORT(offset)); 2448c2ecf20Sopenharmony_ci} 2458c2ecf20Sopenharmony_ci 2468c2ecf20Sopenharmony_cistatic inline void serial_out(int offset, int value) 2478c2ecf20Sopenharmony_ci{ 2488c2ecf20Sopenharmony_ci writel(value, (void *)PORT(offset)); 2498c2ecf20Sopenharmony_ci} 2508c2ecf20Sopenharmony_ci 2518c2ecf20Sopenharmony_civoid prom_putchar(char c) 2528c2ecf20Sopenharmony_ci{ 2538c2ecf20Sopenharmony_ci while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0) 2548c2ecf20Sopenharmony_ci ; 2558c2ecf20Sopenharmony_ci serial_out(UART_TX, c); 2568c2ecf20Sopenharmony_ci} 257