V4L/DVB (7235): tuner-simple: fix a buffer overflow
[linux-2.6] / drivers / media / video / 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/videodev.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 static int offset;
21 module_param(offset, int, 0664);
22 MODULE_PARM_DESC(offset, "Allows to specify an offset for tuner");
23
24 /* ---------------------------------------------------------------------- */
25
26 /* tv standard selection for Temic 4046 FM5
27    this value takes the low bits of control byte 2
28    from datasheet Rev.01, Feb.00
29      standard     BG      I       L       L2      D
30      picture IF   38.9    38.9    38.9    33.95   38.9
31      sound 1      33.4    32.9    32.4    40.45   32.4
32      sound 2      33.16
33      NICAM        33.05   32.348  33.05           33.05
34  */
35 #define TEMIC_SET_PAL_I         0x05
36 #define TEMIC_SET_PAL_DK        0x09
37 #define TEMIC_SET_PAL_L         0x0a /* SECAM ? */
38 #define TEMIC_SET_PAL_L2        0x0b /* change IF ! */
39 #define TEMIC_SET_PAL_BG        0x0c
40
41 /* tv tuner system standard selection for Philips FQ1216ME
42    this value takes the low bits of control byte 2
43    from datasheet "1999 Nov 16" (supersedes "1999 Mar 23")
44      standard           BG      DK      I       L       L`
45      picture carrier    38.90   38.90   38.90   38.90   33.95
46      colour             34.47   34.47   34.47   34.47   38.38
47      sound 1            33.40   32.40   32.90   32.40   40.45
48      sound 2            33.16   -       -       -       -
49      NICAM              33.05   33.05   32.35   33.05   39.80
50  */
51 #define PHILIPS_SET_PAL_I       0x01 /* Bit 2 always zero !*/
52 #define PHILIPS_SET_PAL_BGDK    0x09
53 #define PHILIPS_SET_PAL_L2      0x0a
54 #define PHILIPS_SET_PAL_L       0x0b
55
56 /* system switching for Philips FI1216MF MK2
57    from datasheet "1996 Jul 09",
58     standard         BG     L      L'
59     picture carrier  38.90  38.90  33.95
60     colour           34.47  34.37  38.38
61     sound 1          33.40  32.40  40.45
62     sound 2          33.16  -      -
63     NICAM            33.05  33.05  39.80
64  */
65 #define PHILIPS_MF_SET_STD_BG   0x01 /* Bit 2 must be zero, Bit 3 is system output */
66 #define PHILIPS_MF_SET_STD_L    0x03 /* Used on Secam France */
67 #define PHILIPS_MF_SET_STD_LC   0x02 /* Used on SECAM L' */
68
69 /* Control byte */
70
71 #define TUNER_RATIO_MASK        0x06 /* Bit cb1:cb2 */
72 #define TUNER_RATIO_SELECT_50   0x00
73 #define TUNER_RATIO_SELECT_32   0x02
74 #define TUNER_RATIO_SELECT_166  0x04
75 #define TUNER_RATIO_SELECT_62   0x06
76
77 #define TUNER_CHARGE_PUMP       0x40  /* Bit cb6 */
78
79 /* Status byte */
80
81 #define TUNER_POR         0x80
82 #define TUNER_FL          0x40
83 #define TUNER_MODE        0x38
84 #define TUNER_AFC         0x07
85 #define TUNER_SIGNAL      0x07
86 #define TUNER_STEREO      0x10
87
88 #define TUNER_PLL_LOCKED   0x40
89 #define TUNER_STEREO_MK3   0x04
90
91 struct tuner_simple_priv {
92         u16 last_div;
93         struct tuner_i2c_props i2c_props;
94
95         unsigned int type;
96         struct tunertype *tun;
97
98         u32 frequency;
99 };
100
101 /* ---------------------------------------------------------------------- */
102
103 static int tuner_read_status(struct dvb_frontend *fe)
104 {
105         struct tuner_simple_priv *priv = fe->tuner_priv;
106         unsigned char byte;
107
108         if (1 != tuner_i2c_xfer_recv(&priv->i2c_props, &byte, 1))
109                 return 0;
110
111         return byte;
112 }
113
114 static inline int tuner_signal(const int status)
115 {
116         return (status & TUNER_SIGNAL) << 13;
117 }
118
119 static inline int tuner_stereo(const int type, const int status)
120 {
121         switch (type) {
122         case TUNER_PHILIPS_FM1216ME_MK3:
123         case TUNER_PHILIPS_FM1236_MK3:
124         case TUNER_PHILIPS_FM1256_IH3:
125         case TUNER_LG_NTSC_TAPE:
126                 return ((status & TUNER_SIGNAL) == TUNER_STEREO_MK3);
127         default:
128                 return status & TUNER_STEREO;
129         }
130 }
131
132 static inline int tuner_islocked(const int status)
133 {
134         return (status & TUNER_FL);
135 }
136
137 static inline int tuner_afcstatus(const int status)
138 {
139         return (status & TUNER_AFC) - 2;
140 }
141
142
143 static int simple_get_status(struct dvb_frontend *fe, u32 *status)
144 {
145         struct tuner_simple_priv *priv = fe->tuner_priv;
146         int tuner_status = tuner_read_status(fe);
147
148         *status = 0;
149
150         if (tuner_islocked(tuner_status))
151                 *status = TUNER_STATUS_LOCKED;
152         if (tuner_stereo(priv->type, tuner_status))
153                 *status |= TUNER_STATUS_STEREO;
154
155         tuner_dbg("AFC Status: %d\n", tuner_afcstatus(tuner_status));
156
157         return 0;
158 }
159
160 static int simple_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
161 {
162         struct tuner_simple_priv *priv = fe->tuner_priv;
163         int signal = tuner_signal(tuner_read_status(fe));
164
165         *strength = signal;
166
167         tuner_dbg("Signal strength: %d\n", signal);
168
169         return 0;
170 }
171
172 /* ---------------------------------------------------------------------- */
173
174 static inline char *tuner_param_name(enum param_type type)
175 {
176         char *name;
177
178         switch (type) {
179         case TUNER_PARAM_TYPE_RADIO:
180                 name = "radio";
181                 break;
182         case TUNER_PARAM_TYPE_PAL:
183                 name = "pal";
184                 break;
185         case TUNER_PARAM_TYPE_SECAM:
186                 name = "secam";
187                 break;
188         case TUNER_PARAM_TYPE_NTSC:
189                 name = "ntsc";
190                 break;
191         default:
192                 name = "unknown";
193                 break;
194         }
195         return name;
196 }
197
198 static struct tuner_params *simple_tuner_params(struct dvb_frontend *fe,
199                                                 enum param_type desired_type)
200 {
201         struct tuner_simple_priv *priv = fe->tuner_priv;
202         struct tunertype *tun = priv->tun;
203         int i;
204
205         for (i = 0; i < tun->count; i++)
206                 if (desired_type == tun->params[i].type)
207                         break;
208
209         /* use default tuner params if desired_type not available */
210         if (i == tun->count) {
211                 tuner_dbg("desired params (%s) undefined for tuner %d\n",
212                           tuner_param_name(desired_type), priv->type);
213                 i = 0;
214         }
215
216         tuner_dbg("using tuner params #%d (%s)\n", i,
217                   tuner_param_name(tun->params[i].type));
218
219         return &tun->params[i];
220 }
221
222 static int simple_config_lookup(struct dvb_frontend *fe,
223                                 struct tuner_params *t_params,
224                                 int *frequency, u8 *config, u8 *cb)
225 {
226         struct tuner_simple_priv *priv = fe->tuner_priv;
227         int i;
228
229         for (i = 0; i < t_params->count; i++) {
230                 if (*frequency > t_params->ranges[i].limit)
231                         continue;
232                 break;
233         }
234         if (i == t_params->count) {
235                 tuner_dbg("frequency out of range (%d > %d)\n",
236                           *frequency, t_params->ranges[i - 1].limit);
237                 *frequency = t_params->ranges[--i].limit;
238         }
239         *config = t_params->ranges[i].config;
240         *cb     = t_params->ranges[i].cb;
241
242         tuner_dbg("freq = %d.%02d (%d), range = %d, "
243                   "config = 0x%02x, cb = 0x%02x\n",
244                   *frequency / 16, *frequency % 16 * 100 / 16, *frequency,
245                   i, *config, *cb);
246
247         return i;
248 }
249
250 /* ---------------------------------------------------------------------- */
251
252 static int simple_std_setup(struct dvb_frontend *fe,
253                             struct analog_parameters *params,
254                             u8 *config, u8 *cb)
255 {
256         struct tuner_simple_priv *priv = fe->tuner_priv;
257         u8 tuneraddr;
258         int rc;
259
260         /* tv norm specific stuff for multi-norm tuners */
261         switch (priv->type) {
262         case TUNER_PHILIPS_SECAM: /* FI1216MF */
263                 /* 0x01 -> ??? no change ??? */
264                 /* 0x02 -> PAL BDGHI / SECAM L */
265                 /* 0x04 -> ??? PAL others / SECAM others ??? */
266                 *cb &= ~0x03;
267                 if (params->std & V4L2_STD_SECAM_L)
268                         /* also valid for V4L2_STD_SECAM */
269                         *cb |= PHILIPS_MF_SET_STD_L;
270                 else if (params->std & V4L2_STD_SECAM_LC)
271                         *cb |= PHILIPS_MF_SET_STD_LC;
272                 else /* V4L2_STD_B|V4L2_STD_GH */
273                         *cb |= PHILIPS_MF_SET_STD_BG;
274                 break;
275
276         case TUNER_TEMIC_4046FM5:
277                 *cb &= ~0x0f;
278
279                 if (params->std & V4L2_STD_PAL_BG) {
280                         *cb |= TEMIC_SET_PAL_BG;
281
282                 } else if (params->std & V4L2_STD_PAL_I) {
283                         *cb |= TEMIC_SET_PAL_I;
284
285                 } else if (params->std & V4L2_STD_PAL_DK) {
286                         *cb |= TEMIC_SET_PAL_DK;
287
288                 } else if (params->std & V4L2_STD_SECAM_L) {
289                         *cb |= TEMIC_SET_PAL_L;
290
291                 }
292                 break;
293
294         case TUNER_PHILIPS_FQ1216ME:
295                 *cb &= ~0x0f;
296
297                 if (params->std & (V4L2_STD_PAL_BG|V4L2_STD_PAL_DK)) {
298                         *cb |= PHILIPS_SET_PAL_BGDK;
299
300                 } else if (params->std & V4L2_STD_PAL_I) {
301                         *cb |= PHILIPS_SET_PAL_I;
302
303                 } else if (params->std & V4L2_STD_SECAM_L) {
304                         *cb |= PHILIPS_SET_PAL_L;
305
306                 }
307                 break;
308
309         case TUNER_PHILIPS_ATSC:
310                 /* 0x00 -> ATSC antenna input 1 */
311                 /* 0x01 -> ATSC antenna input 2 */
312                 /* 0x02 -> NTSC antenna input 1 */
313                 /* 0x03 -> NTSC antenna input 2 */
314                 *cb &= ~0x03;
315                 if (!(params->std & V4L2_STD_ATSC))
316                         *cb |= 2;
317                 /* FIXME: input */
318                 break;
319
320         case TUNER_MICROTUNE_4042FI5:
321                 /* Set the charge pump for fast tuning */
322                 *config |= TUNER_CHARGE_PUMP;
323                 break;
324
325         case TUNER_PHILIPS_TUV1236D:
326         {
327                 /* 0x40 -> ATSC antenna input 1 */
328                 /* 0x48 -> ATSC antenna input 2 */
329                 /* 0x00 -> NTSC antenna input 1 */
330                 /* 0x08 -> NTSC antenna input 2 */
331                 u8 buffer[4] = { 0x14, 0x00, 0x17, 0x00};
332                 *cb &= ~0x40;
333                 if (params->std & V4L2_STD_ATSC) {
334                         *cb |= 0x40;
335                         buffer[1] = 0x04;
336                 }
337                 /* set to the correct mode (analog or digital) */
338                 tuneraddr = priv->i2c_props.addr;
339                 priv->i2c_props.addr = 0x0a;
340                 rc = tuner_i2c_xfer_send(&priv->i2c_props, &buffer[0], 2);
341                 if (2 != rc)
342                         tuner_warn("i2c i/o error: rc == %d "
343                                    "(should be 2)\n", rc);
344                 rc = tuner_i2c_xfer_send(&priv->i2c_props, &buffer[2], 2);
345                 if (2 != rc)
346                         tuner_warn("i2c i/o error: rc == %d "
347                                    "(should be 2)\n", rc);
348                 priv->i2c_props.addr = tuneraddr;
349                 /* FIXME: input */
350                 break;
351         }
352         }
353
354         return 0;
355 }
356
357 static int simple_post_tune(struct dvb_frontend *fe, u8 *buffer,
358                             u16 div, u8 config, u8 cb)
359 {
360         struct tuner_simple_priv *priv = fe->tuner_priv;
361         int rc;
362
363         switch (priv->type) {
364         case TUNER_LG_TDVS_H06XF:
365                 /* Set the Auxiliary Byte. */
366                 buffer[0] = buffer[2];
367                 buffer[0] &= ~0x20;
368                 buffer[0] |= 0x18;
369                 buffer[1] = 0x20;
370                 tuner_dbg("tv 0x%02x 0x%02x\n", buffer[0], buffer[1]);
371
372                 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 2);
373                 if (2 != rc)
374                         tuner_warn("i2c i/o error: rc == %d "
375                                    "(should be 2)\n", rc);
376                 break;
377         case TUNER_MICROTUNE_4042FI5:
378         {
379                 /* FIXME - this may also work for other tuners */
380                 unsigned long timeout = jiffies + msecs_to_jiffies(1);
381                 u8 status_byte = 0;
382
383                 /* Wait until the PLL locks */
384                 for (;;) {
385                         if (time_after(jiffies, timeout))
386                                 return 0;
387                         rc = tuner_i2c_xfer_recv(&priv->i2c_props,
388                                                  &status_byte, 1);
389                         if (1 != rc) {
390                                 tuner_warn("i2c i/o read error: rc == %d "
391                                            "(should be 1)\n", rc);
392                                 break;
393                         }
394                         if (status_byte & TUNER_PLL_LOCKED)
395                                 break;
396                         udelay(10);
397                 }
398
399                 /* Set the charge pump for optimized phase noise figure */
400                 config &= ~TUNER_CHARGE_PUMP;
401                 buffer[0] = (div>>8) & 0x7f;
402                 buffer[1] = div      & 0xff;
403                 buffer[2] = config;
404                 buffer[3] = cb;
405                 tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
406                           buffer[0], buffer[1], buffer[2], buffer[3]);
407
408                 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
409                 if (4 != rc)
410                         tuner_warn("i2c i/o error: rc == %d "
411                                    "(should be 4)\n", rc);
412                 break;
413         }
414         }
415
416         return 0;
417 }
418
419 static int simple_radio_bandswitch(struct dvb_frontend *fe, u8 *buffer)
420 {
421         struct tuner_simple_priv *priv = fe->tuner_priv;
422
423         switch (priv->type) {
424         case TUNER_TENA_9533_DI:
425         case TUNER_YMEC_TVF_5533MF:
426                 tuner_dbg("This tuner doesn't have FM. "
427                           "Most cards have a TEA5767 for FM\n");
428                 return 0;
429         case TUNER_PHILIPS_FM1216ME_MK3:
430         case TUNER_PHILIPS_FM1236_MK3:
431         case TUNER_PHILIPS_FMD1216ME_MK3:
432         case TUNER_LG_NTSC_TAPE:
433         case TUNER_PHILIPS_FM1256_IH3:
434                 buffer[3] = 0x19;
435                 break;
436         case TUNER_TNF_5335MF:
437                 buffer[3] = 0x11;
438                 break;
439         case TUNER_LG_PAL_FM:
440                 buffer[3] = 0xa5;
441                 break;
442         case TUNER_THOMSON_DTT761X:
443                 buffer[3] = 0x39;
444                 break;
445         case TUNER_MICROTUNE_4049FM5:
446         default:
447                 buffer[3] = 0xa4;
448                 break;
449         }
450
451         return 0;
452 }
453
454 /* ---------------------------------------------------------------------- */
455
456 static int simple_set_tv_freq(struct dvb_frontend *fe,
457                               struct analog_parameters *params)
458 {
459         struct tuner_simple_priv *priv = fe->tuner_priv;
460         u8 config, cb;
461         u16 div;
462         struct tunertype *tun;
463         u8 buffer[4];
464         int rc, IFPCoff, i;
465         enum param_type desired_type;
466         struct tuner_params *t_params;
467
468         tun = priv->tun;
469
470         /* IFPCoff = Video Intermediate Frequency - Vif:
471                 940  =16*58.75  NTSC/J (Japan)
472                 732  =16*45.75  M/N STD
473                 704  =16*44     ATSC (at DVB code)
474                 632  =16*39.50  I U.K.
475                 622.4=16*38.90  B/G D/K I, L STD
476                 592  =16*37.00  D China
477                 590  =16.36.875 B Australia
478                 543.2=16*33.95  L' STD
479                 171.2=16*10.70  FM Radio (at set_radio_freq)
480         */
481
482         if (params->std == V4L2_STD_NTSC_M_JP) {
483                 IFPCoff      = 940;
484                 desired_type = TUNER_PARAM_TYPE_NTSC;
485         } else if ((params->std & V4L2_STD_MN) &&
486                   !(params->std & ~V4L2_STD_MN)) {
487                 IFPCoff      = 732;
488                 desired_type = TUNER_PARAM_TYPE_NTSC;
489         } else if (params->std == V4L2_STD_SECAM_LC) {
490                 IFPCoff      = 543;
491                 desired_type = TUNER_PARAM_TYPE_SECAM;
492         } else {
493                 IFPCoff      = 623;
494                 desired_type = TUNER_PARAM_TYPE_PAL;
495         }
496
497         t_params = simple_tuner_params(fe, desired_type);
498
499         i = simple_config_lookup(fe, t_params, &params->frequency,
500                                  &config, &cb);
501
502         div = params->frequency + IFPCoff + offset;
503
504         tuner_dbg("Freq= %d.%02d MHz, V_IF=%d.%02d MHz, "
505                   "Offset=%d.%02d MHz, div=%0d\n",
506                   params->frequency / 16, params->frequency % 16 * 100 / 16,
507                   IFPCoff / 16, IFPCoff % 16 * 100 / 16,
508                   offset / 16, offset % 16 * 100 / 16, div);
509
510         /* tv norm specific stuff for multi-norm tuners */
511         simple_std_setup(fe, params, &config, &cb);
512
513         if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
514                 buffer[0] = config;
515                 buffer[1] = cb;
516                 buffer[2] = (div>>8) & 0x7f;
517                 buffer[3] = div      & 0xff;
518         } else {
519                 buffer[0] = (div>>8) & 0x7f;
520                 buffer[1] = div      & 0xff;
521                 buffer[2] = config;
522                 buffer[3] = cb;
523         }
524         priv->last_div = div;
525         if (t_params->has_tda9887) {
526                 struct v4l2_priv_tun_config tda9887_cfg;
527                 int config = 0;
528                 int is_secam_l = (params->std & (V4L2_STD_SECAM_L |
529                                                  V4L2_STD_SECAM_LC)) &&
530                         !(params->std & ~(V4L2_STD_SECAM_L |
531                                           V4L2_STD_SECAM_LC));
532
533                 tda9887_cfg.tuner = TUNER_TDA9887;
534                 tda9887_cfg.priv  = &config;
535
536                 if (params->std == V4L2_STD_SECAM_LC) {
537                         if (t_params->port1_active ^ t_params->port1_invert_for_secam_lc)
538                                 config |= TDA9887_PORT1_ACTIVE;
539                         if (t_params->port2_active ^ t_params->port2_invert_for_secam_lc)
540                                 config |= TDA9887_PORT2_ACTIVE;
541                 } else {
542                         if (t_params->port1_active)
543                                 config |= TDA9887_PORT1_ACTIVE;
544                         if (t_params->port2_active)
545                                 config |= TDA9887_PORT2_ACTIVE;
546                 }
547                 if (t_params->intercarrier_mode)
548                         config |= TDA9887_INTERCARRIER;
549                 if (is_secam_l) {
550                         if (i == 0 && t_params->default_top_secam_low)
551                                 config |= TDA9887_TOP(t_params->default_top_secam_low);
552                         else if (i == 1 && t_params->default_top_secam_mid)
553                                 config |= TDA9887_TOP(t_params->default_top_secam_mid);
554                         else if (t_params->default_top_secam_high)
555                                 config |= TDA9887_TOP(t_params->default_top_secam_high);
556                 } else {
557                         if (i == 0 && t_params->default_top_low)
558                                 config |= TDA9887_TOP(t_params->default_top_low);
559                         else if (i == 1 && t_params->default_top_mid)
560                                 config |= TDA9887_TOP(t_params->default_top_mid);
561                         else if (t_params->default_top_high)
562                                 config |= TDA9887_TOP(t_params->default_top_high);
563                 }
564                 if (t_params->default_pll_gating_18)
565                         config |= TDA9887_GATING_18;
566                 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
567                                     &tda9887_cfg);
568         }
569         tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
570                   buffer[0], buffer[1], buffer[2], buffer[3]);
571
572         rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
573         if (4 != rc)
574                 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
575
576         simple_post_tune(fe, &buffer[0], div, config, cb);
577
578         return 0;
579 }
580
581 static int simple_set_radio_freq(struct dvb_frontend *fe,
582                                  struct analog_parameters *params)
583 {
584         struct tunertype *tun;
585         struct tuner_simple_priv *priv = fe->tuner_priv;
586         u8 buffer[4];
587         u16 div;
588         int rc, j;
589         struct tuner_params *t_params;
590         unsigned int freq = params->frequency;
591
592         tun = priv->tun;
593
594         for (j = tun->count-1; j > 0; j--)
595                 if (tun->params[j].type == TUNER_PARAM_TYPE_RADIO)
596                         break;
597         /* default t_params (j=0) will be used if desired type wasn't found */
598         t_params = &tun->params[j];
599
600         /* Select Radio 1st IF used */
601         switch (t_params->radio_if) {
602         case 0: /* 10.7 MHz */
603                 freq += (unsigned int)(10.7*16000);
604                 break;
605         case 1: /* 33.3 MHz */
606                 freq += (unsigned int)(33.3*16000);
607                 break;
608         case 2: /* 41.3 MHz */
609                 freq += (unsigned int)(41.3*16000);
610                 break;
611         default:
612                 tuner_warn("Unsupported radio_if value %d\n",
613                            t_params->radio_if);
614                 return 0;
615         }
616
617         /* Bandswitch byte */
618         simple_radio_bandswitch(fe, &buffer[0]);
619
620         buffer[2] = (t_params->ranges[0].config & ~TUNER_RATIO_MASK) |
621                     TUNER_RATIO_SELECT_50; /* 50 kHz step */
622
623         /* Convert from 1/16 kHz V4L steps to 1/20 MHz (=50 kHz) PLL steps
624            freq * (1 Mhz / 16000 V4L steps) * (20 PLL steps / 1 MHz) =
625            freq * (1/800) */
626         div = (freq + 400) / 800;
627
628         if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
629                 buffer[0] = buffer[2];
630                 buffer[1] = buffer[3];
631                 buffer[2] = (div>>8) & 0x7f;
632                 buffer[3] = div      & 0xff;
633         } else {
634                 buffer[0] = (div>>8) & 0x7f;
635                 buffer[1] = div      & 0xff;
636         }
637
638         tuner_dbg("radio 0x%02x 0x%02x 0x%02x 0x%02x\n",
639                buffer[0], buffer[1], buffer[2], buffer[3]);
640         priv->last_div = div;
641
642         if (t_params->has_tda9887) {
643                 int config = 0;
644                 struct v4l2_priv_tun_config tda9887_cfg;
645
646                 tda9887_cfg.tuner = TUNER_TDA9887;
647                 tda9887_cfg.priv = &config;
648
649                 if (t_params->port1_active &&
650                     !t_params->port1_fm_high_sensitivity)
651                         config |= TDA9887_PORT1_ACTIVE;
652                 if (t_params->port2_active &&
653                     !t_params->port2_fm_high_sensitivity)
654                         config |= TDA9887_PORT2_ACTIVE;
655                 if (t_params->intercarrier_mode)
656                         config |= TDA9887_INTERCARRIER;
657 /*              if (t_params->port1_set_for_fm_mono)
658                         config &= ~TDA9887_PORT1_ACTIVE;*/
659                 if (t_params->fm_gain_normal)
660                         config |= TDA9887_GAIN_NORMAL;
661                 if (t_params->radio_if == 2)
662                         config |= TDA9887_RIF_41_3;
663                 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
664                                     &tda9887_cfg);
665         }
666         rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
667         if (4 != rc)
668                 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
669
670         return 0;
671 }
672
673 static int simple_set_params(struct dvb_frontend *fe,
674                              struct analog_parameters *params)
675 {
676         struct tuner_simple_priv *priv = fe->tuner_priv;
677         int ret = -EINVAL;
678
679         switch (params->mode) {
680         case V4L2_TUNER_RADIO:
681                 ret = simple_set_radio_freq(fe, params);
682                 priv->frequency = params->frequency * 125 / 2;
683                 break;
684         case V4L2_TUNER_ANALOG_TV:
685         case V4L2_TUNER_DIGITAL_TV:
686                 ret = simple_set_tv_freq(fe, params);
687                 priv->frequency = params->frequency * 62500;
688                 break;
689         }
690
691         return ret;
692 }
693
694
695 static int simple_release(struct dvb_frontend *fe)
696 {
697         kfree(fe->tuner_priv);
698         fe->tuner_priv = NULL;
699
700         return 0;
701 }
702
703 static int simple_get_frequency(struct dvb_frontend *fe, u32 *frequency)
704 {
705         struct tuner_simple_priv *priv = fe->tuner_priv;
706         *frequency = priv->frequency;
707         return 0;
708 }
709
710 static struct dvb_tuner_ops simple_tuner_ops = {
711         .set_analog_params = simple_set_params,
712         .release           = simple_release,
713         .get_frequency     = simple_get_frequency,
714         .get_status        = simple_get_status,
715         .get_rf_strength   = simple_get_rf_strength,
716 };
717
718 struct dvb_frontend *simple_tuner_attach(struct dvb_frontend *fe,
719                                          struct i2c_adapter *i2c_adap,
720                                          u8 i2c_addr,
721                                          unsigned int type)
722 {
723         struct tuner_simple_priv *priv = NULL;
724
725         if (type >= tuner_count) {
726                 printk(KERN_WARNING "%s: invalid tuner type: %d (max: %d)\n",
727                        __FUNCTION__, type, tuner_count-1);
728                 return NULL;
729         }
730
731         priv = kzalloc(sizeof(struct tuner_simple_priv), GFP_KERNEL);
732         if (priv == NULL)
733                 return NULL;
734         fe->tuner_priv = priv;
735
736         priv->i2c_props.addr = i2c_addr;
737         priv->i2c_props.adap = i2c_adap;
738         priv->i2c_props.name = "tuner-simple";
739
740         priv->type = type;
741         priv->tun  = &tuners[type];
742
743         memcpy(&fe->ops.tuner_ops, &simple_tuner_ops,
744                sizeof(struct dvb_tuner_ops));
745
746         tuner_info("type set to %d (%s)\n", priv->type, priv->tun->name);
747
748         strlcpy(fe->ops.tuner_ops.info.name, priv->tun->name,
749                 sizeof(fe->ops.tuner_ops.info.name));
750
751         return fe;
752 }
753 EXPORT_SYMBOL_GPL(simple_tuner_attach);
754
755 MODULE_DESCRIPTION("Simple 4-control-bytes style tuner driver");
756 MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
757 MODULE_LICENSE("GPL");
758
759 /*
760  * Overrides for Emacs so that we follow Linus's tabbing style.
761  * ---------------------------------------------------------------------------
762  * Local variables:
763  * c-basic-offset: 8
764  * End:
765  */