1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * (C) Copyright 2002
3*4882a593Smuzhiyun * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4*4882a593Smuzhiyun *
5*4882a593Smuzhiyun * SPDX-License-Identifier: GPL-2.0+
6*4882a593Smuzhiyun */
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun #include <common.h>
9*4882a593Smuzhiyun
10*4882a593Smuzhiyun /*
11*4882a593Smuzhiyun * CPU test
12*4882a593Smuzhiyun * Load/store string instructions: lswi, stswi, lswx, stswx
13*4882a593Smuzhiyun *
14*4882a593Smuzhiyun * Several consecutive bytes from a source memory buffer are loaded
15*4882a593Smuzhiyun * left to right into GPRs. After that, the bytes are stored
16*4882a593Smuzhiyun * from the GPRs into a target memory buffer. The contents
17*4882a593Smuzhiyun * of the source and target buffers are then compared.
18*4882a593Smuzhiyun */
19*4882a593Smuzhiyun
20*4882a593Smuzhiyun #include <post.h>
21*4882a593Smuzhiyun #include "cpu_asm.h"
22*4882a593Smuzhiyun
23*4882a593Smuzhiyun #if CONFIG_POST & CONFIG_SYS_POST_CPU
24*4882a593Smuzhiyun
25*4882a593Smuzhiyun extern void cpu_post_exec_02 (ulong *code, ulong op1, ulong op2);
26*4882a593Smuzhiyun extern void cpu_post_exec_04 (ulong *code, ulong op1, ulong op2, ulong op3,
27*4882a593Smuzhiyun ulong op4);
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun #include <bedbug/regs.h>
cpu_post_test_string(void)30*4882a593Smuzhiyun int cpu_post_test_string (void)
31*4882a593Smuzhiyun {
32*4882a593Smuzhiyun int ret = 0;
33*4882a593Smuzhiyun unsigned int i;
34*4882a593Smuzhiyun int flag = disable_interrupts();
35*4882a593Smuzhiyun
36*4882a593Smuzhiyun if (ret == 0)
37*4882a593Smuzhiyun {
38*4882a593Smuzhiyun char src [31], dst [31];
39*4882a593Smuzhiyun
40*4882a593Smuzhiyun ulong code[] =
41*4882a593Smuzhiyun {
42*4882a593Smuzhiyun ASM_LSWI(5, 3, 31),
43*4882a593Smuzhiyun ASM_STSWI(5, 4, 31),
44*4882a593Smuzhiyun ASM_BLR,
45*4882a593Smuzhiyun };
46*4882a593Smuzhiyun
47*4882a593Smuzhiyun for (i = 0; i < sizeof(src); i ++)
48*4882a593Smuzhiyun {
49*4882a593Smuzhiyun src[i] = (char) i;
50*4882a593Smuzhiyun dst[i] = 0;
51*4882a593Smuzhiyun }
52*4882a593Smuzhiyun
53*4882a593Smuzhiyun cpu_post_exec_02(code, (ulong)src, (ulong)dst);
54*4882a593Smuzhiyun
55*4882a593Smuzhiyun ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
56*4882a593Smuzhiyun }
57*4882a593Smuzhiyun
58*4882a593Smuzhiyun if (ret == 0)
59*4882a593Smuzhiyun {
60*4882a593Smuzhiyun char src [95], dst [95];
61*4882a593Smuzhiyun
62*4882a593Smuzhiyun ulong code[] =
63*4882a593Smuzhiyun {
64*4882a593Smuzhiyun ASM_LSWX(8, 3, 5),
65*4882a593Smuzhiyun ASM_STSWX(8, 4, 5),
66*4882a593Smuzhiyun ASM_BLR,
67*4882a593Smuzhiyun };
68*4882a593Smuzhiyun
69*4882a593Smuzhiyun for (i = 0; i < sizeof(src); i ++)
70*4882a593Smuzhiyun {
71*4882a593Smuzhiyun src[i] = (char) i;
72*4882a593Smuzhiyun dst[i] = 0;
73*4882a593Smuzhiyun }
74*4882a593Smuzhiyun
75*4882a593Smuzhiyun cpu_post_exec_04(code, (ulong)src, (ulong)dst, 0, sizeof(src));
76*4882a593Smuzhiyun
77*4882a593Smuzhiyun ret = memcmp(src, dst, sizeof(dst)) == 0 ? 0 : -1;
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun if (ret != 0)
81*4882a593Smuzhiyun {
82*4882a593Smuzhiyun post_log ("Error at string test !\n");
83*4882a593Smuzhiyun }
84*4882a593Smuzhiyun
85*4882a593Smuzhiyun if (flag)
86*4882a593Smuzhiyun enable_interrupts();
87*4882a593Smuzhiyun
88*4882a593Smuzhiyun return ret;
89*4882a593Smuzhiyun }
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun #endif
92