[people/ms/u-boot.git] / examples / smc91111_eeprom.c

/*
 * (C) Copyright 2004
 * Robin Getz rgetz@blacfin.uclinux.org
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that 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
 *
 * Heavily borrowed from the following peoples GPL'ed software:
 *  - Wolfgang Denk, DENX Software Engineering, wd@denx.de
 *       Das U-boot
 *  - Ladislav Michl ladis@linux-mips.org
 *       A rejected patch on the U-Boot mailing list
 */

#include <common.h>
#include <exports.h>
#include "../drivers/smc91111.h"

#define SMC_BASE_ADDRESS CONFIG_SMC91111_BASE
#define EEPROM		0x1;
#define MAC		0x2;
#define	UNKNOWN 	0x4;

void dump_reg (void);
void dump_eeprom (void);
int write_eeprom_reg (int, int);
void copy_from_eeprom (void);
void print_MAC (void);
int read_eeprom_reg (int);
void print_macaddr (void);

int smc91111_eeprom (int argc, char *argv[])
{
	int c, i, j, done, line, reg, value, start, what;
	char input[50];

	/* Print the ABI version */
	app_startup (argv);
	if (XF_VERSION != (int) get_version ()) {
		printf ("Expects ABI version %d\n", XF_VERSION);
		printf ("Actual U-Boot ABI version %d\n",
			(int) get_version ());
		printf ("Can't run\n\n");
		return (0);
	}

	asm ("p2.h = 0xFFC0;");
	asm ("p2.l = 0x0730;");
	asm ("r0 = 0x01;");
	asm ("w[p2] = r0;");
	asm ("ssync;");

	asm ("p2.h = 0xffc0;");
	asm ("p2.l = 0x0708;");
	asm ("r0 = 0x01;");
	asm ("w[p2] = r0;");
	asm ("ssync;");

	if ((SMC_inw (BANK_SELECT) & 0xFF00) != 0x3300) {
		printf ("Can't find SMSC91111\n");
		return (0);
	}

	done = 0;
	what = UNKNOWN;
	printf ("\n");
	while (!done) {
		/* print the prompt */
		printf ("SMC91111> ");
		line = 0;
		i = 0;
		start = 1;
		while (!line) {
			/* Wait for a keystroke */
			while (!tstc ());

			c = getc ();
			/* Make Uppercase */
			if (c >= 'Z')
				c -= ('a' - 'A');
			/* printf(" |%02x| ",c); */

			switch (c) {
			case '\r':	/* Enter                */
			case '\n':
				input[i] = 0;
				puts ("\r\n");
				line = 1;
				break;
			case '\0':	/* nul                  */
				continue;

			case 0x03:	/* ^C - break           */
				input[0] = 0;
				i = 0;
				line = 1;
				done = 1;
				break;

			case 0x5F:
			case 0x08:	/* ^H  - backspace      */
			case 0x7F:	/* DEL - backspace      */
				if (i > 0) {
					puts ("\b \b");
					i--;
				}
				break;
			default:
				if (start) {
					if ((c == 'W') || (c == 'D')
					    || (c == 'M') || (c == 'C')
					    || (c == 'P')) {
						putc (c);
						input[i] = c;
						if (i <= 45)
							i++;
						start = 0;
					}
				} else {
					if ((c >= '0' && c <= '9')
					    || (c >= 'A' && c <= 'F')
					    || (c == 'E') || (c == 'M')
					    || (c == ' ')) {
						putc (c);
						input[i] = c;
						if (i <= 45)
							i++;
						break;
					}
				}
				break;
			}
		}

		for (; i < 49; i++)
			input[i] = 0;

		switch (input[0]) {
		case ('W'):
			/* Line should be w reg value */
			i = 0;
			reg = 0;
			value = 0;
			/* Skip to the next space or end) */
			while ((input[i] != ' ') && (input[i] != 0))
				i++;

			if (input[i] != 0)
				i++;

			/* Are we writing to EEPROM or MAC */
			switch (input[i]) {
			case ('E'):
				what = EEPROM;
				break;
			case ('M'):
				what = MAC;
				break;
			default:
				what = UNKNOWN;
				break;
			}

			/* skip to the next space or end */
			while ((input[i] != ' ') && (input[i] != 0))
				i++;
			if (input[i] != 0)
				i++;

			/* Find register to write into */
			j = 0;
			while ((input[i] != ' ') && (input[i] != 0)) {
				j = input[i] - 0x30;
				if (j >= 0xA) {
					j -= 0x07;
				}
				reg = (reg * 0x10) + j;
				i++;
			}

			while ((input[i] != ' ') && (input[i] != 0))
				i++;

			if (input[i] != 0)
				i++;
			else
				what = UNKNOWN;

			/* Get the value to write */
			j = 0;
			while ((input[i] != ' ') && (input[i] != 0)) {
				j = input[i] - 0x30;
				if (j >= 0xA) {
					j -= 0x07;
				}
				value = (value * 0x10) + j;
				i++;
			}

			switch (what) {
			case 1:
				printf ("Writing EEPROM register %02x with %04x\n", reg, value);
				write_eeprom_reg (value, reg);
				break;
			case 2:
				printf ("Writing MAC register bank %i, reg %02x with %04x\n", reg >> 4, reg & 0xE, value);
				SMC_SELECT_BANK (reg >> 4);
				SMC_outw (value, reg & 0xE);
				break;
			default:
				printf ("Wrong\n");
				break;
			}
			break;
		case ('D'):
			dump_eeprom ();
			break;
		case ('M'):
			dump_reg ();
			break;
		case ('C'):
			copy_from_eeprom ();
			break;
		case ('P'):
			print_macaddr ();
			break;
		default:
			break;
		}

	}

	return (0);
}

void copy_from_eeprom (void)
{
	int i;

	SMC_SELECT_BANK (1);
	SMC_outw ((SMC_inw (CTL_REG) & !CTL_EEPROM_SELECT) | CTL_RELOAD,
		  CTL_REG);
	i = 100;
	while ((SMC_inw (CTL_REG) & CTL_RELOAD) && --i)
		udelay (100);
	if (i == 0) {
		printf ("Timeout Refreshing EEPROM registers\n");
	} else {
		printf ("EEPROM contents copied to MAC\n");
	}

}

void print_macaddr (void)
{
	int i, j, k, mac[6];

	printf ("Current MAC Address in SMSC91111 ");
	SMC_SELECT_BANK (1);
	for (i = 0; i < 5; i++) {
		printf ("%02x:", SMC_inb (ADDR0_REG + i));
	}

	printf ("%02x\n", SMC_inb (ADDR0_REG + 5));

	i = 0;
	for (j = 0x20; j < 0x23; j++) {
		k = read_eeprom_reg (j);
		mac[i] = k & 0xFF;
		i++;
		mac[i] = k >> 8;
		i++;
	}

	printf ("Current MAC Address in EEPROM    ");
	for (i = 0; i < 5; i++)
		printf ("%02x:", mac[i]);
	printf ("%02x\n", mac[5]);

}
void dump_eeprom (void)
{
	int j, k;

	printf ("IOS2-0    ");
	for (j = 0; j < 8; j++) {
		printf ("%03x     ", j);
	}
	printf ("\n");

	for (k = 0; k < 4; k++) {
		if (k == 0)
			printf ("CONFIG ");
		if (k == 1)
			printf ("BASE   ");
		if ((k == 2) || (k == 3))
			printf ("       ");
		for (j = 0; j < 0x20; j += 4) {
			printf ("%02x:%04x ", j + k, read_eeprom_reg (j + k));
		}
		printf ("\n");
	}

	for (j = 0x20; j < 0x40; j++) {
		if ((j & 0x07) == 0)
			printf ("\n");
		printf ("%02x:%04x ", j, read_eeprom_reg (j));
	}
	printf ("\n");

}

int read_eeprom_reg (int reg)
{
	int timeout;

	SMC_SELECT_BANK (2);
	SMC_outw (reg, PTR_REG);

	SMC_SELECT_BANK (1);
	SMC_outw (SMC_inw (CTL_REG) | CTL_EEPROM_SELECT | CTL_RELOAD,
		  CTL_REG);
	timeout = 100;
	while ((SMC_inw (CTL_REG) & CTL_RELOAD) && --timeout)
		udelay (100);
	if (timeout == 0) {
		printf ("Timeout Reading EEPROM register %02x\n", reg);
		return 0;
	}

	return SMC_inw (GP_REG);

}

int write_eeprom_reg (int value, int reg)
{
	int timeout;

	SMC_SELECT_BANK (2);
	SMC_outw (reg, PTR_REG);

	SMC_SELECT_BANK (1);
	SMC_outw (value, GP_REG);
	SMC_outw (SMC_inw (CTL_REG) | CTL_EEPROM_SELECT | CTL_STORE, CTL_REG);
	timeout = 100;
	while ((SMC_inw (CTL_REG) & CTL_STORE) && --timeout)
		udelay (100);
	if (timeout == 0) {
		printf ("Timeout Writing EEPROM register %02x\n", reg);
		return 0;
	}

	return 1;

}

void dump_reg (void)
{
	int i, j;

	printf ("    ");
	for (j = 0; j < 4; j++) {
		printf ("Bank%i ", j);
	}
	printf ("\n");
	for (i = 0; i < 0xF; i += 2) {
		printf ("%02x  ", i);
		for (j = 0; j < 4; j++) {
			SMC_SELECT_BANK (j);
			printf ("%04x  ", SMC_inw (i));
		}
		printf ("\n");
	}
}
Commit	Line	Data
5a95f6fb WD	1	/*
	2	* (C) Copyright 2004
	3	* Robin Getz rgetz@blacfin.uclinux.org
	4	*
	5	* See file CREDITS for list of people who contributed to this
	6	* project.
	7	*
	8	* This program is free software; you can redistribute it and/or
	9	* modify it under the terms of the GNU General Public License as
	10	* published by the Free Software Foundation; either version 2 of
	11	* the License, or (at your option) any later version.
	12	*
	13	* This program is distributed in the hope that it will be useful,
	14	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	15	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	16	* GNU General Public License for more details.
	17	*
	18	* You should have received a copy of the GNU General Public License
	19	* along with this program; if not, write to the Free Software
	20	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	21	* MA 02111-1307 USA
	22	*
	23	* Heavily borrowed from the following peoples GPL'ed software:
	24	* - Wolfgang Denk, DENX Software Engineering, wd@denx.de
	25	* Das U-boot
	26	* - Ladislav Michl ladis@linux-mips.org
	27	* A rejected patch on the U-Boot mailing list
	28	*/
	29
	30	#include <common.h>
	31	#include <exports.h>
	32	#include "../drivers/smc91111.h"
	33
	34	#define SMC_BASE_ADDRESS CONFIG_SMC91111_BASE
	35	#define EEPROM 0x1;
	36	#define MAC 0x2;
	37	#define UNKNOWN 0x4;
	38
	39	void dump_reg (void);
	40	void dump_eeprom (void);
	41	int write_eeprom_reg (int, int);
	42	void copy_from_eeprom (void);
	43	void print_MAC (void);
	44	int read_eeprom_reg (int);
	45	void print_macaddr (void);
	46
	47	int smc91111_eeprom (int argc, char *argv[])
	48	{
	49	int c, i, j, done, line, reg, value, start, what;
	50	char input[50];
	51
	52	/* Print the ABI version */
	53	app_startup (argv);
	54	if (XF_VERSION != (int) get_version ()) {
	55	printf ("Expects ABI version %d\n", XF_VERSION);
	56	printf ("Actual U-Boot ABI version %d\n",
	57	(int) get_version ());
	58	printf ("Can't run\n\n");
	59	return (0);
	60	}
	61
	62	asm ("p2.h = 0xFFC0;");
	63	asm ("p2.l = 0x0730;");
	64	asm ("r0 = 0x01;");
65	asm ("w[p2] = r0;");
66	asm ("ssync;");
67
68	asm ("p2.h = 0xffc0;");
69	asm ("p2.l = 0x0708;");
70	asm ("r0 = 0x01;");
71	asm ("w[p2] = r0;");
72	asm ("ssync;");
73
74	if ((SMC_inw (BANK_SELECT) & 0xFF00) != 0x3300) {
75	printf ("Can't find SMSC91111\n");
76	return (0);
77	}
78
79	done = 0;
80	what = UNKNOWN;
81	printf ("\n");
82	while (!done) {
83	/* print the prompt */
84	printf ("SMC91111> ");
85	line = 0;
86	i = 0;
87	start = 1;
88	while (!line) {
89	/* Wait for a keystroke */
90	while (!tstc ());
91
92	c = getc ();
93	/* Make Uppercase */
94	if (c >= 'Z')
95	c -= ('a' - 'A');
96	/* printf(" \|%02x\| ",c); */
97
98	switch (c) {
99	case '\r': /* Enter */
100	case '\n':
101	input[i] = 0;
102	puts ("\r\n");
103	line = 1;
104	break;
105	case '\0': /* nul */
106	continue;
107
108	case 0x03: /* ^C - break */
109	input[0] = 0;
110	i = 0;
111	line = 1;
112	done = 1;
113	break;
114
115	case 0x5F:
116	case 0x08: /* ^H - backspace */
117	case 0x7F: /* DEL - backspace */
118	if (i > 0) {
119	puts ("\b \b");
120	i--;
121	}
122	break;
123	default:
124	if (start) {
125	if ((c == 'W') \|\| (c == 'D')
126	\|\| (c == 'M') \|\| (c == 'C')
127	\|\| (c == 'P')) {
128	putc (c);
129	input[i] = c;
130	if (i <= 45)
131	i++;
132	start = 0;
133	}
134	} else {
135	if ((c >= '0' && c <= '9')
136	\|\| (c >= 'A' && c <= 'F')
137	\|\| (c == 'E') \|\| (c == 'M')
138	\|\| (c == ' ')) {
139	putc (c);
140	input[i] = c;
141	if (i <= 45)
142	i++;
143	break;
144	}
145	}
146	break;
147	}
148	}
149
150	for (; i < 49; i++)
151	input[i] = 0;
152
153	switch (input[0]) {
154	case ('W'):
155	/* Line should be w reg value */
156	i = 0;
157	reg = 0;
158	value = 0;
159	/* Skip to the next space or end) */
160	while ((input[i] != ' ') && (input[i] != 0))
161	i++;
162
163	if (input[i] != 0)
164	i++;
165
166	/* Are we writing to EEPROM or MAC */
167	switch (input[i]) {
168	case ('E'):
169	what = EEPROM;
170	break;
171	case ('M'):
172	what = MAC;
173	break;
174	default:
175	what = UNKNOWN;
176	break;
177	}
178
179	/* skip to the next space or end */
180	while ((input[i] != ' ') && (input[i] != 0))
181	i++;
182	if (input[i] != 0)
183	i++;
184
185	/* Find register to write into */
186	j = 0;
187	while ((input[i] != ' ') && (input[i] != 0)) {
188	j = input[i] - 0x30;
189	if (j >= 0xA) {
190	j -= 0x07;
191	}
192	reg = (reg * 0x10) + j;
193	i++;
194	}
195
196	while ((input[i] != ' ') && (input[i] != 0))
197	i++;
198
199	if (input[i] != 0)
200	i++;
201	else
202	what = UNKNOWN;
203
204	/* Get the value to write */
205	j = 0;
206	while ((input[i] != ' ') && (input[i] != 0)) {
207	j = input[i] - 0x30;
208	if (j >= 0xA) {
209	j -= 0x07;
210	}
211	value = (value * 0x10) + j;
212	i++;
213	}
214
215	switch (what) {
216	case 1:
0afe519a	217	printf ("Writing EEPROM register %02x with %04x\n", reg, value);
5a95f6fb WD	218	write_eeprom_reg (value, reg);
	219	break;
	220	case 2:
0afe519a	221	printf ("Writing MAC register bank %i, reg %02x with %04x\n", reg >> 4, reg & 0xE, value);
5a95f6fb WD	222	SMC_SELECT_BANK (reg >> 4);
	223	SMC_outw (value, reg & 0xE);
	224	break;
	225	default:
	226	printf ("Wrong\n");
	227	break;
	228	}
	229	break;
	230	case ('D'):
	231	dump_eeprom ();
	232	break;
	233	case ('M'):
	234	dump_reg ();
	235	break;
	236	case ('C'):
	237	copy_from_eeprom ();
	238	break;
	239	case ('P'):
	240	print_macaddr ();
	241	break;
	242	default:
	243	break;
	244	}
	245
	246	}
	247
	248	return (0);
	249	}
	250
	251	void copy_from_eeprom (void)
	252	{
	253	int i;
	254
	255	SMC_SELECT_BANK (1);
	256	SMC_outw ((SMC_inw (CTL_REG) & !CTL_EEPROM_SELECT) \| CTL_RELOAD,
	257	CTL_REG);
	258	i = 100;
	259	while ((SMC_inw (CTL_REG) & CTL_RELOAD) && --i)
	260	udelay (100);
	261	if (i == 0) {
	262	printf ("Timeout Refreshing EEPROM registers\n");
	263	} else {
	264	printf ("EEPROM contents copied to MAC\n");
	265	}
	266
	267	}
	268
	269	void print_macaddr (void)
	270	{
	271	int i, j, k, mac[6];
	272
	273	printf ("Current MAC Address in SMSC91111 ");
	274	SMC_SELECT_BANK (1);
	275	for (i = 0; i < 5; i++) {
	276	printf ("%02x:", SMC_inb (ADDR0_REG + i));
	277	}
	278
	279	printf ("%02x\n", SMC_inb (ADDR0_REG + 5));
	280
	281	i = 0;
	282	for (j = 0x20; j < 0x23; j++) {
	283	k = read_eeprom_reg (j);
	284	mac[i] = k & 0xFF;
	285	i++;
286	mac[i] = k >> 8;
287	i++;
288	}
289
290	printf ("Current MAC Address in EEPROM ");
291	for (i = 0; i < 5; i++)
292	printf ("%02x:", mac[i]);
293	printf ("%02x\n", mac[5]);
294
295	}
296	void dump_eeprom (void)
297	{
298	int j, k;
299
300	printf ("IOS2-0 ");
301	for (j = 0; j < 8; j++) {
302	printf ("%03x ", j);
303	}
304	printf ("\n");
305
306	for (k = 0; k < 4; k++) {
307	if (k == 0)
308	printf ("CONFIG ");
309	if (k == 1)
310	printf ("BASE ");
311	if ((k == 2) \|\| (k == 3))
312	printf (" ");
313	for (j = 0; j < 0x20; j += 4) {
314	printf ("%02x:%04x ", j + k, read_eeprom_reg (j + k));
315	}
316	printf ("\n");
317	}
318
319	for (j = 0x20; j < 0x40; j++) {
320	if ((j & 0x07) == 0)
321	printf ("\n");
322	printf ("%02x:%04x ", j, read_eeprom_reg (j));
323	}
324	printf ("\n");
325
326	}
327
328	int read_eeprom_reg (int reg)
329	{
330	int timeout;
331
332	SMC_SELECT_BANK (2);
333	SMC_outw (reg, PTR_REG);
334
335	SMC_SELECT_BANK (1);
336	SMC_outw (SMC_inw (CTL_REG) \| CTL_EEPROM_SELECT \| CTL_RELOAD,
337	CTL_REG);
338	timeout = 100;
339	while ((SMC_inw (CTL_REG) & CTL_RELOAD) && --timeout)
340	udelay (100);
341	if (timeout == 0) {
342	printf ("Timeout Reading EEPROM register %02x\n", reg);
343	return 0;
344	}
345
346	return SMC_inw (GP_REG);
347
348	}
349
350	int write_eeprom_reg (int value, int reg)
351	{
352	int timeout;
353
354	SMC_SELECT_BANK (2);
355	SMC_outw (reg, PTR_REG);
356
357	SMC_SELECT_BANK (1);
358	SMC_outw (value, GP_REG);
359	SMC_outw (SMC_inw (CTL_REG) \| CTL_EEPROM_SELECT \| CTL_STORE, CTL_REG);
360	timeout = 100;
361	while ((SMC_inw (CTL_REG) & CTL_STORE) && --timeout)
362	udelay (100);
363	if (timeout == 0) {
364	printf ("Timeout Writing EEPROM register %02x\n", reg);
365	return 0;
366	}
367
368	return 1;
369
370	}
371
372	void dump_reg (void)
373	{
374	int i, j;
375
376	printf (" ");
377	for (j = 0; j < 4; j++) {
378	printf ("Bank%i ", j);
379	}
380	printf ("\n");
381	for (i = 0; i < 0xF; i += 2) {
382	printf ("%02x ", i);
383	for (j = 0; j < 4; j++) {
384	SMC_SELECT_BANK (j);
385	printf ("%04x ", SMC_inw (i));
386	}
387	printf ("\n");
388	}
389	}