xref: /openbmc/u-boot/post/lib_powerpc/multi.c (revision 8875833a)
1 /*
2  * (C) Copyright 2002
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
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 #include <common.h>
25 
26 /*
27  * CPU test
28  * Load/store multiple word instructions:	lmw, stmw
29  *
30  * 27 consecutive words are loaded from a source memory buffer
31  * into GPRs r5 through r31. After that, 27 consecutive words are stored
32  * from the GPRs r5 through r31 into a target memory buffer. The contents
33  * of the source and target buffers are then compared.
34  */
35 
36 #include <post.h>
37 #include "cpu_asm.h"
38 
39 #if CONFIG_POST & CONFIG_SYS_POST_CPU
40 
41 extern void cpu_post_exec_02(ulong *code, ulong op1, ulong op2);
42 
43 int cpu_post_test_multi(void)
44 {
45 	int ret = 0;
46 	unsigned int i;
47 	ulong src[27], dst[27];
48 	int flag = disable_interrupts();
49 
50 	ulong code[] = {
51 		ASM_LMW(5, 3, 0),	/* lmw	r5, 0(r3)	*/
52 		ASM_STMW(5, 4, 0),	/* stmr	r5, 0(r4)	*/
53 		ASM_BLR,		/* blr			*/
54 	};
55 
56 	for (i = 0; i < ARRAY_SIZE(src); ++i) {
57 		src[i] = i;
58 		dst[i] = 0;
59 	}
60 
61 	cpu_post_exec_02(code, (ulong) src, (ulong) dst);
62 
63 	ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
64 
65 	if (ret != 0)
66 		post_log("Error at multi test !\n");
67 
68 	if (flag)
69 		enable_interrupts();
70 
71 	return ret;
72 }
73 
74 #endif
75