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 /* ----------------------------------------------------------- */
  28 /* descriptions                                                */
  29
  30 struct dvb_pll_desc dvb_pll_thomson_dtt7579 = {
  31         .name  = "Thomson dtt7579",
  32         .min   = 177000000,
  33         .max   = 858000000,
  34         .count = 5,
  35         .entries = {
  36                 {          0, 36166667, 166666, 0xb4, 0x03 }, /* go sleep */
  37                 {  443250000, 36166667, 166666, 0xb4, 0x02 },
  38                 {  542000000, 36166667, 166666, 0xb4, 0x08 },
  39                 {  771000000, 36166667, 166666, 0xbc, 0x08 },
  40                 {  999999999, 36166667, 166666, 0xf4, 0x08 },
  41         },
  42 };
  43 EXPORT_SYMBOL(dvb_pll_thomson_dtt7579);
  44
  45 struct dvb_pll_desc dvb_pll_thomson_dtt7610 = {
  46         .name  = "Thomson dtt7610",
  47         .min   =  44000000,
  48         .max   = 958000000,
  49         .count = 3,
  50         .entries = {
  51                 { 157250000, 44000000, 62500, 0x8e, 0x39 },
  52                 { 454000000, 44000000, 62500, 0x8e, 0x3a },
  53                 { 999999999, 44000000, 62500, 0x8e, 0x3c },
  54         },
  55 };
  56 EXPORT_SYMBOL(dvb_pll_thomson_dtt7610);
  57
  58 static void thomson_dtt759x_bw(u8 *buf, u32 freq, int bandwidth)
  59 {
  60         if (BANDWIDTH_7_MHZ == bandwidth)
  61                 buf[3] |= 0x10;
  62 }
  63
  64 struct dvb_pll_desc dvb_pll_thomson_dtt759x = {
  65         .name  = "Thomson dtt759x",
  66         .min   = 177000000,
  67         .max   = 896000000,
  68         .setbw = thomson_dtt759x_bw,
  69         .count = 6,
  70         .entries = {
  71                 {          0, 36166667, 166666, 0x84, 0x03 },
  72                 {  264000000, 36166667, 166666, 0xb4, 0x02 },
  73                 {  470000000, 36166667, 166666, 0xbc, 0x02 },
  74                 {  735000000, 36166667, 166666, 0xbc, 0x08 },
  75                 {  835000000, 36166667, 166666, 0xf4, 0x08 },
  76                 {  999999999, 36166667, 166666, 0xfc, 0x08 },
  77         },
  78 };
  79 EXPORT_SYMBOL(dvb_pll_thomson_dtt759x);
  80
  81 struct dvb_pll_desc dvb_pll_lg_z201 = {
  82         .name  = "LG z201",
  83         .min   = 174000000,
  84         .max   = 862000000,
  85         .count = 6,
  86         .entries = {
  87                 {          0, 36166667, 166666, 0xbc, 0x03 },
  88                 {  157500000, 36166667, 166666, 0xbc, 0x01 },
  89                 {  443250000, 36166667, 166666, 0xbc, 0x02 },
  90                 {  542000000, 36166667, 166666, 0xbc, 0x04 },
  91                 {  830000000, 36166667, 166666, 0xf4, 0x04 },
  92                 {  999999999, 36166667, 166666, 0xfc, 0x04 },
  93         },
  94 };
  95 EXPORT_SYMBOL(dvb_pll_lg_z201);
  96
  97 struct dvb_pll_desc dvb_pll_microtune_4042 = {
  98         .name  = "Microtune 4042 FI5",
  99         .min   =  57000000,
 100         .max   = 858000000,
 101         .count = 3,
 102         .entries = {
 103                 { 162000000, 44000000, 62500, 0x8e, 0xa1 },
 104                 { 457000000, 44000000, 62500, 0x8e, 0x91 },
 105                 { 999999999, 44000000, 62500, 0x8e, 0x31 },
 106         },
 107 };
 108 EXPORT_SYMBOL(dvb_pll_microtune_4042);
 109
 110 struct dvb_pll_desc dvb_pll_thomson_dtt761x = {
 111         /* DTT 7611 7611A 7612 7613 7613A 7614 7615 7615A */
 112         .name  = "Thomson dtt761x",
 113         .min   =  57000000,
 114         .max   = 863000000,
 115         .count = 3,
 116         .entries = {
 117                 { 147000000, 44000000, 62500, 0x8e, 0x39 },
 118                 { 417000000, 44000000, 62500, 0x8e, 0x3a },
 119                 { 999999999, 44000000, 62500, 0x8e, 0x3c },
 120         },
 121 };
 122 EXPORT_SYMBOL(dvb_pll_thomson_dtt761x);
 123
 124 struct dvb_pll_desc dvb_pll_unknown_1 = {
 125         .name  = "unknown 1", /* used by dntv live dvb-t */
 126         .min   = 174000000,
 127         .max   = 862000000,
 128         .count = 9,
 129         .entries = {
 130                 {  150000000, 36166667, 166666, 0xb4, 0x01 },
 131                 {  173000000, 36166667, 166666, 0xbc, 0x01 },
 132                 {  250000000, 36166667, 166666, 0xb4, 0x02 },
 133                 {  400000000, 36166667, 166666, 0xbc, 0x02 },
 134                 {  420000000, 36166667, 166666, 0xf4, 0x02 },
 135                 {  470000000, 36166667, 166666, 0xfc, 0x02 },
 136                 {  600000000, 36166667, 166666, 0xbc, 0x08 },
 137                 {  730000000, 36166667, 166666, 0xf4, 0x08 },
 138                 {  999999999, 36166667, 166666, 0xfc, 0x08 },
 139         },
 140 };
 141 EXPORT_SYMBOL(dvb_pll_unknown_1);
 142
 143 /* Infineon TUA6010XS
 144  * used in Thomson Cable Tuner
 145  */
 146 struct dvb_pll_desc dvb_pll_tua6010xs = {
 147         .name  = "Infineon TUA6010XS",
 148         .min   =  44250000,
 149         .max   = 858000000,
 150         .count = 3,
 151         .entries = {
 152                 {  115750000, 36125000, 62500, 0x8e, 0x03 },
 153                 {  403250000, 36125000, 62500, 0x8e, 0x06 },
 154                 {  999999999, 36125000, 62500, 0x8e, 0x85 },
 155         },
 156 };
 157 EXPORT_SYMBOL(dvb_pll_tua6010xs);
 158
 159 /* Panasonic env57h1xd5 (some Philips PLL ?) */
 160 struct dvb_pll_desc dvb_pll_env57h1xd5 = {
 161         .name  = "Panasonic ENV57H1XD5",
 162         .min   =  44250000,
 163         .max   = 858000000,
 164         .count = 4,
 165         .entries = {
 166                 {  153000000, 36291666, 166666, 0xc2, 0x41 },
 167                 {  470000000, 36291666, 166666, 0xc2, 0x42 },
 168                 {  526000000, 36291666, 166666, 0xc2, 0x84 },
 169                 {  999999999, 36291666, 166666, 0xc2, 0xa4 },
 170         },
 171 };
 172 EXPORT_SYMBOL(dvb_pll_env57h1xd5);
 173
 174 /* Philips TDA6650/TDA6651
 175  * used in Panasonic ENV77H11D5
 176  */
 177 static void tda665x_bw(u8 *buf, u32 freq, int bandwidth)
 178 {
 179         if (bandwidth == BANDWIDTH_8_MHZ)
 180                 buf[3] |= 0x08;
 181 }
 182
 183 struct dvb_pll_desc dvb_pll_tda665x = {
 184         .name  = "Philips TDA6650/TDA6651",
 185         .min   =  44250000,
 186         .max   = 858000000,
 187         .setbw = tda665x_bw,
 188         .count = 12,
 189         .entries = {
 190                 {   93834000, 36249333, 166667, 0xca, 0x61 /* 011 0 0 0  01 */ },
 191                 {  123834000, 36249333, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 192                 {  161000000, 36249333, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 193                 {  163834000, 36249333, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 194                 {  253834000, 36249333, 166667, 0xca, 0x62 /* 011 0 0 0  10 */ },
 195                 {  383834000, 36249333, 166667, 0xca, 0xa2 /* 101 0 0 0  10 */ },
 196                 {  443834000, 36249333, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 197                 {  444000000, 36249333, 166667, 0xca, 0xc3 /* 110 0 0 0  11 */ },
 198                 {  583834000, 36249333, 166667, 0xca, 0x63 /* 011 0 0 0  11 */ },
 199                 {  793834000, 36249333, 166667, 0xca, 0xa3 /* 101 0 0 0  11 */ },
 200                 {  444834000, 36249333, 166667, 0xca, 0xc3 /* 110 0 0 0  11 */ },
 201                 {  861000000, 36249333, 166667, 0xca, 0xe3 /* 111 0 0 0  11 */ },
 202         }
 203 };
 204 EXPORT_SYMBOL(dvb_pll_tda665x);
 205
 206 /* Infineon TUA6034
 207  * used in LG TDTP E102P
 208  */
 209 static void tua6034_bw(u8 *buf, u32 freq, int bandwidth)
 210 {
 211         if (BANDWIDTH_7_MHZ != bandwidth)
 212                 buf[3] |= 0x08;
 213 }
 214
 215 struct dvb_pll_desc dvb_pll_tua6034 = {
 216         .name  = "Infineon TUA6034",
 217         .min   =  44250000,
 218         .max   = 858000000,
 219         .count = 3,
 220         .setbw = tua6034_bw,
 221         .entries = {
 222                 {  174500000, 36166667, 62500, 0xce, 0x01 },
 223                 {  230000000, 36166667, 62500, 0xce, 0x02 },
 224                 {  999999999, 36166667, 62500, 0xce, 0x04 },
 225         },
 226 };
 227 EXPORT_SYMBOL(dvb_pll_tua6034);
 228
 229 /* Infineon TUA6034
 230  * used in LG TDVS-H061F, LG TDVS-H062F and LG TDVS-H064F
 231  */
 232 struct dvb_pll_desc dvb_pll_lg_tdvs_h06xf = {
 233         .name  = "LG TDVS-H06xF",
 234         .min   =  54000000,
 235         .max   = 863000000,
 236         .count = 3,
 237         .entries = {
 238                 {  165000000, 44000000, 62500, 0xce, 0x01 },
 239                 {  450000000, 44000000, 62500, 0xce, 0x02 },
 240                 {  999999999, 44000000, 62500, 0xce, 0x04 },
 241         },
 242 };
 243 EXPORT_SYMBOL(dvb_pll_lg_tdvs_h06xf);
 244
 245 /* Philips FMD1216ME
 246  * used in Medion Hybrid PCMCIA card and USB Box
 247  */
 248 static void fmd1216me_bw(u8 *buf, u32 freq, int bandwidth)
 249 {
 250         if (bandwidth == BANDWIDTH_8_MHZ && freq >= 158870000)
 251                 buf[3] |= 0x08;
 252 }
 253
 254 struct dvb_pll_desc dvb_pll_fmd1216me = {
 255         .name = "Philips FMD1216ME",
 256         .min = 50870000,
 257         .max = 858000000,
 258         .setbw = fmd1216me_bw,
 259         .count = 7,
 260         .entries = {
 261                 { 143870000, 36213333, 166667, 0xbc, 0x41 },
 262                 { 158870000, 36213333, 166667, 0xf4, 0x41 },
 263                 { 329870000, 36213333, 166667, 0xbc, 0x42 },
 264                 { 441870000, 36213333, 166667, 0xf4, 0x42 },
 265                 { 625870000, 36213333, 166667, 0xbc, 0x44 },
 266                 { 803870000, 36213333, 166667, 0xf4, 0x44 },
 267                 { 999999999, 36213333, 166667, 0xfc, 0x44 },
 268         }
 269 };
 270 EXPORT_SYMBOL(dvb_pll_fmd1216me);
 271
 272 /* ALPS TDED4
 273  * used in Nebula-Cards and USB boxes
 274  */
 275 static void tded4_bw(u8 *buf, u32 freq, int bandwidth)
 276 {
 277         if (bandwidth == BANDWIDTH_8_MHZ)
 278                 buf[3] |= 0x04;
 279 }
 280
 281 struct dvb_pll_desc dvb_pll_tded4 = {
 282         .name = "ALPS TDED4",
 283         .min = 47000000,
 284         .max = 863000000,
 285         .setbw = tded4_bw,
 286         .count = 4,
 287         .entries = {
 288                 { 153000000, 36166667, 166667, 0x85, 0x01 },
 289                 { 470000000, 36166667, 166667, 0x85, 0x02 },
 290                 { 823000000, 36166667, 166667, 0x85, 0x08 },
 291                 { 999999999, 36166667, 166667, 0x85, 0x88 },
 292         }
 293 };
 294 EXPORT_SYMBOL(dvb_pll_tded4);
 295
 296 /* ALPS TDHU2
 297  * used in AverTVHD MCE A180
 298  */
 299 struct dvb_pll_desc dvb_pll_tdhu2 = {
 300         .name = "ALPS TDHU2",
 301         .min = 54000000,
 302         .max = 864000000,
 303         .count = 4,
 304         .entries = {
 305                 { 162000000, 44000000, 62500, 0x85, 0x01 },
 306                 { 426000000, 44000000, 62500, 0x85, 0x02 },
 307                 { 782000000, 44000000, 62500, 0x85, 0x08 },
 308                 { 999999999, 44000000, 62500, 0x85, 0x88 },
 309         }
 310 };
 311 EXPORT_SYMBOL(dvb_pll_tdhu2);
 312
 313 /* Philips TUV1236D
 314  * used in ATI HDTV Wonder
 315  */
 316 struct dvb_pll_desc dvb_pll_tuv1236d = {
 317         .name  = "Philips TUV1236D",
 318         .min   =  54000000,
 319         .max   = 864000000,
 320         .count = 3,
 321         .entries = {
 322                 { 157250000, 44000000, 62500, 0xc6, 0x41 },
 323                 { 454000000, 44000000, 62500, 0xc6, 0x42 },
 324                 { 999999999, 44000000, 62500, 0xc6, 0x44 },
 325         },
 326 };
 327 EXPORT_SYMBOL(dvb_pll_tuv1236d);
 328
 329 /* Samsung TBMV30111IN / TBMV30712IN1
 330  * used in Air2PC ATSC - 2nd generation (nxt2002)
 331  */
 332 struct dvb_pll_desc dvb_pll_samsung_tbmv = {
 333         .name = "Samsung TBMV30111IN / TBMV30712IN1",
 334         .min = 54000000,
 335         .max = 860000000,
 336         .count = 6,
 337         .entries = {
 338                 { 172000000, 44000000, 166666, 0xb4, 0x01 },
 339                 { 214000000, 44000000, 166666, 0xb4, 0x02 },
 340                 { 467000000, 44000000, 166666, 0xbc, 0x02 },
 341                 { 721000000, 44000000, 166666, 0xbc, 0x08 },
 342                 { 841000000, 44000000, 166666, 0xf4, 0x08 },
 343                 { 999999999, 44000000, 166666, 0xfc, 0x02 },
 344         }
 345 };
 346 EXPORT_SYMBOL(dvb_pll_samsung_tbmv);
 347
 348 /*
 349  * Philips SD1878 Tuner.
 350  */
 351 struct dvb_pll_desc dvb_pll_philips_sd1878_tda8261 = {
 352         .name  = "Philips SD1878",
 353         .min   =  950000,
 354         .max   = 2150000,
 355         .count = 4,
 356         .entries = {
 357                 { 1250000, 499, 500, 0xc4, 0x00},
 358                 { 1550000, 499, 500, 0xc4, 0x40},
 359                 { 2050000, 499, 500, 0xc4, 0x80},
 360                 { 2150000, 499, 500, 0xc4, 0xc0},
 361         },
 362 };
 363 EXPORT_SYMBOL(dvb_pll_philips_sd1878_tda8261);
 364
 365 /*
 366  * Philips TD1316 Tuner.
 367  */
 368 static void td1316_bw(u8 *buf, u32 freq, int bandwidth)
 369 {
 370         u8 band;
 371
 372         /* determine band */
 373         if (freq < 161000000)
 374                 band = 1;
 375         else if (freq < 444000000)
 376                 band = 2;
 377         else
 378                 band = 4;
 379
 380         buf[3] |= band;
 381
 382         /* setup PLL filter */
 383         if (bandwidth == BANDWIDTH_8_MHZ)
 384                 buf[3] |= 1 << 3;
 385 }
 386
 387 struct dvb_pll_desc dvb_pll_philips_td1316 = {
 388         .name  = "Philips TD1316",
 389         .min   =  87000000,
 390         .max   = 895000000,
 391         .setbw = td1316_bw,
 392         .count = 9,
 393         .entries = {
 394                 {  93834000, 36166000, 166666, 0xca, 0x60},
 395                 { 123834000, 36166000, 166666, 0xca, 0xa0},
 396                 { 163834000, 36166000, 166666, 0xca, 0xc0},
 397                 { 253834000, 36166000, 166666, 0xca, 0x60},
 398                 { 383834000, 36166000, 166666, 0xca, 0xa0},
 399                 { 443834000, 36166000, 166666, 0xca, 0xc0},
 400                 { 583834000, 36166000, 166666, 0xca, 0x60},
 401                 { 793834000, 36166000, 166666, 0xca, 0xa0},
 402                 { 858834000, 36166000, 166666, 0xca, 0xe0},
 403         },
 404 };
 405 EXPORT_SYMBOL(dvb_pll_philips_td1316);
 406
 407 /* FE6600 used on DViCO Hybrid */
 408 struct dvb_pll_desc dvb_pll_thomson_fe6600 = {
 409         .name = "Thomson FE6600",
 410         .min =  44250000,
 411         .max = 858000000,
 412         .count = 4,
 413         .entries = {
 414                 { 250000000, 36213333, 166667, 0xb4, 0x12 },
 415                 { 455000000, 36213333, 166667, 0xfe, 0x11 },
 416                 { 775500000, 36213333, 166667, 0xbc, 0x18 },
 417                 { 999999999, 36213333, 166667, 0xf4, 0x18 },
 418         }
 419 };
 420 EXPORT_SYMBOL(dvb_pll_thomson_fe6600);
 421
 422 struct dvb_pll_priv {
 423         /* i2c details */
 424         int pll_i2c_address;
 425         struct i2c_adapter *i2c;
 426
 427         /* the PLL descriptor */
 428         struct dvb_pll_desc *pll_desc;
 429
 430         /* cached frequency/bandwidth */
 431         u32 frequency;
 432         u32 bandwidth;
 433 };
 434
 435 /* ----------------------------------------------------------- */
 436 /* code                                                        */
 437
 438 static int debug = 0;
 439 module_param(debug, int, 0644);
 440 MODULE_PARM_DESC(debug, "enable verbose debug messages");
 441
 442 int dvb_pll_configure(struct dvb_pll_desc *desc, u8 *buf,
 443                       u32 freq, int bandwidth)
 444 {
 445         u32 div;
 446         int i;
 447
 448         if (freq != 0 && (freq < desc->min || freq > desc->max))
 449             return -EINVAL;
 450
 451         for (i = 0; i < desc->count; i++) {
 452                 if (freq > desc->entries[i].limit)
 453                         continue;
 454                 break;
 455         }
 456         if (debug)
 457                 printk("pll: %s: freq=%d bw=%d | i=%d/%d\n",
 458                        desc->name, freq, bandwidth, i, desc->count);
 459         if (i == desc->count)
 460                 return -EINVAL;
 461
 462         div = (freq + desc->entries[i].offset) / desc->entries[i].stepsize;
 463         buf[0] = div >> 8;
 464         buf[1] = div & 0xff;
 465         buf[2] = desc->entries[i].config;
 466         buf[3] = desc->entries[i].cb;
 467
 468         if (desc->setbw)
 469                 desc->setbw(buf, freq, bandwidth);
 470
 471         if (debug)
 472                 printk("pll: %s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
 473                        desc->name, div, buf[0], buf[1], buf[2], buf[3]);
 474
 475         return 0;
 476 }
 477 EXPORT_SYMBOL(dvb_pll_configure);
 478
 479 static int dvb_pll_release(struct dvb_frontend *fe)
 480 {
 481         if (fe->tuner_priv)
 482                 kfree(fe->tuner_priv);
 483         fe->tuner_priv = NULL;
 484         return 0;
 485 }
 486
 487 static int dvb_pll_sleep(struct dvb_frontend *fe)
 488 {
 489         struct dvb_pll_priv *priv = fe->tuner_priv;
 490         u8 buf[4];
 491         struct i2c_msg msg =
 492                 { .addr = priv->pll_i2c_address, .flags = 0, .buf = buf, .len = sizeof(buf) };
 493         int i;
 494         int result;
 495
 496         for (i = 0; i < priv->pll_desc->count; i++) {
 497                 if (priv->pll_desc->entries[i].limit == 0)
 498                         break;
 499         }
 500         if (i == priv->pll_desc->count)
 501                 return 0;
 502
 503         buf[0] = 0;
 504         buf[1] = 0;
 505         buf[2] = priv->pll_desc->entries[i].config;
 506         buf[3] = priv->pll_desc->entries[i].cb;
 507
 508         if (fe->ops.i2c_gate_ctrl)
 509                 fe->ops.i2c_gate_ctrl(fe, 1);
 510         if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 511                 return result;
 512         }
 513
 514         return 0;
 515 }
 516
 517 static int dvb_pll_set_params(struct dvb_frontend *fe, struct dvb_frontend_parameters *params)
 518 {
 519         struct dvb_pll_priv *priv = fe->tuner_priv;
 520         u8 buf[4];
 521         struct i2c_msg msg =
 522                 { .addr = priv->pll_i2c_address, .flags = 0, .buf = buf, .len = sizeof(buf) };
 523         int result;
 524         u32 div;
 525         int i;
 526         u32 bandwidth = 0;
 527
 528         if (priv->i2c == NULL)
 529                 return -EINVAL;
 530
 531         // DVBT bandwidth only just now
 532         if (fe->ops.info.type == FE_OFDM) {
 533                 bandwidth = params->u.ofdm.bandwidth;
 534         }
 535
 536         if ((result = dvb_pll_configure(priv->pll_desc, buf, params->frequency, bandwidth)) != 0)
 537                 return result;
 538
 539         if (fe->ops.i2c_gate_ctrl)
 540                 fe->ops.i2c_gate_ctrl(fe, 1);
 541         if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 542                 return result;
 543         }
 544
 545         // calculate the frequency we set it to
 546         for (i = 0; i < priv->pll_desc->count; i++) {
 547                 if (params->frequency > priv->pll_desc->entries[i].limit)
 548                         continue;
 549                 break;
 550         }
 551         div = (params->frequency + priv->pll_desc->entries[i].offset) / priv->pll_desc->entries[i].stepsize;
 552         priv->frequency = (div * priv->pll_desc->entries[i].stepsize) - priv->pll_desc->entries[i].offset;
 553         priv->bandwidth = bandwidth;
 554
 555         return 0;
 556 }
 557
 558 static int dvb_pll_calc_regs(struct dvb_frontend *fe, struct dvb_frontend_parameters *params, u8 *buf, int buf_len)
 559 {
 560         struct dvb_pll_priv *priv = fe->tuner_priv;
 561         int result;
 562         u32 div;
 563         int i;
 564         u32 bandwidth = 0;
 565
 566         if (buf_len < 5)
 567                 return -EINVAL;
 568
 569         // DVBT bandwidth only just now
 570         if (fe->ops.info.type == FE_OFDM) {
 571                 bandwidth = params->u.ofdm.bandwidth;
 572         }
 573
 574         if ((result = dvb_pll_configure(priv->pll_desc, buf+1, params->frequency, bandwidth)) != 0)
 575                 return result;
 576         buf[0] = priv->pll_i2c_address;
 577
 578         // calculate the frequency we set it to
 579         for (i = 0; i < priv->pll_desc->count; i++) {
 580                 if (params->frequency > priv->pll_desc->entries[i].limit)
 581                         continue;
 582                 break;
 583         }
 584         div = (params->frequency + priv->pll_desc->entries[i].offset) / priv->pll_desc->entries[i].stepsize;
 585         priv->frequency = (div * priv->pll_desc->entries[i].stepsize) - priv->pll_desc->entries[i].offset;
 586         priv->bandwidth = bandwidth;
 587
 588         return 5;
 589 }
 590
 591 static int dvb_pll_get_frequency(struct dvb_frontend *fe, u32 *frequency)
 592 {
 593         struct dvb_pll_priv *priv = fe->tuner_priv;
 594         *frequency = priv->frequency;
 595         return 0;
 596 }
 597
 598 static int dvb_pll_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
 599 {
 600         struct dvb_pll_priv *priv = fe->tuner_priv;
 601         *bandwidth = priv->bandwidth;
 602         return 0;
 603 }
 604
 605 static struct dvb_tuner_ops dvb_pll_tuner_ops = {
 606         .release = dvb_pll_release,
 607         .sleep = dvb_pll_sleep,
 608         .set_params = dvb_pll_set_params,
 609         .calc_regs = dvb_pll_calc_regs,
 610         .get_frequency = dvb_pll_get_frequency,
 611         .get_bandwidth = dvb_pll_get_bandwidth,
 612 };
 613
 614 int dvb_pll_attach(struct dvb_frontend *fe, int pll_addr, struct i2c_adapter *i2c, struct dvb_pll_desc *desc)
 615 {
 616         struct dvb_pll_priv *priv = NULL;
 617
 618         priv = kzalloc(sizeof(struct dvb_pll_priv), GFP_KERNEL);
 619         if (priv == NULL)
 620                 return -ENOMEM;
 621
 622         priv->pll_i2c_address = pll_addr;
 623         priv->i2c = i2c;
 624         priv->pll_desc = desc;
 625
 626         memcpy(&fe->ops.tuner_ops, &dvb_pll_tuner_ops, sizeof(struct dvb_tuner_ops));
 627         strncpy(fe->ops.tuner_ops.info.name, desc->name, 128);
 628         fe->ops.tuner_ops.info.frequency_min = desc->min;
 629         fe->ops.tuner_ops.info.frequency_min = desc->max;
 630
 631         fe->tuner_priv = priv;
 632         return 0;
 633 }
 634 EXPORT_SYMBOL(dvb_pll_attach);
 635
 636 MODULE_DESCRIPTION("dvb pll library");
 637 MODULE_AUTHOR("Gerd Knorr");
 638 MODULE_LICENSE("GPL");