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 <linux/module.h>
26#include <linux/kernel.h>
27#include <linux/usb.h>
28#include <linux/i2c.h>
29
30#include "em28xx.h"
31#include "tuner-xc2028.h"
32#include <media/v4l2-common.h>
33#include <media/tuner.h>
34
35
36
37static unsigned int i2c_scan;
38module_param(i2c_scan, int, 0444);
39MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time");
40
41static unsigned int i2c_debug;
42module_param(i2c_debug, int, 0644);
43MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");
44
45
46
47
48
49static int em2800_i2c_send_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len)
50{
51 int ret;
52 int write_timeout;
53 u8 b2[6];
54
55 if (len < 1 || len > 4)
56 return -EOPNOTSUPP;
57
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
69
70 ret = dev->em28xx_write_regs(dev, 4 - len, &b2[4 - len], 2 + len);
71 if (ret != 2 + len) {
72 em28xx_warn("failed to trigger write to i2c address 0x%x (error=%i)\n",
73 addr, ret);
74 return (ret < 0) ? ret : -EIO;
75 }
76
77 for (write_timeout = EM2800_I2C_XFER_TIMEOUT; write_timeout > 0;
78 write_timeout -= 5) {
79 ret = dev->em28xx_read_reg(dev, 0x05);
80 if (ret == 0x80 + len - 1) {
81 return len;
82 } else if (ret == 0x94 + len - 1) {
83 return -ENODEV;
84 } else if (ret < 0) {
85 em28xx_warn("failed to get i2c transfer status from bridge register (error=%i)\n",
86 ret);
87 return ret;
88 }
89 msleep(5);
90 }
91 em28xx_warn("write to i2c device at 0x%x timed out\n", addr);
92 return -EIO;
93}
94
95
96
97
98
99static int em2800_i2c_recv_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len)
100{
101 u8 buf2[4];
102 int ret;
103 int read_timeout;
104 int i;
105
106 if (len < 1 || len > 4)
107 return -EOPNOTSUPP;
108
109
110 buf2[1] = 0x84 + len - 1;
111 buf2[0] = addr;
112 ret = dev->em28xx_write_regs(dev, 0x04, buf2, 2);
113 if (ret != 2) {
114 em28xx_warn("failed to trigger read from i2c address 0x%x (error=%i)\n",
115 addr, ret);
116 return (ret < 0) ? ret : -EIO;
117 }
118
119
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) {
126 return -ENODEV;
127 } else if (ret < 0) {
128 em28xx_warn("failed to get i2c transfer status from bridge register (error=%i)\n",
129 ret);
130 return ret;
131 }
132 msleep(5);
133 }
134 if (ret != 0x84 + len - 1)
135 em28xx_warn("read from i2c device at 0x%x timed out\n", addr);
136
137
138 ret = dev->em28xx_read_reg_req_len(dev, 0x00, 4-len, buf2, len);
139 if (ret != len) {
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);
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;
148}
149
150
151
152
153
154static int em2800_i2c_check_for_device(struct em28xx *dev, u8 addr)
155{
156 u8 buf;
157 int ret;
158
159 ret = em2800_i2c_recv_bytes(dev, addr, &buf, 1);
160 if (ret == 1)
161 return 0;
162 return (ret < 0) ? ret : -EIO;
163}
164
165
166
167
168static int em28xx_i2c_send_bytes(struct em28xx *dev, u16 addr, u8 *buf,
169 u16 len, int stop)
170{
171 int write_timeout, ret;
172
173 if (len < 1 || len > 64)
174 return -EOPNOTSUPP;
175
176
177
178
179
180
181 ret = dev->em28xx_write_regs_req(dev, stop ? 2 : 3, addr, buf, len);
182 if (ret != len) {
183 if (ret < 0) {
184 em28xx_warn("writing to i2c device at 0x%x failed (error=%i)\n",
185 addr, ret);
186 return ret;
187 } else {
188 em28xx_warn("%i bytes write to i2c device at 0x%x requested, but %i bytes written\n",
189 len, addr, ret);
190 return -EIO;
191 }
192 }
193
194
195 for (write_timeout = EM2800_I2C_XFER_TIMEOUT; write_timeout > 0;
196 write_timeout -= 5) {
197 ret = dev->em28xx_read_reg(dev, 0x05);
198 if (ret == 0) {
199 return len;
200 } else if (ret == 0x10) {
201 return -ENODEV;
202 } else if (ret < 0) {
203 em28xx_warn("failed to read i2c transfer status from bridge (error=%i)\n",
204 ret);
205 return ret;
206 }
207 msleep(5);
208
209
210
211
212
213 }
214 em28xx_warn("write to i2c device at 0x%x timed out\n", addr);
215 return -EIO;
216}
217
218
219
220
221
222static int em28xx_i2c_recv_bytes(struct em28xx *dev, u16 addr, u8 *buf, u16 len)
223{
224 int ret;
225
226 if (len < 1 || len > 64)
227 return -EOPNOTSUPP;
228
229
230
231
232
233
234 ret = dev->em28xx_read_reg_req_len(dev, 2, addr, buf, len);
235 if (ret < 0) {
236 em28xx_warn("reading from i2c device at 0x%x failed (error=%i)\n",
237 addr, ret);
238 return ret;
239 }
240
241
242
243
244
245
246
247
248
249
250 ret = dev->em28xx_read_reg(dev, 0x05);
251 if (ret < 0) {
252 em28xx_warn("failed to read i2c transfer status from bridge (error=%i)\n",
253 ret);
254 return ret;
255 }
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;
265}
266
267
268
269
270
271static int em28xx_i2c_check_for_device(struct em28xx *dev, u16 addr)
272{
273 int ret;
274 u8 buf;
275
276 ret = em28xx_i2c_recv_bytes(dev, addr, &buf, 1);
277 if (ret == 1)
278 return 0;
279 return (ret < 0) ? ret : -EIO;
280}
281
282
283
284
285
286static 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
295
296
297
298
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
312 ret = dev->em28xx_read_reg_req(dev, 0x08, 0x0000);
313
314
315
316
317 if (!ret)
318 return len;
319 else if (ret > 0)
320 return -ENODEV;
321
322 return ret;
323
324
325
326
327
328}
329
330
331
332
333
334static 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
343
344
345
346
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
355
356
357
358
359
360
361
362
363 ret = dev->em28xx_read_reg_req(dev, 0x08, 0x0000);
364
365
366
367
368 if (!ret)
369 return len;
370 else if (ret > 0)
371 return -ENODEV;
372
373 return ret;
374
375
376
377
378
379}
380
381
382
383
384
385static 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
397
398
399}
400
401static 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
419static 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
439static 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
459
460
461
462
463static int em28xx_i2c_xfer(struct i2c_adapter *i2c_adap,
464 struct i2c_msg msgs[], int num)
465{
466 struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data;
467 struct em28xx *dev = i2c_bus->dev;
468 unsigned bus = i2c_bus->bus;
469 int addr, rc, i;
470 u8 reg;
471
472 rc = rt_mutex_trylock(&dev->i2c_bus_lock);
473 if (rc < 0)
474 return rc;
475
476
477 if (bus != dev->cur_i2c_bus &&
478 i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX) {
479 if (bus == 1)
480 reg = EM2874_I2C_SECONDARY_BUS_SELECT;
481 else
482 reg = 0;
483 em28xx_write_reg_bits(dev, EM28XX_R06_I2C_CLK, reg,
484 EM2874_I2C_SECONDARY_BUS_SELECT);
485 dev->cur_i2c_bus = bus;
486 }
487
488 if (num <= 0) {
489 rt_mutex_unlock(&dev->i2c_bus_lock);
490 return 0;
491 }
492 for (i = 0; i < num; i++) {
493 addr = msgs[i].addr << 1;
494 if (i2c_debug)
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);
500 if (!msgs[i].len) {
501 rc = i2c_check_for_device(i2c_bus, addr);
502 if (rc == -ENODEV) {
503 rt_mutex_unlock(&dev->i2c_bus_lock);
504 return rc;
505 }
506 } else if (msgs[i].flags & I2C_M_RD) {
507
508 rc = i2c_recv_bytes(i2c_bus, msgs[i]);
509 } else {
510
511 rc = i2c_send_bytes(i2c_bus, msgs[i], i == num - 1);
512 }
513 if (rc < 0) {
514 if (i2c_debug)
515 printk(" ERROR: %i\n", rc);
516 rt_mutex_unlock(&dev->i2c_bus_lock);
517 return rc;
518 }
519 if (i2c_debug)
520 printk("\n");
521 }
522
523 rt_mutex_unlock(&dev->i2c_bus_lock);
524 return num;
525}
526
527
528
529
530
531
532static 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
553
554
555
556
557static int em28xx_i2c_read_block(struct em28xx *dev, unsigned bus, u16 addr,
558 bool addr_w16, u16 len, u8 *data)
559{
560 int remain = len, rsize, rsize_max, ret;
561 u8 buf[2];
562
563
564 if (addr + remain > (addr_w16 * 0xff00 + 0xff + 1))
565 return -EINVAL;
566
567 buf[0] = addr >> 8;
568 buf[1] = addr & 0xff;
569 ret = i2c_master_send(&dev->i2c_client[bus], buf + !addr_w16, 1 + addr_w16);
570 if (ret < 0)
571 return ret;
572
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
583 ret = i2c_master_recv(&dev->i2c_client[bus], data, rsize);
584 if (ret < 0)
585 return ret;
586
587 remain -= rsize;
588 data += rsize;
589 }
590
591 return len;
592}
593
594static int em28xx_i2c_eeprom(struct em28xx *dev, unsigned bus,
595 u8 **eedata, u16 *eedata_len)
596{
597 const u16 len = 256;
598
599
600
601
602
603 int i, err;
604 struct em28xx_eeprom *dev_config;
605 u8 buf, *data;
606
607 *eedata = NULL;
608 *eedata_len = 0;
609
610
611
612 dev->i2c_client[bus].addr = 0xa0 >> 1;
613
614
615 err = i2c_master_recv(&dev->i2c_client[bus], &buf, 0);
616 if (err < 0) {
617 em28xx_info("board has no eeprom\n");
618 return -ENODEV;
619 }
620
621 data = kzalloc(len, GFP_KERNEL);
622 if (data == NULL)
623 return -ENOMEM;
624
625
626 err = em28xx_i2c_read_block(dev, bus, 0x0000,
627 dev->eeprom_addrwidth_16bit,
628 len, data);
629 if (err != len) {
630 em28xx_errdev("failed to read eeprom (err=%d)\n", err);
631 goto error;
632 }
633
634
635 for (i = 0; i < len; i++) {
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 }
642 printk(" %02x", data[i]);
643 if (15 == (i % 16))
644 printk("\n");
645 }
646 if (dev->eeprom_addrwidth_16bit)
647 em28xx_info("i2c eeprom %04x: ... (skipped)\n", i);
648
649 if (dev->eeprom_addrwidth_16bit &&
650 data[0] == 0x26 && data[3] == 0x00) {
651
652 u16 mc_start;
653 u16 hwconf_offset;
654
655 dev->hash = em28xx_hash_mem(data, len, 32);
656 mc_start = (data[1] << 8) + 4;
657
658 em28xx_info("EEPROM ID = %02x %02x %02x %02x, EEPROM hash = 0x%08lx\n",
659 data[0], data[1], data[2], data[3], dev->hash);
660 em28xx_info("EEPROM info:\n");
661 em28xx_info("\tmicrocode start address = 0x%04x, boot configuration = 0x%02x\n",
662 mc_start, data[2]);
663
664
665
666
667
668
669
670
671
672
673
674
675
676
677 err = em28xx_i2c_read_block(dev, bus, mc_start + 46, 1, 2,
678 data);
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
686 hwconf_offset = mc_start + data[0] + (data[1] << 8);
687
688
689
690
691
692
693
694
695 err = em28xx_i2c_read_block(dev, bus, hwconf_offset, 1, len,
696 data);
697 if (err != len) {
698 em28xx_errdev("failed to read hardware configuration data from eeprom (err=%d)\n",
699 err);
700 goto error;
701 }
702
703
704
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
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);
718 em28xx_info("EEPROM ID = %02x %02x %02x %02x, EEPROM hash = 0x%08lx\n",
719 data[0], data[1], data[2], data[3], dev->hash);
720 em28xx_info("EEPROM info:\n");
721 } else {
722 em28xx_info("unknown eeprom format or eeprom corrupted !\n");
723 err = -ENODEV;
724 goto error;
725 }
726
727 *eedata = data;
728 *eedata_len = len;
729 dev_config = (void *)eedata;
730
731 switch (le16_to_cpu(dev_config->chip_conf) >> 4 & 0x3) {
732 case 0:
733 em28xx_info("\tNo audio on board.\n");
734 break;
735 case 1:
736 em28xx_info("\tAC97 audio (5 sample rates)\n");
737 break;
738 case 2:
739 em28xx_info("\tI2S audio, sample rate=32k\n");
740 break;
741 case 3:
742 em28xx_info("\tI2S audio, 3 sample rates\n");
743 break;
744 }
745
746 if (le16_to_cpu(dev_config->chip_conf) & 1 << 3)
747 em28xx_info("\tUSB Remote wakeup capable\n");
748
749 if (le16_to_cpu(dev_config->chip_conf) & 1 << 2)
750 em28xx_info("\tUSB Self power capable\n");
751
752 switch (le16_to_cpu(dev_config->chip_conf) & 0x3) {
753 case 0:
754 em28xx_info("\t500mA max power\n");
755 break;
756 case 1:
757 em28xx_info("\t400mA max power\n");
758 break;
759 case 2:
760 em28xx_info("\t300mA max power\n");
761 break;
762 case 3:
763 em28xx_info("\t200mA max power\n");
764 break;
765 }
766 em28xx_info("\tTable at offset 0x%02x, strings=0x%04x, 0x%04x, 0x%04x\n",
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));
771
772 return 0;
773
774error:
775 kfree(data);
776 return err;
777}
778
779
780
781
782
783
784static u32 functionality(struct i2c_adapter *i2c_adap)
785{
786 struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data;
787
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;
798}
799
800static struct i2c_algorithm em28xx_algo = {
801 .master_xfer = em28xx_i2c_xfer,
802 .functionality = functionality,
803};
804
805static struct i2c_adapter em28xx_adap_template = {
806 .owner = THIS_MODULE,
807 .name = "em28xx",
808 .algo = &em28xx_algo,
809};
810
811static struct i2c_client em28xx_client_template = {
812 .name = "em28xx internal",
813};
814
815
816
817
818
819
820
821static char *i2c_devs[128] = {
822 [0x3e >> 1] = "remote IR sensor",
823 [0x4a >> 1] = "saa7113h",
824 [0x52 >> 1] = "drxk",
825 [0x60 >> 1] = "remote IR sensor",
826 [0x8e >> 1] = "remote IR sensor",
827 [0x86 >> 1] = "tda9887",
828 [0x80 >> 1] = "msp34xx",
829 [0x88 >> 1] = "msp34xx",
830 [0xa0 >> 1] = "eeprom",
831 [0xb0 >> 1] = "tda9874",
832 [0xb8 >> 1] = "tvp5150a",
833 [0xba >> 1] = "webcam sensor or tvp5150a",
834 [0xc0 >> 1] = "tuner (analog)",
835 [0xc2 >> 1] = "tuner (analog)",
836 [0xc4 >> 1] = "tuner (analog)",
837 [0xc6 >> 1] = "tuner (analog)",
838};
839
840
841
842
843
844void em28xx_do_i2c_scan(struct em28xx *dev, unsigned bus)
845{
846 u8 i2c_devicelist[128];
847 unsigned char buf;
848 int i, rc;
849
850 memset(i2c_devicelist, 0, ARRAY_SIZE(i2c_devicelist));
851
852 for (i = 0; i < ARRAY_SIZE(i2c_devs); i++) {
853 dev->i2c_client[bus].addr = i;
854 rc = i2c_master_recv(&dev->i2c_client[bus], &buf, 0);
855 if (rc < 0)
856 continue;
857 i2c_devicelist[i] = i;
858 em28xx_info("found i2c device @ 0x%x on bus %d [%s]\n",
859 i << 1, bus, i2c_devs[i] ? i2c_devs[i] : "???");
860 }
861
862 if (bus == dev->def_i2c_bus)
863 dev->i2c_hash = em28xx_hash_mem(i2c_devicelist,
864 ARRAY_SIZE(i2c_devicelist), 32);
865}
866
867
868
869
870
871int em28xx_i2c_register(struct em28xx *dev, unsigned bus,
872 enum em28xx_i2c_algo_type algo_type)
873{
874 int retval;
875
876 BUG_ON(!dev->em28xx_write_regs || !dev->em28xx_read_reg);
877 BUG_ON(!dev->em28xx_write_regs_req || !dev->em28xx_read_reg_req);
878
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;
887 dev->i2c_bus[bus].algo_type = algo_type;
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]);
893 if (retval < 0) {
894 em28xx_errdev("%s: i2c_add_adapter failed! retval [%d]\n",
895 __func__, retval);
896 return retval;
897 }
898
899 dev->i2c_client[bus] = em28xx_client_template;
900 dev->i2c_client[bus].adapter = &dev->i2c_adap[bus];
901
902
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);
908
909 return retval;
910 }
911 }
912
913 if (i2c_scan)
914 em28xx_do_i2c_scan(dev, bus);
915
916 return 0;
917}
918
919
920
921
922
923int em28xx_i2c_unregister(struct em28xx *dev, unsigned bus)
924{
925 if (bus >= NUM_I2C_BUSES)
926 return -ENODEV;
927
928 i2c_del_adapter(&dev->i2c_adap[bus]);
929 return 0;
930}
931