aboutsummaryrefslogtreecommitdiffstats
diff options
context:
space:
mode:
-rw-r--r--drivers/i2c/i2c-sensor-detect.c45
1 files changed, 13 insertions, 32 deletions
diff --git a/drivers/i2c/i2c-sensor-detect.c b/drivers/i2c/i2c-sensor-detect.c
index f99a8161a9f1..5aede3ca9cb0 100644
--- a/drivers/i2c/i2c-sensor-detect.c
+++ b/drivers/i2c/i2c-sensor-detect.c
@@ -25,42 +25,34 @@
25#include <linux/i2c-sensor.h> 25#include <linux/i2c-sensor.h>
26 26
27static unsigned short empty[] = {I2C_CLIENT_END}; 27static unsigned short empty[] = {I2C_CLIENT_END};
28static unsigned int empty_isa[] = {I2C_CLIENT_ISA_END};
29 28
30/* Very inefficient for ISA detects, and won't work for 10-bit addresses! */ 29/* Won't work for 10-bit addresses! */
31int i2c_detect(struct i2c_adapter *adapter, 30int i2c_detect(struct i2c_adapter *adapter,
32 struct i2c_address_data *address_data, 31 struct i2c_address_data *address_data,
33 int (*found_proc) (struct i2c_adapter *, int, int)) 32 int (*found_proc) (struct i2c_adapter *, int, int))
34{ 33{
35 int addr, i, found, j, err; 34 int addr, i, found, j, err;
36 struct i2c_force_data *this_force; 35 struct i2c_force_data *this_force;
37 int is_isa = i2c_is_isa_adapter(adapter); 36 int adapter_id = i2c_adapter_id(adapter);
38 int adapter_id =
39 is_isa ? ANY_I2C_ISA_BUS : i2c_adapter_id(adapter);
40 unsigned short *normal_i2c; 37 unsigned short *normal_i2c;
41 unsigned int *normal_isa;
42 unsigned short *probe; 38 unsigned short *probe;
43 unsigned short *ignore; 39 unsigned short *ignore;
44 40
45 /* Forget it if we can't probe using SMBUS_QUICK */ 41 /* Forget it if we can't probe using SMBUS_QUICK */
46 if ((!is_isa) && 42 if (!i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK))
47 !i2c_check_functionality(adapter, I2C_FUNC_SMBUS_QUICK))
48 return -1; 43 return -1;
49 44
50 /* Use default "empty" list if the adapter doesn't specify any */ 45 /* Use default "empty" list if the adapter doesn't specify any */
51 normal_i2c = probe = ignore = empty; 46 normal_i2c = probe = ignore = empty;
52 normal_isa = empty_isa;
53 if (address_data->normal_i2c) 47 if (address_data->normal_i2c)
54 normal_i2c = address_data->normal_i2c; 48 normal_i2c = address_data->normal_i2c;
55 if (address_data->normal_isa)
56 normal_isa = address_data->normal_isa;
57 if (address_data->probe) 49 if (address_data->probe)
58 probe = address_data->probe; 50 probe = address_data->probe;
59 if (address_data->ignore) 51 if (address_data->ignore)
60 ignore = address_data->ignore; 52 ignore = address_data->ignore;
61 53
62 for (addr = 0x00; addr <= (is_isa ? 0xffff : 0x7f); addr++) { 54 for (addr = 0x00; addr <= 0x7f; addr++) {
63 if (!is_isa && i2c_check_addr(adapter, addr)) 55 if (i2c_check_addr(adapter, addr))
64 continue; 56 continue;
65 57
66 /* If it is in one of the force entries, we don't do any 58 /* If it is in one of the force entries, we don't do any
@@ -69,7 +61,7 @@ int i2c_detect(struct i2c_adapter *adapter,
69 for (i = 0; !found && (this_force = address_data->forces + i, this_force->force); i++) { 61 for (i = 0; !found && (this_force = address_data->forces + i, this_force->force); i++) {
70 for (j = 0; !found && (this_force->force[j] != I2C_CLIENT_END); j += 2) { 62 for (j = 0; !found && (this_force->force[j] != I2C_CLIENT_END); j += 2) {
71 if ( ((adapter_id == this_force->force[j]) || 63 if ( ((adapter_id == this_force->force[j]) ||
72 ((this_force->force[j] == ANY_I2C_BUS) && !is_isa)) && 64 (this_force->force[j] == ANY_I2C_BUS)) &&
73 (addr == this_force->force[j + 1]) ) { 65 (addr == this_force->force[j + 1]) ) {
74 dev_dbg(&adapter->dev, "found force parameter for adapter %d, addr %04x\n", adapter_id, addr); 66 dev_dbg(&adapter->dev, "found force parameter for adapter %d, addr %04x\n", adapter_id, addr);
75 if ((err = found_proc(adapter, addr, this_force->kind))) 67 if ((err = found_proc(adapter, addr, this_force->kind)))
@@ -85,8 +77,7 @@ int i2c_detect(struct i2c_adapter *adapter,
85 right now */ 77 right now */
86 for (i = 0; !found && (ignore[i] != I2C_CLIENT_END); i += 2) { 78 for (i = 0; !found && (ignore[i] != I2C_CLIENT_END); i += 2) {
87 if ( ((adapter_id == ignore[i]) || 79 if ( ((adapter_id == ignore[i]) ||
88 ((ignore[i] == ANY_I2C_BUS) && 80 (ignore[i] == ANY_I2C_BUS)) &&
89 !is_isa)) &&
90 (addr == ignore[i + 1])) { 81 (addr == ignore[i + 1])) {
91 dev_dbg(&adapter->dev, "found ignore parameter for adapter %d, addr %04x\n", adapter_id, addr); 82 dev_dbg(&adapter->dev, "found ignore parameter for adapter %d, addr %04x\n", adapter_id, addr);
92 found = 1; 83 found = 1;
@@ -97,19 +88,10 @@ int i2c_detect(struct i2c_adapter *adapter,
97 88
98 /* Now, we will do a detection, but only if it is in the normal or 89 /* Now, we will do a detection, but only if it is in the normal or
99 probe entries */ 90 probe entries */
100 if (is_isa) { 91 for (i = 0; !found && (normal_i2c[i] != I2C_CLIENT_END); i += 1) {
101 for (i = 0; !found && (normal_isa[i] != I2C_CLIENT_ISA_END); i += 1) { 92 if (addr == normal_i2c[i]) {
102 if (addr == normal_isa[i]) { 93 found = 1;
103 dev_dbg(&adapter->dev, "found normal isa entry for adapter %d, addr %04x\n", adapter_id, addr); 94 dev_dbg(&adapter->dev, "found normal i2c entry for adapter %d, addr %02x\n", adapter_id, addr);
104 found = 1;
105 }
106 }
107 } else {
108 for (i = 0; !found && (normal_i2c[i] != I2C_CLIENT_END); i += 1) {
109 if (addr == normal_i2c[i]) {
110 found = 1;
111 dev_dbg(&adapter->dev, "found normal i2c entry for adapter %d, addr %02x\n", adapter_id, addr);
112 }
113 } 95 }
114 } 96 }
115 97
@@ -117,7 +99,7 @@ int i2c_detect(struct i2c_adapter *adapter,
117 !found && (probe[i] != I2C_CLIENT_END); 99 !found && (probe[i] != I2C_CLIENT_END);
118 i += 2) { 100 i += 2) {
119 if (((adapter_id == probe[i]) || 101 if (((adapter_id == probe[i]) ||
120 ((probe[i] == ANY_I2C_BUS) && !is_isa)) 102 (probe[i] == ANY_I2C_BUS))
121 && (addr == probe[i + 1])) { 103 && (addr == probe[i + 1])) {
122 dev_dbg(&adapter->dev, "found probe parameter for adapter %d, addr %04x\n", adapter_id, addr); 104 dev_dbg(&adapter->dev, "found probe parameter for adapter %d, addr %04x\n", adapter_id, addr);
123 found = 1; 105 found = 1;
@@ -128,8 +110,7 @@ int i2c_detect(struct i2c_adapter *adapter,
128 110
129 /* OK, so we really should examine this address. First check 111 /* OK, so we really should examine this address. First check
130 whether there is some client here at all! */ 112 whether there is some client here at all! */
131 if (is_isa || 113 if (i2c_smbus_xfer(adapter, addr, 0, 0, 0, I2C_SMBUS_QUICK, NULL) >= 0)
132 (i2c_smbus_xfer (adapter, addr, 0, 0, 0, I2C_SMBUS_QUICK, NULL) >= 0))
133 if ((err = found_proc(adapter, addr, -1))) 114 if ((err = found_proc(adapter, addr, -1)))
134 return err; 115 return err;
135 } 116 }