SAFE public projects git trees. - safe/jmp/linux-2.6/blob - drivers/media/dvb/frontends/dvb-pll.c

   1 /*
   2  * descriptions + helper functions for simple dvb plls.
   3  *
   4  * (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
   5  *
   6  *  This program is free software; you can redistribute it and/or modify
   7  *  it under the terms of the GNU General Public License as published by
   8  *  the Free Software Foundation; either version 2 of the License, or
   9  *  (at your option) any later version.
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  19  */
  20
  21 #include <linux/module.h>
  22 #include <linux/dvb/frontend.h>
  23 #include <asm/types.h>
  24
  25 #include "dvb-pll.h"
  26
  27 struct dvb_pll_priv {
  28         /* pll number */
  29         int nr;
  30
  31         /* i2c details */
  32         int pll_i2c_address;
  33         struct i2c_adapter *i2c;
  34
  35         /* the PLL descriptor */
  36         struct dvb_pll_desc *pll_desc;
  37
  38         /* cached frequency/bandwidth */
  39         u32 frequency;
  40         u32 bandwidth;
  41 };
  42
  43 #define DVB_PLL_MAX 64
  44
  45 static unsigned int dvb_pll_devcount;
  46
  47 static int debug;
  48 module_param(debug, int, 0644);
  49 MODULE_PARM_DESC(debug, "enable verbose debug messages");
  50
  51 static unsigned int input[DVB_PLL_MAX] = { [ 0 ... (DVB_PLL_MAX-1) ] = 0 };
  52 module_param_array(input, int, NULL, 0644);
  53 MODULE_PARM_DESC(input,"specify rf input choice, 0 for autoselect (default)");
  54
  55 static unsigned int id[DVB_PLL_MAX] =
  56         { [ 0 ... (DVB_PLL_MAX-1) ] = DVB_PLL_UNDEFINED };
  57 module_param_array(id, int, NULL, 0644);
  58 MODULE_PARM_DESC(id, "force pll id to use (DEBUG ONLY)");
  59
  60 /* ----------------------------------------------------------- */
  61
  62 struct dvb_pll_desc {
  63         char *name;
  64         u32  min;
  65         u32  max;
  66         u32  iffreq;
  67         void (*set)(struct dvb_frontend *fe, u8 *buf,
  68                     const struct dvb_frontend_parameters *params);
  69         u8   *initdata;
  70         u8   *sleepdata;
  71         int  count;
  72         struct {
  73                 u32 limit;
  74                 u32 stepsize;
  75                 u8  config;
  76                 u8  cb;
  77         } entries[12];
  78 };
  79
  80 /* ----------------------------------------------------------- */
  81 /* descriptions                                                */
  82
  83 /* Set AGC TOP value to 103 dBuV:
  84         0x80 = Control Byte
  85         0x40 = 250 uA charge pump (irrelevant)
  86         0x18 = Aux Byte to follow
  87         0x06 = 64.5 kHz divider (irrelevant)
  88         0x01 = Disable Vt (aka sleep)
  89
  90         0x00 = AGC Time constant 2s Iagc = 300 nA (vs 0x80 = 9 nA)
  91         0x50 = AGC Take over point = 103 dBuV */
  92 static u8 tua603x_agc103[] = { 2, 0x80|0x40|0x18|0x06|0x01, 0x00|0x50 };
  93
  94 /*      0x04 = 166.67 kHz divider
  95
  96         0x80 = AGC Time constant 50ms Iagc = 9 uA
  97         0x20 = AGC Take over point = 112 dBuV */
  98 static u8 tua603x_agc112[] = { 2, 0x80|0x40|0x18|0x04|0x01, 0x80|0x20 };
  99
 100 static struct dvb_pll_desc dvb_pll_thomson_dtt7579 = {
 101         .name  = "Thomson dtt7579",
 102         .min   = 177000000,
 103         .max   = 858000000,
 104         .iffreq= 36166667,
 105         .sleepdata = (u8[]){ 2, 0xb4, 0x03 },
 106         .count = 4,
 107         .entries = {
 108                 {  443250000, 166667, 0xb4, 0x02 },
 109                 {  542000000, 166667, 0xb4, 0x08 },
 110                 {  771000000, 166667, 0xbc, 0x08 },
 111                 {  999999999, 166667, 0xf4, 0x08 },
 112         },
 113 };
 114
 115
 116 static void thomson_dtt759x_bw(struct dvb_frontend *fe, u8 *buf,
 117                                const struct dvb_frontend_parameters *params)
 118 {
 119         if (BANDWIDTH_7_MHZ == params->u.ofdm.bandwidth)
 120                 buf[3] |= 0x10;
 121 }
 122
 123 static struct dvb_pll_desc dvb_pll_thomson_dtt759x = {
 124         .name  = "Thomson dtt759x",
 125         .min   = 177000000,
 126         .max   = 896000000,
 127         .set   = thomson_dtt759x_bw,
 128         .iffreq= 36166667,
 129         .sleepdata = (u8[]){ 2, 0x84, 0x03 },
 130         .count = 5,
 131         .entries = {
 132                 {  264000000, 166667, 0xb4, 0x02 },
 133                 {  470000000, 166667, 0xbc, 0x02 },
 134                 {  735000000, 166667, 0xbc, 0x08 },
 135                 {  835000000, 166667, 0xf4, 0x08 },
 136                 {  999999999, 166667, 0xfc, 0x08 },
 137         },
 138 };
 139
 140 static struct dvb_pll_desc dvb_pll_lg_z201 = {
 141         .name  = "LG z201",
 142         .min   = 174000000,
 143         .max   = 862000000,
 144         .iffreq= 36166667,
 145         .sleepdata = (u8[]){ 2, 0xbc, 0x03 },
 146         .count = 5,
 147         .entries = {
 148                 {  157500000, 166667, 0xbc, 0x01 },
 149                 {  443250000, 166667, 0xbc, 0x02 },
 150                 {  542000000, 166667, 0xbc, 0x04 },
 151                 {  830000000, 166667, 0xf4, 0x04 },
 152                 {  999999999, 166667, 0xfc, 0x04 },
 153         },
 154 };
 155
 156
 157 static struct dvb_pll_desc dvb_pll_unknown_1 = {
 158         .name  = "unknown 1", /* used by dntv live dvb-t */
 159         .min   = 174000000,
 160         .max   = 862000000,
 161         .iffreq= 36166667,
 162         .count = 9,
 163         .entries = {
 164                 {  150000000, 166667, 0xb4, 0x01 },
 165                 {  173000000, 166667, 0xbc, 0x01 },
 166                 {  250000000, 166667, 0xb4, 0x02 },
 167                 {  400000000, 166667, 0xbc, 0x02 },
 168                 {  420000000, 166667, 0xf4, 0x02 },
 169                 {  470000000, 166667, 0xfc, 0x02 },
 170                 {  600000000, 166667, 0xbc, 0x08 },
 171                 {  730000000, 166667, 0xf4, 0x08 },
 172                 {  999999999, 166667, 0xfc, 0x08 },
 173         },
 174 };
 175
 176 /* Infineon TUA6010XS
 177  * used in Thomson Cable Tuner
 178  */
 179 static struct dvb_pll_desc dvb_pll_tua6010xs = {
 180         .name  = "Infineon TUA6010XS",
 181         .min   =  44250000,
 182         .max   = 858000000,
 183         .iffreq= 36125000,
 184         .count = 3,
 185         .entries = {
 186                 {  115750000, 62500, 0x8e, 0x03 },
 187                 {  403250000, 62500, 0x8e, 0x06 },
 188                 {  999999999, 62500, 0x8e, 0x85 },
 189         },
 190 };
 191
 192 /* Panasonic env57h1xd5 (some Philips PLL ?) */
 193 static struct dvb_pll_desc dvb_pll_env57h1xd5 = {
 194         .name  = "Panasonic ENV57H1XD5",
 195         .min   =  44250000,
 196         .max   = 858000000,
 197         .iffreq= 36125000,
 198         .count = 4,
 199         .entries = {
 200                 {  153000000, 166667, 0xc2, 0x41 },
 201                 {  470000000, 166667, 0xc2, 0x42 },
 202                 {  526000000, 166667, 0xc2, 0x84 },
 203                 {  999999999, 166667, 0xc2, 0xa4 },
 204         },
 205 };
 206
 207 /* Philips TDA6650/TDA6651
 208  * used in Panasonic ENV77H11D5
 209  */
 210 static void tda665x_bw(struct dvb_frontend *fe, u8 *buf,
 211                        const struct dvb_frontend_parameters *params)
 212 {
 213         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 214                 buf[3] |= 0x08;
 215 }
 216
 217 static struct dvb_pll_desc dvb_pll_tda665x = {
 218         .name  = "Philips TDA6650/TDA6651",
 219         .min   =  44250000,
 220         .max   = 858000000,
 221         .set   = tda665x_bw,
 222         .iffreq= 36166667,
 223         .initdata = (u8[]){ 4, 0x0b, 0xf5, 0x85, 0xab },
 224         .count = 12,
 225         .entries = {
 226                 {   93834000, 166667, 0xca, 0x61 /* 011 0 0 0  01 */ },
 227                 {  123834000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 228                 {  161000000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 229                 {  163834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 230                 {  253834000, 166667, 0xca, 0x62 /* 011 0 0 0  10 */ },
 231                 {  383834000, 166667, 0xca, 0xa2 /* 101 0 0 0  10 */ },
 232                 {  443834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 233                 {  444000000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
 234                 {  583834000, 166667, 0xca, 0x64 /* 011 0 0 1  00 */ },
 235                 {  793834000, 166667, 0xca, 0xa4 /* 101 0 0 1  00 */ },
 236                 {  444834000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
 237                 {  861000000, 166667, 0xca, 0xe4 /* 111 0 0 1  00 */ },
 238         }
 239 };
 240
 241 /* Infineon TUA6034
 242  * used in LG TDTP E102P
 243  */
 244 static void tua6034_bw(struct dvb_frontend *fe, u8 *buf,
 245                        const struct dvb_frontend_parameters *params)
 246 {
 247         if (BANDWIDTH_7_MHZ != params->u.ofdm.bandwidth)
 248                 buf[3] |= 0x08;
 249 }
 250
 251 static struct dvb_pll_desc dvb_pll_tua6034 = {
 252         .name  = "Infineon TUA6034",
 253         .min   =  44250000,
 254         .max   = 858000000,
 255         .iffreq= 36166667,
 256         .count = 3,
 257         .set   = tua6034_bw,
 258         .entries = {
 259                 {  174500000, 62500, 0xce, 0x01 },
 260                 {  230000000, 62500, 0xce, 0x02 },
 261                 {  999999999, 62500, 0xce, 0x04 },
 262         },
 263 };
 264
 265 /* Infineon TUA6034
 266  * used in LG TDVS-H061F, LG TDVS-H062F and LG TDVS-H064F
 267  */
 268 static struct dvb_pll_desc dvb_pll_lg_tdvs_h06xf = {
 269         .name  = "LG TDVS-H06xF",
 270         .min   =  54000000,
 271         .max   = 863000000,
 272         .iffreq= 44000000,
 273         .initdata = tua603x_agc103,
 274         .count = 3,
 275         .entries = {
 276                 {  165000000, 62500, 0xce, 0x01 },
 277                 {  450000000, 62500, 0xce, 0x02 },
 278                 {  999999999, 62500, 0xce, 0x04 },
 279         },
 280 };
 281
 282 /* Philips FMD1216ME
 283  * used in Medion Hybrid PCMCIA card and USB Box
 284  */
 285 static void fmd1216me_bw(struct dvb_frontend *fe, u8 *buf,
 286                          const struct dvb_frontend_parameters *params)
 287 {
 288         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ &&
 289             params->frequency >= 158870000)
 290                 buf[3] |= 0x08;
 291 }
 292
 293 static struct dvb_pll_desc dvb_pll_fmd1216me = {
 294         .name = "Philips FMD1216ME",
 295         .min = 50870000,
 296         .max = 858000000,
 297         .iffreq= 36125000,
 298         .set   = fmd1216me_bw,
 299         .initdata = tua603x_agc112,
 300         .sleepdata = (u8[]){ 4, 0x9c, 0x60, 0x85, 0x54 },
 301         .count = 7,
 302         .entries = {
 303                 { 143870000, 166667, 0xbc, 0x41 },
 304                 { 158870000, 166667, 0xf4, 0x41 },
 305                 { 329870000, 166667, 0xbc, 0x42 },
 306                 { 441870000, 166667, 0xf4, 0x42 },
 307                 { 625870000, 166667, 0xbc, 0x44 },
 308                 { 803870000, 166667, 0xf4, 0x44 },
 309                 { 999999999, 166667, 0xfc, 0x44 },
 310         }
 311 };
 312
 313 /* ALPS TDED4
 314  * used in Nebula-Cards and USB boxes
 315  */
 316 static void tded4_bw(struct dvb_frontend *fe, u8 *buf,
 317                      const struct dvb_frontend_parameters *params)
 318 {
 319         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 320                 buf[3] |= 0x04;
 321 }
 322
 323 static struct dvb_pll_desc dvb_pll_tded4 = {
 324         .name = "ALPS TDED4",
 325         .min = 47000000,
 326         .max = 863000000,
 327         .iffreq= 36166667,
 328         .set   = tded4_bw,
 329         .count = 4,
 330         .entries = {
 331                 { 153000000, 166667, 0x85, 0x01 },
 332                 { 470000000, 166667, 0x85, 0x02 },
 333                 { 823000000, 166667, 0x85, 0x08 },
 334                 { 999999999, 166667, 0x85, 0x88 },
 335         }
 336 };
 337
 338 /* ALPS TDHU2
 339  * used in AverTVHD MCE A180
 340  */
 341 static struct dvb_pll_desc dvb_pll_tdhu2 = {
 342         .name = "ALPS TDHU2",
 343         .min = 54000000,
 344         .max = 864000000,
 345         .iffreq= 44000000,
 346         .count = 4,
 347         .entries = {
 348                 { 162000000, 62500, 0x85, 0x01 },
 349                 { 426000000, 62500, 0x85, 0x02 },
 350                 { 782000000, 62500, 0x85, 0x08 },
 351                 { 999999999, 62500, 0x85, 0x88 },
 352         }
 353 };
 354
 355 /* Philips TUV1236D
 356  * used in ATI HDTV Wonder
 357  */
 358 static void tuv1236d_rf(struct dvb_frontend *fe, u8 *buf,
 359                         const struct dvb_frontend_parameters *params)
 360 {
 361         struct dvb_pll_priv *priv = fe->tuner_priv;
 362         unsigned int new_rf = input[priv->nr];
 363
 364         if ((new_rf == 0) || (new_rf > 2)) {
 365                 switch (params->u.vsb.modulation) {
 366                         case QAM_64:
 367                         case QAM_256:
 368                                 new_rf = 1;
 369                                 break;
 370                         case VSB_8:
 371                         default:
 372                                 new_rf = 2;
 373                 }
 374         }
 375
 376         switch (new_rf) {
 377                 case 1:
 378                         buf[3] |= 0x08;
 379                         break;
 380                 case 2:
 381                         buf[3] &= ~0x08;
 382                         break;
 383                 default:
 384                         printk(KERN_WARNING
 385                                "%s: unhandled rf input selection: %d",
 386                                __FUNCTION__, new_rf);
 387         }
 388 }
 389
 390 static struct dvb_pll_desc dvb_pll_tuv1236d = {
 391         .name  = "Philips TUV1236D",
 392         .min   =  54000000,
 393         .max   = 864000000,
 394         .iffreq= 44000000,
 395         .set   = tuv1236d_rf,
 396         .count = 3,
 397         .entries = {
 398                 { 157250000, 62500, 0xc6, 0x41 },
 399                 { 454000000, 62500, 0xc6, 0x42 },
 400                 { 999999999, 62500, 0xc6, 0x44 },
 401         },
 402 };
 403
 404 /* Samsung TBMV30111IN / TBMV30712IN1
 405  * used in Air2PC ATSC - 2nd generation (nxt2002)
 406  */
 407 static struct dvb_pll_desc dvb_pll_samsung_tbmv = {
 408         .name = "Samsung TBMV30111IN / TBMV30712IN1",
 409         .min = 54000000,
 410         .max = 860000000,
 411         .iffreq= 44000000,
 412         .count = 6,
 413         .entries = {
 414                 { 172000000, 166667, 0xb4, 0x01 },
 415                 { 214000000, 166667, 0xb4, 0x02 },
 416                 { 467000000, 166667, 0xbc, 0x02 },
 417                 { 721000000, 166667, 0xbc, 0x08 },
 418                 { 841000000, 166667, 0xf4, 0x08 },
 419                 { 999999999, 166667, 0xfc, 0x02 },
 420         }
 421 };
 422
 423 /*
 424  * Philips SD1878 Tuner.
 425  */
 426 static struct dvb_pll_desc dvb_pll_philips_sd1878_tda8261 = {
 427         .name  = "Philips SD1878",
 428         .min   =  950000,
 429         .max   = 2150000,
 430         .iffreq= 249, /* zero-IF, offset 249 is to round up */
 431         .count = 4,
 432         .entries = {
 433                 { 1250000, 500, 0xc4, 0x00},
 434                 { 1550000, 500, 0xc4, 0x40},
 435                 { 2050000, 500, 0xc4, 0x80},
 436                 { 2150000, 500, 0xc4, 0xc0},
 437         },
 438 };
 439
 440 /*
 441  * Philips TD1316 Tuner.
 442  */
 443 static void td1316_bw(struct dvb_frontend *fe, u8 *buf,
 444                       const struct dvb_frontend_parameters *params)
 445 {
 446         u8 band;
 447
 448         /* determine band */
 449         if (params->frequency < 161000000)
 450                 band = 1;
 451         else if (params->frequency < 444000000)
 452                 band = 2;
 453         else
 454                 band = 4;
 455
 456         buf[3] |= band;
 457
 458         /* setup PLL filter */
 459         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 460                 buf[3] |= 1 << 3;
 461 }
 462
 463 static struct dvb_pll_desc dvb_pll_philips_td1316 = {
 464         .name  = "Philips TD1316",
 465         .min   =  87000000,
 466         .max   = 895000000,
 467         .iffreq= 36166667,
 468         .set   = td1316_bw,
 469         .count = 9,
 470         .entries = {
 471                 {  93834000, 166667, 0xca, 0x60},
 472                 { 123834000, 166667, 0xca, 0xa0},
 473                 { 163834000, 166667, 0xca, 0xc0},
 474                 { 253834000, 166667, 0xca, 0x60},
 475                 { 383834000, 166667, 0xca, 0xa0},
 476                 { 443834000, 166667, 0xca, 0xc0},
 477                 { 583834000, 166667, 0xca, 0x60},
 478                 { 793834000, 166667, 0xca, 0xa0},
 479                 { 858834000, 166667, 0xca, 0xe0},
 480         },
 481 };
 482
 483
 484 static void opera1_bw(struct dvb_frontend *fe, u8 *buf,
 485                       const struct dvb_frontend_parameters *params)
 486 {
 487         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 488                 buf[2] |= 0x08;
 489 }
 490
 491 static struct dvb_pll_desc dvb_pll_opera1 = {
 492         .name  = "Opera Tuner",
 493         .min   =  900000,
 494         .max   = 2250000,
 495         .iffreq= 0,
 496         .set   = opera1_bw,
 497         .count = 8,
 498         .entries = {
 499                 { 1064000, 500, 0xe5, 0xc6 },
 500                 { 1169000, 500, 0xe5, 0xe6 },
 501                 { 1299000, 500, 0xe5, 0x24 },
 502                 { 1444000, 500, 0xe5, 0x44 },
 503                 { 1606000, 500, 0xe5, 0x64 },
 504                 { 1777000, 500, 0xe5, 0x84 },
 505                 { 1941000, 500, 0xe5, 0xa4 },
 506                 { 2250000, 500, 0xe5, 0xc4 },
 507         }
 508 };
 509
 510 /* Philips FCV1236D
 511  */
 512 static struct dvb_pll_desc dvb_pll_fcv1236d = {
 513 /* Bit_0: RF Input select
 514  * Bit_1: 0=digital, 1=analog
 515  */
 516         .name  = "Philips FCV1236D",
 517         .min   =  53000000,
 518         .max   = 803000000,
 519         .iffreq= 44000000,
 520         .count = 3,
 521         .entries = {
 522                 { 159000000, 62500, 0x8e, 0xa0 },
 523                 { 453000000, 62500, 0x8e, 0x90 },
 524                 { 999999999, 62500, 0x8e, 0x30 },
 525         },
 526 };
 527
 528 /* ----------------------------------------------------------- */
 529
 530 static struct dvb_pll_desc *pll_list[] = {
 531         [DVB_PLL_UNDEFINED]              = NULL,
 532         [DVB_PLL_THOMSON_DTT7579]        = &dvb_pll_thomson_dtt7579,
 533         [DVB_PLL_THOMSON_DTT759X]        = &dvb_pll_thomson_dtt759x,
 534         [DVB_PLL_LG_Z201]                = &dvb_pll_lg_z201,
 535         [DVB_PLL_UNKNOWN_1]              = &dvb_pll_unknown_1,
 536         [DVB_PLL_TUA6010XS]              = &dvb_pll_tua6010xs,
 537         [DVB_PLL_ENV57H1XD5]             = &dvb_pll_env57h1xd5,
 538         [DVB_PLL_TUA6034]                = &dvb_pll_tua6034,
 539         [DVB_PLL_LG_TDVS_H06XF]          = &dvb_pll_lg_tdvs_h06xf,
 540         [DVB_PLL_TDA665X]                = &dvb_pll_tda665x,
 541         [DVB_PLL_FMD1216ME]              = &dvb_pll_fmd1216me,
 542         [DVB_PLL_TDED4]                  = &dvb_pll_tded4,
 543         [DVB_PLL_TUV1236D]               = &dvb_pll_tuv1236d,
 544         [DVB_PLL_TDHU2]                  = &dvb_pll_tdhu2,
 545         [DVB_PLL_SAMSUNG_TBMV]           = &dvb_pll_samsung_tbmv,
 546         [DVB_PLL_PHILIPS_SD1878_TDA8261] = &dvb_pll_philips_sd1878_tda8261,
 547         [DVB_PLL_PHILIPS_TD1316]         = &dvb_pll_philips_td1316,
 548         [DVB_PLL_OPERA1]                 = &dvb_pll_opera1,
 549         [DVB_PLL_FCV1236D]               = &dvb_pll_fcv1236d,
 550 };
 551
 552 /* ----------------------------------------------------------- */
 553 /* code                                                        */
 554
 555 static int dvb_pll_configure(struct dvb_frontend *fe, u8 *buf,
 556                              const struct dvb_frontend_parameters *params)
 557 {
 558         struct dvb_pll_priv *priv = fe->tuner_priv;
 559         struct dvb_pll_desc *desc = priv->pll_desc;
 560         u32 div;
 561         int i;
 562
 563         if (params->frequency != 0 && (params->frequency < desc->min ||
 564                                        params->frequency > desc->max))
 565                 return -EINVAL;
 566
 567         for (i = 0; i < desc->count; i++) {
 568                 if (params->frequency > desc->entries[i].limit)
 569                         continue;
 570                 break;
 571         }
 572
 573         if (debug)
 574                 printk("pll: %s: freq=%d | i=%d/%d\n", desc->name,
 575                        params->frequency, i, desc->count);
 576         if (i == desc->count)
 577                 return -EINVAL;
 578
 579         div = (params->frequency + desc->iffreq +
 580                desc->entries[i].stepsize/2) / desc->entries[i].stepsize;
 581         buf[0] = div >> 8;
 582         buf[1] = div & 0xff;
 583         buf[2] = desc->entries[i].config;
 584         buf[3] = desc->entries[i].cb;
 585
 586         if (desc->set)
 587                 desc->set(fe, buf, params);
 588
 589         if (debug)
 590                 printk("pll: %s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
 591                        desc->name, div, buf[0], buf[1], buf[2], buf[3]);
 592
 593         // calculate the frequency we set it to
 594         return (div * desc->entries[i].stepsize) - desc->iffreq;
 595 }
 596
 597 static int dvb_pll_release(struct dvb_frontend *fe)
 598 {
 599         kfree(fe->tuner_priv);
 600         fe->tuner_priv = NULL;
 601         return 0;
 602 }
 603
 604 static int dvb_pll_sleep(struct dvb_frontend *fe)
 605 {
 606         struct dvb_pll_priv *priv = fe->tuner_priv;
 607
 608         if (priv->i2c == NULL)
 609                 return -EINVAL;
 610
 611         if (priv->pll_desc->sleepdata) {
 612                 struct i2c_msg msg = { .flags = 0,
 613                         .addr = priv->pll_i2c_address,
 614                         .buf = priv->pll_desc->sleepdata + 1,
 615                         .len = priv->pll_desc->sleepdata[0] };
 616
 617                 int result;
 618
 619                 if (fe->ops.i2c_gate_ctrl)
 620                         fe->ops.i2c_gate_ctrl(fe, 1);
 621                 if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 622                         return result;
 623                 }
 624                 return 0;
 625         }
 626         /* Shouldn't be called when initdata is NULL, maybe BUG()? */
 627         return -EINVAL;
 628 }
 629
 630 static int dvb_pll_set_params(struct dvb_frontend *fe,
 631                               struct dvb_frontend_parameters *params)
 632 {
 633         struct dvb_pll_priv *priv = fe->tuner_priv;
 634         u8 buf[4];
 635         struct i2c_msg msg =
 636                 { .addr = priv->pll_i2c_address, .flags = 0,
 637                   .buf = buf, .len = sizeof(buf) };
 638         int result;
 639         u32 frequency = 0;
 640
 641         if (priv->i2c == NULL)
 642                 return -EINVAL;
 643
 644         if ((result = dvb_pll_configure(fe, buf, params)) < 0)
 645                 return result;
 646         else
 647                 frequency = result;
 648
 649         if (fe->ops.i2c_gate_ctrl)
 650                 fe->ops.i2c_gate_ctrl(fe, 1);
 651         if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 652                 return result;
 653         }
 654
 655         priv->frequency = frequency;
 656         priv->bandwidth = (fe->ops.info.type == FE_OFDM) ? params->u.ofdm.bandwidth : 0;
 657
 658         return 0;
 659 }
 660
 661 static int dvb_pll_calc_regs(struct dvb_frontend *fe,
 662                              struct dvb_frontend_parameters *params,
 663                              u8 *buf, int buf_len)
 664 {
 665         struct dvb_pll_priv *priv = fe->tuner_priv;
 666         int result;
 667         u32 frequency = 0;
 668
 669         if (buf_len < 5)
 670                 return -EINVAL;
 671
 672         if ((result = dvb_pll_configure(fe, buf+1, params)) < 0)
 673                 return result;
 674         else
 675                 frequency = result;
 676
 677         buf[0] = priv->pll_i2c_address;
 678
 679         priv->frequency = frequency;
 680         priv->bandwidth = (fe->ops.info.type == FE_OFDM) ? params->u.ofdm.bandwidth : 0;
 681
 682         return 5;
 683 }
 684
 685 static int dvb_pll_get_frequency(struct dvb_frontend *fe, u32 *frequency)
 686 {
 687         struct dvb_pll_priv *priv = fe->tuner_priv;
 688         *frequency = priv->frequency;
 689         return 0;
 690 }
 691
 692 static int dvb_pll_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
 693 {
 694         struct dvb_pll_priv *priv = fe->tuner_priv;
 695         *bandwidth = priv->bandwidth;
 696         return 0;
 697 }
 698
 699 static int dvb_pll_init(struct dvb_frontend *fe)
 700 {
 701         struct dvb_pll_priv *priv = fe->tuner_priv;
 702
 703         if (priv->i2c == NULL)
 704                 return -EINVAL;
 705
 706         if (priv->pll_desc->initdata) {
 707                 struct i2c_msg msg = { .flags = 0,
 708                         .addr = priv->pll_i2c_address,
 709                         .buf = priv->pll_desc->initdata + 1,
 710                         .len = priv->pll_desc->initdata[0] };
 711
 712                 int result;
 713                 if (fe->ops.i2c_gate_ctrl)
 714                         fe->ops.i2c_gate_ctrl(fe, 1);
 715                 if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 716                         return result;
 717                 }
 718                 return 0;
 719         }
 720         /* Shouldn't be called when initdata is NULL, maybe BUG()? */
 721         return -EINVAL;
 722 }
 723
 724 static struct dvb_tuner_ops dvb_pll_tuner_ops = {
 725         .release = dvb_pll_release,
 726         .sleep = dvb_pll_sleep,
 727         .init = dvb_pll_init,
 728         .set_params = dvb_pll_set_params,
 729         .calc_regs = dvb_pll_calc_regs,
 730         .get_frequency = dvb_pll_get_frequency,
 731         .get_bandwidth = dvb_pll_get_bandwidth,
 732 };
 733
 734 struct dvb_frontend *dvb_pll_attach(struct dvb_frontend *fe, int pll_addr,
 735                                     struct i2c_adapter *i2c,
 736                                     unsigned int pll_desc_id)
 737 {
 738         u8 b1 [] = { 0 };
 739         struct i2c_msg msg = { .addr = pll_addr, .flags = I2C_M_RD,
 740                                .buf = b1, .len = 1 };
 741         struct dvb_pll_priv *priv = NULL;
 742         int ret;
 743         struct dvb_pll_desc *desc;
 744
 745         if ((id[dvb_pll_devcount] > DVB_PLL_UNDEFINED) &&
 746             (id[dvb_pll_devcount] < ARRAY_SIZE(pll_list)))
 747                 pll_desc_id = id[dvb_pll_devcount];
 748
 749         BUG_ON(pll_desc_id < 1 || pll_desc_id >= ARRAY_SIZE(pll_list));
 750
 751         desc = pll_list[pll_desc_id];
 752
 753         if (i2c != NULL) {
 754                 if (fe->ops.i2c_gate_ctrl)
 755                         fe->ops.i2c_gate_ctrl(fe, 1);
 756
 757                 ret = i2c_transfer (i2c, &msg, 1);
 758                 if (ret != 1)
 759                         return NULL;
 760                 if (fe->ops.i2c_gate_ctrl)
 761                              fe->ops.i2c_gate_ctrl(fe, 0);
 762         }
 763
 764         priv = kzalloc(sizeof(struct dvb_pll_priv), GFP_KERNEL);
 765         if (priv == NULL)
 766                 return NULL;
 767
 768         priv->pll_i2c_address = pll_addr;
 769         priv->i2c = i2c;
 770         priv->pll_desc = desc;
 771         priv->nr = dvb_pll_devcount++;
 772
 773         memcpy(&fe->ops.tuner_ops, &dvb_pll_tuner_ops,
 774                sizeof(struct dvb_tuner_ops));
 775
 776         strncpy(fe->ops.tuner_ops.info.name, desc->name,
 777                 sizeof(fe->ops.tuner_ops.info.name));
 778         fe->ops.tuner_ops.info.frequency_min = desc->min;
 779         fe->ops.tuner_ops.info.frequency_max = desc->max;
 780         if (!desc->initdata)
 781                 fe->ops.tuner_ops.init = NULL;
 782         if (!desc->sleepdata)
 783                 fe->ops.tuner_ops.sleep = NULL;
 784
 785         fe->tuner_priv = priv;
 786
 787         if ((debug) || (id[priv->nr] == pll_desc_id)) {
 788                 printk("dvb-pll[%d]", priv->nr);
 789                 if (i2c != NULL)
 790                         printk(" %d-%04x", i2c_adapter_id(i2c), pll_addr);
 791                 printk(": id# %d (%s) attached, %s\n", pll_desc_id, desc->name,
 792                        id[priv->nr] == pll_desc_id ?
 793                                 "insmod option" : "autodetected");
 794         }
 795         if ((debug) || (input[priv->nr] > 0)) {
 796                 printk("dvb-pll[%d]", priv->nr);
 797                 if (i2c != NULL)
 798                         printk(" %d-%04x", i2c_adapter_id(i2c), pll_addr);
 799                 printk(": tuner rf input will be ");
 800                 switch (input[priv->nr]) {
 801                 case 0:
 802                         printk("autoselected\n");
 803                         break;
 804                 default:
 805                         printk("set to input %d (insmod option)\n",
 806                                input[priv->nr]);
 807                 }
 808         }
 809
 810         return fe;
 811 }
 812 EXPORT_SYMBOL(dvb_pll_attach);
 813
 814 MODULE_DESCRIPTION("dvb pll library");
 815 MODULE_AUTHOR("Gerd Knorr");
 816 MODULE_LICENSE("GPL");