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