]> git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blame - drivers/media/pci/saa7134/saa7134-tvaudio.c
[media] saa7134: avoid complex macro warnings
[mirror_ubuntu-artful-kernel.git] / drivers / media / pci / saa7134 / saa7134-tvaudio.c
CommitLineData
1da177e4 1/*
1da177e4
LT
2 *
3 * device driver for philips saa7134 based TV cards
4 * tv audio decoder (fm stereo, nicam, ...)
5 *
6 * (c) 2001-03 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License as published by
10 * the Free Software Foundation; either version 2 of the License, or
11 * (at your option) any later version.
12 *
13 * This program is distributed in the hope that it will be useful,
14 * but WITHOUT ANY WARRANTY; without even the implied warranty of
15 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
16 * GNU General Public License for more details.
17 *
18 * You should have received a copy of the GNU General Public License
19 * along with this program; if not, write to the Free Software
20 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 */
22
9a12ccfc
MCC
23#include "saa7134.h"
24#include "saa7134-reg.h"
25
1da177e4
LT
26#include <linux/init.h>
27#include <linux/list.h>
28#include <linux/module.h>
1da177e4 29#include <linux/kernel.h>
3e0e38e6 30#include <linux/kthread.h>
1da177e4 31#include <linux/delay.h>
ea63d0b1 32#include <linux/freezer.h>
1da177e4
LT
33#include <asm/div64.h>
34
1da177e4
LT
35/* ------------------------------------------------------------------ */
36
ff699e6b 37static unsigned int audio_debug;
1da177e4
LT
38module_param(audio_debug, int, 0644);
39MODULE_PARM_DESC(audio_debug,"enable debug messages [tv audio]");
40
ff699e6b 41static unsigned int audio_ddep;
1da177e4
LT
42module_param(audio_ddep, int, 0644);
43MODULE_PARM_DESC(audio_ddep,"audio ddep overwrite");
44
45static int audio_clock_override = UNSET;
46module_param(audio_clock_override, int, 0644);
47
ff699e6b 48static int audio_clock_tweak;
1da177e4
LT
49module_param(audio_clock_tweak, int, 0644);
50MODULE_PARM_DESC(audio_clock_tweak, "Audio clock tick fine tuning for cards with audio crystal that's slightly off (range [-1024 .. 1024])");
51
45f38cb3
MCC
52#define audio_dbg(level, fmt, arg...) do { \
53 if (audio_debug >= level) \
54 printk(KERN_DEBUG pr_fmt("audio: " fmt), ## arg); \
55 } while (0)
1da177e4
LT
56
57/* msecs */
58#define SCAN_INITIAL_DELAY 1000
59#define SCAN_SAMPLE_DELAY 200
60#define SCAN_SUBCARRIER_DELAY 2000
61
62/* ------------------------------------------------------------------ */
63/* saa7134 code */
64
65static struct mainscan {
66 char *name;
67 v4l2_std_id std;
68 int carr;
69} mainscan[] = {
70 {
17b10a73
HH
71 .name = "MN",
72 .std = V4L2_STD_MN,
1da177e4
LT
73 .carr = 4500,
74 },{
17b10a73
HH
75 .name = "BGH",
76 .std = V4L2_STD_B | V4L2_STD_GH,
1da177e4
LT
77 .carr = 5500,
78 },{
79 .name = "I",
80 .std = V4L2_STD_PAL_I,
81 .carr = 6000,
82 },{
83 .name = "DKL",
17b10a73 84 .std = V4L2_STD_DK | V4L2_STD_SECAM_L | V4L2_STD_SECAM_LC,
1da177e4
LT
85 .carr = 6500,
86 }
87};
88
89static struct saa7134_tvaudio tvaudio[] = {
90 {
91 .name = "PAL-B/G FM-stereo",
17b10a73 92 .std = V4L2_STD_PAL_BG,
1da177e4
LT
93 .mode = TVAUDIO_FM_BG_STEREO,
94 .carr1 = 5500,
95 .carr2 = 5742,
96 },{
97 .name = "PAL-D/K1 FM-stereo",
17b10a73 98 .std = V4L2_STD_PAL_DK,
1da177e4
LT
99 .carr1 = 6500,
100 .carr2 = 6258,
101 .mode = TVAUDIO_FM_BG_STEREO,
102 },{
103 .name = "PAL-D/K2 FM-stereo",
17b10a73 104 .std = V4L2_STD_PAL_DK,
1da177e4
LT
105 .carr1 = 6500,
106 .carr2 = 6742,
107 .mode = TVAUDIO_FM_BG_STEREO,
108 },{
109 .name = "PAL-D/K3 FM-stereo",
17b10a73 110 .std = V4L2_STD_PAL_DK,
1da177e4
LT
111 .carr1 = 6500,
112 .carr2 = 5742,
113 .mode = TVAUDIO_FM_BG_STEREO,
114 },{
115 .name = "PAL-B/G NICAM",
17b10a73 116 .std = V4L2_STD_PAL_BG,
1da177e4
LT
117 .carr1 = 5500,
118 .carr2 = 5850,
119 .mode = TVAUDIO_NICAM_FM,
120 },{
121 .name = "PAL-I NICAM",
17b10a73 122 .std = V4L2_STD_PAL_I,
1da177e4
LT
123 .carr1 = 6000,
124 .carr2 = 6552,
125 .mode = TVAUDIO_NICAM_FM,
126 },{
127 .name = "PAL-D/K NICAM",
17b10a73 128 .std = V4L2_STD_PAL_DK,
1da177e4
LT
129 .carr1 = 6500,
130 .carr2 = 5850,
131 .mode = TVAUDIO_NICAM_FM,
132 },{
133 .name = "SECAM-L NICAM",
17b10a73 134 .std = V4L2_STD_SECAM_L,
1da177e4
LT
135 .carr1 = 6500,
136 .carr2 = 5850,
137 .mode = TVAUDIO_NICAM_AM,
f7d66e82 138 },{
17b10a73
HH
139 .name = "SECAM-D/K NICAM",
140 .std = V4L2_STD_SECAM_DK,
f7d66e82 141 .carr1 = 6500,
17b10a73
HH
142 .carr2 = 5850,
143 .mode = TVAUDIO_NICAM_FM,
1da177e4 144 },{
17b10a73
HH
145 .name = "NTSC-A2 FM-stereo",
146 .std = V4L2_STD_NTSC,
147 .carr1 = 4500,
148 .carr2 = 4724,
149 .mode = TVAUDIO_FM_K_STEREO,
1da177e4
LT
150 },{
151 .name = "NTSC-M",
152 .std = V4L2_STD_NTSC,
153 .carr1 = 4500,
154 .carr2 = -1,
155 .mode = TVAUDIO_FM_MONO,
1da177e4
LT
156 }
157};
80297125 158#define TVAUDIO ARRAY_SIZE(tvaudio)
1da177e4
LT
159
160/* ------------------------------------------------------------------ */
161
1da177e4
LT
162static u32 tvaudio_carr2reg(u32 carrier)
163{
164 u64 a = carrier;
165
166 a <<= 24;
167 do_div(a,12288);
168 return a;
169}
170
171static void tvaudio_setcarrier(struct saa7134_dev *dev,
172 int primary, int secondary)
173{
174 if (-1 == secondary)
175 secondary = primary;
176 saa_writel(SAA7134_CARRIER1_FREQ0 >> 2, tvaudio_carr2reg(primary));
177 saa_writel(SAA7134_CARRIER2_FREQ0 >> 2, tvaudio_carr2reg(secondary));
178}
179
1eaad5b1
NS
180#define SAA7134_MUTE_MASK 0xbb
181#define SAA7134_MUTE_ANALOG 0x04
182#define SAA7134_MUTE_I2S 0x40
183
1da177e4
LT
184static void mute_input_7134(struct saa7134_dev *dev)
185{
186 unsigned int mute;
187 struct saa7134_input *in;
188 int ausel=0, ics=0, ocs=0;
189 int mask;
190
191 /* look what is to do ... */
192 in = dev->input;
193 mute = (dev->ctl_mute ||
194 (dev->automute && (&card(dev).radio) != in));
330a115a
MCC
195 if (card(dev).mute.name) {
196 /*
197 * 7130 - we'll mute using some unconnected audio input
198 * 7134 - we'll probably should switch external mux with gpio
199 */
1da177e4
LT
200 if (mute)
201 in = &card(dev).mute;
202 }
330a115a 203
1da177e4 204 if (dev->hw_mute == mute &&
c458473e 205 dev->hw_input == in && !dev->insuspend) {
e67bcf3e
MCC
206 audio_dbg(1, "mute/input: nothing to do [mute=%d,input=%s]\n",
207 mute, in->name);
1da177e4
LT
208 return;
209 }
210
e67bcf3e
MCC
211 audio_dbg(1, "ctl_mute=%d automute=%d input=%s => mute=%d input=%s\n",
212 dev->ctl_mute, dev->automute,
213 dev->input->name, mute, in->name);
1da177e4
LT
214 dev->hw_mute = mute;
215 dev->hw_input = in;
216
217 if (PCI_DEVICE_ID_PHILIPS_SAA7134 == dev->pci->device)
218 /* 7134 mute */
1eaad5b1 219 saa_writeb(SAA7134_AUDIO_MUTE_CTRL, mute ?
4ac97914 220 SAA7134_MUTE_MASK |
1eaad5b1
NS
221 SAA7134_MUTE_ANALOG |
222 SAA7134_MUTE_I2S :
223 SAA7134_MUTE_MASK);
1da177e4
LT
224
225 /* switch internal audio mux */
226 switch (in->amux) {
227 case TV: ausel=0xc0; ics=0x00; ocs=0x02; break;
228 case LINE1: ausel=0x80; ics=0x00; ocs=0x00; break;
229 case LINE2: ausel=0x80; ics=0x08; ocs=0x01; break;
230 case LINE2_LEFT: ausel=0x80; ics=0x08; ocs=0x05; break;
231 }
232 saa_andorb(SAA7134_AUDIO_FORMAT_CTRL, 0xc0, ausel);
233 saa_andorb(SAA7134_ANALOG_IO_SELECT, 0x08, ics);
234 saa_andorb(SAA7134_ANALOG_IO_SELECT, 0x07, ocs);
ac19ecc6
MCC
235 // for oss, we need to change the clock configuration
236 if (in->amux == TV)
237 saa_andorb(SAA7134_SIF_SAMPLE_FREQ, 0x03, 0x00);
238 else
239 saa_andorb(SAA7134_SIF_SAMPLE_FREQ, 0x03, 0x01);
1da177e4
LT
240
241 /* switch gpio-connected external audio mux */
242 if (0 == card(dev).gpiomask)
243 return;
330a115a 244
1da177e4
LT
245 mask = card(dev).gpiomask;
246 saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, mask, mask);
247 saa_andorl(SAA7134_GPIO_GPSTATUS0 >> 2, mask, in->gpio);
248 saa7134_track_gpio(dev,in->name);
249}
250
251static void tvaudio_setmode(struct saa7134_dev *dev,
252 struct saa7134_tvaudio *audio,
253 char *note)
254{
255 int acpf, tweak = 0;
256
257 if (dev->tvnorm->id == V4L2_STD_NTSC) {
258 acpf = 0x19066;
259 } else {
260 acpf = 0x1e000;
261 }
262 if (audio_clock_tweak > -1024 && audio_clock_tweak < 1024)
263 tweak = audio_clock_tweak;
264
265 if (note)
e67bcf3e
MCC
266 audio_dbg(1, "tvaudio_setmode: %s %s [%d.%03d/%d.%03d MHz] acpf=%d%+d\n",
267 note, audio->name,
1da177e4
LT
268 audio->carr1 / 1000, audio->carr1 % 1000,
269 audio->carr2 / 1000, audio->carr2 % 1000,
270 acpf, tweak);
271
272 acpf += tweak;
273 saa_writeb(SAA7134_AUDIO_CLOCKS_PER_FIELD0, (acpf & 0x0000ff) >> 0);
274 saa_writeb(SAA7134_AUDIO_CLOCKS_PER_FIELD1, (acpf & 0x00ff00) >> 8);
275 saa_writeb(SAA7134_AUDIO_CLOCKS_PER_FIELD2, (acpf & 0x030000) >> 16);
276 tvaudio_setcarrier(dev,audio->carr1,audio->carr2);
277
278 switch (audio->mode) {
279 case TVAUDIO_FM_MONO:
280 case TVAUDIO_FM_BG_STEREO:
281 saa_writeb(SAA7134_DEMODULATOR, 0x00);
282 saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x00);
283 saa_writeb(SAA7134_FM_DEEMPHASIS, 0x22);
284 saa_writeb(SAA7134_FM_DEMATRIX, 0x80);
285 saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa0);
286 break;
287 case TVAUDIO_FM_K_STEREO:
288 saa_writeb(SAA7134_DEMODULATOR, 0x00);
289 saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x01);
290 saa_writeb(SAA7134_FM_DEEMPHASIS, 0x22);
291 saa_writeb(SAA7134_FM_DEMATRIX, 0x80);
292 saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa0);
293 break;
294 case TVAUDIO_NICAM_FM:
295 saa_writeb(SAA7134_DEMODULATOR, 0x10);
296 saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x00);
297 saa_writeb(SAA7134_FM_DEEMPHASIS, 0x44);
298 saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa1);
299 saa_writeb(SAA7134_NICAM_CONFIG, 0x00);
300 break;
301 case TVAUDIO_NICAM_AM:
302 saa_writeb(SAA7134_DEMODULATOR, 0x12);
303 saa_writeb(SAA7134_DCXO_IDENT_CTRL, 0x00);
304 saa_writeb(SAA7134_FM_DEEMPHASIS, 0x44);
305 saa_writeb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0xa1);
306 saa_writeb(SAA7134_NICAM_CONFIG, 0x00);
307 break;
308 case TVAUDIO_FM_SAT_STEREO:
309 /* not implemented (yet) */
310 break;
311 }
312}
313
314static int tvaudio_sleep(struct saa7134_dev *dev, int timeout)
315{
3e0e38e6
CH
316 if (dev->thread.scan1 == dev->thread.scan2 &&
317 !kthread_should_stop()) {
1da177e4
LT
318 if (timeout < 0) {
319 set_current_state(TASK_INTERRUPTIBLE);
320 schedule();
321 } else {
8b93ec77
NA
322 schedule_timeout_interruptible
323 (msecs_to_jiffies(timeout));
1da177e4
LT
324 }
325 }
1da177e4
LT
326 return dev->thread.scan1 != dev->thread.scan2;
327}
328
329static int tvaudio_checkcarrier(struct saa7134_dev *dev, struct mainscan *scan)
330{
331 __s32 left,right,value;
332
a1dca1e3
SS
333 if (!(dev->tvnorm->id & scan->std)) {
334 value = 0;
e67bcf3e
MCC
335 audio_dbg(1, "skipping %d.%03d MHz [%4s]\n",
336 scan->carr / 1000, scan->carr % 1000, scan->name);
a1dca1e3
SS
337 return 0;
338 }
339
1da177e4
LT
340 if (audio_debug > 1) {
341 int i;
e67bcf3e 342 audio_dbg(1, "debug %d:", scan->carr);
1da177e4
LT
343 for (i = -150; i <= 150; i += 30) {
344 tvaudio_setcarrier(dev,scan->carr+i,scan->carr+i);
345 saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
346 if (tvaudio_sleep(dev,SCAN_SAMPLE_DELAY))
347 return -1;
348 value = saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
349 if (0 == i)
e67bcf3e 350 pr_cont(" # %6d # ",value >> 16);
1da177e4 351 else
e67bcf3e 352 pr_cont(" %6d",value >> 16);
1da177e4 353 }
e67bcf3e 354 pr_cont("\n");
1da177e4 355 }
a1dca1e3
SS
356
357 tvaudio_setcarrier(dev,scan->carr-90,scan->carr-90);
358 saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
359 if (tvaudio_sleep(dev,SCAN_SAMPLE_DELAY))
360 return -1;
361 left = saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
362
363 tvaudio_setcarrier(dev,scan->carr+90,scan->carr+90);
364 saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
365 if (tvaudio_sleep(dev,SCAN_SAMPLE_DELAY))
366 return -1;
367 right = saa_readl(SAA7134_LEVEL_READOUT1 >> 2);
368
369 left >>= 16;
370 right >>= 16;
371 value = left > right ? left - right : right - left;
e67bcf3e
MCC
372 audio_dbg(1, "scanning %d.%03d MHz [%4s] => dc is %5d [%d/%d]\n",
373 scan->carr / 1000, scan->carr % 1000,
374 scan->name, value, left, right);
1da177e4
LT
375 return value;
376}
377
1da177e4
LT
378
379static int tvaudio_getstereo(struct saa7134_dev *dev, struct saa7134_tvaudio *audio)
380{
330a115a 381 __u32 idp, nicam, nicam_status;
1da177e4
LT
382 int retval = -1;
383
384 switch (audio->mode) {
385 case TVAUDIO_FM_MONO:
386 return V4L2_TUNER_SUB_MONO;
387 case TVAUDIO_FM_K_STEREO:
388 case TVAUDIO_FM_BG_STEREO:
389 idp = (saa_readb(SAA7134_IDENT_SIF) & 0xe0) >> 5;
e67bcf3e 390 audio_dbg(1, "getstereo: fm/stereo: idp=0x%x\n", idp);
1da177e4
LT
391 if (0x03 == (idp & 0x03))
392 retval = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
393 else if (0x05 == (idp & 0x05))
394 retval = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
395 else if (0x01 == (idp & 0x01))
396 retval = V4L2_TUNER_SUB_MONO;
397 break;
398 case TVAUDIO_FM_SAT_STEREO:
399 /* not implemented (yet) */
400 break;
401 case TVAUDIO_NICAM_FM:
402 case TVAUDIO_NICAM_AM:
330a115a 403 nicam = saa_readb(SAA7134_AUDIO_STATUS);
e67bcf3e 404 audio_dbg(1, "getstereo: nicam=0x%x\n", nicam);
330a115a
MCC
405 if (nicam & 0x1) {
406 nicam_status = saa_readb(SAA7134_NICAM_STATUS);
e67bcf3e 407 audio_dbg(1, "getstereo: nicam_status=0x%x\n", nicam_status);
330a115a
MCC
408
409 switch (nicam_status & 0x03) {
410 case 0x01:
411 retval = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
412 break;
413 case 0x02:
414 retval = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
415 break;
416 default:
417 retval = V4L2_TUNER_SUB_MONO;
418 }
419 } else {
420 /* No nicam detected */
1da177e4
LT
421 }
422 break;
423 }
424 if (retval != -1)
e67bcf3e 425 audio_dbg(1, "found audio subchannels:%s%s%s%s\n",
1da177e4
LT
426 (retval & V4L2_TUNER_SUB_MONO) ? " mono" : "",
427 (retval & V4L2_TUNER_SUB_STEREO) ? " stereo" : "",
428 (retval & V4L2_TUNER_SUB_LANG1) ? " lang1" : "",
429 (retval & V4L2_TUNER_SUB_LANG2) ? " lang2" : "");
430 return retval;
431}
432
433static int tvaudio_setstereo(struct saa7134_dev *dev, struct saa7134_tvaudio *audio,
434 u32 mode)
435{
436 static char *name[] = {
437 [ V4L2_TUNER_MODE_MONO ] = "mono",
438 [ V4L2_TUNER_MODE_STEREO ] = "stereo",
439 [ V4L2_TUNER_MODE_LANG1 ] = "lang1",
440 [ V4L2_TUNER_MODE_LANG2 ] = "lang2",
301e22d6 441 [ V4L2_TUNER_MODE_LANG1_LANG2 ] = "lang1+lang2",
1da177e4
LT
442 };
443 static u32 fm[] = {
444 [ V4L2_TUNER_MODE_MONO ] = 0x00, /* ch1 */
445 [ V4L2_TUNER_MODE_STEREO ] = 0x80, /* auto */
446 [ V4L2_TUNER_MODE_LANG1 ] = 0x00, /* ch1 */
447 [ V4L2_TUNER_MODE_LANG2 ] = 0x01, /* ch2 */
301e22d6 448 [ V4L2_TUNER_MODE_LANG1_LANG2 ] = 0x80, /* auto */
1da177e4
LT
449 };
450 u32 reg;
451
452 switch (audio->mode) {
453 case TVAUDIO_FM_MONO:
454 /* nothing to do ... */
455 break;
456 case TVAUDIO_FM_K_STEREO:
457 case TVAUDIO_FM_BG_STEREO:
330a115a
MCC
458 case TVAUDIO_NICAM_AM:
459 case TVAUDIO_NICAM_FM:
e67bcf3e
MCC
460 audio_dbg(1, "setstereo [fm] => %s\n",
461 name[mode % ARRAY_SIZE(name)]);
1da177e4
LT
462 reg = fm[ mode % ARRAY_SIZE(fm) ];
463 saa_writeb(SAA7134_FM_DEMATRIX, reg);
464 break;
465 case TVAUDIO_FM_SAT_STEREO:
330a115a 466 /* Not implemented */
1da177e4
LT
467 break;
468 }
469 return 0;
470}
471
472static int tvaudio_thread(void *data)
473{
474 struct saa7134_dev *dev = data;
475 int carr_vals[ARRAY_SIZE(mainscan)];
476 unsigned int i, audio, nscan;
477 int max1,max2,carrier,rx,mode,lastmode,default_carrier;
478
ea63d0b1
ML
479 set_freezable();
480
1da177e4
LT
481 for (;;) {
482 tvaudio_sleep(dev,-1);
ea63d0b1 483 if (kthread_should_stop())
1da177e4
LT
484 goto done;
485
486 restart:
ea63d0b1
ML
487 try_to_freeze();
488
1da177e4 489 dev->thread.scan1 = dev->thread.scan2;
e67bcf3e
MCC
490 audio_dbg(1, "tvaudio thread scan start [%d]\n",
491 dev->thread.scan1);
1da177e4 492 dev->tvaudio = NULL;
f36224d3
ML
493
494 saa_writeb(SAA7134_MONITOR_SELECT, 0xa0);
495 saa_writeb(SAA7134_FM_DEMATRIX, 0x80);
496
1da177e4
LT
497 if (dev->ctl_automute)
498 dev->automute = 1;
f36224d3 499
1da177e4
LT
500 mute_input_7134(dev);
501
502 /* give the tuner some time */
503 if (tvaudio_sleep(dev,SCAN_INITIAL_DELAY))
504 goto restart;
505
506 max1 = 0;
507 max2 = 0;
508 nscan = 0;
509 carrier = 0;
510 default_carrier = 0;
511 for (i = 0; i < ARRAY_SIZE(mainscan); i++) {
512 if (!(dev->tvnorm->id & mainscan[i].std))
513 continue;
514 if (!default_carrier)
515 default_carrier = mainscan[i].carr;
516 nscan++;
517 }
518
519 if (1 == nscan) {
520 /* only one candidate -- skip scan ;) */
e67bcf3e 521 audio_dbg(1, "only one main carrier candidate - skipping scan\n");
1da177e4
LT
522 max1 = 12345;
523 carrier = default_carrier;
524 } else {
525 /* scan for the main carrier */
526 saa_writeb(SAA7134_MONITOR_SELECT,0x00);
527 tvaudio_setmode(dev,&tvaudio[0],NULL);
528 for (i = 0; i < ARRAY_SIZE(mainscan); i++) {
529 carr_vals[i] = tvaudio_checkcarrier(dev, mainscan+i);
530 if (dev->thread.scan1 != dev->thread.scan2)
531 goto restart;
532 }
533 for (max1 = 0, max2 = 0, i = 0; i < ARRAY_SIZE(mainscan); i++) {
534 if (max1 < carr_vals[i]) {
535 max2 = max1;
536 max1 = carr_vals[i];
537 carrier = mainscan[i].carr;
538 } else if (max2 < carr_vals[i]) {
539 max2 = carr_vals[i];
540 }
541 }
542 }
543
544 if (0 != carrier && max1 > 2000 && max1 > max2*3) {
545 /* found good carrier */
e67bcf3e
MCC
546 audio_dbg(1, "found %s main sound carrier @ %d.%03d MHz [%d/%d]\n",
547 dev->tvnorm->name, carrier/1000, carrier%1000,
548 max1, max2);
1da177e4 549 dev->last_carrier = carrier;
a1dca1e3 550 dev->automute = 0;
1da177e4
LT
551
552 } else if (0 != dev->last_carrier) {
553 /* no carrier -- try last detected one as fallback */
554 carrier = dev->last_carrier;
e67bcf3e
MCC
555 audio_dbg(1, "audio carrier scan failed, using %d.%03d MHz [last detected]\n",
556 carrier/1000, carrier%1000);
a1dca1e3 557 dev->automute = 1;
1da177e4
LT
558
559 } else {
560 /* no carrier + no fallback -- use default */
561 carrier = default_carrier;
e67bcf3e
MCC
562 audio_dbg(1, "audio carrier scan failed, using %d.%03d MHz [default]\n",
563 carrier/1000, carrier%1000);
a1dca1e3 564 dev->automute = 1;
1da177e4
LT
565 }
566 tvaudio_setcarrier(dev,carrier,carrier);
1da177e4
LT
567 saa_andorb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0x30, 0x00);
568 saa7134_tvaudio_setmute(dev);
1da177e4
LT
569 /* find the exact tv audio norm */
570 for (audio = UNSET, i = 0; i < TVAUDIO; i++) {
571 if (dev->tvnorm->id != UNSET &&
330a115a 572 !(dev->tvnorm->id & tvaudio[i].std))
1da177e4
LT
573 continue;
574 if (tvaudio[i].carr1 != carrier)
575 continue;
17b10a73 576 /* Note: at least the primary carrier is right here */
1da177e4
LT
577 if (UNSET == audio)
578 audio = i;
579 tvaudio_setmode(dev,&tvaudio[i],"trying");
580 if (tvaudio_sleep(dev,SCAN_SUBCARRIER_DELAY))
581 goto restart;
582 if (-1 != tvaudio_getstereo(dev,&tvaudio[i])) {
583 audio = i;
584 break;
585 }
586 }
587 saa_andorb(SAA7134_STEREO_DAC_OUTPUT_SELECT, 0x30, 0x30);
588 if (UNSET == audio)
589 continue;
590 tvaudio_setmode(dev,&tvaudio[audio],"using");
17b10a73 591
1da177e4
LT
592 tvaudio_setstereo(dev,&tvaudio[audio],V4L2_TUNER_MODE_MONO);
593 dev->tvaudio = &tvaudio[audio];
594
595 lastmode = 42;
596 for (;;) {
ea63d0b1
ML
597
598 try_to_freeze();
599
1da177e4
LT
600 if (tvaudio_sleep(dev,5000))
601 goto restart;
ea63d0b1 602 if (kthread_should_stop())
1da177e4
LT
603 break;
604 if (UNSET == dev->thread.mode) {
e82db75d 605 rx = tvaudio_getstereo(dev, &tvaudio[audio]);
1da177e4
LT
606 mode = saa7134_tvaudio_rx2mode(rx);
607 } else {
608 mode = dev->thread.mode;
609 }
610 if (lastmode != mode) {
611 tvaudio_setstereo(dev,&tvaudio[audio],mode);
612 lastmode = mode;
613 }
614 }
615 }
616
617 done:
ea63d0b1 618 dev->thread.stopped = 1;
1da177e4
LT
619 return 0;
620}
621
622/* ------------------------------------------------------------------ */
623/* saa7133 / saa7135 code */
624
625static char *stdres[0x20] = {
626 [0x00] = "no standard detected",
627 [0x01] = "B/G (in progress)",
628 [0x02] = "D/K (in progress)",
629 [0x03] = "M (in progress)",
630
631 [0x04] = "B/G A2",
632 [0x05] = "B/G NICAM",
633 [0x06] = "D/K A2 (1)",
634 [0x07] = "D/K A2 (2)",
635 [0x08] = "D/K A2 (3)",
636 [0x09] = "D/K NICAM",
637 [0x0a] = "L NICAM",
638 [0x0b] = "I NICAM",
639
640 [0x0c] = "M Korea",
641 [0x0d] = "M BTSC ",
642 [0x0e] = "M EIAJ",
643
644 [0x0f] = "FM radio / IF 10.7 / 50 deemp",
645 [0x10] = "FM radio / IF 10.7 / 75 deemp",
646 [0x11] = "FM radio / IF sel / 50 deemp",
647 [0x12] = "FM radio / IF sel / 75 deemp",
648
649 [0x13 ... 0x1e ] = "unknown",
650 [0x1f] = "??? [in progress]",
651};
652
653#define DSP_RETRY 32
654#define DSP_DELAY 16
867bc6cc
HH
655#define SAA7135_DSP_RWCLEAR_RERR 1
656
657static inline int saa_dsp_reset_error_bit(struct saa7134_dev *dev)
658{
659 int state = saa_readb(SAA7135_DSP_RWSTATE);
660 if (unlikely(state & SAA7135_DSP_RWSTATE_ERR)) {
e67bcf3e 661 audio_dbg(2, "%s: resetting error bit\n", dev->name);
867bc6cc
HH
662 saa_writeb(SAA7135_DSP_RWCLEAR, SAA7135_DSP_RWCLEAR_RERR);
663 }
664 return 0;
665}
1da177e4
LT
666
667static inline int saa_dsp_wait_bit(struct saa7134_dev *dev, int bit)
668{
669 int state, count = DSP_RETRY;
670
671 state = saa_readb(SAA7135_DSP_RWSTATE);
672 if (unlikely(state & SAA7135_DSP_RWSTATE_ERR)) {
83582009 673 pr_warn("%s: dsp access error\n", dev->name);
867bc6cc 674 saa_dsp_reset_error_bit(dev);
1da177e4
LT
675 return -EIO;
676 }
677 while (0 == (state & bit)) {
678 if (unlikely(0 == count)) {
2bb3e2ee
MCC
679 pr_err("dsp access wait timeout [bit=%s]\n",
680 (bit & SAA7135_DSP_RWSTATE_WRR) ? "WRR" :
681 (bit & SAA7135_DSP_RWSTATE_RDB) ? "RDB" :
682 (bit & SAA7135_DSP_RWSTATE_IDA) ? "IDA" :
683 "???");
1da177e4
LT
684 return -EIO;
685 }
686 saa_wait(DSP_DELAY);
687 state = saa_readb(SAA7135_DSP_RWSTATE);
688 count--;
689 }
690 return 0;
691}
692
1da177e4
LT
693
694int saa_dsp_writel(struct saa7134_dev *dev, int reg, u32 value)
695{
696 int err;
697
e67bcf3e 698 audio_dbg(2, "dsp write reg 0x%x = 0x%06x\n", reg << 2, value);
1da177e4
LT
699 err = saa_dsp_wait_bit(dev,SAA7135_DSP_RWSTATE_WRR);
700 if (err < 0)
701 return err;
702 saa_writel(reg,value);
703 err = saa_dsp_wait_bit(dev,SAA7135_DSP_RWSTATE_WRR);
704 if (err < 0)
705 return err;
706 return 0;
707}
708
709static int getstereo_7133(struct saa7134_dev *dev)
710{
711 int retval = V4L2_TUNER_SUB_MONO;
712 u32 value;
713
714 value = saa_readl(0x528 >> 2);
715 if (value & 0x20)
716 retval = V4L2_TUNER_SUB_MONO | V4L2_TUNER_SUB_STEREO;
717 if (value & 0x40)
718 retval = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
719 return retval;
720}
721
722static int mute_input_7133(struct saa7134_dev *dev)
723{
724 u32 reg = 0;
330a115a 725 u32 xbarin, xbarout;
1da177e4 726 int mask;
330a115a 727 struct saa7134_input *in;
1da177e4 728
330a115a 729 xbarin = 0x03;
1da177e4
LT
730 switch (dev->input->amux) {
731 case TV:
732 reg = 0x02;
330a115a 733 xbarin = 0;
1da177e4
LT
734 break;
735 case LINE1:
736 reg = 0x00;
737 break;
738 case LINE2:
739 case LINE2_LEFT:
330a115a 740 reg = 0x09;
1da177e4
LT
741 break;
742 }
330a115a
MCC
743 saa_dsp_writel(dev, 0x464 >> 2, xbarin);
744 if (dev->ctl_mute) {
1da177e4 745 reg = 0x07;
330a115a
MCC
746 xbarout = 0xbbbbbb;
747 } else
748 xbarout = 0xbbbb10;
749 saa_dsp_writel(dev, 0x46c >> 2, xbarout);
750
1da177e4
LT
751 saa_writel(0x594 >> 2, reg);
752
330a115a 753
1da177e4 754 /* switch gpio-connected external audio mux */
4ac97914
MCC
755 if (0 != card(dev).gpiomask) {
756 mask = card(dev).gpiomask;
330a115a
MCC
757
758 if (card(dev).mute.name && dev->ctl_mute)
759 in = &card(dev).mute;
760 else
761 in = dev->input;
762
4ac97914
MCC
763 saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, mask, mask);
764 saa_andorl(SAA7134_GPIO_GPSTATUS0 >> 2, mask, in->gpio);
765 saa7134_track_gpio(dev,in->name);
1da177e4 766 }
330a115a 767
1da177e4
LT
768 return 0;
769}
770
771static int tvaudio_thread_ddep(void *data)
772{
773 struct saa7134_dev *dev = data;
f36224d3 774 u32 value, norms;
1da177e4 775
ea63d0b1 776 set_freezable();
1da177e4
LT
777 for (;;) {
778 tvaudio_sleep(dev,-1);
ea63d0b1 779 if (kthread_should_stop())
1da177e4 780 goto done;
1da177e4 781 restart:
ea63d0b1
ML
782 try_to_freeze();
783
1da177e4 784 dev->thread.scan1 = dev->thread.scan2;
e67bcf3e
MCC
785 audio_dbg(1, "tvaudio thread scan start [%d]\n",
786 dev->thread.scan1);
1da177e4
LT
787
788 if (audio_ddep >= 0x04 && audio_ddep <= 0x0e) {
789 /* insmod option override */
790 norms = (audio_ddep << 2) | 0x01;
e67bcf3e
MCC
791 audio_dbg(1, "ddep override: %s\n",
792 stdres[audio_ddep]);
1da177e4 793 } else if (&card(dev).radio == dev->input) {
e67bcf3e 794 audio_dbg(1, "FM Radio\n");
0f79c363
HH
795 if (dev->tuner_type == TUNER_PHILIPS_TDA8290) {
796 norms = (0x11 << 2) | 0x01;
34fe2784 797 /* set IF frequency to 5.5 MHz */
0f79c363
HH
798 saa_dsp_writel(dev, 0x42c >> 2, 0x729555);
799 } else {
800 norms = (0x0f << 2) | 0x01;
801 }
1da177e4
LT
802 } else {
803 /* (let chip) scan for sound carrier */
804 norms = 0;
17b10a73
HH
805 if (dev->tvnorm->id & (V4L2_STD_B | V4L2_STD_GH))
806 norms |= 0x04;
807 if (dev->tvnorm->id & V4L2_STD_PAL_I)
808 norms |= 0x20;
809 if (dev->tvnorm->id & V4L2_STD_DK)
810 norms |= 0x08;
811 if (dev->tvnorm->id & V4L2_STD_MN)
812 norms |= 0x40;
813 if (dev->tvnorm->id & (V4L2_STD_SECAM_L | V4L2_STD_SECAM_LC))
814 norms |= 0x10;
1da177e4
LT
815 if (0 == norms)
816 norms = 0x7c; /* all */
e67bcf3e
MCC
817 audio_dbg(1, "scanning:%s%s%s%s%s\n",
818 (norms & 0x04) ? " B/G" : "",
819 (norms & 0x08) ? " D/K" : "",
820 (norms & 0x10) ? " L/L'" : "",
821 (norms & 0x20) ? " I" : "",
822 (norms & 0x40) ? " M" : "");
1da177e4
LT
823 }
824
825 /* kick automatic standard detection */
826 saa_dsp_writel(dev, 0x454 >> 2, 0);
827 saa_dsp_writel(dev, 0x454 >> 2, norms | 0x80);
828
829 /* setup crossbars */
830 saa_dsp_writel(dev, 0x464 >> 2, 0x000000);
831 saa_dsp_writel(dev, 0x470 >> 2, 0x101010);
832
833 if (tvaudio_sleep(dev,3000))
834 goto restart;
835 value = saa_readl(0x528 >> 2) & 0xffffff;
836
e67bcf3e
MCC
837 audio_dbg(1, "tvaudio thread status: 0x%x [%s%s%s]\n",
838 value, stdres[value & 0x1f],
839 (value & 0x000020) ? ",stereo" : "",
840 (value & 0x000040) ? ",dual" : "");
841 audio_dbg(1, "detailed status: %s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s#%s\n",
842 (value & 0x000080) ? " A2/EIAJ pilot tone " : "",
843 (value & 0x000100) ? " A2/EIAJ dual " : "",
844 (value & 0x000200) ? " A2/EIAJ stereo " : "",
845 (value & 0x000400) ? " A2/EIAJ noise mute " : "",
846
847 (value & 0x000800) ? " BTSC/FM radio pilot " : "",
848 (value & 0x001000) ? " SAP carrier " : "",
849 (value & 0x002000) ? " BTSC stereo noise mute " : "",
850 (value & 0x004000) ? " SAP noise mute " : "",
851 (value & 0x008000) ? " VDSP " : "",
852
853 (value & 0x010000) ? " NICST " : "",
854 (value & 0x020000) ? " NICDU " : "",
855 (value & 0x040000) ? " NICAM muted " : "",
856 (value & 0x080000) ? " NICAM reserve sound " : "",
857
858 (value & 0x100000) ? " init done " : "");
1da177e4
LT
859 }
860
861 done:
ea63d0b1 862 dev->thread.stopped = 1;
1da177e4
LT
863 return 0;
864}
865
866/* ------------------------------------------------------------------ */
867/* common stuff + external entry points */
868
cb71201f 869void saa7134_enable_i2s(struct saa7134_dev *dev)
1da177e4
LT
870{
871 int i2s_format;
872
873 if (!card_is_empress(dev))
874 return;
1da177e4 875
37df96d3
DB
876 if (dev->pci->device == PCI_DEVICE_ID_PHILIPS_SAA7130)
877 return;
878
879 /* configure GPIO for out */
880 saa_andorl(SAA7134_GPIO_GPMODE0 >> 2, 0x0E000000, 0x00000000);
881
882 switch (dev->pci->device) {
883 case PCI_DEVICE_ID_PHILIPS_SAA7133:
884 case PCI_DEVICE_ID_PHILIPS_SAA7135:
885 /* Set I2S format (SONY)  */
886 saa_writeb(SAA7133_I2S_AUDIO_CONTROL, 0x00);
f808a9e3 887 /* Start I2S */
37df96d3 888 saa_writeb(SAA7134_I2S_AUDIO_OUTPUT, 0x11);
f808a9e3 889 break;
37df96d3
DB
890
891 case PCI_DEVICE_ID_PHILIPS_SAA7134:
f808a9e3
DB
892 i2s_format = (dev->input->amux == TV) ? 0x00 : 0x01;
893
894 /* enable I2S audio output for the mpeg encoder */
37df96d3
DB
895 saa_writeb(SAA7134_I2S_OUTPUT_SELECT, 0x80);
896 saa_writeb(SAA7134_I2S_OUTPUT_FORMAT, i2s_format);
897 saa_writeb(SAA7134_I2S_OUTPUT_LEVEL, 0x0F);
898 saa_writeb(SAA7134_I2S_AUDIO_OUTPUT, 0x01);
899
900 default:
901 break;
f808a9e3 902 }
1da177e4
LT
903}
904
905int saa7134_tvaudio_rx2mode(u32 rx)
906{
907 u32 mode;
908
909 mode = V4L2_TUNER_MODE_MONO;
910 if (rx & V4L2_TUNER_SUB_STEREO)
911 mode = V4L2_TUNER_MODE_STEREO;
912 else if (rx & V4L2_TUNER_SUB_LANG1)
913 mode = V4L2_TUNER_MODE_LANG1;
914 else if (rx & V4L2_TUNER_SUB_LANG2)
915 mode = V4L2_TUNER_MODE_LANG2;
916 return mode;
917}
918
919void saa7134_tvaudio_setmute(struct saa7134_dev *dev)
920{
921 switch (dev->pci->device) {
922 case PCI_DEVICE_ID_PHILIPS_SAA7130:
923 case PCI_DEVICE_ID_PHILIPS_SAA7134:
924 mute_input_7134(dev);
925 break;
926 case PCI_DEVICE_ID_PHILIPS_SAA7133:
927 case PCI_DEVICE_ID_PHILIPS_SAA7135:
928 mute_input_7133(dev);
929 break;
930 }
931}
932
933void saa7134_tvaudio_setinput(struct saa7134_dev *dev,
934 struct saa7134_input *in)
935{
936 dev->input = in;
937 switch (dev->pci->device) {
938 case PCI_DEVICE_ID_PHILIPS_SAA7130:
939 case PCI_DEVICE_ID_PHILIPS_SAA7134:
940 mute_input_7134(dev);
941 break;
942 case PCI_DEVICE_ID_PHILIPS_SAA7133:
943 case PCI_DEVICE_ID_PHILIPS_SAA7135:
944 mute_input_7133(dev);
945 break;
946 }
947 saa7134_enable_i2s(dev);
948}
949
950void saa7134_tvaudio_setvolume(struct saa7134_dev *dev, int level)
951{
952 switch (dev->pci->device) {
953 case PCI_DEVICE_ID_PHILIPS_SAA7134:
954 saa_writeb(SAA7134_CHANNEL1_LEVEL, level & 0x1f);
955 saa_writeb(SAA7134_CHANNEL2_LEVEL, level & 0x1f);
956 saa_writeb(SAA7134_NICAM_LEVEL_ADJUST, level & 0x1f);
957 break;
958 }
959}
960
961int saa7134_tvaudio_getstereo(struct saa7134_dev *dev)
962{
963 int retval = V4L2_TUNER_SUB_MONO;
964
965 switch (dev->pci->device) {
966 case PCI_DEVICE_ID_PHILIPS_SAA7134:
967 if (dev->tvaudio)
968 retval = tvaudio_getstereo(dev,dev->tvaudio);
969 break;
970 case PCI_DEVICE_ID_PHILIPS_SAA7133:
971 case PCI_DEVICE_ID_PHILIPS_SAA7135:
972 retval = getstereo_7133(dev);
973 break;
974 }
975 return retval;
976}
977
f36224d3
ML
978void saa7134_tvaudio_init(struct saa7134_dev *dev)
979{
980 int clock = saa7134_boards[dev->board].audio_clock;
981
982 if (UNSET != audio_clock_override)
983 clock = audio_clock_override;
984
985 switch (dev->pci->device) {
986 case PCI_DEVICE_ID_PHILIPS_SAA7134:
987 /* init all audio registers */
988 saa_writeb(SAA7134_AUDIO_PLL_CTRL, 0x00);
989 if (need_resched())
990 schedule();
991 else
992 udelay(10);
993
994 saa_writeb(SAA7134_AUDIO_CLOCK0, clock & 0xff);
995 saa_writeb(SAA7134_AUDIO_CLOCK1, (clock >> 8) & 0xff);
996 saa_writeb(SAA7134_AUDIO_CLOCK2, (clock >> 16) & 0xff);
997 /* frame locked audio is mandatory for NICAM */
998 saa_writeb(SAA7134_AUDIO_PLL_CTRL, 0x01);
999 saa_writeb(SAA7134_NICAM_ERROR_LOW, 0x14);
1000 saa_writeb(SAA7134_NICAM_ERROR_HIGH, 0x50);
1001 break;
1002 case PCI_DEVICE_ID_PHILIPS_SAA7133:
1003 case PCI_DEVICE_ID_PHILIPS_SAA7135:
1004 saa_writel(0x598 >> 2, clock);
1005 saa_dsp_writel(dev, 0x474 >> 2, 0x00);
1006 saa_dsp_writel(dev, 0x450 >> 2, 0x00);
1007 }
1008}
1009
1da177e4
LT
1010int saa7134_tvaudio_init2(struct saa7134_dev *dev)
1011{
1da177e4
LT
1012 int (*my_thread)(void *data) = NULL;
1013
1014 switch (dev->pci->device) {
1015 case PCI_DEVICE_ID_PHILIPS_SAA7134:
1016 my_thread = tvaudio_thread;
1017 break;
1018 case PCI_DEVICE_ID_PHILIPS_SAA7133:
1019 case PCI_DEVICE_ID_PHILIPS_SAA7135:
1020 my_thread = tvaudio_thread_ddep;
1021 break;
1022 }
1023
3e0e38e6 1024 dev->thread.thread = NULL;
a1dca1e3 1025 dev->thread.scan1 = dev->thread.scan2 = 0;
1da177e4 1026 if (my_thread) {
f36224d3 1027 saa7134_tvaudio_init(dev);
1da177e4 1028 /* start tvaudio thread */
3e0e38e6
CH
1029 dev->thread.thread = kthread_run(my_thread, dev, "%s", dev->name);
1030 if (IS_ERR(dev->thread.thread)) {
83582009 1031 pr_warn("%s: kernel_thread() failed\n",
1da177e4 1032 dev->name);
3e0e38e6
CH
1033 /* XXX: missing error handling here */
1034 }
1da177e4
LT
1035 }
1036
1037 saa7134_enable_i2s(dev);
1038 return 0;
1039}
1040
a1dca1e3
SS
1041int saa7134_tvaudio_close(struct saa7134_dev *dev)
1042{
1043 dev->automute = 1;
1044 /* anything else to undo? */
1045 return 0;
1046}
1047
1da177e4
LT
1048int saa7134_tvaudio_fini(struct saa7134_dev *dev)
1049{
1050 /* shutdown tvaudio thread */
ea63d0b1 1051 if (dev->thread.thread && !dev->thread.stopped)
3e0e38e6
CH
1052 kthread_stop(dev->thread.thread);
1053
1da177e4
LT
1054 saa_andorb(SAA7134_ANALOG_IO_SELECT, 0x07, 0x00); /* LINE1 */
1055 return 0;
1056}
1057
1058int saa7134_tvaudio_do_scan(struct saa7134_dev *dev)
1059{
17b10a73 1060 if (dev->input->amux != TV) {
e67bcf3e 1061 audio_dbg(1, "sound IF not in use, skipping scan\n");
17b10a73
HH
1062 dev->automute = 0;
1063 saa7134_tvaudio_setmute(dev);
3e0e38e6 1064 } else if (dev->thread.thread) {
1da177e4
LT
1065 dev->thread.mode = UNSET;
1066 dev->thread.scan2++;
ea63d0b1
ML
1067
1068 if (!dev->insuspend && !dev->thread.stopped)
1069 wake_up_process(dev->thread.thread);
1da177e4
LT
1070 } else {
1071 dev->automute = 0;
1072 saa7134_tvaudio_setmute(dev);
1073 }
1074 return 0;
1075}
1076
79dd0c69 1077EXPORT_SYMBOL(saa_dsp_writel);
e9f964da 1078EXPORT_SYMBOL(saa7134_tvaudio_setmute);