Hello Mauro, On 2014-11-03 22:43:18, Mauro Carvalho Chehab wrote: >Em Thu, 30 Oct 2014 16:01:51 +0800 >"Nibble Max" <nibble.max@xxxxxxxxx> escreveu: > >> v3: >> -config demod mclk in "set_params" call back. >> -remove "set_config". > >Where's patch 1/3 v3? patch 1/3 is the smipcie bridge driver. https://patchwork.linuxtv.org/patch/26436/ It has no review feed back, so it has no v3 version. > >Regards, >Mauro > BR, Max >> >> 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.max@xxxxxxxxx> >> --- >> 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.max@xxxxxxxxx> >> + * >> + * 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, ®map_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.max@xxxxxxxxx>"); >> +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.max@xxxxxxxxx> >> + * >> + * 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 majordomo@xxxxxxxxxxxxxxx More majordomo info at http://vger.kernel.org/majordomo-info.html
