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