xref: /openbmc/linux/drivers/media/usb/em28xx/em28xx-i2c.c (revision 1970105af093f2fbbc5578640075ca843575c934)
1f22e9e71SMauro Carvalho Chehab // SPDX-License-Identifier: GPL-2.0+
2f22e9e71SMauro Carvalho Chehab //
3f22e9e71SMauro Carvalho Chehab // em28xx-i2c.c - driver for Empia EM2800/EM2820/2840 USB video capture devices
4f22e9e71SMauro Carvalho Chehab //
5f22e9e71SMauro Carvalho Chehab // Copyright (C) 2005 Ludovico Cavedon <cavedon@sssup.it>
6f22e9e71SMauro Carvalho Chehab //		      Markus Rechberger <mrechberger@gmail.com>
732590819SMauro Carvalho Chehab //		      Mauro Carvalho Chehab <mchehab@kernel.org>
8f22e9e71SMauro Carvalho Chehab //		      Sascha Sommer <saschasommer@freenet.de>
9f22e9e71SMauro Carvalho Chehab // Copyright (C) 2013 Frank Schäfer <fschaefer.oss@googlemail.com>
10f22e9e71SMauro Carvalho Chehab //
11f22e9e71SMauro Carvalho Chehab // This program is free software; you can redistribute it and/or modify
12f22e9e71SMauro Carvalho Chehab // it under the terms of the GNU General Public License as published by
13f22e9e71SMauro Carvalho Chehab // the Free Software Foundation; either version 2 of the License, or
14f22e9e71SMauro Carvalho Chehab // (at your option) any later version.
15f22e9e71SMauro Carvalho Chehab //
16f22e9e71SMauro Carvalho Chehab // This program is distributed in the hope that it will be useful,
17f22e9e71SMauro Carvalho Chehab // but WITHOUT ANY WARRANTY; without even the implied warranty of
18f22e9e71SMauro Carvalho Chehab // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
19f22e9e71SMauro Carvalho Chehab // GNU General Public License for more details.
200c0d06caSMauro Carvalho Chehab 
218314d402SMauro Carvalho Chehab #include "em28xx.h"
228314d402SMauro Carvalho Chehab 
230c0d06caSMauro Carvalho Chehab #include <linux/module.h>
240c0d06caSMauro Carvalho Chehab #include <linux/kernel.h>
250c0d06caSMauro Carvalho Chehab #include <linux/usb.h>
260c0d06caSMauro Carvalho Chehab #include <linux/i2c.h>
274b83626aSMauro Carvalho Chehab #include <linux/jiffies.h>
280c0d06caSMauro Carvalho Chehab 
290c0d06caSMauro Carvalho Chehab #include "tuner-xc2028.h"
300c0d06caSMauro Carvalho Chehab #include <media/v4l2-common.h>
310c0d06caSMauro Carvalho Chehab #include <media/tuner.h>
320c0d06caSMauro Carvalho Chehab 
330c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */
340c0d06caSMauro Carvalho Chehab 
350c0d06caSMauro Carvalho Chehab static unsigned int i2c_scan;
360c0d06caSMauro Carvalho Chehab module_param(i2c_scan, int, 0444);
370c0d06caSMauro Carvalho Chehab MODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time");
380c0d06caSMauro Carvalho Chehab 
390c0d06caSMauro Carvalho Chehab static unsigned int i2c_debug;
400c0d06caSMauro Carvalho Chehab module_param(i2c_debug, int, 0644);
4150f0a9dfSMauro Carvalho Chehab MODULE_PARM_DESC(i2c_debug, "i2c debug message level (1: normal debug, 2: show I2C transfers)");
420c0d06caSMauro Carvalho Chehab 
43ce8591ffSMauro Carvalho Chehab #define dprintk(level, fmt, arg...) do {				\
44ce8591ffSMauro Carvalho Chehab 	if (i2c_debug > level)						\
4529b05e22SMauro Carvalho Chehab 		dev_printk(KERN_DEBUG, &dev->intf->dev,			\
46ce8591ffSMauro Carvalho Chehab 			   "i2c: %s: " fmt, __func__, ## arg);		\
47ce8591ffSMauro Carvalho Chehab } while (0)
48ce8591ffSMauro Carvalho Chehab 
490c0d06caSMauro Carvalho Chehab /*
50cf68c22fSMauro Carvalho Chehab  * Time in msecs to wait for i2c xfers to finish.
51cf68c22fSMauro Carvalho Chehab  * 35ms is the maximum time a SMBUS device could wait when
52cf68c22fSMauro Carvalho Chehab  * clock stretching is used. As the transfer itself will take
53cf68c22fSMauro Carvalho Chehab  * some time to happen, set it to 35 ms.
54cf68c22fSMauro Carvalho Chehab  *
55cf68c22fSMauro Carvalho Chehab  * Ok, I2C doesn't specify any limit. So, eventually, we may need
56cf68c22fSMauro Carvalho Chehab  * to increase this timeout.
57cf68c22fSMauro Carvalho Chehab  */
58cf68c22fSMauro Carvalho Chehab #define EM28XX_I2C_XFER_TIMEOUT         35 /* ms */
59cf68c22fSMauro Carvalho Chehab 
60cf68c22fSMauro Carvalho Chehab static int em28xx_i2c_timeout(struct em28xx *dev)
61cf68c22fSMauro Carvalho Chehab {
62cf68c22fSMauro Carvalho Chehab 	int time = EM28XX_I2C_XFER_TIMEOUT;
63cf68c22fSMauro Carvalho Chehab 
64cf68c22fSMauro Carvalho Chehab 	switch (dev->i2c_speed & 0x03) {
65cf68c22fSMauro Carvalho Chehab 	case EM28XX_I2C_FREQ_25_KHZ:
66cf68c22fSMauro Carvalho Chehab 		time += 4;		/* Assume 4 ms for transfers */
67cf68c22fSMauro Carvalho Chehab 		break;
68cf68c22fSMauro Carvalho Chehab 	case EM28XX_I2C_FREQ_100_KHZ:
69cf68c22fSMauro Carvalho Chehab 	case EM28XX_I2C_FREQ_400_KHZ:
70cf68c22fSMauro Carvalho Chehab 		time += 1;		/* Assume 1 ms for transfers */
71cf68c22fSMauro Carvalho Chehab 		break;
72cf68c22fSMauro Carvalho Chehab 	default: /* EM28XX_I2C_FREQ_1_5_MHZ */
73cf68c22fSMauro Carvalho Chehab 		break;
74cf68c22fSMauro Carvalho Chehab 	}
75cf68c22fSMauro Carvalho Chehab 
76cf68c22fSMauro Carvalho Chehab 	return msecs_to_jiffies(time);
77cf68c22fSMauro Carvalho Chehab }
78cf68c22fSMauro Carvalho Chehab 
79cf68c22fSMauro Carvalho Chehab /*
80f5ae371aSFrank Schaefer  * em2800_i2c_send_bytes()
81f5ae371aSFrank Schaefer  * send up to 4 bytes to the em2800 i2c device
820c0d06caSMauro Carvalho Chehab  */
83f5ae371aSFrank Schaefer static int em2800_i2c_send_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len)
840c0d06caSMauro Carvalho Chehab {
85cf68c22fSMauro Carvalho Chehab 	unsigned long timeout = jiffies + em28xx_i2c_timeout(dev);
860c0d06caSMauro Carvalho Chehab 	int ret;
87a6bad040SFrank Schaefer 	u8 b2[6];
88f5ae371aSFrank Schaefer 
89f5ae371aSFrank Schaefer 	if (len < 1 || len > 4)
90f5ae371aSFrank Schaefer 		return -EOPNOTSUPP;
91f5ae371aSFrank Schaefer 
920c0d06caSMauro Carvalho Chehab 	b2[5] = 0x80 + len - 1;
930c0d06caSMauro Carvalho Chehab 	b2[4] = addr;
940c0d06caSMauro Carvalho Chehab 	b2[3] = buf[0];
950c0d06caSMauro Carvalho Chehab 	if (len > 1)
960c0d06caSMauro Carvalho Chehab 		b2[2] = buf[1];
970c0d06caSMauro Carvalho Chehab 	if (len > 2)
980c0d06caSMauro Carvalho Chehab 		b2[1] = buf[2];
990c0d06caSMauro Carvalho Chehab 	if (len > 3)
1000c0d06caSMauro Carvalho Chehab 		b2[0] = buf[3];
1010c0d06caSMauro Carvalho Chehab 
1022fcc82d8SFrank Schaefer 	/* trigger write */
1030c0d06caSMauro Carvalho Chehab 	ret = dev->em28xx_write_regs(dev, 4 - len, &b2[4 - len], 2 + len);
1040c0d06caSMauro Carvalho Chehab 	if (ret != 2 + len) {
10529b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
106ce8591ffSMauro Carvalho Chehab 			 "failed to trigger write to i2c address 0x%x (error=%i)\n",
107d230d5adSFrank Schaefer 			    addr, ret);
10845f04e82SFrank Schaefer 		return (ret < 0) ? ret : -EIO;
1090c0d06caSMauro Carvalho Chehab 	}
1102fcc82d8SFrank Schaefer 	/* wait for completion */
1114b83626aSMauro Carvalho Chehab 	while (time_is_after_jiffies(timeout)) {
1120c0d06caSMauro Carvalho Chehab 		ret = dev->em28xx_read_reg(dev, 0x05);
1134b83626aSMauro Carvalho Chehab 		if (ret == 0x80 + len - 1)
1140c0d06caSMauro Carvalho Chehab 			return len;
1154b83626aSMauro Carvalho Chehab 		if (ret == 0x94 + len - 1) {
116ce8591ffSMauro Carvalho Chehab 			dprintk(1, "R05 returned 0x%02x: I2C ACK error\n", ret);
117e63b009dSMauro Carvalho Chehab 			return -ENXIO;
1184b83626aSMauro Carvalho Chehab 		}
1194b83626aSMauro Carvalho Chehab 		if (ret < 0) {
12029b05e22SMauro Carvalho Chehab 			dev_warn(&dev->intf->dev,
121ce8591ffSMauro Carvalho Chehab 				 "failed to get i2c transfer status from bridge register (error=%i)\n",
122d230d5adSFrank Schaefer 				ret);
12345f04e82SFrank Schaefer 			return ret;
12445f04e82SFrank Schaefer 		}
1258adbc7d6SMauro Carvalho Chehab 		usleep_range(5000, 6000);
1260c0d06caSMauro Carvalho Chehab 	}
127ce8591ffSMauro Carvalho Chehab 	dprintk(0, "write to i2c device at 0x%x timed out\n", addr);
128e63b009dSMauro Carvalho Chehab 	return -ETIMEDOUT;
1290c0d06caSMauro Carvalho Chehab }
1300c0d06caSMauro Carvalho Chehab 
1310c0d06caSMauro Carvalho Chehab /*
1320c0d06caSMauro Carvalho Chehab  * em2800_i2c_recv_bytes()
1332fcc82d8SFrank Schaefer  * read up to 4 bytes from the em2800 i2c device
1340c0d06caSMauro Carvalho Chehab  */
135a6bad040SFrank Schaefer static int em2800_i2c_recv_bytes(struct em28xx *dev, u8 addr, u8 *buf, u16 len)
1360c0d06caSMauro Carvalho Chehab {
137cf68c22fSMauro Carvalho Chehab 	unsigned long timeout = jiffies + em28xx_i2c_timeout(dev);
1382fcc82d8SFrank Schaefer 	u8 buf2[4];
1390c0d06caSMauro Carvalho Chehab 	int ret;
1402fcc82d8SFrank Schaefer 	int i;
141f5ae371aSFrank Schaefer 
142f5ae371aSFrank Schaefer 	if (len < 1 || len > 4)
143f5ae371aSFrank Schaefer 		return -EOPNOTSUPP;
144f5ae371aSFrank Schaefer 
1452fcc82d8SFrank Schaefer 	/* trigger read */
1462fcc82d8SFrank Schaefer 	buf2[1] = 0x84 + len - 1;
1472fcc82d8SFrank Schaefer 	buf2[0] = addr;
1482fcc82d8SFrank Schaefer 	ret = dev->em28xx_write_regs(dev, 0x04, buf2, 2);
1492fcc82d8SFrank Schaefer 	if (ret != 2) {
15029b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
151ce8591ffSMauro Carvalho Chehab 			 "failed to trigger read from i2c address 0x%x (error=%i)\n",
152d230d5adSFrank Schaefer 			 addr, ret);
1532fcc82d8SFrank Schaefer 		return (ret < 0) ? ret : -EIO;
1542fcc82d8SFrank Schaefer 	}
1552fcc82d8SFrank Schaefer 
1562fcc82d8SFrank Schaefer 	/* wait for completion */
1574b83626aSMauro Carvalho Chehab 	while (time_is_after_jiffies(timeout)) {
1582fcc82d8SFrank Schaefer 		ret = dev->em28xx_read_reg(dev, 0x05);
1594b83626aSMauro Carvalho Chehab 		if (ret == 0x84 + len - 1)
1602fcc82d8SFrank Schaefer 			break;
1614b83626aSMauro Carvalho Chehab 		if (ret == 0x94 + len - 1) {
162ce8591ffSMauro Carvalho Chehab 			dprintk(1, "R05 returned 0x%02x: I2C ACK error\n",
163d845fb3aSMauro Carvalho Chehab 				ret);
164e63b009dSMauro Carvalho Chehab 			return -ENXIO;
1654b83626aSMauro Carvalho Chehab 		}
1664b83626aSMauro Carvalho Chehab 		if (ret < 0) {
16729b05e22SMauro Carvalho Chehab 			dev_warn(&dev->intf->dev,
168ce8591ffSMauro Carvalho Chehab 				 "failed to get i2c transfer status from bridge register (error=%i)\n",
169d230d5adSFrank Schaefer 				 ret);
1700c0d06caSMauro Carvalho Chehab 			return ret;
1710c0d06caSMauro Carvalho Chehab 		}
1728adbc7d6SMauro Carvalho Chehab 		usleep_range(5000, 6000);
1732fcc82d8SFrank Schaefer 	}
1748adbc7d6SMauro Carvalho Chehab 	if (ret != 0x84 + len - 1)
175ce8591ffSMauro Carvalho Chehab 		dprintk(0, "read from i2c device at 0x%x timed out\n", addr);
1762fcc82d8SFrank Schaefer 
1772fcc82d8SFrank Schaefer 	/* get the received message */
1782fcc82d8SFrank Schaefer 	ret = dev->em28xx_read_reg_req_len(dev, 0x00, 4 - len, buf2, len);
1792fcc82d8SFrank Schaefer 	if (ret != len) {
18029b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
181ce8591ffSMauro Carvalho Chehab 			 "reading from i2c device at 0x%x failed: couldn't get the received message from the bridge (error=%i)\n",
182d230d5adSFrank Schaefer 			 addr, ret);
1832fcc82d8SFrank Schaefer 		return (ret < 0) ? ret : -EIO;
1842fcc82d8SFrank Schaefer 	}
1852fcc82d8SFrank Schaefer 	for (i = 0; i < len; i++)
1862fcc82d8SFrank Schaefer 		buf[i] = buf2[len - 1 - i];
1872fcc82d8SFrank Schaefer 
1880c0d06caSMauro Carvalho Chehab 	return ret;
1890c0d06caSMauro Carvalho Chehab }
1902fcc82d8SFrank Schaefer 
1912fcc82d8SFrank Schaefer /*
1922fcc82d8SFrank Schaefer  * em2800_i2c_check_for_device()
1932fcc82d8SFrank Schaefer  * check if there is an i2c device at the supplied address
1942fcc82d8SFrank Schaefer  */
1952fcc82d8SFrank Schaefer static int em2800_i2c_check_for_device(struct em28xx *dev, u8 addr)
1962fcc82d8SFrank Schaefer {
1972fcc82d8SFrank Schaefer 	u8 buf;
1982fcc82d8SFrank Schaefer 	int ret;
1992fcc82d8SFrank Schaefer 
2002fcc82d8SFrank Schaefer 	ret = em2800_i2c_recv_bytes(dev, addr, &buf, 1);
2012fcc82d8SFrank Schaefer 	if (ret == 1)
2022fcc82d8SFrank Schaefer 		return 0;
2032fcc82d8SFrank Schaefer 	return (ret < 0) ? ret : -EIO;
2040c0d06caSMauro Carvalho Chehab }
2050c0d06caSMauro Carvalho Chehab 
2060c0d06caSMauro Carvalho Chehab /*
2070c0d06caSMauro Carvalho Chehab  * em28xx_i2c_send_bytes()
2080c0d06caSMauro Carvalho Chehab  */
209a6bad040SFrank Schaefer static int em28xx_i2c_send_bytes(struct em28xx *dev, u16 addr, u8 *buf,
210a6bad040SFrank Schaefer 				 u16 len, int stop)
2110c0d06caSMauro Carvalho Chehab {
212cf68c22fSMauro Carvalho Chehab 	unsigned long timeout = jiffies + em28xx_i2c_timeout(dev);
2134b83626aSMauro Carvalho Chehab 	int ret;
2140c0d06caSMauro Carvalho Chehab 
215f5ae371aSFrank Schaefer 	if (len < 1 || len > 64)
216f5ae371aSFrank Schaefer 		return -EOPNOTSUPP;
217fa74aca3SFrank Schaefer 	/*
218fa74aca3SFrank Schaefer 	 * NOTE: limited by the USB ctrl message constraints
219fa74aca3SFrank Schaefer 	 * Zero length reads always succeed, even if no device is connected
220fa74aca3SFrank Schaefer 	 */
221f5ae371aSFrank Schaefer 
22245f04e82SFrank Schaefer 	/* Write to i2c device */
22345f04e82SFrank Schaefer 	ret = dev->em28xx_write_regs_req(dev, stop ? 2 : 3, addr, buf, len);
22445f04e82SFrank Schaefer 	if (ret != len) {
22545f04e82SFrank Schaefer 		if (ret < 0) {
22629b05e22SMauro Carvalho Chehab 			dev_warn(&dev->intf->dev,
227ce8591ffSMauro Carvalho Chehab 				 "writing to i2c device at 0x%x failed (error=%i)\n",
228d230d5adSFrank Schaefer 				 addr, ret);
22945f04e82SFrank Schaefer 			return ret;
2308adbc7d6SMauro Carvalho Chehab 		}
23129b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
232ce8591ffSMauro Carvalho Chehab 			 "%i bytes write to i2c device at 0x%x requested, but %i bytes written\n",
23345f04e82SFrank Schaefer 				len, addr, ret);
23445f04e82SFrank Schaefer 		return -EIO;
23545f04e82SFrank Schaefer 	}
2360c0d06caSMauro Carvalho Chehab 
2374b83626aSMauro Carvalho Chehab 	/* wait for completion */
2384b83626aSMauro Carvalho Chehab 	while (time_is_after_jiffies(timeout)) {
2390c0d06caSMauro Carvalho Chehab 		ret = dev->em28xx_read_reg(dev, 0x05);
2404b83626aSMauro Carvalho Chehab 		if (ret == 0) /* success */
24145f04e82SFrank Schaefer 			return len;
2424b83626aSMauro Carvalho Chehab 		if (ret == 0x10) {
243ce8591ffSMauro Carvalho Chehab 			dprintk(1, "I2C ACK error on writing to addr 0x%02x\n",
244d845fb3aSMauro Carvalho Chehab 				addr);
245e63b009dSMauro Carvalho Chehab 			return -ENXIO;
2464b83626aSMauro Carvalho Chehab 		}
2474b83626aSMauro Carvalho Chehab 		if (ret < 0) {
24829b05e22SMauro Carvalho Chehab 			dev_warn(&dev->intf->dev,
249ce8591ffSMauro Carvalho Chehab 				 "failed to get i2c transfer status from bridge register (error=%i)\n",
250d230d5adSFrank Schaefer 				 ret);
25145f04e82SFrank Schaefer 			return ret;
2520c0d06caSMauro Carvalho Chehab 		}
2538adbc7d6SMauro Carvalho Chehab 		usleep_range(5000, 6000);
254fa74aca3SFrank Schaefer 		/*
255fa74aca3SFrank Schaefer 		 * NOTE: do we really have to wait for success ?
256fa74aca3SFrank Schaefer 		 * Never seen anything else than 0x00 or 0x10
257fa74aca3SFrank Schaefer 		 * (even with high payload) ...
258fa74aca3SFrank Schaefer 		 */
25945f04e82SFrank Schaefer 	}
260123a17d1SFrank Schaefer 
261123a17d1SFrank Schaefer 	if (ret == 0x02 || ret == 0x04) {
262123a17d1SFrank Schaefer 		/* NOTE: these errors seem to be related to clock stretching */
263ce8591ffSMauro Carvalho Chehab 		dprintk(0,
264ce8591ffSMauro Carvalho Chehab 			"write to i2c device at 0x%x timed out (status=%i)\n",
26550f0a9dfSMauro Carvalho Chehab 			addr, ret);
266e63b009dSMauro Carvalho Chehab 		return -ETIMEDOUT;
2670c0d06caSMauro Carvalho Chehab 	}
2680c0d06caSMauro Carvalho Chehab 
26929b05e22SMauro Carvalho Chehab 	dev_warn(&dev->intf->dev,
270ce8591ffSMauro Carvalho Chehab 		 "write to i2c device at 0x%x failed with unknown error (status=%i)\n",
271123a17d1SFrank Schaefer 		 addr, ret);
272123a17d1SFrank Schaefer 	return -EIO;
273123a17d1SFrank Schaefer }
274123a17d1SFrank Schaefer 
2750c0d06caSMauro Carvalho Chehab /*
2760c0d06caSMauro Carvalho Chehab  * em28xx_i2c_recv_bytes()
2770c0d06caSMauro Carvalho Chehab  * read a byte from the i2c device
2780c0d06caSMauro Carvalho Chehab  */
279a6bad040SFrank Schaefer static int em28xx_i2c_recv_bytes(struct em28xx *dev, u16 addr, u8 *buf, u16 len)
2800c0d06caSMauro Carvalho Chehab {
2810c0d06caSMauro Carvalho Chehab 	int ret;
282f5ae371aSFrank Schaefer 
283f5ae371aSFrank Schaefer 	if (len < 1 || len > 64)
284f5ae371aSFrank Schaefer 		return -EOPNOTSUPP;
285fa74aca3SFrank Schaefer 	/*
286fa74aca3SFrank Schaefer 	 * NOTE: limited by the USB ctrl message constraints
287fa74aca3SFrank Schaefer 	 * Zero length reads always succeed, even if no device is connected
288fa74aca3SFrank Schaefer 	 */
289f5ae371aSFrank Schaefer 
29045f04e82SFrank Schaefer 	/* Read data from i2c device */
2910c0d06caSMauro Carvalho Chehab 	ret = dev->em28xx_read_reg_req_len(dev, 2, addr, buf, len);
2920c0d06caSMauro Carvalho Chehab 	if (ret < 0) {
29329b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
294ce8591ffSMauro Carvalho Chehab 			 "reading from i2c device at 0x%x failed (error=%i)\n",
2957f6301d1SFrank Schaefer 			 addr, ret);
29645f04e82SFrank Schaefer 		return ret;
297*1970105aSBrad Love 	} else if (ret != len) {
298*1970105aSBrad Love 		dev_dbg(&dev->intf->dev,
299*1970105aSBrad Love 			"%i bytes read from i2c device at 0x%x requested, but %i bytes written\n",
300*1970105aSBrad Love 				ret, addr, len);
30145f04e82SFrank Schaefer 	}
302fa74aca3SFrank Schaefer 	/*
3033e4d8f48SMauro Carvalho Chehab 	 * NOTE: some devices with two i2c buses have the bad habit to return 0
3047f6301d1SFrank Schaefer 	 * bytes if we are on bus B AND there was no write attempt to the
3057f6301d1SFrank Schaefer 	 * specified slave address before AND no device is present at the
3067f6301d1SFrank Schaefer 	 * requested slave address.
307e63b009dSMauro Carvalho Chehab 	 * Anyway, the next check will fail with -ENXIO in this case, so avoid
3087f6301d1SFrank Schaefer 	 * spamming the system log on device probing and do nothing here.
3097f6301d1SFrank Schaefer 	 */
31045f04e82SFrank Schaefer 
31145f04e82SFrank Schaefer 	/* Check success of the i2c operation */
31245f04e82SFrank Schaefer 	ret = dev->em28xx_read_reg(dev, 0x05);
3134b83626aSMauro Carvalho Chehab 	if (ret == 0) /* success */
3144b83626aSMauro Carvalho Chehab 		return len;
31545f04e82SFrank Schaefer 	if (ret < 0) {
31629b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
317ce8591ffSMauro Carvalho Chehab 			 "failed to get i2c transfer status from bridge register (error=%i)\n",
318d230d5adSFrank Schaefer 			 ret);
3190c0d06caSMauro Carvalho Chehab 		return ret;
3200c0d06caSMauro Carvalho Chehab 	}
321d845fb3aSMauro Carvalho Chehab 	if (ret == 0x10) {
322ce8591ffSMauro Carvalho Chehab 		dprintk(1, "I2C ACK error on writing to addr 0x%02x\n",
323d845fb3aSMauro Carvalho Chehab 			addr);
324e63b009dSMauro Carvalho Chehab 		return -ENXIO;
325d845fb3aSMauro Carvalho Chehab 	}
3264b83626aSMauro Carvalho Chehab 
327123a17d1SFrank Schaefer 	if (ret == 0x02 || ret == 0x04) {
328123a17d1SFrank Schaefer 		/* NOTE: these errors seem to be related to clock stretching */
329ce8591ffSMauro Carvalho Chehab 		dprintk(0,
330ce8591ffSMauro Carvalho Chehab 			"write to i2c device at 0x%x timed out (status=%i)\n",
331123a17d1SFrank Schaefer 			addr, ret);
332e63b009dSMauro Carvalho Chehab 		return -ETIMEDOUT;
33345f04e82SFrank Schaefer 	}
3340c0d06caSMauro Carvalho Chehab 
33529b05e22SMauro Carvalho Chehab 	dev_warn(&dev->intf->dev,
336*1970105aSBrad Love 		 "read from i2c device at 0x%x failed with unknown error (status=%i)\n",
337123a17d1SFrank Schaefer 		 addr, ret);
338123a17d1SFrank Schaefer 	return -EIO;
339123a17d1SFrank Schaefer }
340123a17d1SFrank Schaefer 
3410c0d06caSMauro Carvalho Chehab /*
3420c0d06caSMauro Carvalho Chehab  * em28xx_i2c_check_for_device()
3430c0d06caSMauro Carvalho Chehab  * check if there is a i2c_device at the supplied address
3440c0d06caSMauro Carvalho Chehab  */
345a6bad040SFrank Schaefer static int em28xx_i2c_check_for_device(struct em28xx *dev, u16 addr)
3460c0d06caSMauro Carvalho Chehab {
3470c0d06caSMauro Carvalho Chehab 	int ret;
34845f04e82SFrank Schaefer 	u8 buf;
3490c0d06caSMauro Carvalho Chehab 
35045f04e82SFrank Schaefer 	ret = em28xx_i2c_recv_bytes(dev, addr, &buf, 1);
35145f04e82SFrank Schaefer 	if (ret == 1)
3520c0d06caSMauro Carvalho Chehab 		return 0;
35345f04e82SFrank Schaefer 	return (ret < 0) ? ret : -EIO;
3540c0d06caSMauro Carvalho Chehab }
3550c0d06caSMauro Carvalho Chehab 
3560c0d06caSMauro Carvalho Chehab /*
357a3ea4bf9SFrank Schaefer  * em25xx_bus_B_send_bytes
358a3ea4bf9SFrank Schaefer  * write bytes to the i2c device
359a3ea4bf9SFrank Schaefer  */
360a3ea4bf9SFrank Schaefer static int em25xx_bus_B_send_bytes(struct em28xx *dev, u16 addr, u8 *buf,
361a3ea4bf9SFrank Schaefer 				   u16 len)
362a3ea4bf9SFrank Schaefer {
363a3ea4bf9SFrank Schaefer 	int ret;
364a3ea4bf9SFrank Schaefer 
365a3ea4bf9SFrank Schaefer 	if (len < 1 || len > 64)
366a3ea4bf9SFrank Schaefer 		return -EOPNOTSUPP;
367a3ea4bf9SFrank Schaefer 	/*
368a3ea4bf9SFrank Schaefer 	 * NOTE: limited by the USB ctrl message constraints
369a3ea4bf9SFrank Schaefer 	 * Zero length reads always succeed, even if no device is connected
370a3ea4bf9SFrank Schaefer 	 */
371a3ea4bf9SFrank Schaefer 
372a3ea4bf9SFrank Schaefer 	/* Set register and write value */
373a3ea4bf9SFrank Schaefer 	ret = dev->em28xx_write_regs_req(dev, 0x06, addr, buf, len);
374a3ea4bf9SFrank Schaefer 	if (ret != len) {
375a3ea4bf9SFrank Schaefer 		if (ret < 0) {
37629b05e22SMauro Carvalho Chehab 			dev_warn(&dev->intf->dev,
377ce8591ffSMauro Carvalho Chehab 				 "writing to i2c device at 0x%x failed (error=%i)\n",
378a3ea4bf9SFrank Schaefer 				 addr, ret);
379a3ea4bf9SFrank Schaefer 			return ret;
3808adbc7d6SMauro Carvalho Chehab 		}
3818adbc7d6SMauro Carvalho Chehab 
38229b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
383ce8591ffSMauro Carvalho Chehab 			 "%i bytes write to i2c device at 0x%x requested, but %i bytes written\n",
384a3ea4bf9SFrank Schaefer 			 len, addr, ret);
385a3ea4bf9SFrank Schaefer 		return -EIO;
386a3ea4bf9SFrank Schaefer 	}
387a3ea4bf9SFrank Schaefer 	/* Check success */
388a3ea4bf9SFrank Schaefer 	ret = dev->em28xx_read_reg_req(dev, 0x08, 0x0000);
389a3ea4bf9SFrank Schaefer 	/*
390a3ea4bf9SFrank Schaefer 	 * NOTE: the only error we've seen so far is
391a3ea4bf9SFrank Schaefer 	 * 0x01 when the slave device is not present
392a3ea4bf9SFrank Schaefer 	 */
393a3ea4bf9SFrank Schaefer 	if (!ret)
394a3ea4bf9SFrank Schaefer 		return len;
3958adbc7d6SMauro Carvalho Chehab 
3968adbc7d6SMauro Carvalho Chehab 	if (ret > 0) {
397ce8591ffSMauro Carvalho Chehab 		dprintk(1, "Bus B R08 returned 0x%02x: I2C ACK error\n", ret);
398e63b009dSMauro Carvalho Chehab 		return -ENXIO;
399d845fb3aSMauro Carvalho Chehab 	}
400a3ea4bf9SFrank Schaefer 
401a3ea4bf9SFrank Schaefer 	return ret;
402a3ea4bf9SFrank Schaefer 	/*
403a3ea4bf9SFrank Schaefer 	 * NOTE: With chip types (other chip IDs) which actually don't support
404a3ea4bf9SFrank Schaefer 	 * this operation, it seems to succeed ALWAYS ! (even if there is no
405a3ea4bf9SFrank Schaefer 	 * slave device or even no second i2c bus provided)
406a3ea4bf9SFrank Schaefer 	 */
407a3ea4bf9SFrank Schaefer }
408a3ea4bf9SFrank Schaefer 
409a3ea4bf9SFrank Schaefer /*
410a3ea4bf9SFrank Schaefer  * em25xx_bus_B_recv_bytes
411a3ea4bf9SFrank Schaefer  * read bytes from the i2c device
412a3ea4bf9SFrank Schaefer  */
413a3ea4bf9SFrank Schaefer static int em25xx_bus_B_recv_bytes(struct em28xx *dev, u16 addr, u8 *buf,
414a3ea4bf9SFrank Schaefer 				   u16 len)
415a3ea4bf9SFrank Schaefer {
416a3ea4bf9SFrank Schaefer 	int ret;
417a3ea4bf9SFrank Schaefer 
418a3ea4bf9SFrank Schaefer 	if (len < 1 || len > 64)
419a3ea4bf9SFrank Schaefer 		return -EOPNOTSUPP;
420a3ea4bf9SFrank Schaefer 	/*
421a3ea4bf9SFrank Schaefer 	 * NOTE: limited by the USB ctrl message constraints
422a3ea4bf9SFrank Schaefer 	 * Zero length reads always succeed, even if no device is connected
423a3ea4bf9SFrank Schaefer 	 */
424a3ea4bf9SFrank Schaefer 
425a3ea4bf9SFrank Schaefer 	/* Read value */
426a3ea4bf9SFrank Schaefer 	ret = dev->em28xx_read_reg_req_len(dev, 0x06, addr, buf, len);
427a3ea4bf9SFrank Schaefer 	if (ret < 0) {
42829b05e22SMauro Carvalho Chehab 		dev_warn(&dev->intf->dev,
429ce8591ffSMauro Carvalho Chehab 			 "reading from i2c device at 0x%x failed (error=%i)\n",
430a3ea4bf9SFrank Schaefer 			 addr, ret);
431a3ea4bf9SFrank Schaefer 		return ret;
432a3ea4bf9SFrank Schaefer 	}
433a3ea4bf9SFrank Schaefer 	/*
4343e4d8f48SMauro Carvalho Chehab 	 * NOTE: some devices with two i2c buses have the bad habit to return 0
435a3ea4bf9SFrank Schaefer 	 * bytes if we are on bus B AND there was no write attempt to the
436a3ea4bf9SFrank Schaefer 	 * specified slave address before AND no device is present at the
437a3ea4bf9SFrank Schaefer 	 * requested slave address.
438e63b009dSMauro Carvalho Chehab 	 * Anyway, the next check will fail with -ENXIO in this case, so avoid
439a3ea4bf9SFrank Schaefer 	 * spamming the system log on device probing and do nothing here.
440a3ea4bf9SFrank Schaefer 	 */
441a3ea4bf9SFrank Schaefer 
442a3ea4bf9SFrank Schaefer 	/* Check success */
443a3ea4bf9SFrank Schaefer 	ret = dev->em28xx_read_reg_req(dev, 0x08, 0x0000);
444a3ea4bf9SFrank Schaefer 	/*
445a3ea4bf9SFrank Schaefer 	 * NOTE: the only error we've seen so far is
446a3ea4bf9SFrank Schaefer 	 * 0x01 when the slave device is not present
447a3ea4bf9SFrank Schaefer 	 */
448a3ea4bf9SFrank Schaefer 	if (!ret)
449a3ea4bf9SFrank Schaefer 		return len;
4508adbc7d6SMauro Carvalho Chehab 
4518adbc7d6SMauro Carvalho Chehab 	if (ret > 0) {
452ce8591ffSMauro Carvalho Chehab 		dprintk(1, "Bus B R08 returned 0x%02x: I2C ACK error\n", ret);
453e63b009dSMauro Carvalho Chehab 		return -ENXIO;
454d845fb3aSMauro Carvalho Chehab 	}
455a3ea4bf9SFrank Schaefer 
456a3ea4bf9SFrank Schaefer 	return ret;
457a3ea4bf9SFrank Schaefer 	/*
458a3ea4bf9SFrank Schaefer 	 * NOTE: With chip types (other chip IDs) which actually don't support
459a3ea4bf9SFrank Schaefer 	 * this operation, it seems to succeed ALWAYS ! (even if there is no
460a3ea4bf9SFrank Schaefer 	 * slave device or even no second i2c bus provided)
461a3ea4bf9SFrank Schaefer 	 */
462a3ea4bf9SFrank Schaefer }
463a3ea4bf9SFrank Schaefer 
464a3ea4bf9SFrank Schaefer /*
465a3ea4bf9SFrank Schaefer  * em25xx_bus_B_check_for_device()
466a3ea4bf9SFrank Schaefer  * check if there is a i2c device at the supplied address
467a3ea4bf9SFrank Schaefer  */
468a3ea4bf9SFrank Schaefer static int em25xx_bus_B_check_for_device(struct em28xx *dev, u16 addr)
469a3ea4bf9SFrank Schaefer {
470a3ea4bf9SFrank Schaefer 	u8 buf;
471a3ea4bf9SFrank Schaefer 	int ret;
472a3ea4bf9SFrank Schaefer 
473a3ea4bf9SFrank Schaefer 	ret = em25xx_bus_B_recv_bytes(dev, addr, &buf, 1);
474a3ea4bf9SFrank Schaefer 	if (ret < 0)
475a3ea4bf9SFrank Schaefer 		return ret;
476a3ea4bf9SFrank Schaefer 
477a3ea4bf9SFrank Schaefer 	return 0;
478a3ea4bf9SFrank Schaefer 	/*
479a3ea4bf9SFrank Schaefer 	 * NOTE: With chips which do not support this operation,
480a3ea4bf9SFrank Schaefer 	 * it seems to succeed ALWAYS ! (even if no device connected)
481a3ea4bf9SFrank Schaefer 	 */
482a3ea4bf9SFrank Schaefer }
483a3ea4bf9SFrank Schaefer 
484a3ea4bf9SFrank Schaefer static inline int i2c_check_for_device(struct em28xx_i2c_bus *i2c_bus, u16 addr)
485a3ea4bf9SFrank Schaefer {
486a3ea4bf9SFrank Schaefer 	struct em28xx *dev = i2c_bus->dev;
487a3ea4bf9SFrank Schaefer 	int rc = -EOPNOTSUPP;
488a3ea4bf9SFrank Schaefer 
489a3ea4bf9SFrank Schaefer 	if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX)
490a3ea4bf9SFrank Schaefer 		rc = em28xx_i2c_check_for_device(dev, addr);
491a3ea4bf9SFrank Schaefer 	else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800)
492a3ea4bf9SFrank Schaefer 		rc = em2800_i2c_check_for_device(dev, addr);
493a3ea4bf9SFrank Schaefer 	else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B)
494a3ea4bf9SFrank Schaefer 		rc = em25xx_bus_B_check_for_device(dev, addr);
495a3ea4bf9SFrank Schaefer 	return rc;
496a3ea4bf9SFrank Schaefer }
497a3ea4bf9SFrank Schaefer 
498a3ea4bf9SFrank Schaefer static inline int i2c_recv_bytes(struct em28xx_i2c_bus *i2c_bus,
499a3ea4bf9SFrank Schaefer 				 struct i2c_msg msg)
500a3ea4bf9SFrank Schaefer {
501a3ea4bf9SFrank Schaefer 	struct em28xx *dev = i2c_bus->dev;
502a3ea4bf9SFrank Schaefer 	u16 addr = msg.addr << 1;
50350f0a9dfSMauro Carvalho Chehab 	int rc = -EOPNOTSUPP;
504a3ea4bf9SFrank Schaefer 
505a3ea4bf9SFrank Schaefer 	if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX)
506a3ea4bf9SFrank Schaefer 		rc = em28xx_i2c_recv_bytes(dev, addr, msg.buf, msg.len);
507a3ea4bf9SFrank Schaefer 	else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800)
508a3ea4bf9SFrank Schaefer 		rc = em2800_i2c_recv_bytes(dev, addr, msg.buf, msg.len);
509a3ea4bf9SFrank Schaefer 	else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B)
510a3ea4bf9SFrank Schaefer 		rc = em25xx_bus_B_recv_bytes(dev, addr, msg.buf, msg.len);
511a3ea4bf9SFrank Schaefer 	return rc;
512a3ea4bf9SFrank Schaefer }
513a3ea4bf9SFrank Schaefer 
514a3ea4bf9SFrank Schaefer static inline int i2c_send_bytes(struct em28xx_i2c_bus *i2c_bus,
515a3ea4bf9SFrank Schaefer 				 struct i2c_msg msg, int stop)
516a3ea4bf9SFrank Schaefer {
517a3ea4bf9SFrank Schaefer 	struct em28xx *dev = i2c_bus->dev;
518a3ea4bf9SFrank Schaefer 	u16 addr = msg.addr << 1;
51950f0a9dfSMauro Carvalho Chehab 	int rc = -EOPNOTSUPP;
520a3ea4bf9SFrank Schaefer 
521a3ea4bf9SFrank Schaefer 	if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX)
522a3ea4bf9SFrank Schaefer 		rc = em28xx_i2c_send_bytes(dev, addr, msg.buf, msg.len, stop);
523a3ea4bf9SFrank Schaefer 	else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800)
524a3ea4bf9SFrank Schaefer 		rc = em2800_i2c_send_bytes(dev, addr, msg.buf, msg.len);
525a3ea4bf9SFrank Schaefer 	else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B)
526a3ea4bf9SFrank Schaefer 		rc = em25xx_bus_B_send_bytes(dev, addr, msg.buf, msg.len);
527a3ea4bf9SFrank Schaefer 	return rc;
528a3ea4bf9SFrank Schaefer }
529a3ea4bf9SFrank Schaefer 
530a3ea4bf9SFrank Schaefer /*
5310c0d06caSMauro Carvalho Chehab  * em28xx_i2c_xfer()
5320c0d06caSMauro Carvalho Chehab  * the main i2c transfer function
5330c0d06caSMauro Carvalho Chehab  */
5340c0d06caSMauro Carvalho Chehab static int em28xx_i2c_xfer(struct i2c_adapter *i2c_adap,
5350c0d06caSMauro Carvalho Chehab 			   struct i2c_msg msgs[], int num)
5360c0d06caSMauro Carvalho Chehab {
537aab3125cSMauro Carvalho Chehab 	struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data;
538aab3125cSMauro Carvalho Chehab 	struct em28xx *dev = i2c_bus->dev;
5398adbc7d6SMauro Carvalho Chehab 	unsigned int bus = i2c_bus->bus;
540a3ea4bf9SFrank Schaefer 	int addr, rc, i;
5413190fbeeSMauro Carvalho Chehab 	u8 reg;
5420c0d06caSMauro Carvalho Chehab 
5438adbc7d6SMauro Carvalho Chehab 	/*
5448adbc7d6SMauro Carvalho Chehab 	 * prevent i2c xfer attempts after device is disconnected
5458adbc7d6SMauro Carvalho Chehab 	 * some fe's try to do i2c writes/reads from their release
5468adbc7d6SMauro Carvalho Chehab 	 * interfaces when called in disconnect path
5478adbc7d6SMauro Carvalho Chehab 	 */
548cc5c5d20SShuah Khan 	if (dev->disconnected)
549cc5c5d20SShuah Khan 		return -ENODEV;
550cc5c5d20SShuah Khan 
551e44c153bSDan Carpenter 	if (!rt_mutex_trylock(&dev->i2c_bus_lock))
552e44c153bSDan Carpenter 		return -EAGAIN;
553aab3125cSMauro Carvalho Chehab 
554aab3125cSMauro Carvalho Chehab 	/* Switch I2C bus if needed */
555a3ea4bf9SFrank Schaefer 	if (bus != dev->cur_i2c_bus &&
556a3ea4bf9SFrank Schaefer 	    i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX) {
557aab3125cSMauro Carvalho Chehab 		if (bus == 1)
5583190fbeeSMauro Carvalho Chehab 			reg = EM2874_I2C_SECONDARY_BUS_SELECT;
559aab3125cSMauro Carvalho Chehab 		else
5603190fbeeSMauro Carvalho Chehab 			reg = 0;
5613190fbeeSMauro Carvalho Chehab 		em28xx_write_reg_bits(dev, EM28XX_R06_I2C_CLK, reg,
5623190fbeeSMauro Carvalho Chehab 				      EM2874_I2C_SECONDARY_BUS_SELECT);
563aab3125cSMauro Carvalho Chehab 		dev->cur_i2c_bus = bus;
564aab3125cSMauro Carvalho Chehab 	}
565aab3125cSMauro Carvalho Chehab 
5660c0d06caSMauro Carvalho Chehab 	for (i = 0; i < num; i++) {
5670c0d06caSMauro Carvalho Chehab 		addr = msgs[i].addr << 1;
568e63b009dSMauro Carvalho Chehab 		if (!msgs[i].len) {
569e63b009dSMauro Carvalho Chehab 			/*
570e63b009dSMauro Carvalho Chehab 			 * no len: check only for device presence
571e63b009dSMauro Carvalho Chehab 			 * This code is only called during device probe.
572e63b009dSMauro Carvalho Chehab 			 */
573a3ea4bf9SFrank Schaefer 			rc = i2c_check_for_device(i2c_bus, addr);
574ce8591ffSMauro Carvalho Chehab 
575ce8591ffSMauro Carvalho Chehab 			if (rc == -ENXIO)
57650f0a9dfSMauro Carvalho Chehab 				rc = -ENODEV;
5770c0d06caSMauro Carvalho Chehab 		} else if (msgs[i].flags & I2C_M_RD) {
5780c0d06caSMauro Carvalho Chehab 			/* read bytes */
579a3ea4bf9SFrank Schaefer 			rc = i2c_recv_bytes(i2c_bus, msgs[i]);
5800c0d06caSMauro Carvalho Chehab 		} else {
5810c0d06caSMauro Carvalho Chehab 			/* write bytes */
582a3ea4bf9SFrank Schaefer 			rc = i2c_send_bytes(i2c_bus, msgs[i], i == num - 1);
5830c0d06caSMauro Carvalho Chehab 		}
584ce8591ffSMauro Carvalho Chehab 
585ce8591ffSMauro Carvalho Chehab 		if (rc < 0)
586ce8591ffSMauro Carvalho Chehab 			goto error;
587ce8591ffSMauro Carvalho Chehab 
588ce8591ffSMauro Carvalho Chehab 		dprintk(2, "%s %s addr=%02x len=%d: %*ph\n",
589ce8591ffSMauro Carvalho Chehab 			(msgs[i].flags & I2C_M_RD) ? "read" : "write",
590ce8591ffSMauro Carvalho Chehab 			i == num - 1 ? "stop" : "nonstop",
591ce8591ffSMauro Carvalho Chehab 			addr, msgs[i].len,
592ce8591ffSMauro Carvalho Chehab 			msgs[i].len, msgs[i].buf);
5930c0d06caSMauro Carvalho Chehab 	}
5940c0d06caSMauro Carvalho Chehab 
595aab3125cSMauro Carvalho Chehab 	rt_mutex_unlock(&dev->i2c_bus_lock);
5960c0d06caSMauro Carvalho Chehab 	return num;
597ce8591ffSMauro Carvalho Chehab 
598ce8591ffSMauro Carvalho Chehab error:
599ce8591ffSMauro Carvalho Chehab 	dprintk(2, "%s %s addr=%02x len=%d: %sERROR: %i\n",
600ce8591ffSMauro Carvalho Chehab 		(msgs[i].flags & I2C_M_RD) ? "read" : "write",
601ce8591ffSMauro Carvalho Chehab 		i == num - 1 ? "stop" : "nonstop",
602ce8591ffSMauro Carvalho Chehab 		addr, msgs[i].len,
603ce8591ffSMauro Carvalho Chehab 		(rc == -ENODEV) ? "no device " : "",
604ce8591ffSMauro Carvalho Chehab 		rc);
605ce8591ffSMauro Carvalho Chehab 
606ce8591ffSMauro Carvalho Chehab 	rt_mutex_unlock(&dev->i2c_bus_lock);
607ce8591ffSMauro Carvalho Chehab 	return rc;
6080c0d06caSMauro Carvalho Chehab }
6090c0d06caSMauro Carvalho Chehab 
610fa74aca3SFrank Schaefer /*
611fa74aca3SFrank Schaefer  * based on linux/sunrpc/svcauth.h and linux/hash.h
6120c0d06caSMauro Carvalho Chehab  * The original hash function returns a different value, if arch is x86_64
6130c0d06caSMauro Carvalho Chehab  * or i386.
6140c0d06caSMauro Carvalho Chehab  */
6150c0d06caSMauro Carvalho Chehab static inline unsigned long em28xx_hash_mem(char *buf, int length, int bits)
6160c0d06caSMauro Carvalho Chehab {
6170c0d06caSMauro Carvalho Chehab 	unsigned long hash = 0;
6180c0d06caSMauro Carvalho Chehab 	unsigned long l = 0;
6190c0d06caSMauro Carvalho Chehab 	int len = 0;
6200c0d06caSMauro Carvalho Chehab 	unsigned char c;
621fdf1bc9fSMauro Carvalho Chehab 
6220c0d06caSMauro Carvalho Chehab 	do {
6230c0d06caSMauro Carvalho Chehab 		if (len == length) {
6240c0d06caSMauro Carvalho Chehab 			c = (char)len;
6250c0d06caSMauro Carvalho Chehab 			len = -1;
6268adbc7d6SMauro Carvalho Chehab 		} else {
6270c0d06caSMauro Carvalho Chehab 			c = *buf++;
6288adbc7d6SMauro Carvalho Chehab 		}
6290c0d06caSMauro Carvalho Chehab 		l = (l << 8) | c;
6300c0d06caSMauro Carvalho Chehab 		len++;
6310c0d06caSMauro Carvalho Chehab 		if ((len & (32 / 8 - 1)) == 0)
6320c0d06caSMauro Carvalho Chehab 			hash = ((hash ^ l) * 0x9e370001UL);
6330c0d06caSMauro Carvalho Chehab 	} while (len);
6340c0d06caSMauro Carvalho Chehab 
6350c0d06caSMauro Carvalho Chehab 	return (hash >> (32 - bits)) & 0xffffffffUL;
6360c0d06caSMauro Carvalho Chehab }
6370c0d06caSMauro Carvalho Chehab 
638fa74aca3SFrank Schaefer /*
639fa74aca3SFrank Schaefer  * Helper function to read data blocks from i2c clients with 8 or 16 bit
640fa74aca3SFrank Schaefer  * address width, 8 bit register width and auto incrementation been activated
641fa74aca3SFrank Schaefer  */
6428adbc7d6SMauro Carvalho Chehab static int em28xx_i2c_read_block(struct em28xx *dev, unsigned int bus, u16 addr,
643aab3125cSMauro Carvalho Chehab 				 bool addr_w16, u16 len, u8 *data)
644d832c5b2SFrank Schaefer {
645d832c5b2SFrank Schaefer 	int remain = len, rsize, rsize_max, ret;
646d832c5b2SFrank Schaefer 	u8 buf[2];
647d832c5b2SFrank Schaefer 
648d832c5b2SFrank Schaefer 	/* Sanity check */
649d832c5b2SFrank Schaefer 	if (addr + remain > (addr_w16 * 0xff00 + 0xff + 1))
650d832c5b2SFrank Schaefer 		return -EINVAL;
651d832c5b2SFrank Schaefer 	/* Select address */
652d832c5b2SFrank Schaefer 	buf[0] = addr >> 8;
653d832c5b2SFrank Schaefer 	buf[1] = addr & 0xff;
6548adbc7d6SMauro Carvalho Chehab 	ret = i2c_master_send(&dev->i2c_client[bus],
6558adbc7d6SMauro Carvalho Chehab 			      buf + !addr_w16, 1 + addr_w16);
656d832c5b2SFrank Schaefer 	if (ret < 0)
657d832c5b2SFrank Schaefer 		return ret;
658d832c5b2SFrank Schaefer 	/* Read data */
659d832c5b2SFrank Schaefer 	if (dev->board.is_em2800)
660d832c5b2SFrank Schaefer 		rsize_max = 4;
661d832c5b2SFrank Schaefer 	else
662d832c5b2SFrank Schaefer 		rsize_max = 64;
663d832c5b2SFrank Schaefer 	while (remain > 0) {
664d832c5b2SFrank Schaefer 		if (remain > rsize_max)
665d832c5b2SFrank Schaefer 			rsize = rsize_max;
666d832c5b2SFrank Schaefer 		else
667d832c5b2SFrank Schaefer 			rsize = remain;
668d832c5b2SFrank Schaefer 
669aab3125cSMauro Carvalho Chehab 		ret = i2c_master_recv(&dev->i2c_client[bus], data, rsize);
670d832c5b2SFrank Schaefer 		if (ret < 0)
671d832c5b2SFrank Schaefer 			return ret;
672d832c5b2SFrank Schaefer 
673d832c5b2SFrank Schaefer 		remain -= rsize;
674d832c5b2SFrank Schaefer 		data += rsize;
675d832c5b2SFrank Schaefer 	}
676d832c5b2SFrank Schaefer 
677d832c5b2SFrank Schaefer 	return len;
678d832c5b2SFrank Schaefer }
679d832c5b2SFrank Schaefer 
6808adbc7d6SMauro Carvalho Chehab static int em28xx_i2c_eeprom(struct em28xx *dev, unsigned int bus,
681aab3125cSMauro Carvalho Chehab 			     u8 **eedata, u16 *eedata_len)
6820c0d06caSMauro Carvalho Chehab {
683510e884cSFrank Schaefer 	const u16 len = 256;
684fa74aca3SFrank Schaefer 	/*
685fa74aca3SFrank Schaefer 	 * FIXME common length/size for bytes to read, to display, hash
686510e884cSFrank Schaefer 	 * calculation and returned device dataset. Simplifies the code a lot,
687fa74aca3SFrank Schaefer 	 * but we might have to deal with multiple sizes in the future !
688fa74aca3SFrank Schaefer 	 */
68950f0a9dfSMauro Carvalho Chehab 	int err;
690510e884cSFrank Schaefer 	struct em28xx_eeprom *dev_config;
691510e884cSFrank Schaefer 	u8 buf, *data;
6920c0d06caSMauro Carvalho Chehab 
693a217968fSFrank Schaefer 	*eedata = NULL;
694510e884cSFrank Schaefer 	*eedata_len = 0;
695a217968fSFrank Schaefer 
696aab3125cSMauro Carvalho Chehab 	/* EEPROM is always on i2c bus 0 on all known devices. */
697aab3125cSMauro Carvalho Chehab 
698aab3125cSMauro Carvalho Chehab 	dev->i2c_client[bus].addr = 0xa0 >> 1;
6990c0d06caSMauro Carvalho Chehab 
7000c0d06caSMauro Carvalho Chehab 	/* Check if board has eeprom */
701aab3125cSMauro Carvalho Chehab 	err = i2c_master_recv(&dev->i2c_client[bus], &buf, 0);
7020c0d06caSMauro Carvalho Chehab 	if (err < 0) {
70329b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "board has no eeprom\n");
7040c0d06caSMauro Carvalho Chehab 		return -ENODEV;
7050c0d06caSMauro Carvalho Chehab 	}
7060c0d06caSMauro Carvalho Chehab 
707a217968fSFrank Schaefer 	data = kzalloc(len, GFP_KERNEL);
7088adbc7d6SMauro Carvalho Chehab 	if (!data)
709a217968fSFrank Schaefer 		return -ENOMEM;
710a217968fSFrank Schaefer 
711d832c5b2SFrank Schaefer 	/* Read EEPROM content */
712aab3125cSMauro Carvalho Chehab 	err = em28xx_i2c_read_block(dev, bus, 0x0000,
713aab3125cSMauro Carvalho Chehab 				    dev->eeprom_addrwidth_16bit,
714a217968fSFrank Schaefer 				    len, data);
715d832c5b2SFrank Schaefer 	if (err != len) {
71629b05e22SMauro Carvalho Chehab 		dev_err(&dev->intf->dev,
717ce8591ffSMauro Carvalho Chehab 			"failed to read eeprom (err=%d)\n", err);
718510e884cSFrank Schaefer 		goto error;
7190c0d06caSMauro Carvalho Chehab 	}
72090271964SFrank Schaefer 
72150f0a9dfSMauro Carvalho Chehab 	if (i2c_debug) {
72287b52439SFrank Schaefer 		/* Display eeprom content */
723ce8591ffSMauro Carvalho Chehab 		print_hex_dump(KERN_DEBUG, "em28xx eeprom ", DUMP_PREFIX_OFFSET,
72450f0a9dfSMauro Carvalho Chehab 			       16, 1, data, len, true);
72550f0a9dfSMauro Carvalho Chehab 
72687b52439SFrank Schaefer 		if (dev->eeprom_addrwidth_16bit)
72729b05e22SMauro Carvalho Chehab 			dev_info(&dev->intf->dev,
728ce8591ffSMauro Carvalho Chehab 				 "eeprom %06x: ... (skipped)\n", 256);
72987b52439SFrank Schaefer 	}
7300c0d06caSMauro Carvalho Chehab 
73187b52439SFrank Schaefer 	if (dev->eeprom_addrwidth_16bit &&
732a217968fSFrank Schaefer 	    data[0] == 0x26 && data[3] == 0x00) {
73387b52439SFrank Schaefer 		/* new eeprom format; size 4-64kb */
734510e884cSFrank Schaefer 		u16 mc_start;
735510e884cSFrank Schaefer 		u16 hwconf_offset;
736510e884cSFrank Schaefer 
737a217968fSFrank Schaefer 		dev->hash = em28xx_hash_mem(data, len, 32);
738510e884cSFrank Schaefer 		mc_start = (data[1] << 8) + 4;	/* usually 0x0004 */
739510e884cSFrank Schaefer 
74029b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev,
741290ef7d8SAntonio Cardace 			 "EEPROM ID = %4ph, EEPROM hash = 0x%08lx\n",
742290ef7d8SAntonio Cardace 			 data, dev->hash);
74329b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev,
744ce8591ffSMauro Carvalho Chehab 			 "EEPROM info:\n");
74529b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev,
746ce8591ffSMauro Carvalho Chehab 			 "\tmicrocode start address = 0x%04x, boot configuration = 0x%02x\n",
747510e884cSFrank Schaefer 			 mc_start, data[2]);
748fa74aca3SFrank Schaefer 		/*
749fa74aca3SFrank Schaefer 		 * boot configuration (address 0x0002):
75087b52439SFrank Schaefer 		 * [0]   microcode download speed: 1 = 400 kHz; 0 = 100 kHz
75187b52439SFrank Schaefer 		 * [1]   always selects 12 kb RAM
75287b52439SFrank Schaefer 		 * [2]   USB device speed: 1 = force Full Speed; 0 = auto detect
75387b52439SFrank Schaefer 		 * [4]   1 = force fast mode and no suspend for device testing
75487b52439SFrank Schaefer 		 * [5:7] USB PHY tuning registers; determined by device
75587b52439SFrank Schaefer 		 *       characterization
75687b52439SFrank Schaefer 		 */
75787b52439SFrank Schaefer 
758fa74aca3SFrank Schaefer 		/*
759fa74aca3SFrank Schaefer 		 * Read hardware config dataset offset from address
760fa74aca3SFrank Schaefer 		 * (microcode start + 46)
761fa74aca3SFrank Schaefer 		 */
762aab3125cSMauro Carvalho Chehab 		err = em28xx_i2c_read_block(dev, bus, mc_start + 46, 1, 2,
763aab3125cSMauro Carvalho Chehab 					    data);
764510e884cSFrank Schaefer 		if (err != 2) {
76529b05e22SMauro Carvalho Chehab 			dev_err(&dev->intf->dev,
766ce8591ffSMauro Carvalho Chehab 				"failed to read hardware configuration data from eeprom (err=%d)\n",
767510e884cSFrank Schaefer 				err);
768510e884cSFrank Schaefer 			goto error;
769510e884cSFrank Schaefer 		}
77087b52439SFrank Schaefer 
771510e884cSFrank Schaefer 		/* Calculate hardware config dataset start address */
772510e884cSFrank Schaefer 		hwconf_offset = mc_start + data[0] + (data[1] << 8);
773510e884cSFrank Schaefer 
774510e884cSFrank Schaefer 		/* Read hardware config dataset */
775fa74aca3SFrank Schaefer 		/*
776fa74aca3SFrank Schaefer 		 * NOTE: the microcode copy can be multiple pages long, but
777510e884cSFrank Schaefer 		 * we assume the hardware config dataset is the same as in
778510e884cSFrank Schaefer 		 * the old eeprom and not longer than 256 bytes.
779510e884cSFrank Schaefer 		 * tveeprom is currently also limited to 256 bytes.
780510e884cSFrank Schaefer 		 */
781aab3125cSMauro Carvalho Chehab 		err = em28xx_i2c_read_block(dev, bus, hwconf_offset, 1, len,
782aab3125cSMauro Carvalho Chehab 					    data);
783510e884cSFrank Schaefer 		if (err != len) {
78429b05e22SMauro Carvalho Chehab 			dev_err(&dev->intf->dev,
785ce8591ffSMauro Carvalho Chehab 				"failed to read hardware configuration data from eeprom (err=%d)\n",
786510e884cSFrank Schaefer 				err);
787510e884cSFrank Schaefer 			goto error;
788510e884cSFrank Schaefer 		}
789510e884cSFrank Schaefer 
790510e884cSFrank Schaefer 		/* Verify hardware config dataset */
791510e884cSFrank Schaefer 		/* NOTE: not all devices provide this type of dataset */
792510e884cSFrank Schaefer 		if (data[0] != 0x1a || data[1] != 0xeb ||
793a217968fSFrank Schaefer 		    data[2] != 0x67 || data[3] != 0x95) {
79429b05e22SMauro Carvalho Chehab 			dev_info(&dev->intf->dev,
795ce8591ffSMauro Carvalho Chehab 				 "\tno hardware configuration dataset found in eeprom\n");
796510e884cSFrank Schaefer 			kfree(data);
797510e884cSFrank Schaefer 			return 0;
798510e884cSFrank Schaefer 		}
799510e884cSFrank Schaefer 
8008adbc7d6SMauro Carvalho Chehab 		/*
8018adbc7d6SMauro Carvalho Chehab 		 * TODO: decrypt eeprom data for camera bridges
8028adbc7d6SMauro Carvalho Chehab 		 * (em25xx, em276x+)
8038adbc7d6SMauro Carvalho Chehab 		 */
804510e884cSFrank Schaefer 
805510e884cSFrank Schaefer 	} else if (!dev->eeprom_addrwidth_16bit &&
806510e884cSFrank Schaefer 		   data[0] == 0x1a && data[1] == 0xeb &&
807510e884cSFrank Schaefer 		   data[2] == 0x67 && data[3] == 0x95) {
808510e884cSFrank Schaefer 		dev->hash = em28xx_hash_mem(data, len, 32);
80929b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev,
810290ef7d8SAntonio Cardace 			 "EEPROM ID = %4ph, EEPROM hash = 0x%08lx\n",
811290ef7d8SAntonio Cardace 			 data, dev->hash);
81229b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev,
813ce8591ffSMauro Carvalho Chehab 			 "EEPROM info:\n");
814510e884cSFrank Schaefer 	} else {
81529b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev,
816ce8591ffSMauro Carvalho Chehab 			 "unknown eeprom format or eeprom corrupted !\n");
817510e884cSFrank Schaefer 		err = -ENODEV;
818510e884cSFrank Schaefer 		goto error;
819f55eacbeSFrank Schaefer 	}
820f55eacbeSFrank Schaefer 
821a217968fSFrank Schaefer 	*eedata = data;
822510e884cSFrank Schaefer 	*eedata_len = len;
82332bf7c6cSAlban Browaeys 	dev_config = (void *)*eedata;
824a217968fSFrank Schaefer 
825510e884cSFrank Schaefer 	switch (le16_to_cpu(dev_config->chip_conf) >> 4 & 0x3) {
8260c0d06caSMauro Carvalho Chehab 	case 0:
82729b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\tNo audio on board.\n");
8280c0d06caSMauro Carvalho Chehab 		break;
8290c0d06caSMauro Carvalho Chehab 	case 1:
83029b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\tAC97 audio (5 sample rates)\n");
8310c0d06caSMauro Carvalho Chehab 		break;
8320c0d06caSMauro Carvalho Chehab 	case 2:
833687ff8b0SFrank Schaefer 		if (dev->chip_id < CHIP_ID_EM2860)
83429b05e22SMauro Carvalho Chehab 			dev_info(&dev->intf->dev,
835ce8591ffSMauro Carvalho Chehab 				 "\tI2S audio, sample rate=32k\n");
836687ff8b0SFrank Schaefer 		else
83729b05e22SMauro Carvalho Chehab 			dev_info(&dev->intf->dev,
838ce8591ffSMauro Carvalho Chehab 				 "\tI2S audio, 3 sample rates\n");
8390c0d06caSMauro Carvalho Chehab 		break;
8400c0d06caSMauro Carvalho Chehab 	case 3:
841687ff8b0SFrank Schaefer 		if (dev->chip_id < CHIP_ID_EM2860)
84229b05e22SMauro Carvalho Chehab 			dev_info(&dev->intf->dev,
843ce8591ffSMauro Carvalho Chehab 				 "\tI2S audio, 3 sample rates\n");
844687ff8b0SFrank Schaefer 		else
84529b05e22SMauro Carvalho Chehab 			dev_info(&dev->intf->dev,
846ce8591ffSMauro Carvalho Chehab 				 "\tI2S audio, 5 sample rates\n");
8470c0d06caSMauro Carvalho Chehab 		break;
8480c0d06caSMauro Carvalho Chehab 	}
8490c0d06caSMauro Carvalho Chehab 
850510e884cSFrank Schaefer 	if (le16_to_cpu(dev_config->chip_conf) & 1 << 3)
85129b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\tUSB Remote wakeup capable\n");
8520c0d06caSMauro Carvalho Chehab 
853510e884cSFrank Schaefer 	if (le16_to_cpu(dev_config->chip_conf) & 1 << 2)
85429b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\tUSB Self power capable\n");
8550c0d06caSMauro Carvalho Chehab 
856510e884cSFrank Schaefer 	switch (le16_to_cpu(dev_config->chip_conf) & 0x3) {
8570c0d06caSMauro Carvalho Chehab 	case 0:
85829b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\t500mA max power\n");
8590c0d06caSMauro Carvalho Chehab 		break;
8600c0d06caSMauro Carvalho Chehab 	case 1:
86129b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\t400mA max power\n");
8620c0d06caSMauro Carvalho Chehab 		break;
8630c0d06caSMauro Carvalho Chehab 	case 2:
86429b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\t300mA max power\n");
8650c0d06caSMauro Carvalho Chehab 		break;
8660c0d06caSMauro Carvalho Chehab 	case 3:
86729b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev, "\t200mA max power\n");
8680c0d06caSMauro Carvalho Chehab 		break;
8690c0d06caSMauro Carvalho Chehab 	}
87029b05e22SMauro Carvalho Chehab 	dev_info(&dev->intf->dev,
871ce8591ffSMauro Carvalho Chehab 		 "\tTable at offset 0x%02x, strings=0x%04x, 0x%04x, 0x%04x\n",
872510e884cSFrank Schaefer 		 dev_config->string_idx_table,
873510e884cSFrank Schaefer 		 le16_to_cpu(dev_config->string1),
874510e884cSFrank Schaefer 		 le16_to_cpu(dev_config->string2),
875510e884cSFrank Schaefer 		 le16_to_cpu(dev_config->string3));
8760c0d06caSMauro Carvalho Chehab 
8770c0d06caSMauro Carvalho Chehab 	return 0;
878510e884cSFrank Schaefer 
879510e884cSFrank Schaefer error:
880510e884cSFrank Schaefer 	kfree(data);
881510e884cSFrank Schaefer 	return err;
8820c0d06caSMauro Carvalho Chehab }
8830c0d06caSMauro Carvalho Chehab 
8840c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */
8850c0d06caSMauro Carvalho Chehab 
8860c0d06caSMauro Carvalho Chehab /*
8870c0d06caSMauro Carvalho Chehab  * functionality()
8880c0d06caSMauro Carvalho Chehab  */
889aab3125cSMauro Carvalho Chehab static u32 functionality(struct i2c_adapter *i2c_adap)
8900c0d06caSMauro Carvalho Chehab {
891aab3125cSMauro Carvalho Chehab 	struct em28xx_i2c_bus *i2c_bus = i2c_adap->algo_data;
892aab3125cSMauro Carvalho Chehab 
8938adbc7d6SMauro Carvalho Chehab 	if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM28XX ||
8948adbc7d6SMauro Carvalho Chehab 	    i2c_bus->algo_type == EM28XX_I2C_ALGO_EM25XX_BUS_B) {
895a3ea4bf9SFrank Schaefer 		return I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL;
896a3ea4bf9SFrank Schaefer 	} else if (i2c_bus->algo_type == EM28XX_I2C_ALGO_EM2800)  {
897a3ea4bf9SFrank Schaefer 		return (I2C_FUNC_I2C | I2C_FUNC_SMBUS_EMUL) &
898a3ea4bf9SFrank Schaefer 			~I2C_FUNC_SMBUS_WRITE_BLOCK_DATA;
899a3ea4bf9SFrank Schaefer 	}
900a3ea4bf9SFrank Schaefer 
901a3ea4bf9SFrank Schaefer 	WARN(1, "Unknown i2c bus algorithm.\n");
902a3ea4bf9SFrank Schaefer 	return 0;
9030c0d06caSMauro Carvalho Chehab }
9040c0d06caSMauro Carvalho Chehab 
90578f2c50bSJulia Lawall static const struct i2c_algorithm em28xx_algo = {
9060c0d06caSMauro Carvalho Chehab 	.master_xfer   = em28xx_i2c_xfer,
9070c0d06caSMauro Carvalho Chehab 	.functionality = functionality,
9080c0d06caSMauro Carvalho Chehab };
9090c0d06caSMauro Carvalho Chehab 
9106843868fSBhumika Goyal static const struct i2c_adapter em28xx_adap_template = {
9110c0d06caSMauro Carvalho Chehab 	.owner = THIS_MODULE,
9120c0d06caSMauro Carvalho Chehab 	.name = "em28xx",
9130c0d06caSMauro Carvalho Chehab 	.algo = &em28xx_algo,
9140c0d06caSMauro Carvalho Chehab };
9150c0d06caSMauro Carvalho Chehab 
9162b83247fSBhumika Goyal static const struct i2c_client em28xx_client_template = {
9170c0d06caSMauro Carvalho Chehab 	.name = "em28xx internal",
9180c0d06caSMauro Carvalho Chehab };
9190c0d06caSMauro Carvalho Chehab 
9200c0d06caSMauro Carvalho Chehab /* ----------------------------------------------------------- */
9210c0d06caSMauro Carvalho Chehab 
9220c0d06caSMauro Carvalho Chehab /*
9230c0d06caSMauro Carvalho Chehab  * i2c_devs
9240c0d06caSMauro Carvalho Chehab  * incomplete list of known devices
9250c0d06caSMauro Carvalho Chehab  */
9260c0d06caSMauro Carvalho Chehab static char *i2c_devs[128] = {
9279aa785b1SWilson Michaels 	[0x1c >> 1] = "lgdt330x",
9280b3966e4SFrank Schaefer 	[0x3e >> 1] = "remote IR sensor",
9290c0d06caSMauro Carvalho Chehab 	[0x4a >> 1] = "saa7113h",
9300c0d06caSMauro Carvalho Chehab 	[0x52 >> 1] = "drxk",
9310c0d06caSMauro Carvalho Chehab 	[0x60 >> 1] = "remote IR sensor",
9320c0d06caSMauro Carvalho Chehab 	[0x8e >> 1] = "remote IR sensor",
9330c0d06caSMauro Carvalho Chehab 	[0x86 >> 1] = "tda9887",
9340c0d06caSMauro Carvalho Chehab 	[0x80 >> 1] = "msp34xx",
9350c0d06caSMauro Carvalho Chehab 	[0x88 >> 1] = "msp34xx",
9360c0d06caSMauro Carvalho Chehab 	[0xa0 >> 1] = "eeprom",
9370c0d06caSMauro Carvalho Chehab 	[0xb0 >> 1] = "tda9874",
9380c0d06caSMauro Carvalho Chehab 	[0xb8 >> 1] = "tvp5150a",
9390c0d06caSMauro Carvalho Chehab 	[0xba >> 1] = "webcam sensor or tvp5150a",
9400c0d06caSMauro Carvalho Chehab 	[0xc0 >> 1] = "tuner (analog)",
9410c0d06caSMauro Carvalho Chehab 	[0xc2 >> 1] = "tuner (analog)",
9420c0d06caSMauro Carvalho Chehab 	[0xc4 >> 1] = "tuner (analog)",
9430c0d06caSMauro Carvalho Chehab 	[0xc6 >> 1] = "tuner (analog)",
9440c0d06caSMauro Carvalho Chehab };
9450c0d06caSMauro Carvalho Chehab 
9460c0d06caSMauro Carvalho Chehab /*
9470c0d06caSMauro Carvalho Chehab  * do_i2c_scan()
9480c0d06caSMauro Carvalho Chehab  * check i2c address range for devices
9490c0d06caSMauro Carvalho Chehab  */
9508adbc7d6SMauro Carvalho Chehab void em28xx_do_i2c_scan(struct em28xx *dev, unsigned int bus)
9510c0d06caSMauro Carvalho Chehab {
9520c0d06caSMauro Carvalho Chehab 	u8 i2c_devicelist[128];
9530c0d06caSMauro Carvalho Chehab 	unsigned char buf;
9540c0d06caSMauro Carvalho Chehab 	int i, rc;
9550c0d06caSMauro Carvalho Chehab 
9562df34d3aSHans Verkuil 	memset(i2c_devicelist, 0, sizeof(i2c_devicelist));
9570c0d06caSMauro Carvalho Chehab 
9580c0d06caSMauro Carvalho Chehab 	for (i = 0; i < ARRAY_SIZE(i2c_devs); i++) {
959aab3125cSMauro Carvalho Chehab 		dev->i2c_client[bus].addr = i;
960aab3125cSMauro Carvalho Chehab 		rc = i2c_master_recv(&dev->i2c_client[bus], &buf, 0);
9610c0d06caSMauro Carvalho Chehab 		if (rc < 0)
9620c0d06caSMauro Carvalho Chehab 			continue;
9630c0d06caSMauro Carvalho Chehab 		i2c_devicelist[i] = i;
96429b05e22SMauro Carvalho Chehab 		dev_info(&dev->intf->dev,
965ce8591ffSMauro Carvalho Chehab 			 "found i2c device @ 0x%x on bus %d [%s]\n",
966aab3125cSMauro Carvalho Chehab 			 i << 1, bus, i2c_devs[i] ? i2c_devs[i] : "???");
9670c0d06caSMauro Carvalho Chehab 	}
9680c0d06caSMauro Carvalho Chehab 
969aab3125cSMauro Carvalho Chehab 	if (bus == dev->def_i2c_bus)
9700c0d06caSMauro Carvalho Chehab 		dev->i2c_hash = em28xx_hash_mem(i2c_devicelist,
9712df34d3aSHans Verkuil 						sizeof(i2c_devicelist), 32);
9720c0d06caSMauro Carvalho Chehab }
9730c0d06caSMauro Carvalho Chehab 
9740c0d06caSMauro Carvalho Chehab /*
9750c0d06caSMauro Carvalho Chehab  * em28xx_i2c_register()
9760c0d06caSMauro Carvalho Chehab  * register i2c bus
9770c0d06caSMauro Carvalho Chehab  */
9788adbc7d6SMauro Carvalho Chehab int em28xx_i2c_register(struct em28xx *dev, unsigned int bus,
979a3ea4bf9SFrank Schaefer 			enum em28xx_i2c_algo_type algo_type)
9800c0d06caSMauro Carvalho Chehab {
9810c0d06caSMauro Carvalho Chehab 	int retval;
9820c0d06caSMauro Carvalho Chehab 
9838adbc7d6SMauro Carvalho Chehab 	if (WARN_ON(!dev->em28xx_write_regs || !dev->em28xx_read_reg ||
9848adbc7d6SMauro Carvalho Chehab 		    !dev->em28xx_write_regs_req || !dev->em28xx_read_reg_req))
9858adbc7d6SMauro Carvalho Chehab 		return -ENODEV;
9860c0d06caSMauro Carvalho Chehab 
987aab3125cSMauro Carvalho Chehab 	if (bus >= NUM_I2C_BUSES)
988aab3125cSMauro Carvalho Chehab 		return -ENODEV;
989aab3125cSMauro Carvalho Chehab 
990aab3125cSMauro Carvalho Chehab 	dev->i2c_adap[bus] = em28xx_adap_template;
99129b05e22SMauro Carvalho Chehab 	dev->i2c_adap[bus].dev.parent = &dev->intf->dev;
992cc1e6315SMauro Carvalho Chehab 	strscpy(dev->i2c_adap[bus].name, dev_name(&dev->intf->dev),
993cc1e6315SMauro Carvalho Chehab 		sizeof(dev->i2c_adap[bus].name));
994aab3125cSMauro Carvalho Chehab 
995aab3125cSMauro Carvalho Chehab 	dev->i2c_bus[bus].bus = bus;
996a3ea4bf9SFrank Schaefer 	dev->i2c_bus[bus].algo_type = algo_type;
997aab3125cSMauro Carvalho Chehab 	dev->i2c_bus[bus].dev = dev;
998aab3125cSMauro Carvalho Chehab 	dev->i2c_adap[bus].algo_data = &dev->i2c_bus[bus];
999aab3125cSMauro Carvalho Chehab 
1000aab3125cSMauro Carvalho Chehab 	retval = i2c_add_adapter(&dev->i2c_adap[bus]);
10010c0d06caSMauro Carvalho Chehab 	if (retval < 0) {
100229b05e22SMauro Carvalho Chehab 		dev_err(&dev->intf->dev,
1003ce8591ffSMauro Carvalho Chehab 			"%s: i2c_add_adapter failed! retval [%d]\n",
10040c0d06caSMauro Carvalho Chehab 			__func__, retval);
10050c0d06caSMauro Carvalho Chehab 		return retval;
10060c0d06caSMauro Carvalho Chehab 	}
10070c0d06caSMauro Carvalho Chehab 
1008aab3125cSMauro Carvalho Chehab 	dev->i2c_client[bus] = em28xx_client_template;
1009aab3125cSMauro Carvalho Chehab 	dev->i2c_client[bus].adapter = &dev->i2c_adap[bus];
10100c0d06caSMauro Carvalho Chehab 
1011aab3125cSMauro Carvalho Chehab 	/* Up to now, all eeproms are at bus 0 */
1012aab3125cSMauro Carvalho Chehab 	if (!bus) {
10138adbc7d6SMauro Carvalho Chehab 		retval = em28xx_i2c_eeprom(dev, bus,
10148adbc7d6SMauro Carvalho Chehab 					   &dev->eedata, &dev->eedata_len);
10158adbc7d6SMauro Carvalho Chehab 		if (retval < 0 && retval != -ENODEV) {
101629b05e22SMauro Carvalho Chehab 			dev_err(&dev->intf->dev,
1017ce8591ffSMauro Carvalho Chehab 				"%s: em28xx_i2_eeprom failed! retval [%d]\n",
10180c0d06caSMauro Carvalho Chehab 				__func__, retval);
10190c0d06caSMauro Carvalho Chehab 		}
1020aab3125cSMauro Carvalho Chehab 	}
10210c0d06caSMauro Carvalho Chehab 
10220c0d06caSMauro Carvalho Chehab 	if (i2c_scan)
1023aab3125cSMauro Carvalho Chehab 		em28xx_do_i2c_scan(dev, bus);
10240c0d06caSMauro Carvalho Chehab 
10250c0d06caSMauro Carvalho Chehab 	return 0;
10260c0d06caSMauro Carvalho Chehab }
10270c0d06caSMauro Carvalho Chehab 
10280c0d06caSMauro Carvalho Chehab /*
10290c0d06caSMauro Carvalho Chehab  * em28xx_i2c_unregister()
10300c0d06caSMauro Carvalho Chehab  * unregister i2c_bus
10310c0d06caSMauro Carvalho Chehab  */
10328adbc7d6SMauro Carvalho Chehab int em28xx_i2c_unregister(struct em28xx *dev, unsigned int bus)
10330c0d06caSMauro Carvalho Chehab {
1034aab3125cSMauro Carvalho Chehab 	if (bus >= NUM_I2C_BUSES)
1035aab3125cSMauro Carvalho Chehab 		return -ENODEV;
1036aab3125cSMauro Carvalho Chehab 
1037aab3125cSMauro Carvalho Chehab 	i2c_del_adapter(&dev->i2c_adap[bus]);
10380c0d06caSMauro Carvalho Chehab 	return 0;
10390c0d06caSMauro Carvalho Chehab }
1040