Merge branch 'master' of /home/wd/git/u-boot/lwmon5
[platform/kernel/u-boot.git] / post / lib_ppc / string.c
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 string instructions:      lswi, stswi, lswx, stswx
29  *
30  * Several consecutive bytes from a source memory buffer are loaded
31  * left to right into GPRs. After that, the bytes are stored
32  * from the GPRs 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 & CFG_POST_CPU
40
41 extern void cpu_post_exec_02 (ulong *code, ulong op1, ulong op2);
42 extern void cpu_post_exec_04 (ulong *code, ulong op1, ulong op2, ulong op3,
43     ulong op4);
44
45 #include <bedbug/regs.h>
46 int cpu_post_test_string (void)
47 {
48     int ret = 0;
49     unsigned int i;
50
51     if (ret == 0)
52     {
53         char src [31], dst [31];
54
55         ulong code[] =
56         {
57             ASM_LSWI(5, 3, 31),
58             ASM_STSWI(5, 4, 31),
59             ASM_BLR,
60         };
61
62         for (i = 0; i < sizeof(src); i ++)
63         {
64             src[i] = (char) i;
65             dst[i] = 0;
66         }
67
68         cpu_post_exec_02(code, (ulong)src, (ulong)dst);
69
70         ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
71     }
72
73     if (ret == 0)
74     {
75         char src [95], dst [95];
76
77         ulong code[] =
78         {
79             ASM_LSWX(8, 3, 5),
80             ASM_STSWX(8, 4, 5),
81             ASM_BLR,
82         };
83
84         for (i = 0; i < sizeof(src); i ++)
85         {
86             src[i] = (char) i;
87             dst[i] = 0;
88         }
89
90         cpu_post_exec_04(code, (ulong)src, (ulong)dst, 0, sizeof(src));
91
92         ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
93     }
94
95     if (ret != 0)
96     {
97         post_log ("Error at string test !\n");
98     }
99
100     return ret;
101 }
102
103 #endif