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