3 * (The TDA9875 is used on the Diamond DTV2000 french version
4 * Other cards probably use these chips as well.)
5 * This driver will not complain if used with any
6 * other i2c device with the same address.
8 * Copyright (c) 2000 Guillaume Delvit based on Gerd Knorr source and
10 * Copyright (c) 2006 Mauro Carvalho Chehab <mchehab@infradead.org>
11 * This code is placed under the terms of the GNU General Public License
12 * Based on tda9855.c by Steve VanDeBogart (vandebo@uclink.berkeley.edu)
13 * Which was based on tda8425.c by Greg Alexander (c) 1998
16 * debug - set to 1 if you'd like to see debug messages
18 * Revision: 0.1 - original version
21 #include <linux/module.h>
22 #include <linux/kernel.h>
23 #include <linux/string.h>
24 #include <linux/timer.h>
25 #include <linux/delay.h>
26 #include <linux/errno.h>
27 #include <linux/slab.h>
28 #include <linux/i2c.h>
29 #include <linux/videodev2.h>
30 #include <media/v4l2-device.h>
31 #include <media/i2c-addr.h>
33 static int debug
; /* insmod parameter */
34 module_param(debug
, int, S_IRUGO
| S_IWUSR
);
35 MODULE_LICENSE("GPL");
38 /* This is a superset of the TDA9875 */
40 struct v4l2_subdev sd
;
45 static inline struct tda9875
*to_state(struct v4l2_subdev
*sd
)
47 return container_of(sd
, struct tda9875
, sd
);
50 #define dprintk if (debug) printk
52 /* The TDA9875 is made by Philips Semiconductor
53 * http://www.semiconductors.philips.com
54 * TDA9875: I2C-bus controlled DSP audio processor, FM demodulator
58 /* subaddresses for TDA9875 */
59 #define TDA9875_MUT 0x12 /*General mute (value --> 0b11001100*/
60 #define TDA9875_CFG 0x01 /* Config register (value --> 0b00000000 */
61 #define TDA9875_DACOS 0x13 /*DAC i/o select (ADC) 0b0000100*/
62 #define TDA9875_LOSR 0x16 /*Line output select regirter 0b0100 0001*/
64 #define TDA9875_CH1V 0x0c /*Channel 1 volume (mute)*/
65 #define TDA9875_CH2V 0x0d /*Channel 2 volume (mute)*/
66 #define TDA9875_SC1 0x14 /*SCART 1 in (mono)*/
67 #define TDA9875_SC2 0x15 /*SCART 2 in (mono)*/
69 #define TDA9875_ADCIS 0x17 /*ADC input select (mono) 0b0110 000*/
70 #define TDA9875_AER 0x19 /*Audio effect (AVL+Pseudo) 0b0000 0110*/
71 #define TDA9875_MCS 0x18 /*Main channel select (DAC) 0b0000100*/
72 #define TDA9875_MVL 0x1a /* Main volume gauche */
73 #define TDA9875_MVR 0x1b /* Main volume droite */
74 #define TDA9875_MBA 0x1d /* Main Basse */
75 #define TDA9875_MTR 0x1e /* Main treble */
76 #define TDA9875_ACS 0x1f /* Auxilary channel select (FM) 0b0000000*/
77 #define TDA9875_AVL 0x20 /* Auxilary volume gauche */
78 #define TDA9875_AVR 0x21 /* Auxilary volume droite */
79 #define TDA9875_ABA 0x22 /* Auxilary Basse */
80 #define TDA9875_ATR 0x23 /* Auxilary treble */
82 #define TDA9875_MSR 0x02 /* Monitor select register */
83 #define TDA9875_C1MSB 0x03 /* Carrier 1 (FM) frequency register MSB */
84 #define TDA9875_C1MIB 0x04 /* Carrier 1 (FM) frequency register (16-8]b */
85 #define TDA9875_C1LSB 0x05 /* Carrier 1 (FM) frequency register LSB */
86 #define TDA9875_C2MSB 0x06 /* Carrier 2 (nicam) frequency register MSB */
87 #define TDA9875_C2MIB 0x07 /* Carrier 2 (nicam) frequency register (16-8]b */
88 #define TDA9875_C2LSB 0x08 /* Carrier 2 (nicam) frequency register LSB */
89 #define TDA9875_DCR 0x09 /* Demodulateur configuration regirter*/
90 #define TDA9875_DEEM 0x0a /* FM de-emphasis regirter*/
91 #define TDA9875_FMAT 0x0b /* FM Matrix regirter*/
94 #define TDA9875_MUTE_ON 0xff /* general mute */
95 #define TDA9875_MUTE_OFF 0xcc /* general no mute */
101 static int tda9875_write(struct v4l2_subdev
*sd
, int subaddr
, unsigned char val
)
103 struct i2c_client
*client
= v4l2_get_subdevdata(sd
);
104 unsigned char buffer
[2];
106 v4l2_dbg(1, debug
, sd
, "Writing %d 0x%x\n", subaddr
, val
);
109 if (2 != i2c_master_send(client
, buffer
, 2)) {
110 v4l2_warn(sd
, "I/O error, trying (write %d 0x%x)\n",
118 static int i2c_read_register(struct i2c_client
*client
, int addr
, int reg
)
120 unsigned char write
[1];
121 unsigned char read
[1];
122 struct i2c_msg msgs
[2] = {
123 { addr
, 0, 1, write
},
124 { addr
, I2C_M_RD
, 1, read
}
129 if (2 != i2c_transfer(client
->adapter
, msgs
, 2)) {
130 v4l_warn(client
, "I/O error (read2)\n");
133 v4l_dbg(1, debug
, client
, "chip_read2: reg%d=0x%x\n", reg
, read
[0]);
137 static void tda9875_set(struct v4l2_subdev
*sd
)
139 struct tda9875
*tda
= to_state(sd
);
142 v4l2_dbg(1, debug
, sd
, "tda9875_set(%04x,%04x,%04x,%04x)\n",
143 tda
->lvol
, tda
->rvol
, tda
->bass
, tda
->treble
);
145 a
= tda
->lvol
& 0xff;
146 tda9875_write(sd
, TDA9875_MVL
, a
);
148 tda9875_write(sd
, TDA9875_MVR
, a
);
150 tda9875_write(sd
, TDA9875_MBA
, a
);
151 a
=tda
->treble
& 0xff;
152 tda9875_write(sd
, TDA9875_MTR
, a
);
155 static void do_tda9875_init(struct v4l2_subdev
*sd
)
157 struct tda9875
*t
= to_state(sd
);
159 v4l2_dbg(1, debug
, sd
, "In tda9875_init\n");
160 tda9875_write(sd
, TDA9875_CFG
, 0xd0); /*reg de config 0 (reset)*/
161 tda9875_write(sd
, TDA9875_MSR
, 0x03); /* Monitor 0b00000XXX*/
162 tda9875_write(sd
, TDA9875_C1MSB
, 0x00); /*Car1(FM) MSB XMHz*/
163 tda9875_write(sd
, TDA9875_C1MIB
, 0x00); /*Car1(FM) MIB XMHz*/
164 tda9875_write(sd
, TDA9875_C1LSB
, 0x00); /*Car1(FM) LSB XMHz*/
165 tda9875_write(sd
, TDA9875_C2MSB
, 0x00); /*Car2(NICAM) MSB XMHz*/
166 tda9875_write(sd
, TDA9875_C2MIB
, 0x00); /*Car2(NICAM) MIB XMHz*/
167 tda9875_write(sd
, TDA9875_C2LSB
, 0x00); /*Car2(NICAM) LSB XMHz*/
168 tda9875_write(sd
, TDA9875_DCR
, 0x00); /*Demod config 0x00*/
169 tda9875_write(sd
, TDA9875_DEEM
, 0x44); /*DE-Emph 0b0100 0100*/
170 tda9875_write(sd
, TDA9875_FMAT
, 0x00); /*FM Matrix reg 0x00*/
171 tda9875_write(sd
, TDA9875_SC1
, 0x00); /* SCART 1 (SC1)*/
172 tda9875_write(sd
, TDA9875_SC2
, 0x01); /* SCART 2 (sc2)*/
174 tda9875_write(sd
, TDA9875_CH1V
, 0x10); /* Channel volume 1 mute*/
175 tda9875_write(sd
, TDA9875_CH2V
, 0x10); /* Channel volume 2 mute */
176 tda9875_write(sd
, TDA9875_DACOS
, 0x02); /* sig DAC i/o(in:nicam)*/
177 tda9875_write(sd
, TDA9875_ADCIS
, 0x6f); /* sig ADC input(in:mono)*/
178 tda9875_write(sd
, TDA9875_LOSR
, 0x00); /* line out (in:mono)*/
179 tda9875_write(sd
, TDA9875_AER
, 0x00); /*06 Effect (AVL+PSEUDO) */
180 tda9875_write(sd
, TDA9875_MCS
, 0x44); /* Main ch select (DAC) */
181 tda9875_write(sd
, TDA9875_MVL
, 0x03); /* Vol Main left 10dB */
182 tda9875_write(sd
, TDA9875_MVR
, 0x03); /* Vol Main right 10dB*/
183 tda9875_write(sd
, TDA9875_MBA
, 0x00); /* Main Bass Main 0dB*/
184 tda9875_write(sd
, TDA9875_MTR
, 0x00); /* Main Treble Main 0dB*/
185 tda9875_write(sd
, TDA9875_ACS
, 0x44); /* Aux chan select (dac)*/
186 tda9875_write(sd
, TDA9875_AVL
, 0x00); /* Vol Aux left 0dB*/
187 tda9875_write(sd
, TDA9875_AVR
, 0x00); /* Vol Aux right 0dB*/
188 tda9875_write(sd
, TDA9875_ABA
, 0x00); /* Aux Bass Main 0dB*/
189 tda9875_write(sd
, TDA9875_ATR
, 0x00); /* Aux Aigus Main 0dB*/
191 tda9875_write(sd
, TDA9875_MUT
, 0xcc); /* General mute */
193 t
->lvol
= t
->rvol
= 0; /* 0dB */
194 t
->bass
= 0; /* 0dB */
195 t
->treble
= 0; /* 0dB */
200 static int tda9875_g_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
202 struct tda9875
*t
= to_state(sd
);
205 case V4L2_CID_AUDIO_VOLUME
:
207 int left
= (t
->lvol
+84)*606;
208 int right
= (t
->rvol
+84)*606;
210 ctrl
->value
=max(left
,right
);
213 case V4L2_CID_AUDIO_BALANCE
:
215 int left
= (t
->lvol
+84)*606;
216 int right
= (t
->rvol
+84)*606;
217 int volume
= max(left
,right
);
218 int balance
= (32768*min(left
,right
))/
219 (volume
? volume
: 1);
220 ctrl
->value
=(left
<right
)?
221 (65535-balance
) : balance
;
224 case V4L2_CID_AUDIO_BASS
:
225 ctrl
->value
= (t
->bass
+12)*2427; /* min -12 max +15 */
227 case V4L2_CID_AUDIO_TREBLE
:
228 ctrl
->value
= (t
->treble
+12)*2730;/* min -12 max +12 */
234 static int tda9875_s_ctrl(struct v4l2_subdev
*sd
, struct v4l2_control
*ctrl
)
236 struct tda9875
*t
= to_state(sd
);
237 int chvol
= 0, volume
= 0, balance
= 0, left
, right
;
240 case V4L2_CID_AUDIO_VOLUME
:
241 left
= (t
->lvol
+84)*606;
242 right
= (t
->rvol
+84)*606;
244 volume
= max(left
,right
);
245 balance
= (32768*min(left
,right
))/
246 (volume
? volume
: 1);
247 balance
=(left
<right
)?
248 (65535-balance
) : balance
;
250 volume
= ctrl
->value
;
254 case V4L2_CID_AUDIO_BALANCE
:
255 left
= (t
->lvol
+84)*606;
256 right
= (t
->rvol
+84)*606;
258 volume
=max(left
,right
);
260 balance
= ctrl
->value
;
264 case V4L2_CID_AUDIO_BASS
:
265 t
->bass
= ((ctrl
->value
/2400)-12) & 0xff;
269 t
->bass
= -12 & 0xff;
271 case V4L2_CID_AUDIO_TREBLE
:
272 t
->treble
= ((ctrl
->value
/2700)-12) & 0xff;
276 t
->treble
= -12 & 0xff;
283 left
= (min(65536 - balance
,32768) *
285 right
= (min(balance
,32768) *
287 t
->lvol
= ((left
/606)-84) & 0xff;
291 t
->lvol
= -84 & 0xff;
293 t
->rvol
= ((right
/606)-84) & 0xff;
297 t
->rvol
= -84 & 0xff;
304 static int tda9875_queryctrl(struct v4l2_subdev
*sd
, struct v4l2_queryctrl
*qc
)
307 case V4L2_CID_AUDIO_VOLUME
:
308 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 58880);
309 case V4L2_CID_AUDIO_BASS
:
310 case V4L2_CID_AUDIO_TREBLE
:
311 return v4l2_ctrl_query_fill(qc
, 0, 65535, 65535 / 100, 32768);
316 /* ----------------------------------------------------------------------- */
318 static const struct v4l2_subdev_core_ops tda9875_core_ops
= {
319 .queryctrl
= tda9875_queryctrl
,
320 .g_ctrl
= tda9875_g_ctrl
,
321 .s_ctrl
= tda9875_s_ctrl
,
324 static const struct v4l2_subdev_ops tda9875_ops
= {
325 .core
= &tda9875_core_ops
,
328 /* ----------------------------------------------------------------------- */
331 /* *********************** *
332 * i2c interface functions *
333 * *********************** */
335 static int tda9875_checkit(struct i2c_client
*client
, int addr
)
339 dic
= i2c_read_register(client
, addr
, 254);
340 rev
= i2c_read_register(client
, addr
, 255);
342 if (dic
== 0 || dic
== 2) { /* tda9875 and tda9875A */
343 v4l_info(client
, "tda9875%s rev. %d detected at 0x%02x\n",
344 dic
== 0 ? "" : "A", rev
, addr
<< 1);
347 v4l_info(client
, "no such chip at 0x%02x (dic=0x%x rev=0x%x)\n",
348 addr
<< 1, dic
, rev
);
352 static int tda9875_probe(struct i2c_client
*client
,
353 const struct i2c_device_id
*id
)
356 struct v4l2_subdev
*sd
;
358 v4l_info(client
, "chip found @ 0x%02x (%s)\n",
359 client
->addr
<< 1, client
->adapter
->name
);
361 if (!tda9875_checkit(client
, client
->addr
))
364 t
= kzalloc(sizeof(*t
), GFP_KERNEL
);
368 v4l2_i2c_subdev_init(sd
, client
, &tda9875_ops
);
374 static int tda9875_remove(struct i2c_client
*client
)
376 struct v4l2_subdev
*sd
= i2c_get_clientdata(client
);
379 v4l2_device_unregister_subdev(sd
);
384 static const struct i2c_device_id tda9875_id
[] = {
388 MODULE_DEVICE_TABLE(i2c
, tda9875_id
);
390 static struct i2c_driver tda9875_driver
= {
392 .owner
= THIS_MODULE
,
395 .probe
= tda9875_probe
,
396 .remove
= tda9875_remove
,
397 .id_table
= tda9875_id
,
400 static __init
int init_tda9875(void)
402 return i2c_add_driver(&tda9875_driver
);
405 static __exit
void exit_tda9875(void)
407 i2c_del_driver(&tda9875_driver
);
410 module_init(init_tda9875
);
411 module_exit(exit_tda9875
);