]>
Commit | Line | Data |
---|---|---|
a6c2ba28 | 1 | /* |
f7abcd38 | 2 | em28xx-i2c.c - driver for Empia EM2800/EM2820/2840 USB video capture devices |
a6c2ba28 | 3 | |
f7abcd38 MCC |
4 | Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it> |
5 | Markus Rechberger <mrechberger@gmail.com> | |
2e7c6dc3 | 6 | Mauro Carvalho Chehab <mchehab@infradead.org> |
f7abcd38 | 7 | Sascha Sommer <saschasommer@freenet.de> |
a3ea4bf9 | 8 | Copyright (C) 2013 Frank Schäfer <fschaefer.oss@googlemail.com> |
a6c2ba28 | 9 | |
10 | This program is free software; you can redistribute it and/or modify | |
11 | it under the terms of the GNU General Public License as published by | |
12 | the Free Software Foundation; either version 2 of the License, or | |
13 | (at your option) any later version. | |
14 | ||
15 | This program is distributed in the hope that it will be useful, | |
16 | but WITHOUT ANY WARRANTY; without even the implied warranty of | |
17 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
18 | GNU General Public License for more details. | |
19 | ||
20 | You should have received a copy of the GNU General Public License | |
21 | along with this program; if not, write to the Free Software | |
22 | Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | |
23 | */ | |
24 | ||
8314d402 MCC |
25 | #include "em28xx.h" |
26 | ||
a6c2ba28 | 27 | #include <linux/module.h> |
28 | #include <linux/kernel.h> | |
29 | #include <linux/usb.h> | |
30 | #include <linux/i2c.h> | |
4b83626a | 31 | #include <linux/jiffies.h> |
a6c2ba28 | 32 | |
6c362c8e | 33 | #include "tuner-xc2028.h" |
5e453dc7 | 34 | #include <media/v4l2-common.h> |
d5e52653 | 35 | #include <media/tuner.h> |
a6c2ba28 | 36 | |
37 | /* ----------------------------------------------------------- */ | |
38 | ||
ff699e6b | 39 | static unsigned int i2c_scan; |
a6c2ba28 | 40 | module_param(i2c_scan, int, 0444); |
41 | MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time"); | |
42 | ||
ff699e6b | 43 | static unsigned int i2c_debug; |
a6c2ba28 | 44 | module_param(i2c_debug, int, 0644); |
50f0a9df | 45 | MODULE_PARM_DESC(i2c_debug, "i2c debug message level (1: normal debug, 2: show I2C transfers)"); |
a6c2ba28 | 46 | |
ce8591ff MCC |
47 | #define dprintk(level, fmt, arg...) do { \ |
48 | if (i2c_debug > level) \ | |
29b05e22 | 49 | dev_printk(KERN_DEBUG, &dev->intf->dev, \ |
ce8591ff MCC |
50 | "i2c: %s: " fmt, __func__, ## arg); \ |
51 | } while (0) | |
52 | ||
53 | ||
a6c2ba28 | 54 | /* |
f5ae371a FS |
55 | * em2800_i2c_send_bytes() |
56 | * send up to 4 bytes to the em2800 i2c device | |
596d92d5 | 57 | */ |
f5ae371a | 58 | static int em2800_i2c_send_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len) |
596d92d5 | 59 | { |
d1b7213b | 60 | unsigned long timeout = jiffies + msecs_to_jiffies(EM28XX_I2C_XFER_TIMEOUT); |
596d92d5 | 61 | int ret; |
a6bad040 | 62 | u8 b2[6]; |
f5ae371a FS |
63 | |
64 | if (len < 1 || len > 4) | |
65 | return -EOPNOTSUPP; | |
66 | ||
596d92d5 MCC |
67 | BUG_ON(len < 1 || len > 4); |
68 | b2[5] = 0x80 + len - 1; | |
69 | b2[4] = addr; | |
70 | b2[3] = buf[0]; | |
71 | if (len > 1) | |
72 | b2[2] = buf[1]; | |
73 | if (len > 2) | |
74 | b2[1] = buf[2]; | |
75 | if (len > 3) | |
76 | b2[0] = buf[3]; | |
77 | ||
2fcc82d8 | 78 | /* trigger write */ |
3acf2809 | 79 | ret = dev->em28xx_write_regs(dev, 4 - len, &b2[4 - len], 2 + len); |
596d92d5 | 80 | if (ret != 2 + len) { |
29b05e22 | 81 | dev_warn(&dev->intf->dev, |
ce8591ff | 82 | "failed to trigger write to i2c address 0x%x (error=%i)\n", |
d230d5ad | 83 | addr, ret); |
45f04e82 | 84 | return (ret < 0) ? ret : -EIO; |
596d92d5 | 85 | } |
2fcc82d8 | 86 | /* wait for completion */ |
4b83626a | 87 | while (time_is_after_jiffies(timeout)) { |
3acf2809 | 88 | ret = dev->em28xx_read_reg(dev, 0x05); |
4b83626a | 89 | if (ret == 0x80 + len - 1) |
596d92d5 | 90 | return len; |
4b83626a | 91 | if (ret == 0x94 + len - 1) { |
ce8591ff | 92 | dprintk(1, "R05 returned 0x%02x: I2C ACK error\n", ret); |
e63b009d | 93 | return -ENXIO; |
4b83626a MCC |
94 | } |
95 | if (ret < 0) { | |
29b05e22 | 96 | dev_warn(&dev->intf->dev, |
ce8591ff | 97 | "failed to get i2c transfer status from bridge register (error=%i)\n", |
2a96f60e | 98 | ret); |
45f04e82 FS |
99 | return ret; |
100 | } | |
e8e41da4 | 101 | msleep(5); |
596d92d5 | 102 | } |
ce8591ff | 103 | dprintk(0, "write to i2c device at 0x%x timed out\n", addr); |
e63b009d | 104 | return -ETIMEDOUT; |
596d92d5 MCC |
105 | } |
106 | ||
596d92d5 | 107 | /* |
2fcc82d8 FS |
108 | * em2800_i2c_recv_bytes() |
109 | * read up to 4 bytes from the em2800 i2c device | |
596d92d5 | 110 | */ |
2fcc82d8 | 111 | static int em2800_i2c_recv_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len) |
596d92d5 | 112 | { |
d1b7213b | 113 | unsigned long timeout = jiffies + msecs_to_jiffies(EM28XX_I2C_XFER_TIMEOUT); |
2fcc82d8 | 114 | u8 buf2[4]; |
596d92d5 | 115 | int ret; |
2fcc82d8 FS |
116 | int i; |
117 | ||
118 | if (len < 1 || len > 4) | |
119 | return -EOPNOTSUPP; | |
120 | ||
121 | /* trigger read */ | |
122 | buf2[1] = 0x84 + len - 1; | |
123 | buf2[0] = addr; | |
124 | ret = dev->em28xx_write_regs(dev, 0x04, buf2, 2); | |
125 | if (ret != 2) { | |
29b05e22 | 126 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
127 | "failed to trigger read from i2c address 0x%x (error=%i)\n", |
128 | addr, ret); | |
2fcc82d8 | 129 | return (ret < 0) ? ret : -EIO; |
596d92d5 | 130 | } |
d45b9b8a | 131 | |
2fcc82d8 | 132 | /* wait for completion */ |
4b83626a | 133 | while (time_is_after_jiffies(timeout)) { |
2fcc82d8 | 134 | ret = dev->em28xx_read_reg(dev, 0x05); |
4b83626a | 135 | if (ret == 0x84 + len - 1) |
2fcc82d8 | 136 | break; |
4b83626a | 137 | if (ret == 0x94 + len - 1) { |
ce8591ff MCC |
138 | dprintk(1, "R05 returned 0x%02x: I2C ACK error\n", |
139 | ret); | |
e63b009d | 140 | return -ENXIO; |
4b83626a MCC |
141 | } |
142 | if (ret < 0) { | |
29b05e22 | 143 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
144 | "failed to get i2c transfer status from bridge register (error=%i)\n", |
145 | ret); | |
2fcc82d8 FS |
146 | return ret; |
147 | } | |
e8e41da4 | 148 | msleep(5); |
596d92d5 | 149 | } |
50f0a9df | 150 | if (ret != 0x84 + len - 1) { |
ce8591ff | 151 | dprintk(0, "read from i2c device at 0x%x timed out\n", addr); |
50f0a9df | 152 | } |
2fcc82d8 FS |
153 | |
154 | /* get the received message */ | |
155 | ret = dev->em28xx_read_reg_req_len(dev, 0x00, 4-len, buf2, len); | |
156 | if (ret != len) { | |
29b05e22 | 157 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
158 | "reading from i2c device at 0x%x failed: couldn't get the received message from the bridge (error=%i)\n", |
159 | addr, ret); | |
2fcc82d8 FS |
160 | return (ret < 0) ? ret : -EIO; |
161 | } | |
162 | for (i = 0; i < len; i++) | |
163 | buf[i] = buf2[len - 1 - i]; | |
164 | ||
165 | return ret; | |
596d92d5 MCC |
166 | } |
167 | ||
168 | /* | |
2fcc82d8 FS |
169 | * em2800_i2c_check_for_device() |
170 | * check if there is an i2c device at the supplied address | |
596d92d5 | 171 | */ |
2fcc82d8 | 172 | static int em2800_i2c_check_for_device(struct em28xx *dev, u8 addr) |
596d92d5 | 173 | { |
2fcc82d8 | 174 | u8 buf; |
596d92d5 | 175 | int ret; |
f5ae371a | 176 | |
2fcc82d8 FS |
177 | ret = em2800_i2c_recv_bytes(dev, addr, &buf, 1); |
178 | if (ret == 1) | |
179 | return 0; | |
180 | return (ret < 0) ? ret : -EIO; | |
596d92d5 MCC |
181 | } |
182 | ||
183 | /* | |
3acf2809 | 184 | * em28xx_i2c_send_bytes() |
a6c2ba28 | 185 | */ |
a6bad040 FS |
186 | static int em28xx_i2c_send_bytes(struct em28xx *dev, u16 addr, u8 *buf, |
187 | u16 len, int stop) | |
a6c2ba28 | 188 | { |
d1b7213b | 189 | unsigned long timeout = jiffies + msecs_to_jiffies(EM28XX_I2C_XFER_TIMEOUT); |
4b83626a | 190 | int ret; |
a6c2ba28 | 191 | |
f5ae371a FS |
192 | if (len < 1 || len > 64) |
193 | return -EOPNOTSUPP; | |
fa74aca3 FS |
194 | /* |
195 | * NOTE: limited by the USB ctrl message constraints | |
196 | * Zero length reads always succeed, even if no device is connected | |
197 | */ | |
f5ae371a | 198 | |
45f04e82 FS |
199 | /* Write to i2c device */ |
200 | ret = dev->em28xx_write_regs_req(dev, stop ? 2 : 3, addr, buf, len); | |
201 | if (ret != len) { | |
202 | if (ret < 0) { | |
29b05e22 | 203 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
204 | "writing to i2c device at 0x%x failed (error=%i)\n", |
205 | addr, ret); | |
45f04e82 FS |
206 | return ret; |
207 | } else { | |
29b05e22 | 208 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
209 | "%i bytes write to i2c device at 0x%x requested, but %i bytes written\n", |
210 | len, addr, ret); | |
45f04e82 FS |
211 | return -EIO; |
212 | } | |
213 | } | |
a6c2ba28 | 214 | |
4b83626a MCC |
215 | /* wait for completion */ |
216 | while (time_is_after_jiffies(timeout)) { | |
bbc70e64 | 217 | ret = dev->em28xx_read_reg(dev, 0x05); |
4b83626a | 218 | if (ret == 0) /* success */ |
45f04e82 | 219 | return len; |
4b83626a | 220 | if (ret == 0x10) { |
ce8591ff MCC |
221 | dprintk(1, "I2C ACK error on writing to addr 0x%02x\n", |
222 | addr); | |
e63b009d | 223 | return -ENXIO; |
4b83626a MCC |
224 | } |
225 | if (ret < 0) { | |
29b05e22 | 226 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
227 | "failed to get i2c transfer status from bridge register (error=%i)\n", |
228 | ret); | |
45f04e82 FS |
229 | return ret; |
230 | } | |
bbc70e64 | 231 | msleep(5); |
fa74aca3 FS |
232 | /* |
233 | * NOTE: do we really have to wait for success ? | |
234 | * Never seen anything else than 0x00 or 0x10 | |
235 | * (even with high payload) ... | |
236 | */ | |
bbc70e64 | 237 | } |
123a17d1 FS |
238 | |
239 | if (ret == 0x02 || ret == 0x04) { | |
240 | /* NOTE: these errors seem to be related to clock stretching */ | |
ce8591ff MCC |
241 | dprintk(0, |
242 | "write to i2c device at 0x%x timed out (status=%i)\n", | |
243 | addr, ret); | |
123a17d1 FS |
244 | return -ETIMEDOUT; |
245 | } | |
246 | ||
29b05e22 | 247 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
248 | "write to i2c device at 0x%x failed with unknown error (status=%i)\n", |
249 | addr, ret); | |
123a17d1 | 250 | return -EIO; |
a6c2ba28 | 251 | } |
252 | ||
253 | /* | |
3acf2809 | 254 | * em28xx_i2c_recv_bytes() |
a6c2ba28 | 255 | * read a byte from the i2c device |
256 | */ | |
a6bad040 | 257 | static int em28xx_i2c_recv_bytes(struct em28xx *dev, u16 addr, u8 *buf, u16 len) |
a6c2ba28 | 258 | { |
259 | int ret; | |
f5ae371a FS |
260 | |
261 | if (len < 1 || len > 64) | |
262 | return -EOPNOTSUPP; | |
fa74aca3 FS |
263 | /* |
264 | * NOTE: limited by the USB ctrl message constraints | |
265 | * Zero length reads always succeed, even if no device is connected | |
266 | */ | |
f5ae371a | 267 | |
45f04e82 | 268 | /* Read data from i2c device */ |
3acf2809 | 269 | ret = dev->em28xx_read_reg_req_len(dev, 2, addr, buf, len); |
7f6301d1 | 270 | if (ret < 0) { |
29b05e22 | 271 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
272 | "reading from i2c device at 0x%x failed (error=%i)\n", |
273 | addr, ret); | |
7f6301d1 | 274 | return ret; |
45f04e82 | 275 | } |
fa74aca3 FS |
276 | /* |
277 | * NOTE: some devices with two i2c busses have the bad habit to return 0 | |
7f6301d1 FS |
278 | * bytes if we are on bus B AND there was no write attempt to the |
279 | * specified slave address before AND no device is present at the | |
280 | * requested slave address. | |
e63b009d | 281 | * Anyway, the next check will fail with -ENXIO in this case, so avoid |
7f6301d1 FS |
282 | * spamming the system log on device probing and do nothing here. |
283 | */ | |
45f04e82 FS |
284 | |
285 | /* Check success of the i2c operation */ | |
286 | ret = dev->em28xx_read_reg(dev, 0x05); | |
4b83626a MCC |
287 | if (ret == 0) /* success */ |
288 | return len; | |
a6c2ba28 | 289 | if (ret < 0) { |
29b05e22 | 290 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
291 | "failed to get i2c transfer status from bridge register (error=%i)\n", |
292 | ret); | |
a6c2ba28 | 293 | return ret; |
294 | } | |
d845fb3a | 295 | if (ret == 0x10) { |
ce8591ff MCC |
296 | dprintk(1, "I2C ACK error on writing to addr 0x%02x\n", |
297 | addr); | |
e63b009d | 298 | return -ENXIO; |
d845fb3a | 299 | } |
4b83626a | 300 | |
123a17d1 FS |
301 | if (ret == 0x02 || ret == 0x04) { |
302 | /* NOTE: these errors seem to be related to clock stretching */ | |
ce8591ff MCC |
303 | dprintk(0, |
304 | "write to i2c device at 0x%x timed out (status=%i)\n", | |
305 | addr, ret); | |
123a17d1 FS |
306 | return -ETIMEDOUT; |
307 | } | |
308 | ||
29b05e22 | 309 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
310 | "write to i2c device at 0x%x failed with unknown error (status=%i)\n", |
311 | addr, ret); | |
123a17d1 | 312 | return -EIO; |
a6c2ba28 | 313 | } |
314 | ||
315 | /* | |
3acf2809 | 316 | * em28xx_i2c_check_for_device() |
a6c2ba28 | 317 | * check if there is a i2c_device at the supplied address |
318 | */ | |
a6bad040 | 319 | static int em28xx_i2c_check_for_device(struct em28xx *dev, u16 addr) |
a6c2ba28 | 320 | { |
a6c2ba28 | 321 | int ret; |
45f04e82 | 322 | u8 buf; |
a6c2ba28 | 323 | |
45f04e82 FS |
324 | ret = em28xx_i2c_recv_bytes(dev, addr, &buf, 1); |
325 | if (ret == 1) | |
326 | return 0; | |
327 | return (ret < 0) ? ret : -EIO; | |
a6c2ba28 | 328 | } |
329 | ||
a3ea4bf9 FS |
330 | /* |
331 | * em25xx_bus_B_send_bytes | |
332 | * write bytes to the i2c device | |
333 | */ | |
334 | static int em25xx_bus_B_send_bytes(struct em28xx *dev, u16 addr, u8 *buf, | |
335 | u16 len) | |
336 | { | |
337 | int ret; | |
338 | ||
339 | if (len < 1 || len > 64) | |
340 | return -EOPNOTSUPP; | |
341 | /* | |
342 | * NOTE: limited by the USB ctrl message constraints | |
343 | * Zero length reads always succeed, even if no device is connected | |
344 | */ | |
345 | ||
346 | /* Set register and write value */ | |
347 | ret = dev->em28xx_write_regs_req(dev, 0x06, addr, buf, len); | |
348 | if (ret != len) { | |
349 | if (ret < 0) { | |
29b05e22 | 350 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
351 | "writing to i2c device at 0x%x failed (error=%i)\n", |
352 | addr, ret); | |
a3ea4bf9 FS |
353 | return ret; |
354 | } else { | |
29b05e22 | 355 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
356 | "%i bytes write to i2c device at 0x%x requested, but %i bytes written\n", |
357 | len, addr, ret); | |
a3ea4bf9 FS |
358 | return -EIO; |
359 | } | |
360 | } | |
361 | /* Check success */ | |
362 | ret = dev->em28xx_read_reg_req(dev, 0x08, 0x0000); | |
363 | /* | |
364 | * NOTE: the only error we've seen so far is | |
365 | * 0x01 when the slave device is not present | |
366 | */ | |
367 | if (!ret) | |
368 | return len; | |
d845fb3a | 369 | else if (ret > 0) { |
ce8591ff | 370 | dprintk(1, "Bus B R08 returned 0x%02x: I2C ACK error\n", ret); |
e63b009d | 371 | return -ENXIO; |
d845fb3a | 372 | } |
a3ea4bf9 FS |
373 | |
374 | return ret; | |
375 | /* | |
376 | * NOTE: With chip types (other chip IDs) which actually don't support | |
377 | * this operation, it seems to succeed ALWAYS ! (even if there is no | |
378 | * slave device or even no second i2c bus provided) | |
379 | */ | |
380 | } | |
381 | ||
382 | /* | |
383 | * em25xx_bus_B_recv_bytes | |
384 | * read bytes from the i2c device | |
385 | */ | |
386 | static int em25xx_bus_B_recv_bytes(struct em28xx *dev, u16 addr, u8 *buf, | |
387 | u16 len) | |
388 | { | |
389 | int ret; | |
390 | ||
391 | if (len < 1 || len > 64) | |
392 | return -EOPNOTSUPP; | |
393 | /* | |
394 | * NOTE: limited by the USB ctrl message constraints | |
395 | * Zero length reads always succeed, even if no device is connected | |
396 | */ | |
397 | ||
398 | /* Read value */ | |
399 | ret = dev->em28xx_read_reg_req_len(dev, 0x06, addr, buf, len); | |
400 | if (ret < 0) { | |
29b05e22 | 401 | dev_warn(&dev->intf->dev, |
ce8591ff MCC |
402 | "reading from i2c device at 0x%x failed (error=%i)\n", |
403 | addr, ret); | |
a3ea4bf9 FS |
404 | return ret; |
405 | } | |
406 | /* | |
407 | * NOTE: some devices with two i2c busses have the bad habit to return 0 | |
408 | * bytes if we are on bus B AND there was no write attempt to the | |
409 | * specified slave address before AND no device is present at the | |
410 | * requested slave address. | |
e63b009d | 411 | * Anyway, the next check will fail with -ENXIO in this case, so avoid |
a3ea4bf9 FS |
412 | * spamming the system log on device probing and do nothing here. |
413 | */ | |
414 | ||
415 | /* Check success */ | |
416 | ret = dev->em28xx_read_reg_req(dev, 0x08, 0x0000); | |
417 | /* | |
418 | * NOTE: the only error we've seen so far is | |
419 | * 0x01 when the slave device is not present | |
420 | */ | |
421 | if (!ret) | |
422 | return len; | |
d845fb3a | 423 | else if (ret > 0) { |
ce8591ff | 424 | dprintk(1, "Bus B R08 returned 0x%02x: I2C ACK error\n", ret); |
e63b009d | 425 | return -ENXIO; |
d845fb3a | 426 | } |
a3ea4bf9 FS |
427 | |
428 | return ret; | |
429 | /* | |
430 | * NOTE: With chip types (other chip IDs) which actually don't support | |
431 | * this operation, it seems to succeed ALWAYS ! (even if there is no | |
432 | * slave device or even no second i2c bus provided) | |
433 | */ | |
434 | } | |
435 | ||
436 | /* | |
437 | * em25xx_bus_B_check_for_device() | |
438 | * check if there is a i2c device at the supplied address | |
439 | */ | |
440 | static int em25xx_bus_B_check_for_device(struct em28xx *dev, u16 addr) | |
441 | { | |
442 | u8 buf; | |
443 | int ret; | |
444 | ||
445 | ret = em25xx_bus_B_recv_bytes(dev, addr, &buf, 1); | |
446 | if (ret < 0) | |
447 | return ret; | |
448 | ||
449 | return 0; | |
450 | /* | |
451 | * NOTE: With chips which do not support this operation, | |
452 | * it seems to succeed ALWAYS ! (even if no device connected) | |
453 | */ | |
454 | } | |
455 | ||
456 | static inline int i2c_check_for_device(struct em28xx_i2c_bus *i2c_bus, u16 addr) | |
457 | { | |
458 | struct em28xx *dev = i2c_bus->dev; | |
459 | int rc = -EOPNOTSUPP; | |
460 | ||
461 | if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX) | |
462 | rc = em28xx_i2c_check_for_device(dev, addr); | |
463 | else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800) | |
464 | rc = em2800_i2c_check_for_device(dev, addr); | |
465 | else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B) | |
466 | rc = em25xx_bus_B_check_for_device(dev, addr); | |
a3ea4bf9 FS |
467 | return rc; |
468 | } | |
469 | ||
470 | static inline int i2c_recv_bytes(struct em28xx_i2c_bus *i2c_bus, | |
471 | struct i2c_msg msg) | |
472 | { | |
473 | struct em28xx *dev = i2c_bus->dev; | |
474 | u16 addr = msg.addr << 1; | |
50f0a9df | 475 | int rc = -EOPNOTSUPP; |
a3ea4bf9 FS |
476 | |
477 | if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX) | |
478 | rc = em28xx_i2c_recv_bytes(dev, addr, msg.buf, msg.len); | |
479 | else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800) | |
480 | rc = em2800_i2c_recv_bytes(dev, addr, msg.buf, msg.len); | |
481 | else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B) | |
482 | rc = em25xx_bus_B_recv_bytes(dev, addr, msg.buf, msg.len); | |
a3ea4bf9 FS |
483 | return rc; |
484 | } | |
485 | ||
486 | static inline int i2c_send_bytes(struct em28xx_i2c_bus *i2c_bus, | |
487 | struct i2c_msg msg, int stop) | |
488 | { | |
489 | struct em28xx *dev = i2c_bus->dev; | |
490 | u16 addr = msg.addr << 1; | |
50f0a9df | 491 | int rc = -EOPNOTSUPP; |
a3ea4bf9 | 492 | |
a3ea4bf9 FS |
493 | if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX) |
494 | rc = em28xx_i2c_send_bytes(dev, addr, msg.buf, msg.len, stop); | |
495 | else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800) | |
496 | rc = em2800_i2c_send_bytes(dev, addr, msg.buf, msg.len); | |
497 | else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B) | |
498 | rc = em25xx_bus_B_send_bytes(dev, addr, msg.buf, msg.len); | |
499 | return rc; | |
500 | } | |
501 | ||
a6c2ba28 | 502 | /* |
3acf2809 | 503 | * em28xx_i2c_xfer() |
a6c2ba28 | 504 | * the main i2c transfer function |
505 | */ | |
3acf2809 | 506 | static int em28xx_i2c_xfer(struct i2c_adapter *i2c_adap, |
a6c2ba28 | 507 | struct i2c_msg msgs[], int num) |
508 | { | |
aab3125c MCC |
509 | struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data; |
510 | struct em28xx *dev = i2c_bus->dev; | |
511 | unsigned bus = i2c_bus->bus; | |
a3ea4bf9 | 512 | int addr, rc, i; |
3190fbee | 513 | u8 reg; |
a6c2ba28 | 514 | |
cc5c5d20 SK |
515 | /* prevent i2c xfer attempts after device is disconnected |
516 | some fe's try to do i2c writes/reads from their release | |
517 | interfaces when called in disconnect path */ | |
518 | if (dev->disconnected) | |
519 | return -ENODEV; | |
520 | ||
e44c153b DC |
521 | if (!rt_mutex_trylock(&dev->i2c_bus_lock)) |
522 | return -EAGAIN; | |
aab3125c MCC |
523 | |
524 | /* Switch I2C bus if needed */ | |
a3ea4bf9 FS |
525 | if (bus != dev->cur_i2c_bus && |
526 | i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX) { | |
aab3125c | 527 | if (bus == 1) |
3190fbee | 528 | reg = EM2874_I2C_SECONDARY_BUS_SELECT; |
aab3125c | 529 | else |
3190fbee MCC |
530 | reg = 0; |
531 | em28xx_write_reg_bits(dev, EM28XX_R06_I2C_CLK, reg, | |
532 | EM2874_I2C_SECONDARY_BUS_SELECT); | |
aab3125c MCC |
533 | dev->cur_i2c_bus = bus; |
534 | } | |
535 | ||
536 | if (num <= 0) { | |
537 | rt_mutex_unlock(&dev->i2c_bus_lock); | |
a6c2ba28 | 538 | return 0; |
aab3125c | 539 | } |
a6c2ba28 | 540 | for (i = 0; i < num; i++) { |
541 | addr = msgs[i].addr << 1; | |
e63b009d MCC |
542 | if (!msgs[i].len) { |
543 | /* | |
544 | * no len: check only for device presence | |
545 | * This code is only called during device probe. | |
546 | */ | |
a3ea4bf9 | 547 | rc = i2c_check_for_device(i2c_bus, addr); |
ce8591ff MCC |
548 | |
549 | if (rc == -ENXIO) | |
550 | rc = -ENODEV; | |
596d92d5 | 551 | } else if (msgs[i].flags & I2C_M_RD) { |
a6c2ba28 | 552 | /* read bytes */ |
a3ea4bf9 | 553 | rc = i2c_recv_bytes(i2c_bus, msgs[i]); |
a6c2ba28 | 554 | } else { |
555 | /* write bytes */ | |
a3ea4bf9 | 556 | rc = i2c_send_bytes(i2c_bus, msgs[i], i == num - 1); |
a6c2ba28 | 557 | } |
ce8591ff MCC |
558 | |
559 | if (rc < 0) | |
560 | goto error; | |
561 | ||
562 | dprintk(2, "%s %s addr=%02x len=%d: %*ph\n", | |
563 | (msgs[i].flags & I2C_M_RD) ? "read" : "write", | |
564 | i == num - 1 ? "stop" : "nonstop", | |
565 | addr, msgs[i].len, | |
566 | msgs[i].len, msgs[i].buf); | |
a6c2ba28 | 567 | } |
568 | ||
aab3125c | 569 | rt_mutex_unlock(&dev->i2c_bus_lock); |
a6c2ba28 | 570 | return num; |
ce8591ff MCC |
571 | |
572 | error: | |
573 | dprintk(2, "%s %s addr=%02x len=%d: %sERROR: %i\n", | |
574 | (msgs[i].flags & I2C_M_RD) ? "read" : "write", | |
575 | i == num - 1 ? "stop" : "nonstop", | |
576 | addr, msgs[i].len, | |
577 | (rc == -ENODEV) ? "no device " : "", | |
578 | rc); | |
579 | ||
580 | rt_mutex_unlock(&dev->i2c_bus_lock); | |
581 | return rc; | |
a6c2ba28 | 582 | } |
583 | ||
fa74aca3 FS |
584 | /* |
585 | * based on linux/sunrpc/svcauth.h and linux/hash.h | |
03910cc3 | 586 | * The original hash function returns a different value, if arch is x86_64 |
fa74aca3 | 587 | * or i386. |
03910cc3 MCC |
588 | */ |
589 | static inline unsigned long em28xx_hash_mem(char *buf, int length, int bits) | |
590 | { | |
591 | unsigned long hash = 0; | |
592 | unsigned long l = 0; | |
593 | int len = 0; | |
594 | unsigned char c; | |
fdf1bc9f | 595 | |
03910cc3 MCC |
596 | do { |
597 | if (len == length) { | |
598 | c = (char)len; | |
599 | len = -1; | |
600 | } else | |
601 | c = *buf++; | |
602 | l = (l << 8) | c; | |
603 | len++; | |
604 | if ((len & (32 / 8 - 1)) == 0) | |
605 | hash = ((hash^l) * 0x9e370001UL); | |
606 | } while (len); | |
607 | ||
608 | return (hash >> (32 - bits)) & 0xffffffffUL; | |
609 | } | |
610 | ||
fa74aca3 FS |
611 | /* |
612 | * Helper function to read data blocks from i2c clients with 8 or 16 bit | |
613 | * address width, 8 bit register width and auto incrementation been activated | |
614 | */ | |
aab3125c MCC |
615 | static int em28xx_i2c_read_block(struct em28xx *dev, unsigned bus, u16 addr, |
616 | bool addr_w16, u16 len, u8 *data) | |
d832c5b2 FS |
617 | { |
618 | int remain = len, rsize, rsize_max, ret; | |
619 | u8 buf[2]; | |
620 | ||
621 | /* Sanity check */ | |
622 | if (addr + remain > (addr_w16 * 0xff00 + 0xff + 1)) | |
623 | return -EINVAL; | |
624 | /* Select address */ | |
625 | buf[0] = addr >> 8; | |
626 | buf[1] = addr & 0xff; | |
aab3125c | 627 | ret = i2c_master_send(&dev->i2c_client[bus], buf + !addr_w16, 1 + addr_w16); |
d832c5b2 FS |
628 | if (ret < 0) |
629 | return ret; | |
630 | /* Read data */ | |
631 | if (dev->board.is_em2800) | |
632 | rsize_max = 4; | |
633 | else | |
634 | rsize_max = 64; | |
635 | while (remain > 0) { | |
636 | if (remain > rsize_max) | |
637 | rsize = rsize_max; | |
638 | else | |
639 | rsize = remain; | |
640 | ||
aab3125c | 641 | ret = i2c_master_recv(&dev->i2c_client[bus], data, rsize); |
d832c5b2 FS |
642 | if (ret < 0) |
643 | return ret; | |
644 | ||
645 | remain -= rsize; | |
646 | data += rsize; | |
647 | } | |
648 | ||
649 | return len; | |
650 | } | |
651 | ||
aab3125c MCC |
652 | static int em28xx_i2c_eeprom(struct em28xx *dev, unsigned bus, |
653 | u8 **eedata, u16 *eedata_len) | |
a6c2ba28 | 654 | { |
510e884c | 655 | const u16 len = 256; |
fa74aca3 FS |
656 | /* |
657 | * FIXME common length/size for bytes to read, to display, hash | |
510e884c | 658 | * calculation and returned device dataset. Simplifies the code a lot, |
fa74aca3 FS |
659 | * but we might have to deal with multiple sizes in the future ! |
660 | */ | |
50f0a9df | 661 | int err; |
510e884c FS |
662 | struct em28xx_eeprom *dev_config; |
663 | u8 buf, *data; | |
a6c2ba28 | 664 | |
a217968f | 665 | *eedata = NULL; |
510e884c | 666 | *eedata_len = 0; |
a217968f | 667 | |
aab3125c MCC |
668 | /* EEPROM is always on i2c bus 0 on all known devices. */ |
669 | ||
670 | dev->i2c_client[bus].addr = 0xa0 >> 1; | |
596d92d5 MCC |
671 | |
672 | /* Check if board has eeprom */ | |
aab3125c | 673 | err = i2c_master_recv(&dev->i2c_client[bus], &buf, 0); |
f2a01a00 | 674 | if (err < 0) { |
29b05e22 | 675 | dev_info(&dev->intf->dev, "board has no eeprom\n"); |
c41109fc | 676 | return -ENODEV; |
f2a01a00 | 677 | } |
596d92d5 | 678 | |
a217968f FS |
679 | data = kzalloc(len, GFP_KERNEL); |
680 | if (data == NULL) | |
681 | return -ENOMEM; | |
682 | ||
d832c5b2 | 683 | /* Read EEPROM content */ |
aab3125c MCC |
684 | err = em28xx_i2c_read_block(dev, bus, 0x0000, |
685 | dev->eeprom_addrwidth_16bit, | |
a217968f | 686 | len, data); |
d832c5b2 | 687 | if (err != len) { |
29b05e22 | 688 | dev_err(&dev->intf->dev, |
ce8591ff | 689 | "failed to read eeprom (err=%d)\n", err); |
510e884c | 690 | goto error; |
a6c2ba28 | 691 | } |
90271964 | 692 | |
50f0a9df MCC |
693 | if (i2c_debug) { |
694 | /* Display eeprom content */ | |
ce8591ff | 695 | print_hex_dump(KERN_DEBUG, "em28xx eeprom ", DUMP_PREFIX_OFFSET, |
50f0a9df MCC |
696 | 16, 1, data, len, true); |
697 | ||
698 | if (dev->eeprom_addrwidth_16bit) | |
29b05e22 | 699 | dev_info(&dev->intf->dev, |
ce8591ff | 700 | "eeprom %06x: ... (skipped)\n", 256); |
a6c2ba28 | 701 | } |
702 | ||
87b52439 | 703 | if (dev->eeprom_addrwidth_16bit && |
a217968f | 704 | data[0] == 0x26 && data[3] == 0x00) { |
87b52439 | 705 | /* new eeprom format; size 4-64kb */ |
510e884c FS |
706 | u16 mc_start; |
707 | u16 hwconf_offset; | |
708 | ||
a217968f | 709 | dev->hash = em28xx_hash_mem(data, len, 32); |
510e884c FS |
710 | mc_start = (data[1] << 8) + 4; /* usually 0x0004 */ |
711 | ||
29b05e22 | 712 | dev_info(&dev->intf->dev, |
ce8591ff MCC |
713 | "EEPROM ID = %02x %02x %02x %02x, EEPROM hash = 0x%08lx\n", |
714 | data[0], data[1], data[2], data[3], dev->hash); | |
29b05e22 | 715 | dev_info(&dev->intf->dev, |
ce8591ff | 716 | "EEPROM info:\n"); |
29b05e22 | 717 | dev_info(&dev->intf->dev, |
ce8591ff MCC |
718 | "\tmicrocode start address = 0x%04x, boot configuration = 0x%02x\n", |
719 | mc_start, data[2]); | |
fa74aca3 FS |
720 | /* |
721 | * boot configuration (address 0x0002): | |
87b52439 FS |
722 | * [0] microcode download speed: 1 = 400 kHz; 0 = 100 kHz |
723 | * [1] always selects 12 kb RAM | |
724 | * [2] USB device speed: 1 = force Full Speed; 0 = auto detect | |
725 | * [4] 1 = force fast mode and no suspend for device testing | |
726 | * [5:7] USB PHY tuning registers; determined by device | |
727 | * characterization | |
728 | */ | |
729 | ||
fa74aca3 FS |
730 | /* |
731 | * Read hardware config dataset offset from address | |
732 | * (microcode start + 46) | |
733 | */ | |
aab3125c MCC |
734 | err = em28xx_i2c_read_block(dev, bus, mc_start + 46, 1, 2, |
735 | data); | |
510e884c | 736 | if (err != 2) { |
29b05e22 | 737 | dev_err(&dev->intf->dev, |
ce8591ff MCC |
738 | "failed to read hardware configuration data from eeprom (err=%d)\n", |
739 | err); | |
510e884c FS |
740 | goto error; |
741 | } | |
742 | ||
743 | /* Calculate hardware config dataset start address */ | |
744 | hwconf_offset = mc_start + data[0] + (data[1] << 8); | |
745 | ||
746 | /* Read hardware config dataset */ | |
fa74aca3 FS |
747 | /* |
748 | * NOTE: the microcode copy can be multiple pages long, but | |
510e884c FS |
749 | * we assume the hardware config dataset is the same as in |
750 | * the old eeprom and not longer than 256 bytes. | |
751 | * tveeprom is currently also limited to 256 bytes. | |
87b52439 | 752 | */ |
aab3125c MCC |
753 | err = em28xx_i2c_read_block(dev, bus, hwconf_offset, 1, len, |
754 | data); | |
510e884c | 755 | if (err != len) { |
29b05e22 | 756 | dev_err(&dev->intf->dev, |
ce8591ff MCC |
757 | "failed to read hardware configuration data from eeprom (err=%d)\n", |
758 | err); | |
510e884c FS |
759 | goto error; |
760 | } | |
87b52439 | 761 | |
510e884c FS |
762 | /* Verify hardware config dataset */ |
763 | /* NOTE: not all devices provide this type of dataset */ | |
764 | if (data[0] != 0x1a || data[1] != 0xeb || | |
765 | data[2] != 0x67 || data[3] != 0x95) { | |
29b05e22 | 766 | dev_info(&dev->intf->dev, |
ce8591ff | 767 | "\tno hardware configuration dataset found in eeprom\n"); |
510e884c FS |
768 | kfree(data); |
769 | return 0; | |
770 | } | |
771 | ||
772 | /* TODO: decrypt eeprom data for camera bridges (em25xx, em276x+) */ | |
773 | ||
774 | } else if (!dev->eeprom_addrwidth_16bit && | |
775 | data[0] == 0x1a && data[1] == 0xeb && | |
776 | data[2] == 0x67 && data[3] == 0x95) { | |
777 | dev->hash = em28xx_hash_mem(data, len, 32); | |
29b05e22 | 778 | dev_info(&dev->intf->dev, |
ce8591ff MCC |
779 | "EEPROM ID = %02x %02x %02x %02x, EEPROM hash = 0x%08lx\n", |
780 | data[0], data[1], data[2], data[3], dev->hash); | |
29b05e22 | 781 | dev_info(&dev->intf->dev, |
ce8591ff | 782 | "EEPROM info:\n"); |
510e884c | 783 | } else { |
29b05e22 | 784 | dev_info(&dev->intf->dev, |
ce8591ff | 785 | "unknown eeprom format or eeprom corrupted !\n"); |
510e884c FS |
786 | err = -ENODEV; |
787 | goto error; | |
f55eacbe FS |
788 | } |
789 | ||
a217968f | 790 | *eedata = data; |
510e884c | 791 | *eedata_len = len; |
32bf7c6c | 792 | dev_config = (void *)*eedata; |
a217968f | 793 | |
510e884c | 794 | switch (le16_to_cpu(dev_config->chip_conf) >> 4 & 0x3) { |
a6c2ba28 | 795 | case 0: |
29b05e22 | 796 | dev_info(&dev->intf->dev, "\tNo audio on board.\n"); |
a6c2ba28 | 797 | break; |
798 | case 1: | |
29b05e22 | 799 | dev_info(&dev->intf->dev, "\tAC97 audio (5 sample rates)\n"); |
a6c2ba28 | 800 | break; |
801 | case 2: | |
687ff8b0 | 802 | if (dev->chip_id < CHIP_ID_EM2860) |
29b05e22 | 803 | dev_info(&dev->intf->dev, |
ce8591ff | 804 | "\tI2S audio, sample rate=32k\n"); |
687ff8b0 | 805 | else |
29b05e22 | 806 | dev_info(&dev->intf->dev, |
ce8591ff | 807 | "\tI2S audio, 3 sample rates\n"); |
a6c2ba28 | 808 | break; |
809 | case 3: | |
687ff8b0 | 810 | if (dev->chip_id < CHIP_ID_EM2860) |
29b05e22 | 811 | dev_info(&dev->intf->dev, |
ce8591ff | 812 | "\tI2S audio, 3 sample rates\n"); |
687ff8b0 | 813 | else |
29b05e22 | 814 | dev_info(&dev->intf->dev, |
ce8591ff | 815 | "\tI2S audio, 5 sample rates\n"); |
a6c2ba28 | 816 | break; |
817 | } | |
818 | ||
510e884c | 819 | if (le16_to_cpu(dev_config->chip_conf) & 1 << 3) |
29b05e22 | 820 | dev_info(&dev->intf->dev, "\tUSB Remote wakeup capable\n"); |
a6c2ba28 | 821 | |
510e884c | 822 | if (le16_to_cpu(dev_config->chip_conf) & 1 << 2) |
29b05e22 | 823 | dev_info(&dev->intf->dev, "\tUSB Self power capable\n"); |
a6c2ba28 | 824 | |
510e884c | 825 | switch (le16_to_cpu(dev_config->chip_conf) & 0x3) { |
a6c2ba28 | 826 | case 0: |
29b05e22 | 827 | dev_info(&dev->intf->dev, "\t500mA max power\n"); |
a6c2ba28 | 828 | break; |
829 | case 1: | |
29b05e22 | 830 | dev_info(&dev->intf->dev, "\t400mA max power\n"); |
a6c2ba28 | 831 | break; |
832 | case 2: | |
29b05e22 | 833 | dev_info(&dev->intf->dev, "\t300mA max power\n"); |
a6c2ba28 | 834 | break; |
835 | case 3: | |
29b05e22 | 836 | dev_info(&dev->intf->dev, "\t200mA max power\n"); |
a6c2ba28 | 837 | break; |
838 | } | |
29b05e22 | 839 | dev_info(&dev->intf->dev, |
ce8591ff MCC |
840 | "\tTable at offset 0x%02x, strings=0x%04x, 0x%04x, 0x%04x\n", |
841 | dev_config->string_idx_table, | |
842 | le16_to_cpu(dev_config->string1), | |
843 | le16_to_cpu(dev_config->string2), | |
844 | le16_to_cpu(dev_config->string3)); | |
a6c2ba28 | 845 | |
846 | return 0; | |
510e884c FS |
847 | |
848 | error: | |
849 | kfree(data); | |
850 | return err; | |
a6c2ba28 | 851 | } |
852 | ||
853 | /* ----------------------------------------------------------- */ | |
854 | ||
a6c2ba28 | 855 | /* |
856 | * functionality() | |
857 | */ | |
aab3125c | 858 | static u32 functionality(struct i2c_adapter *i2c_adap) |
a6c2ba28 | 859 | { |
aab3125c | 860 | struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data; |
aab3125c | 861 | |
a3ea4bf9 FS |
862 | if ((i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX) || |
863 | (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B)) { | |
864 | return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL; | |
865 | } else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800) { | |
866 | return (I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL) & | |
867 | ~I2C_FUNC_SMBUS_WRITE_BLOCK_DATA; | |
868 | } | |
869 | ||
870 | WARN(1, "Unknown i2c bus algorithm.\n"); | |
871 | return 0; | |
a6c2ba28 | 872 | } |
873 | ||
78f2c50b | 874 | static const struct i2c_algorithm em28xx_algo = { |
3acf2809 | 875 | .master_xfer = em28xx_i2c_xfer, |
a6c2ba28 | 876 | .functionality = functionality, |
877 | }; | |
878 | ||
3acf2809 | 879 | static struct i2c_adapter em28xx_adap_template = { |
a6c2ba28 | 880 | .owner = THIS_MODULE, |
3acf2809 | 881 | .name = "em28xx", |
3acf2809 | 882 | .algo = &em28xx_algo, |
a6c2ba28 | 883 | }; |
884 | ||
3acf2809 MCC |
885 | static struct i2c_client em28xx_client_template = { |
886 | .name = "em28xx internal", | |
a6c2ba28 | 887 | }; |
888 | ||
889 | /* ----------------------------------------------------------- */ | |
890 | ||
891 | /* | |
892 | * i2c_devs | |
893 | * incomplete list of known devices | |
894 | */ | |
895 | static char *i2c_devs[128] = { | |
9aa785b1 | 896 | [0x1c >> 1] = "lgdt330x", |
0b3966e4 | 897 | [0x3e >> 1] = "remote IR sensor", |
a6c2ba28 | 898 | [0x4a >> 1] = "saa7113h", |
729841ed | 899 | [0x52 >> 1] = "drxk", |
a6c2ba28 | 900 | [0x60 >> 1] = "remote IR sensor", |
da45a2a5 | 901 | [0x8e >> 1] = "remote IR sensor", |
a6c2ba28 | 902 | [0x86 >> 1] = "tda9887", |
903 | [0x80 >> 1] = "msp34xx", | |
904 | [0x88 >> 1] = "msp34xx", | |
905 | [0xa0 >> 1] = "eeprom", | |
2bd1d9eb | 906 | [0xb0 >> 1] = "tda9874", |
a6c2ba28 | 907 | [0xb8 >> 1] = "tvp5150a", |
791a08fc | 908 | [0xba >> 1] = "webcam sensor or tvp5150a", |
a6c2ba28 | 909 | [0xc0 >> 1] = "tuner (analog)", |
910 | [0xc2 >> 1] = "tuner (analog)", | |
911 | [0xc4 >> 1] = "tuner (analog)", | |
912 | [0xc6 >> 1] = "tuner (analog)", | |
913 | }; | |
914 | ||
915 | /* | |
916 | * do_i2c_scan() | |
917 | * check i2c address range for devices | |
918 | */ | |
aab3125c | 919 | void em28xx_do_i2c_scan(struct em28xx *dev, unsigned bus) |
a6c2ba28 | 920 | { |
fad7b958 | 921 | u8 i2c_devicelist[128]; |
a6c2ba28 | 922 | unsigned char buf; |
923 | int i, rc; | |
924 | ||
fad7b958 SS |
925 | memset(i2c_devicelist, 0, ARRAY_SIZE(i2c_devicelist)); |
926 | ||
53c4e955 | 927 | for (i = 0; i < ARRAY_SIZE(i2c_devs); i++) { |
aab3125c MCC |
928 | dev->i2c_client[bus].addr = i; |
929 | rc = i2c_master_recv(&dev->i2c_client[bus], &buf, 0); | |
a6c2ba28 | 930 | if (rc < 0) |
931 | continue; | |
fad7b958 | 932 | i2c_devicelist[i] = i; |
29b05e22 | 933 | dev_info(&dev->intf->dev, |
ce8591ff MCC |
934 | "found i2c device @ 0x%x on bus %d [%s]\n", |
935 | i << 1, bus, i2c_devs[i] ? i2c_devs[i] : "???"); | |
a6c2ba28 | 936 | } |
fad7b958 | 937 | |
aab3125c MCC |
938 | if (bus == dev->def_i2c_bus) |
939 | dev->i2c_hash = em28xx_hash_mem(i2c_devicelist, | |
940 | ARRAY_SIZE(i2c_devicelist), 32); | |
a6c2ba28 | 941 | } |
942 | ||
a6c2ba28 | 943 | /* |
3acf2809 | 944 | * em28xx_i2c_register() |
a6c2ba28 | 945 | * register i2c bus |
946 | */ | |
a3ea4bf9 FS |
947 | int em28xx_i2c_register(struct em28xx *dev, unsigned bus, |
948 | enum em28xx_i2c_algo_type algo_type) | |
a6c2ba28 | 949 | { |
f2a01a00 DSL |
950 | int retval; |
951 | ||
3acf2809 MCC |
952 | BUG_ON(!dev->em28xx_write_regs || !dev->em28xx_read_reg); |
953 | BUG_ON(!dev->em28xx_write_regs_req || !dev->em28xx_read_reg_req); | |
f2a01a00 | 954 | |
aab3125c MCC |
955 | if (bus >= NUM_I2C_BUSES) |
956 | return -ENODEV; | |
957 | ||
958 | dev->i2c_adap[bus] = em28xx_adap_template; | |
29b05e22 MCC |
959 | dev->i2c_adap[bus].dev.parent = &dev->intf->dev; |
960 | strcpy(dev->i2c_adap[bus].name, dev_name(&dev->intf->dev)); | |
aab3125c MCC |
961 | |
962 | dev->i2c_bus[bus].bus = bus; | |
a3ea4bf9 | 963 | dev->i2c_bus[bus].algo_type = algo_type; |
aab3125c MCC |
964 | dev->i2c_bus[bus].dev = dev; |
965 | dev->i2c_adap[bus].algo_data = &dev->i2c_bus[bus]; | |
aab3125c MCC |
966 | |
967 | retval = i2c_add_adapter(&dev->i2c_adap[bus]); | |
f2a01a00 | 968 | if (retval < 0) { |
29b05e22 | 969 | dev_err(&dev->intf->dev, |
ce8591ff MCC |
970 | "%s: i2c_add_adapter failed! retval [%d]\n", |
971 | __func__, retval); | |
f2a01a00 DSL |
972 | return retval; |
973 | } | |
a6c2ba28 | 974 | |
aab3125c MCC |
975 | dev->i2c_client[bus] = em28xx_client_template; |
976 | dev->i2c_client[bus].adapter = &dev->i2c_adap[bus]; | |
a6c2ba28 | 977 | |
aab3125c MCC |
978 | /* Up to now, all eeproms are at bus 0 */ |
979 | if (!bus) { | |
980 | retval = em28xx_i2c_eeprom(dev, bus, &dev->eedata, &dev->eedata_len); | |
981 | if ((retval < 0) && (retval != -ENODEV)) { | |
29b05e22 | 982 | dev_err(&dev->intf->dev, |
ce8591ff MCC |
983 | "%s: em28xx_i2_eeprom failed! retval [%d]\n", |
984 | __func__, retval); | |
aab3125c | 985 | } |
f2a01a00 | 986 | } |
a6c2ba28 | 987 | |
988 | if (i2c_scan) | |
aab3125c | 989 | em28xx_do_i2c_scan(dev, bus); |
c41109fc | 990 | |
a6c2ba28 | 991 | return 0; |
992 | } | |
993 | ||
994 | /* | |
3acf2809 | 995 | * em28xx_i2c_unregister() |
a6c2ba28 | 996 | * unregister i2c_bus |
997 | */ | |
aab3125c | 998 | int em28xx_i2c_unregister(struct em28xx *dev, unsigned bus) |
a6c2ba28 | 999 | { |
aab3125c MCC |
1000 | if (bus >= NUM_I2C_BUSES) |
1001 | return -ENODEV; | |
1002 | ||
1003 | i2c_del_adapter(&dev->i2c_adap[bus]); | |
a6c2ba28 | 1004 | return 0; |
1005 | } |