drivers/staging/tm6000/tm6000-i2c.c - kernel/skids - Git at Google

 /*
    tm6000-i2c.c - driver for TM5600/TM6000/TM6010 USB video capture devices

    Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org>

    Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>
 	- Fix SMBus Read Byte command

    This program is free software; you can redistribute it and/or modify
    it under the terms of the GNU General Public License as published by
    the Free Software Foundation version 2

    This program is distributed in the hope that it will be useful,
    but WITHOUT ANY WARRANTY; without even the implied warranty of
    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
    GNU General Public License for more details.

    You should have received a copy of the GNU General Public License
    along with this program; if not, write to the Free Software
    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  */

 #include <linux/module.h>
 #include <linux/kernel.h>
 #include <linux/usb.h>
 #include <linux/i2c.h>

 #include "tm6000.h"
 #include "tm6000-regs.h"
 #include <media/v4l2-common.h>
 #include <media/tuner.h>
 #include "tuner-xc2028.h"


 /*FIXME: Hack to avoid needing to patch i2c-id.h */
 #define I2C_HW_B_TM6000 I2C_HW_B_EM28XX
 /* ----------------------------------------------------------- */

 static unsigned int i2c_debug = 0;
 module_param(i2c_debug, int, 0644);
 MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");

 #define i2c_dprintk(lvl,fmt, args...) if (i2c_debug>=lvl) do{ \
 			printk(KERN_DEBUG "%s at %s: " fmt, \
 			dev->name, __FUNCTION__ , ##args); } while (0)

 static int tm6000_i2c_send_regs(struct tm6000_core *dev, unsigned char addr,
 				__u8 reg, char *buf, int len)
 {
 	int rc;
 	unsigned int tsleep;
 	unsigned int i2c_packet_limit = 16;

 	if (dev->dev_type == TM6010)
 		i2c_packet_limit = 64;

 	if (!buf)
 		return -1;

 	if (len < 1 || len > i2c_packet_limit) {
 		printk(KERN_ERR "Incorrect length of i2c packet = %d, limit set to %d\n",
 			len, i2c_packet_limit);
 		return -1;
 	}

 	/* capture mutex */
 	rc = tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR |
 		USB_RECIP_DEVICE, REQ_16_SET_GET_I2C_WR1_RDN,
 		addr | reg << 8, 0, buf, len);

 	if (rc < 0) {
 		/* release mutex */
 		return rc;
 	}

 	/* Calculate delay time, 14000us for 64 bytes */
 	tsleep = ((len * 200) + 200 + 1000) / 1000;
 	msleep(tsleep);

 	/* release mutex */
 	return rc;
 }

 /* Generic read - doesn't work fine with 16bit registers */
 static int tm6000_i2c_recv_regs(struct tm6000_core *dev, unsigned char addr,
 				__u8 reg, char *buf, int len)
 {
 	int rc;
 	u8 b[2];
 	unsigned int i2c_packet_limit = 16;

 	if (dev->dev_type == TM6010)
 		i2c_packet_limit = 64;

 	if (!buf)
 		return -1;

 	if (len < 1 || len > i2c_packet_limit) {
 		printk(KERN_ERR "Incorrect length of i2c packet = %d, limit set to %d\n",
 			len, i2c_packet_limit);
 		return -1;
 	}

 	/* capture mutex */
 	if ((dev->caps.has_zl10353) && (dev->demod_addr << 1 == addr) && (reg % 2 == 0)) {
 		/*
 		 * Workaround an I2C bug when reading from zl10353
 		 */
 		reg -= 1;
 		len += 1;

 		rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 			REQ_16_SET_GET_I2C_WR1_RDN, addr | reg << 8, 0, b, len);

 		*buf = b[1];
 	} else {
 		rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR | USB_RECIP_DEVICE,
 			REQ_16_SET_GET_I2C_WR1_RDN, addr | reg << 8, 0, buf, len);
 	}

 	/* release mutex */
 	return rc;
 }

 /*
  * read from a 16bit register
  * for example xc2028, xc3028 or xc3028L
  */
 static int tm6000_i2c_recv_regs16(struct tm6000_core *dev, unsigned char addr,
 				  __u16 reg, char *buf, int len)
 {
 	int rc;
 	unsigned char ureg;

 	if (!buf || len != 2)
 		return -1;

 	/* capture mutex */
 	if (dev->dev_type == TM6010) {
 		ureg = reg & 0xFF;
 		rc = tm6000_read_write_usb(dev, USB_DIR_OUT | USB_TYPE_VENDOR |
 			USB_RECIP_DEVICE, REQ_16_SET_GET_I2C_WR1_RDN,
 			addr | (reg & 0xFF00), 0, &ureg, 1);

 		if (rc < 0) {
 			/* release mutex */
 			return rc;
 		}

 		msleep(1400 / 1000);
 		rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR |
 			USB_RECIP_DEVICE, REQ_35_AFTEK_TUNER_READ,
 			reg, 0, buf, len);
 	} else {
 		rc = tm6000_read_write_usb(dev, USB_DIR_IN | USB_TYPE_VENDOR |
 			USB_RECIP_DEVICE, REQ_14_SET_GET_I2C_WR2_RDN,
 			addr, reg, buf, len);
 	}

 	/* release mutex */
 	return rc;
 }

 static int tm6000_i2c_xfer(struct i2c_adapter *i2c_adap,
 			   struct i2c_msg msgs[], int num)
 {
 	struct tm6000_core *dev = i2c_adap->algo_data;
 	int addr, rc, i, byte;

 	if (num <= 0)
 		return 0;
 	for (i = 0; i < num; i++) {
 		addr = (msgs[i].addr << 1) & 0xff;
 		i2c_dprintk(2,"%s %s addr=0x%x len=%d:",
 			 (msgs[i].flags & I2C_M_RD) ? "read" : "write",
 			 i == num - 1 ? "stop" : "nonstop", addr, msgs[i].len);
 		if (msgs[i].flags & I2C_M_RD) {
 			/* read request without preceding register selection */
 			/*
 			 * The TM6000 only supports a read transaction
 			 * immediately after a 1 or 2 byte write to select
 			 * a register.  We cannot fulfil this request.
 			 */
 			i2c_dprintk(2, " read without preceding write not"
 				       " supported");
 			rc = -EOPNOTSUPP;
 			goto err;
 		} else if (i + 1 < num && msgs[i].len <= 2 &&
 			   (msgs[i + 1].flags & I2C_M_RD) &&
 			   msgs[i].addr == msgs[i + 1].addr) {
 			/* 1 or 2 byte write followed by a read */
 			if (i2c_debug >= 2)
 				for (byte = 0; byte < msgs[i].len; byte++)
 					printk(" %02x", msgs[i].buf[byte]);
 			i2c_dprintk(2, "; joined to read %s len=%d:",
 				    i == num - 2 ? "stop" : "nonstop",
 				    msgs[i + 1].len);

 			if (msgs[i].len == 2) {
 				rc = tm6000_i2c_recv_regs16(dev, addr,
 					msgs[i].buf[0] << 8 | msgs[i].buf[1],
 					msgs[i + 1].buf, msgs[i + 1].len);
 			} else {
 				rc = tm6000_i2c_recv_regs(dev, addr, msgs[i].buf[0],
 					msgs[i + 1].buf, msgs[i + 1].len);
 			}

 			i++;

 			if (addr == dev->tuner_addr << 1) {
 				tm6000_set_reg(dev, REQ_50_SET_START, 0, 0);
 				tm6000_set_reg(dev, REQ_51_SET_STOP, 0, 0);
 			}
 			if (i2c_debug >= 2)
 				for (byte = 0; byte < msgs[i].len; byte++)
 					printk(" %02x", msgs[i].buf[byte]);
 		} else {
 			/* write bytes */
 			if (i2c_debug >= 2)
 				for (byte = 0; byte < msgs[i].len; byte++)
 					printk(" %02x", msgs[i].buf[byte]);
 			rc = tm6000_i2c_send_regs(dev, addr, msgs[i].buf[0],
 				msgs[i].buf + 1, msgs[i].len - 1);

 			if (addr == dev->tuner_addr  << 1) {
 				tm6000_set_reg(dev, REQ_50_SET_START, 0, 0);
 				tm6000_set_reg(dev, REQ_51_SET_STOP, 0, 0);
 			}
 		}
 		if (i2c_debug >= 2)
 			printk("\n");
 		if (rc < 0)
 			goto err;
 	}

 	return num;
 err:
 	i2c_dprintk(2," ERROR: %i\n", rc);
 	return rc;
 }

 static int tm6000_i2c_eeprom(struct tm6000_core *dev,
 			     unsigned char *eedata, int len)
 {
 	int i, rc;
 	unsigned char *p = eedata;
 	unsigned char bytes[17];

 	dev->i2c_client.addr = 0xa0 >> 1;

 	bytes[16] = '\0';
 	for (i = 0; i < len; ) {
 	*p = i;
 	rc = tm6000_i2c_recv_regs(dev, 0xa0, i, p, 1);
 		if (rc < 1) {
 			if (p == eedata)
 				goto noeeprom;
 			else {
 				printk(KERN_WARNING
 				"%s: i2c eeprom read error (err=%d)\n",
 				dev->name, rc);
 			}
 			return -1;
 		}
 		p++;
 		if (0 == (i % 16))
 			printk(KERN_INFO "%s: i2c eeprom %02x:", dev->name, i);
 		printk(" %02x", eedata[i]);
 		if ((eedata[i] >= ' ') && (eedata[i] <= 'z')) {
 			bytes[i%16] = eedata[i];
 		} else {
 			bytes[i%16]='.';
 		}

 		i++;

 		if (0 == (i % 16)) {
 			bytes[16] = '\0';
 			printk("  %s\n", bytes);
 		}
 	}
 	if (0 != (i%16)) {
 		bytes[i%16] = '\0';
 		for (i %= 16; i < 16; i++)
 			printk("   ");
 	}
 	printk("  %s\n", bytes);

 	return 0;

 noeeprom:
 	printk(KERN_INFO "%s: Huh, no eeprom present (err=%d)?\n",
 		       dev->name, rc);
 	return rc;
 }

 /* ----------------------------------------------------------- */

 /*
  * functionality()
  */
 static u32 functionality(struct i2c_adapter *adap)
 {
 	return I2C_FUNC_SMBUS_EMUL;
 }

 #define mass_write(addr, reg, data...)					\
 	{ const static u8 _val[] = data;				\
 	rc=tm6000_read_write_usb(dev,USB_DIR_OUT | USB_TYPE_VENDOR,	\
 	REQ_16_SET_GET_I2C_WR1_RDN,(reg<<8)+addr, 0x00, (u8 *) _val,	\
 	ARRAY_SIZE(_val));						\
 	if (rc<0) {							\
 		printk(KERN_ERR "Error on line %d: %d\n",__LINE__,rc);	\
 		return rc;						\
 	}								\
 	msleep (10);							\
 	}

 static struct i2c_algorithm tm6000_algo = {
 	.master_xfer   = tm6000_i2c_xfer,
 	.functionality = functionality,
 };

 static struct i2c_adapter tm6000_adap_template = {
 	.owner = THIS_MODULE,
 	.class = I2C_CLASS_TV_ANALOG | I2C_CLASS_TV_DIGITAL,
 	.name = "tm6000",
 	.id = I2C_HW_B_TM6000,
 	.algo = &tm6000_algo,
 };

 static struct i2c_client tm6000_client_template = {
 	.name = "tm6000 internal",
 };

 /* ----------------------------------------------------------- */

 /*
  * tm6000_i2c_register()
  * register i2c bus
  */
 int tm6000_i2c_register(struct tm6000_core *dev)
 {
 	unsigned char eedata[256];

 	dev->i2c_adap = tm6000_adap_template;
 	dev->i2c_adap.dev.parent = &dev->udev->dev;
 	strcpy(dev->i2c_adap.name, dev->name);
 	dev->i2c_adap.algo_data = dev;
 	i2c_add_adapter(&dev->i2c_adap);

 	dev->i2c_client = tm6000_client_template;
 	dev->i2c_client.adapter = &dev->i2c_adap;

 	i2c_set_adapdata(&dev->i2c_adap, &dev->v4l2_dev);

 	tm6000_i2c_eeprom(dev, eedata, sizeof(eedata));

 	return 0;
 }

 /*
  * tm6000_i2c_unregister()
  * unregister i2c_bus
  */
 int tm6000_i2c_unregister(struct tm6000_core *dev)
 {
 	i2c_del_adapter(&dev->i2c_adap);
 	return 0;
 }
	/*
	tm6000-i2c.c - driver for TM5600/TM6000/TM6010 USB video capture devices

	Copyright (C) 2006-2007 Mauro Carvalho Chehab <mchehab@infradead.org>

	Copyright (C) 2007 Michel Ludwig <michel.ludwig@gmail.com>
	- Fix SMBus Read Byte command

	This program is free software; you can redistribute it and/or modify
	it under the terms of the GNU General Public License as published by
	the Free Software Foundation version 2

	This program is distributed in the hope that it will be useful,
	but WITHOUT ANY WARRANTY; without even the implied warranty of
	MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	GNU General Public License for more details.

	You should have received a copy of the GNU General Public License
	along with this program; if not, write to the Free Software
	Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	*/

	#include <linux/module.h>
	#include <linux/kernel.h>
	#include <linux/usb.h>
	#include <linux/i2c.h>

	#include "tm6000.h"
	#include "tm6000-regs.h"
	#include <media/v4l2-common.h>
	#include <media/tuner.h>
	#include "tuner-xc2028.h"


	/FIXME: Hack to avoid needing to patch i2c-id.h /
	#define I2C_HW_B_TM6000 I2C_HW_B_EM28XX
	/* ----------------------------------------------------------- */

	static unsigned int i2c_debug = 0;
	module_param(i2c_debug, int, 0644);
	MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");

	#define i2c_dprintk(lvl,fmt, args...) if (i2c_debug>=lvl) do{ \
	printk(KERN_DEBUG "%s at %s: " fmt, \
	dev->name, __FUNCTION__ , ##args); } while (0)

	static int tm6000_i2c_send_regs(struct tm6000_core *dev, unsigned char addr,
	__u8 reg, char *buf, int len)
	{
	int rc;
	unsigned int tsleep;
	unsigned int i2c_packet_limit = 16;

	if (dev->dev_type == TM6010)
	i2c_packet_limit = 64;

	if (!buf)
	return -1;

	if (len < 1 \|\| len > i2c_packet_limit) {
	printk(KERN_ERR "Incorrect length of i2c packet = %d, limit set to %d\n",
	len, i2c_packet_limit);
	return -1;
	}

	/* capture mutex */
	rc = tm6000_read_write_usb(dev, USB_DIR_OUT \| USB_TYPE_VENDOR \|
	USB_RECIP_DEVICE, REQ_16_SET_GET_I2C_WR1_RDN,
	addr \| reg << 8, 0, buf, len);

	if (rc < 0) {
	/* release mutex */
	return rc;
	}

	/* Calculate delay time, 14000us for 64 bytes */
	tsleep = ((len * 200) + 200 + 1000) / 1000;
	msleep(tsleep);

	/* release mutex */
	return rc;
	}

	/* Generic read - doesn't work fine with 16bit registers */
	static int tm6000_i2c_recv_regs(struct tm6000_core *dev, unsigned char addr,
	__u8 reg, char *buf, int len)
	{
	int rc;
	u8 b[2];
	unsigned int i2c_packet_limit = 16;

	if (dev->dev_type == TM6010)
	i2c_packet_limit = 64;

	if (!buf)
	return -1;

	if (len < 1 \|\| len > i2c_packet_limit) {
	printk(KERN_ERR "Incorrect length of i2c packet = %d, limit set to %d\n",
	len, i2c_packet_limit);
	return -1;
	}

	/* capture mutex */
	if ((dev->caps.has_zl10353) && (dev->demod_addr << 1 == addr) && (reg % 2 == 0)) {
	/*
	* Workaround an I2C bug when reading from zl10353
	*/
	reg -= 1;
	len += 1;

	rc = tm6000_read_write_usb(dev, USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	REQ_16_SET_GET_I2C_WR1_RDN, addr \| reg << 8, 0, b, len);

	*buf = b[1];
	} else {
	rc = tm6000_read_write_usb(dev, USB_DIR_IN \| USB_TYPE_VENDOR \| USB_RECIP_DEVICE,
	REQ_16_SET_GET_I2C_WR1_RDN, addr \| reg << 8, 0, buf, len);
	}

	/* release mutex */
	return rc;
	}

	/*
	* read from a 16bit register
	* for example xc2028, xc3028 or xc3028L
	*/
	static int tm6000_i2c_recv_regs16(struct tm6000_core *dev, unsigned char addr,
	__u16 reg, char *buf, int len)
	{
	int rc;
	unsigned char ureg;

	if (!buf \|\| len != 2)
	return -1;

	/* capture mutex */
	if (dev->dev_type == TM6010) {
	ureg = reg & 0xFF;
	rc = tm6000_read_write_usb(dev, USB_DIR_OUT \| USB_TYPE_VENDOR \|
	USB_RECIP_DEVICE, REQ_16_SET_GET_I2C_WR1_RDN,
	addr \| (reg & 0xFF00), 0, &ureg, 1);

	if (rc < 0) {
	/* release mutex */
	return rc;
	}

	msleep(1400 / 1000);
	rc = tm6000_read_write_usb(dev, USB_DIR_IN \| USB_TYPE_VENDOR \|
	USB_RECIP_DEVICE, REQ_35_AFTEK_TUNER_READ,
	reg, 0, buf, len);
	} else {
	rc = tm6000_read_write_usb(dev, USB_DIR_IN \| USB_TYPE_VENDOR \|
	USB_RECIP_DEVICE, REQ_14_SET_GET_I2C_WR2_RDN,
	addr, reg, buf, len);
	}

	/* release mutex */
	return rc;
	}

	static int tm6000_i2c_xfer(struct i2c_adapter *i2c_adap,
	struct i2c_msg msgs[], int num)
	{
	struct tm6000_core *dev = i2c_adap->algo_data;
	int addr, rc, i, byte;

	if (num <= 0)
	return 0;
	for (i = 0; i < num; i++) {
	addr = (msgs[i].addr << 1) & 0xff;
	i2c_dprintk(2,"%s %s addr=0x%x len=%d:",
	(msgs[i].flags & I2C_M_RD) ? "read" : "write",
	i == num - 1 ? "stop" : "nonstop", addr, msgs[i].len);
	if (msgs[i].flags & I2C_M_RD) {
	/* read request without preceding register selection */
	/*
	* The TM6000 only supports a read transaction
	* immediately after a 1 or 2 byte write to select
	* a register. We cannot fulfil this request.
	*/
	i2c_dprintk(2, " read without preceding write not"
	" supported");
	rc = -EOPNOTSUPP;
	goto err;
	} else if (i + 1 < num && msgs[i].len <= 2 &&
	(msgs[i + 1].flags & I2C_M_RD) &&
	msgs[i].addr == msgs[i + 1].addr) {
	/* 1 or 2 byte write followed by a read */
	if (i2c_debug >= 2)
	for (byte = 0; byte < msgs[i].len; byte++)
	printk(" %02x", msgs[i].buf[byte]);
	i2c_dprintk(2, "; joined to read %s len=%d:",
	i == num - 2 ? "stop" : "nonstop",
	msgs[i + 1].len);

	if (msgs[i].len == 2) {
	rc = tm6000_i2c_recv_regs16(dev, addr,
	msgs[i].buf[0] << 8 \| msgs[i].buf[1],
	msgs[i + 1].buf, msgs[i + 1].len);
	} else {
	rc = tm6000_i2c_recv_regs(dev, addr, msgs[i].buf[0],
	msgs[i + 1].buf, msgs[i + 1].len);
	}

	i++;

	if (addr == dev->tuner_addr << 1) {
	tm6000_set_reg(dev, REQ_50_SET_START, 0, 0);
	tm6000_set_reg(dev, REQ_51_SET_STOP, 0, 0);
	}
	if (i2c_debug >= 2)
	for (byte = 0; byte < msgs[i].len; byte++)
	printk(" %02x", msgs[i].buf[byte]);
	} else {
	/* write bytes */
	if (i2c_debug >= 2)
	for (byte = 0; byte < msgs[i].len; byte++)
	printk(" %02x", msgs[i].buf[byte]);
	rc = tm6000_i2c_send_regs(dev, addr, msgs[i].buf[0],
	msgs[i].buf + 1, msgs[i].len - 1);

	if (addr == dev->tuner_addr << 1) {
	tm6000_set_reg(dev, REQ_50_SET_START, 0, 0);
	tm6000_set_reg(dev, REQ_51_SET_STOP, 0, 0);
	}
	}
	if (i2c_debug >= 2)
	printk("\n");
	if (rc < 0)
	goto err;
	}

	return num;
	err:
	i2c_dprintk(2," ERROR: %i\n", rc);
	return rc;
	}

	static int tm6000_i2c_eeprom(struct tm6000_core *dev,
	unsigned char *eedata, int len)
	{
	int i, rc;
	unsigned char *p = eedata;
	unsigned char bytes[17];

	dev->i2c_client.addr = 0xa0 >> 1;

	bytes[16] = '\0';
	for (i = 0; i < len; ) {
	*p = i;
	rc = tm6000_i2c_recv_regs(dev, 0xa0, i, p, 1);
	if (rc < 1) {
	if (p == eedata)
	goto noeeprom;
	else {
	printk(KERN_WARNING
	"%s: i2c eeprom read error (err=%d)\n",
	dev->name, rc);
	}
	return -1;
	}
	p++;
	if (0 == (i % 16))
	printk(KERN_INFO "%s: i2c eeprom %02x:", dev->name, i);
	printk(" %02x", eedata[i]);
	if ((eedata[i] >= ' ') && (eedata[i] <= 'z')) {
	bytes[i%16] = eedata[i];
	} else {
	bytes[i%16]='.';
	}

	i++;

	if (0 == (i % 16)) {
	bytes[16] = '\0';
	printk(" %s\n", bytes);
	}
	}
	if (0 != (i%16)) {
	bytes[i%16] = '\0';
	for (i %= 16; i < 16; i++)
	printk(" ");
	}
	printk(" %s\n", bytes);

	return 0;

	noeeprom:
	printk(KERN_INFO "%s: Huh, no eeprom present (err=%d)?\n",
	dev->name, rc);
	return rc;
	}

	/* ----------------------------------------------------------- */

	/*
	* functionality()
	*/
	static u32 functionality(struct i2c_adapter *adap)
	{
	return I2C_FUNC_SMBUS_EMUL;
	}

	#define mass_write(addr, reg, data...) \
	{ const static u8 _val[] = data; \
	rc=tm6000_read_write_usb(dev,USB_DIR_OUT \| USB_TYPE_VENDOR, \
	REQ_16_SET_GET_I2C_WR1_RDN,(reg<<8)+addr, 0x00, (u8 *) _val, \
	ARRAY_SIZE(_val)); \
	if (rc<0) { \
	printk(KERN_ERR "Error on line %d: %d\n",__LINE__,rc); \
	return rc; \
	} \
	msleep (10); \
	}

	static struct i2c_algorithm tm6000_algo = {
	.master_xfer = tm6000_i2c_xfer,
	.functionality = functionality,
	};

	static struct i2c_adapter tm6000_adap_template = {
	.owner = THIS_MODULE,
	.class = I2C_CLASS_TV_ANALOG \| I2C_CLASS_TV_DIGITAL,
	.name = "tm6000",
	.id = I2C_HW_B_TM6000,
	.algo = &tm6000_algo,
	};

	static struct i2c_client tm6000_client_template = {
	.name = "tm6000 internal",
	};

	/* ----------------------------------------------------------- */

	/*
	* tm6000_i2c_register()
	* register i2c bus
	*/
	int tm6000_i2c_register(struct tm6000_core *dev)
	{
	unsigned char eedata[256];

	dev->i2c_adap = tm6000_adap_template;
	dev->i2c_adap.dev.parent = &dev->udev->dev;
	strcpy(dev->i2c_adap.name, dev->name);
	dev->i2c_adap.algo_data = dev;
	i2c_add_adapter(&dev->i2c_adap);

	dev->i2c_client = tm6000_client_template;
	dev->i2c_client.adapter = &dev->i2c_adap;

	i2c_set_adapdata(&dev->i2c_adap, &dev->v4l2_dev);

	tm6000_i2c_eeprom(dev, eedata, sizeof(eedata));

	return 0;
	}

	/*
	* tm6000_i2c_unregister()
	* unregister i2c_bus
	*/
	int tm6000_i2c_unregister(struct tm6000_core *dev)
	{
	i2c_del_adapter(&dev->i2c_adap);
	return 0;
	}