linux/drivers/media/tuners/m88rs6000t.c
<<
>>
Prefs
   1/*
   2 * Driver for the internal tuner of Montage M88RS6000
   3 *
   4 * Copyright (C) 2014 Max nibble <nibble.max@gmail.com>
   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#include "m88rs6000t.h"
  18#include <linux/regmap.h>
  19
  20struct m88rs6000t_dev {
  21        struct m88rs6000t_config cfg;
  22        struct i2c_client *client;
  23        struct regmap *regmap;
  24        u32 frequency_khz;
  25};
  26
  27struct m88rs6000t_reg_val {
  28        u8 reg;
  29        u8 val;
  30};
  31
  32/* set demod main mclk and ts mclk */
  33static int m88rs6000t_set_demod_mclk(struct dvb_frontend *fe)
  34{
  35        struct m88rs6000t_dev *dev = fe->tuner_priv;
  36        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
  37        u8 reg11, reg15, reg16, reg1D, reg1E, reg1F;
  38        u8 N, f0 = 0, f1 = 0, f2 = 0, f3 = 0;
  39        u16 pll_div_fb;
  40        u32 div, ts_mclk;
  41        unsigned int utmp;
  42        int ret;
  43
  44        /* select demod main mclk */
  45        ret = regmap_read(dev->regmap, 0x15, &utmp);
  46        if (ret)
  47                goto err;
  48        reg15 = utmp;
  49        if (c->symbol_rate > 45010000) {
  50                reg11 = 0x0E;
  51                reg15 |= 0x02;
  52                reg16 = 115; /* mclk = 110.25MHz */
  53        } else {
  54                reg11 = 0x0A;
  55                reg15 &= ~0x02;
  56                reg16 = 96; /* mclk = 96MHz */
  57        }
  58
  59        /* set ts mclk */
  60        if (c->delivery_system == SYS_DVBS)
  61                ts_mclk = 96000;
  62        else
  63                ts_mclk = 144000;
  64
  65        pll_div_fb = (reg15 & 0x01) << 8;
  66        pll_div_fb += reg16;
  67        pll_div_fb += 32;
  68
  69        div = 36000 * pll_div_fb;
  70        div /= ts_mclk;
  71
  72        if (div <= 32) {
  73                N = 2;
  74                f0 = 0;
  75                f1 = div / 2;
  76                f2 = div - f1;
  77                f3 = 0;
  78        } else if (div <= 48) {
  79                N = 3;
  80                f0 = div / 3;
  81                f1 = (div - f0) / 2;
  82                f2 = div - f0 - f1;
  83                f3 = 0;
  84        } else if (div <= 64) {
  85                N = 4;
  86                f0 = div / 4;
  87                f1 = (div - f0) / 3;
  88                f2 = (div - f0 - f1) / 2;
  89                f3 = div - f0 - f1 - f2;
  90        } else {
  91                N = 4;
  92                f0 = 16;
  93                f1 = 16;
  94                f2 = 16;
  95                f3 = 16;
  96        }
  97
  98        if (f0 == 16)
  99                f0 = 0;
 100        if (f1 == 16)
 101                f1 = 0;
 102        if (f2 == 16)
 103                f2 = 0;
 104        if (f3 == 16)
 105                f3 = 0;
 106
 107        ret = regmap_read(dev->regmap, 0x1D, &utmp);
 108        if (ret)
 109                goto err;
 110        reg1D = utmp;
 111        reg1D &= ~0x03;
 112        reg1D |= N - 1;
 113        reg1E = ((f3 << 4) + f2) & 0xFF;
 114        reg1F = ((f1 << 4) + f0) & 0xFF;
 115
 116        /* program and recalibrate demod PLL */
 117        ret = regmap_write(dev->regmap, 0x05, 0x40);
 118        if (ret)
 119                goto err;
 120        ret = regmap_write(dev->regmap, 0x11, 0x08);
 121        if (ret)
 122                goto err;
 123        ret = regmap_write(dev->regmap, 0x15, reg15);
 124        if (ret)
 125                goto err;
 126        ret = regmap_write(dev->regmap, 0x16, reg16);
 127        if (ret)
 128                goto err;
 129        ret = regmap_write(dev->regmap, 0x1D, reg1D);
 130        if (ret)
 131                goto err;
 132        ret = regmap_write(dev->regmap, 0x1E, reg1E);
 133        if (ret)
 134                goto err;
 135        ret = regmap_write(dev->regmap, 0x1F, reg1F);
 136        if (ret)
 137                goto err;
 138        ret = regmap_write(dev->regmap, 0x17, 0xc1);
 139        if (ret)
 140                goto err;
 141        ret = regmap_write(dev->regmap, 0x17, 0x81);
 142        if (ret)
 143                goto err;
 144        usleep_range(5000, 50000);
 145        ret = regmap_write(dev->regmap, 0x05, 0x00);
 146        if (ret)
 147                goto err;
 148        ret = regmap_write(dev->regmap, 0x11, reg11);
 149        if (ret)
 150                goto err;
 151        usleep_range(5000, 50000);
 152err:
 153        if (ret)
 154                dev_dbg(&dev->client->dev, "failed=%d\n", ret);
 155        return ret;
 156}
 157
 158static int m88rs6000t_set_pll_freq(struct m88rs6000t_dev *dev,
 159                        u32 tuner_freq_MHz)
 160{
 161        u32 fcry_KHz, ulNDiv1, ulNDiv2, ulNDiv;
 162        u8 refDiv, ucLoDiv1, ucLomod1, ucLoDiv2, ucLomod2, ucLoDiv, ucLomod;
 163        u8 reg27, reg29, reg42, reg42buf;
 164        unsigned int utmp;
 165        int ret;
 166
 167        fcry_KHz = 27000; /* in kHz */
 168        refDiv = 27;
 169
 170        ret = regmap_write(dev->regmap, 0x36, (refDiv - 8));
 171        if (ret)
 172                goto err;
 173        ret = regmap_write(dev->regmap, 0x31, 0x00);
 174        if (ret)
 175                goto err;
 176        ret = regmap_write(dev->regmap, 0x2c, 0x02);
 177        if (ret)
 178                goto err;
 179
 180        if (tuner_freq_MHz >= 1550) {
 181                ucLoDiv1 = 2;
 182                ucLomod1 = 0;
 183                ucLoDiv2 = 2;
 184                ucLomod2 = 0;
 185        } else if (tuner_freq_MHz >= 1380) {
 186                ucLoDiv1 = 3;
 187                ucLomod1 = 16;
 188                ucLoDiv2 = 2;
 189                ucLomod2 = 0;
 190        } else if (tuner_freq_MHz >= 1070) {
 191                ucLoDiv1 = 3;
 192                ucLomod1 = 16;
 193                ucLoDiv2 = 3;
 194                ucLomod2 = 16;
 195        } else if (tuner_freq_MHz >= 1000) {
 196                ucLoDiv1 = 3;
 197                ucLomod1 = 16;
 198                ucLoDiv2 = 4;
 199                ucLomod2 = 64;
 200        } else if (tuner_freq_MHz >= 775) {
 201                ucLoDiv1 = 4;
 202                ucLomod1 = 64;
 203                ucLoDiv2 = 4;
 204                ucLomod2 = 64;
 205        } else if (tuner_freq_MHz >= 700) {
 206                ucLoDiv1 = 6;
 207                ucLomod1 = 48;
 208                ucLoDiv2 = 4;
 209                ucLomod2 = 64;
 210        } else if (tuner_freq_MHz >= 520) {
 211                ucLoDiv1 = 6;
 212                ucLomod1 = 48;
 213                ucLoDiv2 = 6;
 214                ucLomod2 = 48;
 215        } else {
 216                ucLoDiv1 = 8;
 217                ucLomod1 = 96;
 218                ucLoDiv2 = 8;
 219                ucLomod2 = 96;
 220        }
 221
 222        ulNDiv1 = ((tuner_freq_MHz * ucLoDiv1 * 1000) * refDiv
 223                        / fcry_KHz - 1024) / 2;
 224        ulNDiv2 = ((tuner_freq_MHz * ucLoDiv2 * 1000) * refDiv
 225                        / fcry_KHz - 1024) / 2;
 226
 227        reg27 = (((ulNDiv1 >> 8) & 0x0F) + ucLomod1) & 0x7F;
 228        ret = regmap_write(dev->regmap, 0x27, reg27);
 229        if (ret)
 230                goto err;
 231        ret = regmap_write(dev->regmap, 0x28, (u8)(ulNDiv1 & 0xFF));
 232        if (ret)
 233                goto err;
 234        reg29 = (((ulNDiv2 >> 8) & 0x0F) + ucLomod2) & 0x7f;
 235        ret = regmap_write(dev->regmap, 0x29, reg29);
 236        if (ret)
 237                goto err;
 238        ret = regmap_write(dev->regmap, 0x2a, (u8)(ulNDiv2 & 0xFF));
 239        if (ret)
 240                goto err;
 241        ret = regmap_write(dev->regmap, 0x2F, 0xf5);
 242        if (ret)
 243                goto err;
 244        ret = regmap_write(dev->regmap, 0x30, 0x05);
 245        if (ret)
 246                goto err;
 247        ret = regmap_write(dev->regmap, 0x08, 0x1f);
 248        if (ret)
 249                goto err;
 250        ret = regmap_write(dev->regmap, 0x08, 0x3f);
 251        if (ret)
 252                goto err;
 253        ret = regmap_write(dev->regmap, 0x09, 0x20);
 254        if (ret)
 255                goto err;
 256        ret = regmap_write(dev->regmap, 0x09, 0x00);
 257        if (ret)
 258                goto err;
 259        ret = regmap_write(dev->regmap, 0x3e, 0x11);
 260        if (ret)
 261                goto err;
 262        ret = regmap_write(dev->regmap, 0x08, 0x2f);
 263        if (ret)
 264                goto err;
 265        ret = regmap_write(dev->regmap, 0x08, 0x3f);
 266        if (ret)
 267                goto err;
 268        ret = regmap_write(dev->regmap, 0x09, 0x10);
 269        if (ret)
 270                goto err;
 271        ret = regmap_write(dev->regmap, 0x09, 0x00);
 272        if (ret)
 273                goto err;
 274        usleep_range(2000, 50000);
 275
 276        ret = regmap_read(dev->regmap, 0x42, &utmp);
 277        if (ret)
 278                goto err;
 279        reg42 = utmp;
 280
 281        ret = regmap_write(dev->regmap, 0x3e, 0x10);
 282        if (ret)
 283                goto err;
 284        ret = regmap_write(dev->regmap, 0x08, 0x2f);
 285        if (ret)
 286                goto err;
 287        ret = regmap_write(dev->regmap, 0x08, 0x3f);
 288        if (ret)
 289                goto err;
 290        ret = regmap_write(dev->regmap, 0x09, 0x10);
 291        if (ret)
 292                goto err;
 293        ret = regmap_write(dev->regmap, 0x09, 0x00);
 294        if (ret)
 295                goto err;
 296        usleep_range(2000, 50000);
 297
 298        ret = regmap_read(dev->regmap, 0x42, &utmp);
 299        if (ret)
 300                goto err;
 301        reg42buf = utmp;
 302        if (reg42buf < reg42) {
 303                ret = regmap_write(dev->regmap, 0x3e, 0x11);
 304                if (ret)
 305                        goto err;
 306        }
 307        usleep_range(5000, 50000);
 308
 309        ret = regmap_read(dev->regmap, 0x2d, &utmp);
 310        if (ret)
 311                goto err;
 312        ret = regmap_write(dev->regmap, 0x2d, utmp);
 313        if (ret)
 314                goto err;
 315        ret = regmap_read(dev->regmap, 0x2e, &utmp);
 316        if (ret)
 317                goto err;
 318        ret = regmap_write(dev->regmap, 0x2e, utmp);
 319        if (ret)
 320                goto err;
 321
 322        ret = regmap_read(dev->regmap, 0x27, &utmp);
 323        if (ret)
 324                goto err;
 325        reg27 = utmp & 0x70;
 326        ret = regmap_read(dev->regmap, 0x83, &utmp);
 327        if (ret)
 328                goto err;
 329        if (reg27 == (utmp & 0x70)) {
 330                ucLoDiv = ucLoDiv1;
 331                ulNDiv = ulNDiv1;
 332                ucLomod = ucLomod1 / 16;
 333        } else {
 334                ucLoDiv = ucLoDiv2;
 335                ulNDiv = ulNDiv2;
 336                ucLomod = ucLomod2 / 16;
 337        }
 338
 339        if ((ucLoDiv == 3) || (ucLoDiv == 6)) {
 340                refDiv = 18;
 341                ret = regmap_write(dev->regmap, 0x36, (refDiv - 8));
 342                if (ret)
 343                        goto err;
 344                ulNDiv = ((tuner_freq_MHz * ucLoDiv * 1000) * refDiv
 345                                / fcry_KHz - 1024) / 2;
 346        }
 347
 348        reg27 = (0x80 + ((ucLomod << 4) & 0x70)
 349                        + ((ulNDiv >> 8) & 0x0F)) & 0xFF;
 350        ret = regmap_write(dev->regmap, 0x27, reg27);
 351        if (ret)
 352                goto err;
 353        ret = regmap_write(dev->regmap, 0x28, (u8)(ulNDiv & 0xFF));
 354        if (ret)
 355                goto err;
 356        ret = regmap_write(dev->regmap, 0x29, 0x80);
 357        if (ret)
 358                goto err;
 359        ret = regmap_write(dev->regmap, 0x31, 0x03);
 360        if (ret)
 361                goto err;
 362
 363        if (ucLoDiv == 3)
 364                utmp = 0xCE;
 365        else
 366                utmp = 0x8A;
 367        ret = regmap_write(dev->regmap, 0x3b, utmp);
 368        if (ret)
 369                goto err;
 370
 371        dev->frequency_khz = fcry_KHz * (ulNDiv * 2 + 1024) / refDiv / ucLoDiv;
 372
 373        dev_dbg(&dev->client->dev,
 374                "actual tune frequency=%d\n", dev->frequency_khz);
 375err:
 376        if (ret)
 377                dev_dbg(&dev->client->dev, "failed=%d\n", ret);
 378        return ret;
 379}
 380
 381static int m88rs6000t_set_bb(struct m88rs6000t_dev *dev,
 382                u32 symbol_rate_KSs, s32 lpf_offset_KHz)
 383{
 384        u32 f3dB;
 385        u8  reg40;
 386
 387        f3dB = symbol_rate_KSs * 9 / 14 + 2000;
 388        f3dB += lpf_offset_KHz;
 389        f3dB = clamp_val(f3dB, 6000U, 43000U);
 390        reg40 = f3dB / 1000;
 391        return regmap_write(dev->regmap, 0x40, reg40);
 392}
 393
 394static int m88rs6000t_set_params(struct dvb_frontend *fe)
 395{
 396        struct m88rs6000t_dev *dev = fe->tuner_priv;
 397        struct dtv_frontend_properties *c = &fe->dtv_property_cache;
 398        int ret;
 399        s32 lpf_offset_KHz;
 400        u32 realFreq, freq_MHz;
 401
 402        dev_dbg(&dev->client->dev,
 403                        "frequency=%d symbol_rate=%d\n",
 404                        c->frequency, c->symbol_rate);
 405
 406        if (c->symbol_rate < 5000000)
 407                lpf_offset_KHz = 3000;
 408        else
 409                lpf_offset_KHz = 0;
 410
 411        realFreq = c->frequency + lpf_offset_KHz;
 412        /* set tuner pll.*/
 413        freq_MHz = (realFreq + 500) / 1000;
 414        ret = m88rs6000t_set_pll_freq(dev, freq_MHz);
 415        if (ret)
 416                goto err;
 417        ret = m88rs6000t_set_bb(dev, c->symbol_rate / 1000, lpf_offset_KHz);
 418        if (ret)
 419                goto err;
 420        ret = regmap_write(dev->regmap, 0x00, 0x01);
 421        if (ret)
 422                goto err;
 423        ret = regmap_write(dev->regmap, 0x00, 0x00);
 424        if (ret)
 425                goto err;
 426        /* set demod mlck */
 427        ret = m88rs6000t_set_demod_mclk(fe);
 428err:
 429        if (ret)
 430                dev_dbg(&dev->client->dev, "failed=%d\n", ret);
 431        return ret;
 432}
 433
 434static int m88rs6000t_init(struct dvb_frontend *fe)
 435{
 436        struct m88rs6000t_dev *dev = fe->tuner_priv;
 437        int ret;
 438
 439        dev_dbg(&dev->client->dev, "%s:\n", __func__);
 440
 441        ret = regmap_update_bits(dev->regmap, 0x11, 0x08, 0x08);
 442        if (ret)
 443                goto err;
 444        usleep_range(5000, 50000);
 445        ret = regmap_update_bits(dev->regmap, 0x10, 0x01, 0x01);
 446        if (ret)
 447                goto err;
 448        usleep_range(10000, 50000);
 449        ret = regmap_write(dev->regmap, 0x07, 0x7d);
 450err:
 451        if (ret)
 452                dev_dbg(&dev->client->dev, "failed=%d\n", ret);
 453        return ret;
 454}
 455
 456static int m88rs6000t_sleep(struct dvb_frontend *fe)
 457{
 458        struct m88rs6000t_dev *dev = fe->tuner_priv;
 459        int ret;
 460
 461        dev_dbg(&dev->client->dev, "%s:\n", __func__);
 462
 463        ret = regmap_write(dev->regmap, 0x07, 0x6d);
 464        if (ret) {
 465                dev_dbg(&dev->client->dev, "failed=%d\n", ret);
 466                return ret;
 467        }
 468        usleep_range(5000, 10000);
 469        return 0;
 470}
 471
 472static int m88rs6000t_get_frequency(struct dvb_frontend *fe, u32 *frequency)
 473{
 474        struct m88rs6000t_dev *dev = fe->tuner_priv;
 475
 476        dev_dbg(&dev->client->dev, "\n");
 477
 478        *frequency = dev->frequency_khz;
 479        return 0;
 480}
 481
 482static int m88rs6000t_get_if_frequency(struct dvb_frontend *fe, u32 *frequency)
 483{
 484        struct m88rs6000t_dev *dev = fe->tuner_priv;
 485
 486        dev_dbg(&dev->client->dev, "\n");
 487
 488        *frequency = 0; /* Zero-IF */
 489        return 0;
 490}
 491
 492
 493static int m88rs6000t_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
 494{
 495        struct m88rs6000t_dev *dev = fe->tuner_priv;
 496        unsigned int val, i;
 497        int ret;
 498        u16 gain;
 499        u32 PGA2_cri_GS = 46, PGA2_crf_GS = 290, TIA_GS = 290;
 500        u32 RF_GC = 1200, IF_GC = 1100, BB_GC = 300;
 501        u32 PGA2_GC = 300, TIA_GC = 300, PGA2_cri = 0, PGA2_crf = 0;
 502        u32 RFG = 0, IFG = 0, BBG = 0, PGA2G = 0, TIAG = 0;
 503        u32 RFGS[13] = {0, 245, 266, 268, 270, 285,
 504                        298, 295, 283, 285, 285, 300, 300};
 505        u32 IFGS[12] = {0, 300, 230, 270, 270, 285,
 506                        295, 285, 290, 295, 295, 310};
 507        u32 BBGS[14] = {0, 286, 275, 290, 294, 300, 290,
 508                        290, 285, 283, 260, 295, 290, 260};
 509
 510        ret = regmap_read(dev->regmap, 0x5A, &val);
 511        if (ret)
 512                goto err;
 513        RF_GC = val & 0x0f;
 514
 515        ret = regmap_read(dev->regmap, 0x5F, &val);
 516        if (ret)
 517                goto err;
 518        IF_GC = val & 0x0f;
 519
 520        ret = regmap_read(dev->regmap, 0x3F, &val);
 521        if (ret)
 522                goto err;
 523        TIA_GC = (val >> 4) & 0x07;
 524
 525        ret = regmap_read(dev->regmap, 0x77, &val);
 526        if (ret)
 527                goto err;
 528        BB_GC = (val >> 4) & 0x0f;
 529
 530        ret = regmap_read(dev->regmap, 0x76, &val);
 531        if (ret)
 532                goto err;
 533        PGA2_GC = val & 0x3f;
 534        PGA2_cri = PGA2_GC >> 2;
 535        PGA2_crf = PGA2_GC & 0x03;
 536
 537        for (i = 0; i <= RF_GC; i++)
 538                RFG += RFGS[i];
 539
 540        if (RF_GC == 0)
 541                RFG += 400;
 542        if (RF_GC == 1)
 543                RFG += 300;
 544        if (RF_GC == 2)
 545                RFG += 200;
 546        if (RF_GC == 3)
 547                RFG += 100;
 548
 549        for (i = 0; i <= IF_GC; i++)
 550                IFG += IFGS[i];
 551
 552        TIAG = TIA_GC * TIA_GS;
 553
 554        for (i = 0; i <= BB_GC; i++)
 555                BBG += BBGS[i];
 556
 557        PGA2G = PGA2_cri * PGA2_cri_GS + PGA2_crf * PGA2_crf_GS;
 558
 559        gain = RFG + IFG - TIAG + BBG + PGA2G;
 560
 561        /* scale value to 0x0000-0xffff */
 562        gain = clamp_val(gain, 1000U, 10500U);
 563        *strength = (10500 - gain) * 0xffff / (10500 - 1000);
 564err:
 565        if (ret)
 566                dev_dbg(&dev->client->dev, "failed=%d\n", ret);
 567        return ret;
 568}
 569
 570static const struct dvb_tuner_ops m88rs6000t_tuner_ops = {
 571        .info = {
 572                .name          = "Montage M88RS6000 Internal Tuner",
 573                .frequency_min = 950000,
 574                .frequency_max = 2150000,
 575        },
 576
 577        .init = m88rs6000t_init,
 578        .sleep = m88rs6000t_sleep,
 579        .set_params = m88rs6000t_set_params,
 580        .get_frequency = m88rs6000t_get_frequency,
 581        .get_if_frequency = m88rs6000t_get_if_frequency,
 582        .get_rf_strength = m88rs6000t_get_rf_strength,
 583};
 584
 585static int m88rs6000t_probe(struct i2c_client *client,
 586                const struct i2c_device_id *id)
 587{
 588        struct m88rs6000t_config *cfg = client->dev.platform_data;
 589        struct dvb_frontend *fe = cfg->fe;
 590        struct m88rs6000t_dev *dev;
 591        int ret, i;
 592        unsigned int utmp;
 593        static const struct regmap_config regmap_config = {
 594                .reg_bits = 8,
 595                .val_bits = 8,
 596        };
 597        static const struct m88rs6000t_reg_val reg_vals[] = {
 598                {0x10, 0xfb},
 599                {0x24, 0x38},
 600                {0x11, 0x0a},
 601                {0x12, 0x00},
 602                {0x2b, 0x1c},
 603                {0x44, 0x48},
 604                {0x54, 0x24},
 605                {0x55, 0x06},
 606                {0x59, 0x00},
 607                {0x5b, 0x4c},
 608                {0x60, 0x8b},
 609                {0x61, 0xf4},
 610                {0x65, 0x07},
 611                {0x6d, 0x6f},
 612                {0x6e, 0x31},
 613                {0x3c, 0xf3},
 614                {0x37, 0x0f},
 615                {0x48, 0x28},
 616                {0x49, 0xd8},
 617                {0x70, 0x66},
 618                {0x71, 0xCF},
 619                {0x72, 0x81},
 620                {0x73, 0xA7},
 621                {0x74, 0x4F},
 622                {0x75, 0xFC},
 623        };
 624
 625        dev = kzalloc(sizeof(*dev), GFP_KERNEL);
 626        if (!dev) {
 627                ret = -ENOMEM;
 628                dev_err(&client->dev, "kzalloc() failed\n");
 629                goto err;
 630        }
 631
 632        memcpy(&dev->cfg, cfg, sizeof(struct m88rs6000t_config));
 633        dev->client = client;
 634        dev->regmap = devm_regmap_init_i2c(client, &regmap_config);
 635        if (IS_ERR(dev->regmap)) {
 636                ret = PTR_ERR(dev->regmap);
 637                goto err;
 638        }
 639
 640        ret = regmap_update_bits(dev->regmap, 0x11, 0x08, 0x08);
 641        if (ret)
 642                goto err;
 643        usleep_range(5000, 50000);
 644        ret = regmap_update_bits(dev->regmap, 0x10, 0x01, 0x01);
 645        if (ret)
 646                goto err;
 647        usleep_range(10000, 50000);
 648        ret = regmap_write(dev->regmap, 0x07, 0x7d);
 649        if (ret)
 650                goto err;
 651        ret = regmap_write(dev->regmap, 0x04, 0x01);
 652        if (ret)
 653                goto err;
 654
 655        /* check tuner chip id */
 656        ret = regmap_read(dev->regmap, 0x01, &utmp);
 657        if (ret)
 658                goto err;
 659        dev_info(&dev->client->dev, "chip_id=%02x\n", utmp);
 660        if (utmp != 0x64) {
 661                ret = -ENODEV;
 662                goto err;
 663        }
 664
 665        /* tuner init. */
 666        ret = regmap_write(dev->regmap, 0x05, 0x40);
 667        if (ret)
 668                goto err;
 669        ret = regmap_write(dev->regmap, 0x11, 0x08);
 670        if (ret)
 671                goto err;
 672        ret = regmap_write(dev->regmap, 0x15, 0x6c);
 673        if (ret)
 674                goto err;
 675        ret = regmap_write(dev->regmap, 0x17, 0xc1);
 676        if (ret)
 677                goto err;
 678        ret = regmap_write(dev->regmap, 0x17, 0x81);
 679        if (ret)
 680                goto err;
 681        usleep_range(10000, 50000);
 682        ret = regmap_write(dev->regmap, 0x05, 0x00);
 683        if (ret)
 684                goto err;
 685        ret = regmap_write(dev->regmap, 0x11, 0x0a);
 686        if (ret)
 687                goto err;
 688
 689        for (i = 0; i < ARRAY_SIZE(reg_vals); i++) {
 690                ret = regmap_write(dev->regmap,
 691                                reg_vals[i].reg, reg_vals[i].val);
 692                if (ret)
 693                        goto err;
 694        }
 695
 696        dev_info(&dev->client->dev, "Montage M88RS6000 internal tuner successfully identified\n");
 697
 698        fe->tuner_priv = dev;
 699        memcpy(&fe->ops.tuner_ops, &m88rs6000t_tuner_ops,
 700                        sizeof(struct dvb_tuner_ops));
 701        i2c_set_clientdata(client, dev);
 702        return 0;
 703err:
 704        dev_dbg(&client->dev, "failed=%d\n", ret);
 705        kfree(dev);
 706        return ret;
 707}
 708
 709static int m88rs6000t_remove(struct i2c_client *client)
 710{
 711        struct m88rs6000t_dev *dev = i2c_get_clientdata(client);
 712        struct dvb_frontend *fe = dev->cfg.fe;
 713
 714        dev_dbg(&client->dev, "\n");
 715
 716        memset(&fe->ops.tuner_ops, 0, sizeof(struct dvb_tuner_ops));
 717        fe->tuner_priv = NULL;
 718        kfree(dev);
 719
 720        return 0;
 721}
 722
 723static const struct i2c_device_id m88rs6000t_id[] = {
 724        {"m88rs6000t", 0},
 725        {}
 726};
 727MODULE_DEVICE_TABLE(i2c, m88rs6000t_id);
 728
 729static struct i2c_driver m88rs6000t_driver = {
 730        .driver = {
 731                .name   = "m88rs6000t",
 732        },
 733        .probe          = m88rs6000t_probe,
 734        .remove         = m88rs6000t_remove,
 735        .id_table       = m88rs6000t_id,
 736};
 737
 738module_i2c_driver(m88rs6000t_driver);
 739
 740MODULE_AUTHOR("Max nibble <nibble.max@gmail.com>");
 741MODULE_DESCRIPTION("Montage M88RS6000 internal tuner driver");
 742MODULE_LICENSE("GPL");
 743