]> git.karo-electronics.de Git - karo-tx-uboot.git/blob - post/drivers/i2c.c
post/i2c: Clean up detection logic
[karo-tx-uboot.git] / post / drivers / i2c.c
1 /*
2  * (C) Copyright 2002
3  * Wolfgang Denk, DENX Software Engineering, wd@denx.de.
4  *
5  * See file CREDITS for list of people who contributed to this
6  * project.
7  *
8  * This program is free software; you can redistribute it and/or
9  * modify it under the terms of the GNU General Public License as
10  * published by the Free Software Foundation; either version 2 of
11  * the License, or (at your option) any later version.
12  *
13  * This program is distributed in the hope that it will be useful,
14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16  * GNU General Public License for more details.
17  *
18  * You should have received a copy of the GNU General Public License
19  * along with this program; if not, write to the Free Software
20  * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
21  * MA 02111-1307 USA
22  */
23
24 /*
25  * I2C test
26  *
27  * For verifying the I2C bus, a full I2C bus scanning is performed.
28  *
29  * #ifdef I2C_ADDR_LIST
30  *   The test is considered as passed if all the devices and
31  *   only the devices in the list are found.
32  * #else [ ! I2C_ADDR_LIST ]
33  *   The test is considered as passed if any I2C device is found.
34  * #endif
35  */
36
37 #include <common.h>
38 #include <post.h>
39 #include <i2c.h>
40
41 #if CONFIG_POST & CONFIG_SYS_POST_I2C
42
43 int i2c_post_test (int flags)
44 {
45         unsigned int i;
46 #ifndef I2C_ADDR_LIST
47         for (i = 0; i < 128; i++)
48                 if (i2c_probe (i) == 0)
49                         return 0;
50
51         /* No devices found */
52         return -1;
53 #else
54         unsigned int ret  = 0;
55         int j;
56         const unsigned char i2c_addr_list[] = I2C_ADDR_LIST;
57
58         for (i = 0; i < 128; i++) {
59                 if (i2c_probe(i) != 0)
60                         continue;
61
62                 for (j = 0; j < sizeof(i2c_addr_list); ++j) {
63                         if (i == i2c_addr_list[j]) {
64                                 i2c_addr_list[j] = 0xff;
65                                 break;
66                         }
67                 }
68
69                 if (j == sizeof(i2c_addr_list)) {
70                         ret = -1;
71                         post_log("I2C: addr %02x not expected\n", i);
72                 }
73         }
74
75         for (i = 0; i < sizeof(i2c_addr_list); ++i) {
76                 if (i2c_addr_list[i] == 0xff)
77                         continue;
78                 post_log("I2C: addr %02x did not respond\n", i2c_addr_list[i]);
79                 ret = -1;
80         }
81
82         return ret;
83 #endif
84 }
85
86 #endif /* CONFIG_POST & CONFIG_SYS_POST_I2C */