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