[net-next-2.6.git] / arch / mips / ar7 / prom.c

/*
 * Carsten Langgaard, carstenl@mips.com
 * Copyright (C) 1999,2000 MIPS Technologies, Inc.  All rights reserved.
 *
 *  This program is free software; you can distribute it and/or modify it
 *  under the terms of the GNU General Public License (Version 2) as
 *  published by the Free Software Foundation.
 *
 *  This program is distributed in the hope it will be useful, but WITHOUT
 *  ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 *  FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License
 *  for more details.
 *
 *  You should have received a copy of the GNU General Public License along
 *  with this program; if not, write to the Free Software Foundation, Inc.,
 *  59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
 *
 * Putting things on the screen/serial line using YAMONs facilities.
 */
#include <linux/init.h>
#include <linux/kernel.h>
#include <linux/serial_reg.h>
#include <linux/spinlock.h>
#include <linux/module.h>
#include <linux/string.h>
#include <linux/io.h>
#include <asm/bootinfo.h>

#include <asm/mach-ar7/ar7.h>
#include <asm/mach-ar7/prom.h>

#define MAX_ENTRY 80

struct env_var {
	char *name;
	char *value;
};

static struct env_var adam2_env[MAX_ENTRY];

char *prom_getenv(const char *name)
{
	int i;
	for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)
		if (!strcmp(name, adam2_env[i].name))
			return adam2_env[i].value;

	return NULL;
}
EXPORT_SYMBOL(prom_getenv);

char * __init prom_getcmdline(void)
{
	return &(arcs_cmdline[0]);
}

static void  __init ar7_init_cmdline(int argc, char *argv[])
{
	char *cp;
	int actr;

	actr = 1; /* Always ignore argv[0] */

	cp = &(arcs_cmdline[0]);
	while (actr < argc) {
		strcpy(cp, argv[actr]);
		cp += strlen(argv[actr]);
		*cp++ = ' ';
		actr++;
	}
	if (cp != &(arcs_cmdline[0])) {
		/* get rid of trailing space */
		--cp;
		*cp = '\0';
	}
}

struct psbl_rec {
	u32 psbl_size;
	u32 env_base;
	u32 env_size;
	u32 ffs_base;
	u32 ffs_size;
};

static __initdata char psp_env_version[] = "TIENV0.8";

struct psp_env_chunk {
	u8 num;
	u8 ctrl;
	u16 csum;
	u8 len;
	char data[11];
} __attribute__ ((packed));

struct psp_var_map_entry {
	u8 num;
	char *value;
};

static struct psp_var_map_entry psp_var_map[] = {
	{ 1, "cpufrequency" },
	{ 2, "memsize" },
	{ 3, "flashsize" },
	{ 4, "modetty0" },
	{ 5, "modetty1" },
	{ 8, "maca" },
	{ 9, "macb" },
	{ 28, "sysfrequency" },
	{ 38, "mipsfrequency" },
};

/*

Well-known variable (num is looked up in table above for matching variable name)
Example: cpufrequency=211968000
+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
| 01 |CTRL|CHECKSUM | 01 | _2 | _1 | _1 | _9 | _6 | _8 | _0 | _0 | _0 | \0 | FF
+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---

Name=Value pair in a single chunk
Example: NAME=VALUE
+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
| 00 |CTRL|CHECKSUM | 01 | _N | _A | _M | _E | _0 | _V | _A | _L | _U | _E | \0
+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---

Name=Value pair in 2 chunks (len is the number of chunks)
Example: bootloaderVersion=1.3.7.15
+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
| 00 |CTRL|CHECKSUM | 02 | _b | _o | _o | _t | _l | _o | _a | _d | _e | _r | _V
+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
| _e | _r | _s | _i | _o | _n | \0 | _1 | _. | _3 | _. | _7 | _. | _1 | _5 | \0
+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---

Data is padded with 0xFF

*/

#define PSP_ENV_SIZE  4096

static char psp_env_data[PSP_ENV_SIZE] = { 0, };

static char * __init lookup_psp_var_map(u8 num)
{
	int i;

	for (i = 0; i < ARRAY_SIZE(psp_var_map); i++)
		if (psp_var_map[i].num == num)
			return psp_var_map[i].value;

	return NULL;
}

static void __init add_adam2_var(char *name, char *value)
{
	int i;
	for (i = 0; i < MAX_ENTRY; i++) {
		if (!adam2_env[i].name) {
			adam2_env[i].name = name;
			adam2_env[i].value = value;
			return;
		} else if (!strcmp(adam2_env[i].name, name)) {
			adam2_env[i].value = value;
			return;
		}
	}
}

static int __init parse_psp_env(void *psp_env_base)
{
	int i, n;
	char *name, *value;
	struct psp_env_chunk *chunks = (struct psp_env_chunk *)psp_env_data;

	memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE);

	i = 1;
	n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk);
	while (i < n) {
		if ((chunks[i].num == 0xff) || ((i + chunks[i].len) > n))
			break;
		value = chunks[i].data;
		if (chunks[i].num) {
			name = lookup_psp_var_map(chunks[i].num);
		} else {
			name = value;
			value += strlen(name) + 1;
		}
		if (name)
			add_adam2_var(name, value);
		i += chunks[i].len;
	}
	return 0;
}

static void __init ar7_init_env(struct env_var *env)
{
	int i;
	struct psbl_rec *psbl = (struct psbl_rec *)(KSEG1ADDR(0x14000300));
	void *psp_env = (void *)KSEG1ADDR(psbl->env_base);

	if (strcmp(psp_env, psp_env_version) == 0) {
		parse_psp_env(psp_env);
	} else {
		for (i = 0; i < MAX_ENTRY; i++, env++)
			if (env->name)
				add_adam2_var(env->name, env->value);
	}
}

static void __init console_config(void)
{
#ifdef CONFIG_SERIAL_8250_CONSOLE
	char console_string[40];
	int baud = 0;
	char parity = '\0', bits = '\0', flow = '\0';
	char *s, *p;

	if (strstr(prom_getcmdline(), "console="))
		return;

	s = prom_getenv("modetty0");
	if (s) {
		baud = simple_strtoul(s, &p, 10);
		s = p;
		if (*s == ',')
			s++;
		if (*s)
			parity = *s++;
		if (*s == ',')
			s++;
		if (*s)
			bits = *s++;
		if (*s == ',')
			s++;
		if (*s == 'h')
			flow = 'r';
	}

	if (baud == 0)
		baud = 38400;
	if (parity != 'n' && parity != 'o' && parity != 'e')
		parity = 'n';
	if (bits != '7' && bits != '8')
		bits = '8';

	if (flow == 'r')
		sprintf(console_string, " console=ttyS0,%d%c%c%c", baud,
			parity, bits, flow);
	else
		sprintf(console_string, " console=ttyS0,%d%c%c", baud, parity,
			bits);
	strcat(prom_getcmdline(), console_string);
#endif
}

void __init prom_init(void)
{
	ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
	ar7_init_env((struct env_var *)fw_arg2);
	console_config();
}

#define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))
static inline unsigned int serial_in(int offset)
{
	return readl((void *)PORT(offset));
}

static inline void serial_out(int offset, int value)
{
	writel(value, (void *)PORT(offset));
}

int prom_putchar(char c)
{
	while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0)
		;
	serial_out(UART_TX, c);
	return 1;
}
Commit	Line	Data
7ca5dc14 FF	1	/*
	2	* Carsten Langgaard, carstenl@mips.com
	3	* Copyright (C) 1999,2000 MIPS Technologies, Inc. All rights reserved.
	4	*
	5	* This program is free software; you can distribute it and/or modify it
	6	* under the terms of the GNU General Public License (Version 2) as
	7	* published by the Free Software Foundation.
	8	*
	9	* This program is distributed in the hope it will be useful, but WITHOUT
	10	* ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
	11	* FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
	12	* for more details.
	13	*
	14	* You should have received a copy of the GNU General Public License along
	15	* with this program; if not, write to the Free Software Foundation, Inc.,
	16	* 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
	17	*
	18	* Putting things on the screen/serial line using YAMONs facilities.
	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
	34	struct env_var {
	35	char *name;
	36	char *value;
	37	};
	38
	39	static struct env_var adam2_env[MAX_ENTRY];
	40
	41	char prom_getenv(const char name)
	42	{
	43	int i;
	44	for (i = 0; (i < MAX_ENTRY) && adam2_env[i].name; i++)
	45	if (!strcmp(name, adam2_env[i].name))
	46	return adam2_env[i].value;
	47
	48	return NULL;
	49	}
	50	EXPORT_SYMBOL(prom_getenv);
	51
	52	char * __init prom_getcmdline(void)
	53	{
	54	return &(arcs_cmdline[0]);
	55	}
	56
	57	static void __init ar7_init_cmdline(int argc, char *argv[])
	58	{
	59	char *cp;
	60	int actr;
	61
	62	actr = 1; /* Always ignore argv[0] */
	63
	64	cp = &(arcs_cmdline[0]);
65	while (actr < argc) {
66	strcpy(cp, argv[actr]);
67	cp += strlen(argv[actr]);
68	*cp++ = ' ';
69	actr++;
70	}
71	if (cp != &(arcs_cmdline[0])) {
72	/* get rid of trailing space */
73	--cp;
74	*cp = '\0';
75	}
76	}
77
78	struct psbl_rec {
79	u32 psbl_size;
80	u32 env_base;
81	u32 env_size;
82	u32 ffs_base;
83	u32 ffs_size;
84	};
85
86	static __initdata char psp_env_version[] = "TIENV0.8";
87
88	struct psp_env_chunk {
89	u8 num;
90	u8 ctrl;
91	u16 csum;
92	u8 len;
93	char data[11];
94	} __attribute__ ((packed));
95
96	struct psp_var_map_entry {
97	u8 num;
98	char *value;
99	};
100
101	static struct psp_var_map_entry psp_var_map[] = {
102	{ 1, "cpufrequency" },
103	{ 2, "memsize" },
104	{ 3, "flashsize" },
105	{ 4, "modetty0" },
106	{ 5, "modetty1" },
107	{ 8, "maca" },
108	{ 9, "macb" },
109	{ 28, "sysfrequency" },
110	{ 38, "mipsfrequency" },
111	};
112
113	/*
114
115	Well-known variable (num is looked up in table above for matching variable name)
116	Example: cpufrequency=211968000
117	+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
118	\| 01 \|CTRL\|CHECKSUM \| 01 \| _2 \| _1 \| _1 \| _9 \| _6 \| _8 \| _0 \| _0 \| _0 \| \0 \| FF
119	+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
120
121	Name=Value pair in a single chunk
122	Example: NAME=VALUE
123	+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
124	\| 00 \|CTRL\|CHECKSUM \| 01 \| _N \| _A \| _M \| _E \| _0 \| _V \| _A \| _L \| _U \| _E \| \0
125	+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
126
127	Name=Value pair in 2 chunks (len is the number of chunks)
128	Example: bootloaderVersion=1.3.7.15
129	+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
130	\| 00 \|CTRL\|CHECKSUM \| 02 \| _b \| _o \| _o \| _t \| _l \| _o \| _a \| _d \| _e \| _r \| _V
131	+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
132	\| _e \| _r \| _s \| _i \| _o \| _n \| \0 \| _1 \| _. \| _3 \| _. \| _7 \| _. \| _1 \| _5 \| \0
133	+----+----+----+----+----+----+----+----+----+----+----+----+----+----+----+---
134
135	Data is padded with 0xFF
136
137	*/
138
139	#define PSP_ENV_SIZE 4096
140
141	static char psp_env_data[PSP_ENV_SIZE] = { 0, };
142
143	static char * __init lookup_psp_var_map(u8 num)
144	{
145	int i;
146
ea85a0e4	147	for (i = 0; i < ARRAY_SIZE(psp_var_map); i++)
7ca5dc14 FF	148	if (psp_var_map[i].num == num)
	149	return psp_var_map[i].value;
	150
	151	return NULL;
	152	}
	153
	154	static void __init add_adam2_var(char name, char value)
	155	{
	156	int i;
	157	for (i = 0; i < MAX_ENTRY; i++) {
	158	if (!adam2_env[i].name) {
	159	adam2_env[i].name = name;
	160	adam2_env[i].value = value;
	161	return;
	162	} else if (!strcmp(adam2_env[i].name, name)) {
	163	adam2_env[i].value = value;
	164	return;
	165	}
	166	}
	167	}
	168
	169	static int __init parse_psp_env(void *psp_env_base)
	170	{
	171	int i, n;
	172	char name, value;
	173	struct psp_env_chunk chunks = (struct psp_env_chunk )psp_env_data;
	174
	175	memcpy_fromio(chunks, psp_env_base, PSP_ENV_SIZE);
	176
	177	i = 1;
	178	n = PSP_ENV_SIZE / sizeof(struct psp_env_chunk);
	179	while (i < n) {
	180	if ((chunks[i].num == 0xff) \|\| ((i + chunks[i].len) > n))
	181	break;
	182	value = chunks[i].data;
	183	if (chunks[i].num) {
	184	name = lookup_psp_var_map(chunks[i].num);
	185	} else {
	186	name = value;
	187	value += strlen(name) + 1;
	188	}
	189	if (name)
	190	add_adam2_var(name, value);
	191	i += chunks[i].len;
	192	}
	193	return 0;
	194	}
	195
	196	static void __init ar7_init_env(struct env_var *env)
	197	{
	198	int i;
	199	struct psbl_rec psbl = (struct psbl_rec )(KSEG1ADDR(0x14000300));
	200	void psp_env = (void )KSEG1ADDR(psbl->env_base);
	201
	202	if (strcmp(psp_env, psp_env_version) == 0) {
	203	parse_psp_env(psp_env);
	204	} else {
	205	for (i = 0; i < MAX_ENTRY; i++, env++)
	206	if (env->name)
	207	add_adam2_var(env->name, env->value);
	208	}
	209	}
	210
	211	static void __init console_config(void)
212	{
213	#ifdef CONFIG_SERIAL_8250_CONSOLE
214	char console_string[40];
215	int baud = 0;
216	char parity = '\0', bits = '\0', flow = '\0';
217	char s, p;
218
219	if (strstr(prom_getcmdline(), "console="))
220	return;
221
7ca5dc14 FF	222	s = prom_getenv("modetty0");
	223	if (s) {
	224	baud = simple_strtoul(s, &p, 10);
	225	s = p;
	226	if (*s == ',')
	227	s++;
	228	if (*s)
	229	parity = *s++;
	230	if (*s == ',')
	231	s++;
	232	if (*s)
	233	bits = *s++;
	234	if (*s == ',')
	235	s++;
	236	if (*s == 'h')
	237	flow = 'r';
	238	}
	239
	240	if (baud == 0)
	241	baud = 38400;
	242	if (parity != 'n' && parity != 'o' && parity != 'e')
	243	parity = 'n';
	244	if (bits != '7' && bits != '8')
	245	bits = '8';
	246
	247	if (flow == 'r')
	248	sprintf(console_string, " console=ttyS0,%d%c%c%c", baud,
	249	parity, bits, flow);
	250	else
	251	sprintf(console_string, " console=ttyS0,%d%c%c", baud, parity,
	252	bits);
	253	strcat(prom_getcmdline(), console_string);
	254	#endif
	255	}
	256
	257	void __init prom_init(void)
	258	{
	259	ar7_init_cmdline(fw_arg0, (char **)fw_arg1);
	260	ar7_init_env((struct env_var *)fw_arg2);
	261	console_config();
	262	}
	263
	264	#define PORT(offset) (KSEG1ADDR(AR7_REGS_UART0 + (offset * 4)))
	265	static inline unsigned int serial_in(int offset)
	266	{
	267	return readl((void *)PORT(offset));
	268	}
	269
	270	static inline void serial_out(int offset, int value)
	271	{
	272	writel(value, (void *)PORT(offset));
	273	}
	274
7ca5dc14 FF	275	int prom_putchar(char c)
	276	{
	277	while ((serial_in(UART_LSR) & UART_LSR_TEMT) == 0)
	278	;
	279	serial_out(UART_TX, c);
	280	return 1;
	281	}