projects / deliverable / linux.git / blame
? search:
summary | shortlog | log | commit | commitdiff | tree
blob | blame (incremental) | history | HEAD
V4L/DVB (3667a): Fix SAP + stereo mode at msp3400
[deliverable/linux.git] / drivers / media / video / msp3400-kthreads.c
CommitLineData
7e8b09ea
HV		 1/*
2 * Programming the mspx4xx sound processor family
3 *
4 * (c) 1997-2001 Gerd Knorr <kraxel@bytesex.org>
5 *
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License
8 * as published by the Free Software Foundation; either version 2
9 * of the License, or (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
19 */
20
21
22#include <linux/kernel.h>
23#include <linux/module.h>
24#include <linux/slab.h>
25#include <linux/i2c.h>
26#include <linux/videodev.h>
27#include <linux/videodev2.h>
28#include <media/v4l2-common.h>
49965a80 29#include <media/msp3400.h>
7e8b09ea
HV		 30#include <linux/kthread.h>
31#include <linux/suspend.h>
49965a80 32#include "msp3400-driver.h"
7e8b09ea
HV		 33
34/* this one uses the automatic sound standard detection of newer msp34xx
35 chip versions */
36static struct {
37 int retval;
38 int main, second;
39 char *name;
5af0c8f6 40} msp_stdlist[] = {
7e8b09ea
HV		 41 { 0x0000, 0, 0, "could not detect sound standard" },
42 { 0x0001, 0, 0, "autodetect start" },
43 { 0x0002, MSP_CARRIER(4.5), MSP_CARRIER(4.72), "4.5/4.72 M Dual FM-Stereo" },
44 { 0x0003, MSP_CARRIER(5.5), MSP_CARRIER(5.7421875), "5.5/5.74 B/G Dual FM-Stereo" },
45 { 0x0004, MSP_CARRIER(6.5), MSP_CARRIER(6.2578125), "6.5/6.25 D/K1 Dual FM-Stereo" },
46 { 0x0005, MSP_CARRIER(6.5), MSP_CARRIER(6.7421875), "6.5/6.74 D/K2 Dual FM-Stereo" },
47 { 0x0006, MSP_CARRIER(6.5), MSP_CARRIER(6.5), "6.5 D/K FM-Mono (HDEV3)" },
de533ccf 48 { 0x0007, MSP_CARRIER(6.5), MSP_CARRIER(5.7421875), "6.5/5.74 D/K3 Dual FM-Stereo" },
7e8b09ea
HV		 49 { 0x0008, MSP_CARRIER(5.5), MSP_CARRIER(5.85), "5.5/5.85 B/G NICAM FM" },
50 { 0x0009, MSP_CARRIER(6.5), MSP_CARRIER(5.85), "6.5/5.85 L NICAM AM" },
51 { 0x000a, MSP_CARRIER(6.0), MSP_CARRIER(6.55), "6.0/6.55 I NICAM FM" },
52 { 0x000b, MSP_CARRIER(6.5), MSP_CARRIER(5.85), "6.5/5.85 D/K NICAM FM" },
53 { 0x000c, MSP_CARRIER(6.5), MSP_CARRIER(5.85), "6.5/5.85 D/K NICAM FM (HDEV2)" },
de533ccf 54 { 0x000d, MSP_CARRIER(6.5), MSP_CARRIER(5.85), "6.5/5.85 D/K NICAM FM (HDEV3)" },
7e8b09ea
HV		 55 { 0x0020, MSP_CARRIER(4.5), MSP_CARRIER(4.5), "4.5 M BTSC-Stereo" },
56 { 0x0021, MSP_CARRIER(4.5), MSP_CARRIER(4.5), "4.5 M BTSC-Mono + SAP" },
57 { 0x0030, MSP_CARRIER(4.5), MSP_CARRIER(4.5), "4.5 M EIA-J Japan Stereo" },
58 { 0x0040, MSP_CARRIER(10.7), MSP_CARRIER(10.7), "10.7 FM-Stereo Radio" },
59 { 0x0050, MSP_CARRIER(6.5), MSP_CARRIER(6.5), "6.5 SAT-Mono" },
60 { 0x0051, MSP_CARRIER(7.02), MSP_CARRIER(7.20), "7.02/7.20 SAT-Stereo" },
61 { 0x0060, MSP_CARRIER(7.2), MSP_CARRIER(7.2), "7.2 SAT ADR" },
62 { -1, 0, 0, NULL }, /* EOF */
63};
64
65static struct msp3400c_init_data_dem {
66 int fir1[6];
67 int fir2[6];
68 int cdo1;
69 int cdo2;
70 int ad_cv;
71 int mode_reg;
72 int dsp_src;
73 int dsp_matrix;
74} msp3400c_init_data[] = {
75 { /* AM (for carrier detect / msp3400) */
76 {75, 19, 36, 35, 39, 40},
77 {75, 19, 36, 35, 39, 40},
78 MSP_CARRIER(5.5), MSP_CARRIER(5.5),
79 0x00d0, 0x0500, 0x0020, 0x3000
80 },{ /* AM (for carrier detect / msp3410) */
81 {-1, -1, -8, 2, 59, 126},
82 {-1, -1, -8, 2, 59, 126},
83 MSP_CARRIER(5.5), MSP_CARRIER(5.5),
84 0x00d0, 0x0100, 0x0020, 0x3000
85 },{ /* FM Radio */
86 {-8, -8, 4, 6, 78, 107},
87 {-8, -8, 4, 6, 78, 107},
88 MSP_CARRIER(10.7), MSP_CARRIER(10.7),
89 0x00d0, 0x0480, 0x0020, 0x3000
90 },{ /* Terrestial FM-mono + FM-stereo */
91 {3, 18, 27, 48, 66, 72},
92 {3, 18, 27, 48, 66, 72},
93 MSP_CARRIER(5.5), MSP_CARRIER(5.5),
94 0x00d0, 0x0480, 0x0030, 0x3000
95 },{ /* Sat FM-mono */
96 { 1, 9, 14, 24, 33, 37},
97 { 3, 18, 27, 48, 66, 72},
98 MSP_CARRIER(6.5), MSP_CARRIER(6.5),
99 0x00c6, 0x0480, 0x0000, 0x3000
100 },{ /* NICAM/FM -- B/G (5.5/5.85), D/K (6.5/5.85) */
101 {-2, -8, -10, 10, 50, 86},
102 {3, 18, 27, 48, 66, 72},
103 MSP_CARRIER(5.5), MSP_CARRIER(5.5),
104 0x00d0, 0x0040, 0x0120, 0x3000
105 },{ /* NICAM/FM -- I (6.0/6.552) */
106 {2, 4, -6, -4, 40, 94},
107 {3, 18, 27, 48, 66, 72},
108 MSP_CARRIER(6.0), MSP_CARRIER(6.0),
109 0x00d0, 0x0040, 0x0120, 0x3000
110 },{ /* NICAM/AM -- L (6.5/5.85) */
111 {-2, -8, -10, 10, 50, 86},
112 {-4, -12, -9, 23, 79, 126},
113 MSP_CARRIER(6.5), MSP_CARRIER(6.5),
8a4b275f 114 0x00c6, 0x0140, 0x0120, 0x7c00
7e8b09ea
HV		 115 },
116};
117
118struct msp3400c_carrier_detect {
119 int cdo;
120 char *name;
121};
122
123static struct msp3400c_carrier_detect msp3400c_carrier_detect_main[] = {
124 /* main carrier */
125 { MSP_CARRIER(4.5), "4.5 NTSC" },
126 { MSP_CARRIER(5.5), "5.5 PAL B/G" },
127 { MSP_CARRIER(6.0), "6.0 PAL I" },
128 { MSP_CARRIER(6.5), "6.5 PAL D/K + SAT + SECAM" }
129};
130
131static struct msp3400c_carrier_detect msp3400c_carrier_detect_55[] = {
132 /* PAL B/G */
133 { MSP_CARRIER(5.7421875), "5.742 PAL B/G FM-stereo" },
134 { MSP_CARRIER(5.85), "5.85 PAL B/G NICAM" }
135};
136
137static struct msp3400c_carrier_detect msp3400c_carrier_detect_65[] = {
138 /* PAL SAT / SECAM */
139 { MSP_CARRIER(5.85), "5.85 PAL D/K + SECAM NICAM" },
140 { MSP_CARRIER(6.2578125), "6.25 PAL D/K1 FM-stereo" },
141 { MSP_CARRIER(6.7421875), "6.74 PAL D/K2 FM-stereo" },
142 { MSP_CARRIER(7.02), "7.02 PAL SAT FM-stereo s/b" },
143 { MSP_CARRIER(7.20), "7.20 PAL SAT FM-stereo s" },
144 { MSP_CARRIER(7.38), "7.38 PAL SAT FM-stereo b" },
145};
146
147/* ------------------------------------------------------------------------ */
148
5af0c8f6 149const char *msp_standard_std_name(int std)
7e8b09ea
HV		 150{
151 int i;
152
5af0c8f6
HV		 153 for (i = 0; msp_stdlist[i].name != NULL; i++)
154 if (msp_stdlist[i].retval == std)
155 return msp_stdlist[i].name;
7e8b09ea
HV		 156 return "unknown";
157}
158
044f324f 159static void msp_set_source(struct i2c_client *client, u16 src)
8a4b275f
HV		 160{
161 struct msp_state *state = i2c_get_clientdata(client);
162
163 if (msp_dolby) {
164 msp_write_dsp(client, 0x0008, 0x0520); /* I2S1 */
165 msp_write_dsp(client, 0x0009, 0x0620); /* I2S2 */
166 } else {
167 msp_write_dsp(client, 0x0008, src);
168 msp_write_dsp(client, 0x0009, src);
169 }
170 msp_write_dsp(client, 0x000a, src);
171 msp_write_dsp(client, 0x000b, src);
172 msp_write_dsp(client, 0x000c, src);
173 if (state->has_scart23_in_scart2_out)
174 msp_write_dsp(client, 0x0041, src);
175}
176
177void msp3400c_set_carrier(struct i2c_client *client, int cdo1, int cdo2)
7e8b09ea
HV		 178{
179 msp_write_dem(client, 0x0093, cdo1 & 0xfff);
180 msp_write_dem(client, 0x009b, cdo1 >> 12);
181 msp_write_dem(client, 0x00a3, cdo2 & 0xfff);
182 msp_write_dem(client, 0x00ab, cdo2 >> 12);
8a4b275f 183 msp_write_dem(client, 0x0056, 0); /* LOAD_REG_1/2 */
7e8b09ea
HV		 184}
185
8a4b275f 186void msp3400c_set_mode(struct i2c_client *client, int mode)
7e8b09ea
HV		 187{
188 struct msp_state *state = i2c_get_clientdata(client);
8a4b275f 189 struct msp3400c_init_data_dem *data = &msp3400c_init_data[mode];
2474ed44 190 int tuner = (state->routing.input >> 3) & 1;
7e8b09ea
HV		 191 int i;
192
8a4b275f
HV		 193 v4l_dbg(1, msp_debug, client, "set_mode: %d\n", mode);
194 state->mode = mode;
7e8b09ea
HV		 195 state->rxsubchans = V4L2_TUNER_SUB_MONO;
196
2474ed44 197 msp_write_dem(client, 0x00bb, data->ad_cv | (tuner ? 0x100 : 0));
7e8b09ea
HV		 198
199 for (i = 5; i >= 0; i--) /* fir 1 */
8a4b275f 200 msp_write_dem(client, 0x0001, data->fir1[i]);
7e8b09ea
HV		 201
202 msp_write_dem(client, 0x0005, 0x0004); /* fir 2 */
203 msp_write_dem(client, 0x0005, 0x0040);
204 msp_write_dem(client, 0x0005, 0x0000);
205 for (i = 5; i >= 0; i--)
8a4b275f 206 msp_write_dem(client, 0x0005, data->fir2[i]);
7e8b09ea 207
8a4b275f 208 msp_write_dem(client, 0x0083, data->mode_reg);
7e8b09ea 209
8a4b275f 210 msp3400c_set_carrier(client, data->cdo1, data->cdo2);
7e8b09ea 211
8a4b275f 212 msp_set_source(client, data->dsp_src);
de533ccf 213 /* set prescales */
7e8b09ea 214
de533ccf
HV		 215 /* volume prescale for SCART (AM mono input) */
216 msp_write_dsp(client, 0x000d, 0x1900);
217 msp_write_dsp(client, 0x000e, data->dsp_matrix);
218 if (state->has_nicam) /* nicam prescale */
219 msp_write_dsp(client, 0x0010, 0x5a00);
7e8b09ea
HV		 220}
221
8a4b275f
HV		 222/* Set audio mode. Note that the pre-'G' models do not support BTSC+SAP,
223 nor do they support stereo BTSC. */
044f324f 224static void msp3400c_set_audmode(struct i2c_client *client)
7e8b09ea 225{
301e22d6 226 static char *strmode[] = { "mono", "stereo", "lang2", "lang1", "lang1+lang2" };
7e8b09ea 227 struct msp_state *state = i2c_get_clientdata(client);
301e22d6 228 char *modestr = (state->audmode >= 0 && state->audmode < 5) ?
8a4b275f
HV		 229 strmode[state->audmode] : "unknown";
230 int src = 0; /* channel source: FM/AM, nicam or SCART */
7061561e 231 int audmode = state->audmode;
7e8b09ea
HV		 232
233 if (state->opmode == OPMODE_AUTOSELECT) {
234 /* this method would break everything, let's make sure
235 * it's never called
236 */
8a4b275f
HV		 237 v4l_dbg(1, msp_debug, client,
238 "set_audmode called with mode=%d instead of set_source (ignored)\n",
239 state->audmode);
7e8b09ea
HV		 240 return;
241 }
242
7061561e
HV		 243 /* If no second language is available, switch to the first language */
244 if ((audmode == V4L2_TUNER_MODE_LANG2 ||
245 audmode == V4L2_TUNER_MODE_LANG1_LANG2) &&
246 !(state->rxsubchans & V4L2_TUNER_SUB_LANG2))
247 audmode = V4L2_TUNER_MODE_LANG1;
248 /* switch to stereo for stereo transmission, otherwise
249 keep first language */
250 if (audmode == V4L2_TUNER_MODE_LANG1 &&
251 (state->rxsubchans & V4L2_TUNER_SUB_STEREO))
252 audmode = V4L2_TUNER_MODE_STEREO;
253
7e8b09ea
HV		 254 /* switch demodulator */
255 switch (state->mode) {
256 case MSP_MODE_FM_TERRA:
8a4b275f 257 v4l_dbg(1, msp_debug, client, "FM set_audmode: %s\n", modestr);
7061561e 258 switch (audmode) {
7e8b09ea
HV		 259 case V4L2_TUNER_MODE_STEREO:
260 msp_write_dsp(client, 0x000e, 0x3001);
261 break;
262 case V4L2_TUNER_MODE_MONO:
263 case V4L2_TUNER_MODE_LANG1:
264 case V4L2_TUNER_MODE_LANG2:
301e22d6 265 case V4L2_TUNER_MODE_LANG1_LANG2:
7e8b09ea
HV		 266 msp_write_dsp(client, 0x000e, 0x3000);
267 break;
268 }
269 break;
270 case MSP_MODE_FM_SAT:
8a4b275f 271 v4l_dbg(1, msp_debug, client, "SAT set_audmode: %s\n", modestr);
7061561e 272 switch (audmode) {
7e8b09ea 273 case V4L2_TUNER_MODE_MONO:
8a4b275f 274 msp3400c_set_carrier(client, MSP_CARRIER(6.5), MSP_CARRIER(6.5));
7e8b09ea
HV		 275 break;
276 case V4L2_TUNER_MODE_STEREO:
301e22d6 277 case V4L2_TUNER_MODE_LANG1_LANG2:
8a4b275f 278 msp3400c_set_carrier(client, MSP_CARRIER(7.2), MSP_CARRIER(7.02));
7e8b09ea
HV		 279 break;
280 case V4L2_TUNER_MODE_LANG1:
8a4b275f 281 msp3400c_set_carrier(client, MSP_CARRIER(7.38), MSP_CARRIER(7.02));
7e8b09ea
HV		 282 break;
283 case V4L2_TUNER_MODE_LANG2:
8a4b275f 284 msp3400c_set_carrier(client, MSP_CARRIER(7.38), MSP_CARRIER(7.02));
7e8b09ea
HV		 285 break;
286 }
287 break;
288 case MSP_MODE_FM_NICAM1:
289 case MSP_MODE_FM_NICAM2:
290 case MSP_MODE_AM_NICAM:
8a4b275f 291 v4l_dbg(1, msp_debug, client, "NICAM set_audmode: %s\n",modestr);
7e8b09ea 292 if (state->nicam_on)
8a4b275f 293 src = 0x0100; /* NICAM */
7e8b09ea
HV		 294 break;
295 case MSP_MODE_BTSC:
8a4b275f 296 v4l_dbg(1, msp_debug, client, "BTSC set_audmode: %s\n",modestr);
7e8b09ea
HV		 297 break;
298 case MSP_MODE_EXTERN:
8a4b275f
HV		 299 v4l_dbg(1, msp_debug, client, "extern set_audmode: %s\n",modestr);
300 src = 0x0200; /* SCART */
7e8b09ea
HV		 301 break;
302 case MSP_MODE_FM_RADIO:
8a4b275f 303 v4l_dbg(1, msp_debug, client, "FM-Radio set_audmode: %s\n",modestr);
7e8b09ea
HV		 304 break;
305 default:
8a4b275f 306 v4l_dbg(1, msp_debug, client, "mono set_audmode\n");
7e8b09ea
HV		 307 return;
308 }
309
310 /* switch audio */
7061561e 311 switch (audmode) {
7e8b09ea 312 case V4L2_TUNER_MODE_STEREO:
301e22d6 313 case V4L2_TUNER_MODE_LANG1_LANG2:
8a4b275f 314 src |= 0x0020;
7e8b09ea
HV		 315 break;
316 case V4L2_TUNER_MODE_MONO:
317 if (state->mode == MSP_MODE_AM_NICAM) {
f167cb4e 318 v4l_dbg(1, msp_debug, client, "switching to AM mono\n");
7e8b09ea
HV		 319 /* AM mono decoding is handled by tuner, not MSP chip */
320 /* SCART switching control register */
321 msp_set_scart(client, SCART_MONO, 0);
322 src = 0x0200;
323 break;
324 }
8a4b275f
HV		 325 if (state->rxsubchans & V4L2_TUNER_SUB_STEREO)
326 src = 0x0030;
327 break;
7e8b09ea 328 case V4L2_TUNER_MODE_LANG1:
7e8b09ea
HV		 329 break;
330 case V4L2_TUNER_MODE_LANG2:
8a4b275f 331 src |= 0x0010;
7e8b09ea
HV		 332 break;
333 }
8a4b275f 334 v4l_dbg(1, msp_debug, client, "set_audmode final source/matrix = 0x%x\n", src);
7e8b09ea 335
8a4b275f 336 msp_set_source(client, src);
7e8b09ea
HV		 337}
338
339static void msp3400c_print_mode(struct i2c_client *client)
340{
341 struct msp_state *state = i2c_get_clientdata(client);
342
343 if (state->main == state->second) {
f167cb4e 344 v4l_dbg(1, msp_debug, client, "mono sound carrier: %d.%03d MHz\n",
7e8b09ea
HV		 345 state->main / 910000, (state->main / 910) % 1000);
346 } else {
f167cb4e 347 v4l_dbg(1, msp_debug, client, "main sound carrier: %d.%03d MHz\n",
7e8b09ea
HV		 348 state->main / 910000, (state->main / 910) % 1000);
349 }
350 if (state->mode == MSP_MODE_FM_NICAM1 || state->mode == MSP_MODE_FM_NICAM2)
f167cb4e 351 v4l_dbg(1, msp_debug, client, "NICAM/FM carrier : %d.%03d MHz\n",
7e8b09ea
HV		 352 state->second / 910000, (state->second/910) % 1000);
353 if (state->mode == MSP_MODE_AM_NICAM)
f167cb4e 354 v4l_dbg(1, msp_debug, client, "NICAM/AM carrier : %d.%03d MHz\n",
7e8b09ea
HV		 355 state->second / 910000, (state->second / 910) % 1000);
356 if (state->mode == MSP_MODE_FM_TERRA && state->main != state->second) {
f167cb4e 357 v4l_dbg(1, msp_debug, client, "FM-stereo carrier : %d.%03d MHz\n",
7e8b09ea
HV		 358 state->second / 910000, (state->second / 910) % 1000);
359 }
360}
361
362/* ----------------------------------------------------------------------- */
363
8a4b275f 364static int msp3400c_detect_stereo(struct i2c_client *client)
7e8b09ea
HV		 365{
366 struct msp_state *state = i2c_get_clientdata(client);
367 int val;
368 int rxsubchans = state->rxsubchans;
8a4b275f 369 int newnicam = state->nicam_on;
7e8b09ea
HV		 370 int update = 0;
371
372 switch (state->mode) {
373 case MSP_MODE_FM_TERRA:
374 val = msp_read_dsp(client, 0x18);
375 if (val > 32767)
376 val -= 65536;
f167cb4e 377 v4l_dbg(2, msp_debug, client, "stereo detect register: %d\n", val);
7e8b09ea 378 if (val > 4096) {
8a4b275f 379 rxsubchans = V4L2_TUNER_SUB_STEREO;
7e8b09ea
HV		 380 } else if (val < -4096) {
381 rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
382 } else {
383 rxsubchans = V4L2_TUNER_SUB_MONO;
384 }
385 newnicam = 0;
386 break;
387 case MSP_MODE_FM_NICAM1:
388 case MSP_MODE_FM_NICAM2:
389 case MSP_MODE_AM_NICAM:
390 val = msp_read_dem(client, 0x23);
f167cb4e 391 v4l_dbg(2, msp_debug, client, "nicam sync=%d, mode=%d\n",
7e8b09ea
HV		 392 val & 1, (val & 0x1e) >> 1);
393
394 if (val & 1) {
395 /* nicam synced */
396 switch ((val & 0x1e) >> 1) {
397 case 0:
398 case 8:
399 rxsubchans = V4L2_TUNER_SUB_STEREO;
400 break;
401 case 1:
402 case 9:
8a4b275f 403 rxsubchans = V4L2_TUNER_SUB_MONO;
7e8b09ea
HV		 404 break;
405 case 2:
406 case 10:
8a4b275f 407 rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
7e8b09ea
HV		 408 break;
409 default:
410 rxsubchans = V4L2_TUNER_SUB_MONO;
411 break;
412 }
413 newnicam = 1;
414 } else {
415 newnicam = 0;
416 rxsubchans = V4L2_TUNER_SUB_MONO;
417 }
418 break;
7e8b09ea
HV		 419 }
420 if (rxsubchans != state->rxsubchans) {
421 update = 1;
8a4b275f
HV		 422 v4l_dbg(1, msp_debug, client, "watch: rxsubchans %02x => %02x\n",
423 state->rxsubchans, rxsubchans);
7e8b09ea
HV		 424 state->rxsubchans = rxsubchans;
425 }
426 if (newnicam != state->nicam_on) {
427 update = 1;
f167cb4e 428 v4l_dbg(1, msp_debug, client, "watch: nicam %d => %d\n",
8a4b275f 429 state->nicam_on, newnicam);
7e8b09ea
HV		 430 state->nicam_on = newnicam;
431 }
432 return update;
433}
434
435/*
436 * A kernel thread for msp3400 control -- we don't want to block the
437 * in the ioctl while doing the sound carrier & stereo detect
438 */
439/* stereo/multilang monitoring */
440static void watch_stereo(struct i2c_client *client)
441{
442 struct msp_state *state = i2c_get_clientdata(client);
443
de533ccf
HV		 444 if (msp_detect_stereo(client)) {
445 msp_set_audmode(client);
7e8b09ea
HV		 446 }
447
f167cb4e 448 if (msp_once)
7e8b09ea
HV		 449 state->watch_stereo = 0;
450}
451
452int msp3400c_thread(void *data)
453{
454 struct i2c_client *client = data;
455 struct msp_state *state = i2c_get_clientdata(client);
456 struct msp3400c_carrier_detect *cd;
8a4b275f 457 int count, max1, max2, val1, val2, val, this;
7e8b09ea
HV		 458
459
f167cb4e 460 v4l_dbg(1, msp_debug, client, "msp3400 daemon started\n");
7e8b09ea 461 for (;;) {
f167cb4e 462 v4l_dbg(2, msp_debug, client, "msp3400 thread: sleep\n");
7e8b09ea 463 msp_sleep(state, -1);
f167cb4e 464 v4l_dbg(2, msp_debug, client, "msp3400 thread: wakeup\n");
7e8b09ea
HV		 465
466 restart:
8a4b275f 467 v4l_dbg(2, msp_debug, client, "thread: restart scan\n");
7e8b09ea
HV		 468 state->restart = 0;
469 if (kthread_should_stop())
470 break;
471
7560d7a4 472 if (state->radio || MSP_MODE_EXTERN == state->mode) {
7e8b09ea 473 /* no carrier scan, just unmute */
f167cb4e 474 v4l_dbg(1, msp_debug, client, "thread: no carrier scan\n");
7e8b09ea
HV		 475 msp_set_audio(client);
476 continue;
477 }
478
479 /* mute */
480 msp_set_mute(client);
de533ccf 481 msp3400c_set_mode(client, MSP_MODE_AM_DETECT);
7e8b09ea
HV		 482 val1 = val2 = 0;
483 max1 = max2 = -1;
484 state->watch_stereo = 0;
8a4b275f 485 state->nicam_on = 0;
7e8b09ea
HV		 486
487 /* some time for the tuner to sync */
8a4b275f 488 if (msp_sleep(state, 200))
7e8b09ea
HV		 489 goto restart;
490
491 /* carrier detect pass #1 -- main carrier */
492 cd = msp3400c_carrier_detect_main;
493 count = ARRAY_SIZE(msp3400c_carrier_detect_main);
494
f167cb4e 495 if (msp_amsound && (state->v4l2_std & V4L2_STD_SECAM)) {
7e8b09ea
HV		 496 /* autodetect doesn't work well with AM ... */
497 max1 = 3;
498 count = 0;
f167cb4e 499 v4l_dbg(1, msp_debug, client, "AM sound override\n");
7e8b09ea
HV		 500 }
501
502 for (this = 0; this < count; this++) {
8a4b275f 503 msp3400c_set_carrier(client, cd[this].cdo, cd[this].cdo);
7e8b09ea
HV		 504 if (msp_sleep(state,100))
505 goto restart;
506 val = msp_read_dsp(client, 0x1b);
507 if (val > 32767)
508 val -= 65536;
509 if (val1 < val)
510 val1 = val, max1 = this;
f167cb4e 511 v4l_dbg(1, msp_debug, client, "carrier1 val: %5d / %s\n", val,cd[this].name);
7e8b09ea
HV		 512 }
513
514 /* carrier detect pass #2 -- second (stereo) carrier */
515 switch (max1) {
516 case 1: /* 5.5 */
517 cd = msp3400c_carrier_detect_55;
518 count = ARRAY_SIZE(msp3400c_carrier_detect_55);
519 break;
520 case 3: /* 6.5 */
521 cd = msp3400c_carrier_detect_65;
522 count = ARRAY_SIZE(msp3400c_carrier_detect_65);
523 break;
524 case 0: /* 4.5 */
525 case 2: /* 6.0 */
526 default:
527 cd = NULL;
528 count = 0;
529 break;
530 }
531
f167cb4e 532 if (msp_amsound && (state->v4l2_std & V4L2_STD_SECAM)) {
7e8b09ea
HV		 533 /* autodetect doesn't work well with AM ... */
534 cd = NULL;
535 count = 0;
536 max2 = 0;
537 }
538 for (this = 0; this < count; this++) {
8a4b275f 539 msp3400c_set_carrier(client, cd[this].cdo, cd[this].cdo);
7e8b09ea
HV		 540 if (msp_sleep(state,100))
541 goto restart;
542 val = msp_read_dsp(client, 0x1b);
543 if (val > 32767)
544 val -= 65536;
545 if (val2 < val)
546 val2 = val, max2 = this;
f167cb4e 547 v4l_dbg(1, msp_debug, client, "carrier2 val: %5d / %s\n", val,cd[this].name);
7e8b09ea
HV		 548 }
549
550 /* program the msp3400 according to the results */
8a4b275f 551 state->main = msp3400c_carrier_detect_main[max1].cdo;
7e8b09ea
HV		 552 switch (max1) {
553 case 1: /* 5.5 */
554 if (max2 == 0) {
555 /* B/G FM-stereo */
556 state->second = msp3400c_carrier_detect_55[max2].cdo;
8a4b275f 557 msp3400c_set_mode(client, MSP_MODE_FM_TERRA);
7e8b09ea 558 state->watch_stereo = 1;
7560d7a4 559 } else if (max2 == 1 && state->has_nicam) {
7e8b09ea
HV		 560 /* B/G NICAM */
561 state->second = msp3400c_carrier_detect_55[max2].cdo;
8a4b275f
HV		 562 msp3400c_set_mode(client, MSP_MODE_FM_NICAM1);
563 msp3400c_set_carrier(client, state->second, state->main);
7e8b09ea 564 state->nicam_on = 1;
7e8b09ea
HV		 565 state->watch_stereo = 1;
566 } else {
567 goto no_second;
568 }
569 break;
570 case 2: /* 6.0 */
571 /* PAL I NICAM */
572 state->second = MSP_CARRIER(6.552);
8a4b275f
HV		 573 msp3400c_set_mode(client, MSP_MODE_FM_NICAM2);
574 msp3400c_set_carrier(client, state->second, state->main);
7e8b09ea 575 state->nicam_on = 1;
7e8b09ea
HV		 576 state->watch_stereo = 1;
577 break;
578 case 3: /* 6.5 */
579 if (max2 == 1 || max2 == 2) {
580 /* D/K FM-stereo */
581 state->second = msp3400c_carrier_detect_65[max2].cdo;
8a4b275f 582 msp3400c_set_mode(client, MSP_MODE_FM_TERRA);
7e8b09ea 583 state->watch_stereo = 1;
5af0c8f6 584 } else if (max2 == 0 && (state->v4l2_std & V4L2_STD_SECAM)) {
7e8b09ea
HV		 585 /* L NICAM or AM-mono */
586 state->second = msp3400c_carrier_detect_65[max2].cdo;
8a4b275f
HV		 587 msp3400c_set_mode(client, MSP_MODE_AM_NICAM);
588 msp3400c_set_carrier(client, state->second, state->main);
7e8b09ea 589 state->watch_stereo = 1;
7560d7a4 590 } else if (max2 == 0 && state->has_nicam) {
7e8b09ea
HV		 591 /* D/K NICAM */
592 state->second = msp3400c_carrier_detect_65[max2].cdo;
8a4b275f
HV		 593 msp3400c_set_mode(client, MSP_MODE_FM_NICAM1);
594 msp3400c_set_carrier(client, state->second, state->main);
7e8b09ea 595 state->nicam_on = 1;
7e8b09ea
HV		 596 state->watch_stereo = 1;
597 } else {
598 goto no_second;
599 }
600 break;
601 case 0: /* 4.5 */
602 default:
603 no_second:
604 state->second = msp3400c_carrier_detect_main[max1].cdo;
8a4b275f
HV		 605 msp3400c_set_mode(client, MSP_MODE_FM_TERRA);
606 msp3400c_set_carrier(client, state->second, state->main);
7e8b09ea 607 state->rxsubchans = V4L2_TUNER_SUB_MONO;
7e8b09ea
HV		 608 break;
609 }
610
611 /* unmute */
612 msp_set_audio(client);
8a4b275f 613 msp3400c_set_audmode(client);
7e8b09ea 614
f167cb4e 615 if (msp_debug)
7e8b09ea
HV		 616 msp3400c_print_mode(client);
617
8a4b275f
HV		 618 /* monitor tv audio mode, the first time don't wait
619 so long to get a quick stereo/bilingual result */
620 if (msp_sleep(state, 1000))
621 goto restart;
7e8b09ea 622 while (state->watch_stereo) {
7061561e 623 watch_stereo(client);
8a4b275f 624 if (msp_sleep(state, 5000))
7e8b09ea 625 goto restart;
7e8b09ea
HV		 626 }
627 }
f167cb4e 628 v4l_dbg(1, msp_debug, client, "thread: exit\n");
7e8b09ea
HV		 629 return 0;
630}
631
632
633int msp3410d_thread(void *data)
634{
635 struct i2c_client *client = data;
636 struct msp_state *state = i2c_get_clientdata(client);
d312a46e 637 int val, i, std;
7e8b09ea 638
f167cb4e 639 v4l_dbg(1, msp_debug, client, "msp3410 daemon started\n");
7e8b09ea
HV		 640
641 for (;;) {
f167cb4e 642 v4l_dbg(2, msp_debug, client, "msp3410 thread: sleep\n");
7e8b09ea 643 msp_sleep(state,-1);
f167cb4e 644 v4l_dbg(2, msp_debug, client, "msp3410 thread: wakeup\n");
7e8b09ea
HV		 645
646 restart:
8a4b275f 647 v4l_dbg(2, msp_debug, client, "thread: restart scan\n");
7e8b09ea
HV		 648 state->restart = 0;
649 if (kthread_should_stop())
650 break;
651
652 if (state->mode == MSP_MODE_EXTERN) {
653 /* no carrier scan needed, just unmute */
f167cb4e 654 v4l_dbg(1, msp_debug, client, "thread: no carrier scan\n");
7e8b09ea
HV		 655 msp_set_audio(client);
656 continue;
657 }
658
659 /* put into sane state (and mute) */
660 msp_reset(client);
661
662 /* some time for the tuner to sync */
663 if (msp_sleep(state,200))
664 goto restart;
665
de533ccf
HV		 666 /* start autodetect. Note: autodetect is not supported for
667 NTSC-M and radio, hence we force the standard in those cases. */
5af0c8f6
HV		 668 if (state->radio)
669 std = 0x40;
d312a46e 670 else
5af0c8f6 671 std = (state->v4l2_std & V4L2_STD_NTSC) ? 0x20 : 1;
7e8b09ea 672 state->watch_stereo = 0;
8a4b275f 673 state->nicam_on = 0;
7e8b09ea 674
f167cb4e 675 if (msp_debug)
8a4b275f 676 v4l_dbg(2, msp_debug, client, "setting standard: %s (0x%04x)\n",
5af0c8f6 677 msp_standard_std_name(std), std);
7e8b09ea
HV		 678
679 if (std != 1) {
680 /* programmed some specific mode */
681 val = std;
682 } else {
683 /* triggered autodetect */
5af0c8f6 684 msp_write_dem(client, 0x20, std);
7e8b09ea 685 for (;;) {
d312a46e 686 if (msp_sleep(state, 100))
7e8b09ea
HV		 687 goto restart;
688
689 /* check results */
690 val = msp_read_dem(client, 0x7e);
691 if (val < 0x07ff)
692 break;
8a4b275f 693 v4l_dbg(2, msp_debug, client, "detection still in progress\n");
7e8b09ea
HV		 694 }
695 }
5af0c8f6
HV		 696 for (i = 0; msp_stdlist[i].name != NULL; i++)
697 if (msp_stdlist[i].retval == val)
7e8b09ea 698 break;
f167cb4e 699 v4l_dbg(1, msp_debug, client, "current standard: %s (0x%04x)\n",
5af0c8f6
HV		 700 msp_standard_std_name(val), val);
701 state->main = msp_stdlist[i].main;
702 state->second = msp_stdlist[i].second;
703 state->std = val;
704
f167cb4e 705 if (msp_amsound && !state->radio && (state->v4l2_std & V4L2_STD_SECAM) &&
5af0c8f6 706 (val != 0x0009)) {
7e8b09ea 707 /* autodetection has failed, let backup */
f167cb4e 708 v4l_dbg(1, msp_debug, client, "autodetection failed,"
5af0c8f6
HV		 709 " switching to backup standard: %s (0x%04x)\n",
710 msp_stdlist[8].name ? msp_stdlist[8].name : "unknown",val);
de533ccf 711 state->std = val = 0x0009;
7e8b09ea
HV		 712 msp_write_dem(client, 0x20, val);
713 }
714
7e8b09ea
HV		 715 /* set stereo */
716 switch (val) {
717 case 0x0008: /* B/G NICAM */
718 case 0x000a: /* I NICAM */
de533ccf
HV		 719 case 0x000b: /* D/K NICAM */
720 if (val == 0x000a)
7e8b09ea 721 state->mode = MSP_MODE_FM_NICAM2;
de533ccf
HV		 722 else
723 state->mode = MSP_MODE_FM_NICAM1;
7e8b09ea
HV		 724 /* just turn on stereo */
725 state->rxsubchans = V4L2_TUNER_SUB_STEREO;
726 state->nicam_on = 1;
727 state->watch_stereo = 1;
7e8b09ea
HV		 728 break;
729 case 0x0009:
730 state->mode = MSP_MODE_AM_NICAM;
731 state->rxsubchans = V4L2_TUNER_SUB_MONO;
732 state->nicam_on = 1;
7e8b09ea
HV		 733 state->watch_stereo = 1;
734 break;
735 case 0x0020: /* BTSC */
8a4b275f 736 /* The pre-'G' models only have BTSC-mono */
7e8b09ea 737 state->mode = MSP_MODE_BTSC;
8a4b275f 738 state->rxsubchans = V4L2_TUNER_SUB_MONO;
7e8b09ea
HV		 739 break;
740 case 0x0040: /* FM radio */
7560d7a4 741 state->mode = MSP_MODE_FM_RADIO;
7e8b09ea 742 state->rxsubchans = V4L2_TUNER_SUB_STEREO;
7560d7a4 743 /* not needed in theory if we have radio, but
7e8b09ea 744 short programming enables carrier mute */
8a4b275f
HV		 745 msp3400c_set_mode(client, MSP_MODE_FM_RADIO);
746 msp3400c_set_carrier(client, MSP_CARRIER(10.7),
7e8b09ea 747 MSP_CARRIER(10.7));
8a4b275f 748 /* scart routing (this doesn't belong here I think) */
7e8b09ea 749 msp_set_scart(client,SCART_IN2,0);
7e8b09ea 750 break;
de533ccf 751 case 0x0002:
7e8b09ea
HV		 752 case 0x0003:
753 case 0x0004:
754 case 0x0005:
5af0c8f6 755 state->mode = MSP_MODE_FM_TERRA;
7e8b09ea 756 state->rxsubchans = V4L2_TUNER_SUB_MONO;
7e8b09ea
HV		 757 state->watch_stereo = 1;
758 break;
759 }
760
de533ccf
HV		 761 /* set various prescales */
762 msp_write_dsp(client, 0x0d, 0x1900); /* scart */
763 msp_write_dsp(client, 0x0e, 0x3000); /* FM */
764 if (state->has_nicam)
765 msp_write_dsp(client, 0x10, 0x5a00); /* nicam */
766
5af0c8f6
HV		 767 if (state->has_i2s_conf)
768 msp_write_dem(client, 0x40, state->i2s_mode);
7e8b09ea 769
de533ccf
HV		 770 /* unmute, restore misc registers */
771 msp_set_audio(client);
772
773 msp_write_dsp(client, 0x13, state->acb);
8a4b275f
HV		 774 msp3400c_set_audmode(client);
775
776 /* monitor tv audio mode, the first time don't wait
777 so long to get a quick stereo/bilingual result */
778 if (msp_sleep(state, 1000))
779 goto restart;
7e8b09ea 780 while (state->watch_stereo) {
7e8b09ea 781 watch_stereo(client);
8a4b275f
HV		 782 if (msp_sleep(state, 5000))
783 goto restart;
7e8b09ea
HV		 784 }
785 }
f167cb4e 786 v4l_dbg(1, msp_debug, client, "thread: exit\n");
7e8b09ea
HV		 787 return 0;
788}
789
790/* ----------------------------------------------------------------------- */
791
de533ccf
HV		 792/* msp34xxG + (autoselect no-thread)
793 * this one uses both automatic standard detection and automatic sound
794 * select which are available in the newer G versions
795 * struct msp: only norm, acb and source are really used in this mode
796 */
7e8b09ea 797
9a80a93d
HV		 798static int msp34xxg_modus(struct i2c_client *client)
799{
800 struct msp_state *state = i2c_get_clientdata(client);
801
802 if (state->radio) {
803 v4l_dbg(1, msp_debug, client, "selected radio modus\n");
804 return 0x0001;
805 }
806
807 if (state->v4l2_std & V4L2_STD_PAL) {
808 v4l_dbg(1, msp_debug, client, "selected PAL modus\n");
809 return 0x7001;
810 }
811 if (state->v4l2_std == V4L2_STD_NTSC_M_JP) {
812 v4l_dbg(1, msp_debug, client, "selected M (EIA-J) modus\n");
813 return 0x4001;
814 }
815 if (state->v4l2_std == V4L2_STD_NTSC_M_KR) {
816 v4l_dbg(1, msp_debug, client, "selected M (A2) modus\n");
817 return 0x0001;
818 }
819 if (state->v4l2_std & V4L2_STD_MN) {
820 v4l_dbg(1, msp_debug, client, "selected M (BTSC) modus\n");
821 return 0x2001;
822 }
823 if (state->v4l2_std & V4L2_STD_SECAM) {
824 v4l_dbg(1, msp_debug, client, "selected SECAM modus\n");
825 return 0x6001;
826 }
827 return 0x0001;
828}
829
2474ed44
HV		 830static void msp34xxg_set_source(struct i2c_client *client, u16 reg, int in)
831 {
832 struct msp_state *state = i2c_get_clientdata(client);
833 int source, matrix;
834
835 switch (state->audmode) {
836 case V4L2_TUNER_MODE_MONO:
837 source = 0; /* mono only */
838 matrix = 0x30;
839 break;
840 case V4L2_TUNER_MODE_LANG1:
841 source = 3; /* stereo or A */
842 matrix = 0x00;
843 break;
844 case V4L2_TUNER_MODE_LANG2:
845 source = 4; /* stereo or B */
846 matrix = 0x10;
847 break;
848 case V4L2_TUNER_MODE_STEREO:
301e22d6 849 case V4L2_TUNER_MODE_LANG1_LANG2:
2474ed44
HV		 850 default:
851 source = 1; /* stereo or A|B */
852 matrix = 0x20;
853 break;
854 }
855
856 if (in == MSP_DSP_OUT_TUNER)
857 source = (source << 8) | 0x20;
858 /* the msp34x2g puts the MAIN_AVC, MAIN and AUX sources in 12, 13, 14
859 instead of 11, 12, 13. So we add one for that msp version. */
860 else if (in >= MSP_DSP_OUT_MAIN_AVC && state->has_dolby_pro_logic)
861 source = ((in + 1) << 8) | matrix;
862 else
863 source = (in << 8) | matrix;
864
865 v4l_dbg(1, msp_debug, client, "set source to %d (0x%x) for output %02x\n",
866 in, source, reg);
867 msp_write_dsp(client, reg, source);
868}
869
870static void msp34xxg_set_sources(struct i2c_client *client)
871{
872 struct msp_state *state = i2c_get_clientdata(client);
873 u32 in = state->routing.input;
874
875 msp34xxg_set_source(client, 0x0008, (in >> 4) & 0xf);
876 /* quasi-peak detector is set to same input as the loudspeaker (MAIN) */
877 msp34xxg_set_source(client, 0x000c, (in >> 4) & 0xf);
878 msp34xxg_set_source(client, 0x0009, (in >> 8) & 0xf);
879 msp34xxg_set_source(client, 0x000a, (in >> 12) & 0xf);
880 if (state->has_scart23_in_scart2_out)
881 msp34xxg_set_source(client, 0x0041, (in >> 16) & 0xf);
882 msp34xxg_set_source(client, 0x000b, (in >> 20) & 0xf);
883}
884
de533ccf
HV		 885/* (re-)initialize the msp34xxg */
886static void msp34xxg_reset(struct i2c_client *client)
7e8b09ea
HV		 887{
888 struct msp_state *state = i2c_get_clientdata(client);
2474ed44 889 int tuner = (state->routing.input >> 3) & 1;
de533ccf 890 int modus;
7e8b09ea 891
de533ccf
HV		 892 /* initialize std to 1 (autodetect) to signal that no standard is
893 selected yet. */
894 state->std = 1;
895
896 msp_reset(client);
7e8b09ea
HV		 897
898 /* make sure that input/output is muted (paranoid mode) */
899 /* ACB, mute DSP input, mute SCART 1 */
de533ccf 900 msp_write_dsp(client, 0x13, 0x0f20);
7e8b09ea 901
5af0c8f6
HV		 902 if (state->has_i2s_conf)
903 msp_write_dem(client, 0x40, state->i2s_mode);
7e8b09ea
HV		 904
905 /* step-by-step initialisation, as described in the manual */
9a80a93d 906 modus = msp34xxg_modus(client);
2474ed44 907 modus |= tuner ? 0x100 : 0;
de533ccf 908 msp_write_dem(client, 0x30, modus);
7e8b09ea
HV		 909
910 /* write the dsps that may have an influence on
911 standard/audio autodetection right now */
2474ed44 912 msp34xxg_set_sources(client);
7e8b09ea 913
de533ccf
HV		 914 msp_write_dsp(client, 0x0d, 0x1900); /* scart */
915 msp_write_dsp(client, 0x0e, 0x3000); /* FM */
916 if (state->has_nicam)
917 msp_write_dsp(client, 0x10, 0x5a00); /* nicam */
7e8b09ea 918
de533ccf
HV		 919 /* set identification threshold. Personally, I
920 * I set it to a higher value than the default
921 * of 0x190 to ignore noisy stereo signals.
922 * this needs tuning. (recommended range 0x00a0-0x03c0)
923 * 0x7f0 = forced mono mode
924 *
925 * a2 threshold for stereo/bilingual.
926 * Note: this register is part of the Manual/Compatibility mode.
927 * It is supported by all 'G'-family chips.
928 */
929 msp_write_dem(client, 0x22, msp_stereo_thresh);
7e8b09ea
HV		 930}
931
932int msp34xxg_thread(void *data)
933{
934 struct i2c_client *client = data;
935 struct msp_state *state = i2c_get_clientdata(client);
de533ccf 936 int val, i;
7e8b09ea 937
f167cb4e 938 v4l_dbg(1, msp_debug, client, "msp34xxg daemon started\n");
7e8b09ea 939
7e8b09ea 940 for (;;) {
f167cb4e 941 v4l_dbg(2, msp_debug, client, "msp34xxg thread: sleep\n");
7e8b09ea 942 msp_sleep(state, -1);
f167cb4e 943 v4l_dbg(2, msp_debug, client, "msp34xxg thread: wakeup\n");
7e8b09ea
HV		 944
945 restart:
f167cb4e 946 v4l_dbg(1, msp_debug, client, "thread: restart scan\n");
7e8b09ea
HV		 947 state->restart = 0;
948 if (kthread_should_stop())
949 break;
950
951 /* setup the chip*/
952 msp34xxg_reset(client);
de533ccf
HV		 953 state->std = state->radio ? 0x40 : msp_standard;
954 if (state->std != 1)
7e8b09ea 955 goto unmute;
de533ccf
HV		 956 /* start autodetect */
957 msp_write_dem(client, 0x20, state->std);
7e8b09ea
HV		 958
959 /* watch autodetect */
de533ccf 960 v4l_dbg(1, msp_debug, client, "started autodetect, waiting for result\n");
7e8b09ea
HV		 961 for (i = 0; i < 10; i++) {
962 if (msp_sleep(state, 100))
963 goto restart;
964
965 /* check results */
966 val = msp_read_dem(client, 0x7e);
967 if (val < 0x07ff) {
de533ccf 968 state->std = val;
7e8b09ea
HV		 969 break;
970 }
f167cb4e 971 v4l_dbg(2, msp_debug, client, "detection still in progress\n");
7e8b09ea 972 }
de533ccf 973 if (state->std == 1) {
f167cb4e 974 v4l_dbg(1, msp_debug, client, "detection still in progress after 10 tries. giving up.\n");
7e8b09ea
HV		 975 continue;
976 }
977
978 unmute:
de533ccf
HV		 979 v4l_dbg(1, msp_debug, client, "detected standard: %s (0x%04x)\n",
980 msp_standard_std_name(state->std), state->std);
7e8b09ea
HV		 981
982 /* unmute: dispatch sound to scart output, set scart volume */
983 msp_set_audio(client);
984
985 /* restore ACB */
986 if (msp_write_dsp(client, 0x13, state->acb))
987 return -1;
988
de533ccf
HV		 989 /* the periodic stereo/SAP check is only relevant for
990 the 0x20 standard (BTSC) */
991 if (state->std != 0x20)
992 continue;
993
994 state->watch_stereo = 1;
995
996 /* monitor tv audio mode, the first time don't wait
997 in order to get a quick stereo/SAP update */
998 watch_stereo(client);
999 while (state->watch_stereo) {
1000 watch_stereo(client);
1001 if (msp_sleep(state, 5000))
1002 goto restart;
1003 }
7e8b09ea 1004 }
f167cb4e 1005 v4l_dbg(1, msp_debug, client, "thread: exit\n");
7e8b09ea
HV		 1006 return 0;
1007}
1008
de533ccf 1009static int msp34xxg_detect_stereo(struct i2c_client *client)
7e8b09ea
HV		 1010{
1011 struct msp_state *state = i2c_get_clientdata(client);
7e8b09ea
HV		 1012 int status = msp_read_dem(client, 0x0200);
1013 int is_bilingual = status & 0x100;
1014 int is_stereo = status & 0x40;
de533ccf 1015 int oldrx = state->rxsubchans;
7e8b09ea
HV		 1016
1017 state->rxsubchans = 0;
1018 if (is_stereo)
8a4b275f 1019 state->rxsubchans = V4L2_TUNER_SUB_STEREO;
7e8b09ea 1020 else
8a4b275f 1021 state->rxsubchans = V4L2_TUNER_SUB_MONO;
7e8b09ea 1022 if (is_bilingual) {
de533ccf
HV		 1023 if (state->std == 0x20)
1024 state->rxsubchans |= V4L2_TUNER_SUB_SAP;
1025 else
1026 state->rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
7e8b09ea 1027 }
f167cb4e 1028 v4l_dbg(1, msp_debug, client, "status=0x%x, stereo=%d, bilingual=%d -> rxsubchans=%d\n",
7e8b09ea 1029 status, is_stereo, is_bilingual, state->rxsubchans);
de533ccf 1030 return (oldrx != state->rxsubchans);
7e8b09ea
HV		 1031}
1032
044f324f 1033static void msp34xxg_set_audmode(struct i2c_client *client)
7e8b09ea
HV		 1034{
1035 struct msp_state *state = i2c_get_clientdata(client);
7e8b09ea 1036
de533ccf
HV		 1037 if (state->std == 0x20) {
1038 if ((state->rxsubchans & V4L2_TUNER_SUB_SAP) &&
cc33668b 1039 (state->audmode == V4L2_TUNER_MODE_LANG1_LANG2 ||
de533ccf
HV		 1040 state->audmode == V4L2_TUNER_MODE_LANG2)) {
1041 msp_write_dem(client, 0x20, 0x21);
1042 } else {
1043 msp_write_dem(client, 0x20, 0x20);
1044 }
1045 }
1046
2474ed44 1047 msp34xxg_set_sources(client);
7e8b09ea
HV		 1048}
1049
8a4b275f
HV		 1050void msp_set_audmode(struct i2c_client *client)
1051{
1052 struct msp_state *state = i2c_get_clientdata(client);
1053
1054 switch (state->opmode) {
1055 case OPMODE_MANUAL:
1056 case OPMODE_AUTODETECT:
8a4b275f
HV		 1057 msp3400c_set_audmode(client);
1058 break;
1059 case OPMODE_AUTOSELECT:
1060 msp34xxg_set_audmode(client);
1061 break;
1062 }
1063}
1064
de533ccf 1065int msp_detect_stereo(struct i2c_client *client)
8a4b275f
HV		 1066{
1067 struct msp_state *state = i2c_get_clientdata(client);
1068
1069 switch (state->opmode) {
1070 case OPMODE_MANUAL:
1071 case OPMODE_AUTODETECT:
de533ccf 1072 return msp3400c_detect_stereo(client);
8a4b275f 1073 case OPMODE_AUTOSELECT:
de533ccf 1074 return msp34xxg_detect_stereo(client);
8a4b275f 1075 }
de533ccf 1076 return 0;
8a4b275f
HV		 1077}
1078
Linux kernel - Deliverables
This page took 0.11275 seconds and 5 git commands to generate.