aboutsummaryrefslogtreecommitdiffstats
path: root/drivers/media/video/msp3400-kthreads.c
diff options
context:
space:
mode:
Diffstat (limited to 'drivers/media/video/msp3400-kthreads.c')
-rw-r--r--drivers/media/video/msp3400-kthreads.c330
1 files changed, 163 insertions, 167 deletions
diff --git a/drivers/media/video/msp3400-kthreads.c b/drivers/media/video/msp3400-kthreads.c
index 3235a15db59f..c4668f4b6e5c 100644
--- a/drivers/media/video/msp3400-kthreads.c
+++ b/drivers/media/video/msp3400-kthreads.c
@@ -109,7 +109,7 @@ static struct msp3400c_init_data_dem {
109 {-2, -8, -10, 10, 50, 86}, 109 {-2, -8, -10, 10, 50, 86},
110 {-4, -12, -9, 23, 79, 126}, 110 {-4, -12, -9, 23, 79, 126},
111 MSP_CARRIER(6.5), MSP_CARRIER(6.5), 111 MSP_CARRIER(6.5), MSP_CARRIER(6.5),
112 0x00c6, 0x0140, 0x0120, 0x7c03 112 0x00c6, 0x0140, 0x0120, 0x7c00
113 }, 113 },
114}; 114};
115 115
@@ -154,53 +154,60 @@ const char *msp_standard_std_name(int std)
154 return "unknown"; 154 return "unknown";
155} 155}
156 156
157void msp3400c_setcarrier(struct i2c_client *client, int cdo1, int cdo2) 157void msp_set_source(struct i2c_client *client, u16 src)
158{
159 struct msp_state *state = i2c_get_clientdata(client);
160
161 if (msp_dolby) {
162 msp_write_dsp(client, 0x0008, 0x0520); /* I2S1 */
163 msp_write_dsp(client, 0x0009, 0x0620); /* I2S2 */
164 } else {
165 msp_write_dsp(client, 0x0008, src);
166 msp_write_dsp(client, 0x0009, src);
167 }
168 msp_write_dsp(client, 0x000a, src);
169 msp_write_dsp(client, 0x000b, src);
170 msp_write_dsp(client, 0x000c, src);
171 if (state->has_scart23_in_scart2_out)
172 msp_write_dsp(client, 0x0041, src);
173}
174
175void msp3400c_set_carrier(struct i2c_client *client, int cdo1, int cdo2)
158{ 176{
159 msp_write_dem(client, 0x0093, cdo1 & 0xfff); 177 msp_write_dem(client, 0x0093, cdo1 & 0xfff);
160 msp_write_dem(client, 0x009b, cdo1 >> 12); 178 msp_write_dem(client, 0x009b, cdo1 >> 12);
161 msp_write_dem(client, 0x00a3, cdo2 & 0xfff); 179 msp_write_dem(client, 0x00a3, cdo2 & 0xfff);
162 msp_write_dem(client, 0x00ab, cdo2 >> 12); 180 msp_write_dem(client, 0x00ab, cdo2 >> 12);
163 msp_write_dem(client, 0x0056, 0); /*LOAD_REG_1/2*/ 181 msp_write_dem(client, 0x0056, 0); /* LOAD_REG_1/2 */
164} 182}
165 183
166void msp3400c_setmode(struct i2c_client *client, int type) 184void msp3400c_set_mode(struct i2c_client *client, int mode)
167{ 185{
168 struct msp_state *state = i2c_get_clientdata(client); 186 struct msp_state *state = i2c_get_clientdata(client);
187 struct msp3400c_init_data_dem *data = &msp3400c_init_data[mode];
169 int i; 188 int i;
170 189
171 v4l_dbg(1, msp_debug, client, "setmode: %d\n", type); 190 v4l_dbg(1, msp_debug, client, "set_mode: %d\n", mode);
172 state->mode = type; 191 state->mode = mode;
173 state->rxsubchans = V4L2_TUNER_SUB_MONO; 192 state->rxsubchans = V4L2_TUNER_SUB_MONO;
174 193
175 msp_write_dem(client, 0x00bb, msp3400c_init_data[type].ad_cv); 194 msp_write_dem(client, 0x00bb, data->ad_cv);
176 195
177 for (i = 5; i >= 0; i--) /* fir 1 */ 196 for (i = 5; i >= 0; i--) /* fir 1 */
178 msp_write_dem(client, 0x0001, msp3400c_init_data[type].fir1[i]); 197 msp_write_dem(client, 0x0001, data->fir1[i]);
179 198
180 msp_write_dem(client, 0x0005, 0x0004); /* fir 2 */ 199 msp_write_dem(client, 0x0005, 0x0004); /* fir 2 */
181 msp_write_dem(client, 0x0005, 0x0040); 200 msp_write_dem(client, 0x0005, 0x0040);
182 msp_write_dem(client, 0x0005, 0x0000); 201 msp_write_dem(client, 0x0005, 0x0000);
183 for (i = 5; i >= 0; i--) 202 for (i = 5; i >= 0; i--)
184 msp_write_dem(client, 0x0005, msp3400c_init_data[type].fir2[i]); 203 msp_write_dem(client, 0x0005, data->fir2[i]);
185 204
186 msp_write_dem(client, 0x0083, msp3400c_init_data[type].mode_reg); 205 msp_write_dem(client, 0x0083, data->mode_reg);
187 206
188 msp3400c_setcarrier(client, msp3400c_init_data[type].cdo1, 207 msp3400c_set_carrier(client, data->cdo1, data->cdo2);
189 msp3400c_init_data[type].cdo2);
190 208
191 msp_write_dem(client, 0x0056, 0); /*LOAD_REG_1/2*/ 209 msp_set_source(client, data->dsp_src);
192 210 msp_write_dsp(client, 0x000e, data->dsp_matrix);
193 if (msp_dolby) {
194 msp_write_dsp(client, 0x0008, 0x0520); /* I2S1 */
195 msp_write_dsp(client, 0x0009, 0x0620); /* I2S2 */
196 msp_write_dsp(client, 0x000b, msp3400c_init_data[type].dsp_src);
197 } else {
198 msp_write_dsp(client, 0x0008, msp3400c_init_data[type].dsp_src);
199 msp_write_dsp(client, 0x0009, msp3400c_init_data[type].dsp_src);
200 msp_write_dsp(client, 0x000b, msp3400c_init_data[type].dsp_src);
201 }
202 msp_write_dsp(client, 0x000a, msp3400c_init_data[type].dsp_src);
203 msp_write_dsp(client, 0x000e, msp3400c_init_data[type].dsp_matrix);
204 211
205 if (state->has_nicam) { 212 if (state->has_nicam) {
206 /* nicam prescale */ 213 /* nicam prescale */
@@ -208,29 +215,31 @@ void msp3400c_setmode(struct i2c_client *client, int type)
208 } 215 }
209} 216}
210 217
211/* turn on/off nicam + stereo */ 218/* Set audio mode. Note that the pre-'G' models do not support BTSC+SAP,
212void msp3400c_setstereo(struct i2c_client *client, int audmode) 219 nor do they support stereo BTSC. */
220void msp3400c_set_audmode(struct i2c_client *client)
213{ 221{
214 static char *strmode[] = { "mono", "stereo", "lang2", "lang1" }; 222 static char *strmode[] = { "mono", "stereo", "lang2", "lang1" };
215 struct msp_state *state = i2c_get_clientdata(client); 223 struct msp_state *state = i2c_get_clientdata(client);
216 int nicam = 0; /* channel source: FM/AM or nicam */ 224 char *modestr = (state->audmode >= 0 && state->audmode < 4) ?
217 int src = 0; 225 strmode[state->audmode] : "unknown";
226 int src = 0; /* channel source: FM/AM, nicam or SCART */
218 227
219 if (state->opmode == OPMODE_AUTOSELECT) { 228 if (state->opmode == OPMODE_AUTOSELECT) {
220 /* this method would break everything, let's make sure 229 /* this method would break everything, let's make sure
221 * it's never called 230 * it's never called
222 */ 231 */
223 v4l_dbg(1, msp_debug, client, "setstereo called with mode=%d instead of set_source (ignored)\n", 232 v4l_dbg(1, msp_debug, client,
224 audmode); 233 "set_audmode called with mode=%d instead of set_source (ignored)\n",
234 state->audmode);
225 return; 235 return;
226 } 236 }
227 237
228 /* switch demodulator */ 238 /* switch demodulator */
229 switch (state->mode) { 239 switch (state->mode) {
230 case MSP_MODE_FM_TERRA: 240 case MSP_MODE_FM_TERRA:
231 v4l_dbg(1, msp_debug, client, "FM setstereo: %s\n", strmode[audmode]); 241 v4l_dbg(1, msp_debug, client, "FM set_audmode: %s\n", modestr);
232 msp3400c_setcarrier(client, state->second, state->main); 242 switch (state->audmode) {
233 switch (audmode) {
234 case V4L2_TUNER_MODE_STEREO: 243 case V4L2_TUNER_MODE_STEREO:
235 msp_write_dsp(client, 0x000e, 0x3001); 244 msp_write_dsp(client, 0x000e, 0x3001);
236 break; 245 break;
@@ -242,50 +251,49 @@ void msp3400c_setstereo(struct i2c_client *client, int audmode)
242 } 251 }
243 break; 252 break;
244 case MSP_MODE_FM_SAT: 253 case MSP_MODE_FM_SAT:
245 v4l_dbg(1, msp_debug, client, "SAT setstereo: %s\n", strmode[audmode]); 254 v4l_dbg(1, msp_debug, client, "SAT set_audmode: %s\n", modestr);
246 switch (audmode) { 255 switch (state->audmode) {
247 case V4L2_TUNER_MODE_MONO: 256 case V4L2_TUNER_MODE_MONO:
248 msp3400c_setcarrier(client, MSP_CARRIER(6.5), MSP_CARRIER(6.5)); 257 msp3400c_set_carrier(client, MSP_CARRIER(6.5), MSP_CARRIER(6.5));
249 break; 258 break;
250 case V4L2_TUNER_MODE_STEREO: 259 case V4L2_TUNER_MODE_STEREO:
251 msp3400c_setcarrier(client, MSP_CARRIER(7.2), MSP_CARRIER(7.02)); 260 msp3400c_set_carrier(client, MSP_CARRIER(7.2), MSP_CARRIER(7.02));
252 break; 261 break;
253 case V4L2_TUNER_MODE_LANG1: 262 case V4L2_TUNER_MODE_LANG1:
254 msp3400c_setcarrier(client, MSP_CARRIER(7.38), MSP_CARRIER(7.02)); 263 msp3400c_set_carrier(client, MSP_CARRIER(7.38), MSP_CARRIER(7.02));
255 break; 264 break;
256 case V4L2_TUNER_MODE_LANG2: 265 case V4L2_TUNER_MODE_LANG2:
257 msp3400c_setcarrier(client, MSP_CARRIER(7.38), MSP_CARRIER(7.02)); 266 msp3400c_set_carrier(client, MSP_CARRIER(7.38), MSP_CARRIER(7.02));
258 break; 267 break;
259 } 268 }
260 break; 269 break;
261 case MSP_MODE_FM_NICAM1: 270 case MSP_MODE_FM_NICAM1:
262 case MSP_MODE_FM_NICAM2: 271 case MSP_MODE_FM_NICAM2:
263 case MSP_MODE_AM_NICAM: 272 case MSP_MODE_AM_NICAM:
264 v4l_dbg(1, msp_debug, client, "NICAM setstereo: %s\n",strmode[audmode]); 273 v4l_dbg(1, msp_debug, client, "NICAM set_audmode: %s\n",modestr);
265 msp3400c_setcarrier(client,state->second,state->main); 274 msp3400c_set_carrier(client, state->second, state->main);
266 if (state->nicam_on) 275 if (state->nicam_on)
267 nicam=0x0100; 276 src = 0x0100; /* NICAM */
268 break; 277 break;
269 case MSP_MODE_BTSC: 278 case MSP_MODE_BTSC:
270 v4l_dbg(1, msp_debug, client, "BTSC setstereo: %s\n",strmode[audmode]); 279 v4l_dbg(1, msp_debug, client, "BTSC set_audmode: %s\n",modestr);
271 nicam=0x0300;
272 break; 280 break;
273 case MSP_MODE_EXTERN: 281 case MSP_MODE_EXTERN:
274 v4l_dbg(1, msp_debug, client, "extern setstereo: %s\n",strmode[audmode]); 282 v4l_dbg(1, msp_debug, client, "extern set_audmode: %s\n",modestr);
275 nicam = 0x0200; 283 src = 0x0200; /* SCART */
276 break; 284 break;
277 case MSP_MODE_FM_RADIO: 285 case MSP_MODE_FM_RADIO:
278 v4l_dbg(1, msp_debug, client, "FM-Radio setstereo: %s\n",strmode[audmode]); 286 v4l_dbg(1, msp_debug, client, "FM-Radio set_audmode: %s\n",modestr);
279 break; 287 break;
280 default: 288 default:
281 v4l_dbg(1, msp_debug, client, "mono setstereo\n"); 289 v4l_dbg(1, msp_debug, client, "mono set_audmode\n");
282 return; 290 return;
283 } 291 }
284 292
285 /* switch audio */ 293 /* switch audio */
286 switch (audmode) { 294 switch (state->audmode) {
287 case V4L2_TUNER_MODE_STEREO: 295 case V4L2_TUNER_MODE_STEREO:
288 src = 0x0020 | nicam; 296 src |= 0x0020;
289 break; 297 break;
290 case V4L2_TUNER_MODE_MONO: 298 case V4L2_TUNER_MODE_MONO:
291 if (state->mode == MSP_MODE_AM_NICAM) { 299 if (state->mode == MSP_MODE_AM_NICAM) {
@@ -296,29 +304,22 @@ void msp3400c_setstereo(struct i2c_client *client, int audmode)
296 src = 0x0200; 304 src = 0x0200;
297 break; 305 break;
298 } 306 }
307 if (state->rxsubchans & V4L2_TUNER_SUB_STEREO)
308 src = 0x0030;
309 break;
299 case V4L2_TUNER_MODE_LANG1: 310 case V4L2_TUNER_MODE_LANG1:
300 src = 0x0000 | nicam; 311 /* switch to stereo for stereo transmission, otherwise
312 keep first language */
313 if (state->rxsubchans & V4L2_TUNER_SUB_STEREO)
314 src |= 0x0020;
301 break; 315 break;
302 case V4L2_TUNER_MODE_LANG2: 316 case V4L2_TUNER_MODE_LANG2:
303 src = 0x0010 | nicam; 317 src |= 0x0010;
304 break; 318 break;
305 } 319 }
306 v4l_dbg(1, msp_debug, client, "setstereo final source/matrix = 0x%x\n", src); 320 v4l_dbg(1, msp_debug, client, "set_audmode final source/matrix = 0x%x\n", src);
307 321
308 if (msp_dolby) { 322 msp_set_source(client, src);
309 msp_write_dsp(client, 0x0008, 0x0520);
310 msp_write_dsp(client, 0x0009, 0x0620);
311 msp_write_dsp(client, 0x000a, src);
312 msp_write_dsp(client, 0x000b, src);
313 } else {
314 msp_write_dsp(client, 0x0008, src);
315 msp_write_dsp(client, 0x0009, src);
316 msp_write_dsp(client, 0x000a, src);
317 msp_write_dsp(client, 0x000b, src);
318 msp_write_dsp(client, 0x000c, src);
319 if (state->has_scart23_in_scart2_out)
320 msp_write_dsp(client, 0x0041, src);
321 }
322} 323}
323 324
324static void msp3400c_print_mode(struct i2c_client *client) 325static void msp3400c_print_mode(struct i2c_client *client)
@@ -346,12 +347,12 @@ static void msp3400c_print_mode(struct i2c_client *client)
346 347
347/* ----------------------------------------------------------------------- */ 348/* ----------------------------------------------------------------------- */
348 349
349int autodetect_stereo(struct i2c_client *client) 350static int msp3400c_detect_stereo(struct i2c_client *client)
350{ 351{
351 struct msp_state *state = i2c_get_clientdata(client); 352 struct msp_state *state = i2c_get_clientdata(client);
352 int val; 353 int val;
353 int rxsubchans = state->rxsubchans; 354 int rxsubchans = state->rxsubchans;
354 int newnicam = state->nicam_on; 355 int newnicam = state->nicam_on;
355 int update = 0; 356 int update = 0;
356 357
357 switch (state->mode) { 358 switch (state->mode) {
@@ -361,7 +362,7 @@ int autodetect_stereo(struct i2c_client *client)
361 val -= 65536; 362 val -= 65536;
362 v4l_dbg(2, msp_debug, client, "stereo detect register: %d\n", val); 363 v4l_dbg(2, msp_debug, client, "stereo detect register: %d\n", val);
363 if (val > 4096) { 364 if (val > 4096) {
364 rxsubchans = V4L2_TUNER_SUB_STEREO | V4L2_TUNER_SUB_MONO; 365 rxsubchans = V4L2_TUNER_SUB_STEREO;
365 } else if (val < -4096) { 366 } else if (val < -4096) {
366 rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2; 367 rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
367 } else { 368 } else {
@@ -385,14 +386,11 @@ int autodetect_stereo(struct i2c_client *client)
385 break; 386 break;
386 case 1: 387 case 1:
387 case 9: 388 case 9:
388 rxsubchans = V4L2_TUNER_SUB_MONO 389 rxsubchans = V4L2_TUNER_SUB_MONO;
389 | V4L2_TUNER_SUB_LANG1;
390 break; 390 break;
391 case 2: 391 case 2:
392 case 10: 392 case 10:
393 rxsubchans = V4L2_TUNER_SUB_MONO 393 rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
394 | V4L2_TUNER_SUB_LANG1
395 | V4L2_TUNER_SUB_LANG2;
396 break; 394 break;
397 default: 395 default:
398 rxsubchans = V4L2_TUNER_SUB_MONO; 396 rxsubchans = V4L2_TUNER_SUB_MONO;
@@ -404,30 +402,17 @@ int autodetect_stereo(struct i2c_client *client)
404 rxsubchans = V4L2_TUNER_SUB_MONO; 402 rxsubchans = V4L2_TUNER_SUB_MONO;
405 } 403 }
406 break; 404 break;
407 case MSP_MODE_BTSC:
408 val = msp_read_dem(client, 0x200);
409 v4l_dbg(2, msp_debug, client, "status=0x%x (pri=%s, sec=%s, %s%s%s)\n",
410 val,
411 (val & 0x0002) ? "no" : "yes",
412 (val & 0x0004) ? "no" : "yes",
413 (val & 0x0040) ? "stereo" : "mono",
414 (val & 0x0080) ? ", nicam 2nd mono" : "",
415 (val & 0x0100) ? ", bilingual/SAP" : "");
416 rxsubchans = V4L2_TUNER_SUB_MONO;
417 if (val & 0x0040) rxsubchans |= V4L2_TUNER_SUB_STEREO;
418 if (val & 0x0100) rxsubchans |= V4L2_TUNER_SUB_LANG1;
419 break;
420 } 405 }
421 if (rxsubchans != state->rxsubchans) { 406 if (rxsubchans != state->rxsubchans) {
422 update = 1; 407 update = 1;
423 v4l_dbg(1, msp_debug, client, "watch: rxsubchans %d => %d\n", 408 v4l_dbg(1, msp_debug, client, "watch: rxsubchans %02x => %02x\n",
424 state->rxsubchans,rxsubchans); 409 state->rxsubchans, rxsubchans);
425 state->rxsubchans = rxsubchans; 410 state->rxsubchans = rxsubchans;
426 } 411 }
427 if (newnicam != state->nicam_on) { 412 if (newnicam != state->nicam_on) {
428 update = 1; 413 update = 1;
429 v4l_dbg(1, msp_debug, client, "watch: nicam %d => %d\n", 414 v4l_dbg(1, msp_debug, client, "watch: nicam %d => %d\n",
430 state->nicam_on,newnicam); 415 state->nicam_on, newnicam);
431 state->nicam_on = newnicam; 416 state->nicam_on = newnicam;
432 } 417 }
433 return update; 418 return update;
@@ -442,13 +427,8 @@ static void watch_stereo(struct i2c_client *client)
442{ 427{
443 struct msp_state *state = i2c_get_clientdata(client); 428 struct msp_state *state = i2c_get_clientdata(client);
444 429
445 if (autodetect_stereo(client)) { 430 if (msp3400c_detect_stereo(client)) {
446 if (state->rxsubchans & V4L2_TUNER_SUB_STEREO) 431 msp3400c_set_audmode(client);
447 msp3400c_setstereo(client, V4L2_TUNER_MODE_STEREO);
448 else if (state->rxsubchans & V4L2_TUNER_SUB_LANG1)
449 msp3400c_setstereo(client, V4L2_TUNER_MODE_LANG1);
450 else
451 msp3400c_setstereo(client, V4L2_TUNER_MODE_MONO);
452 } 432 }
453 433
454 if (msp_once) 434 if (msp_once)
@@ -460,7 +440,7 @@ int msp3400c_thread(void *data)
460 struct i2c_client *client = data; 440 struct i2c_client *client = data;
461 struct msp_state *state = i2c_get_clientdata(client); 441 struct msp_state *state = i2c_get_clientdata(client);
462 struct msp3400c_carrier_detect *cd; 442 struct msp3400c_carrier_detect *cd;
463 int count, max1,max2,val1,val2, val,this; 443 int count, max1, max2, val1, val2, val, this;
464 444
465 445
466 v4l_dbg(1, msp_debug, client, "msp3400 daemon started\n"); 446 v4l_dbg(1, msp_debug, client, "msp3400 daemon started\n");
@@ -470,7 +450,7 @@ int msp3400c_thread(void *data)
470 v4l_dbg(2, msp_debug, client, "msp3400 thread: wakeup\n"); 450 v4l_dbg(2, msp_debug, client, "msp3400 thread: wakeup\n");
471 451
472 restart: 452 restart:
473 v4l_dbg(1, msp_debug, client, "thread: restart scan\n"); 453 v4l_dbg(2, msp_debug, client, "thread: restart scan\n");
474 state->restart = 0; 454 state->restart = 0;
475 if (kthread_should_stop()) 455 if (kthread_should_stop())
476 break; 456 break;
@@ -484,13 +464,14 @@ int msp3400c_thread(void *data)
484 464
485 /* mute */ 465 /* mute */
486 msp_set_mute(client); 466 msp_set_mute(client);
487 msp3400c_setmode(client, MSP_MODE_AM_DETECT /* +1 */ ); 467 msp3400c_set_mode(client, MSP_MODE_AM_DETECT /* +1 */ );
488 val1 = val2 = 0; 468 val1 = val2 = 0;
489 max1 = max2 = -1; 469 max1 = max2 = -1;
490 state->watch_stereo = 0; 470 state->watch_stereo = 0;
471 state->nicam_on = 0;
491 472
492 /* some time for the tuner to sync */ 473 /* some time for the tuner to sync */
493 if (msp_sleep(state,200)) 474 if (msp_sleep(state, 200))
494 goto restart; 475 goto restart;
495 476
496 /* carrier detect pass #1 -- main carrier */ 477 /* carrier detect pass #1 -- main carrier */
@@ -505,7 +486,7 @@ int msp3400c_thread(void *data)
505 } 486 }
506 487
507 for (this = 0; this < count; this++) { 488 for (this = 0; this < count; this++) {
508 msp3400c_setcarrier(client, cd[this].cdo,cd[this].cdo); 489 msp3400c_set_carrier(client, cd[this].cdo, cd[this].cdo);
509 if (msp_sleep(state,100)) 490 if (msp_sleep(state,100))
510 goto restart; 491 goto restart;
511 val = msp_read_dsp(client, 0x1b); 492 val = msp_read_dsp(client, 0x1b);
@@ -541,7 +522,7 @@ int msp3400c_thread(void *data)
541 max2 = 0; 522 max2 = 0;
542 } 523 }
543 for (this = 0; this < count; this++) { 524 for (this = 0; this < count; this++) {
544 msp3400c_setcarrier(client, cd[this].cdo,cd[this].cdo); 525 msp3400c_set_carrier(client, cd[this].cdo, cd[this].cdo);
545 if (msp_sleep(state,100)) 526 if (msp_sleep(state,100))
546 goto restart; 527 goto restart;
547 val = msp_read_dsp(client, 0x1b); 528 val = msp_read_dsp(client, 0x1b);
@@ -553,22 +534,20 @@ int msp3400c_thread(void *data)
553 } 534 }
554 535
555 /* program the msp3400 according to the results */ 536 /* program the msp3400 according to the results */
556 state->main = msp3400c_carrier_detect_main[max1].cdo; 537 state->main = msp3400c_carrier_detect_main[max1].cdo;
557 switch (max1) { 538 switch (max1) {
558 case 1: /* 5.5 */ 539 case 1: /* 5.5 */
559 if (max2 == 0) { 540 if (max2 == 0) {
560 /* B/G FM-stereo */ 541 /* B/G FM-stereo */
561 state->second = msp3400c_carrier_detect_55[max2].cdo; 542 state->second = msp3400c_carrier_detect_55[max2].cdo;
562 msp3400c_setmode(client, MSP_MODE_FM_TERRA); 543 msp3400c_set_mode(client, MSP_MODE_FM_TERRA);
563 state->nicam_on = 0;
564 msp3400c_setstereo(client, V4L2_TUNER_MODE_MONO);
565 state->watch_stereo = 1; 544 state->watch_stereo = 1;
566 } else if (max2 == 1 && state->has_nicam) { 545 } else if (max2 == 1 && state->has_nicam) {
567 /* B/G NICAM */ 546 /* B/G NICAM */
568 state->second = msp3400c_carrier_detect_55[max2].cdo; 547 state->second = msp3400c_carrier_detect_55[max2].cdo;
569 msp3400c_setmode(client, MSP_MODE_FM_NICAM1); 548 msp3400c_set_mode(client, MSP_MODE_FM_NICAM1);
549 msp3400c_set_carrier(client, state->second, state->main);
570 state->nicam_on = 1; 550 state->nicam_on = 1;
571 msp3400c_setcarrier(client, state->second, state->main);
572 state->watch_stereo = 1; 551 state->watch_stereo = 1;
573 } else { 552 } else {
574 goto no_second; 553 goto no_second;
@@ -577,35 +556,31 @@ int msp3400c_thread(void *data)
577 case 2: /* 6.0 */ 556 case 2: /* 6.0 */
578 /* PAL I NICAM */ 557 /* PAL I NICAM */
579 state->second = MSP_CARRIER(6.552); 558 state->second = MSP_CARRIER(6.552);
580 msp3400c_setmode(client, MSP_MODE_FM_NICAM2); 559 msp3400c_set_mode(client, MSP_MODE_FM_NICAM2);
560 msp3400c_set_carrier(client, state->second, state->main);
581 state->nicam_on = 1; 561 state->nicam_on = 1;
582 msp3400c_setcarrier(client, state->second, state->main);
583 state->watch_stereo = 1; 562 state->watch_stereo = 1;
584 break; 563 break;
585 case 3: /* 6.5 */ 564 case 3: /* 6.5 */
586 if (max2 == 1 || max2 == 2) { 565 if (max2 == 1 || max2 == 2) {
587 /* D/K FM-stereo */ 566 /* D/K FM-stereo */
588 state->second = msp3400c_carrier_detect_65[max2].cdo; 567 state->second = msp3400c_carrier_detect_65[max2].cdo;
589 msp3400c_setmode(client, MSP_MODE_FM_TERRA); 568 msp3400c_set_mode(client, MSP_MODE_FM_TERRA);
590 state->nicam_on = 0;
591 msp3400c_setstereo(client, V4L2_TUNER_MODE_MONO);
592 state->watch_stereo = 1; 569 state->watch_stereo = 1;
593 } else if (max2 == 0 && (state->v4l2_std & V4L2_STD_SECAM)) { 570 } else if (max2 == 0 && (state->v4l2_std & V4L2_STD_SECAM)) {
594 /* L NICAM or AM-mono */ 571 /* L NICAM or AM-mono */
595 state->second = msp3400c_carrier_detect_65[max2].cdo; 572 state->second = msp3400c_carrier_detect_65[max2].cdo;
596 msp3400c_setmode(client, MSP_MODE_AM_NICAM); 573 msp3400c_set_mode(client, MSP_MODE_AM_NICAM);
597 state->nicam_on = 0; 574 msp3400c_set_carrier(client, state->second, state->main);
598 msp3400c_setstereo(client, V4L2_TUNER_MODE_MONO);
599 msp3400c_setcarrier(client, state->second, state->main);
600 /* volume prescale for SCART (AM mono input) */ 575 /* volume prescale for SCART (AM mono input) */
601 msp_write_dsp(client, 0x000d, 0x1900); 576 msp_write_dsp(client, 0x000d, 0x1900);
602 state->watch_stereo = 1; 577 state->watch_stereo = 1;
603 } else if (max2 == 0 && state->has_nicam) { 578 } else if (max2 == 0 && state->has_nicam) {
604 /* D/K NICAM */ 579 /* D/K NICAM */
605 state->second = msp3400c_carrier_detect_65[max2].cdo; 580 state->second = msp3400c_carrier_detect_65[max2].cdo;
606 msp3400c_setmode(client, MSP_MODE_FM_NICAM1); 581 msp3400c_set_mode(client, MSP_MODE_FM_NICAM1);
582 msp3400c_set_carrier(client, state->second, state->main);
607 state->nicam_on = 1; 583 state->nicam_on = 1;
608 msp3400c_setcarrier(client, state->second, state->main);
609 state->watch_stereo = 1; 584 state->watch_stereo = 1;
610 } else { 585 } else {
611 goto no_second; 586 goto no_second;
@@ -615,23 +590,25 @@ int msp3400c_thread(void *data)
615 default: 590 default:
616 no_second: 591 no_second:
617 state->second = msp3400c_carrier_detect_main[max1].cdo; 592 state->second = msp3400c_carrier_detect_main[max1].cdo;
618 msp3400c_setmode(client, MSP_MODE_FM_TERRA); 593 msp3400c_set_mode(client, MSP_MODE_FM_TERRA);
619 state->nicam_on = 0; 594 msp3400c_set_carrier(client, state->second, state->main);
620 msp3400c_setcarrier(client, state->second, state->main);
621 state->rxsubchans = V4L2_TUNER_SUB_MONO; 595 state->rxsubchans = V4L2_TUNER_SUB_MONO;
622 msp3400c_setstereo(client, V4L2_TUNER_MODE_MONO);
623 break; 596 break;
624 } 597 }
625 598
626 /* unmute */ 599 /* unmute */
627 msp_set_audio(client); 600 msp_set_audio(client);
601 msp3400c_set_audmode(client);
628 602
629 if (msp_debug) 603 if (msp_debug)
630 msp3400c_print_mode(client); 604 msp3400c_print_mode(client);
631 605
632 /* monitor tv audio mode */ 606 /* monitor tv audio mode, the first time don't wait
607 so long to get a quick stereo/bilingual result */
608 if (msp_sleep(state, 1000))
609 goto restart;
633 while (state->watch_stereo) { 610 while (state->watch_stereo) {
634 if (msp_sleep(state,5000)) 611 if (msp_sleep(state, 5000))
635 goto restart; 612 goto restart;
636 watch_stereo(client); 613 watch_stereo(client);
637 } 614 }
@@ -655,7 +632,7 @@ int msp3410d_thread(void *data)
655 v4l_dbg(2, msp_debug, client, "msp3410 thread: wakeup\n"); 632 v4l_dbg(2, msp_debug, client, "msp3410 thread: wakeup\n");
656 633
657 restart: 634 restart:
658 v4l_dbg(1, msp_debug, client, "thread: restart scan\n"); 635 v4l_dbg(2, msp_debug, client, "thread: restart scan\n");
659 state->restart = 0; 636 state->restart = 0;
660 if (kthread_should_stop()) 637 if (kthread_should_stop())
661 break; 638 break;
@@ -680,9 +657,10 @@ int msp3410d_thread(void *data)
680 else 657 else
681 std = (state->v4l2_std & V4L2_STD_NTSC) ? 0x20 : 1; 658 std = (state->v4l2_std & V4L2_STD_NTSC) ? 0x20 : 1;
682 state->watch_stereo = 0; 659 state->watch_stereo = 0;
660 state->nicam_on = 0;
683 661
684 if (msp_debug) 662 if (msp_debug)
685 v4l_dbg(1, msp_debug, client, "setting standard: %s (0x%04x)\n", 663 v4l_dbg(2, msp_debug, client, "setting standard: %s (0x%04x)\n",
686 msp_standard_std_name(std), std); 664 msp_standard_std_name(std), std);
687 665
688 if (std != 1) { 666 if (std != 1) {
@@ -699,7 +677,7 @@ int msp3410d_thread(void *data)
699 val = msp_read_dem(client, 0x7e); 677 val = msp_read_dem(client, 0x7e);
700 if (val < 0x07ff) 678 if (val < 0x07ff)
701 break; 679 break;
702 v4l_dbg(1, msp_debug, client, "detection still in progress\n"); 680 v4l_dbg(2, msp_debug, client, "detection still in progress\n");
703 } 681 }
704 } 682 }
705 for (i = 0; msp_stdlist[i].name != NULL; i++) 683 for (i = 0; msp_stdlist[i].name != NULL; i++)
@@ -738,46 +716,34 @@ int msp3410d_thread(void *data)
738 state->rxsubchans = V4L2_TUNER_SUB_STEREO; 716 state->rxsubchans = V4L2_TUNER_SUB_STEREO;
739 state->nicam_on = 1; 717 state->nicam_on = 1;
740 state->watch_stereo = 1; 718 state->watch_stereo = 1;
741 msp3400c_setstereo(client,V4L2_TUNER_MODE_STEREO);
742 break; 719 break;
743 case 0x0009: 720 case 0x0009:
744 state->mode = MSP_MODE_AM_NICAM; 721 state->mode = MSP_MODE_AM_NICAM;
745 state->rxsubchans = V4L2_TUNER_SUB_MONO; 722 state->rxsubchans = V4L2_TUNER_SUB_MONO;
746 state->nicam_on = 1; 723 state->nicam_on = 1;
747 msp3400c_setstereo(client,V4L2_TUNER_MODE_MONO);
748 state->watch_stereo = 1; 724 state->watch_stereo = 1;
749 break; 725 break;
750 case 0x0020: /* BTSC */ 726 case 0x0020: /* BTSC */
751 /* just turn on stereo */ 727 /* The pre-'G' models only have BTSC-mono */
752 state->mode = MSP_MODE_BTSC; 728 state->mode = MSP_MODE_BTSC;
753 state->rxsubchans = V4L2_TUNER_SUB_STEREO; 729 state->rxsubchans = V4L2_TUNER_SUB_MONO;
754 state->nicam_on = 0;
755 state->watch_stereo = 1;
756 msp3400c_setstereo(client,V4L2_TUNER_MODE_STEREO);
757 break; 730 break;
758 case 0x0040: /* FM radio */ 731 case 0x0040: /* FM radio */
759 state->mode = MSP_MODE_FM_RADIO; 732 state->mode = MSP_MODE_FM_RADIO;
760 state->rxsubchans = V4L2_TUNER_SUB_STEREO; 733 state->rxsubchans = V4L2_TUNER_SUB_STEREO;
761 state->nicam_on = 0;
762 state->watch_stereo = 0;
763 /* not needed in theory if we have radio, but 734 /* not needed in theory if we have radio, but
764 short programming enables carrier mute */ 735 short programming enables carrier mute */
765 msp3400c_setmode(client, MSP_MODE_FM_RADIO); 736 msp3400c_set_mode(client, MSP_MODE_FM_RADIO);
766 msp3400c_setcarrier(client, MSP_CARRIER(10.7), 737 msp3400c_set_carrier(client, MSP_CARRIER(10.7),
767 MSP_CARRIER(10.7)); 738 MSP_CARRIER(10.7));
768 /* scart routing */ 739 /* scart routing (this doesn't belong here I think) */
769 msp_set_scart(client,SCART_IN2,0); 740 msp_set_scart(client,SCART_IN2,0);
770 /* msp34xx does radio decoding */
771 msp_write_dsp(client, 0x08, 0x0020);
772 msp_write_dsp(client, 0x09, 0x0020);
773 msp_write_dsp(client, 0x0b, 0x0020);
774 break; 741 break;
775 case 0x0003: 742 case 0x0003:
776 case 0x0004: 743 case 0x0004:
777 case 0x0005: 744 case 0x0005:
778 state->mode = MSP_MODE_FM_TERRA; 745 state->mode = MSP_MODE_FM_TERRA;
779 state->rxsubchans = V4L2_TUNER_SUB_MONO; 746 state->rxsubchans = V4L2_TUNER_SUB_MONO;
780 state->nicam_on = 0;
781 state->watch_stereo = 1; 747 state->watch_stereo = 1;
782 break; 748 break;
783 } 749 }
@@ -788,11 +754,16 @@ int msp3410d_thread(void *data)
788 if (state->has_i2s_conf) 754 if (state->has_i2s_conf)
789 msp_write_dem(client, 0x40, state->i2s_mode); 755 msp_write_dem(client, 0x40, state->i2s_mode);
790 756
791 /* monitor tv audio mode */ 757 msp3400c_set_audmode(client);
758
759 /* monitor tv audio mode, the first time don't wait
760 so long to get a quick stereo/bilingual result */
761 if (msp_sleep(state, 1000))
762 goto restart;
792 while (state->watch_stereo) { 763 while (state->watch_stereo) {
793 if (msp_sleep(state,5000))
794 goto restart;
795 watch_stereo(client); 764 watch_stereo(client);
765 if (msp_sleep(state, 5000))
766 goto restart;
796 } 767 }
797 } 768 }
798 v4l_dbg(1, msp_debug, client, "thread: exit\n"); 769 v4l_dbg(1, msp_debug, client, "thread: exit\n");
@@ -810,7 +781,7 @@ int msp3410d_thread(void *data)
810 * the value for source is the same as bit 15:8 of DSP registers 0x08, 781 * the value for source is the same as bit 15:8 of DSP registers 0x08,
811 * 0x0a and 0x0c: 0=mono, 1=stereo or A|B, 2=SCART, 3=stereo or A, 4=stereo or B 782 * 0x0a and 0x0c: 0=mono, 1=stereo or A|B, 2=SCART, 3=stereo or A, 4=stereo or B
812 * 783 *
813 * this function replaces msp3400c_setstereo 784 * this function replaces msp3400c_set_audmode
814 */ 785 */
815static void msp34xxg_set_source(struct i2c_client *client, int source) 786static void msp34xxg_set_source(struct i2c_client *client, int source)
816{ 787{
@@ -823,12 +794,7 @@ static void msp34xxg_set_source(struct i2c_client *client, int source)
823 int value = (source & 0x07) << 8 | (source == 0 ? 0x30 : 0x20); 794 int value = (source & 0x07) << 8 | (source == 0 ? 0x30 : 0x20);
824 795
825 v4l_dbg(1, msp_debug, client, "set source to %d (0x%x)\n", source, value); 796 v4l_dbg(1, msp_debug, client, "set source to %d (0x%x)\n", source, value);
826 /* Loudspeaker Output */ 797 msp_set_source(client, value);
827 msp_write_dsp(client, 0x08, value);
828 /* SCART1 DA Output */
829 msp_write_dsp(client, 0x0a, value);
830 /* Quasi-peak detector */
831 msp_write_dsp(client, 0x0c, value);
832 /* 798 /*
833 * set identification threshold. Personally, I 799 * set identification threshold. Personally, I
834 * I set it to a higher value that the default 800 * I set it to a higher value that the default
@@ -945,13 +911,14 @@ int msp34xxg_thread(void *data)
945 if (msp_write_dsp(client, 0x13, state->acb)) 911 if (msp_write_dsp(client, 0x13, state->acb))
946 return -1; 912 return -1;
947 913
948 msp_write_dem(client, 0x40, state->i2s_mode); 914 if (state->has_i2s_conf)
915 msp_write_dem(client, 0x40, state->i2s_mode);
949 } 916 }
950 v4l_dbg(1, msp_debug, client, "thread: exit\n"); 917 v4l_dbg(1, msp_debug, client, "thread: exit\n");
951 return 0; 918 return 0;
952} 919}
953 920
954void msp34xxg_detect_stereo(struct i2c_client *client) 921static void msp34xxg_detect_stereo(struct i2c_client *client)
955{ 922{
956 struct msp_state *state = i2c_get_clientdata(client); 923 struct msp_state *state = i2c_get_clientdata(client);
957 924
@@ -961,11 +928,11 @@ void msp34xxg_detect_stereo(struct i2c_client *client)
961 928
962 state->rxsubchans = 0; 929 state->rxsubchans = 0;
963 if (is_stereo) 930 if (is_stereo)
964 state->rxsubchans |= V4L2_TUNER_SUB_STEREO; 931 state->rxsubchans = V4L2_TUNER_SUB_STEREO;
965 else 932 else
966 state->rxsubchans |= V4L2_TUNER_SUB_MONO; 933 state->rxsubchans = V4L2_TUNER_SUB_MONO;
967 if (is_bilingual) { 934 if (is_bilingual) {
968 state->rxsubchans |= V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2; 935 state->rxsubchans = V4L2_TUNER_SUB_LANG1 | V4L2_TUNER_SUB_LANG2;
969 /* I'm supposed to check whether it's SAP or not 936 /* I'm supposed to check whether it's SAP or not
970 * and set only LANG2/SAP in this case. Yet, the MSP 937 * and set only LANG2/SAP in this case. Yet, the MSP
971 * does a lot of work to hide this and handle everything 938 * does a lot of work to hide this and handle everything
@@ -977,12 +944,12 @@ void msp34xxg_detect_stereo(struct i2c_client *client)
977 status, is_stereo, is_bilingual, state->rxsubchans); 944 status, is_stereo, is_bilingual, state->rxsubchans);
978} 945}
979 946
980void msp34xxg_set_audmode(struct i2c_client *client, int audmode) 947void msp34xxg_set_audmode(struct i2c_client *client)
981{ 948{
982 struct msp_state *state = i2c_get_clientdata(client); 949 struct msp_state *state = i2c_get_clientdata(client);
983 int source; 950 int source;
984 951
985 switch (audmode) { 952 switch (state->audmode) {
986 case V4L2_TUNER_MODE_MONO: 953 case V4L2_TUNER_MODE_MONO:
987 source = 0; /* mono only */ 954 source = 0; /* mono only */
988 break; 955 break;
@@ -997,11 +964,40 @@ void msp34xxg_set_audmode(struct i2c_client *client, int audmode)
997 source = 4; /* stereo or B */ 964 source = 4; /* stereo or B */
998 break; 965 break;
999 default: 966 default:
1000 audmode = 0;
1001 source = 1; 967 source = 1;
1002 break; 968 break;
1003 } 969 }
1004 state->audmode = audmode;
1005 msp34xxg_set_source(client, source); 970 msp34xxg_set_source(client, source);
1006} 971}
1007 972
973void msp_set_audmode(struct i2c_client *client)
974{
975 struct msp_state *state = i2c_get_clientdata(client);
976
977 switch (state->opmode) {
978 case OPMODE_MANUAL:
979 case OPMODE_AUTODETECT:
980 state->watch_stereo = 0;
981 msp3400c_set_audmode(client);
982 break;
983 case OPMODE_AUTOSELECT:
984 msp34xxg_set_audmode(client);
985 break;
986 }
987}
988
989void msp_detect_stereo(struct i2c_client *client)
990{
991 struct msp_state *state = i2c_get_clientdata(client);
992
993 switch (state->opmode) {
994 case OPMODE_MANUAL:
995 case OPMODE_AUTODETECT:
996 msp3400c_detect_stereo(client);
997 break;
998 case OPMODE_AUTOSELECT:
999 msp34xxg_detect_stereo(client);
1000 break;
1001 }
1002}
1003
generated by cgit v1.2.2 (git 2.25.0) at 2024-12-26 12:04:30 -0500