Commit 1ff16c20 authored by Thierry MERLE's avatar Thierry MERLE Committed by Mauro Carvalho Chehab

V4L/DVB (5522): Usbvision: i2c function cleanups

usbvision-i2c function renamings, code cleanup
Signed-off-by: default avatarThierry MERLE <thierry.merle@free.fr>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@infradead.org>
parent d3df9c4f
...@@ -2238,7 +2238,7 @@ static void call_usbvision_power_off(struct work_struct *work) ...@@ -2238,7 +2238,7 @@ static void call_usbvision_power_off(struct work_struct *work)
PDEBUG(DBG_FUNC, ""); PDEBUG(DBG_FUNC, "");
down_interruptible(&usbvision->lock); down_interruptible(&usbvision->lock);
if(usbvision->user == 0) { if(usbvision->user == 0) {
usbvision_i2c_usb_del_bus(&usbvision->i2c_adap); usbvision_i2c_unregister(usbvision);
usbvision_power_off(usbvision); usbvision_power_off(usbvision);
usbvision->initialized = 0; usbvision->initialized = 0;
......
/* /*
* I2C_ALGO_USB.C * usbvision_i2c.c
* i2c algorithm for USB-I2C Bridges * i2c algorithm for USB-I2C Bridges
* *
* Copyright (c) 1999-2005 Joerg Heckenbach <joerg@heckenbach-aw.de> * Copyright (c) 1999-2007 Joerg Heckenbach <joerg@heckenbach-aw.de>
* Dwaine Garden <dwainegarden@rogers.com> * Dwaine Garden <dwainegarden@rogers.com>
* *
* This module is part of usbvision driver project. * This module is part of usbvision driver project.
...@@ -39,7 +39,6 @@ ...@@ -39,7 +39,6 @@
#include "usbvision.h" #include "usbvision.h"
#define DBG_I2C 1<<0 #define DBG_I2C 1<<0
#define DBG_ALGO 1<<1
static int i2c_debug = 0; static int i2c_debug = 0;
...@@ -49,22 +48,22 @@ MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]"); ...@@ -49,22 +48,22 @@ MODULE_PARM_DESC(i2c_debug, "enable debug messages [i2c]");
#define PDEBUG(level, fmt, args...) \ #define PDEBUG(level, fmt, args...) \
if (i2c_debug & (level)) info("[%s:%d] " fmt, __PRETTY_FUNCTION__, __LINE__ , ## args) if (i2c_debug & (level)) info("[%s:%d] " fmt, __PRETTY_FUNCTION__, __LINE__ , ## args)
static int usbvision_i2c_write(void *data, unsigned char addr, char *buf, static int usbvision_i2c_write(struct usb_usbvision *usbvision, unsigned char addr, char *buf,
short len); short len);
static int usbvision_i2c_read(void *data, unsigned char addr, char *buf, static int usbvision_i2c_read(struct usb_usbvision *usbvision, unsigned char addr, char *buf,
short len); short len);
static inline int try_write_address(struct i2c_adapter *i2c_adap, static inline int try_write_address(struct i2c_adapter *i2c_adap,
unsigned char addr, int retries) unsigned char addr, int retries)
{ {
void *data; struct usb_usbvision *usbvision;
int i, ret = -1; int i, ret = -1;
char buf[4]; char buf[4];
data = i2c_get_adapdata(i2c_adap); usbvision = i2c_get_adapdata(i2c_adap);
buf[0] = 0x00; buf[0] = 0x00;
for (i = 0; i <= retries; i++) { for (i = 0; i <= retries; i++) {
ret = (usbvision_i2c_write(data, addr, buf, 1)); ret = (usbvision_i2c_write(usbvision, addr, buf, 1));
if (ret == 1) if (ret == 1)
break; /* success! */ break; /* success! */
udelay(5); udelay(5);
...@@ -73,8 +72,8 @@ static inline int try_write_address(struct i2c_adapter *i2c_adap, ...@@ -73,8 +72,8 @@ static inline int try_write_address(struct i2c_adapter *i2c_adap,
udelay(10); udelay(10);
} }
if (i) { if (i) {
PDEBUG(DBG_ALGO,"Needed %d retries for address %#2x", i, addr); PDEBUG(DBG_I2C,"Needed %d retries for address %#2x", i, addr);
PDEBUG(DBG_ALGO,"Maybe there's no device at this address"); PDEBUG(DBG_I2C,"Maybe there's no device at this address");
} }
return ret; return ret;
} }
...@@ -82,13 +81,13 @@ static inline int try_write_address(struct i2c_adapter *i2c_adap, ...@@ -82,13 +81,13 @@ static inline int try_write_address(struct i2c_adapter *i2c_adap,
static inline int try_read_address(struct i2c_adapter *i2c_adap, static inline int try_read_address(struct i2c_adapter *i2c_adap,
unsigned char addr, int retries) unsigned char addr, int retries)
{ {
void *data; struct usb_usbvision *usbvision;
int i, ret = -1; int i, ret = -1;
char buf[4]; char buf[4];
data = i2c_get_adapdata(i2c_adap); usbvision = i2c_get_adapdata(i2c_adap);
for (i = 0; i <= retries; i++) { for (i = 0; i <= retries; i++) {
ret = (usbvision_i2c_read(data, addr, buf, 1)); ret = (usbvision_i2c_read(usbvision, addr, buf, 1));
if (ret == 1) if (ret == 1)
break; /* success! */ break; /* success! */
udelay(5); udelay(5);
...@@ -97,8 +96,8 @@ static inline int try_read_address(struct i2c_adapter *i2c_adap, ...@@ -97,8 +96,8 @@ static inline int try_read_address(struct i2c_adapter *i2c_adap,
udelay(10); udelay(10);
} }
if (i) { if (i) {
PDEBUG(DBG_ALGO,"Needed %d retries for address %#2x", i, addr); PDEBUG(DBG_I2C,"Needed %d retries for address %#2x", i, addr);
PDEBUG(DBG_ALGO,"Maybe there's no device at this address"); PDEBUG(DBG_I2C,"Maybe there's no device at this address");
} }
return ret; return ret;
} }
...@@ -152,32 +151,31 @@ static inline int usb_find_address(struct i2c_adapter *i2c_adap, ...@@ -152,32 +151,31 @@ static inline int usb_find_address(struct i2c_adapter *i2c_adap,
} }
static int static int
usb_xfer(struct i2c_adapter *i2c_adap, struct i2c_msg msgs[], int num) usbvision_i2c_xfer(struct i2c_adapter *i2c_adap, struct i2c_msg msgs[], int num)
{ {
struct i2c_msg *pmsg; struct i2c_msg *pmsg;
void *data; struct usb_usbvision *usbvision;
int i, ret; int i, ret;
unsigned char addr; unsigned char addr;
data = i2c_get_adapdata(i2c_adap); usbvision = i2c_get_adapdata(i2c_adap);
for (i = 0; i < num; i++) { for (i = 0; i < num; i++) {
pmsg = &msgs[i]; pmsg = &msgs[i];
ret = usb_find_address(i2c_adap, pmsg, i2c_adap->retries, &addr); ret = usb_find_address(i2c_adap, pmsg, i2c_adap->retries, &addr);
if (ret != 0) { if (ret != 0) {
PDEBUG(DBG_ALGO,"got NAK from device, message #%d", i); PDEBUG(DBG_I2C,"got NAK from device, message #%d", i);
return (ret < 0) ? ret : -EREMOTEIO; return (ret < 0) ? ret : -EREMOTEIO;
} }
if (pmsg->flags & I2C_M_RD) { if (pmsg->flags & I2C_M_RD) {
/* read bytes into buffer */ /* read bytes into buffer */
ret = (usbvision_i2c_read(data, addr, pmsg->buf, pmsg->len)); ret = (usbvision_i2c_read(usbvision, addr, pmsg->buf, pmsg->len));
if (ret < pmsg->len) { if (ret < pmsg->len) {
return (ret < 0) ? ret : -EREMOTEIO; return (ret < 0) ? ret : -EREMOTEIO;
} }
} else { } else {
/* write bytes from buffer */ /* write bytes from buffer */
ret = (usbvision_i2c_write(data, addr, pmsg->buf, pmsg->len)); ret = (usbvision_i2c_write(usbvision, addr, pmsg->buf, pmsg->len));
if (ret < pmsg->len) { if (ret < pmsg->len) {
return (ret < 0) ? ret : -EREMOTEIO; return (ret < 0) ? ret : -EREMOTEIO;
} }
...@@ -191,7 +189,7 @@ static int algo_control(struct i2c_adapter *adapter, unsigned int cmd, unsigned ...@@ -191,7 +189,7 @@ static int algo_control(struct i2c_adapter *adapter, unsigned int cmd, unsigned
return 0; return 0;
} }
static u32 usb_func(struct i2c_adapter *adap) static u32 functionality(struct i2c_adapter *adap)
{ {
return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR | I2C_FUNC_PROTOCOL_MANGLING; return I2C_FUNC_SMBUS_EMUL | I2C_FUNC_10BIT_ADDR | I2C_FUNC_PROTOCOL_MANGLING;
} }
...@@ -199,73 +197,44 @@ static u32 usb_func(struct i2c_adapter *adap) ...@@ -199,73 +197,44 @@ static u32 usb_func(struct i2c_adapter *adap)
/* -----exported algorithm data: ------------------------------------- */ /* -----exported algorithm data: ------------------------------------- */
static struct i2c_algorithm i2c_usb_algo = { static struct i2c_algorithm usbvision_algo = {
.master_xfer = usb_xfer, .master_xfer = usbvision_i2c_xfer,
.smbus_xfer = NULL, .smbus_xfer = NULL,
.algo_control = algo_control, .algo_control = algo_control,
.functionality = usb_func, .functionality = functionality,
}; };
/*
* registering functions to load algorithms at runtime
*/
static int usbvision_i2c_usb_add_bus(struct i2c_adapter *adap)
{
PDEBUG(DBG_I2C, "I2C debugging is enabled [i2c]");
PDEBUG(DBG_ALGO, "ALGO debugging is enabled [i2c]");
/* register new adapter to i2c module... */
adap->algo = &i2c_usb_algo;
adap->timeout = 100; /* default values, should */
adap->retries = 3; /* be replaced by defines */
i2c_add_adapter(adap);
PDEBUG(DBG_ALGO,"i2c bus for %s registered", adap->name);
return 0;
}
int usbvision_i2c_usb_del_bus(struct i2c_adapter *adap)
{
i2c_del_adapter(adap);
PDEBUG(DBG_ALGO,"i2c bus for %s unregistered", adap->name);
return 0;
}
/* ----------------------------------------------------------------------- */ /* ----------------------------------------------------------------------- */
/* usbvision specific I2C functions */ /* usbvision specific I2C functions */
/* ----------------------------------------------------------------------- */ /* ----------------------------------------------------------------------- */
static struct i2c_adapter i2c_adap_template; static struct i2c_adapter i2c_adap_template;
static struct i2c_client i2c_client_template; static struct i2c_client i2c_client_template;
int usbvision_init_i2c(struct usb_usbvision *usbvision) int usbvision_i2c_register(struct usb_usbvision *usbvision)
{ {
memcpy(&usbvision->i2c_adap, &i2c_adap_template, int ret;
sizeof(struct i2c_adapter));
memcpy(&usbvision->i2c_client, &i2c_client_template,
sizeof(struct i2c_client));
sprintf(usbvision->i2c_adap.name + strlen(usbvision->i2c_adap.name), usbvision->i2c_adap = i2c_adap_template;
" #%d", usbvision->vdev->minor & 0x1f);
PDEBUG(DBG_I2C,"Adaptername: %s", usbvision->i2c_adap.name);
usbvision->i2c_adap.dev.parent = &usbvision->dev->dev; usbvision->i2c_adap.dev.parent = &usbvision->dev->dev;
i2c_set_adapdata(&usbvision->i2c_adap, usbvision); PDEBUG(DBG_I2C, "I2C debugging is enabled [i2c]");
i2c_set_clientdata(&usbvision->i2c_client, usbvision);
sprintf(usbvision->i2c_adap.name + strlen(usbvision->i2c_adap.name),
" #%d", usbvision->vdev->minor & 0x1f);
PDEBUG(DBG_I2C,"I2C Registering adaptername: %s", usbvision->i2c_adap.name);
i2c_set_adapdata(&usbvision->i2c_adap,usbvision);
if ((ret = i2c_add_adapter(&usbvision->i2c_adap)) < 0) {
PDEBUG(DBG_I2C,"could not add I2C adapter %s", usbvision->i2c_adap.name);
return ret;
}
/* TODO: use i2c_client for eeprom detection as an example... */
usbvision->i2c_client = i2c_client_template;
usbvision->i2c_client.adapter = &usbvision->i2c_adap; usbvision->i2c_client.adapter = &usbvision->i2c_adap;
if (usbvision_write_reg(usbvision, USBVISION_SER_MODE, USBVISION_IIC_LRNACK) < 0) { if (usbvision_write_reg(usbvision, USBVISION_SER_MODE, USBVISION_IIC_LRNACK) < 0) {
printk(KERN_ERR "usbvision_init_i2c: can't write reg\n"); printk(KERN_ERR "usbvision_i2c_register: can't write reg\n");
return -EBUSY; return -EBUSY;
} }
...@@ -284,7 +253,17 @@ int usbvision_init_i2c(struct usb_usbvision *usbvision) ...@@ -284,7 +253,17 @@ int usbvision_init_i2c(struct usb_usbvision *usbvision)
} }
#endif #endif
return usbvision_i2c_usb_add_bus(&usbvision->i2c_adap); return 0;
}
int usbvision_i2c_unregister(struct usb_usbvision *usbvision)
{
i2c_del_adapter(&(usbvision->i2c_adap));
PDEBUG(DBG_I2C,"i2c bus for %s unregistered", usbvision->i2c_adap.name);
return 0;
} }
void call_i2c_clients(struct usb_usbvision *usbvision, unsigned int cmd, void call_i2c_clients(struct usb_usbvision *usbvision, unsigned int cmd,
...@@ -297,8 +276,7 @@ static int attach_inform(struct i2c_client *client) ...@@ -297,8 +276,7 @@ static int attach_inform(struct i2c_client *client)
{ {
struct usb_usbvision *usbvision; struct usb_usbvision *usbvision;
usbvision = (struct usb_usbvision *)i2c_get_adapdata(client->adapter); usbvision = i2c_get_adapdata(client->adapter);
switch (client->addr << 1) { switch (client->addr << 1) {
case 0x43: case 0x43:
case 0x4b: case 0x4b:
...@@ -349,7 +327,7 @@ static int detach_inform(struct i2c_client *client) ...@@ -349,7 +327,7 @@ static int detach_inform(struct i2c_client *client)
{ {
struct usb_usbvision *usbvision; struct usb_usbvision *usbvision;
usbvision = (struct usb_usbvision *)i2c_get_adapdata(client->adapter); usbvision = i2c_get_adapdata(client->adapter);
PDEBUG(DBG_I2C,"usbvision[%d] detaches %s", usbvision->nr, client->name); PDEBUG(DBG_I2C,"usbvision[%d] detaches %s", usbvision->nr, client->name);
return 0; return 0;
...@@ -480,7 +458,7 @@ static int usbvision_i2c_write_max4(struct usb_usbvision *usbvision, ...@@ -480,7 +458,7 @@ static int usbvision_i2c_write_max4(struct usb_usbvision *usbvision,
return len; return len;
} }
static int usbvision_i2c_write(void *data, unsigned char addr, char *buf, static int usbvision_i2c_write(struct usb_usbvision *usbvision, unsigned char addr, char *buf,
short len) short len)
{ {
char *bufPtr = buf; char *bufPtr = buf;
...@@ -488,7 +466,6 @@ static int usbvision_i2c_write(void *data, unsigned char addr, char *buf, ...@@ -488,7 +466,6 @@ static int usbvision_i2c_write(void *data, unsigned char addr, char *buf,
int wrcount = 0; int wrcount = 0;
int count; int count;
int maxLen = 4; int maxLen = 4;
struct usb_usbvision *usbvision = (struct usb_usbvision *) data;
while (len > 0) { while (len > 0) {
count = (len > maxLen) ? maxLen : len; count = (len > maxLen) ? maxLen : len;
...@@ -503,14 +480,13 @@ static int usbvision_i2c_write(void *data, unsigned char addr, char *buf, ...@@ -503,14 +480,13 @@ static int usbvision_i2c_write(void *data, unsigned char addr, char *buf,
return wrcount; return wrcount;
} }
static int usbvision_i2c_read(void *data, unsigned char addr, char *buf, static int usbvision_i2c_read(struct usb_usbvision *usbvision, unsigned char addr, char *buf,
short len) short len)
{ {
char temp[4]; char temp[4];
int retval, i; int retval, i;
int rdcount = 0; int rdcount = 0;
int count; int count;
struct usb_usbvision *usbvision = (struct usb_usbvision *) data;
while (len > 0) { while (len > 0) {
count = (len > 3) ? 4 : len; count = (len > 3) ? 4 : len;
...@@ -530,6 +506,8 @@ static struct i2c_adapter i2c_adap_template = { ...@@ -530,6 +506,8 @@ static struct i2c_adapter i2c_adap_template = {
.owner = THIS_MODULE, .owner = THIS_MODULE,
.name = "usbvision", .name = "usbvision",
.id = I2C_HW_B_BT848, /* FIXME */ .id = I2C_HW_B_BT848, /* FIXME */
.algo = &usbvision_algo,
.algo_data = NULL,
.client_register = attach_inform, .client_register = attach_inform,
.client_unregister = detach_inform, .client_unregister = detach_inform,
#ifdef I2C_ADAP_CLASS_TV_ANALOG #ifdef I2C_ADAP_CLASS_TV_ANALOG
......
...@@ -410,7 +410,7 @@ static int usbvision_v4l2_open(struct inode *inode, struct file *file) ...@@ -410,7 +410,7 @@ static int usbvision_v4l2_open(struct inode *inode, struct file *file)
down(&usbvision->lock); down(&usbvision->lock);
if (usbvision->power == 0) { if (usbvision->power == 0) {
usbvision_power_on(usbvision); usbvision_power_on(usbvision);
usbvision_init_i2c(usbvision); usbvision_i2c_register(usbvision);
} }
/* Send init sequence only once, it's large! */ /* Send init sequence only once, it's large! */
...@@ -432,7 +432,7 @@ static int usbvision_v4l2_open(struct inode *inode, struct file *file) ...@@ -432,7 +432,7 @@ static int usbvision_v4l2_open(struct inode *inode, struct file *file)
} }
else { else {
if (PowerOnAtOpen) { if (PowerOnAtOpen) {
usbvision_i2c_usb_del_bus(&usbvision->i2c_adap); usbvision_i2c_unregister(usbvision);
usbvision_power_off(usbvision); usbvision_power_off(usbvision);
usbvision->initialized = 0; usbvision->initialized = 0;
} }
...@@ -1240,7 +1240,7 @@ static int usbvision_radio_open(struct inode *inode, struct file *file) ...@@ -1240,7 +1240,7 @@ static int usbvision_radio_open(struct inode *inode, struct file *file)
usbvision_reset_powerOffTimer(usbvision); usbvision_reset_powerOffTimer(usbvision);
if (usbvision->power == 0) { if (usbvision->power == 0) {
usbvision_power_on(usbvision); usbvision_power_on(usbvision);
usbvision_init_i2c(usbvision); usbvision_i2c_register(usbvision);
} }
} }
...@@ -1262,7 +1262,7 @@ static int usbvision_radio_open(struct inode *inode, struct file *file) ...@@ -1262,7 +1262,7 @@ static int usbvision_radio_open(struct inode *inode, struct file *file)
if (errCode) { if (errCode) {
if (PowerOnAtOpen) { if (PowerOnAtOpen) {
usbvision_i2c_usb_del_bus(&usbvision->i2c_adap); usbvision_i2c_unregister(usbvision);
usbvision_power_off(usbvision); usbvision_power_off(usbvision);
usbvision->initialized = 0; usbvision->initialized = 0;
} }
...@@ -1765,7 +1765,7 @@ static void usbvision_configure_video(struct usb_usbvision *usbvision) ...@@ -1765,7 +1765,7 @@ static void usbvision_configure_video(struct usb_usbvision *usbvision)
usbvision_audio_off(usbvision); //first switch off audio usbvision_audio_off(usbvision); //first switch off audio
if (!PowerOnAtOpen) { if (!PowerOnAtOpen) {
usbvision_power_on(usbvision); //and then power up the noisy tuner usbvision_power_on(usbvision); //and then power up the noisy tuner
usbvision_init_i2c(usbvision); usbvision_i2c_register(usbvision);
} }
} }
...@@ -1913,7 +1913,7 @@ static void __devexit usbvision_disconnect(struct usb_interface *intf) ...@@ -1913,7 +1913,7 @@ static void __devexit usbvision_disconnect(struct usb_interface *intf)
usbvision_stop_isoc(usbvision); usbvision_stop_isoc(usbvision);
if (usbvision->power) { if (usbvision->power) {
usbvision_i2c_usb_del_bus(&usbvision->i2c_adap); usbvision_i2c_unregister(usbvision);
usbvision_power_off(usbvision); usbvision_power_off(usbvision);
} }
usbvision->remove_pending = 1; // Now all ISO data will be ignored usbvision->remove_pending = 1; // Now all ISO data will be ignored
......
...@@ -482,13 +482,11 @@ struct usb_usbvision { ...@@ -482,13 +482,11 @@ struct usb_usbvision {
/* i2c-algo-usb declaration */ /* i2c-algo-usb declaration */
/* --------------------------------------------------------------- */ /* --------------------------------------------------------------- */
int usbvision_i2c_usb_del_bus(struct i2c_adapter *);
/* ----------------------------------------------------------------------- */ /* ----------------------------------------------------------------------- */
/* usbvision specific I2C functions */ /* usbvision specific I2C functions */
/* ----------------------------------------------------------------------- */ /* ----------------------------------------------------------------------- */
int usbvision_init_i2c(struct usb_usbvision *usbvision); int usbvision_i2c_register(struct usb_usbvision *usbvision);
int usbvision_i2c_unregister(struct usb_usbvision *usbvision);
void call_i2c_clients(struct usb_usbvision *usbvision, unsigned int cmd,void *arg); void call_i2c_clients(struct usb_usbvision *usbvision, unsigned int cmd,void *arg);
/* defined in usbvision-core.c */ /* defined in usbvision-core.c */
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment