common/cmd_mem.c

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