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