common/cmd_i2c.c

   1 /*
   2  * (C) Copyright 2001
   3  * Gerald Van Baren, Custom IDEAS, vanbaren@cideas.com.
   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  * I2C Functions similar to the standard memory functions.
  26  *
  27  * There are several parameters in many of the commands that bear further
  28  * explanations:
  29  *
  30  * {i2c_chip} is the I2C chip address (the first byte sent on the bus).
  31  *   Each I2C chip on the bus has a unique address.  On the I2C data bus,
  32  *   the address is the upper seven bits and the LSB is the "read/write"
  33  *   bit.  Note that the {i2c_chip} address specified on the command
  34  *   line is not shifted up: e.g. a typical EEPROM memory chip may have
  35  *   an I2C address of 0x50, but the data put on the bus will be 0xA0
  36  *   for write and 0xA1 for read.  This "non shifted" address notation
  37  *   matches at least half of the data sheets :-/.
  38  *
  39  * {addr} is the address (or offset) within the chip.  Small memory
  40  *   chips have 8 bit addresses.  Large memory chips have 16 bit
  41  *   addresses.  Other memory chips have 9, 10, or 11 bit addresses.
  42  *   Many non-memory chips have multiple registers and {addr} is used
  43  *   as the register index.  Some non-memory chips have only one register
  44  *   and therefore don't need any {addr} parameter.
  45  *
  46  *   The default {addr} parameter is one byte (.1) which works well for
  47  *   memories and registers with 8 bits of address space.
  48  *
  49  *   You can specify the length of the {addr} field with the optional .0,
  50  *   .1, or .2 modifier (similar to the .b, .w, .l modifier).  If you are
  51  *   manipulating a single register device which doesn't use an address
  52  *   field, use "0.0" for the address and the ".0" length field will
  53  *   suppress the address in the I2C data stream.  This also works for
  54  *   successive reads using the I2C auto-incrementing memory pointer.
  55  *
  56  *   If you are manipulating a large memory with 2-byte addresses, use
  57  *   the .2 address modifier, e.g. 210.2 addresses location 528 (decimal).
  58  *
  59  *   Then there are the unfortunate memory chips that spill the most
  60  *   significant 1, 2, or 3 bits of address into the chip address byte.
  61  *   This effectively makes one chip (logically) look like 2, 4, or
  62  *   8 chips.  This is handled (awkwardly) by #defining
  63  *   CONFIG_SYS_I2C_EEPROM_ADDR_OVERFLOW and using the .1 modifier on the
  64  *   {addr} field (since .1 is the default, it doesn't actually have to
  65  *   be specified).  Examples: given a memory chip at I2C chip address
  66  *   0x50, the following would happen...
  67  *     i2c md 50 0 10   display 16 bytes starting at 0x000
  68  *                      On the bus: <S> A0 00 <E> <S> A1 <rd> ... <rd>
  69  *     i2c md 50 100 10 display 16 bytes starting at 0x100
  70  *                      On the bus: <S> A2 00 <E> <S> A3 <rd> ... <rd>
  71  *     i2c md 50 210 10 display 16 bytes starting at 0x210
  72  *                      On the bus: <S> A4 10 <E> <S> A5 <rd> ... <rd>
  73  *   This is awfully ugly.  It would be nice if someone would think up
  74  *   a better way of handling this.
  75  *
  76  * Adapted from cmd_mem.c which is copyright Wolfgang Denk (wd@denx.de).
  77  */
  78
  79 #include <common.h>
  80 #include <command.h>
  81 #include <environment.h>
  82 #include <i2c.h>
  83 #include <malloc.h>
  84 #include <asm/byteorder.h>
  85 #include <linux/compiler.h>
  86
  87 /* Display values from last command.
  88  * Memory modify remembered values are different from display memory.
  89  */
  90 static uchar    i2c_dp_last_chip;
  91 static uint     i2c_dp_last_addr;
  92 static uint     i2c_dp_last_alen;
  93 static uint     i2c_dp_last_length = 0x10;
  94
  95 static uchar    i2c_mm_last_chip;
  96 static uint     i2c_mm_last_addr;
  97 static uint     i2c_mm_last_alen;
  98
  99 /* If only one I2C bus is present, the list of devices to ignore when
 100  * the probe command is issued is represented by a 1D array of addresses.
 101  * When multiple buses are present, the list is an array of bus-address
 102  * pairs.  The following macros take care of this */
 103
 104 #if defined(CONFIG_SYS_I2C_NOPROBES)
 105 #if defined(CONFIG_I2C_MULTI_BUS)
 106 static struct
 107 {
 108         uchar   bus;
 109         uchar   addr;
 110 } i2c_no_probes[] = CONFIG_SYS_I2C_NOPROBES;
 111 #define GET_BUS_NUM     i2c_get_bus_num()
 112 #define COMPARE_BUS(b,i)        (i2c_no_probes[(i)].bus == (b))
 113 #define COMPARE_ADDR(a,i)       (i2c_no_probes[(i)].addr == (a))
 114 #define NO_PROBE_ADDR(i)        i2c_no_probes[(i)].addr
 115 #else           /* single bus */
 116 static uchar i2c_no_probes[] = CONFIG_SYS_I2C_NOPROBES;
 117 #define GET_BUS_NUM     0
 118 #define COMPARE_BUS(b,i)        ((b) == 0)      /* Make compiler happy */
 119 #define COMPARE_ADDR(a,i)       (i2c_no_probes[(i)] == (a))
 120 #define NO_PROBE_ADDR(i)        i2c_no_probes[(i)]
 121 #endif  /* CONFIG_MULTI_BUS */
 122
 123 #define NUM_ELEMENTS_NOPROBE (sizeof(i2c_no_probes)/sizeof(i2c_no_probes[0]))
 124 #endif
 125
 126 #if defined(CONFIG_I2C_MUX)
 127 static I2C_MUX_DEVICE   *i2c_mux_devices = NULL;
 128 static  int     i2c_mux_busid = CONFIG_SYS_MAX_I2C_BUS;
 129
 130 DECLARE_GLOBAL_DATA_PTR;
 131
 132 #endif
 133
 134 #define DISP_LINE_LEN   16
 135
 136 /**
 137  * i2c_init_board() - Board-specific I2C bus init
 138  *
 139  * This function is the default no-op implementation of I2C bus
 140  * initialization. This function can be overriden by board-specific
 141  * implementation if needed.
 142  */
 143 __weak
 144 void i2c_init_board(void)
 145 {
 146         return;
 147 }
 148
 149 /* TODO: Implement architecture-specific get/set functions */
 150
 151 /**
 152  * i2c_get_bus_speed() - Return I2C bus speed
 153  *
 154  * This function is the default implementation of function for retrieveing
 155  * the current I2C bus speed in Hz.
 156  *
 157  * A driver implementing runtime switching of I2C bus speed must override
 158  * this function to report the speed correctly. Simple or legacy drivers
 159  * can use this fallback.
 160  *
 161  * Returns I2C bus speed in Hz.
 162  */
 163 __weak
 164 unsigned int i2c_get_bus_speed(void)
 165 {
 166         return CONFIG_SYS_I2C_SPEED;
 167 }
 168
 169 /**
 170  * i2c_set_bus_speed() - Configure I2C bus speed
 171  * @speed:      Newly set speed of the I2C bus in Hz
 172  *
 173  * This function is the default implementation of function for setting
 174  * the I2C bus speed in Hz.
 175  *
 176  * A driver implementing runtime switching of I2C bus speed must override
 177  * this function to report the speed correctly. Simple or legacy drivers
 178  * can use this fallback.
 179  *
 180  * Returns zero on success, negative value on error.
 181  */
 182 __weak
 183 int i2c_set_bus_speed(unsigned int speed)
 184 {
 185         if (speed != CONFIG_SYS_I2C_SPEED)
 186                 return -1;
 187
 188         return 0;
 189 }
 190
 191 /**
 192  * get_alen() - Small parser helper function to get address length
 193  *
 194  * Returns the address length.
 195  */
 196 static uint get_alen(char *arg)
 197 {
 198         int     j;
 199         int     alen;
 200
 201         alen = 1;
 202         for (j = 0; j < 8; j++) {
 203                 if (arg[j] == '.') {
 204                         alen = arg[j+1] - '0';
 205                         break;
 206                 } else if (arg[j] == '\0')
 207                         break;
 208         }
 209         return alen;
 210 }
 211
 212 /**
 213  * do_i2c_read() - Handle the "i2c read" command-line command
 214  * @cmdtp:      Command data struct pointer
 215  * @flag:       Command flag
 216  * @argc:       Command-line argument count
 217  * @argv:       Array of command-line arguments
 218  *
 219  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
 220  * on error.
 221  *
 222  * Syntax:
 223  *      i2c read {i2c_chip} {devaddr}{.0, .1, .2} {len} {memaddr}
 224  */
 225 static int do_i2c_read ( cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 226 {
 227         u_char  chip;
 228         uint    devaddr, alen, length;
 229         u_char  *memaddr;
 230
 231         if (argc != 5)
 232                 return CMD_RET_USAGE;
 233
 234         /*
 235          * I2C chip address
 236          */
 237         chip = simple_strtoul(argv[1], NULL, 16);
 238
 239         /*
 240          * I2C data address within the chip.  This can be 1 or
 241          * 2 bytes long.  Some day it might be 3 bytes long :-).
 242          */
 243         devaddr = simple_strtoul(argv[2], NULL, 16);
 244         alen = get_alen(argv[2]);
 245         if (alen > 3)
 246                 return CMD_RET_USAGE;
 247
 248         /*
 249          * Length is the number of objects, not number of bytes.
 250          */
 251         length = simple_strtoul(argv[3], NULL, 16);
 252
 253         /*
 254          * memaddr is the address where to store things in memory
 255          */
 256         memaddr = (u_char *)simple_strtoul(argv[4], NULL, 16);
 257
 258         if (i2c_read(chip, devaddr, alen, memaddr, length) != 0) {
 259                 puts ("Error reading the chip.\n");
 260                 return 1;
 261         }
 262         return 0;
 263 }
 264
 265 static int do_i2c_write(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 266 {
 267         u_char  chip;
 268         uint    devaddr, alen, length;
 269         u_char  *memaddr;
 270
 271         if (argc != 5)
 272                 return cmd_usage(cmdtp);
 273
 274         /*
 275          * memaddr is the address where to store things in memory
 276          */
 277         memaddr = (u_char *)simple_strtoul(argv[1], NULL, 16);
 278
 279         /*
 280          * I2C chip address
 281          */
 282         chip = simple_strtoul(argv[2], NULL, 16);
 283
 284         /*
 285          * I2C data address within the chip.  This can be 1 or
 286          * 2 bytes long.  Some day it might be 3 bytes long :-).
 287          */
 288         devaddr = simple_strtoul(argv[3], NULL, 16);
 289         alen = get_alen(argv[3]);
 290         if (alen > 3)
 291                 return cmd_usage(cmdtp);
 292
 293         /*
 294          * Length is the number of objects, not number of bytes.
 295          */
 296         length = simple_strtoul(argv[4], NULL, 16);
 297
 298         while (length-- > 0) {
 299                 if (i2c_write(chip, devaddr++, alen, memaddr++, 1) != 0) {
 300                         puts("Error writing to the chip.\n");
 301                         return 1;
 302                 }
 303 /*
 304  * No write delay with FRAM devices.
 305  */
 306 #if !defined(CONFIG_SYS_I2C_FRAM)
 307                 udelay(11000);
 308 #endif
 309         }
 310         return 0;
 311 }
 312
 313 /**
 314  * do_i2c_md() - Handle the "i2c md" command-line command
 315  * @cmdtp:      Command data struct pointer
 316  * @flag:       Command flag
 317  * @argc:       Command-line argument count
 318  * @argv:       Array of command-line arguments
 319  *
 320  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
 321  * on error.
 322  *
 323  * Syntax:
 324  *      i2c md {i2c_chip} {addr}{.0, .1, .2} {len}
 325  */
 326 static int do_i2c_md ( cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 327 {
 328         u_char  chip;
 329         uint    addr, alen, length;
 330         int     j, nbytes, linebytes;
 331
 332         /* We use the last specified parameters, unless new ones are
 333          * entered.
 334          */
 335         chip   = i2c_dp_last_chip;
 336         addr   = i2c_dp_last_addr;
 337         alen   = i2c_dp_last_alen;
 338         length = i2c_dp_last_length;
 339
 340         if (argc < 3)
 341                 return CMD_RET_USAGE;
 342
 343         if ((flag & CMD_FLAG_REPEAT) == 0) {
 344                 /*
 345                  * New command specified.
 346                  */
 347
 348                 /*
 349                  * I2C chip address
 350                  */
 351                 chip = simple_strtoul(argv[1], NULL, 16);
 352
 353                 /*
 354                  * I2C data address within the chip.  This can be 1 or
 355                  * 2 bytes long.  Some day it might be 3 bytes long :-).
 356                  */
 357                 addr = simple_strtoul(argv[2], NULL, 16);
 358                 alen = get_alen(argv[2]);
 359                 if (alen > 3)
 360                         return CMD_RET_USAGE;
 361
 362                 /*
 363                  * If another parameter, it is the length to display.
 364                  * Length is the number of objects, not number of bytes.
 365                  */
 366                 if (argc > 3)
 367                         length = simple_strtoul(argv[3], NULL, 16);
 368         }
 369
 370         /*
 371          * Print the lines.
 372          *
 373          * We buffer all read data, so we can make sure data is read only
 374          * once.
 375          */
 376         nbytes = length;
 377         do {
 378                 unsigned char   linebuf[DISP_LINE_LEN];
 379                 unsigned char   *cp;
 380
 381                 linebytes = (nbytes > DISP_LINE_LEN) ? DISP_LINE_LEN : nbytes;
 382
 383                 if (i2c_read(chip, addr, alen, linebuf, linebytes) != 0)
 384                         puts ("Error reading the chip.\n");
 385                 else {
 386                         printf("%04x:", addr);
 387                         cp = linebuf;
 388                         for (j=0; j<linebytes; j++) {
 389                                 printf(" %02x", *cp++);
 390                                 addr++;
 391                         }
 392                         puts ("    ");
 393                         cp = linebuf;
 394                         for (j=0; j<linebytes; j++) {
 395                                 if ((*cp < 0x20) || (*cp > 0x7e))
 396                                         puts (".");
 397                                 else
 398                                         printf("%c", *cp);
 399                                 cp++;
 400                         }
 401                         putc ('\n');
 402                 }
 403                 nbytes -= linebytes;
 404         } while (nbytes > 0);
 405
 406         i2c_dp_last_chip   = chip;
 407         i2c_dp_last_addr   = addr;
 408         i2c_dp_last_alen   = alen;
 409         i2c_dp_last_length = length;
 410
 411         return 0;
 412 }
 413
 414 /**
 415  * do_i2c_mw() - Handle the "i2c mw" command-line command
 416  * @cmdtp:      Command data struct pointer
 417  * @flag:       Command flag
 418  * @argc:       Command-line argument count
 419  * @argv:       Array of command-line arguments
 420  *
 421  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
 422  * on error.
 423  *
 424  * Syntax:
 425  *      i2c mw {i2c_chip} {addr}{.0, .1, .2} {data} [{count}]
 426  */
 427 static int do_i2c_mw ( cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 428 {
 429         uchar   chip;
 430         ulong   addr;
 431         uint    alen;
 432         uchar   byte;
 433         int     count;
 434
 435         if ((argc < 4) || (argc > 5))
 436                 return CMD_RET_USAGE;
 437
 438         /*
 439          * Chip is always specified.
 440          */
 441         chip = simple_strtoul(argv[1], NULL, 16);
 442
 443         /*
 444          * Address is always specified.
 445          */
 446         addr = simple_strtoul(argv[2], NULL, 16);
 447         alen = get_alen(argv[2]);
 448         if (alen > 3)
 449                 return CMD_RET_USAGE;
 450
 451         /*
 452          * Value to write is always specified.
 453          */
 454         byte = simple_strtoul(argv[3], NULL, 16);
 455
 456         /*
 457          * Optional count
 458          */
 459         if (argc == 5)
 460                 count = simple_strtoul(argv[4], NULL, 16);
 461         else
 462                 count = 1;
 463
 464         while (count-- > 0) {
 465                 if (i2c_write(chip, addr++, alen, &byte, 1) != 0)
 466                         puts ("Error writing the chip.\n");
 467                 /*
 468                  * Wait for the write to complete.  The write can take
 469                  * up to 10mSec (we allow a little more time).
 470                  */
 471 /*
 472  * No write delay with FRAM devices.
 473  */
 474 #if !defined(CONFIG_SYS_I2C_FRAM)
 475                 udelay(11000);
 476 #endif
 477         }
 478
 479         return 0;
 480 }
 481
 482 /**
 483  * do_i2c_crc() - Handle the "i2c crc32" command-line command
 484  * @cmdtp:      Command data struct pointer
 485  * @flag:       Command flag
 486  * @argc:       Command-line argument count
 487  * @argv:       Array of command-line arguments
 488  *
 489  * Calculate a CRC on memory
 490  *
 491  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
 492  * on error.
 493  *
 494  * Syntax:
 495  *      i2c crc32 {i2c_chip} {addr}{.0, .1, .2} {count}
 496  */
 497 static int do_i2c_crc (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 498 {
 499         uchar   chip;
 500         ulong   addr;
 501         uint    alen;
 502         int     count;
 503         uchar   byte;
 504         ulong   crc;
 505         ulong   err;
 506
 507         if (argc < 4)
 508                 return CMD_RET_USAGE;
 509
 510         /*
 511          * Chip is always specified.
 512          */
 513         chip = simple_strtoul(argv[1], NULL, 16);
 514
 515         /*
 516          * Address is always specified.
 517          */
 518         addr = simple_strtoul(argv[2], NULL, 16);
 519         alen = get_alen(argv[2]);
 520         if (alen > 3)
 521                 return CMD_RET_USAGE;
 522
 523         /*
 524          * Count is always specified
 525          */
 526         count = simple_strtoul(argv[3], NULL, 16);
 527
 528         printf ("CRC32 for %08lx ... %08lx ==> ", addr, addr + count - 1);
 529         /*
 530          * CRC a byte at a time.  This is going to be slooow, but hey, the
 531          * memories are small and slow too so hopefully nobody notices.
 532          */
 533         crc = 0;
 534         err = 0;
 535         while (count-- > 0) {
 536                 if (i2c_read(chip, addr, alen, &byte, 1) != 0)
 537                         err++;
 538                 crc = crc32 (crc, &byte, 1);
 539                 addr++;
 540         }
 541         if (err > 0)
 542                 puts ("Error reading the chip,\n");
 543         else
 544                 printf ("%08lx\n", crc);
 545
 546         return 0;
 547 }
 548
 549 /**
 550  * mod_i2c_mem() - Handle the "i2c mm" and "i2c nm" command-line command
 551  * @cmdtp:      Command data struct pointer
 552  * @flag:       Command flag
 553  * @argc:       Command-line argument count
 554  * @argv:       Array of command-line arguments
 555  *
 556  * Modify memory.
 557  *
 558  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
 559  * on error.
 560  *
 561  * Syntax:
 562  *      i2c mm{.b, .w, .l} {i2c_chip} {addr}{.0, .1, .2}
 563  *      i2c nm{.b, .w, .l} {i2c_chip} {addr}{.0, .1, .2}
 564  */
 565 static int
 566 mod_i2c_mem(cmd_tbl_t *cmdtp, int incrflag, int flag, int argc, char * const argv[])
 567 {
 568         uchar   chip;
 569         ulong   addr;
 570         uint    alen;
 571         ulong   data;
 572         int     size = 1;
 573         int     nbytes;
 574
 575         if (argc != 3)
 576                 return CMD_RET_USAGE;
 577
 578 #ifdef CONFIG_BOOT_RETRY_TIME
 579         reset_cmd_timeout();    /* got a good command to get here */
 580 #endif
 581         /*
 582          * We use the last specified parameters, unless new ones are
 583          * entered.
 584          */
 585         chip = i2c_mm_last_chip;
 586         addr = i2c_mm_last_addr;
 587         alen = i2c_mm_last_alen;
 588
 589         if ((flag & CMD_FLAG_REPEAT) == 0) {
 590                 /*
 591                  * New command specified.  Check for a size specification.
 592                  * Defaults to byte if no or incorrect specification.
 593                  */
 594                 size = cmd_get_data_size(argv[0], 1);
 595
 596                 /*
 597                  * Chip is always specified.
 598                  */
 599                 chip = simple_strtoul(argv[1], NULL, 16);
 600
 601                 /*
 602                  * Address is always specified.
 603                  */
 604                 addr = simple_strtoul(argv[2], NULL, 16);
 605                 alen = get_alen(argv[2]);
 606                 if (alen > 3)
 607                         return CMD_RET_USAGE;
 608         }
 609
 610         /*
 611          * Print the address, followed by value.  Then accept input for
 612          * the next value.  A non-converted value exits.
 613          */
 614         do {
 615                 printf("%08lx:", addr);
 616                 if (i2c_read(chip, addr, alen, (uchar *)&data, size) != 0)
 617                         puts ("\nError reading the chip,\n");
 618                 else {
 619                         data = cpu_to_be32(data);
 620                         if (size == 1)
 621                                 printf(" %02lx", (data >> 24) & 0x000000FF);
 622                         else if (size == 2)
 623                                 printf(" %04lx", (data >> 16) & 0x0000FFFF);
 624                         else
 625                                 printf(" %08lx", data);
 626                 }
 627
 628                 nbytes = readline (" ? ");
 629                 if (nbytes == 0) {
 630                         /*
 631                          * <CR> pressed as only input, don't modify current
 632                          * location and move to next.
 633                          */
 634                         if (incrflag)
 635                                 addr += size;
 636                         nbytes = size;
 637 #ifdef CONFIG_BOOT_RETRY_TIME
 638                         reset_cmd_timeout(); /* good enough to not time out */
 639 #endif
 640                 }
 641 #ifdef CONFIG_BOOT_RETRY_TIME
 642                 else if (nbytes == -2)
 643                         break;  /* timed out, exit the command  */
 644 #endif
 645                 else {
 646                         char *endp;
 647
 648                         data = simple_strtoul(console_buffer, &endp, 16);
 649                         if (size == 1)
 650                                 data = data << 24;
 651                         else if (size == 2)
 652                                 data = data << 16;
 653                         data = be32_to_cpu(data);
 654                         nbytes = endp - console_buffer;
 655                         if (nbytes) {
 656 #ifdef CONFIG_BOOT_RETRY_TIME
 657                                 /*
 658                                  * good enough to not time out
 659                                  */
 660                                 reset_cmd_timeout();
 661 #endif
 662                                 if (i2c_write(chip, addr, alen, (uchar *)&data, size) != 0)
 663                                         puts ("Error writing the chip.\n");
 664 #ifdef CONFIG_SYS_EEPROM_PAGE_WRITE_DELAY_MS
 665                                 udelay(CONFIG_SYS_EEPROM_PAGE_WRITE_DELAY_MS * 1000);
 666 #endif
 667                                 if (incrflag)
 668                                         addr += size;
 669                         }
 670                 }
 671         } while (nbytes);
 672
 673         i2c_mm_last_chip = chip;
 674         i2c_mm_last_addr = addr;
 675         i2c_mm_last_alen = alen;
 676
 677         return 0;
 678 }
 679
 680 /**
 681  * do_i2c_probe() - Handle the "i2c probe" command-line command
 682  * @cmdtp:      Command data struct pointer
 683  * @flag:       Command flag
 684  * @argc:       Command-line argument count
 685  * @argv:       Array of command-line arguments
 686  *
 687  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
 688  * on error.
 689  *
 690  * Syntax:
 691  *      i2c probe {addr}
 692  *
 693  * Returns zero (success) if one or more I2C devices was found
 694  */
 695 static int do_i2c_probe (cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 696 {
 697         int j;
 698         int addr = -1;
 699         int found = 0;
 700 #if defined(CONFIG_SYS_I2C_NOPROBES)
 701         int k, skip;
 702         uchar bus = GET_BUS_NUM;
 703 #endif  /* NOPROBES */
 704
 705         if (argc == 2)
 706                 addr = simple_strtol(argv[1], 0, 16);
 707
 708         puts ("Valid chip addresses:");
 709         for (j = 0; j < 128; j++) {
 710                 if ((0 <= addr) && (j != addr))
 711                         continue;
 712
 713 #if defined(CONFIG_SYS_I2C_NOPROBES)
 714                 skip = 0;
 715                 for (k=0; k < NUM_ELEMENTS_NOPROBE; k++) {
 716                         if (COMPARE_BUS(bus, k) && COMPARE_ADDR(j, k)) {
 717                                 skip = 1;
 718                                 break;
 719                         }
 720                 }
 721                 if (skip)
 722                         continue;
 723 #endif
 724                 if (i2c_probe(j) == 0) {
 725                         printf(" %02X", j);
 726                         found++;
 727                 }
 728         }
 729         putc ('\n');
 730
 731 #if defined(CONFIG_SYS_I2C_NOPROBES)
 732         puts ("Excluded chip addresses:");
 733         for (k=0; k < NUM_ELEMENTS_NOPROBE; k++) {
 734                 if (COMPARE_BUS(bus,k))
 735                         printf(" %02X", NO_PROBE_ADDR(k));
 736         }
 737         putc ('\n');
 738 #endif
 739
 740         return (0 == found);
 741 }
 742
 743 /**
 744  * do_i2c_loop() - Handle the "i2c loop" command-line command
 745  * @cmdtp:      Command data struct pointer
 746  * @flag:       Command flag
 747  * @argc:       Command-line argument count
 748  * @argv:       Array of command-line arguments
 749  *
 750  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
 751  * on error.
 752  *
 753  * Syntax:
 754  *      i2c loop {i2c_chip} {addr}{.0, .1, .2} [{length}] [{delay}]
 755  *      {length} - Number of bytes to read
 756  *      {delay}  - A DECIMAL number and defaults to 1000 uSec
 757  */
 758 static int do_i2c_loop(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
 759 {
 760         u_char  chip;
 761         ulong   alen;
 762         uint    addr;
 763         uint    length;
 764         u_char  bytes[16];
 765         int     delay;
 766
 767         if (argc < 3)
 768                 return CMD_RET_USAGE;
 769
 770         /*
 771          * Chip is always specified.
 772          */
 773         chip = simple_strtoul(argv[1], NULL, 16);
 774
 775         /*
 776          * Address is always specified.
 777          */
 778         addr = simple_strtoul(argv[2], NULL, 16);
 779         alen = get_alen(argv[2]);
 780         if (alen > 3)
 781                 return CMD_RET_USAGE;
 782
 783         /*
 784          * Length is the number of objects, not number of bytes.
 785          */
 786         length = 1;
 787         length = simple_strtoul(argv[3], NULL, 16);
 788         if (length > sizeof(bytes))
 789                 length = sizeof(bytes);
 790
 791         /*
 792          * The delay time (uSec) is optional.
 793          */
 794         delay = 1000;
 795         if (argc > 3)
 796                 delay = simple_strtoul(argv[4], NULL, 10);
 797         /*
 798          * Run the loop...
 799          */
 800         while (1) {
 801                 if (i2c_read(chip, addr, alen, bytes, length) != 0)
 802                         puts ("Error reading the chip.\n");
 803                 udelay(delay);
 804         }
 805
 806         /* NOTREACHED */
 807         return 0;
 808 }
 809
 810 /*
 811  * The SDRAM command is separately configured because many
 812  * (most?) embedded boards don't use SDRAM DIMMs.
 813  *
 814  * FIXME: Document and probably move elsewhere!
 815  */
 816 #if defined(CONFIG_CMD_SDRAM)
 817 static void print_ddr2_tcyc (u_char const b)
 818 {
 819         printf ("%d.", (b >> 4) & 0x0F);
 820         switch (b & 0x0F) {
 821         case 0x0:
 822         case 0x1:
 823         case 0x2:
 824         case 0x3:
 825         case 0x4:
 826         case 0x5:
 827         case 0x6:
 828         case 0x7:
 829         case 0x8:
 830         case 0x9:
 831                 printf ("%d ns\n", b & 0x0F);
 832                 break;
 833         case 0xA:
 834                 puts ("25 ns\n");
 835                 break;
 836         case 0xB:
 837                 puts ("33 ns\n");
 838                 break;
 839         case 0xC:
 840                 puts ("66 ns\n");
 841                 break;
 842         case 0xD:
 843                 puts ("75 ns\n");
 844                 break;
 845         default:
 846                 puts ("?? ns\n");
 847                 break;
 848         }
 849 }
 850
 851 static void decode_bits (u_char const b, char const *str[], int const do_once)
 852 {
 853         u_char mask;
 854
 855         for (mask = 0x80; mask != 0x00; mask >>= 1, ++str) {
 856                 if (b & mask) {
 857                         puts (*str);
 858                         if (do_once)
 859                                 return;
 860                 }
 861         }
 862 }
 863
 864 /*
 865  * Syntax:
 866  *      i2c sdram {i2c_chip}
 867  */
 868 static int do_sdram (cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
 869 {
 870         enum { unknown, EDO, SDRAM, DDR2 } type;
 871
 872         u_char  chip;
 873         u_char  data[128];
 874         u_char  cksum;
 875         int     j;
 876
 877         static const char *decode_CAS_DDR2[] = {
 878                 " TBD", " 6", " 5", " 4", " 3", " 2", " TBD", " TBD"
 879         };
 880
 881         static const char *decode_CAS_default[] = {
 882                 " TBD", " 7", " 6", " 5", " 4", " 3", " 2", " 1"
 883         };
 884
 885         static const char *decode_CS_WE_default[] = {
 886                 " TBD", " 6", " 5", " 4", " 3", " 2", " 1", " 0"
 887         };
 888
 889         static const char *decode_byte21_default[] = {
 890                 "  TBD (bit 7)\n",
 891                 "  Redundant row address\n",
 892                 "  Differential clock input\n",
 893                 "  Registerd DQMB inputs\n",
 894                 "  Buffered DQMB inputs\n",
 895                 "  On-card PLL\n",
 896                 "  Registered address/control lines\n",
 897                 "  Buffered address/control lines\n"
 898         };
 899
 900         static const char *decode_byte22_DDR2[] = {
 901                 "  TBD (bit 7)\n",
 902                 "  TBD (bit 6)\n",
 903                 "  TBD (bit 5)\n",
 904                 "  TBD (bit 4)\n",
 905                 "  TBD (bit 3)\n",
 906                 "  Supports partial array self refresh\n",
 907                 "  Supports 50 ohm ODT\n",
 908                 "  Supports weak driver\n"
 909         };
 910
 911         static const char *decode_row_density_DDR2[] = {
 912                 "512 MiB", "256 MiB", "128 MiB", "16 GiB",
 913                 "8 GiB", "4 GiB", "2 GiB", "1 GiB"
 914         };
 915
 916         static const char *decode_row_density_default[] = {
 917                 "512 MiB", "256 MiB", "128 MiB", "64 MiB",
 918                 "32 MiB", "16 MiB", "8 MiB", "4 MiB"
 919         };
 920
 921         if (argc < 2)
 922                 return CMD_RET_USAGE;
 923
 924         /*
 925          * Chip is always specified.
 926          */
 927         chip = simple_strtoul (argv[1], NULL, 16);
 928
 929         if (i2c_read (chip, 0, 1, data, sizeof (data)) != 0) {
 930                 puts ("No SDRAM Serial Presence Detect found.\n");
 931                 return 1;
 932         }
 933
 934         cksum = 0;
 935         for (j = 0; j < 63; j++) {
 936                 cksum += data[j];
 937         }
 938         if (cksum != data[63]) {
 939                 printf ("WARNING: Configuration data checksum failure:\n"
 940                         "  is 0x%02x, calculated 0x%02x\n", data[63], cksum);
 941         }
 942         printf ("SPD data revision            %d.%d\n",
 943                 (data[62] >> 4) & 0x0F, data[62] & 0x0F);
 944         printf ("Bytes used                   0x%02X\n", data[0]);
 945         printf ("Serial memory size           0x%02X\n", 1 << data[1]);
 946
 947         puts ("Memory type                  ");
 948         switch (data[2]) {
 949         case 2:
 950                 type = EDO;
 951                 puts ("EDO\n");
 952                 break;
 953         case 4:
 954                 type = SDRAM;
 955                 puts ("SDRAM\n");
 956                 break;
 957         case 8:
 958                 type = DDR2;
 959                 puts ("DDR2\n");
 960                 break;
 961         default:
 962                 type = unknown;
 963                 puts ("unknown\n");
 964                 break;
 965         }
 966
 967         puts ("Row address bits             ");
 968         if ((data[3] & 0x00F0) == 0)
 969                 printf ("%d\n", data[3] & 0x0F);
 970         else
 971                 printf ("%d/%d\n", data[3] & 0x0F, (data[3] >> 4) & 0x0F);
 972
 973         puts ("Column address bits          ");
 974         if ((data[4] & 0x00F0) == 0)
 975                 printf ("%d\n", data[4] & 0x0F);
 976         else
 977                 printf ("%d/%d\n", data[4] & 0x0F, (data[4] >> 4) & 0x0F);
 978
 979         switch (type) {
 980         case DDR2:
 981                 printf ("Number of ranks              %d\n",
 982                         (data[5] & 0x07) + 1);
 983                 break;
 984         default:
 985                 printf ("Module rows                  %d\n", data[5]);
 986                 break;
 987         }
 988
 989         switch (type) {
 990         case DDR2:
 991                 printf ("Module data width            %d bits\n", data[6]);
 992                 break;
 993         default:
 994                 printf ("Module data width            %d bits\n",
 995                         (data[7] << 8) | data[6]);
 996                 break;
 997         }
 998
 999         puts ("Interface signal levels      ");
1000         switch(data[8]) {
1001                 case 0:  puts ("TTL 5.0 V\n");  break;
1002                 case 1:  puts ("LVTTL\n");      break;
1003                 case 2:  puts ("HSTL 1.5 V\n"); break;
1004                 case 3:  puts ("SSTL 3.3 V\n"); break;
1005                 case 4:  puts ("SSTL 2.5 V\n"); break;
1006                 case 5:  puts ("SSTL 1.8 V\n"); break;
1007                 default: puts ("unknown\n");    break;
1008         }
1009
1010         switch (type) {
1011         case DDR2:
1012                 printf ("SDRAM cycle time             ");
1013                 print_ddr2_tcyc (data[9]);
1014                 break;
1015         default:
1016                 printf ("SDRAM cycle time             %d.%d ns\n",
1017                         (data[9] >> 4) & 0x0F, data[9] & 0x0F);
1018                 break;
1019         }
1020
1021         switch (type) {
1022         case DDR2:
1023                 printf ("SDRAM access time            0.%d%d ns\n",
1024                         (data[10] >> 4) & 0x0F, data[10] & 0x0F);
1025                 break;
1026         default:
1027                 printf ("SDRAM access time            %d.%d ns\n",
1028                         (data[10] >> 4) & 0x0F, data[10] & 0x0F);
1029                 break;
1030         }
1031
1032         puts ("EDC configuration            ");
1033         switch (data[11]) {
1034                 case 0:  puts ("None\n");       break;
1035                 case 1:  puts ("Parity\n");     break;
1036                 case 2:  puts ("ECC\n");        break;
1037                 default: puts ("unknown\n");    break;
1038         }
1039
1040         if ((data[12] & 0x80) == 0)
1041                 puts ("No self refresh, rate        ");
1042         else
1043                 puts ("Self refresh, rate           ");
1044
1045         switch(data[12] & 0x7F) {
1046                 case 0:  puts ("15.625 us\n");  break;
1047                 case 1:  puts ("3.9 us\n");     break;
1048                 case 2:  puts ("7.8 us\n");     break;
1049                 case 3:  puts ("31.3 us\n");    break;
1050                 case 4:  puts ("62.5 us\n");    break;
1051                 case 5:  puts ("125 us\n");     break;
1052                 default: puts ("unknown\n");    break;
1053         }
1054
1055         switch (type) {
1056         case DDR2:
1057                 printf ("SDRAM width (primary)        %d\n", data[13]);
1058                 break;
1059         default:
1060                 printf ("SDRAM width (primary)        %d\n", data[13] & 0x7F);
1061                 if ((data[13] & 0x80) != 0) {
1062                         printf ("  (second bank)              %d\n",
1063                                 2 * (data[13] & 0x7F));
1064                 }
1065                 break;
1066         }
1067
1068         switch (type) {
1069         case DDR2:
1070                 if (data[14] != 0)
1071                         printf ("EDC width                    %d\n", data[14]);
1072                 break;
1073         default:
1074                 if (data[14] != 0) {
1075                         printf ("EDC width                    %d\n",
1076                                 data[14] & 0x7F);
1077
1078                         if ((data[14] & 0x80) != 0) {
1079                                 printf ("  (second bank)              %d\n",
1080                                         2 * (data[14] & 0x7F));
1081                         }
1082                 }
1083                 break;
1084         }
1085
1086         if (DDR2 != type) {
1087                 printf ("Min clock delay, back-to-back random column addresses "
1088                         "%d\n", data[15]);
1089         }
1090
1091         puts ("Burst length(s)             ");
1092         if (data[16] & 0x80) puts (" Page");
1093         if (data[16] & 0x08) puts (" 8");
1094         if (data[16] & 0x04) puts (" 4");
1095         if (data[16] & 0x02) puts (" 2");
1096         if (data[16] & 0x01) puts (" 1");
1097         putc ('\n');
1098         printf ("Number of banks              %d\n", data[17]);
1099
1100         switch (type) {
1101         case DDR2:
1102                 puts ("CAS latency(s)              ");
1103                 decode_bits (data[18], decode_CAS_DDR2, 0);
1104                 putc ('\n');
1105                 break;
1106         default:
1107                 puts ("CAS latency(s)              ");
1108                 decode_bits (data[18], decode_CAS_default, 0);
1109                 putc ('\n');
1110                 break;
1111         }
1112
1113         if (DDR2 != type) {
1114                 puts ("CS latency(s)               ");
1115                 decode_bits (data[19], decode_CS_WE_default, 0);
1116                 putc ('\n');
1117         }
1118
1119         if (DDR2 != type) {
1120                 puts ("WE latency(s)               ");
1121                 decode_bits (data[20], decode_CS_WE_default, 0);
1122                 putc ('\n');
1123         }
1124
1125         switch (type) {
1126         case DDR2:
1127                 puts ("Module attributes:\n");
1128                 if (data[21] & 0x80)
1129                         puts ("  TBD (bit 7)\n");
1130                 if (data[21] & 0x40)
1131                         puts ("  Analysis probe installed\n");
1132                 if (data[21] & 0x20)
1133                         puts ("  TBD (bit 5)\n");
1134                 if (data[21] & 0x10)
1135                         puts ("  FET switch external enable\n");
1136                 printf ("  %d PLLs on DIMM\n", (data[21] >> 2) & 0x03);
1137                 if (data[20] & 0x11) {
1138                         printf ("  %d active registers on DIMM\n",
1139                                 (data[21] & 0x03) + 1);
1140                 }
1141                 break;
1142         default:
1143                 puts ("Module attributes:\n");
1144                 if (!data[21])
1145                         puts ("  (none)\n");
1146                 else
1147                         decode_bits (data[21], decode_byte21_default, 0);
1148                 break;
1149         }
1150
1151         switch (type) {
1152         case DDR2:
1153                 decode_bits (data[22], decode_byte22_DDR2, 0);
1154                 break;
1155         default:
1156                 puts ("Device attributes:\n");
1157                 if (data[22] & 0x80) puts ("  TBD (bit 7)\n");
1158                 if (data[22] & 0x40) puts ("  TBD (bit 6)\n");
1159                 if (data[22] & 0x20) puts ("  Upper Vcc tolerance 5%\n");
1160                 else                 puts ("  Upper Vcc tolerance 10%\n");
1161                 if (data[22] & 0x10) puts ("  Lower Vcc tolerance 5%\n");
1162                 else                 puts ("  Lower Vcc tolerance 10%\n");
1163                 if (data[22] & 0x08) puts ("  Supports write1/read burst\n");
1164                 if (data[22] & 0x04) puts ("  Supports precharge all\n");
1165                 if (data[22] & 0x02) puts ("  Supports auto precharge\n");
1166                 if (data[22] & 0x01) puts ("  Supports early RAS# precharge\n");
1167                 break;
1168         }
1169
1170         switch (type) {
1171         case DDR2:
1172                 printf ("SDRAM cycle time (2nd highest CAS latency)        ");
1173                 print_ddr2_tcyc (data[23]);
1174                 break;
1175         default:
1176                 printf ("SDRAM cycle time (2nd highest CAS latency)        %d."
1177                         "%d ns\n", (data[23] >> 4) & 0x0F, data[23] & 0x0F);
1178                 break;
1179         }
1180
1181         switch (type) {
1182         case DDR2:
1183                 printf ("SDRAM access from clock (2nd highest CAS latency) 0."
1184                         "%d%d ns\n", (data[24] >> 4) & 0x0F, data[24] & 0x0F);
1185                 break;
1186         default:
1187                 printf ("SDRAM access from clock (2nd highest CAS latency) %d."
1188                         "%d ns\n", (data[24] >> 4) & 0x0F, data[24] & 0x0F);
1189                 break;
1190         }
1191
1192         switch (type) {
1193         case DDR2:
1194                 printf ("SDRAM cycle time (3rd highest CAS latency)        ");
1195                 print_ddr2_tcyc (data[25]);
1196                 break;
1197         default:
1198                 printf ("SDRAM cycle time (3rd highest CAS latency)        %d."
1199                         "%d ns\n", (data[25] >> 4) & 0x0F, data[25] & 0x0F);
1200                 break;
1201         }
1202
1203         switch (type) {
1204         case DDR2:
1205                 printf ("SDRAM access from clock (3rd highest CAS latency) 0."
1206                         "%d%d ns\n", (data[26] >> 4) & 0x0F, data[26] & 0x0F);
1207                 break;
1208         default:
1209                 printf ("SDRAM access from clock (3rd highest CAS latency) %d."
1210                         "%d ns\n", (data[26] >> 4) & 0x0F, data[26] & 0x0F);
1211                 break;
1212         }
1213
1214         switch (type) {
1215         case DDR2:
1216                 printf ("Minimum row precharge        %d.%02d ns\n",
1217                         (data[27] >> 2) & 0x3F, 25 * (data[27] & 0x03));
1218                 break;
1219         default:
1220                 printf ("Minimum row precharge        %d ns\n", data[27]);
1221                 break;
1222         }
1223
1224         switch (type) {
1225         case DDR2:
1226                 printf ("Row active to row active min %d.%02d ns\n",
1227                         (data[28] >> 2) & 0x3F, 25 * (data[28] & 0x03));
1228                 break;
1229         default:
1230                 printf ("Row active to row active min %d ns\n", data[28]);
1231                 break;
1232         }
1233
1234         switch (type) {
1235         case DDR2:
1236                 printf ("RAS to CAS delay min         %d.%02d ns\n",
1237                         (data[29] >> 2) & 0x3F, 25 * (data[29] & 0x03));
1238                 break;
1239         default:
1240                 printf ("RAS to CAS delay min         %d ns\n", data[29]);
1241                 break;
1242         }
1243
1244         printf ("Minimum RAS pulse width      %d ns\n", data[30]);
1245
1246         switch (type) {
1247         case DDR2:
1248                 puts ("Density of each row          ");
1249                 decode_bits (data[31], decode_row_density_DDR2, 1);
1250                 putc ('\n');
1251                 break;
1252         default:
1253                 puts ("Density of each row          ");
1254                 decode_bits (data[31], decode_row_density_default, 1);
1255                 putc ('\n');
1256                 break;
1257         }
1258
1259         switch (type) {
1260         case DDR2:
1261                 puts ("Command and Address setup    ");
1262                 if (data[32] >= 0xA0) {
1263                         printf ("1.%d%d ns\n",
1264                                 ((data[32] >> 4) & 0x0F) - 10, data[32] & 0x0F);
1265                 } else {
1266                         printf ("0.%d%d ns\n",
1267                                 ((data[32] >> 4) & 0x0F), data[32] & 0x0F);
1268                 }
1269                 break;
1270         default:
1271                 printf ("Command and Address setup    %c%d.%d ns\n",
1272                         (data[32] & 0x80) ? '-' : '+',
1273                         (data[32] >> 4) & 0x07, data[32] & 0x0F);
1274                 break;
1275         }
1276
1277         switch (type) {
1278         case DDR2:
1279                 puts ("Command and Address hold     ");
1280                 if (data[33] >= 0xA0) {
1281                         printf ("1.%d%d ns\n",
1282                                 ((data[33] >> 4) & 0x0F) - 10, data[33] & 0x0F);
1283                 } else {
1284                         printf ("0.%d%d ns\n",
1285                                 ((data[33] >> 4) & 0x0F), data[33] & 0x0F);
1286                 }
1287                 break;
1288         default:
1289                 printf ("Command and Address hold     %c%d.%d ns\n",
1290                         (data[33] & 0x80) ? '-' : '+',
1291                         (data[33] >> 4) & 0x07, data[33] & 0x0F);
1292                 break;
1293         }
1294
1295         switch (type) {
1296         case DDR2:
1297                 printf ("Data signal input setup      0.%d%d ns\n",
1298                         (data[34] >> 4) & 0x0F, data[34] & 0x0F);
1299                 break;
1300         default:
1301                 printf ("Data signal input setup      %c%d.%d ns\n",
1302                         (data[34] & 0x80) ? '-' : '+',
1303                         (data[34] >> 4) & 0x07, data[34] & 0x0F);
1304                 break;
1305         }
1306
1307         switch (type) {
1308         case DDR2:
1309                 printf ("Data signal input hold       0.%d%d ns\n",
1310                         (data[35] >> 4) & 0x0F, data[35] & 0x0F);
1311                 break;
1312         default:
1313                 printf ("Data signal input hold       %c%d.%d ns\n",
1314                         (data[35] & 0x80) ? '-' : '+',
1315                         (data[35] >> 4) & 0x07, data[35] & 0x0F);
1316                 break;
1317         }
1318
1319         puts ("Manufacturer's JEDEC ID      ");
1320         for (j = 64; j <= 71; j++)
1321                 printf ("%02X ", data[j]);
1322         putc ('\n');
1323         printf ("Manufacturing Location       %02X\n", data[72]);
1324         puts ("Manufacturer's Part Number   ");
1325         for (j = 73; j <= 90; j++)
1326                 printf ("%02X ", data[j]);
1327         putc ('\n');
1328         printf ("Revision Code                %02X %02X\n", data[91], data[92]);
1329         printf ("Manufacturing Date           %02X %02X\n", data[93], data[94]);
1330         puts ("Assembly Serial Number       ");
1331         for (j = 95; j <= 98; j++)
1332                 printf ("%02X ", data[j]);
1333         putc ('\n');
1334
1335         if (DDR2 != type) {
1336                 printf ("Speed rating                 PC%d\n",
1337                         data[126] == 0x66 ? 66 : data[126]);
1338         }
1339         return 0;
1340 }
1341 #endif
1342
1343 #if defined(CONFIG_I2C_MUX)
1344 /**
1345  * do_i2c_add_bus() - Handle the "i2c bus" command-line command
1346  * @cmdtp:      Command data struct pointer
1347  * @flag:       Command flag
1348  * @argc:       Command-line argument count
1349  * @argv:       Array of command-line arguments
1350  *
1351  * Returns zero always.
1352  */
1353 static int do_i2c_add_bus(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
1354 {
1355         int ret=0;
1356
1357         if (argc == 1) {
1358                 /* show all busses */
1359                 I2C_MUX         *mux;
1360                 I2C_MUX_DEVICE  *device = i2c_mux_devices;
1361
1362                 printf ("Busses reached over muxes:\n");
1363                 while (device != NULL) {
1364                         printf ("Bus ID: %x\n", device->busid);
1365                         printf ("  reached over Mux(es):\n");
1366                         mux = device->mux;
1367                         while (mux != NULL) {
1368                                 printf ("    %s@%x ch: %x\n", mux->name, mux->chip, mux->channel);
1369                                 mux = mux->next;
1370                         }
1371                         device = device->next;
1372                 }
1373         } else {
1374                 (void)i2c_mux_ident_muxstring ((uchar *)argv[1]);
1375                 ret = 0;
1376         }
1377         return ret;
1378 }
1379 #endif  /* CONFIG_I2C_MUX */
1380
1381 #if defined(CONFIG_I2C_MULTI_BUS)
1382 /**
1383  * do_i2c_bus_num() - Handle the "i2c dev" command-line command
1384  * @cmdtp:      Command data struct pointer
1385  * @flag:       Command flag
1386  * @argc:       Command-line argument count
1387  * @argv:       Array of command-line arguments
1388  *
1389  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
1390  * on error.
1391  */
1392 static int do_i2c_bus_num(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
1393 {
1394         int bus_idx, ret=0;
1395
1396         if (argc == 1)
1397                 /* querying current setting */
1398                 printf("Current bus is %d\n", i2c_get_bus_num());
1399         else {
1400                 bus_idx = simple_strtoul(argv[1], NULL, 10);
1401                 printf("Setting bus to %d\n", bus_idx);
1402                 ret = i2c_set_bus_num(bus_idx);
1403                 if (ret)
1404                         printf("Failure changing bus number (%d)\n", ret);
1405         }
1406         return ret;
1407 }
1408 #endif  /* CONFIG_I2C_MULTI_BUS */
1409
1410 /**
1411  * do_i2c_bus_speed() - Handle the "i2c speed" command-line command
1412  * @cmdtp:      Command data struct pointer
1413  * @flag:       Command flag
1414  * @argc:       Command-line argument count
1415  * @argv:       Array of command-line arguments
1416  *
1417  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
1418  * on error.
1419  */
1420 static int do_i2c_bus_speed(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
1421 {
1422         int speed, ret=0;
1423
1424         if (argc == 1)
1425                 /* querying current speed */
1426                 printf("Current bus speed=%d\n", i2c_get_bus_speed());
1427         else {
1428                 speed = simple_strtoul(argv[1], NULL, 10);
1429                 printf("Setting bus speed to %d Hz\n", speed);
1430                 ret = i2c_set_bus_speed(speed);
1431                 if (ret)
1432                         printf("Failure changing bus speed (%d)\n", ret);
1433         }
1434         return ret;
1435 }
1436
1437 /**
1438  * do_i2c_mm() - Handle the "i2c mm" command-line command
1439  * @cmdtp:      Command data struct pointer
1440  * @flag:       Command flag
1441  * @argc:       Command-line argument count
1442  * @argv:       Array of command-line arguments
1443  *
1444  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
1445  * on error.
1446  */
1447 static int do_i2c_mm(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
1448 {
1449         return mod_i2c_mem (cmdtp, 1, flag, argc, argv);
1450 }
1451
1452 /**
1453  * do_i2c_nm() - Handle the "i2c nm" command-line command
1454  * @cmdtp:      Command data struct pointer
1455  * @flag:       Command flag
1456  * @argc:       Command-line argument count
1457  * @argv:       Array of command-line arguments
1458  *
1459  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
1460  * on error.
1461  */
1462 static int do_i2c_nm(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
1463 {
1464         return mod_i2c_mem (cmdtp, 0, flag, argc, argv);
1465 }
1466
1467 /**
1468  * do_i2c_reset() - Handle the "i2c reset" command-line command
1469  * @cmdtp:      Command data struct pointer
1470  * @flag:       Command flag
1471  * @argc:       Command-line argument count
1472  * @argv:       Array of command-line arguments
1473  *
1474  * Returns zero always.
1475  */
1476 static int do_i2c_reset(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
1477 {
1478         i2c_init(CONFIG_SYS_I2C_SPEED, CONFIG_SYS_I2C_SLAVE);
1479         return 0;
1480 }
1481
1482 static cmd_tbl_t cmd_i2c_sub[] = {
1483 #if defined(CONFIG_I2C_MUX)
1484         U_BOOT_CMD_MKENT(bus, 1, 1, do_i2c_add_bus, "", ""),
1485 #endif  /* CONFIG_I2C_MUX */
1486         U_BOOT_CMD_MKENT(crc32, 3, 1, do_i2c_crc, "", ""),
1487 #if defined(CONFIG_I2C_MULTI_BUS)
1488         U_BOOT_CMD_MKENT(dev, 1, 1, do_i2c_bus_num, "", ""),
1489 #endif  /* CONFIG_I2C_MULTI_BUS */
1490         U_BOOT_CMD_MKENT(loop, 3, 1, do_i2c_loop, "", ""),
1491         U_BOOT_CMD_MKENT(md, 3, 1, do_i2c_md, "", ""),
1492         U_BOOT_CMD_MKENT(mm, 2, 1, do_i2c_mm, "", ""),
1493         U_BOOT_CMD_MKENT(mw, 3, 1, do_i2c_mw, "", ""),
1494         U_BOOT_CMD_MKENT(nm, 2, 1, do_i2c_nm, "", ""),
1495         U_BOOT_CMD_MKENT(probe, 0, 1, do_i2c_probe, "", ""),
1496         U_BOOT_CMD_MKENT(read, 5, 1, do_i2c_read, "", ""),
1497         U_BOOT_CMD_MKENT(write, 5, 0, do_i2c_write, "", ""),
1498         U_BOOT_CMD_MKENT(reset, 0, 1, do_i2c_reset, "", ""),
1499 #if defined(CONFIG_CMD_SDRAM)
1500         U_BOOT_CMD_MKENT(sdram, 1, 1, do_sdram, "", ""),
1501 #endif
1502         U_BOOT_CMD_MKENT(speed, 1, 1, do_i2c_bus_speed, "", ""),
1503 };
1504
1505 #ifdef CONFIG_NEEDS_MANUAL_RELOC
1506 void i2c_reloc(void) {
1507         fixup_cmdtable(cmd_i2c_sub, ARRAY_SIZE(cmd_i2c_sub));
1508 }
1509 #endif
1510
1511 /**
1512  * do_i2c() - Handle the "i2c" command-line command
1513  * @cmdtp:      Command data struct pointer
1514  * @flag:       Command flag
1515  * @argc:       Command-line argument count
1516  * @argv:       Array of command-line arguments
1517  *
1518  * Returns zero on success, CMD_RET_USAGE in case of misuse and negative
1519  * on error.
1520  */
1521 static int do_i2c(cmd_tbl_t * cmdtp, int flag, int argc, char * const argv[])
1522 {
1523         cmd_tbl_t *c;
1524
1525         if (argc < 2)
1526                 return CMD_RET_USAGE;
1527
1528         /* Strip off leading 'i2c' command argument */
1529         argc--;
1530         argv++;
1531
1532         c = find_cmd_tbl(argv[0], &cmd_i2c_sub[0], ARRAY_SIZE(cmd_i2c_sub));
1533
1534         if (c)
1535                 return c->cmd(cmdtp, flag, argc, argv);
1536         else
1537                 return CMD_RET_USAGE;
1538 }
1539
1540 /***************************************************/
1541 #ifdef CONFIG_SYS_LONGHELP
1542 static char i2c_help_text[] =
1543 #if defined(CONFIG_I2C_MUX)
1544         "bus [muxtype:muxaddr:muxchannel] - add a new bus reached over muxes\ni2c "
1545 #endif  /* CONFIG_I2C_MUX */
1546         "crc32 chip address[.0, .1, .2] count - compute CRC32 checksum\n"
1547 #if defined(CONFIG_I2C_MULTI_BUS)
1548         "i2c dev [dev] - show or set current I2C bus\n"
1549 #endif  /* CONFIG_I2C_MULTI_BUS */
1550         "i2c loop chip address[.0, .1, .2] [# of objects] - looping read of device\n"
1551         "i2c md chip address[.0, .1, .2] [# of objects] - read from I2C device\n"
1552         "i2c mm chip address[.0, .1, .2] - write to I2C device (auto-incrementing)\n"
1553         "i2c mw chip address[.0, .1, .2] value [count] - write to I2C device (fill)\n"
1554         "i2c nm chip address[.0, .1, .2] - write to I2C device (constant address)\n"
1555         "i2c probe [address] - test for and show device(s) on the I2C bus\n"
1556         "i2c read chip address[.0, .1, .2] length memaddress - read to memory \n"
1557         "i2c write memaddress chip address[.0, .1, .2] length - write memory to i2c\n"
1558         "i2c reset - re-init the I2C Controller\n"
1559 #if defined(CONFIG_CMD_SDRAM)
1560         "i2c sdram chip - print SDRAM configuration information\n"
1561 #endif
1562         "i2c speed [speed] - show or set I2C bus speed";
1563 #endif
1564
1565 U_BOOT_CMD(
1566         i2c, 6, 1, do_i2c,
1567         "I2C sub-system",
1568         i2c_help_text
1569 );
1570
1571 #if defined(CONFIG_I2C_MUX)
1572 static int i2c_mux_add_device(I2C_MUX_DEVICE *dev)
1573 {
1574         I2C_MUX_DEVICE  *devtmp = i2c_mux_devices;
1575
1576         if (i2c_mux_devices == NULL) {
1577                 i2c_mux_devices = dev;
1578                 return 0;
1579         }
1580         while (devtmp->next != NULL)
1581                 devtmp = devtmp->next;
1582
1583         devtmp->next = dev;
1584         return 0;
1585 }
1586
1587 I2C_MUX_DEVICE  *i2c_mux_search_device(int id)
1588 {
1589         I2C_MUX_DEVICE  *device = i2c_mux_devices;
1590
1591         while (device != NULL) {
1592                 if (device->busid == id)
1593                         return device;
1594                 device = device->next;
1595         }
1596         return NULL;
1597 }
1598
1599 /* searches in the buf from *pos the next ':'.
1600  * returns:
1601  *     0 if found (with *pos = where)
1602  *   < 0 if an error occured
1603  *   > 0 if the end of buf is reached
1604  */
1605 static int i2c_mux_search_next (int *pos, uchar *buf, int len)
1606 {
1607         while ((buf[*pos] != ':') && (*pos < len)) {
1608                 *pos += 1;
1609         }
1610         if (*pos >= len)
1611                 return 1;
1612         if (buf[*pos] != ':')
1613                 return -1;
1614         return 0;
1615 }
1616
1617 static int i2c_mux_get_busid (void)
1618 {
1619         int     tmp = i2c_mux_busid;
1620
1621         i2c_mux_busid ++;
1622         return tmp;
1623 }
1624
1625 /* Analyses a Muxstring and immediately sends the
1626    commands to the muxes. Runs from flash.
1627  */
1628 int i2c_mux_ident_muxstring_f (uchar *buf)
1629 {
1630         int     pos = 0;
1631         int     oldpos;
1632         int     ret = 0;
1633         int     len = strlen((char *)buf);
1634         int     chip;
1635         uchar   channel;
1636         int     was = 0;
1637
1638         while (ret == 0) {
1639                 oldpos = pos;
1640                 /* search name */
1641                 ret = i2c_mux_search_next(&pos, buf, len);
1642                 if (ret != 0)
1643                         printf ("ERROR\n");
1644                 /* search address */
1645                 pos ++;
1646                 oldpos = pos;
1647                 ret = i2c_mux_search_next(&pos, buf, len);
1648                 if (ret != 0)
1649                         printf ("ERROR\n");
1650                 buf[pos] = 0;
1651                 chip = simple_strtoul((char *)&buf[oldpos], NULL, 16);
1652                 buf[pos] = ':';
1653                 /* search channel */
1654                 pos ++;
1655                 oldpos = pos;
1656                 ret = i2c_mux_search_next(&pos, buf, len);
1657                 if (ret < 0)
1658                         printf ("ERROR\n");
1659                 was = 0;
1660                 if (buf[pos] != 0) {
1661                         buf[pos] = 0;
1662                         was = 1;
1663                 }
1664                 channel = simple_strtoul((char *)&buf[oldpos], NULL, 16);
1665                 if (was)
1666                         buf[pos] = ':';
1667                 if (i2c_write(chip, 0, 0, &channel, 1) != 0) {
1668                         printf ("Error setting Mux: chip:%x channel: \
1669                                 %x\n", chip, channel);
1670                         return -1;
1671                 }
1672                 pos ++;
1673                 oldpos = pos;
1674
1675         }
1676         i2c_init_board();
1677
1678         return 0;
1679 }
1680
1681 /* Analyses a Muxstring and if this String is correct
1682  * adds a new I2C Bus.
1683  */
1684 I2C_MUX_DEVICE *i2c_mux_ident_muxstring (uchar *buf)
1685 {
1686         I2C_MUX_DEVICE  *device;
1687         I2C_MUX         *mux;
1688         int     pos = 0;
1689         int     oldpos;
1690         int     ret = 0;
1691         int     len = strlen((char *)buf);
1692         int     was = 0;
1693
1694         device = (I2C_MUX_DEVICE *)malloc (sizeof(I2C_MUX_DEVICE));
1695         device->mux = NULL;
1696         device->busid = i2c_mux_get_busid ();
1697         device->next = NULL;
1698         while (ret == 0) {
1699                 mux = (I2C_MUX *)malloc (sizeof(I2C_MUX));
1700                 mux->next = NULL;
1701                 /* search name of mux */
1702                 oldpos = pos;
1703                 ret = i2c_mux_search_next(&pos, buf, len);
1704                 if (ret != 0)
1705                         printf ("%s no name.\n", __FUNCTION__);
1706                 mux->name = (char *)malloc (pos - oldpos + 1);
1707                 memcpy (mux->name, &buf[oldpos], pos - oldpos);
1708                 mux->name[pos - oldpos] = 0;
1709                 /* search address */
1710                 pos ++;
1711                 oldpos = pos;
1712                 ret = i2c_mux_search_next(&pos, buf, len);
1713                 if (ret != 0)
1714                         printf ("%s no mux address.\n", __FUNCTION__);
1715                 buf[pos] = 0;
1716                 mux->chip = simple_strtoul((char *)&buf[oldpos], NULL, 16);
1717                 buf[pos] = ':';
1718                 /* search channel */
1719                 pos ++;
1720                 oldpos = pos;
1721                 ret = i2c_mux_search_next(&pos, buf, len);
1722                 if (ret < 0)
1723                         printf ("%s no mux channel.\n", __FUNCTION__);
1724                 was = 0;
1725                 if (buf[pos] != 0) {
1726                         buf[pos] = 0;
1727                         was = 1;
1728                 }
1729                 mux->channel = simple_strtoul((char *)&buf[oldpos], NULL, 16);
1730                 if (was)
1731                         buf[pos] = ':';
1732                 if (device->mux == NULL)
1733                         device->mux = mux;
1734                 else {
1735                         I2C_MUX         *muxtmp = device->mux;
1736                         while (muxtmp->next != NULL) {
1737                                 muxtmp = muxtmp->next;
1738                         }
1739                         muxtmp->next = mux;
1740                 }
1741                 pos ++;
1742                 oldpos = pos;
1743         }
1744         if (ret > 0) {
1745                 /* Add Device */
1746                 i2c_mux_add_device (device);
1747                 return device;
1748         }
1749
1750         return NULL;
1751 }
1752
1753 int i2x_mux_select_mux(int bus)
1754 {
1755         I2C_MUX_DEVICE  *dev;
1756         I2C_MUX         *mux;
1757
1758         if ((gd->flags & GD_FLG_RELOC) != GD_FLG_RELOC) {
1759                 /* select Default Mux Bus */
1760 #if defined(CONFIG_SYS_I2C_IVM_BUS)
1761                 i2c_mux_ident_muxstring_f ((uchar *)CONFIG_SYS_I2C_IVM_BUS);
1762 #else
1763                 {
1764                 unsigned char *buf;
1765                 buf = (unsigned char *) getenv("EEprom_ivm");
1766                 if (buf != NULL)
1767                         i2c_mux_ident_muxstring_f (buf);
1768                 }
1769 #endif
1770                 return 0;
1771         }
1772         dev = i2c_mux_search_device(bus);
1773         if (dev == NULL)
1774                 return -1;
1775
1776         mux = dev->mux;
1777         while (mux != NULL) {
1778                 /* do deblocking on each level of mux, before mux config */
1779                 i2c_init_board();
1780                 if (i2c_write(mux->chip, 0, 0, &mux->channel, 1) != 0) {
1781                         printf ("Error setting Mux: chip:%x channel: \
1782                                 %x\n", mux->chip, mux->channel);
1783                         return -1;
1784                 }
1785                 mux = mux->next;
1786         }
1787         /* do deblocking on each level of mux and after mux config */
1788         i2c_init_board();
1789         return 0;
1790 }
1791 #endif /* CONFIG_I2C_MUX */