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