blob: 45b9ff26e86b271e1d85a7465791a7407b8b1744 [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 * Branch instructions: b, bl, bc
29 *
30 * The first 2 instructions (b, bl) are verified by jumping
31 * to a fixed address and checking whether control was transfered
32 * to that very point. For the bl instruction the value of the
33 * link register is checked as well (using mfspr).
34 * To verify the bc instruction various combinations of the BI/BO
35 * fields, the CTR and the condition register values are
36 * checked. The list of such combinations is pre-built and
37 * linked in U-Boot at build time.
38 */
39
Wolfgang Denkad5bb452007-03-06 18:08:43 +010040#include <post.h>
41#include "cpu_asm.h"
42
43#if CONFIG_POST & CFG_POST_CPU
44
45extern void cpu_post_exec_11 (ulong *code, ulong *res, ulong op1);
46extern void cpu_post_exec_31 (ulong *code, ulong *ctr, ulong *lr, ulong *jump,
47 ulong cr);
48
49static int cpu_post_test_bc (ulong cmd, ulong bo, ulong bi,
Igor Lisitsina11e0692007-03-28 19:06:19 +040050 int pjump, int decr, int link, ulong pctr, ulong cr)
Wolfgang Denkad5bb452007-03-06 18:08:43 +010051{
52 int ret = 0;
53 ulong lr = 0;
54 ulong ctr = pctr;
55 ulong jump;
56
57 unsigned long code[] =
58 {
59 ASM_MTCR(6),
60 ASM_MFLR(6),
61 ASM_MTCTR(3),
62 ASM_MTLR(4),
63 ASM_LI(5, 1),
64 ASM_3O(cmd, bo, bi, 8),
65 ASM_LI(5, 0),
66 ASM_MFCTR(3),
67 ASM_MFLR(4),
68 ASM_MTLR(6),
69 ASM_BLR,
70 };
71
72 cpu_post_exec_31 (code, &ctr, &lr, &jump, cr);
73
74 if (ret == 0)
75 ret = pjump == jump ? 0 : -1;
76 if (ret == 0)
77 {
Igor Lisitsina11e0692007-03-28 19:06:19 +040078 if (decr)
Wolfgang Denkad5bb452007-03-06 18:08:43 +010079 ret = pctr == ctr + 1 ? 0 : -1;
80 else
81 ret = pctr == ctr ? 0 : -1;
82 }
83 if (ret == 0)
84 {
85 if (link)
86 ret = lr == (ulong) code + 24 ? 0 : -1;
87 else
88 ret = lr == 0 ? 0 : -1;
89 }
90
91 return ret;
92}
93
94int cpu_post_test_b (void)
95{
96 int ret = 0;
97 unsigned int i;
98
99 if (ret == 0)
100 {
101 ulong code[] =
102 {
103 ASM_MFLR(4),
104 ASM_MTLR(3),
105 ASM_B(4),
106 ASM_MFLR(3),
107 ASM_MTLR(4),
108 ASM_BLR,
109 };
110 ulong res;
111
112 cpu_post_exec_11 (code, &res, 0);
113
114 ret = res == 0 ? 0 : -1;
115
116 if (ret != 0)
117 {
118 post_log ("Error at b1 test !\n");
119 }
120 }
121
122 if (ret == 0)
123 {
124 ulong code[] =
125 {
126 ASM_MFLR(4),
127 ASM_MTLR(3),
128 ASM_BL(4),
129 ASM_MFLR(3),
130 ASM_MTLR(4),
131 ASM_BLR,
132 };
133 ulong res;
134
135 cpu_post_exec_11 (code, &res, 0);
136
137 ret = res == (ulong)code + 12 ? 0 : -1;
138
139 if (ret != 0)
140 {
141 post_log ("Error at b2 test !\n");
142 }
143 }
144
145 if (ret == 0)
146 {
147 ulong cc, cd;
148 int cond;
149 ulong ctr;
150 int link;
151
152 i = 0;
153
154 for (cc = 0; cc < 4 && ret == 0; cc++)
155 {
156 for (cd = 0; cd < 4 && ret == 0; cd++)
157 {
158 for (link = 0; link <= 1 && ret == 0; link++)
159 {
160 for (cond = 0; cond <= 1 && ret == 0; cond++)
161 {
162 for (ctr = 1; ctr <= 2 && ret == 0; ctr++)
163 {
Igor Lisitsina11e0692007-03-28 19:06:19 +0400164 int decr = cd < 2;
Wolfgang Denkad5bb452007-03-06 18:08:43 +0100165 int cr = cond ? 0x80000000 : 0x00000000;
166 int jumpc = cc >= 2 ||
167 (cc == 0 && !cond) ||
168 (cc == 1 && cond);
169 int jumpd = cd >= 2 ||
170 (cd == 0 && ctr != 1) ||
171 (cd == 1 && ctr == 1);
172 int jump = jumpc && jumpd;
173
174 ret = cpu_post_test_bc (link ? OP_BCL : OP_BC,
Igor Lisitsina11e0692007-03-28 19:06:19 +0400175 (cc << 3) + (cd << 1), 0, jump, decr, link,
Wolfgang Denkad5bb452007-03-06 18:08:43 +0100176 ctr, cr);
177
178 if (ret != 0)
179 {
180 post_log ("Error at b3 test %d !\n", i);
181 }
182
183 i++;
184 }
185 }
186 }
187 }
188 }
189 }
190
191 return ret;
192}
193
194#endif