V4L/DVB (10867): vino: fold i2c-algo-sgi code into vino.
Signed-off-by: Jean Delvare <khali@linux-fr.org> Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>
This commit is contained in:
Jean Delvare
Mauro Carvalho Chehab
Родитель
a0720d3b7b
Коммит
cea0c681be
|
|
@ -582,7 +582,6 @@ config VIDEO_SAA5249
|
|||
config VIDEO_VINO
|
||||
tristate "SGI Vino Video For Linux (EXPERIMENTAL)"
|
||||
depends on I2C && SGI_IP22 && EXPERIMENTAL && VIDEO_V4L2
|
||||
select I2C_ALGO_SGI
|
||||
select VIDEO_SAA7191 if VIDEO_HELPER_CHIPS_AUTO
|
||||
help
|
||||
Say Y here to build in support for the Vino video input system found
|
||||
|
|
|
|||
|
|
@ -33,7 +33,6 @@
|
|||
#include <linux/kmod.h>
|
||||
|
||||
#include <linux/i2c.h>
|
||||
#include <linux/i2c-algo-sgi.h>
|
||||
|
||||
#include <linux/videodev2.h>
|
||||
#include <media/v4l2-device.h>
|
||||
|
|
@ -141,6 +140,20 @@ MODULE_LICENSE("GPL");
|
|||
|
||||
#define VINO_DATA_NORM_COUNT 4
|
||||
|
||||
/* I2C controller flags */
|
||||
#define SGI_I2C_FORCE_IDLE (0 << 0)
|
||||
#define SGI_I2C_NOT_IDLE (1 << 0)
|
||||
#define SGI_I2C_WRITE (0 << 1)
|
||||
#define SGI_I2C_READ (1 << 1)
|
||||
#define SGI_I2C_RELEASE_BUS (0 << 2)
|
||||
#define SGI_I2C_HOLD_BUS (1 << 2)
|
||||
#define SGI_I2C_XFER_DONE (0 << 4)
|
||||
#define SGI_I2C_XFER_BUSY (1 << 4)
|
||||
#define SGI_I2C_ACK (0 << 5)
|
||||
#define SGI_I2C_NACK (1 << 5)
|
||||
#define SGI_I2C_BUS_OK (0 << 7)
|
||||
#define SGI_I2C_BUS_ERR (1 << 7)
|
||||
|
||||
/* Internal data structure definitions */
|
||||
|
||||
struct vino_input {
|
||||
|
|
@ -640,56 +653,6 @@ struct v4l2_queryctrl vino_saa7191_v4l2_controls[] = {
|
|||
}
|
||||
};
|
||||
|
||||
/* VINO I2C bus functions */
|
||||
|
||||
unsigned i2c_vino_getctrl(void *data)
|
||||
{
|
||||
return vino->i2c_control;
|
||||
}
|
||||
|
||||
void i2c_vino_setctrl(void *data, unsigned val)
|
||||
{
|
||||
vino->i2c_control = val;
|
||||
}
|
||||
|
||||
unsigned i2c_vino_rdata(void *data)
|
||||
{
|
||||
return vino->i2c_data;
|
||||
}
|
||||
|
||||
void i2c_vino_wdata(void *data, unsigned val)
|
||||
{
|
||||
vino->i2c_data = val;
|
||||
}
|
||||
|
||||
static struct i2c_algo_sgi_data i2c_sgi_vino_data =
|
||||
{
|
||||
.getctrl = &i2c_vino_getctrl,
|
||||
.setctrl = &i2c_vino_setctrl,
|
||||
.rdata = &i2c_vino_rdata,
|
||||
.wdata = &i2c_vino_wdata,
|
||||
.xfer_timeout = 200,
|
||||
.ack_timeout = 1000,
|
||||
};
|
||||
|
||||
static struct i2c_adapter vino_i2c_adapter =
|
||||
{
|
||||
.name = "VINO I2C bus",
|
||||
.id = I2C_HW_SGI_VINO,
|
||||
.algo_data = &i2c_sgi_vino_data,
|
||||
.owner = THIS_MODULE,
|
||||
};
|
||||
|
||||
static int vino_i2c_add_bus(void)
|
||||
{
|
||||
return i2c_sgi_add_bus(&vino_i2c_adapter);
|
||||
}
|
||||
|
||||
static int vino_i2c_del_bus(void)
|
||||
{
|
||||
return i2c_del_adapter(&vino_i2c_adapter);
|
||||
}
|
||||
|
||||
/* VINO framebuffer/DMA descriptor management */
|
||||
|
||||
static void vino_free_buffer_with_count(struct vino_framebuffer *fb,
|
||||
|
|
@ -1635,6 +1598,184 @@ static inline void vino_set_default_framerate(struct
|
|||
vino_set_framerate(vcs, vino_data_norms[vcs->data_norm].fps_max);
|
||||
}
|
||||
|
||||
/* VINO I2C bus functions */
|
||||
|
||||
struct i2c_algo_sgi_data {
|
||||
void *data; /* private data for lowlevel routines */
|
||||
unsigned (*getctrl)(void *data);
|
||||
void (*setctrl)(void *data, unsigned val);
|
||||
unsigned (*rdata)(void *data);
|
||||
void (*wdata)(void *data, unsigned val);
|
||||
|
||||
int xfer_timeout;
|
||||
int ack_timeout;
|
||||
};
|
||||
|
||||
static int wait_xfer_done(struct i2c_algo_sgi_data *adap)
|
||||
{
|
||||
int i;
|
||||
|
||||
for (i = 0; i < adap->xfer_timeout; i++) {
|
||||
if ((adap->getctrl(adap->data) & SGI_I2C_XFER_BUSY) == 0)
|
||||
return 0;
|
||||
udelay(1);
|
||||
}
|
||||
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static int wait_ack(struct i2c_algo_sgi_data *adap)
|
||||
{
|
||||
int i;
|
||||
|
||||
if (wait_xfer_done(adap))
|
||||
return -ETIMEDOUT;
|
||||
for (i = 0; i < adap->ack_timeout; i++) {
|
||||
if ((adap->getctrl(adap->data) & SGI_I2C_NACK) == 0)
|
||||
return 0;
|
||||
udelay(1);
|
||||
}
|
||||
|
||||
return -ETIMEDOUT;
|
||||
}
|
||||
|
||||
static int force_idle(struct i2c_algo_sgi_data *adap)
|
||||
{
|
||||
int i;
|
||||
|
||||
adap->setctrl(adap->data, SGI_I2C_FORCE_IDLE);
|
||||
for (i = 0; i < adap->xfer_timeout; i++) {
|
||||
if ((adap->getctrl(adap->data) & SGI_I2C_NOT_IDLE) == 0)
|
||||
goto out;
|
||||
udelay(1);
|
||||
}
|
||||
return -ETIMEDOUT;
|
||||
out:
|
||||
if (adap->getctrl(adap->data) & SGI_I2C_BUS_ERR)
|
||||
return -EIO;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int do_address(struct i2c_algo_sgi_data *adap, unsigned int addr,
|
||||
int rd)
|
||||
{
|
||||
if (rd)
|
||||
adap->setctrl(adap->data, SGI_I2C_NOT_IDLE);
|
||||
/* Check if bus is idle, eventually force it to do so */
|
||||
if (adap->getctrl(adap->data) & SGI_I2C_NOT_IDLE)
|
||||
if (force_idle(adap))
|
||||
return -EIO;
|
||||
/* Write out the i2c chip address and specify operation */
|
||||
adap->setctrl(adap->data,
|
||||
SGI_I2C_HOLD_BUS | SGI_I2C_WRITE | SGI_I2C_NOT_IDLE);
|
||||
if (rd)
|
||||
addr |= 1;
|
||||
adap->wdata(adap->data, addr);
|
||||
if (wait_ack(adap))
|
||||
return -EIO;
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int i2c_read(struct i2c_algo_sgi_data *adap, unsigned char *buf,
|
||||
unsigned int len)
|
||||
{
|
||||
int i;
|
||||
|
||||
adap->setctrl(adap->data,
|
||||
SGI_I2C_HOLD_BUS | SGI_I2C_READ | SGI_I2C_NOT_IDLE);
|
||||
for (i = 0; i < len; i++) {
|
||||
if (wait_xfer_done(adap))
|
||||
return -EIO;
|
||||
buf[i] = adap->rdata(adap->data);
|
||||
}
|
||||
adap->setctrl(adap->data, SGI_I2C_RELEASE_BUS | SGI_I2C_FORCE_IDLE);
|
||||
|
||||
return 0;
|
||||
|
||||
}
|
||||
|
||||
static int i2c_write(struct i2c_algo_sgi_data *adap, unsigned char *buf,
|
||||
unsigned int len)
|
||||
{
|
||||
int i;
|
||||
|
||||
/* We are already in write state */
|
||||
for (i = 0; i < len; i++) {
|
||||
adap->wdata(adap->data, buf[i]);
|
||||
if (wait_ack(adap))
|
||||
return -EIO;
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int sgi_xfer(struct i2c_adapter *i2c_adap, struct i2c_msg *msgs,
|
||||
int num)
|
||||
{
|
||||
struct i2c_algo_sgi_data *adap = i2c_adap->algo_data;
|
||||
struct i2c_msg *p;
|
||||
int i, err = 0;
|
||||
|
||||
for (i = 0; !err && i < num; i++) {
|
||||
p = &msgs[i];
|
||||
err = do_address(adap, p->addr, p->flags & I2C_M_RD);
|
||||
if (err || !p->len)
|
||||
continue;
|
||||
if (p->flags & I2C_M_RD)
|
||||
err = i2c_read(adap, p->buf, p->len);
|
||||
else
|
||||
err = i2c_write(adap, p->buf, p->len);
|
||||
}
|
||||
|
||||
return (err < 0) ? err : i;
|
||||
}
|
||||
|
||||
static u32 sgi_func(struct i2c_adapter *adap)
|
||||
{
|
||||
return I2C_FUNC_SMBUS_EMUL;
|
||||
}
|
||||
|
||||
static const struct i2c_algorithm sgi_algo = {
|
||||
.master_xfer = sgi_xfer,
|
||||
.functionality = sgi_func,
|
||||
};
|
||||
|
||||
static unsigned i2c_vino_getctrl(void *data)
|
||||
{
|
||||
return vino->i2c_control;
|
||||
}
|
||||
|
||||
static void i2c_vino_setctrl(void *data, unsigned val)
|
||||
{
|
||||
vino->i2c_control = val;
|
||||
}
|
||||
|
||||
static unsigned i2c_vino_rdata(void *data)
|
||||
{
|
||||
return vino->i2c_data;
|
||||
}
|
||||
|
||||
static void i2c_vino_wdata(void *data, unsigned val)
|
||||
{
|
||||
vino->i2c_data = val;
|
||||
}
|
||||
|
||||
static struct i2c_algo_sgi_data i2c_sgi_vino_data = {
|
||||
.getctrl = &i2c_vino_getctrl,
|
||||
.setctrl = &i2c_vino_setctrl,
|
||||
.rdata = &i2c_vino_rdata,
|
||||
.wdata = &i2c_vino_wdata,
|
||||
.xfer_timeout = 200,
|
||||
.ack_timeout = 1000,
|
||||
};
|
||||
|
||||
static struct i2c_adapter vino_i2c_adapter = {
|
||||
.name = "VINO I2C bus",
|
||||
.id = I2C_HW_SGI_VINO,
|
||||
.algo = &sgi_algo,
|
||||
.algo_data = &i2c_sgi_vino_data,
|
||||
.owner = THIS_MODULE,
|
||||
};
|
||||
|
||||
/*
|
||||
* Prepare VINO for DMA transfer...
|
||||
* (execute only with vino_lock and input_lock locked)
|
||||
|
|
@ -3999,7 +4140,7 @@ static void vino_module_cleanup(int stage)
|
|||
video_unregister_device(vino_drvdata->a.vdev);
|
||||
vino_drvdata->a.vdev = NULL;
|
||||
case 9:
|
||||
vino_i2c_del_bus();
|
||||
i2c_del_adapter(&vino_i2c_adapter);
|
||||
case 8:
|
||||
free_irq(SGI_VINO_IRQ, NULL);
|
||||
case 7:
|
||||
|
|
@ -4222,7 +4363,7 @@ static int __init vino_module_init(void)
|
|||
}
|
||||
vino_init_stage++;
|
||||
|
||||
ret = vino_i2c_add_bus();
|
||||
ret = i2c_add_adapter(&vino_i2c_adapter);
|
||||
if (ret) {
|
||||
printk(KERN_ERR "VINO I2C bus registration failed\n");
|
||||
vino_module_cleanup(vino_init_stage);
|
||||
|
|
|
|||
Загрузка…
Ссылка в новой задаче