162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * Driver for the Auvitek AU0828 USB bridge 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (c) 2008 Steven Toth <stoth@linuxtv.org> 662306a36Sopenharmony_ci */ 762306a36Sopenharmony_ci 862306a36Sopenharmony_ci#include "au0828.h" 962306a36Sopenharmony_ci 1062306a36Sopenharmony_ci#include <linux/module.h> 1162306a36Sopenharmony_ci#include <linux/moduleparam.h> 1262306a36Sopenharmony_ci#include <linux/init.h> 1362306a36Sopenharmony_ci#include <linux/delay.h> 1462306a36Sopenharmony_ci#include <linux/io.h> 1562306a36Sopenharmony_ci 1662306a36Sopenharmony_ci#include "media/tuner.h" 1762306a36Sopenharmony_ci#include <media/v4l2-common.h> 1862306a36Sopenharmony_ci 1962306a36Sopenharmony_cistatic int i2c_scan; 2062306a36Sopenharmony_cimodule_param(i2c_scan, int, 0444); 2162306a36Sopenharmony_ciMODULE_PARM_DESC(i2c_scan, "scan i2c bus at insmod time"); 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_ci#define I2C_WAIT_DELAY 25 2462306a36Sopenharmony_ci#define I2C_WAIT_RETRY 1000 2562306a36Sopenharmony_ci 2662306a36Sopenharmony_cistatic inline int i2c_slave_did_read_ack(struct i2c_adapter *i2c_adap) 2762306a36Sopenharmony_ci{ 2862306a36Sopenharmony_ci struct au0828_dev *dev = i2c_adap->algo_data; 2962306a36Sopenharmony_ci return au0828_read(dev, AU0828_I2C_STATUS_201) & 3062306a36Sopenharmony_ci AU0828_I2C_STATUS_NO_READ_ACK ? 0 : 1; 3162306a36Sopenharmony_ci} 3262306a36Sopenharmony_ci 3362306a36Sopenharmony_cistatic int i2c_wait_read_ack(struct i2c_adapter *i2c_adap) 3462306a36Sopenharmony_ci{ 3562306a36Sopenharmony_ci int count; 3662306a36Sopenharmony_ci 3762306a36Sopenharmony_ci for (count = 0; count < I2C_WAIT_RETRY; count++) { 3862306a36Sopenharmony_ci if (!i2c_slave_did_read_ack(i2c_adap)) 3962306a36Sopenharmony_ci break; 4062306a36Sopenharmony_ci udelay(I2C_WAIT_DELAY); 4162306a36Sopenharmony_ci } 4262306a36Sopenharmony_ci 4362306a36Sopenharmony_ci if (I2C_WAIT_RETRY == count) 4462306a36Sopenharmony_ci return 0; 4562306a36Sopenharmony_ci 4662306a36Sopenharmony_ci return 1; 4762306a36Sopenharmony_ci} 4862306a36Sopenharmony_ci 4962306a36Sopenharmony_cistatic inline int i2c_is_read_busy(struct i2c_adapter *i2c_adap) 5062306a36Sopenharmony_ci{ 5162306a36Sopenharmony_ci struct au0828_dev *dev = i2c_adap->algo_data; 5262306a36Sopenharmony_ci return au0828_read(dev, AU0828_I2C_STATUS_201) & 5362306a36Sopenharmony_ci AU0828_I2C_STATUS_READ_DONE ? 0 : 1; 5462306a36Sopenharmony_ci} 5562306a36Sopenharmony_ci 5662306a36Sopenharmony_cistatic int i2c_wait_read_done(struct i2c_adapter *i2c_adap) 5762306a36Sopenharmony_ci{ 5862306a36Sopenharmony_ci int count; 5962306a36Sopenharmony_ci 6062306a36Sopenharmony_ci for (count = 0; count < I2C_WAIT_RETRY; count++) { 6162306a36Sopenharmony_ci if (!i2c_is_read_busy(i2c_adap)) 6262306a36Sopenharmony_ci break; 6362306a36Sopenharmony_ci udelay(I2C_WAIT_DELAY); 6462306a36Sopenharmony_ci } 6562306a36Sopenharmony_ci 6662306a36Sopenharmony_ci if (I2C_WAIT_RETRY == count) 6762306a36Sopenharmony_ci return 0; 6862306a36Sopenharmony_ci 6962306a36Sopenharmony_ci return 1; 7062306a36Sopenharmony_ci} 7162306a36Sopenharmony_ci 7262306a36Sopenharmony_cistatic inline int i2c_is_write_done(struct i2c_adapter *i2c_adap) 7362306a36Sopenharmony_ci{ 7462306a36Sopenharmony_ci struct au0828_dev *dev = i2c_adap->algo_data; 7562306a36Sopenharmony_ci return au0828_read(dev, AU0828_I2C_STATUS_201) & 7662306a36Sopenharmony_ci AU0828_I2C_STATUS_WRITE_DONE ? 1 : 0; 7762306a36Sopenharmony_ci} 7862306a36Sopenharmony_ci 7962306a36Sopenharmony_cistatic int i2c_wait_write_done(struct i2c_adapter *i2c_adap) 8062306a36Sopenharmony_ci{ 8162306a36Sopenharmony_ci int count; 8262306a36Sopenharmony_ci 8362306a36Sopenharmony_ci for (count = 0; count < I2C_WAIT_RETRY; count++) { 8462306a36Sopenharmony_ci if (i2c_is_write_done(i2c_adap)) 8562306a36Sopenharmony_ci break; 8662306a36Sopenharmony_ci udelay(I2C_WAIT_DELAY); 8762306a36Sopenharmony_ci } 8862306a36Sopenharmony_ci 8962306a36Sopenharmony_ci if (I2C_WAIT_RETRY == count) 9062306a36Sopenharmony_ci return 0; 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci return 1; 9362306a36Sopenharmony_ci} 9462306a36Sopenharmony_ci 9562306a36Sopenharmony_cistatic inline int i2c_is_busy(struct i2c_adapter *i2c_adap) 9662306a36Sopenharmony_ci{ 9762306a36Sopenharmony_ci struct au0828_dev *dev = i2c_adap->algo_data; 9862306a36Sopenharmony_ci return au0828_read(dev, AU0828_I2C_STATUS_201) & 9962306a36Sopenharmony_ci AU0828_I2C_STATUS_BUSY ? 1 : 0; 10062306a36Sopenharmony_ci} 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_cistatic int i2c_wait_done(struct i2c_adapter *i2c_adap) 10362306a36Sopenharmony_ci{ 10462306a36Sopenharmony_ci int count; 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci for (count = 0; count < I2C_WAIT_RETRY; count++) { 10762306a36Sopenharmony_ci if (!i2c_is_busy(i2c_adap)) 10862306a36Sopenharmony_ci break; 10962306a36Sopenharmony_ci udelay(I2C_WAIT_DELAY); 11062306a36Sopenharmony_ci } 11162306a36Sopenharmony_ci 11262306a36Sopenharmony_ci if (I2C_WAIT_RETRY == count) 11362306a36Sopenharmony_ci return 0; 11462306a36Sopenharmony_ci 11562306a36Sopenharmony_ci return 1; 11662306a36Sopenharmony_ci} 11762306a36Sopenharmony_ci 11862306a36Sopenharmony_ci/* FIXME: Implement join handling correctly */ 11962306a36Sopenharmony_cistatic int i2c_sendbytes(struct i2c_adapter *i2c_adap, 12062306a36Sopenharmony_ci const struct i2c_msg *msg, int joined_rlen) 12162306a36Sopenharmony_ci{ 12262306a36Sopenharmony_ci int i, strobe = 0; 12362306a36Sopenharmony_ci struct au0828_dev *dev = i2c_adap->algo_data; 12462306a36Sopenharmony_ci u8 i2c_speed = dev->board.i2c_clk_divider; 12562306a36Sopenharmony_ci 12662306a36Sopenharmony_ci dprintk(4, "%s()\n", __func__); 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_MULTIBYTE_MODE_2FF, 0x01); 12962306a36Sopenharmony_ci 13062306a36Sopenharmony_ci if (((dev->board.tuner_type == TUNER_XC5000) || 13162306a36Sopenharmony_ci (dev->board.tuner_type == TUNER_XC5000C)) && 13262306a36Sopenharmony_ci (dev->board.tuner_addr == msg->addr)) { 13362306a36Sopenharmony_ci /* 13462306a36Sopenharmony_ci * Due to I2C clock stretch, we need to use a lower speed 13562306a36Sopenharmony_ci * on xc5000 for commands. However, firmware transfer can 13662306a36Sopenharmony_ci * speed up to 400 KHz. 13762306a36Sopenharmony_ci */ 13862306a36Sopenharmony_ci if (msg->len == 64) 13962306a36Sopenharmony_ci i2c_speed = AU0828_I2C_CLK_250KHZ; 14062306a36Sopenharmony_ci else 14162306a36Sopenharmony_ci i2c_speed = AU0828_I2C_CLK_20KHZ; 14262306a36Sopenharmony_ci } 14362306a36Sopenharmony_ci /* Set the I2C clock */ 14462306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_CLK_DIVIDER_202, i2c_speed); 14562306a36Sopenharmony_ci 14662306a36Sopenharmony_ci /* Hardware needs 8 bit addresses */ 14762306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_DEST_ADDR_203, msg->addr << 1); 14862306a36Sopenharmony_ci 14962306a36Sopenharmony_ci dprintk(4, "SEND: %02x\n", msg->addr); 15062306a36Sopenharmony_ci 15162306a36Sopenharmony_ci /* Deal with i2c_scan */ 15262306a36Sopenharmony_ci if (msg->len == 0) { 15362306a36Sopenharmony_ci /* The analog tuner detection code makes use of the SMBUS_QUICK 15462306a36Sopenharmony_ci message (which involves a zero length i2c write). To avoid 15562306a36Sopenharmony_ci checking the status register when we didn't strobe out any 15662306a36Sopenharmony_ci actual bytes to the bus, just do a read check. This is 15762306a36Sopenharmony_ci consistent with how I saw i2c device checking done in the 15862306a36Sopenharmony_ci USB trace of the Windows driver */ 15962306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_TRIGGER_200, 16062306a36Sopenharmony_ci AU0828_I2C_TRIGGER_READ); 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_ci if (!i2c_wait_done(i2c_adap)) 16362306a36Sopenharmony_ci return -EIO; 16462306a36Sopenharmony_ci 16562306a36Sopenharmony_ci if (i2c_wait_read_ack(i2c_adap)) 16662306a36Sopenharmony_ci return -EIO; 16762306a36Sopenharmony_ci 16862306a36Sopenharmony_ci return 0; 16962306a36Sopenharmony_ci } 17062306a36Sopenharmony_ci 17162306a36Sopenharmony_ci for (i = 0; i < msg->len;) { 17262306a36Sopenharmony_ci 17362306a36Sopenharmony_ci dprintk(4, " %02x\n", msg->buf[i]); 17462306a36Sopenharmony_ci 17562306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_WRITE_FIFO_205, msg->buf[i]); 17662306a36Sopenharmony_ci 17762306a36Sopenharmony_ci strobe++; 17862306a36Sopenharmony_ci i++; 17962306a36Sopenharmony_ci 18062306a36Sopenharmony_ci if ((strobe >= 4) || (i >= msg->len)) { 18162306a36Sopenharmony_ci 18262306a36Sopenharmony_ci /* Strobe the byte into the bus */ 18362306a36Sopenharmony_ci if (i < msg->len) 18462306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_TRIGGER_200, 18562306a36Sopenharmony_ci AU0828_I2C_TRIGGER_WRITE | 18662306a36Sopenharmony_ci AU0828_I2C_TRIGGER_HOLD); 18762306a36Sopenharmony_ci else 18862306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_TRIGGER_200, 18962306a36Sopenharmony_ci AU0828_I2C_TRIGGER_WRITE); 19062306a36Sopenharmony_ci 19162306a36Sopenharmony_ci /* Reset strobe trigger */ 19262306a36Sopenharmony_ci strobe = 0; 19362306a36Sopenharmony_ci 19462306a36Sopenharmony_ci if (!i2c_wait_write_done(i2c_adap)) 19562306a36Sopenharmony_ci return -EIO; 19662306a36Sopenharmony_ci 19762306a36Sopenharmony_ci } 19862306a36Sopenharmony_ci 19962306a36Sopenharmony_ci } 20062306a36Sopenharmony_ci if (!i2c_wait_done(i2c_adap)) 20162306a36Sopenharmony_ci return -EIO; 20262306a36Sopenharmony_ci 20362306a36Sopenharmony_ci dprintk(4, "\n"); 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci return msg->len; 20662306a36Sopenharmony_ci} 20762306a36Sopenharmony_ci 20862306a36Sopenharmony_ci/* FIXME: Implement join handling correctly */ 20962306a36Sopenharmony_cistatic int i2c_readbytes(struct i2c_adapter *i2c_adap, 21062306a36Sopenharmony_ci const struct i2c_msg *msg, int joined) 21162306a36Sopenharmony_ci{ 21262306a36Sopenharmony_ci struct au0828_dev *dev = i2c_adap->algo_data; 21362306a36Sopenharmony_ci u8 i2c_speed = dev->board.i2c_clk_divider; 21462306a36Sopenharmony_ci int i; 21562306a36Sopenharmony_ci 21662306a36Sopenharmony_ci dprintk(4, "%s()\n", __func__); 21762306a36Sopenharmony_ci 21862306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_MULTIBYTE_MODE_2FF, 0x01); 21962306a36Sopenharmony_ci 22062306a36Sopenharmony_ci /* 22162306a36Sopenharmony_ci * Due to xc5000c clock stretch, we cannot use full speed at 22262306a36Sopenharmony_ci * readings from xc5000, as otherwise they'll fail. 22362306a36Sopenharmony_ci */ 22462306a36Sopenharmony_ci if (((dev->board.tuner_type == TUNER_XC5000) || 22562306a36Sopenharmony_ci (dev->board.tuner_type == TUNER_XC5000C)) && 22662306a36Sopenharmony_ci (dev->board.tuner_addr == msg->addr)) 22762306a36Sopenharmony_ci i2c_speed = AU0828_I2C_CLK_20KHZ; 22862306a36Sopenharmony_ci 22962306a36Sopenharmony_ci /* Set the I2C clock */ 23062306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_CLK_DIVIDER_202, i2c_speed); 23162306a36Sopenharmony_ci 23262306a36Sopenharmony_ci /* Hardware needs 8 bit addresses */ 23362306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_DEST_ADDR_203, msg->addr << 1); 23462306a36Sopenharmony_ci 23562306a36Sopenharmony_ci dprintk(4, " RECV:\n"); 23662306a36Sopenharmony_ci 23762306a36Sopenharmony_ci /* Deal with i2c_scan */ 23862306a36Sopenharmony_ci if (msg->len == 0) { 23962306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_TRIGGER_200, 24062306a36Sopenharmony_ci AU0828_I2C_TRIGGER_READ); 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_ci if (i2c_wait_read_ack(i2c_adap)) 24362306a36Sopenharmony_ci return -EIO; 24462306a36Sopenharmony_ci return 0; 24562306a36Sopenharmony_ci } 24662306a36Sopenharmony_ci 24762306a36Sopenharmony_ci for (i = 0; i < msg->len;) { 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci i++; 25062306a36Sopenharmony_ci 25162306a36Sopenharmony_ci if (i < msg->len) 25262306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_TRIGGER_200, 25362306a36Sopenharmony_ci AU0828_I2C_TRIGGER_READ | 25462306a36Sopenharmony_ci AU0828_I2C_TRIGGER_HOLD); 25562306a36Sopenharmony_ci else 25662306a36Sopenharmony_ci au0828_write(dev, AU0828_I2C_TRIGGER_200, 25762306a36Sopenharmony_ci AU0828_I2C_TRIGGER_READ); 25862306a36Sopenharmony_ci 25962306a36Sopenharmony_ci if (!i2c_wait_read_done(i2c_adap)) 26062306a36Sopenharmony_ci return -EIO; 26162306a36Sopenharmony_ci 26262306a36Sopenharmony_ci msg->buf[i-1] = au0828_read(dev, AU0828_I2C_READ_FIFO_209) & 26362306a36Sopenharmony_ci 0xff; 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_ci dprintk(4, " %02x\n", msg->buf[i-1]); 26662306a36Sopenharmony_ci } 26762306a36Sopenharmony_ci if (!i2c_wait_done(i2c_adap)) 26862306a36Sopenharmony_ci return -EIO; 26962306a36Sopenharmony_ci 27062306a36Sopenharmony_ci dprintk(4, "\n"); 27162306a36Sopenharmony_ci 27262306a36Sopenharmony_ci return msg->len; 27362306a36Sopenharmony_ci} 27462306a36Sopenharmony_ci 27562306a36Sopenharmony_cistatic int i2c_xfer(struct i2c_adapter *i2c_adap, 27662306a36Sopenharmony_ci struct i2c_msg *msgs, int num) 27762306a36Sopenharmony_ci{ 27862306a36Sopenharmony_ci int i, retval = 0; 27962306a36Sopenharmony_ci 28062306a36Sopenharmony_ci dprintk(4, "%s(num = %d)\n", __func__, num); 28162306a36Sopenharmony_ci 28262306a36Sopenharmony_ci for (i = 0; i < num; i++) { 28362306a36Sopenharmony_ci dprintk(4, "%s(num = %d) addr = 0x%02x len = 0x%x\n", 28462306a36Sopenharmony_ci __func__, num, msgs[i].addr, msgs[i].len); 28562306a36Sopenharmony_ci if (msgs[i].flags & I2C_M_RD) { 28662306a36Sopenharmony_ci /* read */ 28762306a36Sopenharmony_ci retval = i2c_readbytes(i2c_adap, &msgs[i], 0); 28862306a36Sopenharmony_ci } else if (i + 1 < num && (msgs[i + 1].flags & I2C_M_RD) && 28962306a36Sopenharmony_ci msgs[i].addr == msgs[i + 1].addr) { 29062306a36Sopenharmony_ci /* write then read from same address */ 29162306a36Sopenharmony_ci retval = i2c_sendbytes(i2c_adap, &msgs[i], 29262306a36Sopenharmony_ci msgs[i + 1].len); 29362306a36Sopenharmony_ci if (retval < 0) 29462306a36Sopenharmony_ci goto err; 29562306a36Sopenharmony_ci i++; 29662306a36Sopenharmony_ci retval = i2c_readbytes(i2c_adap, &msgs[i], 1); 29762306a36Sopenharmony_ci } else { 29862306a36Sopenharmony_ci /* write */ 29962306a36Sopenharmony_ci retval = i2c_sendbytes(i2c_adap, &msgs[i], 0); 30062306a36Sopenharmony_ci } 30162306a36Sopenharmony_ci if (retval < 0) 30262306a36Sopenharmony_ci goto err; 30362306a36Sopenharmony_ci } 30462306a36Sopenharmony_ci return num; 30562306a36Sopenharmony_ci 30662306a36Sopenharmony_cierr: 30762306a36Sopenharmony_ci return retval; 30862306a36Sopenharmony_ci} 30962306a36Sopenharmony_ci 31062306a36Sopenharmony_cistatic u32 au0828_functionality(struct i2c_adapter *adap) 31162306a36Sopenharmony_ci{ 31262306a36Sopenharmony_ci return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_I2C; 31362306a36Sopenharmony_ci} 31462306a36Sopenharmony_ci 31562306a36Sopenharmony_cistatic const struct i2c_algorithm au0828_i2c_algo_template = { 31662306a36Sopenharmony_ci .master_xfer = i2c_xfer, 31762306a36Sopenharmony_ci .functionality = au0828_functionality, 31862306a36Sopenharmony_ci}; 31962306a36Sopenharmony_ci 32062306a36Sopenharmony_ci/* ----------------------------------------------------------------------- */ 32162306a36Sopenharmony_ci 32262306a36Sopenharmony_cistatic const struct i2c_adapter au0828_i2c_adap_template = { 32362306a36Sopenharmony_ci .name = KBUILD_MODNAME, 32462306a36Sopenharmony_ci .owner = THIS_MODULE, 32562306a36Sopenharmony_ci .algo = &au0828_i2c_algo_template, 32662306a36Sopenharmony_ci}; 32762306a36Sopenharmony_ci 32862306a36Sopenharmony_cistatic const struct i2c_client au0828_i2c_client_template = { 32962306a36Sopenharmony_ci .name = "au0828 internal", 33062306a36Sopenharmony_ci}; 33162306a36Sopenharmony_ci 33262306a36Sopenharmony_cistatic char *i2c_devs[128] = { 33362306a36Sopenharmony_ci [0x8e >> 1] = "au8522", 33462306a36Sopenharmony_ci [0xa0 >> 1] = "eeprom", 33562306a36Sopenharmony_ci [0xc2 >> 1] = "tuner/xc5000", 33662306a36Sopenharmony_ci}; 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_cistatic void do_i2c_scan(char *name, struct i2c_client *c) 33962306a36Sopenharmony_ci{ 34062306a36Sopenharmony_ci unsigned char buf; 34162306a36Sopenharmony_ci int i, rc; 34262306a36Sopenharmony_ci 34362306a36Sopenharmony_ci for (i = 0; i < 128; i++) { 34462306a36Sopenharmony_ci c->addr = i; 34562306a36Sopenharmony_ci rc = i2c_master_recv(c, &buf, 0); 34662306a36Sopenharmony_ci if (rc < 0) 34762306a36Sopenharmony_ci continue; 34862306a36Sopenharmony_ci pr_info("%s: i2c scan: found device @ 0x%x [%s]\n", 34962306a36Sopenharmony_ci name, i << 1, i2c_devs[i] ? i2c_devs[i] : "???"); 35062306a36Sopenharmony_ci } 35162306a36Sopenharmony_ci} 35262306a36Sopenharmony_ci 35362306a36Sopenharmony_ci/* init + register i2c adapter */ 35462306a36Sopenharmony_ciint au0828_i2c_register(struct au0828_dev *dev) 35562306a36Sopenharmony_ci{ 35662306a36Sopenharmony_ci dprintk(1, "%s()\n", __func__); 35762306a36Sopenharmony_ci 35862306a36Sopenharmony_ci dev->i2c_adap = au0828_i2c_adap_template; 35962306a36Sopenharmony_ci dev->i2c_algo = au0828_i2c_algo_template; 36062306a36Sopenharmony_ci dev->i2c_client = au0828_i2c_client_template; 36162306a36Sopenharmony_ci 36262306a36Sopenharmony_ci dev->i2c_adap.dev.parent = &dev->usbdev->dev; 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_ci strscpy(dev->i2c_adap.name, KBUILD_MODNAME, 36562306a36Sopenharmony_ci sizeof(dev->i2c_adap.name)); 36662306a36Sopenharmony_ci 36762306a36Sopenharmony_ci dev->i2c_adap.algo = &dev->i2c_algo; 36862306a36Sopenharmony_ci dev->i2c_adap.algo_data = dev; 36962306a36Sopenharmony_ci#ifdef CONFIG_VIDEO_AU0828_V4L2 37062306a36Sopenharmony_ci i2c_set_adapdata(&dev->i2c_adap, &dev->v4l2_dev); 37162306a36Sopenharmony_ci#else 37262306a36Sopenharmony_ci i2c_set_adapdata(&dev->i2c_adap, dev); 37362306a36Sopenharmony_ci#endif 37462306a36Sopenharmony_ci i2c_add_adapter(&dev->i2c_adap); 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_ci dev->i2c_client.adapter = &dev->i2c_adap; 37762306a36Sopenharmony_ci 37862306a36Sopenharmony_ci if (0 == dev->i2c_rc) { 37962306a36Sopenharmony_ci pr_info("i2c bus registered\n"); 38062306a36Sopenharmony_ci if (i2c_scan) 38162306a36Sopenharmony_ci do_i2c_scan(KBUILD_MODNAME, &dev->i2c_client); 38262306a36Sopenharmony_ci } else 38362306a36Sopenharmony_ci pr_info("i2c bus register FAILED\n"); 38462306a36Sopenharmony_ci 38562306a36Sopenharmony_ci return dev->i2c_rc; 38662306a36Sopenharmony_ci} 38762306a36Sopenharmony_ci 38862306a36Sopenharmony_ciint au0828_i2c_unregister(struct au0828_dev *dev) 38962306a36Sopenharmony_ci{ 39062306a36Sopenharmony_ci i2c_del_adapter(&dev->i2c_adap); 39162306a36Sopenharmony_ci return 0; 39262306a36Sopenharmony_ci} 39362306a36Sopenharmony_ci 394