1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24#include <common.h>
25#include "ar405.h"
26#include <asm/processor.h>
27#include <asm/io.h>
28#include <command.h>
29
30DECLARE_GLOBAL_DATA_PTR;
31
32extern void lxt971_no_sleep(void);
33
34
35
36#if 0
37#define FPGA_DEBUG
38#endif
39
40
41const unsigned char fpgadata[] = {
42#include "fpgadata.c"
43};
44
45const unsigned char fpgadata_xl30[] = {
46#include "fpgadata_xl30.c"
47};
48
49
50
51
52#include "../common/fpga.c"
53
54
55int board_early_init_f (void)
56{
57 int index, len, i;
58 int status;
59
60#ifdef FPGA_DEBUG
61
62 (void) get_clocks ();
63 gd->baudrate = CONFIG_BAUDRATE;
64 serial_init ();
65 console_init_f ();
66#endif
67
68
69
70
71
72 gd->board_type = 40;
73 status = fpga_boot ((unsigned char *) fpgadata, sizeof (fpgadata));
74 if (status != 0) {
75
76 gd->board_type = 30;
77 status = fpga_boot ((unsigned char *) fpgadata_xl30, sizeof (fpgadata_xl30));
78 if (status != 0) {
79
80#ifndef FPGA_DEBUG
81
82 (void) get_clocks ();
83 gd->baudrate = CONFIG_BAUDRATE;
84 serial_init ();
85 console_init_f ();
86#endif
87 printf ("\nFPGA: Booting failed ");
88 switch (status) {
89 case ERROR_FPGA_PRG_INIT_LOW:
90 printf ("(Timeout: INIT not low after asserting PROGRAM*)\n ");
91 break;
92 case ERROR_FPGA_PRG_INIT_HIGH:
93 printf ("(Timeout: INIT not high after deasserting PROGRAM*)\n ");
94 break;
95 case ERROR_FPGA_PRG_DONE:
96 printf ("(Timeout: DONE not high after programming FPGA)\n ");
97 break;
98 }
99
100
101 index = 15;
102 for (i = 0; i < 4; i++) {
103 len = fpgadata[index];
104 printf ("FPGA: %s\n", &(fpgadata[index + 1]));
105 index += len + 3;
106 }
107 putc ('\n');
108
109 for (i = 20; i > 0; i--) {
110 printf ("Rebooting in %2d seconds \r", i);
111 for (index = 0; index < 1000; index++)
112 udelay (1000);
113 }
114 putc ('\n');
115 do_reset (NULL, 0, 0, NULL);
116 }
117 }
118
119
120
121
122
123
124
125
126
127
128
129
130
131 mtdcr (UIC0SR, 0xFFFFFFFF);
132 mtdcr (UIC0ER, 0x00000000);
133 mtdcr (UIC0CR, 0x00000000);
134 mtdcr (UIC0PR, 0xFFFFFF81);
135 mtdcr (UIC0TR, 0x10000000);
136 mtdcr (UIC0VCR, 0x00000001);
137 mtdcr (UIC0SR, 0xFFFFFFFF);
138
139 out_be16((void *)0xf03000ec, 0x0fff);
140
141 return 0;
142}
143
144
145
146
147int checkboard (void)
148{
149 int index;
150 int len;
151 char str[64];
152 int i = getenv_f("serial#", str, sizeof (str));
153 const unsigned char *fpga;
154
155 puts ("Board: ");
156
157 if (i == -1) {
158 puts ("### No HW ID - assuming AR405");
159 } else {
160 puts(str);
161 }
162
163 puts ("\nFPGA: ");
164
165
166 if (gd->board_type == 30) {
167 fpga = fpgadata_xl30;
168 } else {
169 fpga = fpgadata;
170 }
171 index = 15;
172 for (i = 0; i < 4; i++) {
173 len = fpga[index];
174 printf ("%s ", &(fpga[index + 1]));
175 index += len + 3;
176 }
177
178 putc ('\n');
179
180
181
182
183 lxt971_no_sleep();
184
185 return 0;
186}
187
188
189#if 1
190#define DIGEN ((void *)0xf03000b4)
191#define DIGOUT ((void *)0xf03000b0)
192#define DIGIN ((void *)0xf03000a0)
193
194
195
196
197int do_digtest(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
198{
199 int i;
200 int k;
201 int start;
202 int end;
203
204 if (argc != 3) {
205 puts("Usage: digtest n_start n_end (digtest 0 7)\n");
206 return 0;
207 }
208
209 start = simple_strtol (argv[1], NULL, 10);
210 end = simple_strtol (argv[2], NULL, 10);
211
212
213
214
215 out_8(DIGEN, 0x08);
216
217 printf("\nStarting digital In-/Out Test from I/O %d to %d (Cntrl-C to abort)...\n",
218 start, end);
219
220
221
222
223 for (;;) {
224 for (i=start; i<=end; i++) {
225 out_be16(DIGOUT, 0x0001 << i);
226 for (k=0; k<200; k++)
227 udelay(1000);
228
229 if (in_be16(DIGIN) != (0x0001 << i)) {
230 printf("ERROR: OUT=0x%04X, IN=0x%04X\n",
231 0x0001 << i, in_be16(DIGIN));
232 return 0;
233 }
234
235
236 if (ctrlc()) {
237 puts("\nAbort\n");
238 return 0;
239 }
240 }
241 }
242
243 return 0;
244}
245U_BOOT_CMD(
246 digtest, 3, 1, do_digtest,
247 "Test digital in-/output",
248 ""
249);
250
251#define ERROR_DELTA 256
252
253struct io {
254 short val;
255 short dummy;
256};
257
258int do_anatest(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
259{
260 short val;
261 int i;
262 int volt;
263 struct io *out;
264 struct io *in;
265
266 out = (struct io *)0xf0300090;
267 in = (struct io *)0xf0300000;
268
269 i = simple_strtol (argv[1], NULL, 10);
270
271 volt = 0;
272 printf("Setting Channel %d to %dV...\n", i, volt);
273 out_be16((void *)&(out[i].val), (volt * 0x7fff) / 10);
274 udelay(10000);
275 val = in_be16((void *)&(in[i*2].val));
276 printf("-> InChannel %d: 0x%04x=%dV\n", i*2, val, (val * 4000) / 0x7fff);
277 if ((val < ((volt * 0x7fff) / 40) - ERROR_DELTA) ||
278 (val > ((volt * 0x7fff) / 40) + ERROR_DELTA)) {
279 printf("ERROR! (min=0x%04x max=0x%04x)\n", ((volt * 0x7fff) / 40) - ERROR_DELTA,
280 ((volt * 0x7fff) / 40) + ERROR_DELTA);
281 return -1;
282 }
283 val = in_be16((void *)&(in[i*2+1].val));
284 printf("-> InChannel %d: 0x%04x=%dV\n", i*2+1, val, (val * 4000) / 0x7fff);
285 if ((val < ((volt * 0x7fff) / 40) - ERROR_DELTA) ||
286 (val > ((volt * 0x7fff) / 40) + ERROR_DELTA)) {
287 printf("ERROR! (min=0x%04x max=0x%04x)\n", ((volt * 0x7fff) / 40) - ERROR_DELTA,
288 ((volt * 0x7fff) / 40) + ERROR_DELTA);
289 return -1;
290 }
291
292 volt = 5;
293 printf("Setting Channel %d to %dV...\n", i, volt);
294 out_be16((void *)&(out[i].val), (volt * 0x7fff) / 10);
295 udelay(10000);
296 val = in_be16((void *)&(in[i*2].val));
297 printf("-> InChannel %d: 0x%04x=%dV\n", i*2, val, (val * 4000) / 0x7fff);
298 if ((val < ((volt * 0x7fff) / 40) - ERROR_DELTA) ||
299 (val > ((volt * 0x7fff) / 40) + ERROR_DELTA)) {
300 printf("ERROR! (min=0x%04x max=0x%04x)\n", ((volt * 0x7fff) / 40) - ERROR_DELTA,
301 ((volt * 0x7fff) / 40) + ERROR_DELTA);
302 return -1;
303 }
304 val = in_be16((void *)&(in[i*2+1].val));
305 printf("-> InChannel %d: 0x%04x=%dV\n", i*2+1, val, (val * 4000) / 0x7fff);
306 if ((val < ((volt * 0x7fff) / 40) - ERROR_DELTA) ||
307 (val > ((volt * 0x7fff) / 40) + ERROR_DELTA)) {
308 printf("ERROR! (min=0x%04x max=0x%04x)\n", ((volt * 0x7fff) / 40) - ERROR_DELTA,
309 ((volt * 0x7fff) / 40) + ERROR_DELTA);
310 return -1;
311 }
312
313 volt = 10;
314 printf("Setting Channel %d to %dV...\n", i, volt);
315 out_be16((void *)&(out[i].val), (volt * 0x7fff) / 10);
316 udelay(10000);
317 val = in_be16((void *)&(in[i*2].val));
318 printf("-> InChannel %d: 0x%04x=%dV\n", i*2, val, (val * 4000) / 0x7fff);
319 if ((val < ((volt * 0x7fff) / 40) - ERROR_DELTA) ||
320 (val > ((volt * 0x7fff) / 40) + ERROR_DELTA)) {
321 printf("ERROR! (min=0x%04x max=0x%04x)\n", ((volt * 0x7fff) / 40) - ERROR_DELTA,
322 ((volt * 0x7fff) / 40) + ERROR_DELTA);
323 return -1;
324 }
325 val = in_be16((void *)&(in[i*2+1].val));
326 printf("-> InChannel %d: 0x%04x=%dV\n", i*2+1, val, (val * 4000) / 0x7fff);
327 if ((val < ((volt * 0x7fff) / 40) - ERROR_DELTA) ||
328 (val > ((volt * 0x7fff) / 40) + ERROR_DELTA)) {
329 printf("ERROR! (min=0x%04x max=0x%04x)\n", ((volt * 0x7fff) / 40) - ERROR_DELTA,
330 ((volt * 0x7fff) / 40) + ERROR_DELTA);
331 return -1;
332 }
333
334 printf("Channel %d OK!\n", i);
335
336 return 0;
337}
338U_BOOT_CMD(
339 anatest, 2, 1, do_anatest,
340 "Test analog in-/output",
341 ""
342);
343
344
345int counter = 0;
346
347void cyclicInt(void *ptr)
348{
349 out_be16((void *)0xf03000e8, 0x0800);
350 counter++;
351}
352
353
354int do_inctest(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
355{
356 ulong *incin;
357 int i;
358
359 incin = (ulong *)0xf0300040;
360
361
362
363
364 out_be32((void *)&incin[0], 0);
365 out_be32((void *)&incin[1], 0);
366 out_be32((void *)&incin[2], 0);
367 out_be32((void *)&incin[3], 0);
368
369 incin = (ulong *)0xf0300050;
370
371
372
373
374 for (i=0; i<10000; i++) {
375 switch (i & 0x03) {
376 case 0:
377 out_8(DIGEN, 0x02);
378 break;
379 case 1:
380 out_8(DIGEN, 0x03);
381 break;
382 case 2:
383 out_8(DIGEN, 0x01);
384 break;
385 case 3:
386 out_8(DIGEN, 0x00);
387 break;
388 }
389 udelay(10);
390 }
391
392 printf("Inc 0 = %d\n", in_be32((void *)&incin[0]));
393 printf("Inc 1 = %d\n", in_be32((void *)&incin[1]));
394 printf("Inc 2 = %d\n", in_be32((void *)&incin[2]));
395 printf("Inc 3 = %d\n", in_be32((void *)&incin[3]));
396
397 out_be16((void *)0xf03000e0, 0x0c80-1);
398 out_be16((void *)0xf03000ec,
399 in_be16((void *)0xf03000ec) | 0x0800);
400 irq_install_handler (30, (interrupt_handler_t *) cyclicInt, NULL);
401 printf("counter=%d\n", counter);
402
403 return 0;
404}
405U_BOOT_CMD(
406 inctest, 3, 1, do_inctest,
407 "Test incremental encoder inputs",
408 ""
409);
410#endif
411