blob: 1956f6baa3b0df549d22cfaf17a918d7c4818335 [file] [log] [blame]
Wolfgang Denkad5bb452007-03-06 18:08:43 +01001/*
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 * Store instructions: stb(x)(u), sth(x)(u), stw(x)(u)
29 *
30 * All operations are performed on a 16-byte array. The array
31 * is 4-byte aligned. The base register points to offset 8.
32 * The immediate offset (index register) ranges in [-8 ... +7].
33 * The test cases are composed so that they do not
34 * cause alignment exceptions.
35 * The test contains a pre-built table describing all test cases.
36 * The table entry contains:
37 * the instruction opcode, the value of the index register and
38 * the value of the source register. After executing the
39 * instruction, the test verifies the contents of the array
40 * and the value of the base register (it must change for "store
41 * with update" instructions).
42 */
43
Wolfgang Denkad5bb452007-03-06 18:08:43 +010044#include <post.h>
45#include "cpu_asm.h"
46
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +020047#if CONFIG_POST & CONFIG_SYS_POST_CPU
Wolfgang Denkad5bb452007-03-06 18:08:43 +010048
49extern void cpu_post_exec_12w (ulong *code, ulong *op1, ulong op2, ulong op3);
50extern void cpu_post_exec_11w (ulong *code, ulong *op1, ulong op2);
51
52static struct cpu_post_store_s
53{
54 ulong cmd;
55 uint width;
56 int update;
57 int index;
58 ulong offset;
59 ulong value;
60} cpu_post_store_table[] =
61{
62 {
63 OP_STW,
64 4,
65 0,
66 0,
67 -4,
68 0xff00ff00
69 },
70 {
71 OP_STH,
72 2,
73 0,
74 0,
75 -2,
76 0xff00
77 },
78 {
79 OP_STB,
80 1,
81 0,
82 0,
83 -1,
84 0xff
85 },
86 {
87 OP_STWU,
88 4,
89 1,
90 0,
91 -4,
92 0xff00ff00
93 },
94 {
95 OP_STHU,
96 2,
97 1,
98 0,
99 -2,
100 0xff00
101 },
102 {
103 OP_STBU,
104 1,
105 1,
106 0,
107 -1,
108 0xff
109 },
110 {
111 OP_STWX,
112 4,
113 0,
114 1,
115 -4,
116 0xff00ff00
117 },
118 {
119 OP_STHX,
120 2,
121 0,
122 1,
123 -2,
124 0xff00
125 },
126 {
127 OP_STBX,
128 1,
129 0,
130 1,
131 -1,
132 0xff
133 },
134 {
135 OP_STWUX,
136 4,
137 1,
138 1,
139 -4,
140 0xff00ff00
141 },
142 {
143 OP_STHUX,
144 2,
145 1,
146 1,
147 -2,
148 0xff00
149 },
150 {
151 OP_STBUX,
152 1,
153 1,
154 1,
155 -1,
156 0xff
157 },
158};
159static unsigned int cpu_post_store_size =
160 sizeof (cpu_post_store_table) / sizeof (struct cpu_post_store_s);
161
162int cpu_post_test_store (void)
163{
164 int ret = 0;
165 unsigned int i;
Stefan Roesef2302d42008-08-06 14:05:38 +0200166 int flag = disable_interrupts();
Wolfgang Denkad5bb452007-03-06 18:08:43 +0100167
168 for (i = 0; i < cpu_post_store_size && ret == 0; i++)
169 {
170 struct cpu_post_store_s *test = cpu_post_store_table + i;
171 uchar data[16] =
172 { 0, 1, 2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15 };
173 ulong base0 = (ulong) (data + 8);
174 ulong base = base0;
175
176 if (test->index)
177 {
178 ulong code[] =
179 {
180 ASM_12(test->cmd, 5, 3, 4),
181 ASM_BLR,
182 };
183
184 cpu_post_exec_12w (code, &base, test->offset, test->value);
185 }
186 else
187 {
188 ulong code[] =
189 {
190 ASM_11I(test->cmd, 4, 3, test->offset),
191 ASM_BLR,
192 };
193
194 cpu_post_exec_11w (code, &base, test->value);
195 }
196
197 if (ret == 0)
198 {
199 if (test->update)
200 ret = base == base0 + test->offset ? 0 : -1;
201 else
202 ret = base == base0 ? 0 : -1;
203 }
204
205 if (ret == 0)
206 {
207 switch (test->width)
208 {
209 case 1:
210 ret = *(uchar *)(base0 + test->offset) == test->value ?
211 0 : -1;
212 break;
213 case 2:
214 ret = *(ushort *)(base0 + test->offset) == test->value ?
215 0 : -1;
216 break;
217 case 4:
218 ret = *(ulong *)(base0 + test->offset) == test->value ?
219 0 : -1;
220 break;
221 }
222 }
223
224 if (ret != 0)
225 {
226 post_log ("Error at store test %d !\n", i);
227 }
228 }
229
Stefan Roesef2302d42008-08-06 14:05:38 +0200230 if (flag)
231 enable_interrupts();
232
Wolfgang Denkad5bb452007-03-06 18:08:43 +0100233 return ret;
234}
235
236#endif