root/drivers/media/dvb-frontends/dvb-pll.c
// SPDX-License-Identifier: GPL-2.0-or-later
/*
 * descriptions + helper functions for simple dvb plls.
 *
 * (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
 */

#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/slab.h>
#include <linux/module.h>
#include <linux/idr.h>
#include <linux/dvb/frontend.h>
#include <asm/types.h>

#include "dvb-pll.h"

#define dprintk(fmt, arg...) \
        printk(KERN_DEBUG pr_fmt("%s: " fmt), __func__, ##arg)

struct dvb_pll_priv {
        /* pll number */
        int nr;

        /* i2c details */
        int pll_i2c_address;
        struct i2c_adapter *i2c;

        /* the PLL descriptor */
        const struct dvb_pll_desc *pll_desc;

        /* cached frequency/bandwidth */
        u32 frequency;
        u32 bandwidth;
};

#define DVB_PLL_MAX 64
static DEFINE_IDA(pll_ida);

static int debug;
module_param(debug, int, 0644);
MODULE_PARM_DESC(debug, "enable verbose debug messages");

static unsigned int id[DVB_PLL_MAX] =
        { [ 0 ... (DVB_PLL_MAX-1) ] = DVB_PLL_UNDEFINED };
module_param_array(id, int, NULL, 0644);
MODULE_PARM_DESC(id, "force pll id to use (DEBUG ONLY)");

/* ----------------------------------------------------------- */

struct dvb_pll_desc {
        const char *name;
        u32  min;
        u32  max;
        u32  iffreq;
        void (*set)(struct dvb_frontend *fe, u8 *buf);
        u8   *initdata;
        u8   *initdata2;
        u8   *sleepdata;
        int  count;
        struct {
                u32 limit;
                u32 stepsize;
                u8  config;
                u8  cb;
        } entries[];
};

/* ----------------------------------------------------------- */
/* descriptions                                                */

static const struct dvb_pll_desc dvb_pll_thomson_dtt7579 = {
        .name  = "Thomson dtt7579",
        .min   = 177 * MHz,
        .max   = 858 * MHz,
        .iffreq= 36166667,
        .sleepdata = (u8[]){ 2, 0xb4, 0x03 },
        .count = 4,
        .entries = {
                {  443250000, 166667, 0xb4, 0x02 },
                {  542000000, 166667, 0xb4, 0x08 },
                {  771000000, 166667, 0xbc, 0x08 },
                {  999999999, 166667, 0xf4, 0x08 },
        },
};

static void thomson_dtt759x_bw(struct dvb_frontend *fe, u8 *buf)
{
        u32 bw = fe->dtv_property_cache.bandwidth_hz;
        if (bw == 7000000)
                buf[3] |= 0x10;
}

static const struct dvb_pll_desc dvb_pll_thomson_dtt759x = {
        .name  = "Thomson dtt759x",
        .min   = 177 * MHz,
        .max   = 896 * MHz,
        .set   = thomson_dtt759x_bw,
        .iffreq= 36166667,
        .sleepdata = (u8[]){ 2, 0x84, 0x03 },
        .count = 5,
        .entries = {
                {  264000000, 166667, 0xb4, 0x02 },
                {  470000000, 166667, 0xbc, 0x02 },
                {  735000000, 166667, 0xbc, 0x08 },
                {  835000000, 166667, 0xf4, 0x08 },
                {  999999999, 166667, 0xfc, 0x08 },
        },
};

static void thomson_dtt7520x_bw(struct dvb_frontend *fe, u8 *buf)
{
        u32 bw = fe->dtv_property_cache.bandwidth_hz;
        if (bw == 8000000)
                buf[3] ^= 0x10;
}

static const struct dvb_pll_desc dvb_pll_thomson_dtt7520x = {
        .name  = "Thomson dtt7520x",
        .min   = 185 * MHz,
        .max   = 900 * MHz,
        .set   = thomson_dtt7520x_bw,
        .iffreq = 36166667,
        .count = 7,
        .entries = {
                {  305000000, 166667, 0xb4, 0x12 },
                {  405000000, 166667, 0xbc, 0x12 },
                {  445000000, 166667, 0xbc, 0x12 },
                {  465000000, 166667, 0xf4, 0x18 },
                {  735000000, 166667, 0xfc, 0x18 },
                {  835000000, 166667, 0xbc, 0x18 },
                {  999999999, 166667, 0xfc, 0x18 },
        },
};

static const struct dvb_pll_desc dvb_pll_lg_z201 = {
        .name  = "LG z201",
        .min   = 174 * MHz,
        .max   = 862 * MHz,
        .iffreq= 36166667,
        .sleepdata = (u8[]){ 2, 0xbc, 0x03 },
        .count = 5,
        .entries = {
                {  157500000, 166667, 0xbc, 0x01 },
                {  443250000, 166667, 0xbc, 0x02 },
                {  542000000, 166667, 0xbc, 0x04 },
                {  830000000, 166667, 0xf4, 0x04 },
                {  999999999, 166667, 0xfc, 0x04 },
        },
};

static const struct dvb_pll_desc dvb_pll_unknown_1 = {
        .name  = "unknown 1", /* used by dntv live dvb-t */
        .min   = 174 * MHz,
        .max   = 862 * MHz,
        .iffreq= 36166667,
        .count = 9,
        .entries = {
                {  150000000, 166667, 0xb4, 0x01 },
                {  173000000, 166667, 0xbc, 0x01 },
                {  250000000, 166667, 0xb4, 0x02 },
                {  400000000, 166667, 0xbc, 0x02 },
                {  420000000, 166667, 0xf4, 0x02 },
                {  470000000, 166667, 0xfc, 0x02 },
                {  600000000, 166667, 0xbc, 0x08 },
                {  730000000, 166667, 0xf4, 0x08 },
                {  999999999, 166667, 0xfc, 0x08 },
        },
};

/* Infineon TUA6010XS
 * used in Thomson Cable Tuner
 */
static const struct dvb_pll_desc dvb_pll_tua6010xs = {
        .name  = "Infineon TUA6010XS",
        .min   = 44250 * kHz,
        .max   = 858 * MHz,
        .iffreq= 36125000,
        .count = 3,
        .entries = {
                {  115750000, 62500, 0x8e, 0x03 },
                {  403250000, 62500, 0x8e, 0x06 },
                {  999999999, 62500, 0x8e, 0x85 },
        },
};

/* Panasonic env57h1xd5 (some Philips PLL ?) */
static const struct dvb_pll_desc dvb_pll_env57h1xd5 = {
        .name  = "Panasonic ENV57H1XD5",
        .min   = 44250 * kHz,
        .max   = 858 * MHz,
        .iffreq= 36125000,
        .count = 4,
        .entries = {
                {  153000000, 166667, 0xc2, 0x41 },
                {  470000000, 166667, 0xc2, 0x42 },
                {  526000000, 166667, 0xc2, 0x84 },
                {  999999999, 166667, 0xc2, 0xa4 },
        },
};

/* Philips TDA6650/TDA6651
 * used in Panasonic ENV77H11D5
 */
static void tda665x_bw(struct dvb_frontend *fe, u8 *buf)
{
        u32 bw = fe->dtv_property_cache.bandwidth_hz;
        if (bw == 8000000)
                buf[3] |= 0x08;
}

static const struct dvb_pll_desc dvb_pll_tda665x = {
        .name  = "Philips TDA6650/TDA6651",
        .min   = 44250 * kHz,
        .max   = 858 * MHz,
        .set   = tda665x_bw,
        .iffreq= 36166667,
        .initdata = (u8[]){ 4, 0x0b, 0xf5, 0x85, 0xab },
        .count = 12,
        .entries = {
                {   93834000, 166667, 0xca, 0x61 /* 011 0 0 0  01 */ },
                {  123834000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
                {  161000000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
                {  163834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
                {  253834000, 166667, 0xca, 0x62 /* 011 0 0 0  10 */ },
                {  383834000, 166667, 0xca, 0xa2 /* 101 0 0 0  10 */ },
                {  443834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
                {  444000000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
                {  583834000, 166667, 0xca, 0x64 /* 011 0 0 1  00 */ },
                {  793834000, 166667, 0xca, 0xa4 /* 101 0 0 1  00 */ },
                {  444834000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
                {  861000000, 166667, 0xca, 0xe4 /* 111 0 0 1  00 */ },
        }
};

/* Infineon TUA6034
 * used in LG TDTP E102P
 */
static void tua6034_bw(struct dvb_frontend *fe, u8 *buf)
{
        u32 bw = fe->dtv_property_cache.bandwidth_hz;
        if (bw == 7000000)
                buf[3] |= 0x08;
}

static const struct dvb_pll_desc dvb_pll_tua6034 = {
        .name  = "Infineon TUA6034",
        .min   = 44250 * kHz,
        .max   = 858 * MHz,
        .iffreq= 36166667,
        .count = 3,
        .set   = tua6034_bw,
        .entries = {
                {  174500000, 62500, 0xce, 0x01 },
                {  230000000, 62500, 0xce, 0x02 },
                {  999999999, 62500, 0xce, 0x04 },
        },
};

/* ALPS TDED4
 * used in Nebula-Cards and USB boxes
 */
static void tded4_bw(struct dvb_frontend *fe, u8 *buf)
{
        u32 bw = fe->dtv_property_cache.bandwidth_hz;
        if (bw == 8000000)
                buf[3] |= 0x04;
}

static const struct dvb_pll_desc dvb_pll_tded4 = {
        .name = "ALPS TDED4",
        .min =  47 * MHz,
        .max = 863 * MHz,
        .iffreq= 36166667,
        .set   = tded4_bw,
        .count = 4,
        .entries = {
                { 153000000, 166667, 0x85, 0x01 },
                { 470000000, 166667, 0x85, 0x02 },
                { 823000000, 166667, 0x85, 0x08 },
                { 999999999, 166667, 0x85, 0x88 },
        }
};

/* ALPS TDHU2
 * used in AverTVHD MCE A180
 */
static const struct dvb_pll_desc dvb_pll_tdhu2 = {
        .name = "ALPS TDHU2",
        .min =  54 * MHz,
        .max = 864 * MHz,
        .iffreq= 44000000,
        .count = 4,
        .entries = {
                { 162000000, 62500, 0x85, 0x01 },
                { 426000000, 62500, 0x85, 0x02 },
                { 782000000, 62500, 0x85, 0x08 },
                { 999999999, 62500, 0x85, 0x88 },
        }
};

/* Samsung TBMV30111IN / TBMV30712IN1
 * used in Air2PC ATSC - 2nd generation (nxt2002)
 */
static const struct dvb_pll_desc dvb_pll_samsung_tbmv = {
        .name = "Samsung TBMV30111IN / TBMV30712IN1",
        .min =  54 * MHz,
        .max = 860 * MHz,
        .iffreq= 44000000,
        .count = 6,
        .entries = {
                { 172000000, 166667, 0xb4, 0x01 },
                { 214000000, 166667, 0xb4, 0x02 },
                { 467000000, 166667, 0xbc, 0x02 },
                { 721000000, 166667, 0xbc, 0x08 },
                { 841000000, 166667, 0xf4, 0x08 },
                { 999999999, 166667, 0xfc, 0x02 },
        }
};

/*
 * Philips SD1878 Tuner.
 */
static const struct dvb_pll_desc dvb_pll_philips_sd1878_tda8261 = {
        .name  = "Philips SD1878",
        .min   =  950 * MHz,
        .max   = 2150 * MHz,
        .iffreq= 249, /* zero-IF, offset 249 is to round up */
        .count = 4,
        .entries = {
                { 1250000, 500, 0xc4, 0x00},
                { 1450000, 500, 0xc4, 0x40},
                { 2050000, 500, 0xc4, 0x80},
                { 2150000, 500, 0xc4, 0xc0},
        },
};

static void opera1_bw(struct dvb_frontend *fe, u8 *buf)
{
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
        struct dvb_pll_priv *priv = fe->tuner_priv;
        u32 b_w  = (c->symbol_rate * 27) / 32000;
        struct i2c_msg msg = {
                .addr = priv->pll_i2c_address,
                .flags = 0,
                .buf = buf,
                .len = 4
        };
        int result;
        u8 lpf;

        if (fe->ops.i2c_gate_ctrl)
                fe->ops.i2c_gate_ctrl(fe, 1);

        result = i2c_transfer(priv->i2c, &msg, 1);
        if (result != 1)
                pr_err("%s: i2c_transfer failed:%d",
                        __func__, result);

        if (b_w <= 10000)
                lpf = 0xc;
        else if (b_w <= 12000)
                lpf = 0x2;
        else if (b_w <= 14000)
                lpf = 0xa;
        else if (b_w <= 16000)
                lpf = 0x6;
        else if (b_w <= 18000)
                lpf = 0xe;
        else if (b_w <= 20000)
                lpf = 0x1;
        else if (b_w <= 22000)
                lpf = 0x9;
        else if (b_w <= 24000)
                lpf = 0x5;
        else if (b_w <= 26000)
                lpf = 0xd;
        else if (b_w <= 28000)
                lpf = 0x3;
                else
                lpf = 0xb;
        buf[2] ^= 0x1c; /* Flip bits 3-5 */
        /* Set lpf */
        buf[2] |= ((lpf >> 2) & 0x3) << 3;
        buf[3] |= (lpf & 0x3) << 2;

        return;
}

static const struct dvb_pll_desc dvb_pll_opera1 = {
        .name  = "Opera Tuner",
        .min   =  900 * MHz,
        .max   = 2250 * MHz,
        .initdata = (u8[]){ 4, 0x08, 0xe5, 0xe1, 0x00 },
        .initdata2 = (u8[]){ 4, 0x08, 0xe5, 0xe5, 0x00 },
        .iffreq= 0,
        .set   = opera1_bw,
        .count = 8,
        .entries = {
                { 1064000, 500, 0xf9, 0xc2 },
                { 1169000, 500, 0xf9, 0xe2 },
                { 1299000, 500, 0xf9, 0x20 },
                { 1444000, 500, 0xf9, 0x40 },
                { 1606000, 500, 0xf9, 0x60 },
                { 1777000, 500, 0xf9, 0x80 },
                { 1941000, 500, 0xf9, 0xa0 },
                { 2250000, 500, 0xf9, 0xc0 },
        }
};

static void samsung_dtos403ih102a_set(struct dvb_frontend *fe, u8 *buf)
{
        struct dvb_pll_priv *priv = fe->tuner_priv;
        struct i2c_msg msg = {
                .addr = priv->pll_i2c_address,
                .flags = 0,
                .buf = buf,
                .len = 4
        };
        int result;

        if (fe->ops.i2c_gate_ctrl)
                fe->ops.i2c_gate_ctrl(fe, 1);

        result = i2c_transfer(priv->i2c, &msg, 1);
        if (result != 1)
                pr_err("%s: i2c_transfer failed:%d",
                        __func__, result);

        buf[2] = 0x9e;
        buf[3] = 0x90;

        return;
}

/* unknown pll used in Samsung DTOS403IH102A DVB-C tuner */
static const struct dvb_pll_desc dvb_pll_samsung_dtos403ih102a = {
        .name   = "Samsung DTOS403IH102A",
        .min    = 44250 * kHz,
        .max    = 858 * MHz,
        .iffreq =  36125000,
        .count  = 8,
        .set    = samsung_dtos403ih102a_set,
        .entries = {
                { 135000000, 62500, 0xbe, 0x01 },
                { 177000000, 62500, 0xf6, 0x01 },
                { 370000000, 62500, 0xbe, 0x02 },
                { 450000000, 62500, 0xf6, 0x02 },
                { 466000000, 62500, 0xfe, 0x02 },
                { 538000000, 62500, 0xbe, 0x08 },
                { 826000000, 62500, 0xf6, 0x08 },
                { 999999999, 62500, 0xfe, 0x08 },
        }
};

/* Samsung TDTC9251DH0 DVB-T NIM, as used on AirStar 2 */
static const struct dvb_pll_desc dvb_pll_samsung_tdtc9251dh0 = {
        .name   = "Samsung TDTC9251DH0",
        .min    =  48 * MHz,
        .max    = 863 * MHz,
        .iffreq =  36166667,
        .count  = 3,
        .entries = {
                { 157500000, 166667, 0xcc, 0x09 },
                { 443000000, 166667, 0xcc, 0x0a },
                { 863000000, 166667, 0xcc, 0x08 },
        }
};

/* Samsung TBDU18132 DVB-S NIM with TSA5059 PLL, used in SkyStar2 DVB-S 2.3 */
static const struct dvb_pll_desc dvb_pll_samsung_tbdu18132 = {
        .name = "Samsung TBDU18132",
        .min    =  950 * MHz,
        .max    = 2150 * MHz, /* guesses */
        .iffreq = 0,
        .count = 2,
        .entries = {
                { 1550000, 125, 0x84, 0x82 },
                { 4095937, 125, 0x84, 0x80 },
        }
        /* TSA5059 PLL has a 17 bit divisor rather than the 15 bits supported
         * by this driver.  The two extra bits are 0x60 in the third byte.  15
         * bits is enough for over 4 GHz, which is enough to cover the range
         * of this tuner.  We could use the additional divisor bits by adding
         * more entries, e.g.
         { 0x0ffff * 125 + 125/2, 125, 0x84 | 0x20, },
         { 0x17fff * 125 + 125/2, 125, 0x84 | 0x40, },
         { 0x1ffff * 125 + 125/2, 125, 0x84 | 0x60, }, */
};

/* Samsung TBMU24112 DVB-S NIM with SL1935 zero-IF tuner */
static const struct dvb_pll_desc dvb_pll_samsung_tbmu24112 = {
        .name = "Samsung TBMU24112",
        .min    =  950 * MHz,
        .max    = 2150 * MHz, /* guesses */
        .iffreq = 0,
        .count = 2,
        .entries = {
                { 1500000, 125, 0x84, 0x18 },
                { 9999999, 125, 0x84, 0x08 },
        }
};

/* Alps TDEE4 DVB-C NIM, used on Cablestar 2 */
/* byte 4 : 1  *   *   AGD R3  R2  R1  R0
 * byte 5 : C1 *   RE  RTS BS4 BS3 BS2 BS1
 * AGD = 1, R3 R2 R1 R0 = 0 1 0 1 => byte 4 = 1**10101 = 0x95
 * Range(MHz)  C1 *  RE RTS BS4 BS3 BS2 BS1  Byte 5
 *  47 - 153   0  *  0   0   0   0   0   1   0x01
 * 153 - 430   0  *  0   0   0   0   1   0   0x02
 * 430 - 822   0  *  0   0   1   0   0   0   0x08
 * 822 - 862   1  *  0   0   1   0   0   0   0x88 */
static const struct dvb_pll_desc dvb_pll_alps_tdee4 = {
        .name = "ALPS TDEE4",
        .min    =  47 * MHz,
        .max    = 862 * MHz,
        .iffreq =  36125000,
        .count = 4,
        .entries = {
                { 153000000, 62500, 0x95, 0x01 },
                { 430000000, 62500, 0x95, 0x02 },
                { 822000000, 62500, 0x95, 0x08 },
                { 999999999, 62500, 0x95, 0x88 },
        }
};

/* Infineon TUA6034 ISDB-T, used in Friio */
/* CP cur. 50uA, AGC takeover: 103dBuV, PORT3 on */
static const struct dvb_pll_desc dvb_pll_tua6034_friio = {
        .name   = "Infineon TUA6034 ISDB-T (Friio)",
        .min    =  90 * MHz,
        .max    = 770 * MHz,
        .iffreq =  57000000,
        .initdata = (u8[]){ 4, 0x9a, 0x50, 0xb2, 0x08 },
        .sleepdata = (u8[]){ 4, 0x9a, 0x70, 0xb3, 0x0b },
        .count = 3,
        .entries = {
                { 170000000, 142857, 0xba, 0x09 },
                { 470000000, 142857, 0xba, 0x0a },
                { 770000000, 142857, 0xb2, 0x08 },
        }
};

/* Philips TDA6651 ISDB-T, used in Earthsoft PT1 */
static const struct dvb_pll_desc dvb_pll_tda665x_earth_pt1 = {
        .name   = "Philips TDA6651 ISDB-T (EarthSoft PT1)",
        .min    =  90 * MHz,
        .max    = 770 * MHz,
        .iffreq =  57000000,
        .initdata = (u8[]){ 5, 0x0e, 0x7f, 0xc1, 0x80, 0x80 },
        .count = 10,
        .entries = {
                { 140000000, 142857, 0xc1, 0x81 },
                { 170000000, 142857, 0xc1, 0xa1 },
                { 220000000, 142857, 0xc1, 0x62 },
                { 330000000, 142857, 0xc1, 0xa2 },
                { 402000000, 142857, 0xc1, 0xe2 },
                { 450000000, 142857, 0xc1, 0x64 },
                { 550000000, 142857, 0xc1, 0x84 },
                { 600000000, 142857, 0xc1, 0xa4 },
                { 700000000, 142857, 0xc1, 0xc4 },
                { 770000000, 142857, 0xc1, 0xe4 },
        }
};

/* ----------------------------------------------------------- */

static const struct dvb_pll_desc *pll_list[] = {
        [DVB_PLL_UNDEFINED]              = NULL,
        [DVB_PLL_THOMSON_DTT7579]        = &dvb_pll_thomson_dtt7579,
        [DVB_PLL_THOMSON_DTT759X]        = &dvb_pll_thomson_dtt759x,
        [DVB_PLL_THOMSON_DTT7520X]       = &dvb_pll_thomson_dtt7520x,
        [DVB_PLL_LG_Z201]                = &dvb_pll_lg_z201,
        [DVB_PLL_UNKNOWN_1]              = &dvb_pll_unknown_1,
        [DVB_PLL_TUA6010XS]              = &dvb_pll_tua6010xs,
        [DVB_PLL_ENV57H1XD5]             = &dvb_pll_env57h1xd5,
        [DVB_PLL_TUA6034]                = &dvb_pll_tua6034,
        [DVB_PLL_TDA665X]                = &dvb_pll_tda665x,
        [DVB_PLL_TDED4]                  = &dvb_pll_tded4,
        [DVB_PLL_TDEE4]                  = &dvb_pll_alps_tdee4,
        [DVB_PLL_TDHU2]                  = &dvb_pll_tdhu2,
        [DVB_PLL_SAMSUNG_TBMV]           = &dvb_pll_samsung_tbmv,
        [DVB_PLL_PHILIPS_SD1878_TDA8261] = &dvb_pll_philips_sd1878_tda8261,
        [DVB_PLL_OPERA1]                 = &dvb_pll_opera1,
        [DVB_PLL_SAMSUNG_DTOS403IH102A]  = &dvb_pll_samsung_dtos403ih102a,
        [DVB_PLL_SAMSUNG_TDTC9251DH0]    = &dvb_pll_samsung_tdtc9251dh0,
        [DVB_PLL_SAMSUNG_TBDU18132]      = &dvb_pll_samsung_tbdu18132,
        [DVB_PLL_SAMSUNG_TBMU24112]      = &dvb_pll_samsung_tbmu24112,
        [DVB_PLL_TUA6034_FRIIO]          = &dvb_pll_tua6034_friio,
        [DVB_PLL_TDA665X_EARTH_PT1]      = &dvb_pll_tda665x_earth_pt1,
};

/* ----------------------------------------------------------- */
/* code                                                        */

static int dvb_pll_configure(struct dvb_frontend *fe, u8 *buf,
                             const u32 frequency)
{
        struct dvb_pll_priv *priv = fe->tuner_priv;
        const struct dvb_pll_desc *desc = priv->pll_desc;
        u32 div;
        int i;

        for (i = 0; i < desc->count; i++) {
                if (frequency > desc->entries[i].limit)
                        continue;
                break;
        }

        if (debug)
                dprintk("pll: %s: freq=%d | i=%d/%d\n", desc->name,
                       frequency, i, desc->count);
        if (i == desc->count)
                return -EINVAL;

        div = (frequency + desc->iffreq +
               desc->entries[i].stepsize/2) / desc->entries[i].stepsize;
        buf[0] = div >> 8;
        buf[1] = div & 0xff;
        buf[2] = desc->entries[i].config;
        buf[3] = desc->entries[i].cb;

        if (desc->set)
                desc->set(fe, buf);

        if (debug)
                dprintk("pll: %s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
                       desc->name, div, buf[0], buf[1], buf[2], buf[3]);

        // calculate the frequency we set it to
        return (div * desc->entries[i].stepsize) - desc->iffreq;
}

static void dvb_pll_release(struct dvb_frontend *fe)
{
        kfree(fe->tuner_priv);
        fe->tuner_priv = NULL;
}

static int dvb_pll_sleep(struct dvb_frontend *fe)
{
        struct dvb_pll_priv *priv = fe->tuner_priv;

        if (priv->i2c == NULL)
                return -EINVAL;

        if (priv->pll_desc->sleepdata) {
                struct i2c_msg msg = { .flags = 0,
                        .addr = priv->pll_i2c_address,
                        .buf = priv->pll_desc->sleepdata + 1,
                        .len = priv->pll_desc->sleepdata[0] };

                int result;

                if (fe->ops.i2c_gate_ctrl)
                        fe->ops.i2c_gate_ctrl(fe, 1);
                if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
                        return result;
                }
                return 0;
        }
        /* Shouldn't be called when initdata is NULL, maybe BUG()? */
        return -EINVAL;
}

static int dvb_pll_set_params(struct dvb_frontend *fe)
{
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
        struct dvb_pll_priv *priv = fe->tuner_priv;
        u8 buf[4];
        struct i2c_msg msg =
                { .addr = priv->pll_i2c_address, .flags = 0,
                  .buf = buf, .len = sizeof(buf) };
        int result;
        u32 frequency = 0;

        if (priv->i2c == NULL)
                return -EINVAL;

        result = dvb_pll_configure(fe, buf, c->frequency);
        if (result < 0)
                return result;
        else
                frequency = result;

        if (fe->ops.i2c_gate_ctrl)
                fe->ops.i2c_gate_ctrl(fe, 1);
        if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
                return result;
        }

        priv->frequency = frequency;
        priv->bandwidth = c->bandwidth_hz;

        return 0;
}

static int dvb_pll_calc_regs(struct dvb_frontend *fe,
                             u8 *buf, int buf_len)
{
        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
        struct dvb_pll_priv *priv = fe->tuner_priv;
        int result;
        u32 frequency = 0;

        if (buf_len < 5)
                return -EINVAL;

        result = dvb_pll_configure(fe, buf + 1, c->frequency);
        if (result < 0)
                return result;
        else
                frequency = result;

        buf[0] = priv->pll_i2c_address;

        priv->frequency = frequency;
        priv->bandwidth = c->bandwidth_hz;

        return 5;
}

static int dvb_pll_get_frequency(struct dvb_frontend *fe, u32 *frequency)
{
        struct dvb_pll_priv *priv = fe->tuner_priv;
        *frequency = priv->frequency;
        return 0;
}

static int dvb_pll_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
{
        struct dvb_pll_priv *priv = fe->tuner_priv;
        *bandwidth = priv->bandwidth;
        return 0;
}

static int dvb_pll_init(struct dvb_frontend *fe)
{
        struct dvb_pll_priv *priv = fe->tuner_priv;

        if (priv->i2c == NULL)
                return -EINVAL;

        if (priv->pll_desc->initdata) {
                struct i2c_msg msg = { .flags = 0,
                        .addr = priv->pll_i2c_address,
                        .buf = priv->pll_desc->initdata + 1,
                        .len = priv->pll_desc->initdata[0] };

                int result;
                if (fe->ops.i2c_gate_ctrl)
                        fe->ops.i2c_gate_ctrl(fe, 1);
                result = i2c_transfer(priv->i2c, &msg, 1);
                if (result != 1)
                        return result;
                if (priv->pll_desc->initdata2) {
                        msg.buf = priv->pll_desc->initdata2 + 1;
                        msg.len = priv->pll_desc->initdata2[0];
                        if (fe->ops.i2c_gate_ctrl)
                                fe->ops.i2c_gate_ctrl(fe, 1);
                        result = i2c_transfer(priv->i2c, &msg, 1);
                        if (result != 1)
                                return result;
                }
                return 0;
        }
        /* Shouldn't be called when initdata is NULL, maybe BUG()? */
        return -EINVAL;
}

static const struct dvb_tuner_ops dvb_pll_tuner_ops = {
        .release = dvb_pll_release,
        .sleep = dvb_pll_sleep,
        .init = dvb_pll_init,
        .set_params = dvb_pll_set_params,
        .calc_regs = dvb_pll_calc_regs,
        .get_frequency = dvb_pll_get_frequency,
        .get_bandwidth = dvb_pll_get_bandwidth,
};

struct dvb_frontend *dvb_pll_attach(struct dvb_frontend *fe, int pll_addr,
                                    struct i2c_adapter *i2c,
                                    unsigned int pll_desc_id)
{
        u8 *b1;
        struct i2c_msg msg = { .addr = pll_addr, .flags = I2C_M_RD, .len = 1 };
        struct dvb_pll_priv *priv = NULL;
        int ret;
        const struct dvb_pll_desc *desc;
        int nr;

        b1 = kmalloc(1, GFP_KERNEL);
        if (!b1)
                return NULL;

        b1[0] = 0;
        msg.buf = b1;

        nr = ida_alloc_max(&pll_ida, DVB_PLL_MAX - 1, GFP_KERNEL);
        if (nr < 0) {
                kfree(b1);
                return NULL;
        }

        if (id[nr] > DVB_PLL_UNDEFINED && id[nr] < ARRAY_SIZE(pll_list))
                pll_desc_id = id[nr];

        BUG_ON(pll_desc_id < 1 || pll_desc_id >= ARRAY_SIZE(pll_list));

        desc = pll_list[pll_desc_id];

        if (i2c != NULL) {
                if (fe->ops.i2c_gate_ctrl)
                        fe->ops.i2c_gate_ctrl(fe, 1);

                ret = i2c_transfer (i2c, &msg, 1);
                if (ret != 1)
                        goto out;
                if (fe->ops.i2c_gate_ctrl)
                             fe->ops.i2c_gate_ctrl(fe, 0);
        }

        priv = kzalloc_obj(struct dvb_pll_priv);
        if (!priv)
                goto out;

        priv->pll_i2c_address = pll_addr;
        priv->i2c = i2c;
        priv->pll_desc = desc;
        priv->nr = nr;

        memcpy(&fe->ops.tuner_ops, &dvb_pll_tuner_ops,
               sizeof(struct dvb_tuner_ops));

        strscpy(fe->ops.tuner_ops.info.name, desc->name,
                sizeof(fe->ops.tuner_ops.info.name));

        fe->ops.tuner_ops.info.frequency_min_hz = desc->min;
        fe->ops.tuner_ops.info.frequency_max_hz = desc->max;

        dprintk("%s tuner, frequency range: %u...%u\n",
                desc->name, desc->min, desc->max);

        if (!desc->initdata)
                fe->ops.tuner_ops.init = NULL;
        if (!desc->sleepdata)
                fe->ops.tuner_ops.sleep = NULL;

        fe->tuner_priv = priv;

        if ((debug) || (id[priv->nr] == pll_desc_id)) {
                dprintk("dvb-pll[%d]", priv->nr);
                if (i2c != NULL)
                        pr_cont(" %d-%04x", i2c_adapter_id(i2c), pll_addr);
                pr_cont(": id# %d (%s) attached, %s\n", pll_desc_id, desc->name,
                       id[priv->nr] == pll_desc_id ?
                                "insmod option" : "autodetected");
        }

        kfree(b1);

        return fe;
out:
        kfree(b1);
        ida_free(&pll_ida, nr);

        return NULL;
}
EXPORT_SYMBOL_GPL(dvb_pll_attach);


static int
dvb_pll_probe(struct i2c_client *client)
{
        const struct i2c_device_id *id = i2c_client_get_device_id(client);
        struct dvb_pll_config *cfg;
        struct dvb_frontend *fe;
        unsigned int desc_id;

        cfg = client->dev.platform_data;
        fe = cfg->fe;
        i2c_set_clientdata(client, fe);
        desc_id = (unsigned int) id->driver_data;

        if (!dvb_pll_attach(fe, client->addr, client->adapter, desc_id))
                return -ENOMEM;

        /*
         * Unset tuner_ops.release (== dvb_pll_release)
         * which has been just set in the above dvb_pll_attach(),
         * because if tuner_ops.release was left defined,
         * this module would be 'put' twice on exit:
         * once by dvb_frontend_detach() and another by dvb_module_release().
         *
         * dvb_pll_release is instead executed in the i2c driver's .remove(),
         * keeping dvb_pll_attach untouched for legacy (dvb_attach) drivers.
         */
        fe->ops.tuner_ops.release = NULL;
        dev_info(&client->dev, "DVB Simple Tuner attached.\n");
        return 0;
}

static void dvb_pll_remove(struct i2c_client *client)
{
        struct dvb_frontend *fe = i2c_get_clientdata(client);
        struct dvb_pll_priv *priv = fe->tuner_priv;

        ida_free(&pll_ida, priv->nr);
        dvb_pll_release(fe);
}


static const struct i2c_device_id dvb_pll_id[] = {
        {"dtt7579",             DVB_PLL_THOMSON_DTT7579},
        {"dtt759x",             DVB_PLL_THOMSON_DTT759X},
        {"z201",                DVB_PLL_LG_Z201},
        {"unknown_1",           DVB_PLL_UNKNOWN_1},
        {"tua6010xs",           DVB_PLL_TUA6010XS},
        {"env57h1xd5",          DVB_PLL_ENV57H1XD5},
        {"tua6034",             DVB_PLL_TUA6034},
        {"tda665x",             DVB_PLL_TDA665X},
        {"tded4",               DVB_PLL_TDED4},
        {"tdhu2",               DVB_PLL_TDHU2},
        {"tbmv",                DVB_PLL_SAMSUNG_TBMV},
        {"sd1878_tda8261",      DVB_PLL_PHILIPS_SD1878_TDA8261},
        {"opera1",              DVB_PLL_OPERA1},
        {"dtos403ih102a",       DVB_PLL_SAMSUNG_DTOS403IH102A},
        {"tdtc9251dh0",         DVB_PLL_SAMSUNG_TDTC9251DH0},
        {"tbdu18132",           DVB_PLL_SAMSUNG_TBDU18132},
        {"tbmu24112",           DVB_PLL_SAMSUNG_TBMU24112},
        {"tdee4",               DVB_PLL_TDEE4},
        {"dtt7520x",            DVB_PLL_THOMSON_DTT7520X},
        {"tua6034_friio",       DVB_PLL_TUA6034_FRIIO},
        {"tda665x_earthpt1",    DVB_PLL_TDA665X_EARTH_PT1},
        {}
};


MODULE_DEVICE_TABLE(i2c, dvb_pll_id);

static struct i2c_driver dvb_pll_driver = {
        .driver = {
                .name = "dvb_pll",
        },
        .probe    = dvb_pll_probe,
        .remove   = dvb_pll_remove,
        .id_table = dvb_pll_id,
};

module_i2c_driver(dvb_pll_driver);

MODULE_DESCRIPTION("dvb pll library");
MODULE_AUTHOR("Gerd Knorr");
MODULE_LICENSE("GPL");