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 static DEFINE_MUTEX(tuner_simple_list_mutex);
  92 static LIST_HEAD(hybrid_tuner_instance_list);
  93
  94 struct tuner_simple_priv {
  95         u16 last_div;
  96
  97         struct tuner_i2c_props i2c_props;
  98         struct list_head hybrid_tuner_instance_list;
  99
 100         unsigned int type;
 101         struct tunertype *tun;
 102
 103         u32 frequency;
 104         u32 bandwidth;
 105 };
 106
 107 /* ---------------------------------------------------------------------- */
 108
 109 static int tuner_read_status(struct dvb_frontend *fe)
 110 {
 111         struct tuner_simple_priv *priv = fe->tuner_priv;
 112         unsigned char byte;
 113
 114         if (1 != tuner_i2c_xfer_recv(&priv->i2c_props, &byte, 1))
 115                 return 0;
 116
 117         return byte;
 118 }
 119
 120 static inline int tuner_signal(const int status)
 121 {
 122         return (status & TUNER_SIGNAL) << 13;
 123 }
 124
 125 static inline int tuner_stereo(const int type, const int status)
 126 {
 127         switch (type) {
 128         case TUNER_PHILIPS_FM1216ME_MK3:
 129         case TUNER_PHILIPS_FM1236_MK3:
 130         case TUNER_PHILIPS_FM1256_IH3:
 131         case TUNER_LG_NTSC_TAPE:
 132                 return ((status & TUNER_SIGNAL) == TUNER_STEREO_MK3);
 133         default:
 134                 return status & TUNER_STEREO;
 135         }
 136 }
 137
 138 static inline int tuner_islocked(const int status)
 139 {
 140         return (status & TUNER_FL);
 141 }
 142
 143 static inline int tuner_afcstatus(const int status)
 144 {
 145         return (status & TUNER_AFC) - 2;
 146 }
 147
 148
 149 static int simple_get_status(struct dvb_frontend *fe, u32 *status)
 150 {
 151         struct tuner_simple_priv *priv = fe->tuner_priv;
 152         int tuner_status;
 153
 154         if (priv->i2c_props.adap == NULL)
 155                 return -EINVAL;
 156
 157         tuner_status = tuner_read_status(fe);
 158
 159         *status = 0;
 160
 161         if (tuner_islocked(tuner_status))
 162                 *status = TUNER_STATUS_LOCKED;
 163         if (tuner_stereo(priv->type, tuner_status))
 164                 *status |= TUNER_STATUS_STEREO;
 165
 166         tuner_dbg("AFC Status: %d\n", tuner_afcstatus(tuner_status));
 167
 168         return 0;
 169 }
 170
 171 static int simple_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
 172 {
 173         struct tuner_simple_priv *priv = fe->tuner_priv;
 174         int signal;
 175
 176         if (priv->i2c_props.adap == NULL)
 177                 return -EINVAL;
 178
 179         signal = tuner_signal(tuner_read_status(fe));
 180
 181         *strength = signal;
 182
 183         tuner_dbg("Signal strength: %d\n", signal);
 184
 185         return 0;
 186 }
 187
 188 /* ---------------------------------------------------------------------- */
 189
 190 static inline char *tuner_param_name(enum param_type type)
 191 {
 192         char *name;
 193
 194         switch (type) {
 195         case TUNER_PARAM_TYPE_RADIO:
 196                 name = "radio";
 197                 break;
 198         case TUNER_PARAM_TYPE_PAL:
 199                 name = "pal";
 200                 break;
 201         case TUNER_PARAM_TYPE_SECAM:
 202                 name = "secam";
 203                 break;
 204         case TUNER_PARAM_TYPE_NTSC:
 205                 name = "ntsc";
 206                 break;
 207         case TUNER_PARAM_TYPE_DIGITAL:
 208                 name = "digital";
 209                 break;
 210         default:
 211                 name = "unknown";
 212                 break;
 213         }
 214         return name;
 215 }
 216
 217 static struct tuner_params *simple_tuner_params(struct dvb_frontend *fe,
 218                                                 enum param_type desired_type)
 219 {
 220         struct tuner_simple_priv *priv = fe->tuner_priv;
 221         struct tunertype *tun = priv->tun;
 222         int i;
 223
 224         for (i = 0; i < tun->count; i++)
 225                 if (desired_type == tun->params[i].type)
 226                         break;
 227
 228         /* use default tuner params if desired_type not available */
 229         if (i == tun->count) {
 230                 tuner_dbg("desired params (%s) undefined for tuner %d\n",
 231                           tuner_param_name(desired_type), priv->type);
 232                 i = 0;
 233         }
 234
 235         tuner_dbg("using tuner params #%d (%s)\n", i,
 236                   tuner_param_name(tun->params[i].type));
 237
 238         return &tun->params[i];
 239 }
 240
 241 static int simple_config_lookup(struct dvb_frontend *fe,
 242                                 struct tuner_params *t_params,
 243                                 int *frequency, u8 *config, u8 *cb)
 244 {
 245         struct tuner_simple_priv *priv = fe->tuner_priv;
 246         int i;
 247
 248         for (i = 0; i < t_params->count; i++) {
 249                 if (*frequency > t_params->ranges[i].limit)
 250                         continue;
 251                 break;
 252         }
 253         if (i == t_params->count) {
 254                 tuner_dbg("frequency out of range (%d > %d)\n",
 255                           *frequency, t_params->ranges[i - 1].limit);
 256                 *frequency = t_params->ranges[--i].limit;
 257         }
 258         *config = t_params->ranges[i].config;
 259         *cb     = t_params->ranges[i].cb;
 260
 261         tuner_dbg("freq = %d.%02d (%d), range = %d, "
 262                   "config = 0x%02x, cb = 0x%02x\n",
 263                   *frequency / 16, *frequency % 16 * 100 / 16, *frequency,
 264                   i, *config, *cb);
 265
 266         return i;
 267 }
 268
 269 /* ---------------------------------------------------------------------- */
 270
 271 static void simple_set_rf_input(struct dvb_frontend *fe,
 272                                 u8 *config, u8 *cb, unsigned int rf)
 273 {
 274         struct tuner_simple_priv *priv = fe->tuner_priv;
 275
 276         switch (priv->type) {
 277         case TUNER_PHILIPS_TUV1236D:
 278                 switch (rf) {
 279                 case 1:
 280                         *cb |= 0x08;
 281                         break;
 282                 default:
 283                         *cb &= ~0x08;
 284                         break;
 285                 }
 286                 break;
 287         case TUNER_PHILIPS_ATSC:
 288                 switch (rf) {
 289                 case 1:
 290                         *cb |= 0x01;
 291                         break;
 292                 default:
 293                         *cb &= ~0x01;
 294                         break;
 295                 }
 296                 break;
 297         default:
 298                 break;
 299         }
 300 }
 301
 302 static int simple_std_setup(struct dvb_frontend *fe,
 303                             struct analog_parameters *params,
 304                             u8 *config, u8 *cb)
 305 {
 306         struct tuner_simple_priv *priv = fe->tuner_priv;
 307         u8 tuneraddr;
 308         int rc;
 309
 310         /* tv norm specific stuff for multi-norm tuners */
 311         switch (priv->type) {
 312         case TUNER_PHILIPS_SECAM: /* FI1216MF */
 313                 /* 0x01 -> ??? no change ??? */
 314                 /* 0x02 -> PAL BDGHI / SECAM L */
 315                 /* 0x04 -> ??? PAL others / SECAM others ??? */
 316                 *cb &= ~0x03;
 317                 if (params->std & V4L2_STD_SECAM_L)
 318                         /* also valid for V4L2_STD_SECAM */
 319                         *cb |= PHILIPS_MF_SET_STD_L;
 320                 else if (params->std & V4L2_STD_SECAM_LC)
 321                         *cb |= PHILIPS_MF_SET_STD_LC;
 322                 else /* V4L2_STD_B|V4L2_STD_GH */
 323                         *cb |= PHILIPS_MF_SET_STD_BG;
 324                 break;
 325
 326         case TUNER_TEMIC_4046FM5:
 327                 *cb &= ~0x0f;
 328
 329                 if (params->std & V4L2_STD_PAL_BG) {
 330                         *cb |= TEMIC_SET_PAL_BG;
 331
 332                 } else if (params->std & V4L2_STD_PAL_I) {
 333                         *cb |= TEMIC_SET_PAL_I;
 334
 335                 } else if (params->std & V4L2_STD_PAL_DK) {
 336                         *cb |= TEMIC_SET_PAL_DK;
 337
 338                 } else if (params->std & V4L2_STD_SECAM_L) {
 339                         *cb |= TEMIC_SET_PAL_L;
 340
 341                 }
 342                 break;
 343
 344         case TUNER_PHILIPS_FQ1216ME:
 345                 *cb &= ~0x0f;
 346
 347                 if (params->std & (V4L2_STD_PAL_BG|V4L2_STD_PAL_DK)) {
 348                         *cb |= PHILIPS_SET_PAL_BGDK;
 349
 350                 } else if (params->std & V4L2_STD_PAL_I) {
 351                         *cb |= PHILIPS_SET_PAL_I;
 352
 353                 } else if (params->std & V4L2_STD_SECAM_L) {
 354                         *cb |= PHILIPS_SET_PAL_L;
 355
 356                 }
 357                 break;
 358
 359         case TUNER_PHILIPS_ATSC:
 360                 /* 0x00 -> ATSC antenna input 1 */
 361                 /* 0x01 -> ATSC antenna input 2 */
 362                 /* 0x02 -> NTSC antenna input 1 */
 363                 /* 0x03 -> NTSC antenna input 2 */
 364                 *cb &= ~0x03;
 365                 if (!(params->std & V4L2_STD_ATSC))
 366                         *cb |= 2;
 367                 /* FIXME: input */
 368                 break;
 369
 370         case TUNER_MICROTUNE_4042FI5:
 371                 /* Set the charge pump for fast tuning */
 372                 *config |= TUNER_CHARGE_PUMP;
 373                 break;
 374
 375         case TUNER_PHILIPS_TUV1236D:
 376         {
 377                 /* 0x40 -> ATSC antenna input 1 */
 378                 /* 0x48 -> ATSC antenna input 2 */
 379                 /* 0x00 -> NTSC antenna input 1 */
 380                 /* 0x08 -> NTSC antenna input 2 */
 381                 u8 buffer[4] = { 0x14, 0x00, 0x17, 0x00};
 382                 *cb &= ~0x40;
 383                 if (params->std & V4L2_STD_ATSC) {
 384                         *cb |= 0x40;
 385                         buffer[1] = 0x04;
 386                 }
 387                 /* set to the correct mode (analog or digital) */
 388                 tuneraddr = priv->i2c_props.addr;
 389                 priv->i2c_props.addr = 0x0a;
 390                 rc = tuner_i2c_xfer_send(&priv->i2c_props, &buffer[0], 2);
 391                 if (2 != rc)
 392                         tuner_warn("i2c i/o error: rc == %d "
 393                                    "(should be 2)\n", rc);
 394                 rc = tuner_i2c_xfer_send(&priv->i2c_props, &buffer[2], 2);
 395                 if (2 != rc)
 396                         tuner_warn("i2c i/o error: rc == %d "
 397                                    "(should be 2)\n", rc);
 398                 priv->i2c_props.addr = tuneraddr;
 399                 /* FIXME: input */
 400                 break;
 401         }
 402         }
 403
 404         return 0;
 405 }
 406
 407 static int simple_post_tune(struct dvb_frontend *fe, u8 *buffer,
 408                             u16 div, u8 config, u8 cb)
 409 {
 410         struct tuner_simple_priv *priv = fe->tuner_priv;
 411         int rc;
 412
 413         switch (priv->type) {
 414         case TUNER_LG_TDVS_H06XF:
 415                 /* Set the Auxiliary Byte. */
 416                 buffer[0] = buffer[2];
 417                 buffer[0] &= ~0x20;
 418                 buffer[0] |= 0x18;
 419                 buffer[1] = 0x20;
 420                 tuner_dbg("tv 0x%02x 0x%02x\n", buffer[0], buffer[1]);
 421
 422                 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 2);
 423                 if (2 != rc)
 424                         tuner_warn("i2c i/o error: rc == %d "
 425                                    "(should be 2)\n", rc);
 426                 break;
 427         case TUNER_MICROTUNE_4042FI5:
 428         {
 429                 /* FIXME - this may also work for other tuners */
 430                 unsigned long timeout = jiffies + msecs_to_jiffies(1);
 431                 u8 status_byte = 0;
 432
 433                 /* Wait until the PLL locks */
 434                 for (;;) {
 435                         if (time_after(jiffies, timeout))
 436                                 return 0;
 437                         rc = tuner_i2c_xfer_recv(&priv->i2c_props,
 438                                                  &status_byte, 1);
 439                         if (1 != rc) {
 440                                 tuner_warn("i2c i/o read error: rc == %d "
 441                                            "(should be 1)\n", rc);
 442                                 break;
 443                         }
 444                         if (status_byte & TUNER_PLL_LOCKED)
 445                                 break;
 446                         udelay(10);
 447                 }
 448
 449                 /* Set the charge pump for optimized phase noise figure */
 450                 config &= ~TUNER_CHARGE_PUMP;
 451                 buffer[0] = (div>>8) & 0x7f;
 452                 buffer[1] = div      & 0xff;
 453                 buffer[2] = config;
 454                 buffer[3] = cb;
 455                 tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
 456                           buffer[0], buffer[1], buffer[2], buffer[3]);
 457
 458                 rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
 459                 if (4 != rc)
 460                         tuner_warn("i2c i/o error: rc == %d "
 461                                    "(should be 4)\n", rc);
 462                 break;
 463         }
 464         }
 465
 466         return 0;
 467 }
 468
 469 static int simple_radio_bandswitch(struct dvb_frontend *fe, u8 *buffer)
 470 {
 471         struct tuner_simple_priv *priv = fe->tuner_priv;
 472
 473         switch (priv->type) {
 474         case TUNER_TENA_9533_DI:
 475         case TUNER_YMEC_TVF_5533MF:
 476                 tuner_dbg("This tuner doesn't have FM. "
 477                           "Most cards have a TEA5767 for FM\n");
 478                 return 0;
 479         case TUNER_PHILIPS_FM1216ME_MK3:
 480         case TUNER_PHILIPS_FM1236_MK3:
 481         case TUNER_PHILIPS_FMD1216ME_MK3:
 482         case TUNER_LG_NTSC_TAPE:
 483         case TUNER_PHILIPS_FM1256_IH3:
 484                 buffer[3] = 0x19;
 485                 break;
 486         case TUNER_TNF_5335MF:
 487                 buffer[3] = 0x11;
 488                 break;
 489         case TUNER_LG_PAL_FM:
 490                 buffer[3] = 0xa5;
 491                 break;
 492         case TUNER_THOMSON_DTT761X:
 493                 buffer[3] = 0x39;
 494                 break;
 495         case TUNER_MICROTUNE_4049FM5:
 496         default:
 497                 buffer[3] = 0xa4;
 498                 break;
 499         }
 500
 501         return 0;
 502 }
 503
 504 /* ---------------------------------------------------------------------- */
 505
 506 static int simple_set_tv_freq(struct dvb_frontend *fe,
 507                               struct analog_parameters *params)
 508 {
 509         struct tuner_simple_priv *priv = fe->tuner_priv;
 510         u8 config, cb;
 511         u16 div;
 512         struct tunertype *tun;
 513         u8 buffer[4];
 514         int rc, IFPCoff, i;
 515         enum param_type desired_type;
 516         struct tuner_params *t_params;
 517
 518         tun = priv->tun;
 519
 520         /* IFPCoff = Video Intermediate Frequency - Vif:
 521                 940  =16*58.75  NTSC/J (Japan)
 522                 732  =16*45.75  M/N STD
 523                 704  =16*44     ATSC (at DVB code)
 524                 632  =16*39.50  I U.K.
 525                 622.4=16*38.90  B/G D/K I, L STD
 526                 592  =16*37.00  D China
 527                 590  =16.36.875 B Australia
 528                 543.2=16*33.95  L' STD
 529                 171.2=16*10.70  FM Radio (at set_radio_freq)
 530         */
 531
 532         if (params->std == V4L2_STD_NTSC_M_JP) {
 533                 IFPCoff      = 940;
 534                 desired_type = TUNER_PARAM_TYPE_NTSC;
 535         } else if ((params->std & V4L2_STD_MN) &&
 536                   !(params->std & ~V4L2_STD_MN)) {
 537                 IFPCoff      = 732;
 538                 desired_type = TUNER_PARAM_TYPE_NTSC;
 539         } else if (params->std == V4L2_STD_SECAM_LC) {
 540                 IFPCoff      = 543;
 541                 desired_type = TUNER_PARAM_TYPE_SECAM;
 542         } else {
 543                 IFPCoff      = 623;
 544                 desired_type = TUNER_PARAM_TYPE_PAL;
 545         }
 546
 547         t_params = simple_tuner_params(fe, desired_type);
 548
 549         i = simple_config_lookup(fe, t_params, &params->frequency,
 550                                  &config, &cb);
 551
 552         div = params->frequency + IFPCoff + offset;
 553
 554         tuner_dbg("Freq= %d.%02d MHz, V_IF=%d.%02d MHz, "
 555                   "Offset=%d.%02d MHz, div=%0d\n",
 556                   params->frequency / 16, params->frequency % 16 * 100 / 16,
 557                   IFPCoff / 16, IFPCoff % 16 * 100 / 16,
 558                   offset / 16, offset % 16 * 100 / 16, div);
 559
 560         /* tv norm specific stuff for multi-norm tuners */
 561         simple_std_setup(fe, params, &config, &cb);
 562
 563         if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
 564                 buffer[0] = config;
 565                 buffer[1] = cb;
 566                 buffer[2] = (div>>8) & 0x7f;
 567                 buffer[3] = div      & 0xff;
 568         } else {
 569                 buffer[0] = (div>>8) & 0x7f;
 570                 buffer[1] = div      & 0xff;
 571                 buffer[2] = config;
 572                 buffer[3] = cb;
 573         }
 574         priv->last_div = div;
 575         if (t_params->has_tda9887) {
 576                 struct v4l2_priv_tun_config tda9887_cfg;
 577                 int config = 0;
 578                 int is_secam_l = (params->std & (V4L2_STD_SECAM_L |
 579                                                  V4L2_STD_SECAM_LC)) &&
 580                         !(params->std & ~(V4L2_STD_SECAM_L |
 581                                           V4L2_STD_SECAM_LC));
 582
 583                 tda9887_cfg.tuner = TUNER_TDA9887;
 584                 tda9887_cfg.priv  = &config;
 585
 586                 if (params->std == V4L2_STD_SECAM_LC) {
 587                         if (t_params->port1_active ^ t_params->port1_invert_for_secam_lc)
 588                                 config |= TDA9887_PORT1_ACTIVE;
 589                         if (t_params->port2_active ^ t_params->port2_invert_for_secam_lc)
 590                                 config |= TDA9887_PORT2_ACTIVE;
 591                 } else {
 592                         if (t_params->port1_active)
 593                                 config |= TDA9887_PORT1_ACTIVE;
 594                         if (t_params->port2_active)
 595                                 config |= TDA9887_PORT2_ACTIVE;
 596                 }
 597                 if (t_params->intercarrier_mode)
 598                         config |= TDA9887_INTERCARRIER;
 599                 if (is_secam_l) {
 600                         if (i == 0 && t_params->default_top_secam_low)
 601                                 config |= TDA9887_TOP(t_params->default_top_secam_low);
 602                         else if (i == 1 && t_params->default_top_secam_mid)
 603                                 config |= TDA9887_TOP(t_params->default_top_secam_mid);
 604                         else if (t_params->default_top_secam_high)
 605                                 config |= TDA9887_TOP(t_params->default_top_secam_high);
 606                 } else {
 607                         if (i == 0 && t_params->default_top_low)
 608                                 config |= TDA9887_TOP(t_params->default_top_low);
 609                         else if (i == 1 && t_params->default_top_mid)
 610                                 config |= TDA9887_TOP(t_params->default_top_mid);
 611                         else if (t_params->default_top_high)
 612                                 config |= TDA9887_TOP(t_params->default_top_high);
 613                 }
 614                 if (t_params->default_pll_gating_18)
 615                         config |= TDA9887_GATING_18;
 616                 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
 617                                     &tda9887_cfg);
 618         }
 619         tuner_dbg("tv 0x%02x 0x%02x 0x%02x 0x%02x\n",
 620                   buffer[0], buffer[1], buffer[2], buffer[3]);
 621
 622         rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
 623         if (4 != rc)
 624                 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
 625
 626         simple_post_tune(fe, &buffer[0], div, config, cb);
 627
 628         return 0;
 629 }
 630
 631 static int simple_set_radio_freq(struct dvb_frontend *fe,
 632                                  struct analog_parameters *params)
 633 {
 634         struct tunertype *tun;
 635         struct tuner_simple_priv *priv = fe->tuner_priv;
 636         u8 buffer[4];
 637         u16 div;
 638         int rc, j;
 639         struct tuner_params *t_params;
 640         unsigned int freq = params->frequency;
 641
 642         tun = priv->tun;
 643
 644         for (j = tun->count-1; j > 0; j--)
 645                 if (tun->params[j].type == TUNER_PARAM_TYPE_RADIO)
 646                         break;
 647         /* default t_params (j=0) will be used if desired type wasn't found */
 648         t_params = &tun->params[j];
 649
 650         /* Select Radio 1st IF used */
 651         switch (t_params->radio_if) {
 652         case 0: /* 10.7 MHz */
 653                 freq += (unsigned int)(10.7*16000);
 654                 break;
 655         case 1: /* 33.3 MHz */
 656                 freq += (unsigned int)(33.3*16000);
 657                 break;
 658         case 2: /* 41.3 MHz */
 659                 freq += (unsigned int)(41.3*16000);
 660                 break;
 661         default:
 662                 tuner_warn("Unsupported radio_if value %d\n",
 663                            t_params->radio_if);
 664                 return 0;
 665         }
 666
 667         /* Bandswitch byte */
 668         simple_radio_bandswitch(fe, &buffer[0]);
 669
 670         buffer[2] = (t_params->ranges[0].config & ~TUNER_RATIO_MASK) |
 671                     TUNER_RATIO_SELECT_50; /* 50 kHz step */
 672
 673         /* Convert from 1/16 kHz V4L steps to 1/20 MHz (=50 kHz) PLL steps
 674            freq * (1 Mhz / 16000 V4L steps) * (20 PLL steps / 1 MHz) =
 675            freq * (1/800) */
 676         div = (freq + 400) / 800;
 677
 678         if (t_params->cb_first_if_lower_freq && div < priv->last_div) {
 679                 buffer[0] = buffer[2];
 680                 buffer[1] = buffer[3];
 681                 buffer[2] = (div>>8) & 0x7f;
 682                 buffer[3] = div      & 0xff;
 683         } else {
 684                 buffer[0] = (div>>8) & 0x7f;
 685                 buffer[1] = div      & 0xff;
 686         }
 687
 688         tuner_dbg("radio 0x%02x 0x%02x 0x%02x 0x%02x\n",
 689                buffer[0], buffer[1], buffer[2], buffer[3]);
 690         priv->last_div = div;
 691
 692         if (t_params->has_tda9887) {
 693                 int config = 0;
 694                 struct v4l2_priv_tun_config tda9887_cfg;
 695
 696                 tda9887_cfg.tuner = TUNER_TDA9887;
 697                 tda9887_cfg.priv = &config;
 698
 699                 if (t_params->port1_active &&
 700                     !t_params->port1_fm_high_sensitivity)
 701                         config |= TDA9887_PORT1_ACTIVE;
 702                 if (t_params->port2_active &&
 703                     !t_params->port2_fm_high_sensitivity)
 704                         config |= TDA9887_PORT2_ACTIVE;
 705                 if (t_params->intercarrier_mode)
 706                         config |= TDA9887_INTERCARRIER;
 707 /*              if (t_params->port1_set_for_fm_mono)
 708                         config &= ~TDA9887_PORT1_ACTIVE;*/
 709                 if (t_params->fm_gain_normal)
 710                         config |= TDA9887_GAIN_NORMAL;
 711                 if (t_params->radio_if == 2)
 712                         config |= TDA9887_RIF_41_3;
 713                 i2c_clients_command(priv->i2c_props.adap, TUNER_SET_CONFIG,
 714                                     &tda9887_cfg);
 715         }
 716         rc = tuner_i2c_xfer_send(&priv->i2c_props, buffer, 4);
 717         if (4 != rc)
 718                 tuner_warn("i2c i/o error: rc == %d (should be 4)\n", rc);
 719
 720         return 0;
 721 }
 722
 723 static int simple_set_params(struct dvb_frontend *fe,
 724                              struct analog_parameters *params)
 725 {
 726         struct tuner_simple_priv *priv = fe->tuner_priv;
 727         int ret = -EINVAL;
 728
 729         if (priv->i2c_props.adap == NULL)
 730                 return -EINVAL;
 731
 732         switch (params->mode) {
 733         case V4L2_TUNER_RADIO:
 734                 ret = simple_set_radio_freq(fe, params);
 735                 priv->frequency = params->frequency * 125 / 2;
 736                 break;
 737         case V4L2_TUNER_ANALOG_TV:
 738         case V4L2_TUNER_DIGITAL_TV:
 739                 ret = simple_set_tv_freq(fe, params);
 740                 priv->frequency = params->frequency * 62500;
 741                 break;
 742         }
 743         priv->bandwidth = 0;
 744
 745         return ret;
 746 }
 747
 748 static void simple_set_dvb(struct dvb_frontend *fe, u8 *buf,
 749                            const struct dvb_frontend_parameters *params)
 750 {
 751         struct tuner_simple_priv *priv = fe->tuner_priv;
 752
 753         switch (priv->type) {
 754         case TUNER_PHILIPS_FMD1216ME_MK3:
 755                 if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ &&
 756                     params->frequency >= 158870000)
 757                         buf[3] |= 0x08;
 758                 break;
 759         case TUNER_PHILIPS_TUV1236D:
 760         case TUNER_PHILIPS_ATSC:
 761         {
 762                 unsigned int new_rf;
 763
 764                 switch (params->u.vsb.modulation) {
 765                 case QAM_64:
 766                 case QAM_256:
 767                         new_rf = 1;
 768                         break;
 769                 case VSB_8:
 770                 default:
 771                         new_rf = 0;
 772                         break;
 773                 }
 774                 simple_set_rf_input(fe, &buf[2], &buf[3], new_rf);
 775                 break;
 776         }
 777         default:
 778                 break;
 779         }
 780 }
 781
 782 static int simple_dvb_configure(struct dvb_frontend *fe, u8 *buf,
 783                                 const struct dvb_frontend_parameters *params)
 784 {
 785         struct tuner_simple_priv *priv = fe->tuner_priv;
 786         struct tunertype *tun = priv->tun;
 787         static struct tuner_params *t_params;
 788         u8 config, cb;
 789         u32 div;
 790         int ret, frequency = params->frequency / 62500;
 791
 792         t_params = simple_tuner_params(fe, TUNER_PARAM_TYPE_DIGITAL);
 793         ret = simple_config_lookup(fe, t_params, &frequency, &config, &cb);
 794         if (ret < 0)
 795                 return ret;
 796
 797         div = ((frequency + t_params->iffreq) * 62500 + offset +
 798                tun->stepsize/2) / tun->stepsize;
 799
 800         buf[0] = div >> 8;
 801         buf[1] = div & 0xff;
 802         buf[2] = config;
 803         buf[3] = cb;
 804
 805         simple_set_dvb(fe, buf, params);
 806
 807         tuner_dbg("%s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
 808                   tun->name, div, buf[0], buf[1], buf[2], buf[3]);
 809
 810         /* calculate the frequency we set it to */
 811         return (div * tun->stepsize) - t_params->iffreq;
 812 }
 813
 814 static int simple_dvb_calc_regs(struct dvb_frontend *fe,
 815                                 struct dvb_frontend_parameters *params,
 816                                 u8 *buf, int buf_len)
 817 {
 818         struct tuner_simple_priv *priv = fe->tuner_priv;
 819         int ret;
 820         u32 frequency;
 821
 822         if (buf_len < 5)
 823                 return -EINVAL;
 824
 825         ret = simple_dvb_configure(fe, buf+1, params);
 826         if (ret < 0)
 827                 return ret;
 828         else
 829                 frequency = ret;
 830
 831         buf[0] = priv->i2c_props.addr;
 832
 833         priv->frequency = frequency;
 834         priv->bandwidth = (fe->ops.info.type == FE_OFDM) ?
 835                 params->u.ofdm.bandwidth : 0;
 836
 837         return 5;
 838 }
 839
 840 static int simple_dvb_set_params(struct dvb_frontend *fe,
 841                                  struct dvb_frontend_parameters *params)
 842 {
 843         struct tuner_simple_priv *priv = fe->tuner_priv;
 844         u32 prev_freq, prev_bw;
 845         int ret;
 846         u8 buf[5];
 847
 848         if (priv->i2c_props.adap == NULL)
 849                 return -EINVAL;
 850
 851         prev_freq = priv->frequency;
 852         prev_bw   = priv->bandwidth;
 853
 854         ret = simple_dvb_calc_regs(fe, params, buf, 5);
 855         if (ret != 5)
 856                 goto fail;
 857
 858         /* put analog demod in standby when tuning digital */
 859         if (fe->ops.analog_ops.standby)
 860                 fe->ops.analog_ops.standby(fe);
 861
 862         if (fe->ops.i2c_gate_ctrl)
 863                 fe->ops.i2c_gate_ctrl(fe, 1);
 864
 865         /* buf[0] contains the i2c address, but *
 866          * we already have it in i2c_props.addr */
 867         ret = tuner_i2c_xfer_send(&priv->i2c_props, buf+1, 4);
 868         if (ret != 4)
 869                 goto fail;
 870
 871         return 0;
 872 fail:
 873         /* calc_regs sets frequency and bandwidth. if we failed, unset them */
 874         priv->frequency = prev_freq;
 875         priv->bandwidth = prev_bw;
 876
 877         return ret;
 878 }
 879
 880 static int simple_init(struct dvb_frontend *fe)
 881 {
 882         struct tuner_simple_priv *priv = fe->tuner_priv;
 883
 884         if (priv->i2c_props.adap == NULL)
 885                 return -EINVAL;
 886
 887         if (priv->tun->initdata) {
 888                 int ret;
 889
 890                 if (fe->ops.i2c_gate_ctrl)
 891                         fe->ops.i2c_gate_ctrl(fe, 1);
 892
 893                 ret = tuner_i2c_xfer_send(&priv->i2c_props,
 894                                           priv->tun->initdata + 1,
 895                                           priv->tun->initdata[0]);
 896                 if (ret != priv->tun->initdata[0])
 897                         return ret;
 898         }
 899
 900         return 0;
 901 }
 902
 903 static int simple_sleep(struct dvb_frontend *fe)
 904 {
 905         struct tuner_simple_priv *priv = fe->tuner_priv;
 906
 907         if (priv->i2c_props.adap == NULL)
 908                 return -EINVAL;
 909
 910         if (priv->tun->sleepdata) {
 911                 int ret;
 912
 913                 if (fe->ops.i2c_gate_ctrl)
 914                         fe->ops.i2c_gate_ctrl(fe, 1);
 915
 916                 ret = tuner_i2c_xfer_send(&priv->i2c_props,
 917                                           priv->tun->sleepdata + 1,
 918                                           priv->tun->sleepdata[0]);
 919                 if (ret != priv->tun->sleepdata[0])
 920                         return ret;
 921         }
 922
 923         return 0;
 924 }
 925
 926 static int simple_release(struct dvb_frontend *fe)
 927 {
 928         struct tuner_simple_priv *priv = fe->tuner_priv;
 929
 930         mutex_lock(&tuner_simple_list_mutex);
 931
 932         if (priv)
 933                 hybrid_tuner_release_state(priv);
 934
 935         mutex_unlock(&tuner_simple_list_mutex);
 936
 937         fe->tuner_priv = NULL;
 938
 939         return 0;
 940 }
 941
 942 static int simple_get_frequency(struct dvb_frontend *fe, u32 *frequency)
 943 {
 944         struct tuner_simple_priv *priv = fe->tuner_priv;
 945         *frequency = priv->frequency;
 946         return 0;
 947 }
 948
 949 static int simple_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
 950 {
 951         struct tuner_simple_priv *priv = fe->tuner_priv;
 952         *bandwidth = priv->bandwidth;
 953         return 0;
 954 }
 955
 956 static struct dvb_tuner_ops simple_tuner_ops = {
 957         .init              = simple_init,
 958         .sleep             = simple_sleep,
 959         .set_analog_params = simple_set_params,
 960         .set_params        = simple_dvb_set_params,
 961         .calc_regs         = simple_dvb_calc_regs,
 962         .release           = simple_release,
 963         .get_frequency     = simple_get_frequency,
 964         .get_bandwidth     = simple_get_bandwidth,
 965         .get_status        = simple_get_status,
 966         .get_rf_strength   = simple_get_rf_strength,
 967 };
 968
 969 struct dvb_frontend *simple_tuner_attach(struct dvb_frontend *fe,
 970                                          struct i2c_adapter *i2c_adap,
 971                                          u8 i2c_addr,
 972                                          unsigned int type)
 973 {
 974         struct tuner_simple_priv *priv = NULL;
 975         int instance;
 976
 977         if (type >= tuner_count) {
 978                 printk(KERN_WARNING "%s: invalid tuner type: %d (max: %d)\n",
 979                        __FUNCTION__, type, tuner_count-1);
 980                 return NULL;
 981         }
 982
 983         mutex_lock(&tuner_simple_list_mutex);
 984
 985         instance = hybrid_tuner_request_state(struct tuner_simple_priv, priv,
 986                                               hybrid_tuner_instance_list,
 987                                               i2c_adap, i2c_addr,
 988                                               "tuner-simple");
 989         switch (instance) {
 990         case 0:
 991                 mutex_unlock(&tuner_simple_list_mutex);
 992                 return NULL;
 993                 break;
 994         case 1:
 995                 fe->tuner_priv = priv;
 996
 997                 priv->type = type;
 998                 priv->tun  = &tuners[type];
 999                 break;
1000         default:
1001                 fe->tuner_priv = priv;
1002                 break;
1003         }
1004
1005         mutex_unlock(&tuner_simple_list_mutex);
1006
1007         memcpy(&fe->ops.tuner_ops, &simple_tuner_ops,
1008                sizeof(struct dvb_tuner_ops));
1009
1010         tuner_info("type set to %d (%s)\n", type, priv->tun->name);
1011
1012         strlcpy(fe->ops.tuner_ops.info.name, priv->tun->name,
1013                 sizeof(fe->ops.tuner_ops.info.name));
1014
1015         return fe;
1016 }
1017 EXPORT_SYMBOL_GPL(simple_tuner_attach);
1018
1019 MODULE_DESCRIPTION("Simple 4-control-bytes style tuner driver");
1020 MODULE_AUTHOR("Ralph Metzler, Gerd Knorr, Gunther Mayer");
1021 MODULE_LICENSE("GPL");
1022
1023 /*
1024  * Overrides for Emacs so that we follow Linus's tabbing style.
1025  * ---------------------------------------------------------------------------
1026  * Local variables:
1027  * c-basic-offset: 8
1028  * End:
1029  */