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