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