treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / media / tuners / tuner-simple.c
blobb6e70fada3fb204ec0a7e09a89c9ea937cecc890
1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * i2c tv tuner chip device driver
4 * controls all those simple 4-control-bytes style tuners.
6 * This "tuner-simple" module was split apart from the original "tuner" module.
7 */
8 #include <linux/delay.h>
9 #include <linux/i2c.h>
10 #include <linux/videodev2.h>
11 #include <media/tuner.h>
12 #include <media/v4l2-common.h>
13 #include <media/tuner-types.h>
14 #include "tuner-i2c.h"
15 #include "tuner-simple.h"
17 static int debug;
18 module_param(debug, int, 0644);
19 MODULE_PARM_DESC(debug, "enable verbose debug messages");
21 #define TUNER_SIMPLE_MAX 64
22 static unsigned int simple_devcount;
24 static int offset;
25 module_param(offset, int, 0664);
26 MODULE_PARM_DESC(offset, "Allows to specify an offset for tuner");
28 static unsigned int atv_input[TUNER_SIMPLE_MAX] = \
29 { [0 ... (TUNER_SIMPLE_MAX-1)] = 0 };
30 static unsigned int dtv_input[TUNER_SIMPLE_MAX] = \
31 { [0 ... (TUNER_SIMPLE_MAX-1)] = 0 };
32 module_param_array(atv_input, int, NULL, 0644);
33 module_param_array(dtv_input, int, NULL, 0644);
34 MODULE_PARM_DESC(atv_input, "specify atv rf input, 0 for autoselect");
35 MODULE_PARM_DESC(dtv_input, "specify dtv rf input, 0 for autoselect");
37 /* ---------------------------------------------------------------------- */
39 /* tv standard selection for Temic 4046 FM5
40 this value takes the low bits of control byte 2
41 from datasheet Rev.01, Feb.00
42 standard BG I L L2 D
43 picture IF 38.9 38.9 38.9 33.95 38.9
44 sound 1 33.4 32.9 32.4 40.45 32.4
45 sound 2 33.16
46 NICAM 33.05 32.348 33.05 33.05
48 #define TEMIC_SET_PAL_I 0x05
49 #define TEMIC_SET_PAL_DK 0x09
50 #define TEMIC_SET_PAL_L 0x0a /* SECAM ? */
51 #define TEMIC_SET_PAL_L2 0x0b /* change IF ! */
52 #define TEMIC_SET_PAL_BG 0x0c
54 /* tv tuner system standard selection for Philips FQ1216ME
55 this value takes the low bits of control byte 2
56 from datasheet "1999 Nov 16" (supersedes "1999 Mar 23")
57 standard BG DK I L L`
58 picture carrier 38.90 38.90 38.90 38.90 33.95
59 colour 34.47 34.47 34.47 34.47 38.38
60 sound 1 33.40 32.40 32.90 32.40 40.45
61 sound 2 33.16 - - - -
62 NICAM 33.05 33.05 32.35 33.05 39.80
64 #define PHILIPS_SET_PAL_I 0x01 /* Bit 2 always zero !*/
65 #define PHILIPS_SET_PAL_BGDK 0x09
66 #define PHILIPS_SET_PAL_L2 0x0a
67 #define PHILIPS_SET_PAL_L 0x0b
69 /* system switching for Philips FI1216MF MK2
70 from datasheet "1996 Jul 09",
71 standard BG L L'
72 picture carrier 38.90 38.90 33.95
73 colour 34.47 34.37 38.38
74 sound 1 33.40 32.40 40.45
75 sound 2 33.16 - -
76 NICAM 33.05 33.05 39.80
78 #define PHILIPS_MF_SET_STD_BG 0x01 /* Bit 2 must be zero, Bit 3 is system output */
79 #define PHILIPS_MF_SET_STD_L 0x03 /* Used on Secam France */
80 #define PHILIPS_MF_SET_STD_LC 0x02 /* Used on SECAM L' */
82 /* Control byte */
84 #define TUNER_RATIO_MASK 0x06 /* Bit cb1:cb2 */
85 #define TUNER_RATIO_SELECT_50 0x00
86 #define TUNER_RATIO_SELECT_32 0x02
87 #define TUNER_RATIO_SELECT_166 0x04
88 #define TUNER_RATIO_SELECT_62 0x06
90 #define TUNER_CHARGE_PUMP 0x40 /* Bit cb6 */
92 /* Status byte */
94 #define TUNER_POR 0x80
95 #define TUNER_FL 0x40
96 #define TUNER_MODE 0x38
97 #define TUNER_AFC 0x07
98 #define TUNER_SIGNAL 0x07
99 #define TUNER_STEREO 0x10
101 #define TUNER_PLL_LOCKED 0x40
102 #define TUNER_STEREO_MK3 0x04
104 static DEFINE_MUTEX(tuner_simple_list_mutex);
105 static LIST_HEAD(hybrid_tuner_instance_list);
107 struct tuner_simple_priv {
108 unsigned int nr;
109 u16 last_div;
111 struct tuner_i2c_props i2c_props;
112 struct list_head hybrid_tuner_instance_list;
114 unsigned int type;
115 struct tunertype *tun;
117 u32 frequency;
118 u32 bandwidth;
119 bool radio_mode;
122 /* ---------------------------------------------------------------------- */
124 static int tuner_read_status(struct dvb_frontend *fe)
126 struct tuner_simple_priv *priv = fe->tuner_priv;
127 unsigned char byte;
129 if (1 != tuner_i2c_xfer_recv(&priv->i2c_props, &byte, 1))
130 return 0;
132 return byte;
135 static inline int tuner_signal(const int status)
137 return (status & TUNER_SIGNAL) << 13;
140 static inline int tuner_stereo(const int type, const int status)
142 switch (type) {
143 case TUNER_PHILIPS_FM1216ME_MK3:
144 case TUNER_PHILIPS_FM1236_MK3:
145 case TUNER_PHILIPS_FM1256_IH3:
146 case TUNER_LG_NTSC_TAPE:
147 case TUNER_TCL_MF02GIP_5N:
148 return ((status & TUNER_SIGNAL) == TUNER_STEREO_MK3);
149 case TUNER_PHILIPS_FM1216MK5:
150 return status | TUNER_STEREO;
151 default:
152 return status & TUNER_STEREO;
156 static inline int tuner_islocked(const int status)
158 return (status & TUNER_FL);
161 static inline int tuner_afcstatus(const int status)
163 return (status & TUNER_AFC) - 2;
167 static int simple_get_status(struct dvb_frontend *fe, u32 *status)
169 struct tuner_simple_priv *priv = fe->tuner_priv;
170 int tuner_status;
172 if (priv->i2c_props.adap == NULL)
173 return -EINVAL;
175 tuner_status = tuner_read_status(fe);
177 *status = 0;
179 if (tuner_islocked(tuner_status))
180 *status = TUNER_STATUS_LOCKED;
181 if (tuner_stereo(priv->type, tuner_status))
182 *status |= TUNER_STATUS_STEREO;
184 tuner_dbg("AFC Status: %d\n", tuner_afcstatus(tuner_status));
186 return 0;
189 static int simple_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
191 struct tuner_simple_priv *priv = fe->tuner_priv;
192 int signal;
194 if (priv->i2c_props.adap == NULL || !priv->radio_mode)
195 return -EINVAL;
197 signal = tuner_signal(tuner_read_status(fe));
199 *strength = signal;
201 tuner_dbg("Signal strength: %d\n", signal);
203 return 0;
206 /* ---------------------------------------------------------------------- */
208 static inline char *tuner_param_name(enum param_type type)
210 char *name;
212 switch (type) {
213 case TUNER_PARAM_TYPE_RADIO:
214 name = "radio";
215 break;
216 case TUNER_PARAM_TYPE_PAL:
217 name = "pal";
218 break;
219 case TUNER_PARAM_TYPE_SECAM:
220 name = "secam";
221 break;
222 case TUNER_PARAM_TYPE_NTSC:
223 name = "ntsc";
224 break;
225 case TUNER_PARAM_TYPE_DIGITAL:
226 name = "digital";
227 break;
228 default:
229 name = "unknown";
230 break;
232 return name;
235 static struct tuner_params *simple_tuner_params(struct dvb_frontend *fe,
236 enum param_type desired_type)
238 struct tuner_simple_priv *priv = fe->tuner_priv;
239 struct tunertype *tun = priv->tun;
240 int i;
242 for (i = 0; i < tun->count; i++)
243 if (desired_type == tun->params[i].type)
244 break;
246 /* use default tuner params if desired_type not available */
247 if (i == tun->count) {
248 tuner_dbg("desired params (%s) undefined for tuner %d\n",
249 tuner_param_name(desired_type), priv->type);
250 i = 0;
253 tuner_dbg("using tuner params #%d (%s)\n", i,
254 tuner_param_name(tun->params[i].type));
256 return &tun->params[i];
259 static int simple_config_lookup(struct dvb_frontend *fe,
260 struct tuner_params *t_params,
261 unsigned *frequency, u8 *config, u8 *cb)
263 struct tuner_simple_priv *priv = fe->tuner_priv;
264 int i;
266 for (i = 0; i < t_params->count; i++) {
267 if (*frequency > t_params->ranges[i].limit)
268 continue;
269 break;
271 if (i == t_params->count) {
272 tuner_dbg("frequency out of range (%d > %d)\n",
273 *frequency, t_params->ranges[i - 1].limit);
274 *frequency = t_params->ranges[--i].limit;
276 *config = t_params->ranges[i].config;
277 *cb = t_params->ranges[i].cb;
279 tuner_dbg("freq = %d.%02d (%d), range = %d, config = 0x%02x, cb = 0x%02x\n",
280 *frequency / 16, *frequency % 16 * 100 / 16, *frequency,
281 i, *config, *cb);
283 return i;
286 /* ---------------------------------------------------------------------- */
288 static void simple_set_rf_input(struct dvb_frontend *fe,
289 u8 *config, u8 *cb, unsigned int rf)
291 struct tuner_simple_priv *priv = fe->tuner_priv;
293 switch (priv->type) {
294 case TUNER_PHILIPS_TUV1236D:
295 switch (rf) {
296 case 1:
297 *cb |= 0x08;
298 break;
299 default:
300 *cb &= ~0x08;
301 break;
303 break;
304 case TUNER_PHILIPS_FCV1236D:
305 switch (rf) {
306 case 1:
307 *cb |= 0x01;
308 break;
309 default:
310 *cb &= ~0x01;
311 break;
313 break;
314 default:
315 break;
319 static int simple_std_setup(struct dvb_frontend *fe,
320 struct analog_parameters *params,
321 u8 *config, u8 *cb)
323 struct tuner_simple_priv *priv = fe->tuner_priv;
324 int rc;
326 /* tv norm specific stuff for multi-norm tuners */
327 switch (priv->type) {
328 case TUNER_PHILIPS_SECAM: /* FI1216MF */
329 /* 0x01 -> ??? no change ??? */
330 /* 0x02 -> PAL BDGHI / SECAM L */
331 /* 0x04 -> ??? PAL others / SECAM others ??? */
332 *cb &= ~0x03;
333 if (params->std & V4L2_STD_SECAM_L)
334 /* also valid for V4L2_STD_SECAM */
335 *cb |= PHILIPS_MF_SET_STD_L;
336 else if (params->std & V4L2_STD_SECAM_LC)
337 *cb |= PHILIPS_MF_SET_STD_LC;
338 else /* V4L2_STD_B|V4L2_STD_GH */
339 *cb |= PHILIPS_MF_SET_STD_BG;
340 break;
342 case TUNER_TEMIC_4046FM5:
343 *cb &= ~0x0f;
345 if (params->std & V4L2_STD_PAL_BG) {
346 *cb |= TEMIC_SET_PAL_BG;
348 } else if (params->std & V4L2_STD_PAL_I) {
349 *cb |= TEMIC_SET_PAL_I;
351 } else if (params->std & V4L2_STD_PAL_DK) {
352 *cb |= TEMIC_SET_PAL_DK;
354 } else if (params->std & V4L2_STD_SECAM_L) {
355 *cb |= TEMIC_SET_PAL_L;
358 break;
360 case TUNER_PHILIPS_FQ1216ME:
361 *cb &= ~0x0f;
363 if (params->std & (V4L2_STD_PAL_BG|V4L2_STD_PAL_DK)) {
364 *cb |= PHILIPS_SET_PAL_BGDK;
366 } else if (params->std & V4L2_STD_PAL_I) {
367 *cb |= PHILIPS_SET_PAL_I;
369 } else if (params->std & V4L2_STD_SECAM_L) {
370 *cb |= PHILIPS_SET_PAL_L;
373 break;
375 case TUNER_PHILIPS_FCV1236D:
376 /* 0x00 -> ATSC antenna input 1 */
377 /* 0x01 -> ATSC antenna input 2 */
378 /* 0x02 -> NTSC antenna input 1 */
379 /* 0x03 -> NTSC antenna input 2 */
380 *cb &= ~0x03;
381 if (!(params->std & V4L2_STD_ATSC))
382 *cb |= 2;
383 break;
385 case TUNER_MICROTUNE_4042FI5:
386 /* Set the charge pump for fast tuning */
387 *config |= TUNER_CHARGE_PUMP;
388 break;
390 case TUNER_PHILIPS_TUV1236D:
392 struct tuner_i2c_props i2c = priv->i2c_props;
393 /* 0x40 -> ATSC antenna input 1 */
394 /* 0x48 -> ATSC antenna input 2 */
395 /* 0x00 -> NTSC antenna input 1 */
396 /* 0x08 -> NTSC antenna input 2 */
397 u8 buffer[4] = { 0x14, 0x00, 0x17, 0x00};
398 *cb &= ~0x40;
399 if (params->std & V4L2_STD_ATSC) {
400 *cb |= 0x40;
401 buffer[1] = 0x04;
403 /* set to the correct mode (analog or digital) */
404 i2c.addr = 0x0a;
405 rc = tuner_i2c_xfer_send(&i2c, &buffer[0], 2);
406 if (2 != rc)
407 tuner_warn("i2c i/o error: rc == %d (should be 2)\n",
408 rc);
409 rc = tuner_i2c_xfer_send(&i2c, &buffer[2], 2);
410 if (2 != rc)
411 tuner_warn("i2c i/o error: rc == %d (should be 2)\n",
412 rc);
413 break;
416 if (atv_input[priv->nr])
417 simple_set_rf_input(fe, config, cb, atv_input[priv->nr]);
419 return 0;
422 static int simple_set_aux_byte(struct dvb_frontend *fe, u8 config, u8 aux)
424 struct tuner_simple_priv *priv = fe->tuner_priv;
425 int rc;
426 u8 buffer[2];
428 buffer[0] = (config & ~0x38) | 0x18;
429 buffer[1] = aux;
431 tuner_dbg("setting aux byte: 0x%02x 0x%02x\n", buffer[0], buffer[1]);
433 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 2);
434 if (2 != rc)
435 tuner_warn("i2c i/o error: rc == %d (should be 2)\n", rc);
437 return rc == 2 ? 0 : rc;
440 static int simple_post_tune(struct dvb_frontend *fe, u8 *buffer,
441 u16 div, u8 config, u8 cb)
443 struct tuner_simple_priv *priv = fe->tuner_priv;
444 int rc;
446 switch (priv->type) {
447 case TUNER_LG_TDVS_H06XF:
448 simple_set_aux_byte(fe, config, 0x20);
449 break;
450 case TUNER_PHILIPS_FQ1216LME_MK3:
451 simple_set_aux_byte(fe, config, 0x60); /* External AGC */
452 break;
453 case TUNER_MICROTUNE_4042FI5:
455 /* FIXME - this may also work for other tuners */
456 unsigned long timeout = jiffies + msecs_to_jiffies(1);
457 u8 status_byte = 0;
459 /* Wait until the PLL locks */
460 for (;;) {
461 if (time_after(jiffies, timeout))
462 return 0;
463 rc = tuner_i2c_xfer_recv(&priv->i2c_props,
464 &status_byte, 1);
465 if (1 != rc) {
466 tuner_warn("i2c i/o read error: rc == %d (should be 1)\n",
467 rc);
468 break;
470 if (status_byte & TUNER_PLL_LOCKED)
471 break;
472 udelay(10);
475 /* Set the charge pump for optimized phase noise figure */
476 config &= ~TUNER_CHARGE_PUMP;
477 buffer[0] = (div>>8) & 0x7f;
478 buffer[1] = div & 0xff;
479 buffer[2] = config;
480 buffer[3] = cb;
481 tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
482 buffer[0], buffer[1], buffer[2], buffer[3]);
484 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
485 if (4 != rc)
486 tuner_warn("i2c i/o error: rc == %d (should be 4)\n",
487 rc);
488 break;
492 return 0;
495 static int simple_radio_bandswitch(struct dvb_frontend *fe, u8 *buffer)
497 struct tuner_simple_priv *priv = fe->tuner_priv;
499 switch (priv->type) {
500 case TUNER_TENA_9533_DI:
501 case TUNER_YMEC_TVF_5533MF:
502 tuner_dbg("This tuner doesn't have FM. Most cards have a TEA5767 for FM\n");
503 return 0;
504 case TUNER_PHILIPS_FM1216ME_MK3:
505 case TUNER_PHILIPS_FM1236_MK3:
506 case TUNER_PHILIPS_FMD1216ME_MK3:
507 case TUNER_PHILIPS_FMD1216MEX_MK3:
508 case TUNER_LG_NTSC_TAPE:
509 case TUNER_PHILIPS_FM1256_IH3:
510 case TUNER_TCL_MF02GIP_5N:
511 buffer[3] = 0x19;
512 break;
513 case TUNER_PHILIPS_FM1216MK5:
514 buffer[2] = 0x88;
515 buffer[3] = 0x09;
516 break;
517 case TUNER_TNF_5335MF:
518 buffer[3] = 0x11;
519 break;
520 case TUNER_LG_PAL_FM:
521 buffer[3] = 0xa5;
522 break;
523 case TUNER_THOMSON_DTT761X:
524 buffer[3] = 0x39;
525 break;
526 case TUNER_PHILIPS_FQ1216LME_MK3:
527 case TUNER_PHILIPS_FQ1236_MK5:
528 tuner_err("This tuner doesn't have FM\n");
529 /* Set the low band for sanity, since it covers 88-108 MHz */
530 buffer[3] = 0x01;
531 break;
532 case TUNER_MICROTUNE_4049FM5:
533 default:
534 buffer[3] = 0xa4;
535 break;
538 return 0;
541 /* ---------------------------------------------------------------------- */
543 static int simple_set_tv_freq(struct dvb_frontend *fe,
544 struct analog_parameters *params)
546 struct tuner_simple_priv *priv = fe->tuner_priv;
547 u8 config, cb;
548 u16 div;
549 u8 buffer[4];
550 int rc, IFPCoff, i;
551 enum param_type desired_type;
552 struct tuner_params *t_params;
554 /* IFPCoff = Video Intermediate Frequency - Vif:
555 940 =16*58.75 NTSC/J (Japan)
556 732 =16*45.75 M/N STD
557 704 =16*44 ATSC (at DVB code)
558 632 =16*39.50 I U.K.
559 622.4=16*38.90 B/G D/K I, L STD
560 592 =16*37.00 D China
561 590 =16.36.875 B Australia
562 543.2=16*33.95 L' STD
563 171.2=16*10.70 FM Radio (at set_radio_freq)
566 if (params->std == V4L2_STD_NTSC_M_JP) {
567 IFPCoff = 940;
568 desired_type = TUNER_PARAM_TYPE_NTSC;
569 } else if ((params->std & V4L2_STD_MN) &&
570 !(params->std & ~V4L2_STD_MN)) {
571 IFPCoff = 732;
572 desired_type = TUNER_PARAM_TYPE_NTSC;
573 } else if (params->std == V4L2_STD_SECAM_LC) {
574 IFPCoff = 543;
575 desired_type = TUNER_PARAM_TYPE_SECAM;
576 } else {
577 IFPCoff = 623;
578 desired_type = TUNER_PARAM_TYPE_PAL;
581 t_params = simple_tuner_params(fe, desired_type);
583 i = simple_config_lookup(fe, t_params, &params->frequency,
584 &config, &cb);
586 div = params->frequency + IFPCoff + offset;
588 tuner_dbg("Freq= %d.%02d MHz, V_IF=%d.%02d MHz, Offset=%d.%02d MHz, div=%0d\n",
589 params->frequency / 16, params->frequency % 16 * 100 / 16,
590 IFPCoff / 16, IFPCoff % 16 * 100 / 16,
591 offset / 16, offset % 16 * 100 / 16, div);
593 /* tv norm specific stuff for multi-norm tuners */
594 simple_std_setup(fe, params, &config, &cb);
596 if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
597 buffer[0] = config;
598 buffer[1] = cb;
599 buffer[2] = (div>>8) & 0x7f;
600 buffer[3] = div & 0xff;
601 } else {
602 buffer[0] = (div>>8) & 0x7f;
603 buffer[1] = div & 0xff;
604 buffer[2] = config;
605 buffer[3] = cb;
607 priv->last_div = div;
608 if (t_params->has_tda9887) {
609 struct v4l2_priv_tun_config tda9887_cfg;
610 int tda_config = 0;
611 int is_secam_l = (params->std & (V4L2_STD_SECAM_L |
612 V4L2_STD_SECAM_LC)) &&
613 !(params->std & ~(V4L2_STD_SECAM_L |
614 V4L2_STD_SECAM_LC));
616 tda9887_cfg.tuner = TUNER_TDA9887;
617 tda9887_cfg.priv = &tda_config;
619 if (params->std == V4L2_STD_SECAM_LC) {
620 if (t_params->port1_active ^ t_params->port1_invert_for_secam_lc)
621 tda_config |= TDA9887_PORT1_ACTIVE;
622 if (t_params->port2_active ^ t_params->port2_invert_for_secam_lc)
623 tda_config |= TDA9887_PORT2_ACTIVE;
624 } else {
625 if (t_params->port1_active)
626 tda_config |= TDA9887_PORT1_ACTIVE;
627 if (t_params->port2_active)
628 tda_config |= TDA9887_PORT2_ACTIVE;
630 if (t_params->intercarrier_mode)
631 tda_config |= TDA9887_INTERCARRIER;
632 if (is_secam_l) {
633 if (i == 0 && t_params->default_top_secam_low)
634 tda_config |= TDA9887_TOP(t_params->default_top_secam_low);
635 else if (i == 1 && t_params->default_top_secam_mid)
636 tda_config |= TDA9887_TOP(t_params->default_top_secam_mid);
637 else if (t_params->default_top_secam_high)
638 tda_config |= TDA9887_TOP(t_params->default_top_secam_high);
639 } else {
640 if (i == 0 && t_params->default_top_low)
641 tda_config |= TDA9887_TOP(t_params->default_top_low);
642 else if (i == 1 && t_params->default_top_mid)
643 tda_config |= TDA9887_TOP(t_params->default_top_mid);
644 else if (t_params->default_top_high)
645 tda_config |= TDA9887_TOP(t_params->default_top_high);
647 if (t_params->default_pll_gating_18)
648 tda_config |= TDA9887_GATING_18;
649 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
650 &tda9887_cfg);
652 tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
653 buffer[0], buffer[1], buffer[2], buffer[3]);
655 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
656 if (4 != rc)
657 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
659 simple_post_tune(fe, &buffer[0], div, config, cb);
661 return 0;
664 static int simple_set_radio_freq(struct dvb_frontend *fe,
665 struct analog_parameters *params)
667 struct tunertype *tun;
668 struct tuner_simple_priv *priv = fe->tuner_priv;
669 u8 buffer[4];
670 u16 div;
671 int rc, j;
672 struct tuner_params *t_params;
673 unsigned int freq = params->frequency;
674 bool mono = params->audmode == V4L2_TUNER_MODE_MONO;
676 tun = priv->tun;
678 for (j = tun->count-1; j > 0; j--)
679 if (tun->params[j].type == TUNER_PARAM_TYPE_RADIO)
680 break;
681 /* default t_params (j=0) will be used if desired type wasn't found */
682 t_params = &tun->params[j];
684 /* Select Radio 1st IF used */
685 switch (t_params->radio_if) {
686 case 0: /* 10.7 MHz */
687 freq += (unsigned int)(10.7*16000);
688 break;
689 case 1: /* 33.3 MHz */
690 freq += (unsigned int)(33.3*16000);
691 break;
692 case 2: /* 41.3 MHz */
693 freq += (unsigned int)(41.3*16000);
694 break;
695 default:
696 tuner_warn("Unsupported radio_if value %d\n",
697 t_params->radio_if);
698 return 0;
701 buffer[2] = (t_params->ranges[0].config & ~TUNER_RATIO_MASK) |
702 TUNER_RATIO_SELECT_50; /* 50 kHz step */
704 /* Bandswitch byte */
705 simple_radio_bandswitch(fe, &buffer[0]);
707 /* Convert from 1/16 kHz V4L steps to 1/20 MHz (=50 kHz) PLL steps
708 freq * (1 Mhz / 16000 V4L steps) * (20 PLL steps / 1 MHz) =
709 freq * (1/800) */
710 div = (freq + 400) / 800;
712 if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
713 buffer[0] = buffer[2];
714 buffer[1] = buffer[3];
715 buffer[2] = (div>>8) & 0x7f;
716 buffer[3] = div & 0xff;
717 } else {
718 buffer[0] = (div>>8) & 0x7f;
719 buffer[1] = div & 0xff;
722 tuner_dbg("radio 0x%02x 0x%02x 0x%02x 0x%02x\n",
723 buffer[0], buffer[1], buffer[2], buffer[3]);
724 priv->last_div = div;
726 if (t_params->has_tda9887) {
727 int config = 0;
728 struct v4l2_priv_tun_config tda9887_cfg;
730 tda9887_cfg.tuner = TUNER_TDA9887;
731 tda9887_cfg.priv = &config;
733 if (t_params->port1_active &&
734 !t_params->port1_fm_high_sensitivity)
735 config |= TDA9887_PORT1_ACTIVE;
736 if (t_params->port2_active &&
737 !t_params->port2_fm_high_sensitivity)
738 config |= TDA9887_PORT2_ACTIVE;
739 if (t_params->intercarrier_mode)
740 config |= TDA9887_INTERCARRIER;
741 if (t_params->port1_set_for_fm_mono && mono)
742 config &= ~TDA9887_PORT1_ACTIVE;
743 if (t_params->fm_gain_normal)
744 config |= TDA9887_GAIN_NORMAL;
745 if (t_params->radio_if == 2)
746 config |= TDA9887_RIF_41_3;
747 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
748 &tda9887_cfg);
750 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
751 if (4 != rc)
752 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
754 /* Write AUX byte */
755 switch (priv->type) {
756 case TUNER_PHILIPS_FM1216ME_MK3:
757 buffer[2] = 0x98;
758 buffer[3] = 0x20; /* set TOP AGC */
759 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
760 if (4 != rc)
761 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
762 break;
765 return 0;
768 static int simple_set_params(struct dvb_frontend *fe,
769 struct analog_parameters *params)
771 struct tuner_simple_priv *priv = fe->tuner_priv;
772 int ret = -EINVAL;
774 if (priv->i2c_props.adap == NULL)
775 return -EINVAL;
777 switch (params->mode) {
778 case V4L2_TUNER_RADIO:
779 priv->radio_mode = true;
780 ret = simple_set_radio_freq(fe, params);
781 priv->frequency = params->frequency * 125 / 2;
782 break;
783 case V4L2_TUNER_ANALOG_TV:
784 case V4L2_TUNER_DIGITAL_TV:
785 priv->radio_mode = false;
786 ret = simple_set_tv_freq(fe, params);
787 priv->frequency = params->frequency * 62500;
788 break;
790 priv->bandwidth = 0;
792 return ret;
795 static void simple_set_dvb(struct dvb_frontend *fe, u8 *buf,
796 const u32 delsys,
797 const u32 frequency,
798 const u32 bandwidth)
800 struct tuner_simple_priv *priv = fe->tuner_priv;
802 switch (priv->type) {
803 case TUNER_PHILIPS_FMD1216ME_MK3:
804 case TUNER_PHILIPS_FMD1216MEX_MK3:
805 if (bandwidth == 8000000 &&
806 frequency >= 158870000)
807 buf[3] |= 0x08;
808 break;
809 case TUNER_PHILIPS_TD1316:
810 /* determine band */
811 buf[3] |= (frequency < 161000000) ? 1 :
812 (frequency < 444000000) ? 2 : 4;
814 /* setup PLL filter */
815 if (bandwidth == 8000000)
816 buf[3] |= 1 << 3;
817 break;
818 case TUNER_PHILIPS_TUV1236D:
819 case TUNER_PHILIPS_FCV1236D:
821 unsigned int new_rf;
823 if (dtv_input[priv->nr])
824 new_rf = dtv_input[priv->nr];
825 else
826 switch (delsys) {
827 case SYS_DVBC_ANNEX_B:
828 new_rf = 1;
829 break;
830 case SYS_ATSC:
831 default:
832 new_rf = 0;
833 break;
835 simple_set_rf_input(fe, &buf[2], &buf[3], new_rf);
836 break;
838 default:
839 break;
843 static u32 simple_dvb_configure(struct dvb_frontend *fe, u8 *buf,
844 const u32 delsys,
845 const u32 freq,
846 const u32 bw)
848 /* This function returns the tuned frequency on success, 0 on error */
849 struct tuner_simple_priv *priv = fe->tuner_priv;
850 struct tunertype *tun = priv->tun;
851 struct tuner_params *t_params;
852 u8 config, cb;
853 u32 div;
854 int ret;
855 u32 frequency = freq / 62500;
857 if (!tun->stepsize) {
858 /* tuner-core was loaded before the digital tuner was
859 * configured and somehow picked the wrong tuner type */
860 tuner_err("attempt to treat tuner %d (%s) as digital tuner without stepsize defined.\n",
861 priv->type, priv->tun->name);
862 return 0; /* failure */
865 t_params = simple_tuner_params(fe, TUNER_PARAM_TYPE_DIGITAL);
866 ret = simple_config_lookup(fe, t_params, &frequency, &config, &cb);
867 if (ret < 0)
868 return 0; /* failure */
870 div = ((frequency + t_params->iffreq) * 62500 + offset +
871 tun->stepsize/2) / tun->stepsize;
873 buf[0] = div >> 8;
874 buf[1] = div & 0xff;
875 buf[2] = config;
876 buf[3] = cb;
878 simple_set_dvb(fe, buf, delsys, freq, bw);
880 tuner_dbg("%s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
881 tun->name, div, buf[0], buf[1], buf[2], buf[3]);
883 /* calculate the frequency we set it to */
884 return (div * tun->stepsize) - t_params->iffreq;
887 static int simple_dvb_calc_regs(struct dvb_frontend *fe,
888 u8 *buf, int buf_len)
890 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
891 u32 delsys = c->delivery_system;
892 u32 bw = c->bandwidth_hz;
893 struct tuner_simple_priv *priv = fe->tuner_priv;
894 u32 frequency;
896 if (buf_len < 5)
897 return -EINVAL;
899 frequency = simple_dvb_configure(fe, buf+1, delsys, c->frequency, bw);
900 if (frequency == 0)
901 return -EINVAL;
903 buf[0] = priv->i2c_props.addr;
905 priv->frequency = frequency;
906 priv->bandwidth = c->bandwidth_hz;
908 return 5;
911 static int simple_dvb_set_params(struct dvb_frontend *fe)
913 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
914 u32 delsys = c->delivery_system;
915 u32 bw = c->bandwidth_hz;
916 u32 freq = c->frequency;
917 struct tuner_simple_priv *priv = fe->tuner_priv;
918 u32 frequency;
919 u32 prev_freq, prev_bw;
920 int ret;
921 u8 buf[5];
923 if (priv->i2c_props.adap == NULL)
924 return -EINVAL;
926 prev_freq = priv->frequency;
927 prev_bw = priv->bandwidth;
929 frequency = simple_dvb_configure(fe, buf+1, delsys, freq, bw);
930 if (frequency == 0)
931 return -EINVAL;
933 buf[0] = priv->i2c_props.addr;
935 priv->frequency = frequency;
936 priv->bandwidth = bw;
938 /* put analog demod in standby when tuning digital */
939 if (fe->ops.analog_ops.standby)
940 fe->ops.analog_ops.standby(fe);
942 if (fe->ops.i2c_gate_ctrl)
943 fe->ops.i2c_gate_ctrl(fe, 1);
945 /* buf[0] contains the i2c address, but *
946 * we already have it in i2c_props.addr */
947 ret = tuner_i2c_xfer_send(&priv->i2c_props, buf+1, 4);
948 if (ret != 4)
949 goto fail;
951 return 0;
952 fail:
953 /* calc_regs sets frequency and bandwidth. if we failed, unset them */
954 priv->frequency = prev_freq;
955 priv->bandwidth = prev_bw;
957 return ret;
960 static int simple_init(struct dvb_frontend *fe)
962 struct tuner_simple_priv *priv = fe->tuner_priv;
964 if (priv->i2c_props.adap == NULL)
965 return -EINVAL;
967 if (priv->tun->initdata) {
968 int ret;
970 if (fe->ops.i2c_gate_ctrl)
971 fe->ops.i2c_gate_ctrl(fe, 1);
973 ret = tuner_i2c_xfer_send(&priv->i2c_props,
974 priv->tun->initdata + 1,
975 priv->tun->initdata[0]);
976 if (ret != priv->tun->initdata[0])
977 return ret;
980 return 0;
983 static int simple_sleep(struct dvb_frontend *fe)
985 struct tuner_simple_priv *priv = fe->tuner_priv;
987 if (priv->i2c_props.adap == NULL)
988 return -EINVAL;
990 if (priv->tun->sleepdata) {
991 int ret;
993 if (fe->ops.i2c_gate_ctrl)
994 fe->ops.i2c_gate_ctrl(fe, 1);
996 ret = tuner_i2c_xfer_send(&priv->i2c_props,
997 priv->tun->sleepdata + 1,
998 priv->tun->sleepdata[0]);
999 if (ret != priv->tun->sleepdata[0])
1000 return ret;
1003 return 0;
1006 static void simple_release(struct dvb_frontend *fe)
1008 struct tuner_simple_priv *priv = fe->tuner_priv;
1010 mutex_lock(&tuner_simple_list_mutex);
1012 if (priv)
1013 hybrid_tuner_release_state(priv);
1015 mutex_unlock(&tuner_simple_list_mutex);
1017 fe->tuner_priv = NULL;
1020 static int simple_get_frequency(struct dvb_frontend *fe, u32 *frequency)
1022 struct tuner_simple_priv *priv = fe->tuner_priv;
1023 *frequency = priv->frequency;
1024 return 0;
1027 static int simple_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
1029 struct tuner_simple_priv *priv = fe->tuner_priv;
1030 *bandwidth = priv->bandwidth;
1031 return 0;
1034 static const struct dvb_tuner_ops simple_tuner_ops = {
1035 .init = simple_init,
1036 .sleep = simple_sleep,
1037 .set_analog_params = simple_set_params,
1038 .set_params = simple_dvb_set_params,
1039 .calc_regs = simple_dvb_calc_regs,
1040 .release = simple_release,
1041 .get_frequency = simple_get_frequency,
1042 .get_bandwidth = simple_get_bandwidth,
1043 .get_status = simple_get_status,
1044 .get_rf_strength = simple_get_rf_strength,
1047 struct dvb_frontend *simple_tuner_attach(struct dvb_frontend *fe,
1048 struct i2c_adapter *i2c_adap,
1049 u8 i2c_addr,
1050 unsigned int type)
1052 struct tuner_simple_priv *priv = NULL;
1053 int instance;
1055 if (type >= tuner_count) {
1056 printk(KERN_WARNING "%s: invalid tuner type: %d (max: %d)\n",
1057 __func__, type, tuner_count-1);
1058 return NULL;
1061 /* If i2c_adap is set, check that the tuner is at the correct address.
1062 * Otherwise, if i2c_adap is NULL, the tuner will be programmed directly
1063 * by the digital demod via calc_regs.
1065 if (i2c_adap != NULL) {
1066 u8 b[1];
1067 struct i2c_msg msg = {
1068 .addr = i2c_addr, .flags = I2C_M_RD,
1069 .buf = b, .len = 1,
1072 if (fe->ops.i2c_gate_ctrl)
1073 fe->ops.i2c_gate_ctrl(fe, 1);
1075 if (1 != i2c_transfer(i2c_adap, &msg, 1))
1076 printk(KERN_WARNING "tuner-simple %d-%04x: unable to probe %s, proceeding anyway.",
1077 i2c_adapter_id(i2c_adap), i2c_addr,
1078 tuners[type].name);
1080 if (fe->ops.i2c_gate_ctrl)
1081 fe->ops.i2c_gate_ctrl(fe, 0);
1084 mutex_lock(&tuner_simple_list_mutex);
1086 instance = hybrid_tuner_request_state(struct tuner_simple_priv, priv,
1087 hybrid_tuner_instance_list,
1088 i2c_adap, i2c_addr,
1089 "tuner-simple");
1090 switch (instance) {
1091 case 0:
1092 mutex_unlock(&tuner_simple_list_mutex);
1093 return NULL;
1094 case 1:
1095 fe->tuner_priv = priv;
1097 priv->type = type;
1098 priv->tun = &tuners[type];
1099 priv->nr = simple_devcount++;
1100 break;
1101 default:
1102 fe->tuner_priv = priv;
1103 break;
1106 mutex_unlock(&tuner_simple_list_mutex);
1108 memcpy(&fe->ops.tuner_ops, &simple_tuner_ops,
1109 sizeof(struct dvb_tuner_ops));
1111 if (type != priv->type)
1112 tuner_warn("couldn't set type to %d. Using %d (%s) instead\n",
1113 type, priv->type, priv->tun->name);
1114 else
1115 tuner_info("type set to %d (%s)\n",
1116 priv->type, priv->tun->name);
1118 if ((debug) || ((atv_input[priv->nr] > 0) ||
1119 (dtv_input[priv->nr] > 0))) {
1120 if (0 == atv_input[priv->nr])
1121 tuner_info("tuner %d atv rf input will be autoselected\n",
1122 priv->nr);
1123 else
1124 tuner_info("tuner %d atv rf input will be set to input %d (insmod option)\n",
1125 priv->nr, atv_input[priv->nr]);
1126 if (0 == dtv_input[priv->nr])
1127 tuner_info("tuner %d dtv rf input will be autoselected\n",
1128 priv->nr);
1129 else
1130 tuner_info("tuner %d dtv rf input will be set to input %d (insmod option)\n",
1131 priv->nr, dtv_input[priv->nr]);
1134 strscpy(fe->ops.tuner_ops.info.name, priv->tun->name,
1135 sizeof(fe->ops.tuner_ops.info.name));
1137 return fe;
1139 EXPORT_SYMBOL_GPL(simple_tuner_attach);
1141 MODULE_DESCRIPTION("Simple 4-control-bytes style tuner driver");
1142 MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
1143 MODULE_LICENSE("GPL");