a2e521e85c
The remove driver function expects that the client is still attached to the driver, so do the detach after calling remove(). Signed-off-by: Hans Verkuil <hverkuil@xs4all.nl> Signed-off-by: Mauro Carvalho Chehab <mchehab@infradead.org>
141 lines
4.3 KiB
C
141 lines
4.3 KiB
C
/*
|
|
* v4l2-i2c-drv-legacy.h - contains I2C handling code that's identical
|
|
* for all V4L2 I2C drivers. Use this header if the
|
|
* I2C driver is used by both legacy drivers and
|
|
* drivers converted to the bus-based I2C API.
|
|
*
|
|
* Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl>
|
|
*
|
|
* 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; either version 2 of the License, or
|
|
* (at your option) any later version.
|
|
*
|
|
* 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.
|
|
*/
|
|
|
|
struct v4l2_i2c_driver_data {
|
|
const char * const name;
|
|
int driverid;
|
|
int (*command)(struct i2c_client *client, unsigned int cmd, void *arg);
|
|
int (*probe)(struct i2c_client *client);
|
|
int (*remove)(struct i2c_client *client);
|
|
int (*suspend)(struct i2c_client *client, pm_message_t state);
|
|
int (*resume)(struct i2c_client *client);
|
|
int (*legacy_probe)(struct i2c_adapter *adapter);
|
|
int legacy_class;
|
|
};
|
|
|
|
static struct v4l2_i2c_driver_data v4l2_i2c_data;
|
|
static struct i2c_client_address_data addr_data;
|
|
static struct i2c_driver v4l2_i2c_driver_legacy;
|
|
static char v4l2_i2c_drv_name_legacy[32];
|
|
|
|
static int v4l2_i2c_drv_attach_legacy(struct i2c_adapter *adapter, int address, int kind)
|
|
{
|
|
return v4l2_i2c_attach(adapter, address, &v4l2_i2c_driver_legacy,
|
|
v4l2_i2c_drv_name_legacy, v4l2_i2c_data.probe);
|
|
}
|
|
|
|
static int v4l2_i2c_drv_probe_legacy(struct i2c_adapter *adapter)
|
|
{
|
|
if (v4l2_i2c_data.legacy_probe) {
|
|
if (v4l2_i2c_data.legacy_probe(adapter))
|
|
return i2c_probe(adapter, &addr_data, v4l2_i2c_drv_attach_legacy);
|
|
return 0;
|
|
}
|
|
if (adapter->class & v4l2_i2c_data.legacy_class)
|
|
return i2c_probe(adapter, &addr_data, v4l2_i2c_drv_attach_legacy);
|
|
return 0;
|
|
}
|
|
|
|
static int v4l2_i2c_drv_detach_legacy(struct i2c_client *client)
|
|
{
|
|
int err;
|
|
|
|
if (v4l2_i2c_data.remove)
|
|
v4l2_i2c_data.remove(client);
|
|
|
|
err = i2c_detach_client(client);
|
|
if (err)
|
|
return err;
|
|
kfree(client);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int v4l2_i2c_drv_suspend_helper(struct i2c_client *client, pm_message_t state)
|
|
{
|
|
return v4l2_i2c_data.suspend ? v4l2_i2c_data.suspend(client, state) : 0;
|
|
}
|
|
|
|
static int v4l2_i2c_drv_resume_helper(struct i2c_client *client)
|
|
{
|
|
return v4l2_i2c_data.resume ? v4l2_i2c_data.resume(client) : 0;
|
|
}
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
/* i2c implementation */
|
|
static struct i2c_driver v4l2_i2c_driver_legacy = {
|
|
.driver = {
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.attach_adapter = v4l2_i2c_drv_probe_legacy,
|
|
.detach_client = v4l2_i2c_drv_detach_legacy,
|
|
.suspend = v4l2_i2c_drv_suspend_helper,
|
|
.resume = v4l2_i2c_drv_resume_helper,
|
|
};
|
|
|
|
/* ----------------------------------------------------------------------- */
|
|
|
|
/* i2c implementation */
|
|
static struct i2c_driver v4l2_i2c_driver = {
|
|
.suspend = v4l2_i2c_drv_suspend_helper,
|
|
.resume = v4l2_i2c_drv_resume_helper,
|
|
};
|
|
|
|
static int __init v4l2_i2c_drv_init(void)
|
|
{
|
|
int err;
|
|
|
|
strlcpy(v4l2_i2c_drv_name_legacy, v4l2_i2c_data.name, sizeof(v4l2_i2c_drv_name_legacy));
|
|
strlcat(v4l2_i2c_drv_name_legacy, "'", sizeof(v4l2_i2c_drv_name_legacy));
|
|
|
|
if (v4l2_i2c_data.legacy_class == 0)
|
|
v4l2_i2c_data.legacy_class = I2C_CLASS_TV_ANALOG;
|
|
|
|
v4l2_i2c_driver_legacy.driver.name = v4l2_i2c_drv_name_legacy;
|
|
v4l2_i2c_driver_legacy.id = v4l2_i2c_data.driverid;
|
|
v4l2_i2c_driver_legacy.command = v4l2_i2c_data.command;
|
|
err = i2c_add_driver(&v4l2_i2c_driver_legacy);
|
|
|
|
if (err)
|
|
return err;
|
|
v4l2_i2c_driver.driver.name = v4l2_i2c_data.name;
|
|
v4l2_i2c_driver.id = v4l2_i2c_data.driverid;
|
|
v4l2_i2c_driver.command = v4l2_i2c_data.command;
|
|
v4l2_i2c_driver.probe = v4l2_i2c_data.probe;
|
|
v4l2_i2c_driver.remove = v4l2_i2c_data.remove;
|
|
err = i2c_add_driver(&v4l2_i2c_driver);
|
|
if (err)
|
|
i2c_del_driver(&v4l2_i2c_driver_legacy);
|
|
return err;
|
|
}
|
|
|
|
static void __exit v4l2_i2c_drv_cleanup(void)
|
|
{
|
|
i2c_del_driver(&v4l2_i2c_driver_legacy);
|
|
i2c_del_driver(&v4l2_i2c_driver);
|
|
}
|
|
|
|
module_init(v4l2_i2c_drv_init);
|
|
module_exit(v4l2_i2c_drv_cleanup);
|