1 /*
2 tda9840 - i2c-driver for the tda9840 by SGS Thomson
3
4 Copyright (C) 1998-2003 Michael Hunold <michael@mihu.de>
5 Copyright (C) 2008 Hans Verkuil <hverkuil@xs4all.nl>
6
7 The tda9840 is a stereo/dual sound processor with digital
8 identification. It can be found at address 0x84 on the i2c-bus.
9
10 For detailed informations download the specifications directly
11 from SGS Thomson at http://www.st.com
12
13 This program is free software; you can redistribute it and/or modify
14 it under the terms of the GNU General Public License as published by
15 the Free Software Foundation; either version 2 of the License, or
16 (at your option) any later version.
17
18 This program is distributed in the hope that it will be useful,
19 but WITHOUT ANY WARRANTY; without even the implied warranty of
20 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
21 GNU General Public License for more details.
22
23 You should have received a copy of the GNU General Public License
24 along with this program; if not, write to the Free Software
25 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
26 */
27
28
29 #include <linux/module.h>
30 #include <linux/ioctl.h>
31 #include <linux/i2c.h>
32 #include <media/v4l2-device.h>
33 #include <media/v4l2-i2c-drv-legacy.h>
34 #include "tda9840.h"
35
36 MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
37 MODULE_DESCRIPTION("tda9840 driver");
38 MODULE_LICENSE("GPL");
39
40 static int debug;
41 module_param(debug, int, 0644);
42
43 MODULE_PARM_DESC(debug, "Debug level (0-1)");
44
45 #define SWITCH 0x00
46 #define LEVEL_ADJUST 0x02
47 #define STEREO_ADJUST 0x03
48 #define TEST 0x04
49
50 #define TDA9840_SET_MUTE 0x00
51 #define TDA9840_SET_MONO 0x10
52 #define TDA9840_SET_STEREO 0x2a
53 #define TDA9840_SET_LANG1 0x12
54 #define TDA9840_SET_LANG2 0x1e
55 #define TDA9840_SET_BOTH 0x1a
56 #define TDA9840_SET_BOTH_R 0x16
57 #define TDA9840_SET_EXTERNAL 0x7a
58
59 /* addresses to scan, found only at 0x42 (7-Bit) */
60 static unsigned short normal_i2c[] = { I2C_ADDR_TDA9840, I2C_CLIENT_END };
61
62 /* magic definition of all other variables and things */
63 I2C_CLIENT_INSMOD;
64
tda9840_write(struct v4l2_subdev * sd,u8 reg,u8 val)65 static void tda9840_write(struct v4l2_subdev *sd, u8 reg, u8 val)
66 {
67 struct i2c_client *client = v4l2_get_subdevdata(sd);
68
69 if (i2c_smbus_write_byte_data(client, reg, val))
70 v4l2_dbg(1, debug, sd, "error writing %02x to %02x\n",
71 val, reg);
72 }
73
tda9840_s_tuner(struct v4l2_subdev * sd,struct v4l2_tuner * t)74 static int tda9840_s_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *t)
75 {
76 int byte;
77
78 if (t->index)
79 return -EINVAL;
80
81 switch (t->audmode) {
82 case V4L2_TUNER_MODE_STEREO:
83 byte = TDA9840_SET_STEREO;
84 break;
85 case V4L2_TUNER_MODE_LANG1_LANG2:
86 byte = TDA9840_SET_BOTH;
87 break;
88 case V4L2_TUNER_MODE_LANG1:
89 byte = TDA9840_SET_LANG1;
90 break;
91 case V4L2_TUNER_MODE_LANG2:
92 byte = TDA9840_SET_LANG2;
93 break;
94 default:
95 byte = TDA9840_SET_MONO;
96 break;
97 }
98 v4l2_dbg(1, debug, sd, "TDA9840_SWITCH: 0x%02x\n", byte);
99 tda9840_write(sd, SWITCH, byte);
100 return 0;
101 }
102
tda9840_g_tuner(struct v4l2_subdev * sd,struct v4l2_tuner * t)103 static int tda9840_g_tuner(struct v4l2_subdev *sd, struct v4l2_tuner *t)
104 {
105 struct i2c_client *client = v4l2_get_subdevdata(sd);
106 u8 byte;
107
108 t->rxsubchans = V4L2_TUNER_SUB_MONO;
109 if (1 != i2c_master_recv(client, &byte, 1)) {
110 v4l2_dbg(1, debug, sd,
111 "i2c_master_recv() failed\n");
112 return -EIO;
113 }
114
115 if (byte & 0x80) {
116 v4l2_dbg(1, debug, sd,
117 "TDA9840_DETECT: register contents invalid\n");
118 return -EINVAL;
119 }
120
121 v4l2_dbg(1, debug, sd, "TDA9840_DETECT: byte: 0x%02x\n", byte);
122
123 switch (byte & 0x60) {
124 case 0x00:
125 t->rxsubchans = V4L2_TUNER_SUB_MONO;
126 break;
127 case 0x20:
128 t->rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
129 break;
130 case 0x40:
131 t->rxsubchans = V4L2_TUNER_SUB_STEREO | V4L2_TUNER_SUB_MONO;
132 break;
133 default: /* Incorrect detect */
134 t->rxsubchans = V4L2_TUNER_MODE_MONO;
135 break;
136 }
137 return 0;
138 }
139
tda9840_ioctl(struct v4l2_subdev * sd,unsigned cmd,void * arg)140 static long tda9840_ioctl(struct v4l2_subdev *sd, unsigned cmd, void *arg)
141 {
142 int byte;
143
144 switch (cmd) {
145 case TDA9840_LEVEL_ADJUST:
146 byte = *(int *)arg;
147 v4l2_dbg(1, debug, sd, "TDA9840_LEVEL_ADJUST: %d\n", byte);
148
149 /* check for correct range */
150 if (byte > 25 || byte < -20)
151 return -EINVAL;
152
153 /* calculate actual value to set, see specs, page 18 */
154 byte /= 5;
155 if (0 < byte)
156 byte += 0x8;
157 else
158 byte = -byte;
159 tda9840_write(sd, LEVEL_ADJUST, byte);
160 break;
161
162 case TDA9840_STEREO_ADJUST:
163 byte = *(int *)arg;
164 v4l2_dbg(1, debug, sd, "TDA9840_STEREO_ADJUST: %d\n", byte);
165
166 /* check for correct range */
167 if (byte > 25 || byte < -24)
168 return -EINVAL;
169
170 /* calculate actual value to set */
171 byte /= 5;
172 if (0 < byte)
173 byte += 0x20;
174 else
175 byte = -byte;
176
177 tda9840_write(sd, STEREO_ADJUST, byte);
178 break;
179 default:
180 return -ENOIOCTLCMD;
181 }
182 return 0;
183 }
184
tda9840_command(struct i2c_client * client,unsigned cmd,void * arg)185 static int tda9840_command(struct i2c_client *client, unsigned cmd, void *arg)
186 {
187 return v4l2_subdev_command(i2c_get_clientdata(client), cmd, arg);
188 }
189
190 /* ----------------------------------------------------------------------- */
191
192 static const struct v4l2_subdev_core_ops tda9840_core_ops = {
193 .ioctl = tda9840_ioctl,
194 };
195
196 static const struct v4l2_subdev_tuner_ops tda9840_tuner_ops = {
197 .s_tuner = tda9840_s_tuner,
198 .g_tuner = tda9840_g_tuner,
199 };
200
201 static const struct v4l2_subdev_ops tda9840_ops = {
202 .core = &tda9840_core_ops,
203 .tuner = &tda9840_tuner_ops,
204 };
205
206 /* ----------------------------------------------------------------------- */
207
tda9840_probe(struct i2c_client * client,const struct i2c_device_id * id)208 static int tda9840_probe(struct i2c_client *client,
209 const struct i2c_device_id *id)
210 {
211 struct v4l2_subdev *sd;
212 int result;
213 int byte;
214
215 /* let's see whether this adapter can support what we need */
216 if (!i2c_check_functionality(client->adapter,
217 I2C_FUNC_SMBUS_READ_BYTE_DATA |
218 I2C_FUNC_SMBUS_WRITE_BYTE_DATA))
219 return -EIO;
220
221 v4l_info(client, "chip found @ 0x%x (%s)\n",
222 client->addr << 1, client->adapter->name);
223
224 sd = kmalloc(sizeof(struct v4l2_subdev), GFP_KERNEL);
225 if (sd == NULL)
226 return -ENOMEM;
227 v4l2_i2c_subdev_init(sd, client, &tda9840_ops);
228
229 /* set initial values for level & stereo - adjustment, mode */
230 byte = 0;
231 result = tda9840_ioctl(sd, TDA9840_LEVEL_ADJUST, &byte);
232 result |= tda9840_ioctl(sd, TDA9840_STEREO_ADJUST, &byte);
233 tda9840_write(sd, SWITCH, TDA9840_SET_STEREO);
234 if (result) {
235 v4l2_dbg(1, debug, sd, "could not initialize tda9840\n");
236 kfree(sd);
237 return -ENODEV;
238 }
239 return 0;
240 }
241
tda9840_remove(struct i2c_client * client)242 static int tda9840_remove(struct i2c_client *client)
243 {
244 struct v4l2_subdev *sd = i2c_get_clientdata(client);
245
246 v4l2_device_unregister_subdev(sd);
247 kfree(sd);
248 return 0;
249 }
250
tda9840_legacy_probe(struct i2c_adapter * adapter)251 static int tda9840_legacy_probe(struct i2c_adapter *adapter)
252 {
253 /* Let's see whether this is a known adapter we can attach to.
254 Prevents conflicts with tvaudio.c. */
255 return adapter->id == I2C_HW_SAA7146;
256 }
257 static const struct i2c_device_id tda9840_id[] = {
258 { "tda9840", 0 },
259 { }
260 };
261 MODULE_DEVICE_TABLE(i2c, tda9840_id);
262
263 static struct v4l2_i2c_driver_data v4l2_i2c_data = {
264 .name = "tda9840",
265 .driverid = I2C_DRIVERID_TDA9840,
266 .command = tda9840_command,
267 .probe = tda9840_probe,
268 .remove = tda9840_remove,
269 .legacy_probe = tda9840_legacy_probe,
270 .id_table = tda9840_id,
271 };
272