Add the rt linux 4.1.3-rt3 as base
[kvmfornfv.git] / kernel / drivers / media / tuners / tuner-simple.c
1 /*
2  * i2c tv tuner chip device driver
3  * controls all those simple 4-control-bytes style tuners.
4  *
5  * This "tuner-simple" module was split apart from the original "tuner" module.
6  */
7 #include <linux/delay.h>
8 #include <linux/i2c.h>
9 #include <linux/videodev2.h>
10 #include <media/tuner.h>
11 #include <media/v4l2-common.h>
12 #include <media/tuner-types.h>
13 #include "tuner-i2c.h"
14 #include "tuner-simple.h"
15
16 static int debug;
17 module_param(debug, int, 0644);
18 MODULE_PARM_DESC(debug, "enable verbose debug messages");
19
20 #define TUNER_SIMPLE_MAX 64
21 static unsigned int simple_devcount;
22
23 static int offset;
24 module_param(offset, int, 0664);
25 MODULE_PARM_DESC(offset, "Allows to specify an offset for tuner");
26
27 static unsigned int atv_input[TUNER_SIMPLE_MAX] = \
28                         { [0 ... (TUNER_SIMPLE_MAX-1)] = 0 };
29 static unsigned int dtv_input[TUNER_SIMPLE_MAX] = \
30                         { [0 ... (TUNER_SIMPLE_MAX-1)] = 0 };
31 module_param_array(atv_input, int, NULL, 0644);
32 module_param_array(dtv_input, int, NULL, 0644);
33 MODULE_PARM_DESC(atv_input, "specify atv rf input, 0 for autoselect");
34 MODULE_PARM_DESC(dtv_input, "specify dtv rf input, 0 for autoselect");
35
36 /* ---------------------------------------------------------------------- */
37
38 /* tv standard selection for Temic 4046 FM5
39    this value takes the low bits of control byte 2
40    from datasheet Rev.01, Feb.00
41      standard     BG      I       L       L2      D
42      picture IF   38.9    38.9    38.9    33.95   38.9
43      sound 1      33.4    32.9    32.4    40.45   32.4
44      sound 2      33.16
45      NICAM        33.05   32.348  33.05           33.05
46  */
47 #define TEMIC_SET_PAL_I         0x05
48 #define TEMIC_SET_PAL_DK        0x09
49 #define TEMIC_SET_PAL_L         0x0a /* SECAM ? */
50 #define TEMIC_SET_PAL_L2        0x0b /* change IF ! */
51 #define TEMIC_SET_PAL_BG        0x0c
52
53 /* tv tuner system standard selection for Philips FQ1216ME
54    this value takes the low bits of control byte 2
55    from datasheet "1999 Nov 16" (supersedes "1999 Mar 23")
56      standard           BG      DK      I       L       L`
57      picture carrier    38.90   38.90   38.90   38.90   33.95
58      colour             34.47   34.47   34.47   34.47   38.38
59      sound 1            33.40   32.40   32.90   32.40   40.45
60      sound 2            33.16   -       -       -       -
61      NICAM              33.05   33.05   32.35   33.05   39.80
62  */
63 #define PHILIPS_SET_PAL_I       0x01 /* Bit 2 always zero !*/
64 #define PHILIPS_SET_PAL_BGDK    0x09
65 #define PHILIPS_SET_PAL_L2      0x0a
66 #define PHILIPS_SET_PAL_L       0x0b
67
68 /* system switching for Philips FI1216MF MK2
69    from datasheet "1996 Jul 09",
70     standard         BG     L      L'
71     picture carrier  38.90  38.90  33.95
72     colour           34.47  34.37  38.38
73     sound 1          33.40  32.40  40.45
74     sound 2          33.16  -      -
75     NICAM            33.05  33.05  39.80
76  */
77 #define PHILIPS_MF_SET_STD_BG   0x01 /* Bit 2 must be zero, Bit 3 is system output */
78 #define PHILIPS_MF_SET_STD_L    0x03 /* Used on Secam France */
79 #define PHILIPS_MF_SET_STD_LC   0x02 /* Used on SECAM L' */
80
81 /* Control byte */
82
83 #define TUNER_RATIO_MASK        0x06 /* Bit cb1:cb2 */
84 #define TUNER_RATIO_SELECT_50   0x00
85 #define TUNER_RATIO_SELECT_32   0x02
86 #define TUNER_RATIO_SELECT_166  0x04
87 #define TUNER_RATIO_SELECT_62   0x06
88
89 #define TUNER_CHARGE_PUMP       0x40  /* Bit cb6 */
90
91 /* Status byte */
92
93 #define TUNER_POR         0x80
94 #define TUNER_FL          0x40
95 #define TUNER_MODE        0x38
96 #define TUNER_AFC         0x07
97 #define TUNER_SIGNAL      0x07
98 #define TUNER_STEREO      0x10
99
100 #define TUNER_PLL_LOCKED   0x40
101 #define TUNER_STEREO_MK3   0x04
102
103 static DEFINE_MUTEX(tuner_simple_list_mutex);
104 static LIST_HEAD(hybrid_tuner_instance_list);
105
106 struct tuner_simple_priv {
107         unsigned int nr;
108         u16 last_div;
109
110         struct tuner_i2c_props i2c_props;
111         struct list_head hybrid_tuner_instance_list;
112
113         unsigned int type;
114         struct tunertype *tun;
115
116         u32 frequency;
117         u32 bandwidth;
118         bool radio_mode;
119 };
120
121 /* ---------------------------------------------------------------------- */
122
123 static int tuner_read_status(struct dvb_frontend *fe)
124 {
125         struct tuner_simple_priv *priv = fe->tuner_priv;
126         unsigned char byte;
127
128         if (1 != tuner_i2c_xfer_recv(&priv->i2c_props, &byte, 1))
129                 return 0;
130
131         return byte;
132 }
133
134 static inline int tuner_signal(const int status)
135 {
136         return (status & TUNER_SIGNAL) << 13;
137 }
138
139 static inline int tuner_stereo(const int type, const int status)
140 {
141         switch (type) {
142         case TUNER_PHILIPS_FM1216ME_MK3:
143         case TUNER_PHILIPS_FM1236_MK3:
144         case TUNER_PHILIPS_FM1256_IH3:
145         case TUNER_LG_NTSC_TAPE:
146         case TUNER_TCL_MF02GIP_5N:
147                 return ((status & TUNER_SIGNAL) == TUNER_STEREO_MK3);
148         case TUNER_PHILIPS_FM1216MK5:
149                 return status | TUNER_STEREO;
150         default:
151                 return status & TUNER_STEREO;
152         }
153 }
154
155 static inline int tuner_islocked(const int status)
156 {
157         return (status & TUNER_FL);
158 }
159
160 static inline int tuner_afcstatus(const int status)
161 {
162         return (status & TUNER_AFC) - 2;
163 }
164
165
166 static int simple_get_status(struct dvb_frontend *fe, u32 *status)
167 {
168         struct tuner_simple_priv *priv = fe->tuner_priv;
169         int tuner_status;
170
171         if (priv->i2c_props.adap == NULL)
172                 return -EINVAL;
173
174         tuner_status = tuner_read_status(fe);
175
176         *status = 0;
177
178         if (tuner_islocked(tuner_status))
179                 *status = TUNER_STATUS_LOCKED;
180         if (tuner_stereo(priv->type, tuner_status))
181                 *status |= TUNER_STATUS_STEREO;
182
183         tuner_dbg("AFC Status: %d\n", tuner_afcstatus(tuner_status));
184
185         return 0;
186 }
187
188 static int simple_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
189 {
190         struct tuner_simple_priv *priv = fe->tuner_priv;
191         int signal;
192
193         if (priv->i2c_props.adap == NULL || !priv->radio_mode)
194                 return -EINVAL;
195
196         signal = tuner_signal(tuner_read_status(fe));
197
198         *strength = signal;
199
200         tuner_dbg("Signal strength: %d\n", signal);
201
202         return 0;
203 }
204
205 /* ---------------------------------------------------------------------- */
206
207 static inline char *tuner_param_name(enum param_type type)
208 {
209         char *name;
210
211         switch (type) {
212         case TUNER_PARAM_TYPE_RADIO:
213                 name = "radio";
214                 break;
215         case TUNER_PARAM_TYPE_PAL:
216                 name = "pal";
217                 break;
218         case TUNER_PARAM_TYPE_SECAM:
219                 name = "secam";
220                 break;
221         case TUNER_PARAM_TYPE_NTSC:
222                 name = "ntsc";
223                 break;
224         case TUNER_PARAM_TYPE_DIGITAL:
225                 name = "digital";
226                 break;
227         default:
228                 name = "unknown";
229                 break;
230         }
231         return name;
232 }
233
234 static struct tuner_params *simple_tuner_params(struct dvb_frontend *fe,
235                                                 enum param_type desired_type)
236 {
237         struct tuner_simple_priv *priv = fe->tuner_priv;
238         struct tunertype *tun = priv->tun;
239         int i;
240
241         for (i = 0; i < tun->count; i++)
242                 if (desired_type == tun->params[i].type)
243                         break;
244
245         /* use default tuner params if desired_type not available */
246         if (i == tun->count) {
247                 tuner_dbg("desired params (%s) undefined for tuner %d\n",
248                           tuner_param_name(desired_type), priv->type);
249                 i = 0;
250         }
251
252         tuner_dbg("using tuner params #%d (%s)\n", i,
253                   tuner_param_name(tun->params[i].type));
254
255         return &tun->params[i];
256 }
257
258 static int simple_config_lookup(struct dvb_frontend *fe,
259                                 struct tuner_params *t_params,
260                                 unsigned *frequency, u8 *config, u8 *cb)
261 {
262         struct tuner_simple_priv *priv = fe->tuner_priv;
263         int i;
264
265         for (i = 0; i < t_params->count; i++) {
266                 if (*frequency > t_params->ranges[i].limit)
267                         continue;
268                 break;
269         }
270         if (i == t_params->count) {
271                 tuner_dbg("frequency out of range (%d > %d)\n",
272                           *frequency, t_params->ranges[i - 1].limit);
273                 *frequency = t_params->ranges[--i].limit;
274         }
275         *config = t_params->ranges[i].config;
276         *cb     = t_params->ranges[i].cb;
277
278         tuner_dbg("freq = %d.%02d (%d), range = %d, "
279                   "config = 0x%02x, cb = 0x%02x\n",
280                   *frequency / 16, *frequency % 16 * 100 / 16, *frequency,
281                   i, *config, *cb);
282
283         return i;
284 }
285
286 /* ---------------------------------------------------------------------- */
287
288 static void simple_set_rf_input(struct dvb_frontend *fe,
289                                 u8 *config, u8 *cb, unsigned int rf)
290 {
291         struct tuner_simple_priv *priv = fe->tuner_priv;
292
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;
302                 }
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;
312                 }
313                 break;
314         default:
315                 break;
316         }
317 }
318
319 static int simple_std_setup(struct dvb_frontend *fe,
320                             struct analog_parameters *params,
321                             u8 *config, u8 *cb)
322 {
323         struct tuner_simple_priv *priv = fe->tuner_priv;
324         int rc;
325
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;
341
342         case TUNER_TEMIC_4046FM5:
343                 *cb &= ~0x0f;
344
345                 if (params->std & V4L2_STD_PAL_BG) {
346                         *cb |= TEMIC_SET_PAL_BG;
347
348                 } else if (params->std & V4L2_STD_PAL_I) {
349                         *cb |= TEMIC_SET_PAL_I;
350
351                 } else if (params->std & V4L2_STD_PAL_DK) {
352                         *cb |= TEMIC_SET_PAL_DK;
353
354                 } else if (params->std & V4L2_STD_SECAM_L) {
355                         *cb |= TEMIC_SET_PAL_L;
356
357                 }
358                 break;
359
360         case TUNER_PHILIPS_FQ1216ME:
361                 *cb &= ~0x0f;
362
363                 if (params->std & (V4L2_STD_PAL_BG|V4L2_STD_PAL_DK)) {
364                         *cb |= PHILIPS_SET_PAL_BGDK;
365
366                 } else if (params->std & V4L2_STD_PAL_I) {
367                         *cb |= PHILIPS_SET_PAL_I;
368
369                 } else if (params->std & V4L2_STD_SECAM_L) {
370                         *cb |= PHILIPS_SET_PAL_L;
371
372                 }
373                 break;
374
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;
384
385         case TUNER_MICROTUNE_4042FI5:
386                 /* Set the charge pump for fast tuning */
387                 *config |= TUNER_CHARGE_PUMP;
388                 break;
389
390         case TUNER_PHILIPS_TUV1236D:
391         {
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;
402                 }
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 "
408                                    "(should be 2)\n", rc);
409                 rc = tuner_i2c_xfer_send(&i2c, &buffer[2], 2);
410                 if (2 != rc)
411                         tuner_warn("i2c i/o error: rc == %d "
412                                    "(should be 2)\n", rc);
413                 break;
414         }
415         }
416         if (atv_input[priv->nr])
417                 simple_set_rf_input(fe, config, cb, atv_input[priv->nr]);
418
419         return 0;
420 }
421
422 static int simple_set_aux_byte(struct dvb_frontend *fe, u8 config, u8 aux)
423 {
424         struct tuner_simple_priv *priv = fe->tuner_priv;
425         int rc;
426         u8 buffer[2];
427
428         buffer[0] = (config & ~0x38) | 0x18;
429         buffer[1] = aux;
430
431         tuner_dbg("setting aux byte: 0x%02x 0x%02x\n", buffer[0], buffer[1]);
432
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);
436
437         return rc == 2 ? 0 : rc;
438 }
439
440 static int simple_post_tune(struct dvb_frontend *fe, u8 *buffer,
441                             u16 div, u8 config, u8 cb)
442 {
443         struct tuner_simple_priv *priv = fe->tuner_priv;
444         int rc;
445
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:
454         {
455                 /* FIXME - this may also work for other tuners */
456                 unsigned long timeout = jiffies + msecs_to_jiffies(1);
457                 u8 status_byte = 0;
458
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 "
467                                            "(should be 1)\n", rc);
468                                 break;
469                         }
470                         if (status_byte & TUNER_PLL_LOCKED)
471                                 break;
472                         udelay(10);
473                 }
474
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]);
483
484                 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
485                 if (4 != rc)
486                         tuner_warn("i2c i/o error: rc == %d "
487                                    "(should be 4)\n", rc);
488                 break;
489         }
490         }
491
492         return 0;
493 }
494
495 static int simple_radio_bandswitch(struct dvb_frontend *fe, u8 *buffer)
496 {
497         struct tuner_simple_priv *priv = fe->tuner_priv;
498
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. "
503                           "Most cards have a TEA5767 for FM\n");
504                 return 0;
505         case TUNER_PHILIPS_FM1216ME_MK3:
506         case TUNER_PHILIPS_FM1236_MK3:
507         case TUNER_PHILIPS_FMD1216ME_MK3:
508         case TUNER_PHILIPS_FMD1216MEX_MK3:
509         case TUNER_LG_NTSC_TAPE:
510         case TUNER_PHILIPS_FM1256_IH3:
511         case TUNER_TCL_MF02GIP_5N:
512                 buffer[3] = 0x19;
513                 break;
514         case TUNER_PHILIPS_FM1216MK5:
515                 buffer[2] = 0x88;
516                 buffer[3] = 0x09;
517                 break;
518         case TUNER_TNF_5335MF:
519                 buffer[3] = 0x11;
520                 break;
521         case TUNER_LG_PAL_FM:
522                 buffer[3] = 0xa5;
523                 break;
524         case TUNER_THOMSON_DTT761X:
525                 buffer[3] = 0x39;
526                 break;
527         case TUNER_PHILIPS_FQ1216LME_MK3:
528         case TUNER_PHILIPS_FQ1236_MK5:
529                 tuner_err("This tuner doesn't have FM\n");
530                 /* Set the low band for sanity, since it covers 88-108 MHz */
531                 buffer[3] = 0x01;
532                 break;
533         case TUNER_MICROTUNE_4049FM5:
534         default:
535                 buffer[3] = 0xa4;
536                 break;
537         }
538
539         return 0;
540 }
541
542 /* ---------------------------------------------------------------------- */
543
544 static int simple_set_tv_freq(struct dvb_frontend *fe,
545                               struct analog_parameters *params)
546 {
547         struct tuner_simple_priv *priv = fe->tuner_priv;
548         u8 config, cb;
549         u16 div;
550         u8 buffer[4];
551         int rc, IFPCoff, i;
552         enum param_type desired_type;
553         struct tuner_params *t_params;
554
555         /* IFPCoff = Video Intermediate Frequency - Vif:
556                 940  =16*58.75  NTSC/J (Japan)
557                 732  =16*45.75  M/N STD
558                 704  =16*44     ATSC (at DVB code)
559                 632  =16*39.50  I U.K.
560                 622.4=16*38.90  B/G D/K I, L STD
561                 592  =16*37.00  D China
562                 590  =16.36.875 B Australia
563                 543.2=16*33.95  L' STD
564                 171.2=16*10.70  FM Radio (at set_radio_freq)
565         */
566
567         if (params->std == V4L2_STD_NTSC_M_JP) {
568                 IFPCoff      = 940;
569                 desired_type = TUNER_PARAM_TYPE_NTSC;
570         } else if ((params->std & V4L2_STD_MN) &&
571                   !(params->std & ~V4L2_STD_MN)) {
572                 IFPCoff      = 732;
573                 desired_type = TUNER_PARAM_TYPE_NTSC;
574         } else if (params->std == V4L2_STD_SECAM_LC) {
575                 IFPCoff      = 543;
576                 desired_type = TUNER_PARAM_TYPE_SECAM;
577         } else {
578                 IFPCoff      = 623;
579                 desired_type = TUNER_PARAM_TYPE_PAL;
580         }
581
582         t_params = simple_tuner_params(fe, desired_type);
583
584         i = simple_config_lookup(fe, t_params, &params->frequency,
585                                  &config, &cb);
586
587         div = params->frequency + IFPCoff + offset;
588
589         tuner_dbg("Freq= %d.%02d MHz, V_IF=%d.%02d MHz, "
590                   "Offset=%d.%02d MHz, div=%0d\n",
591                   params->frequency / 16, params->frequency % 16 * 100 / 16,
592                   IFPCoff / 16, IFPCoff % 16 * 100 / 16,
593                   offset / 16, offset % 16 * 100 / 16, div);
594
595         /* tv norm specific stuff for multi-norm tuners */
596         simple_std_setup(fe, params, &config, &cb);
597
598         if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
599                 buffer[0] = config;
600                 buffer[1] = cb;
601                 buffer[2] = (div>>8) & 0x7f;
602                 buffer[3] = div      & 0xff;
603         } else {
604                 buffer[0] = (div>>8) & 0x7f;
605                 buffer[1] = div      & 0xff;
606                 buffer[2] = config;
607                 buffer[3] = cb;
608         }
609         priv->last_div = div;
610         if (t_params->has_tda9887) {
611                 struct v4l2_priv_tun_config tda9887_cfg;
612                 int tda_config = 0;
613                 int is_secam_l = (params->std & (V4L2_STD_SECAM_L |
614                                                  V4L2_STD_SECAM_LC)) &&
615                         !(params->std & ~(V4L2_STD_SECAM_L |
616                                           V4L2_STD_SECAM_LC));
617
618                 tda9887_cfg.tuner = TUNER_TDA9887;
619                 tda9887_cfg.priv  = &tda_config;
620
621                 if (params->std == V4L2_STD_SECAM_LC) {
622                         if (t_params->port1_active ^ t_params->port1_invert_for_secam_lc)
623                                 tda_config |= TDA9887_PORT1_ACTIVE;
624                         if (t_params->port2_active ^ t_params->port2_invert_for_secam_lc)
625                                 tda_config |= TDA9887_PORT2_ACTIVE;
626                 } else {
627                         if (t_params->port1_active)
628                                 tda_config |= TDA9887_PORT1_ACTIVE;
629                         if (t_params->port2_active)
630                                 tda_config |= TDA9887_PORT2_ACTIVE;
631                 }
632                 if (t_params->intercarrier_mode)
633                         tda_config |= TDA9887_INTERCARRIER;
634                 if (is_secam_l) {
635                         if (i == 0 && t_params->default_top_secam_low)
636                                 tda_config |= TDA9887_TOP(t_params->default_top_secam_low);
637                         else if (i == 1 && t_params->default_top_secam_mid)
638                                 tda_config |= TDA9887_TOP(t_params->default_top_secam_mid);
639                         else if (t_params->default_top_secam_high)
640                                 tda_config |= TDA9887_TOP(t_params->default_top_secam_high);
641                 } else {
642                         if (i == 0 && t_params->default_top_low)
643                                 tda_config |= TDA9887_TOP(t_params->default_top_low);
644                         else if (i == 1 && t_params->default_top_mid)
645                                 tda_config |= TDA9887_TOP(t_params->default_top_mid);
646                         else if (t_params->default_top_high)
647                                 tda_config |= TDA9887_TOP(t_params->default_top_high);
648                 }
649                 if (t_params->default_pll_gating_18)
650                         tda_config |= TDA9887_GATING_18;
651                 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
652                                     &tda9887_cfg);
653         }
654         tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
655                   buffer[0], buffer[1], buffer[2], buffer[3]);
656
657         rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
658         if (4 != rc)
659                 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
660
661         simple_post_tune(fe, &buffer[0], div, config, cb);
662
663         return 0;
664 }
665
666 static int simple_set_radio_freq(struct dvb_frontend *fe,
667                                  struct analog_parameters *params)
668 {
669         struct tunertype *tun;
670         struct tuner_simple_priv *priv = fe->tuner_priv;
671         u8 buffer[4];
672         u16 div;
673         int rc, j;
674         struct tuner_params *t_params;
675         unsigned int freq = params->frequency;
676
677         tun = priv->tun;
678
679         for (j = tun->count-1; j > 0; j--)
680                 if (tun->params[j].type == TUNER_PARAM_TYPE_RADIO)
681                         break;
682         /* default t_params (j=0) will be used if desired type wasn't found */
683         t_params = &tun->params[j];
684
685         /* Select Radio 1st IF used */
686         switch (t_params->radio_if) {
687         case 0: /* 10.7 MHz */
688                 freq += (unsigned int)(10.7*16000);
689                 break;
690         case 1: /* 33.3 MHz */
691                 freq += (unsigned int)(33.3*16000);
692                 break;
693         case 2: /* 41.3 MHz */
694                 freq += (unsigned int)(41.3*16000);
695                 break;
696         default:
697                 tuner_warn("Unsupported radio_if value %d\n",
698                            t_params->radio_if);
699                 return 0;
700         }
701
702         buffer[2] = (t_params->ranges[0].config & ~TUNER_RATIO_MASK) |
703                     TUNER_RATIO_SELECT_50; /* 50 kHz step */
704
705         /* Bandswitch byte */
706         simple_radio_bandswitch(fe, &buffer[0]);
707
708         /* Convert from 1/16 kHz V4L steps to 1/20 MHz (=50 kHz) PLL steps
709            freq * (1 Mhz / 16000 V4L steps) * (20 PLL steps / 1 MHz) =
710            freq * (1/800) */
711         div = (freq + 400) / 800;
712
713         if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
714                 buffer[0] = buffer[2];
715                 buffer[1] = buffer[3];
716                 buffer[2] = (div>>8) & 0x7f;
717                 buffer[3] = div      & 0xff;
718         } else {
719                 buffer[0] = (div>>8) & 0x7f;
720                 buffer[1] = div      & 0xff;
721         }
722
723         tuner_dbg("radio 0x%02x 0x%02x 0x%02x 0x%02x\n",
724                buffer[0], buffer[1], buffer[2], buffer[3]);
725         priv->last_div = div;
726
727         if (t_params->has_tda9887) {
728                 int config = 0;
729                 struct v4l2_priv_tun_config tda9887_cfg;
730
731                 tda9887_cfg.tuner = TUNER_TDA9887;
732                 tda9887_cfg.priv = &config;
733
734                 if (t_params->port1_active &&
735                     !t_params->port1_fm_high_sensitivity)
736                         config |= TDA9887_PORT1_ACTIVE;
737                 if (t_params->port2_active &&
738                     !t_params->port2_fm_high_sensitivity)
739                         config |= TDA9887_PORT2_ACTIVE;
740                 if (t_params->intercarrier_mode)
741                         config |= TDA9887_INTERCARRIER;
742 /*              if (t_params->port1_set_for_fm_mono)
743                         config &= ~TDA9887_PORT1_ACTIVE;*/
744                 if (t_params->fm_gain_normal)
745                         config |= TDA9887_GAIN_NORMAL;
746                 if (t_params->radio_if == 2)
747                         config |= TDA9887_RIF_41_3;
748                 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
749                                     &tda9887_cfg);
750         }
751         rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
752         if (4 != rc)
753                 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
754
755         /* Write AUX byte */
756         switch (priv->type) {
757         case TUNER_PHILIPS_FM1216ME_MK3:
758                 buffer[2] = 0x98;
759                 buffer[3] = 0x20; /* set TOP AGC */
760                 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
761                 if (4 != rc)
762                         tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
763                 break;
764         }
765
766         return 0;
767 }
768
769 static int simple_set_params(struct dvb_frontend *fe,
770                              struct analog_parameters *params)
771 {
772         struct tuner_simple_priv *priv = fe->tuner_priv;
773         int ret = -EINVAL;
774
775         if (priv->i2c_props.adap == NULL)
776                 return -EINVAL;
777
778         switch (params->mode) {
779         case V4L2_TUNER_RADIO:
780                 priv->radio_mode = true;
781                 ret = simple_set_radio_freq(fe, params);
782                 priv->frequency = params->frequency * 125 / 2;
783                 break;
784         case V4L2_TUNER_ANALOG_TV:
785         case V4L2_TUNER_DIGITAL_TV:
786                 priv->radio_mode = false;
787                 ret = simple_set_tv_freq(fe, params);
788                 priv->frequency = params->frequency * 62500;
789                 break;
790         }
791         priv->bandwidth = 0;
792
793         return ret;
794 }
795
796 static void simple_set_dvb(struct dvb_frontend *fe, u8 *buf,
797                            const u32 delsys,
798                            const u32 frequency,
799                            const u32 bandwidth)
800 {
801         struct tuner_simple_priv *priv = fe->tuner_priv;
802
803         switch (priv->type) {
804         case TUNER_PHILIPS_FMD1216ME_MK3:
805         case TUNER_PHILIPS_FMD1216MEX_MK3:
806                 if (bandwidth == 8000000 &&
807                     frequency >= 158870000)
808                         buf[3] |= 0x08;
809                 break;
810         case TUNER_PHILIPS_TD1316:
811                 /* determine band */
812                 buf[3] |= (frequency < 161000000) ? 1 :
813                           (frequency < 444000000) ? 2 : 4;
814
815                 /* setup PLL filter */
816                 if (bandwidth == 8000000)
817                         buf[3] |= 1 << 3;
818                 break;
819         case TUNER_PHILIPS_TUV1236D:
820         case TUNER_PHILIPS_FCV1236D:
821         {
822                 unsigned int new_rf;
823
824                 if (dtv_input[priv->nr])
825                         new_rf = dtv_input[priv->nr];
826                 else
827                         switch (delsys) {
828                         case SYS_DVBC_ANNEX_B:
829                                 new_rf = 1;
830                                 break;
831                         case SYS_ATSC:
832                         default:
833                                 new_rf = 0;
834                                 break;
835                         }
836                 simple_set_rf_input(fe, &buf[2], &buf[3], new_rf);
837                 break;
838         }
839         default:
840                 break;
841         }
842 }
843
844 static u32 simple_dvb_configure(struct dvb_frontend *fe, u8 *buf,
845                                 const u32 delsys,
846                                 const u32 freq,
847                                 const u32 bw)
848 {
849         /* This function returns the tuned frequency on success, 0 on error */
850         struct tuner_simple_priv *priv = fe->tuner_priv;
851         struct tunertype *tun = priv->tun;
852         static struct tuner_params *t_params;
853         u8 config, cb;
854         u32 div;
855         int ret;
856         u32 frequency = freq / 62500;
857
858         if (!tun->stepsize) {
859                 /* tuner-core was loaded before the digital tuner was
860                  * configured and somehow picked the wrong tuner type */
861                 tuner_err("attempt to treat tuner %d (%s) as digital tuner "
862                           "without stepsize defined.\n",
863                           priv->type, priv->tun->name);
864                 return 0; /* failure */
865         }
866
867         t_params = simple_tuner_params(fe, TUNER_PARAM_TYPE_DIGITAL);
868         ret = simple_config_lookup(fe, t_params, &frequency, &config, &cb);
869         if (ret < 0)
870                 return 0; /* failure */
871
872         div = ((frequency + t_params->iffreq) * 62500 + offset +
873                tun->stepsize/2) / tun->stepsize;
874
875         buf[0] = div >> 8;
876         buf[1] = div & 0xff;
877         buf[2] = config;
878         buf[3] = cb;
879
880         simple_set_dvb(fe, buf, delsys, freq, bw);
881
882         tuner_dbg("%s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
883                   tun->name, div, buf[0], buf[1], buf[2], buf[3]);
884
885         /* calculate the frequency we set it to */
886         return (div * tun->stepsize) - t_params->iffreq;
887 }
888
889 static int simple_dvb_calc_regs(struct dvb_frontend *fe,
890                                 u8 *buf, int buf_len)
891 {
892         struct dtv_frontend_properties *c = &fe->dtv_property_cache;
893         u32 delsys = c->delivery_system;
894         u32 bw = c->bandwidth_hz;
895         struct tuner_simple_priv *priv = fe->tuner_priv;
896         u32 frequency;
897
898         if (buf_len < 5)
899                 return -EINVAL;
900
901         frequency = simple_dvb_configure(fe, buf+1, delsys, c->frequency, bw);
902         if (frequency == 0)
903                 return -EINVAL;
904
905         buf[0] = priv->i2c_props.addr;
906
907         priv->frequency = frequency;
908         priv->bandwidth = c->bandwidth_hz;
909
910         return 5;
911 }
912
913 static int simple_dvb_set_params(struct dvb_frontend *fe)
914 {
915         struct dtv_frontend_properties *c = &fe->dtv_property_cache;
916         u32 delsys = c->delivery_system;
917         u32 bw = c->bandwidth_hz;
918         u32 freq = c->frequency;
919         struct tuner_simple_priv *priv = fe->tuner_priv;
920         u32 frequency;
921         u32 prev_freq, prev_bw;
922         int ret;
923         u8 buf[5];
924
925         if (priv->i2c_props.adap == NULL)
926                 return -EINVAL;
927
928         prev_freq = priv->frequency;
929         prev_bw   = priv->bandwidth;
930
931         frequency = simple_dvb_configure(fe, buf+1, delsys, freq, bw);
932         if (frequency == 0)
933                 return -EINVAL;
934
935         buf[0] = priv->i2c_props.addr;
936
937         priv->frequency = frequency;
938         priv->bandwidth = bw;
939
940         /* put analog demod in standby when tuning digital */
941         if (fe->ops.analog_ops.standby)
942                 fe->ops.analog_ops.standby(fe);
943
944         if (fe->ops.i2c_gate_ctrl)
945                 fe->ops.i2c_gate_ctrl(fe, 1);
946
947         /* buf[0] contains the i2c address, but *
948          * we already have it in i2c_props.addr */
949         ret = tuner_i2c_xfer_send(&priv->i2c_props, buf+1, 4);
950         if (ret != 4)
951                 goto fail;
952
953         return 0;
954 fail:
955         /* calc_regs sets frequency and bandwidth. if we failed, unset them */
956         priv->frequency = prev_freq;
957         priv->bandwidth = prev_bw;
958
959         return ret;
960 }
961
962 static int simple_init(struct dvb_frontend *fe)
963 {
964         struct tuner_simple_priv *priv = fe->tuner_priv;
965
966         if (priv->i2c_props.adap == NULL)
967                 return -EINVAL;
968
969         if (priv->tun->initdata) {
970                 int ret;
971
972                 if (fe->ops.i2c_gate_ctrl)
973                         fe->ops.i2c_gate_ctrl(fe, 1);
974
975                 ret = tuner_i2c_xfer_send(&priv->i2c_props,
976                                           priv->tun->initdata + 1,
977                                           priv->tun->initdata[0]);
978                 if (ret != priv->tun->initdata[0])
979                         return ret;
980         }
981
982         return 0;
983 }
984
985 static int simple_sleep(struct dvb_frontend *fe)
986 {
987         struct tuner_simple_priv *priv = fe->tuner_priv;
988
989         if (priv->i2c_props.adap == NULL)
990                 return -EINVAL;
991
992         if (priv->tun->sleepdata) {
993                 int ret;
994
995                 if (fe->ops.i2c_gate_ctrl)
996                         fe->ops.i2c_gate_ctrl(fe, 1);
997
998                 ret = tuner_i2c_xfer_send(&priv->i2c_props,
999                                           priv->tun->sleepdata + 1,
1000                                           priv->tun->sleepdata[0]);
1001                 if (ret != priv->tun->sleepdata[0])
1002                         return ret;
1003         }
1004
1005         return 0;
1006 }
1007
1008 static int simple_release(struct dvb_frontend *fe)
1009 {
1010         struct tuner_simple_priv *priv = fe->tuner_priv;
1011
1012         mutex_lock(&tuner_simple_list_mutex);
1013
1014         if (priv)
1015                 hybrid_tuner_release_state(priv);
1016
1017         mutex_unlock(&tuner_simple_list_mutex);
1018
1019         fe->tuner_priv = NULL;
1020
1021         return 0;
1022 }
1023
1024 static int simple_get_frequency(struct dvb_frontend *fe, u32 *frequency)
1025 {
1026         struct tuner_simple_priv *priv = fe->tuner_priv;
1027         *frequency = priv->frequency;
1028         return 0;
1029 }
1030
1031 static int simple_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
1032 {
1033         struct tuner_simple_priv *priv = fe->tuner_priv;
1034         *bandwidth = priv->bandwidth;
1035         return 0;
1036 }
1037
1038 static struct dvb_tuner_ops simple_tuner_ops = {
1039         .init              = simple_init,
1040         .sleep             = simple_sleep,
1041         .set_analog_params = simple_set_params,
1042         .set_params        = simple_dvb_set_params,
1043         .calc_regs         = simple_dvb_calc_regs,
1044         .release           = simple_release,
1045         .get_frequency     = simple_get_frequency,
1046         .get_bandwidth     = simple_get_bandwidth,
1047         .get_status        = simple_get_status,
1048         .get_rf_strength   = simple_get_rf_strength,
1049 };
1050
1051 struct dvb_frontend *simple_tuner_attach(struct dvb_frontend *fe,
1052                                          struct i2c_adapter *i2c_adap,
1053                                          u8 i2c_addr,
1054                                          unsigned int type)
1055 {
1056         struct tuner_simple_priv *priv = NULL;
1057         int instance;
1058
1059         if (type >= tuner_count) {
1060                 printk(KERN_WARNING "%s: invalid tuner type: %d (max: %d)\n",
1061                        __func__, type, tuner_count-1);
1062                 return NULL;
1063         }
1064
1065         /* If i2c_adap is set, check that the tuner is at the correct address.
1066          * Otherwise, if i2c_adap is NULL, the tuner will be programmed directly
1067          * by the digital demod via calc_regs.
1068          */
1069         if (i2c_adap != NULL) {
1070                 u8 b[1];
1071                 struct i2c_msg msg = {
1072                         .addr = i2c_addr, .flags = I2C_M_RD,
1073                         .buf = b, .len = 1,
1074                 };
1075
1076                 if (fe->ops.i2c_gate_ctrl)
1077                         fe->ops.i2c_gate_ctrl(fe, 1);
1078
1079                 if (1 != i2c_transfer(i2c_adap, &msg, 1))
1080                         printk(KERN_WARNING "tuner-simple %d-%04x: "
1081                                "unable to probe %s, proceeding anyway.",
1082                                i2c_adapter_id(i2c_adap), i2c_addr,
1083                                tuners[type].name);
1084
1085                 if (fe->ops.i2c_gate_ctrl)
1086                         fe->ops.i2c_gate_ctrl(fe, 0);
1087         }
1088
1089         mutex_lock(&tuner_simple_list_mutex);
1090
1091         instance = hybrid_tuner_request_state(struct tuner_simple_priv, priv,
1092                                               hybrid_tuner_instance_list,
1093                                               i2c_adap, i2c_addr,
1094                                               "tuner-simple");
1095         switch (instance) {
1096         case 0:
1097                 mutex_unlock(&tuner_simple_list_mutex);
1098                 return NULL;
1099         case 1:
1100                 fe->tuner_priv = priv;
1101
1102                 priv->type = type;
1103                 priv->tun  = &tuners[type];
1104                 priv->nr   = simple_devcount++;
1105                 break;
1106         default:
1107                 fe->tuner_priv = priv;
1108                 break;
1109         }
1110
1111         mutex_unlock(&tuner_simple_list_mutex);
1112
1113         memcpy(&fe->ops.tuner_ops, &simple_tuner_ops,
1114                sizeof(struct dvb_tuner_ops));
1115
1116         if (type != priv->type)
1117                 tuner_warn("couldn't set type to %d. Using %d (%s) instead\n",
1118                             type, priv->type, priv->tun->name);
1119         else
1120                 tuner_info("type set to %d (%s)\n",
1121                            priv->type, priv->tun->name);
1122
1123         if ((debug) || ((atv_input[priv->nr] > 0) ||
1124                         (dtv_input[priv->nr] > 0))) {
1125                 if (0 == atv_input[priv->nr])
1126                         tuner_info("tuner %d atv rf input will be "
1127                                    "autoselected\n", priv->nr);
1128                 else
1129                         tuner_info("tuner %d atv rf input will be "
1130                                    "set to input %d (insmod option)\n",
1131                                    priv->nr, atv_input[priv->nr]);
1132                 if (0 == dtv_input[priv->nr])
1133                         tuner_info("tuner %d dtv rf input will be "
1134                                    "autoselected\n", priv->nr);
1135                 else
1136                         tuner_info("tuner %d dtv rf input will be "
1137                                    "set to input %d (insmod option)\n",
1138                                    priv->nr, dtv_input[priv->nr]);
1139         }
1140
1141         strlcpy(fe->ops.tuner_ops.info.name, priv->tun->name,
1142                 sizeof(fe->ops.tuner_ops.info.name));
1143
1144         return fe;
1145 }
1146 EXPORT_SYMBOL_GPL(simple_tuner_attach);
1147
1148 MODULE_DESCRIPTION("Simple 4-control-bytes style tuner driver");
1149 MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
1150 MODULE_LICENSE("GPL");