1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <common.h>
26#include <post.h>
27#include <i2c.h>
28
29#if CONFIG_POST & CONFIG_SYS_POST_I2C
30
31static int i2c_ignore_device(unsigned int chip)
32{
33#ifdef CONFIG_SYS_POST_I2C_IGNORES
34 const unsigned char i2c_ignore_list[] = CONFIG_SYS_POST_I2C_IGNORES;
35 int i;
36
37 for (i = 0; i < sizeof(i2c_ignore_list); i++)
38 if (i2c_ignore_list[i] == chip)
39 return 1;
40#endif
41
42 return 0;
43}
44
45int i2c_post_test (int flags)
46{
47 unsigned int i;
48#ifndef CONFIG_SYS_POST_I2C_ADDRS
49
50 for (i = 1; i < 128; i++) {
51 if (i2c_ignore_device(i))
52 continue;
53 if (i2c_probe (i) == 0)
54 return 0;
55 }
56
57
58 return -1;
59#else
60 unsigned int ret = 0;
61 int j;
62 unsigned char i2c_addr_list[] = CONFIG_SYS_POST_I2C_ADDRS;
63
64
65 for (i = 1; i < 128; i++) {
66 if (i2c_ignore_device(i))
67 continue;
68 if (i2c_probe(i) != 0)
69 continue;
70
71 for (j = 0; j < sizeof(i2c_addr_list); ++j) {
72 if (i == i2c_addr_list[j]) {
73 i2c_addr_list[j] = 0xff;
74 break;
75 }
76 }
77
78 if (j == sizeof(i2c_addr_list)) {
79 ret = -1;
80 post_log("I2C: addr %02x not expected\n", i);
81 }
82 }
83
84 for (i = 0; i < sizeof(i2c_addr_list); ++i) {
85 if (i2c_addr_list[i] == 0xff)
86 continue;
87 if (i2c_ignore_device(i2c_addr_list[i]))
88 continue;
89 post_log("I2C: addr %02x did not respond\n", i2c_addr_list[i]);
90 ret = -1;
91 }
92
93 return ret;
94#endif
95}
96
97#endif
98