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
  84 static struct dvb_pll_desc dvb_pll_thomson_dtt7579 = {
  85         .name  = "Thomson dtt7579",
  86         .min   = 177000000,
  87         .max   = 858000000,
  88         .iffreq= 36166667,
  89         .sleepdata = (u8[]){ 2, 0xb4, 0x03 },
  90         .count = 4,
  91         .entries = {
  92                 {  443250000, 166667, 0xb4, 0x02 },
  93                 {  542000000, 166667, 0xb4, 0x08 },
  94                 {  771000000, 166667, 0xbc, 0x08 },
  95                 {  999999999, 166667, 0xf4, 0x08 },
  96         },
  97 };
  98
  99
 100 static void thomson_dtt759x_bw(struct dvb_frontend *fe, u8 *buf,
 101                                const struct dvb_frontend_parameters *params)
 102 {
 103         if (BANDWIDTH_7_MHZ == params->u.ofdm.bandwidth)
 104                 buf[3] |= 0x10;
 105 }
 106
 107 static struct dvb_pll_desc dvb_pll_thomson_dtt759x = {
 108         .name  = "Thomson dtt759x",
 109         .min   = 177000000,
 110         .max   = 896000000,
 111         .set   = thomson_dtt759x_bw,
 112         .iffreq= 36166667,
 113         .sleepdata = (u8[]){ 2, 0x84, 0x03 },
 114         .count = 5,
 115         .entries = {
 116                 {  264000000, 166667, 0xb4, 0x02 },
 117                 {  470000000, 166667, 0xbc, 0x02 },
 118                 {  735000000, 166667, 0xbc, 0x08 },
 119                 {  835000000, 166667, 0xf4, 0x08 },
 120                 {  999999999, 166667, 0xfc, 0x08 },
 121         },
 122 };
 123
 124 static struct dvb_pll_desc dvb_pll_lg_z201 = {
 125         .name  = "LG z201",
 126         .min   = 174000000,
 127         .max   = 862000000,
 128         .iffreq= 36166667,
 129         .sleepdata = (u8[]){ 2, 0xbc, 0x03 },
 130         .count = 5,
 131         .entries = {
 132                 {  157500000, 166667, 0xbc, 0x01 },
 133                 {  443250000, 166667, 0xbc, 0x02 },
 134                 {  542000000, 166667, 0xbc, 0x04 },
 135                 {  830000000, 166667, 0xf4, 0x04 },
 136                 {  999999999, 166667, 0xfc, 0x04 },
 137         },
 138 };
 139
 140
 141 static struct dvb_pll_desc dvb_pll_unknown_1 = {
 142         .name  = "unknown 1", /* used by dntv live dvb-t */
 143         .min   = 174000000,
 144         .max   = 862000000,
 145         .iffreq= 36166667,
 146         .count = 9,
 147         .entries = {
 148                 {  150000000, 166667, 0xb4, 0x01 },
 149                 {  173000000, 166667, 0xbc, 0x01 },
 150                 {  250000000, 166667, 0xb4, 0x02 },
 151                 {  400000000, 166667, 0xbc, 0x02 },
 152                 {  420000000, 166667, 0xf4, 0x02 },
 153                 {  470000000, 166667, 0xfc, 0x02 },
 154                 {  600000000, 166667, 0xbc, 0x08 },
 155                 {  730000000, 166667, 0xf4, 0x08 },
 156                 {  999999999, 166667, 0xfc, 0x08 },
 157         },
 158 };
 159
 160 /* Infineon TUA6010XS
 161  * used in Thomson Cable Tuner
 162  */
 163 static struct dvb_pll_desc dvb_pll_tua6010xs = {
 164         .name  = "Infineon TUA6010XS",
 165         .min   =  44250000,
 166         .max   = 858000000,
 167         .iffreq= 36125000,
 168         .count = 3,
 169         .entries = {
 170                 {  115750000, 62500, 0x8e, 0x03 },
 171                 {  403250000, 62500, 0x8e, 0x06 },
 172                 {  999999999, 62500, 0x8e, 0x85 },
 173         },
 174 };
 175
 176 /* Panasonic env57h1xd5 (some Philips PLL ?) */
 177 static struct dvb_pll_desc dvb_pll_env57h1xd5 = {
 178         .name  = "Panasonic ENV57H1XD5",
 179         .min   =  44250000,
 180         .max   = 858000000,
 181         .iffreq= 36125000,
 182         .count = 4,
 183         .entries = {
 184                 {  153000000, 166667, 0xc2, 0x41 },
 185                 {  470000000, 166667, 0xc2, 0x42 },
 186                 {  526000000, 166667, 0xc2, 0x84 },
 187                 {  999999999, 166667, 0xc2, 0xa4 },
 188         },
 189 };
 190
 191 /* Philips TDA6650/TDA6651
 192  * used in Panasonic ENV77H11D5
 193  */
 194 static void tda665x_bw(struct dvb_frontend *fe, u8 *buf,
 195                        const struct dvb_frontend_parameters *params)
 196 {
 197         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 198                 buf[3] |= 0x08;
 199 }
 200
 201 static struct dvb_pll_desc dvb_pll_tda665x = {
 202         .name  = "Philips TDA6650/TDA6651",
 203         .min   =  44250000,
 204         .max   = 858000000,
 205         .set   = tda665x_bw,
 206         .iffreq= 36166667,
 207         .initdata = (u8[]){ 4, 0x0b, 0xf5, 0x85, 0xab },
 208         .count = 12,
 209         .entries = {
 210                 {   93834000, 166667, 0xca, 0x61 /* 011 0 0 0  01 */ },
 211                 {  123834000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 212                 {  161000000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 213                 {  163834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 214                 {  253834000, 166667, 0xca, 0x62 /* 011 0 0 0  10 */ },
 215                 {  383834000, 166667, 0xca, 0xa2 /* 101 0 0 0  10 */ },
 216                 {  443834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 217                 {  444000000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
 218                 {  583834000, 166667, 0xca, 0x64 /* 011 0 0 1  00 */ },
 219                 {  793834000, 166667, 0xca, 0xa4 /* 101 0 0 1  00 */ },
 220                 {  444834000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
 221                 {  861000000, 166667, 0xca, 0xe4 /* 111 0 0 1  00 */ },
 222         }
 223 };
 224
 225 /* Infineon TUA6034
 226  * used in LG TDTP E102P
 227  */
 228 static void tua6034_bw(struct dvb_frontend *fe, u8 *buf,
 229                        const struct dvb_frontend_parameters *params)
 230 {
 231         if (BANDWIDTH_7_MHZ != params->u.ofdm.bandwidth)
 232                 buf[3] |= 0x08;
 233 }
 234
 235 static struct dvb_pll_desc dvb_pll_tua6034 = {
 236         .name  = "Infineon TUA6034",
 237         .min   =  44250000,
 238         .max   = 858000000,
 239         .iffreq= 36166667,
 240         .count = 3,
 241         .set   = tua6034_bw,
 242         .entries = {
 243                 {  174500000, 62500, 0xce, 0x01 },
 244                 {  230000000, 62500, 0xce, 0x02 },
 245                 {  999999999, 62500, 0xce, 0x04 },
 246         },
 247 };
 248
 249
 250 /* ALPS TDED4
 251  * used in Nebula-Cards and USB boxes
 252  */
 253 static void tded4_bw(struct dvb_frontend *fe, u8 *buf,
 254                      const struct dvb_frontend_parameters *params)
 255 {
 256         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 257                 buf[3] |= 0x04;
 258 }
 259
 260 static struct dvb_pll_desc dvb_pll_tded4 = {
 261         .name = "ALPS TDED4",
 262         .min = 47000000,
 263         .max = 863000000,
 264         .iffreq= 36166667,
 265         .set   = tded4_bw,
 266         .count = 4,
 267         .entries = {
 268                 { 153000000, 166667, 0x85, 0x01 },
 269                 { 470000000, 166667, 0x85, 0x02 },
 270                 { 823000000, 166667, 0x85, 0x08 },
 271                 { 999999999, 166667, 0x85, 0x88 },
 272         }
 273 };
 274
 275 /* ALPS TDHU2
 276  * used in AverTVHD MCE A180
 277  */
 278 static struct dvb_pll_desc dvb_pll_tdhu2 = {
 279         .name = "ALPS TDHU2",
 280         .min = 54000000,
 281         .max = 864000000,
 282         .iffreq= 44000000,
 283         .count = 4,
 284         .entries = {
 285                 { 162000000, 62500, 0x85, 0x01 },
 286                 { 426000000, 62500, 0x85, 0x02 },
 287                 { 782000000, 62500, 0x85, 0x08 },
 288                 { 999999999, 62500, 0x85, 0x88 },
 289         }
 290 };
 291
 292 /* Philips TUV1236D
 293  * used in ATI HDTV Wonder
 294  */
 295 static void tuv1236d_rf(struct dvb_frontend *fe, u8 *buf,
 296                         const struct dvb_frontend_parameters *params)
 297 {
 298         struct dvb_pll_priv *priv = fe->tuner_priv;
 299         unsigned int new_rf = input[priv->nr];
 300
 301         if ((new_rf == 0) || (new_rf > 2)) {
 302                 switch (params->u.vsb.modulation) {
 303                         case QAM_64:
 304                         case QAM_256:
 305                                 new_rf = 1;
 306                                 break;
 307                         case VSB_8:
 308                         default:
 309                                 new_rf = 2;
 310                 }
 311         }
 312
 313         switch (new_rf) {
 314                 case 1:
 315                         buf[3] |= 0x08;
 316                         break;
 317                 case 2:
 318                         buf[3] &= ~0x08;
 319                         break;
 320                 default:
 321                         printk(KERN_WARNING
 322                                "%s: unhandled rf input selection: %d",
 323                                __FUNCTION__, new_rf);
 324         }
 325 }
 326
 327 static struct dvb_pll_desc dvb_pll_tuv1236d = {
 328         .name  = "Philips TUV1236D",
 329         .min   =  54000000,
 330         .max   = 864000000,
 331         .iffreq= 44000000,
 332         .set   = tuv1236d_rf,
 333         .count = 3,
 334         .entries = {
 335                 { 157250000, 62500, 0xc6, 0x41 },
 336                 { 454000000, 62500, 0xc6, 0x42 },
 337                 { 999999999, 62500, 0xc6, 0x44 },
 338         },
 339 };
 340
 341 /* Samsung TBMV30111IN / TBMV30712IN1
 342  * used in Air2PC ATSC - 2nd generation (nxt2002)
 343  */
 344 static struct dvb_pll_desc dvb_pll_samsung_tbmv = {
 345         .name = "Samsung TBMV30111IN / TBMV30712IN1",
 346         .min = 54000000,
 347         .max = 860000000,
 348         .iffreq= 44000000,
 349         .count = 6,
 350         .entries = {
 351                 { 172000000, 166667, 0xb4, 0x01 },
 352                 { 214000000, 166667, 0xb4, 0x02 },
 353                 { 467000000, 166667, 0xbc, 0x02 },
 354                 { 721000000, 166667, 0xbc, 0x08 },
 355                 { 841000000, 166667, 0xf4, 0x08 },
 356                 { 999999999, 166667, 0xfc, 0x02 },
 357         }
 358 };
 359
 360 /*
 361  * Philips SD1878 Tuner.
 362  */
 363 static struct dvb_pll_desc dvb_pll_philips_sd1878_tda8261 = {
 364         .name  = "Philips SD1878",
 365         .min   =  950000,
 366         .max   = 2150000,
 367         .iffreq= 249, /* zero-IF, offset 249 is to round up */
 368         .count = 4,
 369         .entries = {
 370                 { 1250000, 500, 0xc4, 0x00},
 371                 { 1550000, 500, 0xc4, 0x40},
 372                 { 2050000, 500, 0xc4, 0x80},
 373                 { 2150000, 500, 0xc4, 0xc0},
 374         },
 375 };
 376
 377 /*
 378  * Philips TD1316 Tuner.
 379  */
 380 static void td1316_bw(struct dvb_frontend *fe, u8 *buf,
 381                       const struct dvb_frontend_parameters *params)
 382 {
 383         u8 band;
 384
 385         /* determine band */
 386         if (params->frequency < 161000000)
 387                 band = 1;
 388         else if (params->frequency < 444000000)
 389                 band = 2;
 390         else
 391                 band = 4;
 392
 393         buf[3] |= band;
 394
 395         /* setup PLL filter */
 396         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 397                 buf[3] |= 1 << 3;
 398 }
 399
 400 static struct dvb_pll_desc dvb_pll_philips_td1316 = {
 401         .name  = "Philips TD1316",
 402         .min   =  87000000,
 403         .max   = 895000000,
 404         .iffreq= 36166667,
 405         .set   = td1316_bw,
 406         .count = 9,
 407         .entries = {
 408                 {  93834000, 166667, 0xca, 0x60},
 409                 { 123834000, 166667, 0xca, 0xa0},
 410                 { 163834000, 166667, 0xca, 0xc0},
 411                 { 253834000, 166667, 0xca, 0x60},
 412                 { 383834000, 166667, 0xca, 0xa0},
 413                 { 443834000, 166667, 0xca, 0xc0},
 414                 { 583834000, 166667, 0xca, 0x60},
 415                 { 793834000, 166667, 0xca, 0xa0},
 416                 { 858834000, 166667, 0xca, 0xe0},
 417         },
 418 };
 419
 420
 421 static void opera1_bw(struct dvb_frontend *fe, u8 *buf,
 422                       const struct dvb_frontend_parameters *params)
 423 {
 424         if (params->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
 425                 buf[2] |= 0x08;
 426 }
 427
 428 static struct dvb_pll_desc dvb_pll_opera1 = {
 429         .name  = "Opera Tuner",
 430         .min   =  900000,
 431         .max   = 2250000,
 432         .iffreq= 0,
 433         .set   = opera1_bw,
 434         .count = 8,
 435         .entries = {
 436                 { 1064000, 500, 0xe5, 0xc6 },
 437                 { 1169000, 500, 0xe5, 0xe6 },
 438                 { 1299000, 500, 0xe5, 0x24 },
 439                 { 1444000, 500, 0xe5, 0x44 },
 440                 { 1606000, 500, 0xe5, 0x64 },
 441                 { 1777000, 500, 0xe5, 0x84 },
 442                 { 1941000, 500, 0xe5, 0xa4 },
 443                 { 2250000, 500, 0xe5, 0xc4 },
 444         }
 445 };
 446
 447
 448 /* ----------------------------------------------------------- */
 449
 450 static struct dvb_pll_desc *pll_list[] = {
 451         [DVB_PLL_UNDEFINED]              = NULL,
 452         [DVB_PLL_THOMSON_DTT7579]        = &dvb_pll_thomson_dtt7579,
 453         [DVB_PLL_THOMSON_DTT759X]        = &dvb_pll_thomson_dtt759x,
 454         [DVB_PLL_LG_Z201]                = &dvb_pll_lg_z201,
 455         [DVB_PLL_UNKNOWN_1]              = &dvb_pll_unknown_1,
 456         [DVB_PLL_TUA6010XS]              = &dvb_pll_tua6010xs,
 457         [DVB_PLL_ENV57H1XD5]             = &dvb_pll_env57h1xd5,
 458         [DVB_PLL_TUA6034]                = &dvb_pll_tua6034,
 459         [DVB_PLL_TDA665X]                = &dvb_pll_tda665x,
 460         [DVB_PLL_TDED4]                  = &dvb_pll_tded4,
 461         [DVB_PLL_TUV1236D]               = &dvb_pll_tuv1236d,
 462         [DVB_PLL_TDHU2]                  = &dvb_pll_tdhu2,
 463         [DVB_PLL_SAMSUNG_TBMV]           = &dvb_pll_samsung_tbmv,
 464         [DVB_PLL_PHILIPS_SD1878_TDA8261] = &dvb_pll_philips_sd1878_tda8261,
 465         [DVB_PLL_PHILIPS_TD1316]         = &dvb_pll_philips_td1316,
 466         [DVB_PLL_OPERA1]                 = &dvb_pll_opera1,
 467 };
 468
 469 /* ----------------------------------------------------------- */
 470 /* code                                                        */
 471
 472 static int dvb_pll_configure(struct dvb_frontend *fe, u8 *buf,
 473                              const struct dvb_frontend_parameters *params)
 474 {
 475         struct dvb_pll_priv *priv = fe->tuner_priv;
 476         struct dvb_pll_desc *desc = priv->pll_desc;
 477         u32 div;
 478         int i;
 479
 480         if (params->frequency != 0 && (params->frequency < desc->min ||
 481                                        params->frequency > desc->max))
 482                 return -EINVAL;
 483
 484         for (i = 0; i < desc->count; i++) {
 485                 if (params->frequency > desc->entries[i].limit)
 486                         continue;
 487                 break;
 488         }
 489
 490         if (debug)
 491                 printk("pll: %s: freq=%d | i=%d/%d\n", desc->name,
 492                        params->frequency, i, desc->count);
 493         if (i == desc->count)
 494                 return -EINVAL;
 495
 496         div = (params->frequency + desc->iffreq +
 497                desc->entries[i].stepsize/2) / desc->entries[i].stepsize;
 498         buf[0] = div >> 8;
 499         buf[1] = div & 0xff;
 500         buf[2] = desc->entries[i].config;
 501         buf[3] = desc->entries[i].cb;
 502
 503         if (desc->set)
 504                 desc->set(fe, buf, params);
 505
 506         if (debug)
 507                 printk("pll: %s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
 508                        desc->name, div, buf[0], buf[1], buf[2], buf[3]);
 509
 510         // calculate the frequency we set it to
 511         return (div * desc->entries[i].stepsize) - desc->iffreq;
 512 }
 513
 514 static int dvb_pll_release(struct dvb_frontend *fe)
 515 {
 516         kfree(fe->tuner_priv);
 517         fe->tuner_priv = NULL;
 518         return 0;
 519 }
 520
 521 static int dvb_pll_sleep(struct dvb_frontend *fe)
 522 {
 523         struct dvb_pll_priv *priv = fe->tuner_priv;
 524
 525         if (priv->i2c == NULL)
 526                 return -EINVAL;
 527
 528         if (priv->pll_desc->sleepdata) {
 529                 struct i2c_msg msg = { .flags = 0,
 530                         .addr = priv->pll_i2c_address,
 531                         .buf = priv->pll_desc->sleepdata + 1,
 532                         .len = priv->pll_desc->sleepdata[0] };
 533
 534                 int result;
 535
 536                 if (fe->ops.i2c_gate_ctrl)
 537                         fe->ops.i2c_gate_ctrl(fe, 1);
 538                 if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 539                         return result;
 540                 }
 541                 return 0;
 542         }
 543         /* Shouldn't be called when initdata is NULL, maybe BUG()? */
 544         return -EINVAL;
 545 }
 546
 547 static int dvb_pll_set_params(struct dvb_frontend *fe,
 548                               struct dvb_frontend_parameters *params)
 549 {
 550         struct dvb_pll_priv *priv = fe->tuner_priv;
 551         u8 buf[4];
 552         struct i2c_msg msg =
 553                 { .addr = priv->pll_i2c_address, .flags = 0,
 554                   .buf = buf, .len = sizeof(buf) };
 555         int result;
 556         u32 frequency = 0;
 557
 558         if (priv->i2c == NULL)
 559                 return -EINVAL;
 560
 561         if ((result = dvb_pll_configure(fe, buf, params)) < 0)
 562                 return result;
 563         else
 564                 frequency = result;
 565
 566         if (fe->ops.i2c_gate_ctrl)
 567                 fe->ops.i2c_gate_ctrl(fe, 1);
 568         if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 569                 return result;
 570         }
 571
 572         priv->frequency = frequency;
 573         priv->bandwidth = (fe->ops.info.type == FE_OFDM) ? params->u.ofdm.bandwidth : 0;
 574
 575         return 0;
 576 }
 577
 578 static int dvb_pll_calc_regs(struct dvb_frontend *fe,
 579                              struct dvb_frontend_parameters *params,
 580                              u8 *buf, int buf_len)
 581 {
 582         struct dvb_pll_priv *priv = fe->tuner_priv;
 583         int result;
 584         u32 frequency = 0;
 585
 586         if (buf_len < 5)
 587                 return -EINVAL;
 588
 589         if ((result = dvb_pll_configure(fe, buf+1, params)) < 0)
 590                 return result;
 591         else
 592                 frequency = result;
 593
 594         buf[0] = priv->pll_i2c_address;
 595
 596         priv->frequency = frequency;
 597         priv->bandwidth = (fe->ops.info.type == FE_OFDM) ? params->u.ofdm.bandwidth : 0;
 598
 599         return 5;
 600 }
 601
 602 static int dvb_pll_get_frequency(struct dvb_frontend *fe, u32 *frequency)
 603 {
 604         struct dvb_pll_priv *priv = fe->tuner_priv;
 605         *frequency = priv->frequency;
 606         return 0;
 607 }
 608
 609 static int dvb_pll_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
 610 {
 611         struct dvb_pll_priv *priv = fe->tuner_priv;
 612         *bandwidth = priv->bandwidth;
 613         return 0;
 614 }
 615
 616 static int dvb_pll_init(struct dvb_frontend *fe)
 617 {
 618         struct dvb_pll_priv *priv = fe->tuner_priv;
 619
 620         if (priv->i2c == NULL)
 621                 return -EINVAL;
 622
 623         if (priv->pll_desc->initdata) {
 624                 struct i2c_msg msg = { .flags = 0,
 625                         .addr = priv->pll_i2c_address,
 626                         .buf = priv->pll_desc->initdata + 1,
 627                         .len = priv->pll_desc->initdata[0] };
 628
 629                 int result;
 630                 if (fe->ops.i2c_gate_ctrl)
 631                         fe->ops.i2c_gate_ctrl(fe, 1);
 632                 if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 633                         return result;
 634                 }
 635                 return 0;
 636         }
 637         /* Shouldn't be called when initdata is NULL, maybe BUG()? */
 638         return -EINVAL;
 639 }
 640
 641 static struct dvb_tuner_ops dvb_pll_tuner_ops = {
 642         .release = dvb_pll_release,
 643         .sleep = dvb_pll_sleep,
 644         .init = dvb_pll_init,
 645         .set_params = dvb_pll_set_params,
 646         .calc_regs = dvb_pll_calc_regs,
 647         .get_frequency = dvb_pll_get_frequency,
 648         .get_bandwidth = dvb_pll_get_bandwidth,
 649 };
 650
 651 struct dvb_frontend *dvb_pll_attach(struct dvb_frontend *fe, int pll_addr,
 652                                     struct i2c_adapter *i2c,
 653                                     unsigned int pll_desc_id)
 654 {
 655         u8 b1 [] = { 0 };
 656         struct i2c_msg msg = { .addr = pll_addr, .flags = I2C_M_RD,
 657                                .buf = b1, .len = 1 };
 658         struct dvb_pll_priv *priv = NULL;
 659         int ret;
 660         struct dvb_pll_desc *desc;
 661
 662         if ((id[dvb_pll_devcount] > DVB_PLL_UNDEFINED) &&
 663             (id[dvb_pll_devcount] < ARRAY_SIZE(pll_list)))
 664                 pll_desc_id = id[dvb_pll_devcount];
 665
 666         BUG_ON(pll_desc_id < 1 || pll_desc_id >= ARRAY_SIZE(pll_list));
 667
 668         desc = pll_list[pll_desc_id];
 669
 670         if (i2c != NULL) {
 671                 if (fe->ops.i2c_gate_ctrl)
 672                         fe->ops.i2c_gate_ctrl(fe, 1);
 673
 674                 ret = i2c_transfer (i2c, &msg, 1);
 675                 if (ret != 1)
 676                         return NULL;
 677                 if (fe->ops.i2c_gate_ctrl)
 678                              fe->ops.i2c_gate_ctrl(fe, 0);
 679         }
 680
 681         priv = kzalloc(sizeof(struct dvb_pll_priv), GFP_KERNEL);
 682         if (priv == NULL)
 683                 return NULL;
 684
 685         priv->pll_i2c_address = pll_addr;
 686         priv->i2c = i2c;
 687         priv->pll_desc = desc;
 688         priv->nr = dvb_pll_devcount++;
 689
 690         memcpy(&fe->ops.tuner_ops, &dvb_pll_tuner_ops,
 691                sizeof(struct dvb_tuner_ops));
 692
 693         strncpy(fe->ops.tuner_ops.info.name, desc->name,
 694                 sizeof(fe->ops.tuner_ops.info.name));
 695         fe->ops.tuner_ops.info.frequency_min = desc->min;
 696         fe->ops.tuner_ops.info.frequency_max = desc->max;
 697         if (!desc->initdata)
 698                 fe->ops.tuner_ops.init = NULL;
 699         if (!desc->sleepdata)
 700                 fe->ops.tuner_ops.sleep = NULL;
 701
 702         fe->tuner_priv = priv;
 703
 704         if ((debug) || (id[priv->nr] == pll_desc_id)) {
 705                 printk("dvb-pll[%d]", priv->nr);
 706                 if (i2c != NULL)
 707                         printk(" %d-%04x", i2c_adapter_id(i2c), pll_addr);
 708                 printk(": id# %d (%s) attached, %s\n", pll_desc_id, desc->name,
 709                        id[priv->nr] == pll_desc_id ?
 710                                 "insmod option" : "autodetected");
 711         }
 712         if ((debug) || (input[priv->nr] > 0)) {
 713                 printk("dvb-pll[%d]", priv->nr);
 714                 if (i2c != NULL)
 715                         printk(" %d-%04x", i2c_adapter_id(i2c), pll_addr);
 716                 printk(": tuner rf input will be ");
 717                 switch (input[priv->nr]) {
 718                 case 0:
 719                         printk("autoselected\n");
 720                         break;
 721                 default:
 722                         printk("set to input %d (insmod option)\n",
 723                                input[priv->nr]);
 724                 }
 725         }
 726
 727         return fe;
 728 }
 729 EXPORT_SYMBOL(dvb_pll_attach);
 730
 731 MODULE_DESCRIPTION("dvb pll library");
 732 MODULE_AUTHOR("Gerd Knorr");
 733 MODULE_LICENSE("GPL");