]> git.sur5r.net Git - u-boot/blob - common/cmd_mem.c
[PATCH] I2C: Add support for multiple I2C busses for RTC & DTT
[u-boot] / common / cmd_mem.c
1 /*
2  * (C) Copyright 2000
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 /*
25  * Memory Functions
26  *
27  * Copied from FADS ROM, Dan Malek (dmalek@jlc.net)
28  */
29
30 #include <common.h>
31 #include <command.h>
32 #if (CONFIG_COMMANDS & CFG_CMD_MMC)
33 #include <mmc.h>
34 #endif
35 #ifdef CONFIG_HAS_DATAFLASH
36 #include <dataflash.h>
37 #endif
38
39 #if (CONFIG_COMMANDS & (CFG_CMD_MEMORY  | \
40                         CFG_CMD_I2C     | \
41                         CFG_CMD_ITEST   | \
42                         CFG_CMD_PCI     | \
43                         CMD_CMD_PORTIO  ) )
44 int cmd_get_data_size(char* arg, int default_size)
45 {
46         /* Check for a size specification .b, .w or .l.
47          */
48         int len = strlen(arg);
49         if (len > 2 && arg[len-2] == '.') {
50                 switch(arg[len-1]) {
51                 case 'b':
52                         return 1;
53                 case 'w':
54                         return 2;
55                 case 'l':
56                         return 4;
57                 case 's':
58                         return -2;
59                 default:
60                         return -1;
61                 }
62         }
63         return default_size;
64 }
65 #endif
66
67 #if (CONFIG_COMMANDS & CFG_CMD_MEMORY)
68
69 #ifdef  CMD_MEM_DEBUG
70 #define PRINTF(fmt,args...)     printf (fmt ,##args)
71 #else
72 #define PRINTF(fmt,args...)
73 #endif
74
75 static int mod_mem(cmd_tbl_t *, int, int, int, char *[]);
76
77 /* Display values from last command.
78  * Memory modify remembered values are different from display memory.
79  */
80 uint    dp_last_addr, dp_last_size;
81 uint    dp_last_length = 0x40;
82 uint    mm_last_addr, mm_last_size;
83
84 static  ulong   base_address = 0;
85
86 /* Memory Display
87  *
88  * Syntax:
89  *      md{.b, .w, .l} {addr} {len}
90  */
91 #define DISP_LINE_LEN   16
92 int do_mem_md ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
93 {
94         ulong   addr, length;
95         ulong   i, nbytes, linebytes;
96         u_char  *cp;
97         int     size;
98         int rc = 0;
99
100         /* We use the last specified parameters, unless new ones are
101          * entered.
102          */
103         addr = dp_last_addr;
104         size = dp_last_size;
105         length = dp_last_length;
106
107         if (argc < 2) {
108                 printf ("Usage:\n%s\n", cmdtp->usage);
109                 return 1;
110         }
111
112         if ((flag & CMD_FLAG_REPEAT) == 0) {
113                 /* New command specified.  Check for a size specification.
114                  * Defaults to long if no or incorrect specification.
115                  */
116                 if ((size = cmd_get_data_size(argv[0], 4)) < 0)
117                         return 1;
118
119                 /* Address is specified since argc > 1
120                 */
121                 addr = simple_strtoul(argv[1], NULL, 16);
122                 addr += base_address;
123
124                 /* If another parameter, it is the length to display.
125                  * Length is the number of objects, not number of bytes.
126                  */
127                 if (argc > 2)
128                         length = simple_strtoul(argv[2], NULL, 16);
129         }
130
131         /* Print the lines.
132          *
133          * We buffer all read data, so we can make sure data is read only
134          * once, and all accesses are with the specified bus width.
135          */
136         nbytes = length * size;
137         do {
138                 char    linebuf[DISP_LINE_LEN];
139                 uint    *uip = (uint   *)linebuf;
140                 ushort  *usp = (ushort *)linebuf;
141                 u_char  *ucp = (u_char *)linebuf;
142 #ifdef CONFIG_HAS_DATAFLASH
143                 int rc;
144 #endif
145                 printf("%08lx:", addr);
146                 linebytes = (nbytes>DISP_LINE_LEN)?DISP_LINE_LEN:nbytes;
147
148 #ifdef CONFIG_HAS_DATAFLASH
149                 if ((rc = read_dataflash(addr, (linebytes/size)*size, linebuf)) == DATAFLASH_OK){
150                         /* if outside dataflash */
151                         /*if (rc != 1) {
152                                 dataflash_perror (rc);
153                                 return (1);
154                         }*/
155                         for (i=0; i<linebytes; i+= size) {
156                                 if (size == 4) {
157                                         printf(" %08x", *uip++);
158                                 } else if (size == 2) {
159                                         printf(" %04x", *usp++);
160                                 } else {
161                                         printf(" %02x", *ucp++);
162                                 }
163                                 addr += size;
164                         }
165
166                 } else {        /* addr does not correspond to DataFlash */
167 #endif
168                 for (i=0; i<linebytes; i+= size) {
169                         if (size == 4) {
170                                 printf(" %08x", (*uip++ = *((uint *)addr)));
171                         } else if (size == 2) {
172                                 printf(" %04x", (*usp++ = *((ushort *)addr)));
173                         } else {
174                                 printf(" %02x", (*ucp++ = *((u_char *)addr)));
175                         }
176                         addr += size;
177                 }
178 #ifdef CONFIG_HAS_DATAFLASH
179                 }
180 #endif
181                 puts ("    ");
182                 cp = (u_char *)linebuf;
183                 for (i=0; i<linebytes; i++) {
184                         if ((*cp < 0x20) || (*cp > 0x7e))
185                                 putc ('.');
186                         else
187                                 printf("%c", *cp);
188                         cp++;
189                 }
190                 putc ('\n');
191                 nbytes -= linebytes;
192                 if (ctrlc()) {
193                         rc = 1;
194                         break;
195                 }
196         } while (nbytes > 0);
197
198         dp_last_addr = addr;
199         dp_last_length = length;
200         dp_last_size = size;
201         return (rc);
202 }
203
204 int do_mem_mm ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
205 {
206         return mod_mem (cmdtp, 1, flag, argc, argv);
207 }
208 int do_mem_nm ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
209 {
210         return mod_mem (cmdtp, 0, flag, argc, argv);
211 }
212
213 int do_mem_mw ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
214 {
215         ulong   addr, writeval, count;
216         int     size;
217
218         if ((argc < 3) || (argc > 4)) {
219                 printf ("Usage:\n%s\n", cmdtp->usage);
220                 return 1;
221         }
222
223         /* Check for size specification.
224         */
225         if ((size = cmd_get_data_size(argv[0], 4)) < 1)
226                 return 1;
227
228         /* Address is specified since argc > 1
229         */
230         addr = simple_strtoul(argv[1], NULL, 16);
231         addr += base_address;
232
233         /* Get the value to write.
234         */
235         writeval = simple_strtoul(argv[2], NULL, 16);
236
237         /* Count ? */
238         if (argc == 4) {
239                 count = simple_strtoul(argv[3], NULL, 16);
240         } else {
241                 count = 1;
242         }
243
244         while (count-- > 0) {
245                 if (size == 4)
246                         *((ulong  *)addr) = (ulong )writeval;
247                 else if (size == 2)
248                         *((ushort *)addr) = (ushort)writeval;
249                 else
250                         *((u_char *)addr) = (u_char)writeval;
251                 addr += size;
252         }
253         return 0;
254 }
255
256 #ifdef CONFIG_MX_CYCLIC
257 int do_mem_mdc ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
258 {
259         int i;
260         ulong count;
261
262         if (argc < 4) {
263                 printf ("Usage:\n%s\n", cmdtp->usage);
264                 return 1;
265         }
266
267         count = simple_strtoul(argv[3], NULL, 10);
268
269         for (;;) {
270                 do_mem_md (NULL, 0, 3, argv);
271
272                 /* delay for <count> ms... */
273                 for (i=0; i<count; i++)
274                         udelay (1000);
275
276                 /* check for ctrl-c to abort... */
277                 if (ctrlc()) {
278                         puts("Abort\n");
279                         return 0;
280                 }
281         }
282
283         return 0;
284 }
285
286 int do_mem_mwc ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
287 {
288         int i;
289         ulong count;
290
291         if (argc < 4) {
292                 printf ("Usage:\n%s\n", cmdtp->usage);
293                 return 1;
294         }
295
296         count = simple_strtoul(argv[3], NULL, 10);
297
298         for (;;) {
299                 do_mem_mw (NULL, 0, 3, argv);
300
301                 /* delay for <count> ms... */
302                 for (i=0; i<count; i++)
303                         udelay (1000);
304
305                 /* check for ctrl-c to abort... */
306                 if (ctrlc()) {
307                         puts("Abort\n");
308                         return 0;
309                 }
310         }
311
312         return 0;
313 }
314 #endif /* CONFIG_MX_CYCLIC */
315
316 int do_mem_cmp (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
317 {
318         ulong   addr1, addr2, count, ngood;
319         int     size;
320         int     rcode = 0;
321
322         if (argc != 4) {
323                 printf ("Usage:\n%s\n", cmdtp->usage);
324                 return 1;
325         }
326
327         /* Check for size specification.
328         */
329         if ((size = cmd_get_data_size(argv[0], 4)) < 0)
330                 return 1;
331
332         addr1 = simple_strtoul(argv[1], NULL, 16);
333         addr1 += base_address;
334
335         addr2 = simple_strtoul(argv[2], NULL, 16);
336         addr2 += base_address;
337
338         count = simple_strtoul(argv[3], NULL, 16);
339
340 #ifdef CONFIG_HAS_DATAFLASH
341         if (addr_dataflash(addr1) | addr_dataflash(addr2)){
342                 puts ("Comparison with DataFlash space not supported.\n\r");
343                 return 0;
344         }
345 #endif
346
347         ngood = 0;
348
349         while (count-- > 0) {
350                 if (size == 4) {
351                         ulong word1 = *(ulong *)addr1;
352                         ulong word2 = *(ulong *)addr2;
353                         if (word1 != word2) {
354                                 printf("word at 0x%08lx (0x%08lx) "
355                                         "!= word at 0x%08lx (0x%08lx)\n",
356                                         addr1, word1, addr2, word2);
357                                 rcode = 1;
358                                 break;
359                         }
360                 }
361                 else if (size == 2) {
362                         ushort hword1 = *(ushort *)addr1;
363                         ushort hword2 = *(ushort *)addr2;
364                         if (hword1 != hword2) {
365                                 printf("halfword at 0x%08lx (0x%04x) "
366                                         "!= halfword at 0x%08lx (0x%04x)\n",
367                                         addr1, hword1, addr2, hword2);
368                                 rcode = 1;
369                                 break;
370                         }
371                 }
372                 else {
373                         u_char byte1 = *(u_char *)addr1;
374                         u_char byte2 = *(u_char *)addr2;
375                         if (byte1 != byte2) {
376                                 printf("byte at 0x%08lx (0x%02x) "
377                                         "!= byte at 0x%08lx (0x%02x)\n",
378                                         addr1, byte1, addr2, byte2);
379                                 rcode = 1;
380                                 break;
381                         }
382                 }
383                 ngood++;
384                 addr1 += size;
385                 addr2 += size;
386         }
387
388         printf("Total of %ld %s%s were the same\n",
389                 ngood, size == 4 ? "word" : size == 2 ? "halfword" : "byte",
390                 ngood == 1 ? "" : "s");
391         return rcode;
392 }
393
394 int do_mem_cp ( cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
395 {
396         ulong   addr, dest, count;
397         int     size;
398
399         if (argc != 4) {
400                 printf ("Usage:\n%s\n", cmdtp->usage);
401                 return 1;
402         }
403
404         /* Check for size specification.
405         */
406         if ((size = cmd_get_data_size(argv[0], 4)) < 0)
407                 return 1;
408
409         addr = simple_strtoul(argv[1], NULL, 16);
410         addr += base_address;
411
412         dest = simple_strtoul(argv[2], NULL, 16);
413         dest += base_address;
414
415         count = simple_strtoul(argv[3], NULL, 16);
416
417         if (count == 0) {
418                 puts ("Zero length ???\n");
419                 return 1;
420         }
421
422 #ifndef CFG_NO_FLASH
423         /* check if we are copying to Flash */
424         if ( (addr2info(dest) != NULL)
425 #ifdef CONFIG_HAS_DATAFLASH
426            && (!addr_dataflash(addr))
427 #endif
428            ) {
429                 int rc;
430
431                 puts ("Copy to Flash... ");
432
433                 rc = flash_write ((char *)addr, dest, count*size);
434                 if (rc != 0) {
435                         flash_perror (rc);
436                         return (1);
437                 }
438                 puts ("done\n");
439                 return 0;
440         }
441 #endif
442
443 #if (CONFIG_COMMANDS & CFG_CMD_MMC)
444         if (mmc2info(dest)) {
445                 int rc;
446
447                 puts ("Copy to MMC... ");
448                 switch (rc = mmc_write ((uchar *)addr, dest, count*size)) {
449                 case 0:
450                         putc ('\n');
451                         return 1;
452                 case -1:
453                         puts ("failed\n");
454                         return 1;
455                 default:
456                         printf ("%s[%d] FIXME: rc=%d\n",__FILE__,__LINE__,rc);
457                         return 1;
458                 }
459                 puts ("done\n");
460                 return 0;
461         }
462
463         if (mmc2info(addr)) {
464                 int rc;
465
466                 puts ("Copy from MMC... ");
467                 switch (rc = mmc_read (addr, (uchar *)dest, count*size)) {
468                 case 0:
469                         putc ('\n');
470                         return 1;
471                 case -1:
472                         puts ("failed\n");
473                         return 1;
474                 default:
475                         printf ("%s[%d] FIXME: rc=%d\n",__FILE__,__LINE__,rc);
476                         return 1;
477                 }
478                 puts ("done\n");
479                 return 0;
480         }
481 #endif
482
483 #ifdef CONFIG_HAS_DATAFLASH
484         /* Check if we are copying from RAM or Flash to DataFlash */
485         if (addr_dataflash(dest) && !addr_dataflash(addr)){
486                 int rc;
487
488                 puts ("Copy to DataFlash... ");
489
490                 rc = write_dataflash (dest, addr, count*size);
491
492                 if (rc != 1) {
493                         dataflash_perror (rc);
494                         return (1);
495                 }
496                 puts ("done\n");
497                 return 0;
498         }
499
500         /* Check if we are copying from DataFlash to RAM */
501         if (addr_dataflash(addr) && !addr_dataflash(dest) && (addr2info(dest)==NULL) ){
502                 int rc;
503                 rc = read_dataflash(addr, count * size, (char *) dest);
504                 if (rc != 1) {
505                         dataflash_perror (rc);
506                         return (1);
507                 }
508                 return 0;
509         }
510
511         if (addr_dataflash(addr) && addr_dataflash(dest)){
512                 puts ("Unsupported combination of source/destination.\n\r");
513                 return 1;
514         }
515 #endif
516
517         while (count-- > 0) {
518                 if (size == 4)
519                         *((ulong  *)dest) = *((ulong  *)addr);
520                 else if (size == 2)
521                         *((ushort *)dest) = *((ushort *)addr);
522                 else
523                         *((u_char *)dest) = *((u_char *)addr);
524                 addr += size;
525                 dest += size;
526         }
527         return 0;
528 }
529
530 int do_mem_base (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
531 {
532         if (argc > 1) {
533                 /* Set new base address.
534                 */
535                 base_address = simple_strtoul(argv[1], NULL, 16);
536         }
537         /* Print the current base address.
538         */
539         printf("Base Address: 0x%08lx\n", base_address);
540         return 0;
541 }
542
543 int do_mem_loop (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
544 {
545         ulong   addr, length, i, junk;
546         int     size;
547         volatile uint   *longp;
548         volatile ushort *shortp;
549         volatile u_char *cp;
550
551         if (argc < 3) {
552                 printf ("Usage:\n%s\n", cmdtp->usage);
553                 return 1;
554         }
555
556         /* Check for a size spefication.
557          * Defaults to long if no or incorrect specification.
558          */
559         if ((size = cmd_get_data_size(argv[0], 4)) < 0)
560                 return 1;
561
562         /* Address is always specified.
563         */
564         addr = simple_strtoul(argv[1], NULL, 16);
565
566         /* Length is the number of objects, not number of bytes.
567         */
568         length = simple_strtoul(argv[2], NULL, 16);
569
570         /* We want to optimize the loops to run as fast as possible.
571          * If we have only one object, just run infinite loops.
572          */
573         if (length == 1) {
574                 if (size == 4) {
575                         longp = (uint *)addr;
576                         for (;;)
577                                 i = *longp;
578                 }
579                 if (size == 2) {
580                         shortp = (ushort *)addr;
581                         for (;;)
582                                 i = *shortp;
583                 }
584                 cp = (u_char *)addr;
585                 for (;;)
586                         i = *cp;
587         }
588
589         if (size == 4) {
590                 for (;;) {
591                         longp = (uint *)addr;
592                         i = length;
593                         while (i-- > 0)
594                                 junk = *longp++;
595                 }
596         }
597         if (size == 2) {
598                 for (;;) {
599                         shortp = (ushort *)addr;
600                         i = length;
601                         while (i-- > 0)
602                                 junk = *shortp++;
603                 }
604         }
605         for (;;) {
606                 cp = (u_char *)addr;
607                 i = length;
608                 while (i-- > 0)
609                         junk = *cp++;
610         }
611 }
612
613 #ifdef CONFIG_LOOPW
614 int do_mem_loopw (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
615 {
616         ulong   addr, length, i, data;
617         int     size;
618         volatile uint   *longp;
619         volatile ushort *shortp;
620         volatile u_char *cp;
621
622         if (argc < 4) {
623                 printf ("Usage:\n%s\n", cmdtp->usage);
624                 return 1;
625         }
626
627         /* Check for a size spefication.
628          * Defaults to long if no or incorrect specification.
629          */
630         if ((size = cmd_get_data_size(argv[0], 4)) < 0)
631                 return 1;
632
633         /* Address is always specified.
634         */
635         addr = simple_strtoul(argv[1], NULL, 16);
636
637         /* Length is the number of objects, not number of bytes.
638         */
639         length = simple_strtoul(argv[2], NULL, 16);
640
641         /* data to write */
642         data = simple_strtoul(argv[3], NULL, 16);
643
644         /* We want to optimize the loops to run as fast as possible.
645          * If we have only one object, just run infinite loops.
646          */
647         if (length == 1) {
648                 if (size == 4) {
649                         longp = (uint *)addr;
650                         for (;;)
651                                 *longp = data;
652                                         }
653                 if (size == 2) {
654                         shortp = (ushort *)addr;
655                         for (;;)
656                                 *shortp = data;
657                 }
658                 cp = (u_char *)addr;
659                 for (;;)
660                         *cp = data;
661         }
662
663         if (size == 4) {
664                 for (;;) {
665                         longp = (uint *)addr;
666                         i = length;
667                         while (i-- > 0)
668                                 *longp++ = data;
669                 }
670         }
671         if (size == 2) {
672                 for (;;) {
673                         shortp = (ushort *)addr;
674                         i = length;
675                         while (i-- > 0)
676                                 *shortp++ = data;
677                 }
678         }
679         for (;;) {
680                 cp = (u_char *)addr;
681                 i = length;
682                 while (i-- > 0)
683                         *cp++ = data;
684         }
685 }
686 #endif /* CONFIG_LOOPW */
687
688 /*
689  * Perform a memory test. A more complete alternative test can be
690  * configured using CFG_ALT_MEMTEST. The complete test loops until
691  * interrupted by ctrl-c or by a failure of one of the sub-tests.
692  */
693 int do_mem_mtest (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
694 {
695         vu_long *addr, *start, *end;
696         ulong   val;
697         ulong   readback;
698
699 #if defined(CFG_ALT_MEMTEST)
700         vu_long addr_mask;
701         vu_long offset;
702         vu_long test_offset;
703         vu_long pattern;
704         vu_long temp;
705         vu_long anti_pattern;
706         vu_long num_words;
707 #if defined(CFG_MEMTEST_SCRATCH)
708         vu_long *dummy = (vu_long*)CFG_MEMTEST_SCRATCH;
709 #else
710         vu_long *dummy = 0;     /* yes, this is address 0x0, not NULL */
711 #endif
712         int     j;
713         int iterations = 1;
714
715         static const ulong bitpattern[] = {
716                 0x00000001,     /* single bit */
717                 0x00000003,     /* two adjacent bits */
718                 0x00000007,     /* three adjacent bits */
719                 0x0000000F,     /* four adjacent bits */
720                 0x00000005,     /* two non-adjacent bits */
721                 0x00000015,     /* three non-adjacent bits */
722                 0x00000055,     /* four non-adjacent bits */
723                 0xaaaaaaaa,     /* alternating 1/0 */
724         };
725 #else
726         ulong   incr;
727         ulong   pattern;
728         int     rcode = 0;
729 #endif
730
731         if (argc > 1) {
732                 start = (ulong *)simple_strtoul(argv[1], NULL, 16);
733         } else {
734                 start = (ulong *)CFG_MEMTEST_START;
735         }
736
737         if (argc > 2) {
738                 end = (ulong *)simple_strtoul(argv[2], NULL, 16);
739         } else {
740                 end = (ulong *)(CFG_MEMTEST_END);
741         }
742
743         if (argc > 3) {
744                 pattern = (ulong)simple_strtoul(argv[3], NULL, 16);
745         } else {
746                 pattern = 0;
747         }
748
749 #if defined(CFG_ALT_MEMTEST)
750         printf ("Testing %08x ... %08x:\n", (uint)start, (uint)end);
751         PRINTF("%s:%d: start 0x%p end 0x%p\n",
752                 __FUNCTION__, __LINE__, start, end);
753
754         for (;;) {
755                 if (ctrlc()) {
756                         putc ('\n');
757                         return 1;
758                 }
759
760                 printf("Iteration: %6d\r", iterations);
761                 PRINTF("Iteration: %6d\n", iterations);
762                 iterations++;
763
764                 /*
765                  * Data line test: write a pattern to the first
766                  * location, write the 1's complement to a 'parking'
767                  * address (changes the state of the data bus so a
768                  * floating bus doen't give a false OK), and then
769                  * read the value back. Note that we read it back
770                  * into a variable because the next time we read it,
771                  * it might be right (been there, tough to explain to
772                  * the quality guys why it prints a failure when the
773                  * "is" and "should be" are obviously the same in the
774                  * error message).
775                  *
776                  * Rather than exhaustively testing, we test some
777                  * patterns by shifting '1' bits through a field of
778                  * '0's and '0' bits through a field of '1's (i.e.
779                  * pattern and ~pattern).
780                  */
781                 addr = start;
782                 for (j = 0; j < sizeof(bitpattern)/sizeof(bitpattern[0]); j++) {
783                     val = bitpattern[j];
784                     for(; val != 0; val <<= 1) {
785                         *addr  = val;
786                         *dummy  = ~val; /* clear the test data off of the bus */
787                         readback = *addr;
788                         if(readback != val) {
789                              printf ("FAILURE (data line): "
790                                 "expected %08lx, actual %08lx\n",
791                                           val, readback);
792                         }
793                         *addr  = ~val;
794                         *dummy  = val;
795                         readback = *addr;
796                         if(readback != ~val) {
797                             printf ("FAILURE (data line): "
798                                 "Is %08lx, should be %08lx\n",
799                                         readback, ~val);
800                         }
801                     }
802                 }
803
804                 /*
805                  * Based on code whose Original Author and Copyright
806                  * information follows: Copyright (c) 1998 by Michael
807                  * Barr. This software is placed into the public
808                  * domain and may be used for any purpose. However,
809                  * this notice must not be changed or removed and no
810                  * warranty is either expressed or implied by its
811                  * publication or distribution.
812                  */
813
814                 /*
815                  * Address line test
816                  *
817                  * Description: Test the address bus wiring in a
818                  *              memory region by performing a walking
819                  *              1's test on the relevant bits of the
820                  *              address and checking for aliasing.
821                  *              This test will find single-bit
822                  *              address failures such as stuck -high,
823                  *              stuck-low, and shorted pins. The base
824                  *              address and size of the region are
825                  *              selected by the caller.
826                  *
827                  * Notes:       For best results, the selected base
828                  *              address should have enough LSB 0's to
829                  *              guarantee single address bit changes.
830                  *              For example, to test a 64-Kbyte
831                  *              region, select a base address on a
832                  *              64-Kbyte boundary. Also, select the
833                  *              region size as a power-of-two if at
834                  *              all possible.
835                  *
836                  * Returns:     0 if the test succeeds, 1 if the test fails.
837                  *
838                  * ## NOTE ##   Be sure to specify start and end
839                  *              addresses such that addr_mask has
840                  *              lots of bits set. For example an
841                  *              address range of 01000000 02000000 is
842                  *              bad while a range of 01000000
843                  *              01ffffff is perfect.
844                  */
845                 addr_mask = ((ulong)end - (ulong)start)/sizeof(vu_long);
846                 pattern = (vu_long) 0xaaaaaaaa;
847                 anti_pattern = (vu_long) 0x55555555;
848
849                 PRINTF("%s:%d: addr mask = 0x%.8lx\n",
850                         __FUNCTION__, __LINE__,
851                         addr_mask);
852                 /*
853                  * Write the default pattern at each of the
854                  * power-of-two offsets.
855                  */
856                 for (offset = 1; (offset & addr_mask) != 0; offset <<= 1) {
857                         start[offset] = pattern;
858                 }
859
860                 /*
861                  * Check for address bits stuck high.
862                  */
863                 test_offset = 0;
864                 start[test_offset] = anti_pattern;
865
866                 for (offset = 1; (offset & addr_mask) != 0; offset <<= 1) {
867                     temp = start[offset];
868                     if (temp != pattern) {
869                         printf ("\nFAILURE: Address bit stuck high @ 0x%.8lx:"
870                                 " expected 0x%.8lx, actual 0x%.8lx\n",
871                                 (ulong)&start[offset], pattern, temp);
872                         return 1;
873                     }
874                 }
875                 start[test_offset] = pattern;
876
877                 /*
878                  * Check for addr bits stuck low or shorted.
879                  */
880                 for (test_offset = 1; (test_offset & addr_mask) != 0; test_offset <<= 1) {
881                     start[test_offset] = anti_pattern;
882
883                     for (offset = 1; (offset & addr_mask) != 0; offset <<= 1) {
884                         temp = start[offset];
885                         if ((temp != pattern) && (offset != test_offset)) {
886                             printf ("\nFAILURE: Address bit stuck low or shorted @"
887                                 " 0x%.8lx: expected 0x%.8lx, actual 0x%.8lx\n",
888                                 (ulong)&start[offset], pattern, temp);
889                             return 1;
890                         }
891                     }
892                     start[test_offset] = pattern;
893                 }
894
895                 /*
896                  * Description: Test the integrity of a physical
897                  *              memory device by performing an
898                  *              increment/decrement test over the
899                  *              entire region. In the process every
900                  *              storage bit in the device is tested
901                  *              as a zero and a one. The base address
902                  *              and the size of the region are
903                  *              selected by the caller.
904                  *
905                  * Returns:     0 if the test succeeds, 1 if the test fails.
906                  */
907                 num_words = ((ulong)end - (ulong)start)/sizeof(vu_long) + 1;
908
909                 /*
910                  * Fill memory with a known pattern.
911                  */
912                 for (pattern = 1, offset = 0; offset < num_words; pattern++, offset++) {
913                         start[offset] = pattern;
914                 }
915
916                 /*
917                  * Check each location and invert it for the second pass.
918                  */
919                 for (pattern = 1, offset = 0; offset < num_words; pattern++, offset++) {
920                     temp = start[offset];
921                     if (temp != pattern) {
922                         printf ("\nFAILURE (read/write) @ 0x%.8lx:"
923                                 " expected 0x%.8lx, actual 0x%.8lx)\n",
924                                 (ulong)&start[offset], pattern, temp);
925                         return 1;
926                     }
927
928                     anti_pattern = ~pattern;
929                     start[offset] = anti_pattern;
930                 }
931
932                 /*
933                  * Check each location for the inverted pattern and zero it.
934                  */
935                 for (pattern = 1, offset = 0; offset < num_words; pattern++, offset++) {
936                     anti_pattern = ~pattern;
937                     temp = start[offset];
938                     if (temp != anti_pattern) {
939                         printf ("\nFAILURE (read/write): @ 0x%.8lx:"
940                                 " expected 0x%.8lx, actual 0x%.8lx)\n",
941                                 (ulong)&start[offset], anti_pattern, temp);
942                         return 1;
943                     }
944                     start[offset] = 0;
945                 }
946         }
947
948 #else /* The original, quickie test */
949         incr = 1;
950         for (;;) {
951                 if (ctrlc()) {
952                         putc ('\n');
953                         return 1;
954                 }
955
956                 printf ("\rPattern %08lX  Writing..."
957                         "%12s"
958                         "\b\b\b\b\b\b\b\b\b\b",
959                         pattern, "");
960
961                 for (addr=start,val=pattern; addr<end; addr++) {
962                         *addr = val;
963                         val  += incr;
964                 }
965
966                 puts ("Reading...");
967
968                 for (addr=start,val=pattern; addr<end; addr++) {
969                         readback = *addr;
970                         if (readback != val) {
971                                 printf ("\nMem error @ 0x%08X: "
972                                         "found %08lX, expected %08lX\n",
973                                         (uint)addr, readback, val);
974                                 rcode = 1;
975                         }
976                         val += incr;
977                 }
978
979                 /*
980                  * Flip the pattern each time to make lots of zeros and
981                  * then, the next time, lots of ones.  We decrement
982                  * the "negative" patterns and increment the "positive"
983                  * patterns to preserve this feature.
984                  */
985                 if(pattern & 0x80000000) {
986                         pattern = -pattern;     /* complement & increment */
987                 }
988                 else {
989                         pattern = ~pattern;
990                 }
991                 incr = -incr;
992         }
993         return rcode;
994 #endif
995 }
996
997
998 /* Modify memory.
999  *
1000  * Syntax:
1001  *      mm{.b, .w, .l} {addr}
1002  *      nm{.b, .w, .l} {addr}
1003  */
1004 static int
1005 mod_mem(cmd_tbl_t *cmdtp, int incrflag, int flag, int argc, char *argv[])
1006 {
1007         ulong   addr, i;
1008         int     nbytes, size;
1009         extern char console_buffer[];
1010
1011         if (argc != 2) {
1012                 printf ("Usage:\n%s\n", cmdtp->usage);
1013                 return 1;
1014         }
1015
1016 #ifdef CONFIG_BOOT_RETRY_TIME
1017         reset_cmd_timeout();    /* got a good command to get here */
1018 #endif
1019         /* We use the last specified parameters, unless new ones are
1020          * entered.
1021          */
1022         addr = mm_last_addr;
1023         size = mm_last_size;
1024
1025         if ((flag & CMD_FLAG_REPEAT) == 0) {
1026                 /* New command specified.  Check for a size specification.
1027                  * Defaults to long if no or incorrect specification.
1028                  */
1029                 if ((size = cmd_get_data_size(argv[0], 4)) < 0)
1030                         return 1;
1031
1032                 /* Address is specified since argc > 1
1033                 */
1034                 addr = simple_strtoul(argv[1], NULL, 16);
1035                 addr += base_address;
1036         }
1037
1038 #ifdef CONFIG_HAS_DATAFLASH
1039         if (addr_dataflash(addr)){
1040                 puts ("Can't modify DataFlash in place. Use cp instead.\n\r");
1041                 return 0;
1042         }
1043 #endif
1044
1045         /* Print the address, followed by value.  Then accept input for
1046          * the next value.  A non-converted value exits.
1047          */
1048         do {
1049                 printf("%08lx:", addr);
1050                 if (size == 4)
1051                         printf(" %08x", *((uint   *)addr));
1052                 else if (size == 2)
1053                         printf(" %04x", *((ushort *)addr));
1054                 else
1055                         printf(" %02x", *((u_char *)addr));
1056
1057                 nbytes = readline (" ? ");
1058                 if (nbytes == 0 || (nbytes == 1 && console_buffer[0] == '-')) {
1059                         /* <CR> pressed as only input, don't modify current
1060                          * location and move to next. "-" pressed will go back.
1061                          */
1062                         if (incrflag)
1063                                 addr += nbytes ? -size : size;
1064                         nbytes = 1;
1065 #ifdef CONFIG_BOOT_RETRY_TIME
1066                         reset_cmd_timeout(); /* good enough to not time out */
1067 #endif
1068                 }
1069 #ifdef CONFIG_BOOT_RETRY_TIME
1070                 else if (nbytes == -2) {
1071                         break;  /* timed out, exit the command  */
1072                 }
1073 #endif
1074                 else {
1075                         char *endp;
1076                         i = simple_strtoul(console_buffer, &endp, 16);
1077                         nbytes = endp - console_buffer;
1078                         if (nbytes) {
1079 #ifdef CONFIG_BOOT_RETRY_TIME
1080                                 /* good enough to not time out
1081                                  */
1082                                 reset_cmd_timeout();
1083 #endif
1084                                 if (size == 4)
1085                                         *((uint   *)addr) = i;
1086                                 else if (size == 2)
1087                                         *((ushort *)addr) = i;
1088                                 else
1089                                         *((u_char *)addr) = i;
1090                                 if (incrflag)
1091                                         addr += size;
1092                         }
1093                 }
1094         } while (nbytes);
1095
1096         mm_last_addr = addr;
1097         mm_last_size = size;
1098         return 0;
1099 }
1100
1101 #ifndef CONFIG_CRC32_VERIFY
1102
1103 int do_mem_crc (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1104 {
1105         ulong addr, length;
1106         ulong crc;
1107         ulong *ptr;
1108
1109         if (argc < 3) {
1110                 printf ("Usage:\n%s\n", cmdtp->usage);
1111                 return 1;
1112         }
1113
1114         addr = simple_strtoul (argv[1], NULL, 16);
1115         addr += base_address;
1116
1117         length = simple_strtoul (argv[2], NULL, 16);
1118
1119         crc = crc32 (0, (const uchar *) addr, length);
1120
1121         printf ("CRC32 for %08lx ... %08lx ==> %08lx\n",
1122                         addr, addr + length - 1, crc);
1123
1124         if (argc > 3) {
1125                 ptr = (ulong *) simple_strtoul (argv[3], NULL, 16);
1126                 *ptr = crc;
1127         }
1128
1129         return 0;
1130 }
1131
1132 #else   /* CONFIG_CRC32_VERIFY */
1133
1134 int do_mem_crc (cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
1135 {
1136         ulong addr, length;
1137         ulong crc;
1138         ulong *ptr;
1139         ulong vcrc;
1140         int verify;
1141         int ac;
1142         char **av;
1143
1144         if (argc < 3) {
1145   usage:
1146                 printf ("Usage:\n%s\n", cmdtp->usage);
1147                 return 1;
1148         }
1149
1150         av = argv + 1;
1151         ac = argc - 1;
1152         if (strcmp(*av, "-v") == 0) {
1153                 verify = 1;
1154                 av++;
1155                 ac--;
1156                 if (ac < 3)
1157                         goto usage;
1158         } else
1159                 verify = 0;
1160
1161         addr = simple_strtoul(*av++, NULL, 16);
1162         addr += base_address;
1163         length = simple_strtoul(*av++, NULL, 16);
1164
1165         crc = crc32(0, (const uchar *) addr, length);
1166
1167         if (!verify) {
1168                 printf ("CRC32 for %08lx ... %08lx ==> %08lx\n",
1169                                 addr, addr + length - 1, crc);
1170                 if (ac > 2) {
1171                         ptr = (ulong *) simple_strtoul (*av++, NULL, 16);
1172                         *ptr = crc;
1173                 }
1174         } else {
1175                 vcrc = simple_strtoul(*av++, NULL, 16);
1176                 if (vcrc != crc) {
1177                         printf ("CRC32 for %08lx ... %08lx ==> %08lx != %08lx ** ERROR **\n",
1178                                         addr, addr + length - 1, crc, vcrc);
1179                         return 1;
1180                 }
1181         }
1182
1183         return 0;
1184
1185 }
1186 #endif  /* CONFIG_CRC32_VERIFY */
1187
1188 /**************************************************/
1189 #if (CONFIG_COMMANDS & CFG_CMD_MEMORY)
1190 U_BOOT_CMD(
1191         md,     3,     1,      do_mem_md,
1192         "md      - memory display\n",
1193         "[.b, .w, .l] address [# of objects]\n    - memory display\n"
1194 );
1195
1196
1197 U_BOOT_CMD(
1198         mm,     2,      1,       do_mem_mm,
1199         "mm      - memory modify (auto-incrementing)\n",
1200         "[.b, .w, .l] address\n" "    - memory modify, auto increment address\n"
1201 );
1202
1203
1204 U_BOOT_CMD(
1205         nm,     2,          1,          do_mem_nm,
1206         "nm      - memory modify (constant address)\n",
1207         "[.b, .w, .l] address\n    - memory modify, read and keep address\n"
1208 );
1209
1210 U_BOOT_CMD(
1211         mw,    4,    1,     do_mem_mw,
1212         "mw      - memory write (fill)\n",
1213         "[.b, .w, .l] address value [count]\n    - write memory\n"
1214 );
1215
1216 U_BOOT_CMD(
1217         cp,    4,    1,    do_mem_cp,
1218         "cp      - memory copy\n",
1219         "[.b, .w, .l] source target count\n    - copy memory\n"
1220 );
1221
1222 U_BOOT_CMD(
1223         cmp,    4,     1,     do_mem_cmp,
1224         "cmp     - memory compare\n",
1225         "[.b, .w, .l] addr1 addr2 count\n    - compare memory\n"
1226 );
1227
1228 #ifndef CONFIG_CRC32_VERIFY
1229
1230 U_BOOT_CMD(
1231         crc32,    4,    1,     do_mem_crc,
1232         "crc32   - checksum calculation\n",
1233         "address count [addr]\n    - compute CRC32 checksum [save at addr]\n"
1234 );
1235
1236 #else   /* CONFIG_CRC32_VERIFY */
1237
1238 U_BOOT_CMD(
1239         crc32,    5,    1,     do_mem_crc,
1240         "crc32   - checksum calculation\n",
1241         "address count [addr]\n    - compute CRC32 checksum [save at addr]\n"
1242         "-v address count crc\n    - verify crc of memory area\n"
1243 );
1244
1245 #endif  /* CONFIG_CRC32_VERIFY */
1246
1247 U_BOOT_CMD(
1248         base,    2,    1,     do_mem_base,
1249         "base    - print or set address offset\n",
1250         "\n    - print address offset for memory commands\n"
1251         "base off\n    - set address offset for memory commands to 'off'\n"
1252 );
1253
1254 U_BOOT_CMD(
1255         loop,    3,    1,    do_mem_loop,
1256         "loop    - infinite loop on address range\n",
1257         "[.b, .w, .l] address number_of_objects\n"
1258         "    - loop on a set of addresses\n"
1259 );
1260
1261 #ifdef CONFIG_LOOPW
1262 U_BOOT_CMD(
1263         loopw,    4,    1,    do_mem_loopw,
1264         "loopw   - infinite write loop on address range\n",
1265         "[.b, .w, .l] address number_of_objects data_to_write\n"
1266         "    - loop on a set of addresses\n"
1267 );
1268 #endif /* CONFIG_LOOPW */
1269
1270 U_BOOT_CMD(
1271         mtest,    4,    1,     do_mem_mtest,
1272         "mtest   - simple RAM test\n",
1273         "[start [end [pattern]]]\n"
1274         "    - simple RAM read/write test\n"
1275 );
1276
1277 #ifdef CONFIG_MX_CYCLIC
1278 U_BOOT_CMD(
1279         mdc,     4,     1,      do_mem_mdc,
1280         "mdc     - memory display cyclic\n",
1281         "[.b, .w, .l] address count delay(ms)\n    - memory display cyclic\n"
1282 );
1283
1284 U_BOOT_CMD(
1285         mwc,     4,     1,      do_mem_mwc,
1286         "mwc     - memory write cyclic\n",
1287         "[.b, .w, .l] address value delay(ms)\n    - memory write cyclic\n"
1288 );
1289 #endif /* CONFIG_MX_CYCLIC */
1290
1291 #endif
1292 #endif  /* CFG_CMD_MEMORY */