common/cmd_mem.c

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