[people/ms/u-boot.git] / board / mpl / common / memtst.c

/*
 * (C) Copyright 2001
 * Denis Peter, MPL AG Switzerland, d.peter@mpl.ch
 *
 * 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
 *
 */

/* NOT Used yet...
  add following code to PIP405.c :
int testdram (void)
{
	unsigned char s[32];
	int i;

	i = getenv_r ("testmem", s, 32);
	if (i != 0) {
		i = (int) simple_strtoul (s, NULL, 10);
		if ((i > 0) && (i < 0xf)) {
			printf ("testing ");
			i = mem_test (0, ramsize, i);
			if (i > 0)
				printf ("ERROR ");
			else
				printf ("Ok ");
		}
	}
	return (1);
}
*/


#include <common.h>
#include <asm/processor.h>
#include <4xx_i2c.h>

DECLARE_GLOBAL_DATA_PTR;

#define FALSE           0
#define TRUE            1

#define TEST_QUIET	8
#define TEST_SHOW_PROG	4
#define TEST_SHOW_ERR	2
#define TEST_SHOW_ALL	1

#define TESTPAT1 0xAA55AA55
#define TESTPAT2 0x55AA55AA
#define TEST_PASSED 0
#define TEST_FAILED 1
#define MEGABYTE (1024*1024)


typedef struct {
	volatile unsigned long pat1;
	volatile unsigned long pat2;
} RAM_MEMTEST_PATTERN2;

typedef struct {
	volatile unsigned long addr;
} RAM_MEMTEST_ADDRLINE;

static __inline unsigned long Swap_32 (unsigned long val)
{
	return (((val << 16) & 0xFFFF0000) | ((val >> 16) & 0x0000FFFF));
}

void testm_puts (int quiet, char *buf)
{
	if ((quiet & TEST_SHOW_ALL) == TEST_SHOW_ALL)
		puts (buf);
}


void Write_Error (int mode, unsigned long addr, unsigned long expected,
				  unsigned long actual)
{

	char dispbuf[64];

	sprintf (dispbuf, "\n ERROR @ 0x%08lX: (exp: 0x%08lX act: 0x%08lX) ",
			 addr, expected, actual);
	testm_puts (((mode & TEST_SHOW_ERR) ==
				 TEST_SHOW_ERR) ? TEST_SHOW_ALL : mode, dispbuf);
}


/*
 * fills the memblock of <size> bytes from <startaddr> with pat1 and pat2
 */


void RAM_MemTest_WritePattern2 (unsigned long startaddr,
								unsigned long size, unsigned long pat1,
								unsigned long pat2)
{
	RAM_MEMTEST_PATTERN2 *p, *pe;

	p = (RAM_MEMTEST_PATTERN2 *) startaddr;
	pe = (RAM_MEMTEST_PATTERN2 *) (startaddr + size);

	while (p < pe) {
		p->pat1 = pat1;
		p->pat2 = pat2;
		p++;
	}							/* endwhile */
}

/*
 * checks the memblock of <size> bytes from <startaddr> with pat1 and pat2
 * returns the address of the first error or NULL if all is well
 */

void *RAM_MemTest_CheckPattern2 (int mode, unsigned long startaddr,
								 unsigned long size, unsigned long pat1,
								 unsigned long pat2)
{
	RAM_MEMTEST_PATTERN2 *p, *pe;
	unsigned long actual1, actual2;

	p = (RAM_MEMTEST_PATTERN2 *) startaddr;
	pe = (RAM_MEMTEST_PATTERN2 *) (startaddr + size);

	while (p < pe) {
		actual1 = p->pat1;
		actual2 = p->pat2;

		if (actual1 != pat1) {
			Write_Error (mode, (unsigned long) &(p->pat1), pat1, actual1);
			return ((void *) &(p->pat1));
		}
		/* endif */
		if (actual2 != pat2) {
			Write_Error (mode, (unsigned long) &(p->pat2), pat2, actual2);
			return ((void *) &(p->pat2));
		}
		/* endif */
		p++;
	}							/* endwhile */

	return (NULL);
}

/*
 * fills the memblock of <size> bytes from <startaddr> with the address
 */

void RAM_MemTest_WriteAddrLine (unsigned long startaddr,
								unsigned long size, int swapped)
{
	RAM_MEMTEST_ADDRLINE *p, *pe;

	p = (RAM_MEMTEST_ADDRLINE *) startaddr;
	pe = (RAM_MEMTEST_ADDRLINE *) (startaddr + size);

	if (!swapped) {
		while (p < pe) {
			p->addr = (unsigned long) p;
			p++;
		}						/* endwhile */
	} else {
		while (p < pe) {
			p->addr = Swap_32 ((unsigned long) p);
			p++;
		}						/* endwhile */
	}							/* endif */
}

/*
 * checks the memblock of <size> bytes from <startaddr>
 * returns the address of the error or NULL if all is well
 */

void *RAM_MemTest_CheckAddrLine (int mode, unsigned long startaddr,
								 unsigned long size, int swapped)
{
	RAM_MEMTEST_ADDRLINE *p, *pe;
	unsigned long actual, expected;

	p = (RAM_MEMTEST_ADDRLINE *) startaddr;
	pe = (RAM_MEMTEST_ADDRLINE *) (startaddr + size);

	if (!swapped) {
		while (p < pe) {
			actual = p->addr;
			expected = (unsigned long) p;
			if (actual != expected) {
				Write_Error (mode, (unsigned long) &(p->addr), expected,
							 actual);
				return ((void *) &(p->addr));
			}					/* endif */
			p++;
		}						/* endwhile */
	} else {
		while (p < pe) {
			actual = p->addr;
			expected = Swap_32 ((unsigned long) p);
			if (actual != expected) {
				Write_Error (mode, (unsigned long) &(p->addr), expected,
							 actual);
				return ((void *) &(p->addr));
			}					/* endif */
			p++;
		}						/* endwhile */
	}							/* endif */

	return (NULL);
}

/*
 * checks the memblock of <size> bytes from <startaddr+size>
 * returns the address of the error or NULL if all is well
 */

void *RAM_MemTest_CheckAddrLineReverse (int mode, unsigned long startaddr,
										unsigned long size, int swapped)
{
	RAM_MEMTEST_ADDRLINE *p, *pe;
	unsigned long actual, expected;

	p = (RAM_MEMTEST_ADDRLINE *) (startaddr + size - sizeof (p->addr));
	pe = (RAM_MEMTEST_ADDRLINE *) startaddr;

	if (!swapped) {
		while (p > pe) {
			actual = p->addr;
			expected = (unsigned long) p;
			if (actual != expected) {
				Write_Error (mode, (unsigned long) &(p->addr), expected,
							 actual);
				return ((void *) &(p->addr));
			}					/* endif */
			p--;
		}						/* endwhile */
	} else {
		while (p > pe) {
			actual = p->addr;
			expected = Swap_32 ((unsigned long) p);
			if (actual != expected) {
				Write_Error (mode, (unsigned long) &(p->addr), expected,
							 actual);
				return ((void *) &(p->addr));
			}					/* endif */
			p--;
		}						/* endwhile */
	}							/* endif */

	return (NULL);
}

/*
 * fills the memblock of <size> bytes from <startaddr> with walking bit pattern
 */

void RAM_MemTest_WriteWalkBit (unsigned long startaddr, unsigned long size)
{
	volatile unsigned long *p, *pe;
	unsigned long i;

	p = (unsigned long *) startaddr;
	pe = (unsigned long *) (startaddr + size);
	i = 0;

	while (p < pe) {
		*p = 1UL << i;
		i = (i + 1 + (((unsigned long) p) >> 7)) % 32;
		p++;
	}							/* endwhile */
}

/*
 * checks the memblock of <size> bytes from <startaddr>
 * returns the address of the error or NULL if all is well
 */

void *RAM_MemTest_CheckWalkBit (int mode, unsigned long startaddr,
								unsigned long size)
{
	volatile unsigned long *p, *pe;
	unsigned long actual, expected;
	unsigned long i;

	p = (unsigned long *) startaddr;
	pe = (unsigned long *) (startaddr + size);
	i = 0;

	while (p < pe) {
		actual = *p;
		expected = (1UL << i);
		if (actual != expected) {
			Write_Error (mode, (unsigned long) p, expected, actual);
			return ((void *) p);
		}						/* endif */
		i = (i + 1 + (((unsigned long) p) >> 7)) % 32;
		p++;
	}							/* endwhile */

	return (NULL);
}

/*
 * fills the memblock of <size> bytes from <startaddr> with "random" pattern
 */

void RAM_MemTest_WriteRandomPattern (unsigned long startaddr,
									 unsigned long size,
									 unsigned long *pat)
{
	unsigned long i, p;

	p = *pat;

	for (i = 0; i < (size / 4); i++) {
		*(unsigned long *) (startaddr + i * 4) = p;
		if ((p % 2) > 0) {
			p ^= i;
			p >>= 1;
			p |= 0x80000000;
		} else {
			p ^= ~i;
			p >>= 1;
		}						/* endif */
	}							/* endfor */
	*pat = p;
}

/*
 * checks the memblock of <size> bytes from <startaddr>
 * returns the address of the error or NULL if all is well
 */

void *RAM_MemTest_CheckRandomPattern (int mode, unsigned long startaddr,
									  unsigned long size,
									  unsigned long *pat)
{
	void *perr = NULL;
	unsigned long i, p, p1;

	p = *pat;

	for (i = 0; i < (size / 4); i++) {
		p1 = *(unsigned long *) (startaddr + i * 4);
		if (p1 != p) {
			if (perr == NULL) {
				Write_Error (mode, startaddr + i * 4, p, p1);
				perr = (void *) (startaddr + i * 4);
			}					/* endif */
		}
		/* endif */
		if ((p % 2) > 0) {
			p ^= i;
			p >>= 1;
			p |= 0x80000000;
		} else {
			p ^= ~i;
			p >>= 1;
		}						/* endif */
	}							/* endfor */

	*pat = p;
	return (perr);
}


void RAM_MemTest_WriteData1 (unsigned long startaddr, unsigned long size,
							 unsigned long *pat)
{
	RAM_MemTest_WritePattern2 (startaddr, size, TESTPAT1, TESTPAT2);
}

void *RAM_MemTest_CheckData1 (int mode, unsigned long startaddr,
							  unsigned long size, unsigned long *pat)
{
	return (RAM_MemTest_CheckPattern2
			(mode, startaddr, size, TESTPAT1, TESTPAT2));
}

void RAM_MemTest_WriteData2 (unsigned long startaddr, unsigned long size,
							 unsigned long *pat)
{
	RAM_MemTest_WritePattern2 (startaddr, size, TESTPAT2, TESTPAT1);
}

void *RAM_MemTest_CheckData2 (int mode, unsigned long startaddr,
							  unsigned long size, unsigned long *pat)
{
	return (RAM_MemTest_CheckPattern2
			(mode, startaddr, size, TESTPAT2, TESTPAT1));
}

void RAM_MemTest_WriteAddr1 (unsigned long startaddr, unsigned long size,
							 unsigned long *pat)
{
	RAM_MemTest_WriteAddrLine (startaddr, size, FALSE);
}

void *RAM_MemTest_Check1Addr1 (int mode, unsigned long startaddr,
							   unsigned long size, unsigned long *pat)
{
	return (RAM_MemTest_CheckAddrLine (mode, startaddr, size, FALSE));
}

void *RAM_MemTest_Check2Addr1 (int mode, unsigned long startaddr,
							   unsigned long size, unsigned long *pat)
{
	return (RAM_MemTest_CheckAddrLineReverse
			(mode, startaddr, size, FALSE));
}

void RAM_MemTest_WriteAddr2 (unsigned long startaddr, unsigned long size,
							 unsigned long *pat)
{
	RAM_MemTest_WriteAddrLine (startaddr, size, TRUE);
}

void *RAM_MemTest_Check1Addr2 (int mode, unsigned long startaddr,
							   unsigned long size, unsigned long *pat)
{
	return (RAM_MemTest_CheckAddrLine (mode, startaddr, size, TRUE));
}

void *RAM_MemTest_Check2Addr2 (int mode, unsigned long startaddr,
							   unsigned long size, unsigned long *pat)
{
	return (RAM_MemTest_CheckAddrLineReverse
			(mode, startaddr, size, TRUE));
}


typedef struct {
	void (*test_write) (unsigned long startaddr, unsigned long size,
						unsigned long *pat);
	char *test_write_desc;
	void *(*test_check1) (int mode, unsigned long startaddr,
						  unsigned long size, unsigned long *pat);
	void *(*test_check2) (int mode, unsigned long startaddr,
						  unsigned long size, unsigned long *pat);
} RAM_MEMTEST_FUNC;


#define TEST_STAGES 5
static RAM_MEMTEST_FUNC test_stage[TEST_STAGES] = {
	{RAM_MemTest_WriteData1, "data test 1...\n", RAM_MemTest_CheckData1,
	 NULL},
	{RAM_MemTest_WriteData2, "data test 2...\n", RAM_MemTest_CheckData2,
	 NULL},
	{RAM_MemTest_WriteAddr1, "address line test...\n",
	 RAM_MemTest_Check1Addr1, RAM_MemTest_Check2Addr1},
	{RAM_MemTest_WriteAddr2, "address line test (swapped)...\n",
	 RAM_MemTest_Check1Addr2, RAM_MemTest_Check2Addr2},
	{RAM_MemTest_WriteRandomPattern, "random data test...\n",
	 RAM_MemTest_CheckRandomPattern, NULL}
};

void mem_test_reloc(void)
{
	unsigned long addr;
	int i;
	for (i=0; i< TEST_STAGES; i++) {
		addr = (ulong) (test_stage[i].test_write) + gd->reloc_off;
		test_stage[i].test_write=
			(void (*) (unsigned long startaddr, unsigned long size,
						unsigned long *pat))addr;
		addr = (ulong) (test_stage[i].test_write_desc) + gd->reloc_off;
		test_stage[i].test_write_desc=(char *)addr;
		if(test_stage[i].test_check1) {
			addr = (ulong) (test_stage[i].test_check1) + gd->reloc_off;
			test_stage[i].test_check1=
				(void *(*) (int mode, unsigned long startaddr,
				 unsigned long size, unsigned long *pat))addr;
		}
		if(test_stage[i].test_check2) {
			addr = (ulong) (test_stage[i].test_check2) + gd->reloc_off;
			test_stage[i].test_check2=
				(void *(*) (int mode, unsigned long startaddr,
				 unsigned long size, unsigned long *pat))addr;
		}
	}
}


int mem_test (unsigned long start, unsigned long ramsize, int quiet)
{
	unsigned long errors, stage;
	unsigned long startaddr, size, i;
	const unsigned long blocksize = 0x80000;	/* check in 512KB blocks */
	unsigned long *perr;
	unsigned long rdatapat;
	char dispbuf[80];
	int status = TEST_PASSED;
	int prog = 0;

	errors = 0;
	startaddr = start;
	size = ramsize;
	if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
		prog++;
		printf (".");
	}
	sprintf (dispbuf, "\nMemory Test: addr = 0x%lx size = 0x%lx\n",
			 startaddr, size);
	testm_puts (quiet, dispbuf);
	for (stage = 0; stage < TEST_STAGES; stage++) {
		sprintf (dispbuf, test_stage[stage].test_write_desc);
		testm_puts (quiet, dispbuf);
		/* fill SDRAM */
		rdatapat = 0x12345678;
		sprintf (dispbuf, "writing block:     ");
		testm_puts (quiet, dispbuf);
		for (i = 0; i < size; i += blocksize) {
			sprintf (dispbuf, "%04lX\b\b\b\b", i / blocksize);
			testm_puts (quiet, dispbuf);
			test_stage[stage].test_write (startaddr + i, blocksize,
										  &rdatapat);
		}						/* endfor */
		sprintf (dispbuf, "\n");
		testm_puts (quiet, dispbuf);
		if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
			prog++;
			printf (".");
		}
		/* check SDRAM */
		rdatapat = 0x12345678;
		sprintf (dispbuf, "checking block:     ");
		testm_puts (quiet, dispbuf);
		for (i = 0; i < size; i += blocksize) {
			sprintf (dispbuf, "%04lX\b\b\b\b", i / blocksize);
			testm_puts (quiet, dispbuf);
			if ((perr =
				 test_stage[stage].test_check1 (quiet, startaddr + i,
												blocksize,
												&rdatapat)) != NULL) {
				status = TEST_FAILED;
			}					/* endif */
		}						/* endfor */
		sprintf (dispbuf, "\n");
		testm_puts (quiet, dispbuf);
		if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
			prog++;
			printf (".");
		}
		if (test_stage[stage].test_check2 != NULL) {
			/* check2 SDRAM */
			sprintf (dispbuf, "2nd checking block:     ");
			rdatapat = 0x12345678;
			testm_puts (quiet, dispbuf);
			for (i = 0; i < size; i += blocksize) {
				sprintf (dispbuf, "%04lX\b\b\b\b", i / blocksize);
				testm_puts (quiet, dispbuf);
				if ((perr =
					 test_stage[stage].test_check2 (quiet, startaddr + i,
													blocksize,
													&rdatapat)) != NULL) {
					status = TEST_FAILED;
				}				/* endif */
			}					/* endfor */
			sprintf (dispbuf, "\n");
			testm_puts (quiet, dispbuf);
			if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
				prog++;
				printf (".");
			}
		}

	}							/* next stage */
	if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
		while (prog-- > 0)
			printf ("\b \b");
	}

	if (status == TEST_FAILED)
		errors++;

	return (errors);
}
Commit	Line	Data
67c4f48a WD	1	/*
	2	* (C) Copyright 2001
	3	* Denis Peter, MPL AG Switzerland, d.peter@mpl.ch
	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	*/
	24
	25	/* NOT Used yet...
	26	add following code to PIP405.c :
	27	int testdram (void)
	28	{
	29	unsigned char s[32];
	30	int i;
	31
	32	i = getenv_r ("testmem", s, 32);
	33	if (i != 0) {
	34	i = (int) simple_strtoul (s, NULL, 10);
	35	if ((i > 0) && (i < 0xf)) {
	36	printf ("testing ");
	37	i = mem_test (0, ramsize, i);
	38	if (i > 0)
	39	printf ("ERROR ");
	40	else
	41	printf ("Ok ");
	42	}
	43	}
	44	return (1);
	45	}
	46	*/
	47
	48
	49	#include <common.h>
	50	#include <asm/processor.h>
79b2d0bb	51	#include <4xx_i2c.h>
67c4f48a	52
d87080b7 WD	53	DECLARE_GLOBAL_DATA_PTR;
d87080b7 WD	54
67c4f48a WD	55	#define FALSE 0
	56	#define TRUE 1
	57
53677ef1 WD	58	#define TEST_QUIET 8
	59	#define TEST_SHOW_PROG 4
	60	#define TEST_SHOW_ERR 2
d87080b7	61	#define TEST_SHOW_ALL 1
67c4f48a WD	62
	63	#define TESTPAT1 0xAA55AA55
	64	#define TESTPAT2 0x55AA55AA
	65	#define TEST_PASSED 0
	66	#define TEST_FAILED 1
	67	#define MEGABYTE (1024*1024)
	68
	69
67c4f48a WD	70	typedef struct {
	71	volatile unsigned long pat1;
	72	volatile unsigned long pat2;
	73	} RAM_MEMTEST_PATTERN2;
	74
	75	typedef struct {
	76	volatile unsigned long addr;
	77	} RAM_MEMTEST_ADDRLINE;
	78
	79	static __inline unsigned long Swap_32 (unsigned long val)
	80	{
	81	return (((val << 16) & 0xFFFF0000) \| ((val >> 16) & 0x0000FFFF));
	82	}
	83
	84	void testm_puts (int quiet, char *buf)
	85	{
	86	if ((quiet & TEST_SHOW_ALL) == TEST_SHOW_ALL)
	87	puts (buf);
	88	}
	89
	90
	91	void Write_Error (int mode, unsigned long addr, unsigned long expected,
	92	unsigned long actual)
	93	{
	94
	95	char dispbuf[64];
	96
	97	sprintf (dispbuf, "\n ERROR @ 0x%08lX: (exp: 0x%08lX act: 0x%08lX) ",
	98	addr, expected, actual);
	99	testm_puts (((mode & TEST_SHOW_ERR) ==
	100	TEST_SHOW_ERR) ? TEST_SHOW_ALL : mode, dispbuf);
	101	}
	102
	103
	104	/*
	105	* fills the memblock of <size> bytes from <startaddr> with pat1 and pat2
	106	*/
	107
	108
	109	void RAM_MemTest_WritePattern2 (unsigned long startaddr,
	110	unsigned long size, unsigned long pat1,
	111	unsigned long pat2)
	112	{
	113	RAM_MEMTEST_PATTERN2 p, pe;
	114
	115	p = (RAM_MEMTEST_PATTERN2 *) startaddr;
	116	pe = (RAM_MEMTEST_PATTERN2 *) (startaddr + size);
	117
	118	while (p < pe) {
	119	p->pat1 = pat1;
	120	p->pat2 = pat2;
	121	p++;
	122	} /* endwhile */
	123	}
	124
	125	/*
	126	* checks the memblock of <size> bytes from <startaddr> with pat1 and pat2
	127	* returns the address of the first error or NULL if all is well
	128	*/
	129
	130	void *RAM_MemTest_CheckPattern2 (int mode, unsigned long startaddr,
	131	unsigned long size, unsigned long pat1,
	132	unsigned long pat2)
	133	{
134	RAM_MEMTEST_PATTERN2 p, pe;
135	unsigned long actual1, actual2;
136
137	p = (RAM_MEMTEST_PATTERN2 *) startaddr;
138	pe = (RAM_MEMTEST_PATTERN2 *) (startaddr + size);
139
140	while (p < pe) {
141	actual1 = p->pat1;
142	actual2 = p->pat2;
143
144	if (actual1 != pat1) {
145	Write_Error (mode, (unsigned long) &(p->pat1), pat1, actual1);
146	return ((void *) &(p->pat1));
147	}
148	/* endif */
149	if (actual2 != pat2) {
150	Write_Error (mode, (unsigned long) &(p->pat2), pat2, actual2);
151	return ((void *) &(p->pat2));
152	}
153	/* endif */
154	p++;
155	} /* endwhile */
156
157	return (NULL);
158	}
159
160	/*
161	* fills the memblock of <size> bytes from <startaddr> with the address
162	*/
163
164	void RAM_MemTest_WriteAddrLine (unsigned long startaddr,
165	unsigned long size, int swapped)
166	{
167	RAM_MEMTEST_ADDRLINE p, pe;
168
169	p = (RAM_MEMTEST_ADDRLINE *) startaddr;
170	pe = (RAM_MEMTEST_ADDRLINE *) (startaddr + size);
171
172	if (!swapped) {
173	while (p < pe) {
174	p->addr = (unsigned long) p;
175	p++;
176	} /* endwhile */
177	} else {
178	while (p < pe) {
179	p->addr = Swap_32 ((unsigned long) p);
180	p++;
181	} /* endwhile */
182	} /* endif */
183	}
184
185	/*
186	* checks the memblock of <size> bytes from <startaddr>
187	* returns the address of the error or NULL if all is well
188	*/
189
190	void *RAM_MemTest_CheckAddrLine (int mode, unsigned long startaddr,
191	unsigned long size, int swapped)
192	{
193	RAM_MEMTEST_ADDRLINE p, pe;
194	unsigned long actual, expected;
195
196	p = (RAM_MEMTEST_ADDRLINE *) startaddr;
197	pe = (RAM_MEMTEST_ADDRLINE *) (startaddr + size);
198
199	if (!swapped) {
200	while (p < pe) {
201	actual = p->addr;
202	expected = (unsigned long) p;
203	if (actual != expected) {
204	Write_Error (mode, (unsigned long) &(p->addr), expected,
205	actual);
206	return ((void *) &(p->addr));
207	} /* endif */
208	p++;
209	} /* endwhile */
210	} else {
211	while (p < pe) {
212	actual = p->addr;
213	expected = Swap_32 ((unsigned long) p);
214	if (actual != expected) {
215	Write_Error (mode, (unsigned long) &(p->addr), expected,
216	actual);
217	return ((void *) &(p->addr));
218	} /* endif */
219	p++;
220	} /* endwhile */
221	} /* endif */
222
223	return (NULL);
224	}
225
226	/*
227	* checks the memblock of <size> bytes from <startaddr+size>
228	* returns the address of the error or NULL if all is well
229	*/
230
231	void *RAM_MemTest_CheckAddrLineReverse (int mode, unsigned long startaddr,
232	unsigned long size, int swapped)
233	{
234	RAM_MEMTEST_ADDRLINE p, pe;
235	unsigned long actual, expected;
236
237	p = (RAM_MEMTEST_ADDRLINE *) (startaddr + size - sizeof (p->addr));
238	pe = (RAM_MEMTEST_ADDRLINE *) startaddr;
239
240	if (!swapped) {
241	while (p > pe) {
242	actual = p->addr;
243	expected = (unsigned long) p;
244	if (actual != expected) {
245	Write_Error (mode, (unsigned long) &(p->addr), expected,
246	actual);
247	return ((void *) &(p->addr));
248	} /* endif */
249	p--;
250	} /* endwhile */
251	} else {
252	while (p > pe) {
253	actual = p->addr;
254	expected = Swap_32 ((unsigned long) p);
255	if (actual != expected) {
256	Write_Error (mode, (unsigned long) &(p->addr), expected,
257	actual);
258	return ((void *) &(p->addr));
259	} /* endif */
260	p--;
261	} /* endwhile */
262	} /* endif */
263
264	return (NULL);
265	}
266
267	/*
268	* fills the memblock of <size> bytes from <startaddr> with walking bit pattern
269	*/
270
271	void RAM_MemTest_WriteWalkBit (unsigned long startaddr, unsigned long size)
272	{
273	volatile unsigned long p, pe;
274	unsigned long i;
275
276	p = (unsigned long *) startaddr;
277	pe = (unsigned long *) (startaddr + size);
278	i = 0;
279
280	while (p < pe) {
281	*p = 1UL << i;
282	i = (i + 1 + (((unsigned long) p) >> 7)) % 32;
283	p++;
284	} /* endwhile */
285	}
286
287	/*
288	* checks the memblock of <size> bytes from <startaddr>
289	* returns the address of the error or NULL if all is well
290	*/
291
292	void *RAM_MemTest_CheckWalkBit (int mode, unsigned long startaddr,
293	unsigned long size)
294	{
295	volatile unsigned long p, pe;
296	unsigned long actual, expected;
297	unsigned long i;
298
299	p = (unsigned long *) startaddr;
300	pe = (unsigned long *) (startaddr + size);
301	i = 0;
302
303	while (p < pe) {
304	actual = *p;
305	expected = (1UL << i);
306	if (actual != expected) {
307	Write_Error (mode, (unsigned long) p, expected, actual);
308	return ((void *) p);
309	} /* endif */
310	i = (i + 1 + (((unsigned long) p) >> 7)) % 32;
311	p++;
312	} /* endwhile */
313
314	return (NULL);
315	}
316
317	/*
318	* fills the memblock of <size> bytes from <startaddr> with "random" pattern
319	*/
320
321	void RAM_MemTest_WriteRandomPattern (unsigned long startaddr,
322	unsigned long size,
323	unsigned long *pat)
324	{
325	unsigned long i, p;
326
327	p = *pat;
328
329	for (i = 0; i < (size / 4); i++) {
330	(unsigned long ) (startaddr + i * 4) = p;
331	if ((p % 2) > 0) {
332	p ^= i;
333	p >>= 1;
334	p \|= 0x80000000;
335	} else {
336	p ^= ~i;
337	p >>= 1;
338	} /* endif */
339	} /* endfor */
340	*pat = p;
341	}
342
343	/*
344	* checks the memblock of <size> bytes from <startaddr>
345	* returns the address of the error or NULL if all is well
346	*/
347
348	void *RAM_MemTest_CheckRandomPattern (int mode, unsigned long startaddr,
349	unsigned long size,
350	unsigned long *pat)
351	{
352	void *perr = NULL;
353	unsigned long i, p, p1;
354
355	p = *pat;
356
357	for (i = 0; i < (size / 4); i++) {
358	p1 = (unsigned long ) (startaddr + i * 4);
359	if (p1 != p) {
360	if (perr == NULL) {
361	Write_Error (mode, startaddr + i * 4, p, p1);
362	perr = (void ) (startaddr + i 4);
363	} /* endif */
364	}
365	/* endif */
366	if ((p % 2) > 0) {
367	p ^= i;
368	p >>= 1;
369	p \|= 0x80000000;
370	} else {
371	p ^= ~i;
372	p >>= 1;
373	} /* endif */
374	} /* endfor */
375
376	*pat = p;
377	return (perr);
378	}
379
380
381	void RAM_MemTest_WriteData1 (unsigned long startaddr, unsigned long size,
382	unsigned long *pat)
383	{
384	RAM_MemTest_WritePattern2 (startaddr, size, TESTPAT1, TESTPAT2);
385	}
386
387	void *RAM_MemTest_CheckData1 (int mode, unsigned long startaddr,
388	unsigned long size, unsigned long *pat)
389	{
390	return (RAM_MemTest_CheckPattern2
391	(mode, startaddr, size, TESTPAT1, TESTPAT2));
392	}
393
394	void RAM_MemTest_WriteData2 (unsigned long startaddr, unsigned long size,
395	unsigned long *pat)
396	{
397	RAM_MemTest_WritePattern2 (startaddr, size, TESTPAT2, TESTPAT1);
398	}
399
400	void *RAM_MemTest_CheckData2 (int mode, unsigned long startaddr,
401	unsigned long size, unsigned long *pat)
402	{
403	return (RAM_MemTest_CheckPattern2
404	(mode, startaddr, size, TESTPAT2, TESTPAT1));
405	}
406
407	void RAM_MemTest_WriteAddr1 (unsigned long startaddr, unsigned long size,
408	unsigned long *pat)
409	{
410	RAM_MemTest_WriteAddrLine (startaddr, size, FALSE);
411	}
412
413	void *RAM_MemTest_Check1Addr1 (int mode, unsigned long startaddr,
414	unsigned long size, unsigned long *pat)
415	{
416	return (RAM_MemTest_CheckAddrLine (mode, startaddr, size, FALSE));
417	}
418
419	void *RAM_MemTest_Check2Addr1 (int mode, unsigned long startaddr,
420	unsigned long size, unsigned long *pat)
421	{
422	return (RAM_MemTest_CheckAddrLineReverse
423	(mode, startaddr, size, FALSE));
424	}
425
426	void RAM_MemTest_WriteAddr2 (unsigned long startaddr, unsigned long size,
427	unsigned long *pat)
428	{
429	RAM_MemTest_WriteAddrLine (startaddr, size, TRUE);
430	}
431
432	void *RAM_MemTest_Check1Addr2 (int mode, unsigned long startaddr,
433	unsigned long size, unsigned long *pat)
434	{
435	return (RAM_MemTest_CheckAddrLine (mode, startaddr, size, TRUE));
436	}
437
438	void *RAM_MemTest_Check2Addr2 (int mode, unsigned long startaddr,
439	unsigned long size, unsigned long *pat)
440	{
441	return (RAM_MemTest_CheckAddrLineReverse
442	(mode, startaddr, size, TRUE));
443	}
444
445
67c4f48a WD	446	typedef struct {
	447	void (*test_write) (unsigned long startaddr, unsigned long size,
	448	unsigned long *pat);
	449	char *test_write_desc;
	450	void (test_check1) (int mode, unsigned long startaddr,
	451	unsigned long size, unsigned long *pat);
	452	void (test_check2) (int mode, unsigned long startaddr,
	453	unsigned long size, unsigned long *pat);
	454	} RAM_MEMTEST_FUNC;
	455
	456
	457	#define TEST_STAGES 5
33149b88	458	static RAM_MEMTEST_FUNC test_stage[TEST_STAGES] = {
67c4f48a WD	459	{RAM_MemTest_WriteData1, "data test 1...\n", RAM_MemTest_CheckData1,
	460	NULL},
	461	{RAM_MemTest_WriteData2, "data test 2...\n", RAM_MemTest_CheckData2,
	462	NULL},
	463	{RAM_MemTest_WriteAddr1, "address line test...\n",
	464	RAM_MemTest_Check1Addr1, RAM_MemTest_Check2Addr1},
	465	{RAM_MemTest_WriteAddr2, "address line test (swapped)...\n",
	466	RAM_MemTest_Check1Addr2, RAM_MemTest_Check2Addr2},
	467	{RAM_MemTest_WriteRandomPattern, "random data test...\n",
	468	RAM_MemTest_CheckRandomPattern, NULL}
	469	};
	470
33149b88 WD	471	void mem_test_reloc(void)
33149b88 WD	472	{
33149b88 WD	473	unsigned long addr;
	474	int i;
	475	for (i=0; i< TEST_STAGES; i++) {
53677ef1	476	addr = (ulong) (test_stage[i].test_write) + gd->reloc_off;
33149b88 WD	477	test_stage[i].test_write=
	478	(void (*) (unsigned long startaddr, unsigned long size,
	479	unsigned long *pat))addr;
53677ef1	480	addr = (ulong) (test_stage[i].test_write_desc) + gd->reloc_off;
33149b88	481	test_stage[i].test_write_desc=(char *)addr;
53677ef1	482	if(test_stage[i].test_check1) {
33149b88 WD	483	addr = (ulong) (test_stage[i].test_check1) + gd->reloc_off;
	484	test_stage[i].test_check1=
	485	(void () (int mode, unsigned long startaddr,
	486	unsigned long size, unsigned long *pat))addr;
	487	}
53677ef1	488	if(test_stage[i].test_check2) {
33149b88 WD	489	addr = (ulong) (test_stage[i].test_check2) + gd->reloc_off;
	490	test_stage[i].test_check2=
	491	(void () (int mode, unsigned long startaddr,
	492	unsigned long size, unsigned long *pat))addr;
	493	}
	494	}
	495	}
67c4f48a WD	496
67c4f48a WD	497
27b207fd	498	int mem_test (unsigned long start, unsigned long ramsize, int quiet)
67c4f48a WD	499	{
	500	unsigned long errors, stage;
	501	unsigned long startaddr, size, i;
	502	const unsigned long blocksize = 0x80000; /* check in 512KB blocks */
	503	unsigned long *perr;
	504	unsigned long rdatapat;
	505	char dispbuf[80];
	506	int status = TEST_PASSED;
	507	int prog = 0;
	508
	509	errors = 0;
	510	startaddr = start;
	511	size = ramsize;
	512	if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
	513	prog++;
	514	printf (".");
	515	}
	516	sprintf (dispbuf, "\nMemory Test: addr = 0x%lx size = 0x%lx\n",
	517	startaddr, size);
	518	testm_puts (quiet, dispbuf);
	519	for (stage = 0; stage < TEST_STAGES; stage++) {
	520	sprintf (dispbuf, test_stage[stage].test_write_desc);
	521	testm_puts (quiet, dispbuf);
	522	/* fill SDRAM */
	523	rdatapat = 0x12345678;
	524	sprintf (dispbuf, "writing block: ");
	525	testm_puts (quiet, dispbuf);
	526	for (i = 0; i < size; i += blocksize) {
	527	sprintf (dispbuf, "%04lX\b\b\b\b", i / blocksize);
	528	testm_puts (quiet, dispbuf);
	529	test_stage[stage].test_write (startaddr + i, blocksize,
	530	&rdatapat);
	531	} /* endfor */
	532	sprintf (dispbuf, "\n");
	533	testm_puts (quiet, dispbuf);
	534	if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
	535	prog++;
	536	printf (".");
	537	}
	538	/* check SDRAM */
	539	rdatapat = 0x12345678;
	540	sprintf (dispbuf, "checking block: ");
	541	testm_puts (quiet, dispbuf);
	542	for (i = 0; i < size; i += blocksize) {
	543	sprintf (dispbuf, "%04lX\b\b\b\b", i / blocksize);
	544	testm_puts (quiet, dispbuf);
	545	if ((perr =
	546	test_stage[stage].test_check1 (quiet, startaddr + i,
	547	blocksize,
	548	&rdatapat)) != NULL) {
	549	status = TEST_FAILED;
	550	} /* endif */
	551	} /* endfor */
	552	sprintf (dispbuf, "\n");
	553	testm_puts (quiet, dispbuf);
	554	if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
	555	prog++;
	556	printf (".");
	557	}
	558	if (test_stage[stage].test_check2 != NULL) {
	559	/* check2 SDRAM */
	560	sprintf (dispbuf, "2nd checking block: ");
	561	rdatapat = 0x12345678;
	562	testm_puts (quiet, dispbuf);
563	for (i = 0; i < size; i += blocksize) {
564	sprintf (dispbuf, "%04lX\b\b\b\b", i / blocksize);
565	testm_puts (quiet, dispbuf);
566	if ((perr =
567	test_stage[stage].test_check2 (quiet, startaddr + i,
568	blocksize,
569	&rdatapat)) != NULL) {
570	status = TEST_FAILED;
571	} /* endif */
572	} /* endfor */
573	sprintf (dispbuf, "\n");
574	testm_puts (quiet, dispbuf);
575	if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
576	prog++;
577	printf (".");
578	}
579	}
580
581	} /* next stage */
582	if ((quiet & TEST_SHOW_PROG) == TEST_SHOW_PROG) {
583	while (prog-- > 0)
584	printf ("\b \b");
585	}
586
587	if (status == TEST_FAILED)
588	errors++;
589
590	return (errors);
591	}