Gitiles
Code Review Sign In
gerrit-public.fairphone.software / kernel / msm-4.9 / 8ffbc6559493c64d6194c92d856196fdaeb8a5fb / . / include / media / v4l2-i2c-drv-legacy.h
blob: c059b32844c156669d1641d3457c28f10430fd64 [file] [log] [blame]
Hans Verkuil8ffbc652007-09-12 08:32:50 -0300[diff] [blame^]1/*
2 * v4l2-i2c-drv-legacy.h - contains I2C handling code that's identical
3 * for all V4L2 I2C drivers. Use this header if the
4 * I2C driver is used by both legacy drivers and
5 * drivers converted to the bus-based I2C API.
6 *
7 * Copyright (C) 2007 Hans Verkuil <hverkuil@xs4all.nl>
8 *
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
13 *
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
18 *
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 */
23
24struct v4l2_i2c_driver_data {
25 const char * const name;
26 int driverid;
27 int (*command)(struct i2c_client *client, unsigned int cmd, void *arg);
28 int (*probe)(struct i2c_client *client);
29 int (*remove)(struct i2c_client *client);
30 int (*suspend)(struct i2c_client *client, pm_message_t state);
31 int (*resume)(struct i2c_client *client);
32 int legacy_class;
33};
34
35static struct v4l2_i2c_driver_data v4l2_i2c_data;
36static struct i2c_client_address_data addr_data;
37static struct i2c_driver v4l2_i2c_driver_legacy;
38static char v4l2_i2c_drv_name_legacy[32];
39
40static int v4l2_i2c_drv_attach_legacy(struct i2c_adapter *adapter, int address, int kind)
41{
42 return v4l2_i2c_attach(adapter, address, &v4l2_i2c_driver_legacy,
43 v4l2_i2c_drv_name_legacy, v4l2_i2c_data.probe);
44}
45
46static int v4l2_i2c_drv_probe_legacy(struct i2c_adapter *adapter)
47{
48 if (adapter->class & v4l2_i2c_data.legacy_class)
49 return i2c_probe(adapter, &addr_data, v4l2_i2c_drv_attach_legacy);
50 return 0;
51}
52
53static int v4l2_i2c_drv_detach_legacy(struct i2c_client *client)
54{
55 int err = i2c_detach_client(client);
56
57 if (err)
58 return err;
59 if (v4l2_i2c_data.remove)
60 v4l2_i2c_data.remove(client);
61 kfree(client);
62
63 return 0;
64}
65
66static int v4l2_i2c_drv_suspend_helper(struct i2c_client *client, pm_message_t state)
67{
68 return v4l2_i2c_data.suspend ? v4l2_i2c_data.suspend(client, state) : 0;
69}
70
71static int v4l2_i2c_drv_resume_helper(struct i2c_client *client)
72{
73 return v4l2_i2c_data.resume ? v4l2_i2c_data.resume(client) : 0;
74}
75
76/* ----------------------------------------------------------------------- */
77
78/* i2c implementation */
79static struct i2c_driver v4l2_i2c_driver_legacy = {
80 .driver = {
81 .owner = THIS_MODULE,
82 },
83 .attach_adapter = v4l2_i2c_drv_probe_legacy,
84 .detach_client = v4l2_i2c_drv_detach_legacy,
85 .suspend = v4l2_i2c_drv_suspend_helper,
86 .resume = v4l2_i2c_drv_resume_helper,
87};
88
89/* ----------------------------------------------------------------------- */
90
91/* i2c implementation */
92static struct i2c_driver v4l2_i2c_driver = {
93 .suspend = v4l2_i2c_drv_suspend_helper,
94 .resume = v4l2_i2c_drv_resume_helper,
95};
96
97static int __init v4l2_i2c_drv_init(void)
98{
99 int err;
100
101 strlcpy(v4l2_i2c_drv_name_legacy, v4l2_i2c_data.name, sizeof(v4l2_i2c_drv_name_legacy));
102 strlcat(v4l2_i2c_drv_name_legacy, "'", sizeof(v4l2_i2c_drv_name_legacy));
103
104 if (v4l2_i2c_data.legacy_class == 0)
105 v4l2_i2c_data.legacy_class = I2C_CLASS_TV_ANALOG;
106
107 v4l2_i2c_driver_legacy.driver.name = v4l2_i2c_drv_name_legacy;
108 v4l2_i2c_driver_legacy.id = v4l2_i2c_data.driverid;
109 v4l2_i2c_driver_legacy.command = v4l2_i2c_data.command;
110 err = i2c_add_driver(&v4l2_i2c_driver_legacy);
111
112 if (err)
113 return err;
114 v4l2_i2c_driver.driver.name = v4l2_i2c_data.name;
115 v4l2_i2c_driver.id = v4l2_i2c_data.driverid;
116 v4l2_i2c_driver.command = v4l2_i2c_data.command;
117 v4l2_i2c_driver.probe = v4l2_i2c_data.probe;
118 v4l2_i2c_driver.remove = v4l2_i2c_data.remove;
119 err = i2c_add_driver(&v4l2_i2c_driver);
120 if (err)
121 i2c_del_driver(&v4l2_i2c_driver_legacy);
122 return err;
123}
124
125static void __exit v4l2_i2c_drv_cleanup(void)
126{
127 i2c_del_driver(&v4l2_i2c_driver_legacy);
128 i2c_del_driver(&v4l2_i2c_driver);
129}
130
131module_init(v4l2_i2c_drv_init);
132module_exit(v4l2_i2c_drv_cleanup);