Em Thu, 30 Oct 2014 16:01:51 +0800
"Nibble Max" <nibble....@gmail.com> escreveu:

> v3:
> -config demod mclk in "set_params" call back.
> -remove "set_config".

Where's patch 1/3 v3?

Regards,
Mauro

> 
> v2:
> -make demod mclk selection logic simple.
> -merge demod mclk and ts mclk into one call back.
> -make code clean.
> 
> M88RS6000 is the integrated chip, which includes tuner and demod.
> Here splite its tuner as a standalone driver.
> .set_config is used to config its demod clock, which sits inside tuner die.
> 
> Signed-off-by: Nibble Max <nibble....@gmail.com>
> ---
>  drivers/media/tuners/Kconfig      |   8 +
>  drivers/media/tuners/Makefile     |   1 +
>  drivers/media/tuners/m88rs6000t.c | 744 
> ++++++++++++++++++++++++++++++++++++++
>  drivers/media/tuners/m88rs6000t.h |  29 ++
>  4 files changed, 782 insertions(+)
> 
> diff --git a/drivers/media/tuners/Kconfig b/drivers/media/tuners/Kconfig
> index f039dc2..42e5a01 100644
> --- a/drivers/media/tuners/Kconfig
> +++ b/drivers/media/tuners/Kconfig
> @@ -232,6 +232,14 @@ config MEDIA_TUNER_M88TS2022
>       help
>         Montage M88TS2022 silicon tuner driver.
>  
> +config MEDIA_TUNER_M88RS6000T
> +     tristate "Montage M88RS6000 internal tuner"
> +     depends on MEDIA_SUPPORT && I2C
> +     select REGMAP_I2C
> +     default m if !MEDIA_SUBDRV_AUTOSELECT
> +     help
> +       Montage M88RS6000 internal tuner.
> +
>  config MEDIA_TUNER_TUA9001
>       tristate "Infineon TUA 9001 silicon tuner"
>       depends on MEDIA_SUPPORT && I2C
> diff --git a/drivers/media/tuners/Makefile b/drivers/media/tuners/Makefile
> index 49fcf80..da4fe6e 100644
> --- a/drivers/media/tuners/Makefile
> +++ b/drivers/media/tuners/Makefile
> @@ -41,6 +41,7 @@ obj-$(CONFIG_MEDIA_TUNER_IT913X) += it913x.o
>  obj-$(CONFIG_MEDIA_TUNER_R820T) += r820t.o
>  obj-$(CONFIG_MEDIA_TUNER_MXL301RF) += mxl301rf.o
>  obj-$(CONFIG_MEDIA_TUNER_QM1D1C0042) += qm1d1c0042.o
> +obj-$(CONFIG_MEDIA_TUNER_M88RS6000T) += m88rs6000t.o
>  
>  ccflags-y += -I$(srctree)/drivers/media/dvb-core
>  ccflags-y += -I$(srctree)/drivers/media/dvb-frontends
> diff --git a/drivers/media/tuners/m88rs6000t.c 
> b/drivers/media/tuners/m88rs6000t.c
> new file mode 100644
> index 0000000..d4c13fe
> --- /dev/null
> +++ b/drivers/media/tuners/m88rs6000t.c
> @@ -0,0 +1,744 @@
> +/*
> + * Driver for the internal tuner of Montage M88RS6000
> + *
> + * Copyright (C) 2014 Max nibble <nibble....@gmail.com>
> + *
> + *    This program is free software; you can redistribute it and/or modify
> + *    it under the terms of the GNU General Public License as published by
> + *    the Free Software Foundation; either version 2 of the License, or
> + *    (at your option) any later version.
> + *
> + *    This program is distributed in the hope that it will be useful,
> + *    but WITHOUT ANY WARRANTY; without even the implied warranty of
> + *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + *    GNU General Public License for more details.
> + */
> +
> +#include "m88rs6000t.h"
> +#include <linux/regmap.h>
> +
> +struct m88rs6000t_dev {
> +     struct m88rs6000t_config cfg;
> +     struct i2c_client *client;
> +     struct regmap *regmap;
> +     u32 frequency_khz;
> +};
> +
> +struct m88rs6000t_reg_val {
> +     u8 reg;
> +     u8 val;
> +};
> +
> +/* set demod main mclk and ts mclk */
> +static int m88rs6000t_set_demod_mclk(struct dvb_frontend *fe)
> +{
> +     struct m88rs6000t_dev *dev = fe->tuner_priv;
> +     struct dtv_frontend_properties *c = &fe->dtv_property_cache;
> +     u8 reg11, reg15, reg16, reg1D, reg1E, reg1F;
> +     u8 N, f0 = 0, f1 = 0, f2 = 0, f3 = 0;
> +     u16 pll_div_fb;
> +     u32 div, ts_mclk;
> +     unsigned int utmp;
> +     int ret;
> +
> +     /* select demod main mclk */
> +     ret = regmap_read(dev->regmap, 0x15, &utmp);
> +     if (ret)
> +             goto err;
> +     reg15 = utmp;
> +     if (c->symbol_rate > 45010000) {
> +             reg11 = 0x0E;
> +             reg15 |= 0x02;
> +             reg16 = 115; /* mclk = 110.25MHz */
> +     } else {
> +             reg11 = 0x0A;
> +             reg15 &= ~0x02;
> +             reg16 = 96; /* mclk = 96MHz */
> +     }
> +
> +     /* set ts mclk */
> +     if (c->delivery_system == SYS_DVBS)
> +             ts_mclk = 96000;
> +     else
> +             ts_mclk = 144000;
> +
> +     pll_div_fb = (reg15 & 0x01) << 8;
> +     pll_div_fb += reg16;
> +     pll_div_fb += 32;
> +
> +     div = 36000 * pll_div_fb;
> +     div /= ts_mclk;
> +
> +     if (div <= 32) {
> +             N = 2;
> +             f0 = 0;
> +             f1 = div / 2;
> +             f2 = div - f1;
> +             f3 = 0;
> +     } else if (div <= 48) {
> +             N = 3;
> +             f0 = div / 3;
> +             f1 = (div - f0) / 2;
> +             f2 = div - f0 - f1;
> +             f3 = 0;
> +     } else if (div <= 64) {
> +             N = 4;
> +             f0 = div / 4;
> +             f1 = (div - f0) / 3;
> +             f2 = (div - f0 - f1) / 2;
> +             f3 = div - f0 - f1 - f2;
> +     } else {
> +             N = 4;
> +             f0 = 16;
> +             f1 = 16;
> +             f2 = 16;
> +             f3 = 16;
> +     }
> +
> +     if (f0 == 16)
> +             f0 = 0;
> +     if (f1 == 16)
> +             f1 = 0;
> +     if (f2 == 16)
> +             f2 = 0;
> +     if (f3 == 16)
> +             f3 = 0;
> +
> +     ret = regmap_read(dev->regmap, 0x1D, &utmp);
> +     if (ret)
> +             goto err;
> +     reg1D = utmp;
> +     reg1D &= ~0x03;
> +     reg1D |= N - 1;
> +     reg1E = ((f3 << 4) + f2) & 0xFF;
> +     reg1F = ((f1 << 4) + f0) & 0xFF;
> +
> +     /* program and recalibrate demod PLL */
> +     ret = regmap_write(dev->regmap, 0x05, 0x40);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x11, 0x08);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x15, reg15);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x16, reg16);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x1D, reg1D);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x1E, reg1E);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x1F, reg1F);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x17, 0xc1);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x17, 0x81);
> +     if (ret)
> +             goto err;
> +     usleep_range(5000, 50000);
> +     ret = regmap_write(dev->regmap, 0x05, 0x00);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x11, reg11);
> +     if (ret)
> +             goto err;
> +     usleep_range(5000, 50000);
> +err:
> +     if (ret)
> +             dev_dbg(&dev->client->dev, "failed=%d\n", ret);
> +     return ret;
> +}
> +
> +static int m88rs6000t_set_pll_freq(struct m88rs6000t_dev *dev,
> +                     u32 tuner_freq_MHz)
> +{
> +     u32 fcry_KHz, ulNDiv1, ulNDiv2, ulNDiv;
> +     u8 refDiv, ucLoDiv1, ucLomod1, ucLoDiv2, ucLomod2, ucLoDiv, ucLomod;
> +     u8 reg27, reg29, reg42, reg42buf;
> +     unsigned int utmp;
> +     int ret;
> +
> +     fcry_KHz = 27000; /* in kHz */
> +     refDiv = 27;
> +
> +     ret = regmap_write(dev->regmap, 0x36, (refDiv - 8));
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x31, 0x00);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x2c, 0x02);
> +     if (ret)
> +             goto err;
> +
> +     if (tuner_freq_MHz >= 1550) {
> +             ucLoDiv1 = 2;
> +             ucLomod1 = 0;
> +             ucLoDiv2 = 2;
> +             ucLomod2 = 0;
> +     } else if (tuner_freq_MHz >= 1380) {
> +             ucLoDiv1 = 3;
> +             ucLomod1 = 16;
> +             ucLoDiv2 = 2;
> +             ucLomod2 = 0;
> +     } else if (tuner_freq_MHz >= 1070) {
> +             ucLoDiv1 = 3;
> +             ucLomod1 = 16;
> +             ucLoDiv2 = 3;
> +             ucLomod2 = 16;
> +     } else if (tuner_freq_MHz >= 1000) {
> +             ucLoDiv1 = 3;
> +             ucLomod1 = 16;
> +             ucLoDiv2 = 4;
> +             ucLomod2 = 64;
> +     } else if (tuner_freq_MHz >= 775) {
> +             ucLoDiv1 = 4;
> +             ucLomod1 = 64;
> +             ucLoDiv2 = 4;
> +             ucLomod2 = 64;
> +     } else if (tuner_freq_MHz >= 700) {
> +             ucLoDiv1 = 6;
> +             ucLomod1 = 48;
> +             ucLoDiv2 = 4;
> +             ucLomod2 = 64;
> +     } else if (tuner_freq_MHz >= 520) {
> +             ucLoDiv1 = 6;
> +             ucLomod1 = 48;
> +             ucLoDiv2 = 6;
> +             ucLomod2 = 48;
> +     } else {
> +             ucLoDiv1 = 8;
> +             ucLomod1 = 96;
> +             ucLoDiv2 = 8;
> +             ucLomod2 = 96;
> +     }
> +
> +     ulNDiv1 = ((tuner_freq_MHz * ucLoDiv1 * 1000) * refDiv
> +                     / fcry_KHz - 1024) / 2;
> +     ulNDiv2 = ((tuner_freq_MHz * ucLoDiv2 * 1000) * refDiv
> +                     / fcry_KHz - 1024) / 2;
> +
> +     reg27 = (((ulNDiv1 >> 8) & 0x0F) + ucLomod1) & 0x7F;
> +     ret = regmap_write(dev->regmap, 0x27, reg27);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x28, (u8)(ulNDiv1 & 0xFF));
> +     if (ret)
> +             goto err;
> +     reg29 = (((ulNDiv2 >> 8) & 0x0F) + ucLomod2) & 0x7f;
> +     ret = regmap_write(dev->regmap, 0x29, reg29);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x2a, (u8)(ulNDiv2 & 0xFF));
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x2F, 0xf5);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x30, 0x05);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x08, 0x1f);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x08, 0x3f);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x09, 0x20);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x09, 0x00);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x3e, 0x11);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x08, 0x2f);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x08, 0x3f);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x09, 0x10);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x09, 0x00);
> +     if (ret)
> +             goto err;
> +     usleep_range(2000, 50000);
> +
> +     ret = regmap_read(dev->regmap, 0x42, &utmp);
> +     if (ret)
> +             goto err;
> +     reg42 = utmp;
> +
> +     ret = regmap_write(dev->regmap, 0x3e, 0x10);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x08, 0x2f);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x08, 0x3f);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x09, 0x10);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x09, 0x00);
> +     if (ret)
> +             goto err;
> +     usleep_range(2000, 50000);
> +
> +     ret = regmap_read(dev->regmap, 0x42, &utmp);
> +     if (ret)
> +             goto err;
> +     reg42buf = utmp;
> +     if (reg42buf < reg42) {
> +             ret = regmap_write(dev->regmap, 0x3e, 0x11);
> +             if (ret)
> +                     goto err;
> +     }
> +     usleep_range(5000, 50000);
> +
> +     ret = regmap_read(dev->regmap, 0x2d, &utmp);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x2d, utmp);
> +     if (ret)
> +             goto err;
> +     ret = regmap_read(dev->regmap, 0x2e, &utmp);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x2e, utmp);
> +     if (ret)
> +             goto err;
> +
> +     ret = regmap_read(dev->regmap, 0x27, &utmp);
> +     if (ret)
> +             goto err;
> +     reg27 = utmp & 0x70;
> +     ret = regmap_read(dev->regmap, 0x83, &utmp);
> +     if (ret)
> +             goto err;
> +     if (reg27 == (utmp & 0x70)) {
> +             ucLoDiv = ucLoDiv1;
> +             ulNDiv = ulNDiv1;
> +             ucLomod = ucLomod1 / 16;
> +     } else {
> +             ucLoDiv = ucLoDiv2;
> +             ulNDiv = ulNDiv2;
> +             ucLomod = ucLomod2 / 16;
> +     }
> +
> +     if ((ucLoDiv == 3) || (ucLoDiv == 6)) {
> +             refDiv = 18;
> +             ret = regmap_write(dev->regmap, 0x36, (refDiv - 8));
> +             if (ret)
> +                     goto err;
> +             ulNDiv = ((tuner_freq_MHz * ucLoDiv * 1000) * refDiv
> +                             / fcry_KHz - 1024) / 2;
> +     }
> +
> +     reg27 = (0x80 + ((ucLomod << 4) & 0x70)
> +                     + ((ulNDiv >> 8) & 0x0F)) & 0xFF;
> +     ret = regmap_write(dev->regmap, 0x27, reg27);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x28, (u8)(ulNDiv & 0xFF));
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x29, 0x80);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x31, 0x03);
> +     if (ret)
> +             goto err;
> +
> +     if (ucLoDiv == 3)
> +             utmp = 0xCE;
> +     else
> +             utmp = 0x8A;
> +     ret = regmap_write(dev->regmap, 0x3b, utmp);
> +     if (ret)
> +             goto err;
> +
> +     dev->frequency_khz = fcry_KHz * (ulNDiv * 2 + 1024) / refDiv / ucLoDiv;
> +
> +     dev_dbg(&dev->client->dev,
> +             "actual tune frequency=%d\n", dev->frequency_khz);
> +err:
> +     if (ret)
> +             dev_dbg(&dev->client->dev, "failed=%d\n", ret);
> +     return ret;
> +}
> +
> +static int m88rs6000t_set_bb(struct m88rs6000t_dev *dev,
> +             u32 symbol_rate_KSs, s32 lpf_offset_KHz)
> +{
> +     u32 f3dB;
> +     u8  reg40;
> +
> +     f3dB = symbol_rate_KSs * 9 / 14 + 2000;
> +     f3dB += lpf_offset_KHz;
> +     f3dB = clamp_val(f3dB, 6000U, 43000U);
> +     reg40 = f3dB / 1000;
> +     return regmap_write(dev->regmap, 0x40, reg40);
> +}
> +
> +static int m88rs6000t_set_params(struct dvb_frontend *fe)
> +{
> +     struct m88rs6000t_dev *dev = fe->tuner_priv;
> +     struct dtv_frontend_properties *c = &fe->dtv_property_cache;
> +     int ret;
> +     s32 lpf_offset_KHz;
> +     u32 realFreq, freq_MHz;
> +
> +     dev_dbg(&dev->client->dev,
> +                     "frequency=%d symbol_rate=%d\n",
> +                     c->frequency, c->symbol_rate);
> +
> +     if (c->symbol_rate < 5000000)
> +             lpf_offset_KHz = 3000;
> +     else
> +             lpf_offset_KHz = 0;
> +
> +     realFreq = c->frequency + lpf_offset_KHz;
> +     /* set tuner pll.*/
> +     freq_MHz = (realFreq + 500) / 1000;
> +     ret = m88rs6000t_set_pll_freq(dev, freq_MHz);
> +     if (ret)
> +             goto err;
> +     ret = m88rs6000t_set_bb(dev, c->symbol_rate / 1000, lpf_offset_KHz);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x00, 0x01);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x00, 0x00);
> +     if (ret)
> +             goto err;
> +     /* set demod mlck */
> +     ret = m88rs6000t_set_demod_mclk(fe);
> +err:
> +     if (ret)
> +             dev_dbg(&dev->client->dev, "failed=%d\n", ret);
> +     return ret;
> +}
> +
> +static int m88rs6000t_init(struct dvb_frontend *fe)
> +{
> +     struct m88rs6000t_dev *dev = fe->tuner_priv;
> +     int ret;
> +
> +     dev_dbg(&dev->client->dev, "%s:\n", __func__);
> +
> +     ret = regmap_update_bits(dev->regmap, 0x11, 0x08, 0x08);
> +     if (ret)
> +             goto err;
> +     usleep_range(5000, 50000);
> +     ret = regmap_update_bits(dev->regmap, 0x10, 0x01, 0x01);
> +     if (ret)
> +             goto err;
> +     usleep_range(10000, 50000);
> +     ret = regmap_write(dev->regmap, 0x07, 0x7d);
> +err:
> +     if (ret)
> +             dev_dbg(&dev->client->dev, "failed=%d\n", ret);
> +     return ret;
> +}
> +
> +static int m88rs6000t_sleep(struct dvb_frontend *fe)
> +{
> +     struct m88rs6000t_dev *dev = fe->tuner_priv;
> +     int ret;
> +
> +     dev_dbg(&dev->client->dev, "%s:\n", __func__);
> +
> +     ret = regmap_write(dev->regmap, 0x07, 0x6d);
> +     if (ret)
> +             goto err;
> +     usleep_range(5000, 10000);
> +err:
> +     if (ret)
> +             dev_dbg(&dev->client->dev, "failed=%d\n", ret);
> +     return ret;
> +}
> +
> +static int m88rs6000t_get_frequency(struct dvb_frontend *fe, u32 *frequency)
> +{
> +     struct m88rs6000t_dev *dev = fe->tuner_priv;
> +
> +     dev_dbg(&dev->client->dev, "\n");
> +
> +     *frequency = dev->frequency_khz;
> +     return 0;
> +}
> +
> +static int m88rs6000t_get_if_frequency(struct dvb_frontend *fe, u32 
> *frequency)
> +{
> +     struct m88rs6000t_dev *dev = fe->tuner_priv;
> +
> +     dev_dbg(&dev->client->dev, "\n");
> +
> +     *frequency = 0; /* Zero-IF */
> +     return 0;
> +}
> +
> +
> +static int m88rs6000t_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
> +{
> +     struct m88rs6000t_dev *dev = fe->tuner_priv;
> +     unsigned int val, i;
> +     int ret;
> +     u16 gain;
> +     u32 PGA2_cri_GS = 46, PGA2_crf_GS = 290, TIA_GS = 290;
> +     u32 RF_GC = 1200, IF_GC = 1100, BB_GC = 300;
> +     u32 PGA2_GC = 300, TIA_GC = 300, PGA2_cri = 0, PGA2_crf = 0;
> +     u32 RFG = 0, IFG = 0, BBG = 0, PGA2G = 0, TIAG = 0;
> +     u32 RFGS[13] = {0, 245, 266, 268, 270, 285,
> +                     298, 295, 283, 285, 285, 300, 300};
> +     u32 IFGS[12] = {0, 300, 230, 270, 270, 285,
> +                     295, 285, 290, 295, 295, 310};
> +     u32 BBGS[14] = {0, 286, 275, 290, 294, 300, 290,
> +                     290, 285, 283, 260, 295, 290, 260};
> +
> +     ret = regmap_read(dev->regmap, 0x5A, &val);
> +     if (ret)
> +             goto err;
> +     RF_GC = val & 0x0f;
> +
> +     ret = regmap_read(dev->regmap, 0x5F, &val);
> +     if (ret)
> +             goto err;
> +     IF_GC = val & 0x0f;
> +
> +     ret = regmap_read(dev->regmap, 0x3F, &val);
> +     if (ret)
> +             goto err;
> +     TIA_GC = (val >> 4) & 0x07;
> +
> +     ret = regmap_read(dev->regmap, 0x77, &val);
> +     if (ret)
> +             goto err;
> +     BB_GC = (val >> 4) & 0x0f;
> +
> +     ret = regmap_read(dev->regmap, 0x76, &val);
> +     if (ret)
> +             goto err;
> +     PGA2_GC = val & 0x3f;
> +     PGA2_cri = PGA2_GC >> 2;
> +     PGA2_crf = PGA2_GC & 0x03;
> +
> +     for (i = 0; i <= RF_GC; i++)
> +             RFG += RFGS[i];
> +
> +     if (RF_GC == 0)
> +             RFG += 400;
> +     if (RF_GC == 1)
> +             RFG += 300;
> +     if (RF_GC == 2)
> +             RFG += 200;
> +     if (RF_GC == 3)
> +             RFG += 100;
> +
> +     for (i = 0; i <= IF_GC; i++)
> +             IFG += IFGS[i];
> +
> +     TIAG = TIA_GC * TIA_GS;
> +
> +     for (i = 0; i <= BB_GC; i++)
> +             BBG += BBGS[i];
> +
> +     PGA2G = PGA2_cri * PGA2_cri_GS + PGA2_crf * PGA2_crf_GS;
> +
> +     gain = RFG + IFG - TIAG + BBG + PGA2G;
> +
> +     /* scale value to 0x0000-0xffff */
> +     gain = clamp_val(gain, 1000U, 10500U);
> +     *strength = (10500 - gain) * 0xffff / (10500 - 1000);
> +err:
> +     if (ret)
> +             dev_dbg(&dev->client->dev, "failed=%d\n", ret);
> +     return ret;
> +}
> +
> +static const struct dvb_tuner_ops m88rs6000t_tuner_ops = {
> +     .info = {
> +             .name          = "Montage M88RS6000 Internal Tuner",
> +             .frequency_min = 950000,
> +             .frequency_max = 2150000,
> +     },
> +
> +     .init = m88rs6000t_init,
> +     .sleep = m88rs6000t_sleep,
> +     .set_params = m88rs6000t_set_params,
> +     .get_frequency = m88rs6000t_get_frequency,
> +     .get_if_frequency = m88rs6000t_get_if_frequency,
> +     .get_rf_strength = m88rs6000t_get_rf_strength,
> +};
> +
> +static int m88rs6000t_probe(struct i2c_client *client,
> +             const struct i2c_device_id *id)
> +{
> +     struct m88rs6000t_config *cfg = client->dev.platform_data;
> +     struct dvb_frontend *fe = cfg->fe;
> +     struct m88rs6000t_dev *dev;
> +     int ret, i;
> +     unsigned int utmp;
> +     static const struct regmap_config regmap_config = {
> +             .reg_bits = 8,
> +             .val_bits = 8,
> +     };
> +     static const struct m88rs6000t_reg_val reg_vals[] = {
> +             {0x10, 0xfb},
> +             {0x24, 0x38},
> +             {0x11, 0x0a},
> +             {0x12, 0x00},
> +             {0x2b, 0x1c},
> +             {0x44, 0x48},
> +             {0x54, 0x24},
> +             {0x55, 0x06},
> +             {0x59, 0x00},
> +             {0x5b, 0x4c},
> +             {0x60, 0x8b},
> +             {0x61, 0xf4},
> +             {0x65, 0x07},
> +             {0x6d, 0x6f},
> +             {0x6e, 0x31},
> +             {0x3c, 0xf3},
> +             {0x37, 0x0f},
> +             {0x48, 0x28},
> +             {0x49, 0xd8},
> +             {0x70, 0x66},
> +             {0x71, 0xCF},
> +             {0x72, 0x81},
> +             {0x73, 0xA7},
> +             {0x74, 0x4F},
> +             {0x75, 0xFC},
> +     };
> +
> +     dev = kzalloc(sizeof(*dev), GFP_KERNEL);
> +     if (!dev) {
> +             ret = -ENOMEM;
> +             dev_err(&client->dev, "kzalloc() failed\n");
> +             goto err;
> +     }
> +
> +     memcpy(&dev->cfg, cfg, sizeof(struct m88rs6000t_config));
> +     dev->client = client;
> +     dev->regmap = devm_regmap_init_i2c(client, &regmap_config);
> +     if (IS_ERR(dev->regmap)) {
> +             ret = PTR_ERR(dev->regmap);
> +             goto err;
> +     }
> +
> +     ret = regmap_update_bits(dev->regmap, 0x11, 0x08, 0x08);
> +     if (ret)
> +             goto err;
> +     usleep_range(5000, 50000);
> +     ret = regmap_update_bits(dev->regmap, 0x10, 0x01, 0x01);
> +     if (ret)
> +             goto err;
> +     usleep_range(10000, 50000);
> +     ret = regmap_write(dev->regmap, 0x07, 0x7d);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x04, 0x01);
> +     if (ret)
> +             goto err;
> +
> +     /* check tuner chip id */
> +     ret = regmap_read(dev->regmap, 0x01, &utmp);
> +     if (ret)
> +             goto err;
> +     dev_info(&dev->client->dev, "chip_id=%02x\n", utmp);
> +     if (utmp != 0x64) {
> +             ret = -ENODEV;
> +             goto err;
> +     }
> +
> +     /* tuner init. */
> +     ret = regmap_write(dev->regmap, 0x05, 0x40);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x11, 0x08);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x15, 0x6c);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x17, 0xc1);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x17, 0x81);
> +     if (ret)
> +             goto err;
> +     usleep_range(10000, 50000);
> +     ret = regmap_write(dev->regmap, 0x05, 0x00);
> +     if (ret)
> +             goto err;
> +     ret = regmap_write(dev->regmap, 0x11, 0x0a);
> +     if (ret)
> +             goto err;
> +
> +     for (i = 0; i < ARRAY_SIZE(reg_vals); i++) {
> +             ret = regmap_write(dev->regmap,
> +                             reg_vals[i].reg, reg_vals[i].val);
> +             if (ret)
> +                     goto err;
> +     }
> +
> +     dev_info(&dev->client->dev, "Montage M88RS6000 internal tuner 
> successfully identified\n");
> +
> +     fe->tuner_priv = dev;
> +     memcpy(&fe->ops.tuner_ops, &m88rs6000t_tuner_ops,
> +                     sizeof(struct dvb_tuner_ops));
> +     i2c_set_clientdata(client, dev);
> +     return 0;
> +err:
> +     dev_dbg(&client->dev, "failed=%d\n", ret);
> +     kfree(dev);
> +     return ret;
> +}
> +
> +static int m88rs6000t_remove(struct i2c_client *client)
> +{
> +     struct m88rs6000t_dev *dev = i2c_get_clientdata(client);
> +     struct dvb_frontend *fe = dev->cfg.fe;
> +
> +     dev_dbg(&client->dev, "\n");
> +
> +     memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops));
> +     fe->tuner_priv = NULL;
> +     kfree(dev);
> +
> +     return 0;
> +}
> +
> +static const struct i2c_device_id m88rs6000t_id[] = {
> +     {"m88rs6000t", 0},
> +     {}
> +};
> +MODULE_DEVICE_TABLE(i2c, m88rs6000t_id);
> +
> +static struct i2c_driver m88rs6000t_driver = {
> +     .driver = {
> +             .owner  = THIS_MODULE,
> +             .name   = "m88rs6000t",
> +     },
> +     .probe          = m88rs6000t_probe,
> +     .remove         = m88rs6000t_remove,
> +     .id_table       = m88rs6000t_id,
> +};
> +
> +module_i2c_driver(m88rs6000t_driver);
> +
> +MODULE_AUTHOR("Max nibble <nibble....@gmail.com>");
> +MODULE_DESCRIPTION("Montage M88RS6000 internal tuner driver");
> +MODULE_LICENSE("GPL");
> diff --git a/drivers/media/tuners/m88rs6000t.h 
> b/drivers/media/tuners/m88rs6000t.h
> new file mode 100644
> index 0000000..264c13e
> --- /dev/null
> +++ b/drivers/media/tuners/m88rs6000t.h
> @@ -0,0 +1,29 @@
> +/*
> + * Driver for the internal tuner of Montage M88RS6000
> + *
> + * Copyright (C) 2014 Max nibble <nibble....@gmail.com>
> + *
> + *    This program is free software; you can redistribute it and/or modify
> + *    it under the terms of the GNU General Public License as published by
> + *    the Free Software Foundation; either version 2 of the License, or
> + *    (at your option) any later version.
> + *
> + *    This program is distributed in the hope that it will be useful,
> + *    but WITHOUT ANY WARRANTY; without even the implied warranty of
> + *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
> + *    GNU General Public License for more details.
> + */
> +
> +#ifndef _M88RS6000T_H_
> +#define _M88RS6000T_H_
> +
> +#include "dvb_frontend.h"
> +
> +struct m88rs6000t_config {
> +     /*
> +      * pointer to DVB frontend
> +      */
> +     struct dvb_frontend *fe;
> +};
> +
> +#endif
> 
--
To unsubscribe from this list: send the line "unsubscribe linux-media" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html

Reply via email to