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