Merge branch 'linus' into sched/urgent
[linux-2.6] / drivers / media / video / cs53l32a.c
1 /*
2  * cs53l32a (Adaptec AVC-2010 and AVC-2410) i2c ivtv driver.
3  * Copyright (C) 2005  Martin Vaughan
4  *
5  * Audio source switching for Adaptec AVC-2410 added by Trev Jackson
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License as published by
9  * the Free Software Foundation; either version 2 of the License, or
10  * (at your option) any later version.
11  *
12  * This program is distributed in the hope that it will be useful,
13  * but WITHOUT ANY WARRANTY; without even the implied warranty of
14  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  * GNU General Public License for more details.
16  *
17  * You should have received a copy of the GNU General Public License
18  * along with this program; if not, write to the Free Software
19  * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20  */
21
22
23 #include <linux/module.h>
24 #include <linux/types.h>
25 #include <linux/ioctl.h>
26 #include <asm/uaccess.h>
27 #include <linux/i2c.h>
28 #include <linux/i2c-id.h>
29 #include <linux/videodev2.h>
30 #include <media/v4l2-device.h>
31 #include <media/v4l2-chip-ident.h>
32 #include <media/v4l2-i2c-drv-legacy.h>
33
34 MODULE_DESCRIPTION("i2c device driver for cs53l32a Audio ADC");
35 MODULE_AUTHOR("Martin Vaughan");
36 MODULE_LICENSE("GPL");
37
38 static int debug;
39
40 module_param(debug, bool, 0644);
41
42 MODULE_PARM_DESC(debug, "Debugging messages, 0=Off (default), 1=On");
43
44 static unsigned short normal_i2c[] = { 0x22 >> 1, I2C_CLIENT_END };
45
46 I2C_CLIENT_INSMOD;
47
48 /* ----------------------------------------------------------------------- */
49
50 static int cs53l32a_write(struct v4l2_subdev *sd, u8 reg, u8 value)
51 {
52         struct i2c_client *client = v4l2_get_subdevdata(sd);
53
54         return i2c_smbus_write_byte_data(client, reg, value);
55 }
56
57 static int cs53l32a_read(struct v4l2_subdev *sd, u8 reg)
58 {
59         struct i2c_client *client = v4l2_get_subdevdata(sd);
60
61         return i2c_smbus_read_byte_data(client, reg);
62 }
63
64 static int cs53l32a_s_routing(struct v4l2_subdev *sd, const struct v4l2_routing *route)
65 {
66         /* There are 2 physical inputs, but the second input can be
67            placed in two modes, the first mode bypasses the PGA (gain),
68            the second goes through the PGA. Hence there are three
69            possible inputs to choose from. */
70         if (route->input > 2) {
71                 v4l2_err(sd, "Invalid input %d.\n", route->input);
72                 return -EINVAL;
73         }
74         cs53l32a_write(sd, 0x01, 0x01 + (route->input << 4));
75         return 0;
76 }
77
78 static int cs53l32a_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
79 {
80         if (ctrl->id == V4L2_CID_AUDIO_MUTE) {
81                 ctrl->value = (cs53l32a_read(sd, 0x03) & 0xc0) != 0;
82                 return 0;
83         }
84         if (ctrl->id != V4L2_CID_AUDIO_VOLUME)
85                 return -EINVAL;
86         ctrl->value = (s8)cs53l32a_read(sd, 0x04);
87         return 0;
88 }
89
90 static int cs53l32a_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *ctrl)
91 {
92         if (ctrl->id == V4L2_CID_AUDIO_MUTE) {
93                 cs53l32a_write(sd, 0x03, ctrl->value ? 0xf0 : 0x30);
94                 return 0;
95         }
96         if (ctrl->id != V4L2_CID_AUDIO_VOLUME)
97                 return -EINVAL;
98         if (ctrl->value > 12 || ctrl->value < -96)
99                 return -EINVAL;
100         cs53l32a_write(sd, 0x04, (u8) ctrl->value);
101         cs53l32a_write(sd, 0x05, (u8) ctrl->value);
102         return 0;
103 }
104
105 static int cs53l32a_g_chip_ident(struct v4l2_subdev *sd, struct v4l2_dbg_chip_ident *chip)
106 {
107         struct i2c_client *client = v4l2_get_subdevdata(sd);
108
109         return v4l2_chip_ident_i2c_client(client,
110                         chip, V4L2_IDENT_CS53l32A, 0);
111 }
112
113 static int cs53l32a_log_status(struct v4l2_subdev *sd)
114 {
115         u8 v = cs53l32a_read(sd, 0x01);
116         u8 m = cs53l32a_read(sd, 0x03);
117         s8 vol = cs53l32a_read(sd, 0x04);
118
119         v4l2_info(sd, "Input:  %d%s\n", (v >> 4) & 3,
120                         (m & 0xC0) ? " (muted)" : "");
121         v4l2_info(sd, "Volume: %d dB\n", vol);
122         return 0;
123 }
124
125 static int cs53l32a_command(struct i2c_client *client, unsigned cmd, void *arg)
126 {
127         return v4l2_subdev_command(i2c_get_clientdata(client), cmd, arg);
128 }
129
130 /* ----------------------------------------------------------------------- */
131
132 static const struct v4l2_subdev_core_ops cs53l32a_core_ops = {
133         .log_status = cs53l32a_log_status,
134         .g_chip_ident = cs53l32a_g_chip_ident,
135         .g_ctrl = cs53l32a_g_ctrl,
136         .s_ctrl = cs53l32a_s_ctrl,
137 };
138
139 static const struct v4l2_subdev_audio_ops cs53l32a_audio_ops = {
140         .s_routing = cs53l32a_s_routing,
141 };
142
143 static const struct v4l2_subdev_ops cs53l32a_ops = {
144         .core = &cs53l32a_core_ops,
145         .audio = &cs53l32a_audio_ops,
146 };
147
148 /* ----------------------------------------------------------------------- */
149
150 /* i2c implementation */
151
152 /*
153  * Generic i2c probe
154  * concerning the addresses: i2c wants 7 bit (without the r/w bit), so '>>1'
155  */
156
157 static int cs53l32a_probe(struct i2c_client *client,
158                           const struct i2c_device_id *id)
159 {
160         struct v4l2_subdev *sd;
161         int i;
162
163         /* Check if the adapter supports the needed features */
164         if (!i2c_check_functionality(client->adapter, I2C_FUNC_SMBUS_BYTE_DATA))
165                 return -EIO;
166
167         if (!id)
168                 strlcpy(client->name, "cs53l32a", sizeof(client->name));
169
170         v4l_info(client, "chip found @ 0x%x (%s)\n",
171                         client->addr << 1, client->adapter->name);
172
173         sd = kmalloc(sizeof(struct v4l2_subdev), GFP_KERNEL);
174         if (sd == NULL)
175                 return -ENOMEM;
176         v4l2_i2c_subdev_init(sd, client, &cs53l32a_ops);
177
178         for (i = 1; i <= 7; i++) {
179                 u8 v = cs53l32a_read(sd, i);
180
181                 v4l2_dbg(1, debug, sd, "Read Reg %d %02x\n", i, v);
182         }
183
184         /* Set cs53l32a internal register for Adaptec 2010/2410 setup */
185
186         cs53l32a_write(sd, 0x01, (u8) 0x21);
187         cs53l32a_write(sd, 0x02, (u8) 0x29);
188         cs53l32a_write(sd, 0x03, (u8) 0x30);
189         cs53l32a_write(sd, 0x04, (u8) 0x00);
190         cs53l32a_write(sd, 0x05, (u8) 0x00);
191         cs53l32a_write(sd, 0x06, (u8) 0x00);
192         cs53l32a_write(sd, 0x07, (u8) 0x00);
193
194         /* Display results, should be 0x21,0x29,0x30,0x00,0x00,0x00,0x00 */
195
196         for (i = 1; i <= 7; i++) {
197                 u8 v = cs53l32a_read(sd, i);
198
199                 v4l2_dbg(1, debug, sd, "Read Reg %d %02x\n", i, v);
200         }
201         return 0;
202 }
203
204 static int cs53l32a_remove(struct i2c_client *client)
205 {
206         struct v4l2_subdev *sd = i2c_get_clientdata(client);
207
208         v4l2_device_unregister_subdev(sd);
209         kfree(sd);
210         return 0;
211 }
212
213 static const struct i2c_device_id cs53l32a_id[] = {
214         { "cs53l32a", 0 },
215         { }
216 };
217 MODULE_DEVICE_TABLE(i2c, cs53l32a_id);
218
219 static struct v4l2_i2c_driver_data v4l2_i2c_data = {
220         .name = "cs53l32a",
221         .driverid = I2C_DRIVERID_CS53L32A,
222         .command = cs53l32a_command,
223         .remove = cs53l32a_remove,
224         .probe = cs53l32a_probe,
225         .id_table = cs53l32a_id,
226 };