1 /* cx25840 audio functions
3 * This program is free software; you can redistribute it and/or
4 * modify it under the terms of the GNU General Public License
5 * as published by the Free Software Foundation; either version 2
6 * of the License, or (at your option) any later version.
8 * This program is distributed in the hope that it will be useful,
9 * but WITHOUT ANY WARRANTY; without even the implied warranty of
10 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
11 * GNU General Public License for more details.
13 * You should have received a copy of the GNU General Public License
14 * along with this program; if not, write to the Free Software
15 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
19 #include <linux/videodev2.h>
20 #include <linux/i2c.h>
21 #include <media/audiochip.h>
22 #include <media/i2c-compat.h>
23 #include <media/v4l2-common.h>
27 inline static int set_audclk_freq(struct i2c_client *client,
28 enum v4l2_audio_clock_freq freq)
30 struct cx25840_state *state = i2c_get_clientdata(client);
32 /* assert soft reset */
33 cx25840_and_or(client, 0x810, ~0x1, 0x01);
35 /* common for all inputs and rates */
36 /* SA_MCLK_SEL=1, SA_MCLK_DIV=0x10 */
37 cx25840_write(client, 0x127, 0x50);
39 switch (state->audio_input) {
42 case V4L2_AUDCLK_32_KHZ:
43 /* VID_PLL and AUX_PLL */
44 cx25840_write4(client, 0x108, 0x0f040610);
47 cx25840_write4(client, 0x110, 0xee39bb01);
49 /* src3/4/6_ctl = 0x0801f77f */
50 cx25840_write4(client, 0x900, 0x7ff70108);
51 cx25840_write4(client, 0x904, 0x7ff70108);
52 cx25840_write4(client, 0x90c, 0x7ff70108);
55 case V4L2_AUDCLK_441_KHZ:
56 /* VID_PLL and AUX_PLL */
57 cx25840_write4(client, 0x108, 0x0f040910);
60 cx25840_write4(client, 0x110, 0xd66bec00);
62 /* src3/4/6_ctl = 0x08016d59 */
63 cx25840_write4(client, 0x900, 0x596d0108);
64 cx25840_write4(client, 0x904, 0x596d0108);
65 cx25840_write4(client, 0x90c, 0x596d0108);
68 case V4L2_AUDCLK_48_KHZ:
69 /* VID_PLL and AUX_PLL */
70 cx25840_write4(client, 0x108, 0x0f040a10);
73 cx25840_write4(client, 0x110, 0xe5d69800);
75 /* src3/4/6_ctl = 0x08014faa */
76 cx25840_write4(client, 0x900, 0xaa4f0108);
77 cx25840_write4(client, 0x904, 0xaa4f0108);
78 cx25840_write4(client, 0x90c, 0xaa4f0108);
88 case V4L2_AUDCLK_32_KHZ:
89 /* VID_PLL and AUX_PLL */
90 cx25840_write4(client, 0x108, 0x0f04081e);
93 cx25840_write4(client, 0x110, 0x69082a01);
95 /* src1_ctl = 0x08010000 */
96 cx25840_write4(client, 0x8f8, 0x00000108);
98 /* src3/4/6_ctl = 0x08020000 */
99 cx25840_write4(client, 0x900, 0x00000208);
100 cx25840_write4(client, 0x904, 0x00000208);
101 cx25840_write4(client, 0x90c, 0x00000208);
103 /* SA_MCLK_SEL=1, SA_MCLK_DIV=0x14 */
104 cx25840_write(client, 0x127, 0x54);
107 case V4L2_AUDCLK_441_KHZ:
108 /* VID_PLL and AUX_PLL */
109 cx25840_write4(client, 0x108, 0x0f040918);
112 cx25840_write4(client, 0x110, 0xd66bec00);
114 /* src1_ctl = 0x08010000 */
115 cx25840_write4(client, 0x8f8, 0xcd600108);
117 /* src3/4/6_ctl = 0x08020000 */
118 cx25840_write4(client, 0x900, 0x85730108);
119 cx25840_write4(client, 0x904, 0x85730108);
120 cx25840_write4(client, 0x90c, 0x85730108);
123 case V4L2_AUDCLK_48_KHZ:
124 /* VID_PLL and AUX_PLL */
125 cx25840_write4(client, 0x108, 0x0f040a18);
128 cx25840_write4(client, 0x110, 0xe5d69800);
130 /* src1_ctl = 0x08010000 */
131 cx25840_write4(client, 0x8f8, 0x00800108);
133 /* src3/4/6_ctl = 0x08020000 */
134 cx25840_write4(client, 0x900, 0x55550108);
135 cx25840_write4(client, 0x904, 0x55550108);
136 cx25840_write4(client, 0x90c, 0x55550108);
142 /* deassert soft reset */
143 cx25840_and_or(client, 0x810, ~0x1, 0x00);
145 state->audclk_freq = freq;
150 static int set_input(struct i2c_client *client, int audio_input)
152 struct cx25840_state *state = i2c_get_clientdata(client);
154 cx25840_dbg("set audio input (%d)\n", audio_input);
156 /* stop microcontroller */
157 cx25840_and_or(client, 0x803, ~0x10, 0);
159 /* Mute everything to prevent the PFFT! */
160 cx25840_write(client, 0x8d3, 0x1f);
162 switch (audio_input) {
164 /* Set Path1 to Analog Demod Main Channel */
165 cx25840_write4(client, 0x8d0, 0x7038061f);
167 /* When the microcontroller detects the
168 * audio format, it will unmute the lines */
169 cx25840_and_or(client, 0x803, ~0x10, 0x10);
176 /* Set Path1 to Serial Audio Input */
177 cx25840_write4(client, 0x8d0, 0x12100101);
179 /* The microcontroller should not be started for the
180 * non-tuner inputs: autodetection is specific for
185 cx25840_dbg("Invalid audio input selection %d\n", audio_input);
189 state->audio_input = audio_input;
191 return set_audclk_freq(client, state->audclk_freq);
194 inline static int get_volume(struct i2c_client *client)
196 /* Volume runs +18dB to -96dB in 1/2dB steps
197 * change to fit the msp3400 -114dB to +12dB range */
199 /* check PATH1_VOLUME */
200 int vol = 228 - cx25840_read(client, 0x8d4);
201 vol = (vol / 2) + 23;
205 inline static void set_volume(struct i2c_client *client, int volume)
207 /* First convert the volume to msp3400 values (0-127) */
208 int vol = volume >> 9;
209 /* now scale it up to cx25840 values
210 * -114dB to -96dB maps to 0
211 * this should be 19, but in my testing that was 4dB too loud */
219 cx25840_write(client, 0x8d4, 228 - (vol * 2));
222 inline static int get_bass(struct i2c_client *client)
224 /* bass is 49 steps +12dB to -12dB */
226 /* check PATH1_EQ_BASS_VOL */
227 int bass = cx25840_read(client, 0x8d9) & 0x3f;
228 bass = (((48 - bass) * 0xffff) + 47) / 48;
232 inline static void set_bass(struct i2c_client *client, int bass)
234 /* PATH1_EQ_BASS_VOL */
235 cx25840_and_or(client, 0x8d9, ~0x3f, 48 - (bass * 48 / 0xffff));
238 inline static int get_treble(struct i2c_client *client)
240 /* treble is 49 steps +12dB to -12dB */
242 /* check PATH1_EQ_TREBLE_VOL */
243 int treble = cx25840_read(client, 0x8db) & 0x3f;
244 treble = (((48 - treble) * 0xffff) + 47) / 48;
248 inline static void set_treble(struct i2c_client *client, int treble)
250 /* PATH1_EQ_TREBLE_VOL */
251 cx25840_and_or(client, 0x8db, ~0x3f, 48 - (treble * 48 / 0xffff));
254 inline static int get_balance(struct i2c_client *client)
256 /* balance is 7 bit, 0 to -96dB */
258 /* check PATH1_BAL_LEVEL */
259 int balance = cx25840_read(client, 0x8d5) & 0x7f;
260 /* check PATH1_BAL_LEFT */
261 if ((cx25840_read(client, 0x8d5) & 0x80) == 0)
262 balance = 0x80 - balance;
264 balance = 0x80 + balance;
268 inline static void set_balance(struct i2c_client *client, int balance)
270 int bal = balance >> 8;
273 cx25840_and_or(client, 0x8d5, 0x7f, 0x80);
274 /* PATH1_BAL_LEVEL */
275 cx25840_and_or(client, 0x8d5, ~0x7f, bal & 0x7f);
278 cx25840_and_or(client, 0x8d5, 0x7f, 0x00);
279 /* PATH1_BAL_LEVEL */
280 cx25840_and_or(client, 0x8d5, ~0x7f, 0x80 - bal);
284 inline static int get_mute(struct i2c_client *client)
286 /* check SRC1_MUTE_EN */
287 return cx25840_read(client, 0x8d3) & 0x2 ? 1 : 0;
290 inline static void set_mute(struct i2c_client *client, int mute)
292 struct cx25840_state *state = i2c_get_clientdata(client);
294 if (state->audio_input == AUDIO_TUNER) {
295 /* Must turn off microcontroller in order to mute sound.
296 * Not sure if this is the best method, but it does work.
297 * If the microcontroller is running, then it will undo any
298 * changes to the mute register. */
300 /* disable microcontroller */
301 cx25840_and_or(client, 0x803, ~0x10, 0x00);
302 cx25840_write(client, 0x8d3, 0x1f);
304 /* enable microcontroller */
305 cx25840_and_or(client, 0x803, ~0x10, 0x10);
309 cx25840_and_or(client, 0x8d3, ~0x2, mute ? 0x02 : 0x00);
313 int cx25840_audio(struct i2c_client *client, unsigned int cmd, void *arg)
315 struct v4l2_control *ctrl = arg;
319 return set_input(client, *(int *)arg);
320 case VIDIOC_INT_AUDIO_CLOCK_FREQ:
321 return set_audclk_freq(client, *(enum v4l2_audio_clock_freq *)arg);
324 case V4L2_CID_AUDIO_VOLUME:
325 ctrl->value = get_volume(client);
327 case V4L2_CID_AUDIO_BASS:
328 ctrl->value = get_bass(client);
330 case V4L2_CID_AUDIO_TREBLE:
331 ctrl->value = get_treble(client);
333 case V4L2_CID_AUDIO_BALANCE:
334 ctrl->value = get_balance(client);
336 case V4L2_CID_AUDIO_MUTE:
337 ctrl->value = get_mute(client);
345 case V4L2_CID_AUDIO_VOLUME:
346 set_volume(client, ctrl->value);
348 case V4L2_CID_AUDIO_BASS:
349 set_bass(client, ctrl->value);
351 case V4L2_CID_AUDIO_TREBLE:
352 set_treble(client, ctrl->value);
354 case V4L2_CID_AUDIO_BALANCE:
355 set_balance(client, ctrl->value);
357 case V4L2_CID_AUDIO_MUTE:
358 set_mute(client, ctrl->value);