linux/drivers/media/dvb-frontends/dvb-pll.c
<<
>>
Prefs
   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
  17#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
  18
  19#include <linux/slab.h>
  20#include <linux/module.h>
  21#include <linux/dvb/frontend.h>
  22#include <asm/types.h>
  23
  24#include "dvb-pll.h"
  25
  26#define dprintk(fmt, arg...) \
  27        printk(KERN_DEBUG pr_fmt("%s: " fmt), __func__, ##arg)
  28
  29struct dvb_pll_priv {
  30        /* pll number */
  31        int nr;
  32
  33        /* i2c details */
  34        int pll_i2c_address;
  35        struct i2c_adapter *i2c;
  36
  37        /* the PLL descriptor */
  38        const struct dvb_pll_desc *pll_desc;
  39
  40        /* cached frequency/bandwidth */
  41        u32 frequency;
  42        u32 bandwidth;
  43};
  44
  45#define DVB_PLL_MAX 64
  46
  47static unsigned int dvb_pll_devcount;
  48
  49static int debug;
  50module_param(debug, int, 0644);
  51MODULE_PARM_DESC(debug, "enable verbose debug messages");
  52
  53static unsigned int id[DVB_PLL_MAX] =
  54        { [ 0 ... (DVB_PLL_MAX-1) ] = DVB_PLL_UNDEFINED };
  55module_param_array(id, int, NULL, 0644);
  56MODULE_PARM_DESC(id, "force pll id to use (DEBUG ONLY)");
  57
  58/* ----------------------------------------------------------- */
  59
  60struct dvb_pll_desc {
  61        const char *name;
  62        u32  min;
  63        u32  max;
  64        u32  iffreq;
  65        void (*set)(struct dvb_frontend *fe, u8 *buf);
  66        u8   *initdata;
  67        u8   *initdata2;
  68        u8   *sleepdata;
  69        int  count;
  70        struct {
  71                u32 limit;
  72                u32 stepsize;
  73                u8  config;
  74                u8  cb;
  75        } entries[];
  76};
  77
  78/* ----------------------------------------------------------- */
  79/* descriptions                                                */
  80
  81static const struct dvb_pll_desc dvb_pll_thomson_dtt7579 = {
  82        .name  = "Thomson dtt7579",
  83        .min   = 177000000,
  84        .max   = 858000000,
  85        .iffreq= 36166667,
  86        .sleepdata = (u8[]){ 2, 0xb4, 0x03 },
  87        .count = 4,
  88        .entries = {
  89                {  443250000, 166667, 0xb4, 0x02 },
  90                {  542000000, 166667, 0xb4, 0x08 },
  91                {  771000000, 166667, 0xbc, 0x08 },
  92                {  999999999, 166667, 0xf4, 0x08 },
  93        },
  94};
  95
  96static void thomson_dtt759x_bw(struct dvb_frontend *fe, u8 *buf)
  97{
  98        u32 bw = fe->dtv_property_cache.bandwidth_hz;
  99        if (bw == 7000000)
 100                buf[3] |= 0x10;
 101}
 102
 103static const struct dvb_pll_desc dvb_pll_thomson_dtt759x = {
 104        .name  = "Thomson dtt759x",
 105        .min   = 177000000,
 106        .max   = 896000000,
 107        .set   = thomson_dtt759x_bw,
 108        .iffreq= 36166667,
 109        .sleepdata = (u8[]){ 2, 0x84, 0x03 },
 110        .count = 5,
 111        .entries = {
 112                {  264000000, 166667, 0xb4, 0x02 },
 113                {  470000000, 166667, 0xbc, 0x02 },
 114                {  735000000, 166667, 0xbc, 0x08 },
 115                {  835000000, 166667, 0xf4, 0x08 },
 116                {  999999999, 166667, 0xfc, 0x08 },
 117        },
 118};
 119
 120static void thomson_dtt7520x_bw(struct dvb_frontend *fe, u8 *buf)
 121{
 122        u32 bw = fe->dtv_property_cache.bandwidth_hz;
 123        if (bw == 8000000)
 124                buf[3] ^= 0x10;
 125}
 126
 127static const struct dvb_pll_desc dvb_pll_thomson_dtt7520x = {
 128        .name  = "Thomson dtt7520x",
 129        .min   = 185000000,
 130        .max   = 900000000,
 131        .set   = thomson_dtt7520x_bw,
 132        .iffreq = 36166667,
 133        .count = 7,
 134        .entries = {
 135                {  305000000, 166667, 0xb4, 0x12 },
 136                {  405000000, 166667, 0xbc, 0x12 },
 137                {  445000000, 166667, 0xbc, 0x12 },
 138                {  465000000, 166667, 0xf4, 0x18 },
 139                {  735000000, 166667, 0xfc, 0x18 },
 140                {  835000000, 166667, 0xbc, 0x18 },
 141                {  999999999, 166667, 0xfc, 0x18 },
 142        },
 143};
 144
 145static const struct dvb_pll_desc dvb_pll_lg_z201 = {
 146        .name  = "LG z201",
 147        .min   = 174000000,
 148        .max   = 862000000,
 149        .iffreq= 36166667,
 150        .sleepdata = (u8[]){ 2, 0xbc, 0x03 },
 151        .count = 5,
 152        .entries = {
 153                {  157500000, 166667, 0xbc, 0x01 },
 154                {  443250000, 166667, 0xbc, 0x02 },
 155                {  542000000, 166667, 0xbc, 0x04 },
 156                {  830000000, 166667, 0xf4, 0x04 },
 157                {  999999999, 166667, 0xfc, 0x04 },
 158        },
 159};
 160
 161static const struct dvb_pll_desc dvb_pll_unknown_1 = {
 162        .name  = "unknown 1", /* used by dntv live dvb-t */
 163        .min   = 174000000,
 164        .max   = 862000000,
 165        .iffreq= 36166667,
 166        .count = 9,
 167        .entries = {
 168                {  150000000, 166667, 0xb4, 0x01 },
 169                {  173000000, 166667, 0xbc, 0x01 },
 170                {  250000000, 166667, 0xb4, 0x02 },
 171                {  400000000, 166667, 0xbc, 0x02 },
 172                {  420000000, 166667, 0xf4, 0x02 },
 173                {  470000000, 166667, 0xfc, 0x02 },
 174                {  600000000, 166667, 0xbc, 0x08 },
 175                {  730000000, 166667, 0xf4, 0x08 },
 176                {  999999999, 166667, 0xfc, 0x08 },
 177        },
 178};
 179
 180/* Infineon TUA6010XS
 181 * used in Thomson Cable Tuner
 182 */
 183static const struct dvb_pll_desc dvb_pll_tua6010xs = {
 184        .name  = "Infineon TUA6010XS",
 185        .min   =  44250000,
 186        .max   = 858000000,
 187        .iffreq= 36125000,
 188        .count = 3,
 189        .entries = {
 190                {  115750000, 62500, 0x8e, 0x03 },
 191                {  403250000, 62500, 0x8e, 0x06 },
 192                {  999999999, 62500, 0x8e, 0x85 },
 193        },
 194};
 195
 196/* Panasonic env57h1xd5 (some Philips PLL ?) */
 197static const struct dvb_pll_desc dvb_pll_env57h1xd5 = {
 198        .name  = "Panasonic ENV57H1XD5",
 199        .min   =  44250000,
 200        .max   = 858000000,
 201        .iffreq= 36125000,
 202        .count = 4,
 203        .entries = {
 204                {  153000000, 166667, 0xc2, 0x41 },
 205                {  470000000, 166667, 0xc2, 0x42 },
 206                {  526000000, 166667, 0xc2, 0x84 },
 207                {  999999999, 166667, 0xc2, 0xa4 },
 208        },
 209};
 210
 211/* Philips TDA6650/TDA6651
 212 * used in Panasonic ENV77H11D5
 213 */
 214static void tda665x_bw(struct dvb_frontend *fe, u8 *buf)
 215{
 216        u32 bw = fe->dtv_property_cache.bandwidth_hz;
 217        if (bw == 8000000)
 218                buf[3] |= 0x08;
 219}
 220
 221static const struct dvb_pll_desc dvb_pll_tda665x = {
 222        .name  = "Philips TDA6650/TDA6651",
 223        .min   =  44250000,
 224        .max   = 858000000,
 225        .set   = tda665x_bw,
 226        .iffreq= 36166667,
 227        .initdata = (u8[]){ 4, 0x0b, 0xf5, 0x85, 0xab },
 228        .count = 12,
 229        .entries = {
 230                {   93834000, 166667, 0xca, 0x61 /* 011 0 0 0  01 */ },
 231                {  123834000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 232                {  161000000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
 233                {  163834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 234                {  253834000, 166667, 0xca, 0x62 /* 011 0 0 0  10 */ },
 235                {  383834000, 166667, 0xca, 0xa2 /* 101 0 0 0  10 */ },
 236                {  443834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
 237                {  444000000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
 238                {  583834000, 166667, 0xca, 0x64 /* 011 0 0 1  00 */ },
 239                {  793834000, 166667, 0xca, 0xa4 /* 101 0 0 1  00 */ },
 240                {  444834000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
 241                {  861000000, 166667, 0xca, 0xe4 /* 111 0 0 1  00 */ },
 242        }
 243};
 244
 245/* Infineon TUA6034
 246 * used in LG TDTP E102P
 247 */
 248static void tua6034_bw(struct dvb_frontend *fe, u8 *buf)
 249{
 250        u32 bw = fe->dtv_property_cache.bandwidth_hz;
 251        if (bw == 7000000)
 252                buf[3] |= 0x08;
 253}
 254
 255static const struct dvb_pll_desc dvb_pll_tua6034 = {
 256        .name  = "Infineon TUA6034",
 257        .min   =  44250000,
 258        .max   = 858000000,
 259        .iffreq= 36166667,
 260        .count = 3,
 261        .set   = tua6034_bw,
 262        .entries = {
 263                {  174500000, 62500, 0xce, 0x01 },
 264                {  230000000, 62500, 0xce, 0x02 },
 265                {  999999999, 62500, 0xce, 0x04 },
 266        },
 267};
 268
 269/* ALPS TDED4
 270 * used in Nebula-Cards and USB boxes
 271 */
 272static void tded4_bw(struct dvb_frontend *fe, u8 *buf)
 273{
 274        u32 bw = fe->dtv_property_cache.bandwidth_hz;
 275        if (bw == 8000000)
 276                buf[3] |= 0x04;
 277}
 278
 279static const struct dvb_pll_desc dvb_pll_tded4 = {
 280        .name = "ALPS TDED4",
 281        .min = 47000000,
 282        .max = 863000000,
 283        .iffreq= 36166667,
 284        .set   = tded4_bw,
 285        .count = 4,
 286        .entries = {
 287                { 153000000, 166667, 0x85, 0x01 },
 288                { 470000000, 166667, 0x85, 0x02 },
 289                { 823000000, 166667, 0x85, 0x08 },
 290                { 999999999, 166667, 0x85, 0x88 },
 291        }
 292};
 293
 294/* ALPS TDHU2
 295 * used in AverTVHD MCE A180
 296 */
 297static const struct dvb_pll_desc dvb_pll_tdhu2 = {
 298        .name = "ALPS TDHU2",
 299        .min = 54000000,
 300        .max = 864000000,
 301        .iffreq= 44000000,
 302        .count = 4,
 303        .entries = {
 304                { 162000000, 62500, 0x85, 0x01 },
 305                { 426000000, 62500, 0x85, 0x02 },
 306                { 782000000, 62500, 0x85, 0x08 },
 307                { 999999999, 62500, 0x85, 0x88 },
 308        }
 309};
 310
 311/* Samsung TBMV30111IN / TBMV30712IN1
 312 * used in Air2PC ATSC - 2nd generation (nxt2002)
 313 */
 314static const struct dvb_pll_desc dvb_pll_samsung_tbmv = {
 315        .name = "Samsung TBMV30111IN / TBMV30712IN1",
 316        .min = 54000000,
 317        .max = 860000000,
 318        .iffreq= 44000000,
 319        .count = 6,
 320        .entries = {
 321                { 172000000, 166667, 0xb4, 0x01 },
 322                { 214000000, 166667, 0xb4, 0x02 },
 323                { 467000000, 166667, 0xbc, 0x02 },
 324                { 721000000, 166667, 0xbc, 0x08 },
 325                { 841000000, 166667, 0xf4, 0x08 },
 326                { 999999999, 166667, 0xfc, 0x02 },
 327        }
 328};
 329
 330/*
 331 * Philips SD1878 Tuner.
 332 */
 333static const struct dvb_pll_desc dvb_pll_philips_sd1878_tda8261 = {
 334        .name  = "Philips SD1878",
 335        .min   =  950000,
 336        .max   = 2150000,
 337        .iffreq= 249, /* zero-IF, offset 249 is to round up */
 338        .count = 4,
 339        .entries = {
 340                { 1250000, 500, 0xc4, 0x00},
 341                { 1450000, 500, 0xc4, 0x40},
 342                { 2050000, 500, 0xc4, 0x80},
 343                { 2150000, 500, 0xc4, 0xc0},
 344        },
 345};
 346
 347static void opera1_bw(struct dvb_frontend *fe, u8 *buf)
 348{
 349        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
 350        struct dvb_pll_priv *priv = fe->tuner_priv;
 351        u32 b_w  = (c->symbol_rate * 27) / 32000;
 352        struct i2c_msg msg = {
 353                .addr = priv->pll_i2c_address,
 354                .flags = 0,
 355                .buf = buf,
 356                .len = 4
 357        };
 358        int result;
 359        u8 lpf;
 360
 361        if (fe->ops.i2c_gate_ctrl)
 362                fe->ops.i2c_gate_ctrl(fe, 1);
 363
 364        result = i2c_transfer(priv->i2c, &msg, 1);
 365        if (result != 1)
 366                pr_err("%s: i2c_transfer failed:%d",
 367                        __func__, result);
 368
 369        if (b_w <= 10000)
 370                lpf = 0xc;
 371        else if (b_w <= 12000)
 372                lpf = 0x2;
 373        else if (b_w <= 14000)
 374                lpf = 0xa;
 375        else if (b_w <= 16000)
 376                lpf = 0x6;
 377        else if (b_w <= 18000)
 378                lpf = 0xe;
 379        else if (b_w <= 20000)
 380                lpf = 0x1;
 381        else if (b_w <= 22000)
 382                lpf = 0x9;
 383        else if (b_w <= 24000)
 384                lpf = 0x5;
 385        else if (b_w <= 26000)
 386                lpf = 0xd;
 387        else if (b_w <= 28000)
 388                lpf = 0x3;
 389                else
 390                lpf = 0xb;
 391        buf[2] ^= 0x1c; /* Flip bits 3-5 */
 392        /* Set lpf */
 393        buf[2] |= ((lpf >> 2) & 0x3) << 3;
 394        buf[3] |= (lpf & 0x3) << 2;
 395
 396        return;
 397}
 398
 399static const struct dvb_pll_desc dvb_pll_opera1 = {
 400        .name  = "Opera Tuner",
 401        .min   =  900000,
 402        .max   = 2250000,
 403        .initdata = (u8[]){ 4, 0x08, 0xe5, 0xe1, 0x00 },
 404        .initdata2 = (u8[]){ 4, 0x08, 0xe5, 0xe5, 0x00 },
 405        .iffreq= 0,
 406        .set   = opera1_bw,
 407        .count = 8,
 408        .entries = {
 409                { 1064000, 500, 0xf9, 0xc2 },
 410                { 1169000, 500, 0xf9, 0xe2 },
 411                { 1299000, 500, 0xf9, 0x20 },
 412                { 1444000, 500, 0xf9, 0x40 },
 413                { 1606000, 500, 0xf9, 0x60 },
 414                { 1777000, 500, 0xf9, 0x80 },
 415                { 1941000, 500, 0xf9, 0xa0 },
 416                { 2250000, 500, 0xf9, 0xc0 },
 417        }
 418};
 419
 420static void samsung_dtos403ih102a_set(struct dvb_frontend *fe, u8 *buf)
 421{
 422        struct dvb_pll_priv *priv = fe->tuner_priv;
 423        struct i2c_msg msg = {
 424                .addr = priv->pll_i2c_address,
 425                .flags = 0,
 426                .buf = buf,
 427                .len = 4
 428        };
 429        int result;
 430
 431        if (fe->ops.i2c_gate_ctrl)
 432                fe->ops.i2c_gate_ctrl(fe, 1);
 433
 434        result = i2c_transfer(priv->i2c, &msg, 1);
 435        if (result != 1)
 436                pr_err("%s: i2c_transfer failed:%d",
 437                        __func__, result);
 438
 439        buf[2] = 0x9e;
 440        buf[3] = 0x90;
 441
 442        return;
 443}
 444
 445/* unknown pll used in Samsung DTOS403IH102A DVB-C tuner */
 446static const struct dvb_pll_desc dvb_pll_samsung_dtos403ih102a = {
 447        .name   = "Samsung DTOS403IH102A",
 448        .min    =  44250000,
 449        .max    = 858000000,
 450        .iffreq =  36125000,
 451        .count  = 8,
 452        .set    = samsung_dtos403ih102a_set,
 453        .entries = {
 454                { 135000000, 62500, 0xbe, 0x01 },
 455                { 177000000, 62500, 0xf6, 0x01 },
 456                { 370000000, 62500, 0xbe, 0x02 },
 457                { 450000000, 62500, 0xf6, 0x02 },
 458                { 466000000, 62500, 0xfe, 0x02 },
 459                { 538000000, 62500, 0xbe, 0x08 },
 460                { 826000000, 62500, 0xf6, 0x08 },
 461                { 999999999, 62500, 0xfe, 0x08 },
 462        }
 463};
 464
 465/* Samsung TDTC9251DH0 DVB-T NIM, as used on AirStar 2 */
 466static const struct dvb_pll_desc dvb_pll_samsung_tdtc9251dh0 = {
 467        .name   = "Samsung TDTC9251DH0",
 468        .min    =  48000000,
 469        .max    = 863000000,
 470        .iffreq =  36166667,
 471        .count  = 3,
 472        .entries = {
 473                { 157500000, 166667, 0xcc, 0x09 },
 474                { 443000000, 166667, 0xcc, 0x0a },
 475                { 863000000, 166667, 0xcc, 0x08 },
 476        }
 477};
 478
 479/* Samsung TBDU18132 DVB-S NIM with TSA5059 PLL, used in SkyStar2 DVB-S 2.3 */
 480static const struct dvb_pll_desc dvb_pll_samsung_tbdu18132 = {
 481        .name = "Samsung TBDU18132",
 482        .min    =  950000,
 483        .max    = 2150000, /* guesses */
 484        .iffreq = 0,
 485        .count = 2,
 486        .entries = {
 487                { 1550000, 125, 0x84, 0x82 },
 488                { 4095937, 125, 0x84, 0x80 },
 489        }
 490        /* TSA5059 PLL has a 17 bit divisor rather than the 15 bits supported
 491         * by this driver.  The two extra bits are 0x60 in the third byte.  15
 492         * bits is enough for over 4 GHz, which is enough to cover the range
 493         * of this tuner.  We could use the additional divisor bits by adding
 494         * more entries, e.g.
 495         { 0x0ffff * 125 + 125/2, 125, 0x84 | 0x20, },
 496         { 0x17fff * 125 + 125/2, 125, 0x84 | 0x40, },
 497         { 0x1ffff * 125 + 125/2, 125, 0x84 | 0x60, }, */
 498};
 499
 500/* Samsung TBMU24112 DVB-S NIM with SL1935 zero-IF tuner */
 501static const struct dvb_pll_desc dvb_pll_samsung_tbmu24112 = {
 502        .name = "Samsung TBMU24112",
 503        .min    =  950000,
 504        .max    = 2150000, /* guesses */
 505        .iffreq = 0,
 506        .count = 2,
 507        .entries = {
 508                { 1500000, 125, 0x84, 0x18 },
 509                { 9999999, 125, 0x84, 0x08 },
 510        }
 511};
 512
 513/* Alps TDEE4 DVB-C NIM, used on Cablestar 2 */
 514/* byte 4 : 1  *   *   AGD R3  R2  R1  R0
 515 * byte 5 : C1 *   RE  RTS BS4 BS3 BS2 BS1
 516 * AGD = 1, R3 R2 R1 R0 = 0 1 0 1 => byte 4 = 1**10101 = 0x95
 517 * Range(MHz)  C1 *  RE RTS BS4 BS3 BS2 BS1  Byte 5
 518 *  47 - 153   0  *  0   0   0   0   0   1   0x01
 519 * 153 - 430   0  *  0   0   0   0   1   0   0x02
 520 * 430 - 822   0  *  0   0   1   0   0   0   0x08
 521 * 822 - 862   1  *  0   0   1   0   0   0   0x88 */
 522static const struct dvb_pll_desc dvb_pll_alps_tdee4 = {
 523        .name = "ALPS TDEE4",
 524        .min    =  47000000,
 525        .max    = 862000000,
 526        .iffreq =  36125000,
 527        .count = 4,
 528        .entries = {
 529                { 153000000, 62500, 0x95, 0x01 },
 530                { 430000000, 62500, 0x95, 0x02 },
 531                { 822000000, 62500, 0x95, 0x08 },
 532                { 999999999, 62500, 0x95, 0x88 },
 533        }
 534};
 535
 536/* ----------------------------------------------------------- */
 537
 538static const struct dvb_pll_desc *pll_list[] = {
 539        [DVB_PLL_UNDEFINED]              = NULL,
 540        [DVB_PLL_THOMSON_DTT7579]        = &dvb_pll_thomson_dtt7579,
 541        [DVB_PLL_THOMSON_DTT759X]        = &dvb_pll_thomson_dtt759x,
 542        [DVB_PLL_THOMSON_DTT7520X]       = &dvb_pll_thomson_dtt7520x,
 543        [DVB_PLL_LG_Z201]                = &dvb_pll_lg_z201,
 544        [DVB_PLL_UNKNOWN_1]              = &dvb_pll_unknown_1,
 545        [DVB_PLL_TUA6010XS]              = &dvb_pll_tua6010xs,
 546        [DVB_PLL_ENV57H1XD5]             = &dvb_pll_env57h1xd5,
 547        [DVB_PLL_TUA6034]                = &dvb_pll_tua6034,
 548        [DVB_PLL_TDA665X]                = &dvb_pll_tda665x,
 549        [DVB_PLL_TDED4]                  = &dvb_pll_tded4,
 550        [DVB_PLL_TDEE4]                  = &dvb_pll_alps_tdee4,
 551        [DVB_PLL_TDHU2]                  = &dvb_pll_tdhu2,
 552        [DVB_PLL_SAMSUNG_TBMV]           = &dvb_pll_samsung_tbmv,
 553        [DVB_PLL_PHILIPS_SD1878_TDA8261] = &dvb_pll_philips_sd1878_tda8261,
 554        [DVB_PLL_OPERA1]                 = &dvb_pll_opera1,
 555        [DVB_PLL_SAMSUNG_DTOS403IH102A]  = &dvb_pll_samsung_dtos403ih102a,
 556        [DVB_PLL_SAMSUNG_TDTC9251DH0]    = &dvb_pll_samsung_tdtc9251dh0,
 557        [DVB_PLL_SAMSUNG_TBDU18132]      = &dvb_pll_samsung_tbdu18132,
 558        [DVB_PLL_SAMSUNG_TBMU24112]      = &dvb_pll_samsung_tbmu24112,
 559};
 560
 561/* ----------------------------------------------------------- */
 562/* code                                                        */
 563
 564static int dvb_pll_configure(struct dvb_frontend *fe, u8 *buf,
 565                             const u32 frequency)
 566{
 567        struct dvb_pll_priv *priv = fe->tuner_priv;
 568        const struct dvb_pll_desc *desc = priv->pll_desc;
 569        u32 div;
 570        int i;
 571
 572        if (frequency && (frequency < desc->min || frequency > desc->max))
 573                return -EINVAL;
 574
 575        for (i = 0; i < desc->count; i++) {
 576                if (frequency > desc->entries[i].limit)
 577                        continue;
 578                break;
 579        }
 580
 581        if (debug)
 582                dprintk("pll: %s: freq=%d | i=%d/%d\n", desc->name,
 583                       frequency, i, desc->count);
 584        if (i == desc->count)
 585                return -EINVAL;
 586
 587        div = (frequency + desc->iffreq +
 588               desc->entries[i].stepsize/2) / desc->entries[i].stepsize;
 589        buf[0] = div >> 8;
 590        buf[1] = div & 0xff;
 591        buf[2] = desc->entries[i].config;
 592        buf[3] = desc->entries[i].cb;
 593
 594        if (desc->set)
 595                desc->set(fe, buf);
 596
 597        if (debug)
 598                dprintk("pll: %s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
 599                       desc->name, div, buf[0], buf[1], buf[2], buf[3]);
 600
 601        // calculate the frequency we set it to
 602        return (div * desc->entries[i].stepsize) - desc->iffreq;
 603}
 604
 605static void dvb_pll_release(struct dvb_frontend *fe)
 606{
 607        kfree(fe->tuner_priv);
 608        fe->tuner_priv = NULL;
 609}
 610
 611static int dvb_pll_sleep(struct dvb_frontend *fe)
 612{
 613        struct dvb_pll_priv *priv = fe->tuner_priv;
 614
 615        if (priv->i2c == NULL)
 616                return -EINVAL;
 617
 618        if (priv->pll_desc->sleepdata) {
 619                struct i2c_msg msg = { .flags = 0,
 620                        .addr = priv->pll_i2c_address,
 621                        .buf = priv->pll_desc->sleepdata + 1,
 622                        .len = priv->pll_desc->sleepdata[0] };
 623
 624                int result;
 625
 626                if (fe->ops.i2c_gate_ctrl)
 627                        fe->ops.i2c_gate_ctrl(fe, 1);
 628                if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 629                        return result;
 630                }
 631                return 0;
 632        }
 633        /* Shouldn't be called when initdata is NULL, maybe BUG()? */
 634        return -EINVAL;
 635}
 636
 637static int dvb_pll_set_params(struct dvb_frontend *fe)
 638{
 639        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
 640        struct dvb_pll_priv *priv = fe->tuner_priv;
 641        u8 buf[4];
 642        struct i2c_msg msg =
 643                { .addr = priv->pll_i2c_address, .flags = 0,
 644                  .buf = buf, .len = sizeof(buf) };
 645        int result;
 646        u32 frequency = 0;
 647
 648        if (priv->i2c == NULL)
 649                return -EINVAL;
 650
 651        result = dvb_pll_configure(fe, buf, c->frequency);
 652        if (result < 0)
 653                return result;
 654        else
 655                frequency = result;
 656
 657        if (fe->ops.i2c_gate_ctrl)
 658                fe->ops.i2c_gate_ctrl(fe, 1);
 659        if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
 660                return result;
 661        }
 662
 663        priv->frequency = frequency;
 664        priv->bandwidth = c->bandwidth_hz;
 665
 666        return 0;
 667}
 668
 669static int dvb_pll_calc_regs(struct dvb_frontend *fe,
 670                             u8 *buf, int buf_len)
 671{
 672        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
 673        struct dvb_pll_priv *priv = fe->tuner_priv;
 674        int result;
 675        u32 frequency = 0;
 676
 677        if (buf_len < 5)
 678                return -EINVAL;
 679
 680        result = dvb_pll_configure(fe, buf + 1, c->frequency);
 681        if (result < 0)
 682                return result;
 683        else
 684                frequency = result;
 685
 686        buf[0] = priv->pll_i2c_address;
 687
 688        priv->frequency = frequency;
 689        priv->bandwidth = c->bandwidth_hz;
 690
 691        return 5;
 692}
 693
 694static int dvb_pll_get_frequency(struct dvb_frontend *fe, u32 *frequency)
 695{
 696        struct dvb_pll_priv *priv = fe->tuner_priv;
 697        *frequency = priv->frequency;
 698        return 0;
 699}
 700
 701static int dvb_pll_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
 702{
 703        struct dvb_pll_priv *priv = fe->tuner_priv;
 704        *bandwidth = priv->bandwidth;
 705        return 0;
 706}
 707
 708static int dvb_pll_init(struct dvb_frontend *fe)
 709{
 710        struct dvb_pll_priv *priv = fe->tuner_priv;
 711
 712        if (priv->i2c == NULL)
 713                return -EINVAL;
 714
 715        if (priv->pll_desc->initdata) {
 716                struct i2c_msg msg = { .flags = 0,
 717                        .addr = priv->pll_i2c_address,
 718                        .buf = priv->pll_desc->initdata + 1,
 719                        .len = priv->pll_desc->initdata[0] };
 720
 721                int result;
 722                if (fe->ops.i2c_gate_ctrl)
 723                        fe->ops.i2c_gate_ctrl(fe, 1);
 724                result = i2c_transfer(priv->i2c, &msg, 1);
 725                if (result != 1)
 726                        return result;
 727                if (priv->pll_desc->initdata2) {
 728                        msg.buf = priv->pll_desc->initdata2 + 1;
 729                        msg.len = priv->pll_desc->initdata2[0];
 730                        if (fe->ops.i2c_gate_ctrl)
 731                                fe->ops.i2c_gate_ctrl(fe, 1);
 732                        result = i2c_transfer(priv->i2c, &msg, 1);
 733                        if (result != 1)
 734                                return result;
 735                }
 736                return 0;
 737        }
 738        /* Shouldn't be called when initdata is NULL, maybe BUG()? */
 739        return -EINVAL;
 740}
 741
 742static const struct dvb_tuner_ops dvb_pll_tuner_ops = {
 743        .release = dvb_pll_release,
 744        .sleep = dvb_pll_sleep,
 745        .init = dvb_pll_init,
 746        .set_params = dvb_pll_set_params,
 747        .calc_regs = dvb_pll_calc_regs,
 748        .get_frequency = dvb_pll_get_frequency,
 749        .get_bandwidth = dvb_pll_get_bandwidth,
 750};
 751
 752struct dvb_frontend *dvb_pll_attach(struct dvb_frontend *fe, int pll_addr,
 753                                    struct i2c_adapter *i2c,
 754                                    unsigned int pll_desc_id)
 755{
 756        u8 b1 [] = { 0 };
 757        struct i2c_msg msg = { .addr = pll_addr, .flags = I2C_M_RD,
 758                               .buf = b1, .len = 1 };
 759        struct dvb_pll_priv *priv = NULL;
 760        int ret;
 761        const struct dvb_pll_desc *desc;
 762
 763        if ((id[dvb_pll_devcount] > DVB_PLL_UNDEFINED) &&
 764            (id[dvb_pll_devcount] < ARRAY_SIZE(pll_list)))
 765                pll_desc_id = id[dvb_pll_devcount];
 766
 767        BUG_ON(pll_desc_id < 1 || pll_desc_id >= ARRAY_SIZE(pll_list));
 768
 769        desc = pll_list[pll_desc_id];
 770
 771        if (i2c != NULL) {
 772                if (fe->ops.i2c_gate_ctrl)
 773                        fe->ops.i2c_gate_ctrl(fe, 1);
 774
 775                ret = i2c_transfer (i2c, &msg, 1);
 776                if (ret != 1)
 777                        return NULL;
 778                if (fe->ops.i2c_gate_ctrl)
 779                             fe->ops.i2c_gate_ctrl(fe, 0);
 780        }
 781
 782        priv = kzalloc(sizeof(struct dvb_pll_priv), GFP_KERNEL);
 783        if (priv == NULL)
 784                return NULL;
 785
 786        priv->pll_i2c_address = pll_addr;
 787        priv->i2c = i2c;
 788        priv->pll_desc = desc;
 789        priv->nr = dvb_pll_devcount++;
 790
 791        memcpy(&fe->ops.tuner_ops, &dvb_pll_tuner_ops,
 792               sizeof(struct dvb_tuner_ops));
 793
 794        strncpy(fe->ops.tuner_ops.info.name, desc->name,
 795                sizeof(fe->ops.tuner_ops.info.name));
 796        fe->ops.tuner_ops.info.frequency_min = desc->min;
 797        fe->ops.tuner_ops.info.frequency_max = desc->max;
 798        if (!desc->initdata)
 799                fe->ops.tuner_ops.init = NULL;
 800        if (!desc->sleepdata)
 801                fe->ops.tuner_ops.sleep = NULL;
 802
 803        fe->tuner_priv = priv;
 804
 805        if ((debug) || (id[priv->nr] == pll_desc_id)) {
 806                dprintk("dvb-pll[%d]", priv->nr);
 807                if (i2c != NULL)
 808                        pr_cont(" %d-%04x", i2c_adapter_id(i2c), pll_addr);
 809                pr_cont(": id# %d (%s) attached, %s\n", pll_desc_id, desc->name,
 810                       id[priv->nr] == pll_desc_id ?
 811                                "insmod option" : "autodetected");
 812        }
 813
 814        return fe;
 815}
 816EXPORT_SYMBOL(dvb_pll_attach);
 817
 818MODULE_DESCRIPTION("dvb pll library");
 819MODULE_AUTHOR("Gerd Knorr");
 820MODULE_LICENSE("GPL");
 821