linux/drivers/media/dvb-frontends/cx24110.c
<<
>>
Prefs
   1// SPDX-License-Identifier: GPL-2.0-or-later
   2/*
   3    cx24110 - Single Chip Satellite Channel Receiver driver module
   4
   5    Copyright (C) 2002 Peter Hettkamp <peter.hettkamp@htp-tel.de> based on
   6    work
   7    Copyright (C) 1999 Convergence Integrated Media GmbH <ralph@convergence.de>
   8
   9
  10*/
  11
  12#include <linux/slab.h>
  13#include <linux/kernel.h>
  14#include <linux/module.h>
  15#include <linux/init.h>
  16
  17#include <media/dvb_frontend.h>
  18#include "cx24110.h"
  19
  20
  21struct cx24110_state {
  22
  23        struct i2c_adapter* i2c;
  24
  25        const struct cx24110_config* config;
  26
  27        struct dvb_frontend frontend;
  28
  29        u32 lastber;
  30        u32 lastbler;
  31        u32 lastesn0;
  32};
  33
  34static int debug;
  35#define dprintk(args...) \
  36        do { \
  37                if (debug) printk(KERN_DEBUG "cx24110: " args); \
  38        } while (0)
  39
  40static struct {u8 reg; u8 data;} cx24110_regdata[]=
  41                      /* Comments beginning with @ denote this value should
  42                         be the default */
  43        {{0x09,0x01}, /* SoftResetAll */
  44         {0x09,0x00}, /* release reset */
  45         {0x01,0xe8}, /* MSB of code rate 27.5MS/s */
  46         {0x02,0x17}, /* middle byte " */
  47         {0x03,0x29}, /* LSB         " */
  48         {0x05,0x03}, /* @ DVB mode, standard code rate 3/4 */
  49         {0x06,0xa5}, /* @ PLL 60MHz */
  50         {0x07,0x01}, /* @ Fclk, i.e. sampling clock, 60MHz */
  51         {0x0a,0x00}, /* @ partial chip disables, do not set */
  52         {0x0b,0x01}, /* set output clock in gapped mode, start signal low
  53                         active for first byte */
  54         {0x0c,0x11}, /* no parity bytes, large hold time, serial data out */
  55         {0x0d,0x6f}, /* @ RS Sync/Unsync thresholds */
  56         {0x10,0x40}, /* chip doc is misleading here: write bit 6 as 1
  57                         to avoid starting the BER counter. Reset the
  58                         CRC test bit. Finite counting selected */
  59         {0x15,0xff}, /* @ size of the limited time window for RS BER
  60                         estimation. It is <value>*256 RS blocks, this
  61                         gives approx. 2.6 sec at 27.5MS/s, rate 3/4 */
  62         {0x16,0x00}, /* @ enable all RS output ports */
  63         {0x17,0x04}, /* @ time window allowed for the RS to sync */
  64         {0x18,0xae}, /* @ allow all standard DVB code rates to be scanned
  65                         for automatically */
  66                      /* leave the current code rate and normalization
  67                         registers as they are after reset... */
  68         {0x21,0x10}, /* @ during AutoAcq, search each viterbi setting
  69                         only once */
  70         {0x23,0x18}, /* @ size of the limited time window for Viterbi BER
  71                         estimation. It is <value>*65536 channel bits, i.e.
  72                         approx. 38ms at 27.5MS/s, rate 3/4 */
  73         {0x24,0x24}, /* do not trigger Viterbi CRC test. Finite count window */
  74                      /* leave front-end AGC parameters at default values */
  75                      /* leave decimation AGC parameters at default values */
  76         {0x35,0x40}, /* disable all interrupts. They are not connected anyway */
  77         {0x36,0xff}, /* clear all interrupt pending flags */
  78         {0x37,0x00}, /* @ fully enable AutoAcqq state machine */
  79         {0x38,0x07}, /* @ enable fade recovery, but not autostart AutoAcq */
  80                      /* leave the equalizer parameters on their default values */
  81                      /* leave the final AGC parameters on their default values */
  82         {0x41,0x00}, /* @ MSB of front-end derotator frequency */
  83         {0x42,0x00}, /* @ middle bytes " */
  84         {0x43,0x00}, /* @ LSB          " */
  85                      /* leave the carrier tracking loop parameters on default */
  86                      /* leave the bit timing loop parameters at default */
  87         {0x56,0x4d}, /* set the filtune voltage to 2.7V, as recommended by */
  88                      /* the cx24108 data sheet for symbol rates above 15MS/s */
  89         {0x57,0x00}, /* @ Filter sigma delta enabled, positive */
  90         {0x61,0x95}, /* GPIO pins 1-4 have special function */
  91         {0x62,0x05}, /* GPIO pin 5 has special function, pin 6 is GPIO */
  92         {0x63,0x00}, /* All GPIO pins use CMOS output characteristics */
  93         {0x64,0x20}, /* GPIO 6 is input, all others are outputs */
  94         {0x6d,0x30}, /* tuner auto mode clock freq 62kHz */
  95         {0x70,0x15}, /* use auto mode, tuner word is 21 bits long */
  96         {0x73,0x00}, /* @ disable several demod bypasses */
  97         {0x74,0x00}, /* @  " */
  98         {0x75,0x00}  /* @  " */
  99                      /* the remaining registers are for SEC */
 100        };
 101
 102
 103static int cx24110_writereg (struct cx24110_state* state, int reg, int data)
 104{
 105        u8 buf [] = { reg, data };
 106        struct i2c_msg msg = { .addr = state->config->demod_address, .flags = 0, .buf = buf, .len = 2 };
 107        int err;
 108
 109        if ((err = i2c_transfer(state->i2c, &msg, 1)) != 1) {
 110                dprintk("%s: writereg error (err == %i, reg == 0x%02x, data == 0x%02x)\n",
 111                        __func__, err, reg, data);
 112                return -EREMOTEIO;
 113        }
 114
 115        return 0;
 116}
 117
 118static int cx24110_readreg (struct cx24110_state* state, u8 reg)
 119{
 120        int ret;
 121        u8 b0 [] = { reg };
 122        u8 b1 [] = { 0 };
 123        struct i2c_msg msg [] = { { .addr = state->config->demod_address, .flags = 0, .buf = b0, .len = 1 },
 124                           { .addr = state->config->demod_address, .flags = I2C_M_RD, .buf = b1, .len = 1 } };
 125
 126        ret = i2c_transfer(state->i2c, msg, 2);
 127
 128        if (ret != 2) return ret;
 129
 130        return b1[0];
 131}
 132
 133static int cx24110_set_inversion(struct cx24110_state *state,
 134                                 enum fe_spectral_inversion inversion)
 135{
 136/* fixme (low): error handling */
 137
 138        switch (inversion) {
 139        case INVERSION_OFF:
 140                cx24110_writereg(state,0x37,cx24110_readreg(state,0x37)|0x1);
 141                /* AcqSpectrInvDis on. No idea why someone should want this */
 142                cx24110_writereg(state,0x5,cx24110_readreg(state,0x5)&0xf7);
 143                /* Initial value 0 at start of acq */
 144                cx24110_writereg(state,0x22,cx24110_readreg(state,0x22)&0xef);
 145                /* current value 0 */
 146                /* The cx24110 manual tells us this reg is read-only.
 147                   But what the heck... set it ayways */
 148                break;
 149        case INVERSION_ON:
 150                cx24110_writereg(state,0x37,cx24110_readreg(state,0x37)|0x1);
 151                /* AcqSpectrInvDis on. No idea why someone should want this */
 152                cx24110_writereg(state,0x5,cx24110_readreg(state,0x5)|0x08);
 153                /* Initial value 1 at start of acq */
 154                cx24110_writereg(state,0x22,cx24110_readreg(state,0x22)|0x10);
 155                /* current value 1 */
 156                break;
 157        case INVERSION_AUTO:
 158                cx24110_writereg(state,0x37,cx24110_readreg(state,0x37)&0xfe);
 159                /* AcqSpectrInvDis off. Leave initial & current states as is */
 160                break;
 161        default:
 162                return -EINVAL;
 163        }
 164
 165        return 0;
 166}
 167
 168static int cx24110_set_fec(struct cx24110_state *state, enum fe_code_rate fec)
 169{
 170        static const int rate[FEC_AUTO] = {-1,    1,    2,    3,    5,    7, -1};
 171        static const int g1[FEC_AUTO]   = {-1, 0x01, 0x02, 0x05, 0x15, 0x45, -1};
 172        static const int g2[FEC_AUTO]   = {-1, 0x01, 0x03, 0x06, 0x1a, 0x7a, -1};
 173
 174        /* Well, the AutoAcq engine of the cx24106 and 24110 automatically
 175           searches all enabled viterbi rates, and can handle non-standard
 176           rates as well. */
 177
 178        if (fec > FEC_AUTO)
 179                fec = FEC_AUTO;
 180
 181        if (fec == FEC_AUTO) { /* (re-)establish AutoAcq behaviour */
 182                cx24110_writereg(state, 0x37, cx24110_readreg(state, 0x37) & 0xdf);
 183                /* clear AcqVitDis bit */
 184                cx24110_writereg(state, 0x18, 0xae);
 185                /* allow all DVB standard code rates */
 186                cx24110_writereg(state, 0x05, (cx24110_readreg(state, 0x05) & 0xf0) | 0x3);
 187                /* set nominal Viterbi rate 3/4 */
 188                cx24110_writereg(state, 0x22, (cx24110_readreg(state, 0x22) & 0xf0) | 0x3);
 189                /* set current Viterbi rate 3/4 */
 190                cx24110_writereg(state, 0x1a, 0x05);
 191                cx24110_writereg(state, 0x1b, 0x06);
 192                /* set the puncture registers for code rate 3/4 */
 193                return 0;
 194        } else {
 195                cx24110_writereg(state, 0x37, cx24110_readreg(state, 0x37) | 0x20);
 196                /* set AcqVitDis bit */
 197                if (rate[fec] < 0)
 198                        return -EINVAL;
 199
 200                cx24110_writereg(state, 0x05, (cx24110_readreg(state, 0x05) & 0xf0) | rate[fec]);
 201                /* set nominal Viterbi rate */
 202                cx24110_writereg(state, 0x22, (cx24110_readreg(state, 0x22) & 0xf0) | rate[fec]);
 203                /* set current Viterbi rate */
 204                cx24110_writereg(state, 0x1a, g1[fec]);
 205                cx24110_writereg(state, 0x1b, g2[fec]);
 206                /* not sure if this is the right way: I always used AutoAcq mode */
 207        }
 208        return 0;
 209}
 210
 211static enum fe_code_rate cx24110_get_fec(struct cx24110_state *state)
 212{
 213        int i;
 214
 215        i=cx24110_readreg(state,0x22)&0x0f;
 216        if(!(i&0x08)) {
 217                return FEC_1_2 + i - 1;
 218        } else {
 219/* fixme (low): a special code rate has been selected. In theory, we need to
 220   return a denominator value, a numerator value, and a pair of puncture
 221   maps to correctly describe this mode. But this should never happen in
 222   practice, because it cannot be set by cx24110_get_fec. */
 223           return FEC_NONE;
 224        }
 225}
 226
 227static int cx24110_set_symbolrate (struct cx24110_state* state, u32 srate)
 228{
 229/* fixme (low): add error handling */
 230        u32 ratio;
 231        u32 tmp, fclk, BDRI;
 232
 233        static const u32 bands[]={5000000UL,15000000UL,90999000UL/2};
 234        int i;
 235
 236        dprintk("cx24110 debug: entering %s(%d)\n",__func__,srate);
 237        if (srate>90999000UL/2)
 238                srate=90999000UL/2;
 239        if (srate<500000)
 240                srate=500000;
 241
 242        for(i = 0; (i < ARRAY_SIZE(bands)) && (srate>bands[i]); i++)
 243                ;
 244        /* first, check which sample rate is appropriate: 45, 60 80 or 90 MHz,
 245           and set the PLL accordingly (R07[1:0] Fclk, R06[7:4] PLLmult,
 246           R06[3:0] PLLphaseDetGain */
 247        tmp=cx24110_readreg(state,0x07)&0xfc;
 248        if(srate<90999000UL/4) { /* sample rate 45MHz*/
 249                cx24110_writereg(state,0x07,tmp);
 250                cx24110_writereg(state,0x06,0x78);
 251                fclk=90999000UL/2;
 252        } else if(srate<60666000UL/2) { /* sample rate 60MHz */
 253                cx24110_writereg(state,0x07,tmp|0x1);
 254                cx24110_writereg(state,0x06,0xa5);
 255                fclk=60666000UL;
 256        } else if(srate<80888000UL/2) { /* sample rate 80MHz */
 257                cx24110_writereg(state,0x07,tmp|0x2);
 258                cx24110_writereg(state,0x06,0x87);
 259                fclk=80888000UL;
 260        } else { /* sample rate 90MHz */
 261                cx24110_writereg(state,0x07,tmp|0x3);
 262                cx24110_writereg(state,0x06,0x78);
 263                fclk=90999000UL;
 264        }
 265        dprintk("cx24110 debug: fclk %d Hz\n",fclk);
 266        /* we need to divide two integers with approx. 27 bits in 32 bit
 267           arithmetic giving a 25 bit result */
 268        /* the maximum dividend is 90999000/2, 0x02b6446c, this number is
 269           also the most complex divisor. Hence, the dividend has,
 270           assuming 32bit unsigned arithmetic, 6 clear bits on top, the
 271           divisor 2 unused bits at the bottom. Also, the quotient is
 272           always less than 1/2. Borrowed from VES1893.c, of course */
 273
 274        tmp=srate<<6;
 275        BDRI=fclk>>2;
 276        ratio=(tmp/BDRI);
 277
 278        tmp=(tmp%BDRI)<<8;
 279        ratio=(ratio<<8)+(tmp/BDRI);
 280
 281        tmp=(tmp%BDRI)<<8;
 282        ratio=(ratio<<8)+(tmp/BDRI);
 283
 284        tmp=(tmp%BDRI)<<1;
 285        ratio=(ratio<<1)+(tmp/BDRI);
 286
 287        dprintk("srate= %d (range %d, up to %d)\n", srate,i,bands[i]);
 288        dprintk("fclk = %d\n", fclk);
 289        dprintk("ratio= %08x\n", ratio);
 290
 291        cx24110_writereg(state, 0x1, (ratio>>16)&0xff);
 292        cx24110_writereg(state, 0x2, (ratio>>8)&0xff);
 293        cx24110_writereg(state, 0x3, (ratio)&0xff);
 294
 295        return 0;
 296
 297}
 298
 299static int _cx24110_pll_write (struct dvb_frontend* fe, const u8 buf[], int len)
 300{
 301        struct cx24110_state *state = fe->demodulator_priv;
 302
 303        if (len != 3)
 304                return -EINVAL;
 305
 306/* tuner data is 21 bits long, must be left-aligned in data */
 307/* tuner cx24108 is written through a dedicated 3wire interface on the demod chip */
 308/* FIXME (low): add error handling, avoid infinite loops if HW fails... */
 309
 310        cx24110_writereg(state,0x6d,0x30); /* auto mode at 62kHz */
 311        cx24110_writereg(state,0x70,0x15); /* auto mode 21 bits */
 312
 313        /* if the auto tuner writer is still busy, clear it out */
 314        while (cx24110_readreg(state,0x6d)&0x80)
 315                cx24110_writereg(state,0x72,0);
 316
 317        /* write the topmost 8 bits */
 318        cx24110_writereg(state,0x72,buf[0]);
 319
 320        /* wait for the send to be completed */
 321        while ((cx24110_readreg(state,0x6d)&0xc0)==0x80)
 322                ;
 323
 324        /* send another 8 bytes */
 325        cx24110_writereg(state,0x72,buf[1]);
 326        while ((cx24110_readreg(state,0x6d)&0xc0)==0x80)
 327                ;
 328
 329        /* and the topmost 5 bits of this byte */
 330        cx24110_writereg(state,0x72,buf[2]);
 331        while ((cx24110_readreg(state,0x6d)&0xc0)==0x80)
 332                ;
 333
 334        /* now strobe the enable line once */
 335        cx24110_writereg(state,0x6d,0x32);
 336        cx24110_writereg(state,0x6d,0x30);
 337
 338        return 0;
 339}
 340
 341static int cx24110_initfe(struct dvb_frontend* fe)
 342{
 343        struct cx24110_state *state = fe->demodulator_priv;
 344/* fixme (low): error handling */
 345        int i;
 346
 347        dprintk("%s: init chip\n", __func__);
 348
 349        for(i = 0; i < ARRAY_SIZE(cx24110_regdata); i++) {
 350                cx24110_writereg(state, cx24110_regdata[i].reg, cx24110_regdata[i].data);
 351        }
 352
 353        return 0;
 354}
 355
 356static int cx24110_set_voltage(struct dvb_frontend *fe,
 357                               enum fe_sec_voltage voltage)
 358{
 359        struct cx24110_state *state = fe->demodulator_priv;
 360
 361        switch (voltage) {
 362        case SEC_VOLTAGE_13:
 363                return cx24110_writereg(state,0x76,(cx24110_readreg(state,0x76)&0x3b)|0xc0);
 364        case SEC_VOLTAGE_18:
 365                return cx24110_writereg(state,0x76,(cx24110_readreg(state,0x76)&0x3b)|0x40);
 366        default:
 367                return -EINVAL;
 368        }
 369}
 370
 371static int cx24110_diseqc_send_burst(struct dvb_frontend *fe,
 372                                     enum fe_sec_mini_cmd burst)
 373{
 374        int rv, bit;
 375        struct cx24110_state *state = fe->demodulator_priv;
 376        unsigned long timeout;
 377
 378        if (burst == SEC_MINI_A)
 379                bit = 0x00;
 380        else if (burst == SEC_MINI_B)
 381                bit = 0x08;
 382        else
 383                return -EINVAL;
 384
 385        rv = cx24110_readreg(state, 0x77);
 386        if (!(rv & 0x04))
 387                cx24110_writereg(state, 0x77, rv | 0x04);
 388
 389        rv = cx24110_readreg(state, 0x76);
 390        cx24110_writereg(state, 0x76, ((rv & 0x90) | 0x40 | bit));
 391        timeout = jiffies + msecs_to_jiffies(100);
 392        while (!time_after(jiffies, timeout) && !(cx24110_readreg(state, 0x76) & 0x40))
 393                ; /* wait for LNB ready */
 394
 395        return 0;
 396}
 397
 398static int cx24110_send_diseqc_msg(struct dvb_frontend* fe,
 399                                   struct dvb_diseqc_master_cmd *cmd)
 400{
 401        int i, rv;
 402        struct cx24110_state *state = fe->demodulator_priv;
 403        unsigned long timeout;
 404
 405        if (cmd->msg_len < 3 || cmd->msg_len > 6)
 406                return -EINVAL;  /* not implemented */
 407
 408        for (i = 0; i < cmd->msg_len; i++)
 409                cx24110_writereg(state, 0x79 + i, cmd->msg[i]);
 410
 411        rv = cx24110_readreg(state, 0x77);
 412        if (rv & 0x04) {
 413                cx24110_writereg(state, 0x77, rv & ~0x04);
 414                msleep(30); /* reportedly fixes switching problems */
 415        }
 416
 417        rv = cx24110_readreg(state, 0x76);
 418
 419        cx24110_writereg(state, 0x76, ((rv & 0x90) | 0x40) | ((cmd->msg_len-3) & 3));
 420        timeout = jiffies + msecs_to_jiffies(100);
 421        while (!time_after(jiffies, timeout) && !(cx24110_readreg(state, 0x76) & 0x40))
 422                ; /* wait for LNB ready */
 423
 424        return 0;
 425}
 426
 427static int cx24110_read_status(struct dvb_frontend *fe,
 428                               enum fe_status *status)
 429{
 430        struct cx24110_state *state = fe->demodulator_priv;
 431
 432        int sync = cx24110_readreg (state, 0x55);
 433
 434        *status = 0;
 435
 436        if (sync & 0x10)
 437                *status |= FE_HAS_SIGNAL;
 438
 439        if (sync & 0x08)
 440                *status |= FE_HAS_CARRIER;
 441
 442        sync = cx24110_readreg (state, 0x08);
 443
 444        if (sync & 0x40)
 445                *status |= FE_HAS_VITERBI;
 446
 447        if (sync & 0x20)
 448                *status |= FE_HAS_SYNC;
 449
 450        if ((sync & 0x60) == 0x60)
 451                *status |= FE_HAS_LOCK;
 452
 453        return 0;
 454}
 455
 456static int cx24110_read_ber(struct dvb_frontend* fe, u32* ber)
 457{
 458        struct cx24110_state *state = fe->demodulator_priv;
 459
 460        /* fixme (maybe): value range is 16 bit. Scale? */
 461        if(cx24110_readreg(state,0x24)&0x10) {
 462                /* the Viterbi error counter has finished one counting window */
 463                cx24110_writereg(state,0x24,0x04); /* select the ber reg */
 464                state->lastber=cx24110_readreg(state,0x25)|
 465                        (cx24110_readreg(state,0x26)<<8);
 466                cx24110_writereg(state,0x24,0x04); /* start new count window */
 467                cx24110_writereg(state,0x24,0x14);
 468        }
 469        *ber = state->lastber;
 470
 471        return 0;
 472}
 473
 474static int cx24110_read_signal_strength(struct dvb_frontend* fe, u16* signal_strength)
 475{
 476        struct cx24110_state *state = fe->demodulator_priv;
 477
 478/* no provision in hardware. Read the frontend AGC accumulator. No idea how to scale this, but I know it is 2s complement */
 479        u8 signal = cx24110_readreg (state, 0x27)+128;
 480        *signal_strength = (signal << 8) | signal;
 481
 482        return 0;
 483}
 484
 485static int cx24110_read_snr(struct dvb_frontend* fe, u16* snr)
 486{
 487        struct cx24110_state *state = fe->demodulator_priv;
 488
 489        /* no provision in hardware. Can be computed from the Es/N0 estimator, but I don't know how. */
 490        if(cx24110_readreg(state,0x6a)&0x80) {
 491                /* the Es/N0 error counter has finished one counting window */
 492                state->lastesn0=cx24110_readreg(state,0x69)|
 493                        (cx24110_readreg(state,0x68)<<8);
 494                cx24110_writereg(state,0x6a,0x84); /* start new count window */
 495        }
 496        *snr = state->lastesn0;
 497
 498        return 0;
 499}
 500
 501static int cx24110_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks)
 502{
 503        struct cx24110_state *state = fe->demodulator_priv;
 504
 505        if(cx24110_readreg(state,0x10)&0x40) {
 506                /* the RS error counter has finished one counting window */
 507                cx24110_writereg(state,0x10,0x60); /* select the byer reg */
 508                (void)(cx24110_readreg(state, 0x12) |
 509                        (cx24110_readreg(state, 0x13) << 8) |
 510                        (cx24110_readreg(state, 0x14) << 16));
 511                cx24110_writereg(state,0x10,0x70); /* select the bler reg */
 512                state->lastbler=cx24110_readreg(state,0x12)|
 513                        (cx24110_readreg(state,0x13)<<8)|
 514                        (cx24110_readreg(state,0x14)<<16);
 515                cx24110_writereg(state,0x10,0x20); /* start new count window */
 516        }
 517        *ucblocks = state->lastbler;
 518
 519        return 0;
 520}
 521
 522static int cx24110_set_frontend(struct dvb_frontend *fe)
 523{
 524        struct cx24110_state *state = fe->demodulator_priv;
 525        struct dtv_frontend_properties *p = &fe->dtv_property_cache;
 526
 527        if (fe->ops.tuner_ops.set_params) {
 528                fe->ops.tuner_ops.set_params(fe);
 529                if (fe->ops.i2c_gate_ctrl) fe->ops.i2c_gate_ctrl(fe, 0);
 530        }
 531
 532        cx24110_set_inversion(state, p->inversion);
 533        cx24110_set_fec(state, p->fec_inner);
 534        cx24110_set_symbolrate(state, p->symbol_rate);
 535        cx24110_writereg(state,0x04,0x05); /* start acquisition */
 536
 537        return 0;
 538}
 539
 540static int cx24110_get_frontend(struct dvb_frontend *fe,
 541                                struct dtv_frontend_properties *p)
 542{
 543        struct cx24110_state *state = fe->demodulator_priv;
 544        s32 afc; unsigned sclk;
 545
 546/* cannot read back tuner settings (freq). Need to have some private storage */
 547
 548        sclk = cx24110_readreg (state, 0x07) & 0x03;
 549/* ok, real AFC (FEDR) freq. is afc/2^24*fsamp, fsamp=45/60/80/90MHz.
 550 * Need 64 bit arithmetic. Is thiss possible in the kernel? */
 551        if (sclk==0) sclk=90999000L/2L;
 552        else if (sclk==1) sclk=60666000L;
 553        else if (sclk==2) sclk=80888000L;
 554        else sclk=90999000L;
 555        sclk>>=8;
 556        afc = sclk*(cx24110_readreg (state, 0x44)&0x1f)+
 557              ((sclk*cx24110_readreg (state, 0x45))>>8)+
 558              ((sclk*cx24110_readreg (state, 0x46))>>16);
 559
 560        p->frequency += afc;
 561        p->inversion = (cx24110_readreg (state, 0x22) & 0x10) ?
 562                                INVERSION_ON : INVERSION_OFF;
 563        p->fec_inner = cx24110_get_fec(state);
 564
 565        return 0;
 566}
 567
 568static int cx24110_set_tone(struct dvb_frontend *fe,
 569                            enum fe_sec_tone_mode tone)
 570{
 571        struct cx24110_state *state = fe->demodulator_priv;
 572
 573        return cx24110_writereg(state,0x76,(cx24110_readreg(state,0x76)&~0x10)|(((tone==SEC_TONE_ON))?0x10:0));
 574}
 575
 576static void cx24110_release(struct dvb_frontend* fe)
 577{
 578        struct cx24110_state* state = fe->demodulator_priv;
 579        kfree(state);
 580}
 581
 582static const struct dvb_frontend_ops cx24110_ops;
 583
 584struct dvb_frontend* cx24110_attach(const struct cx24110_config* config,
 585                                    struct i2c_adapter* i2c)
 586{
 587        struct cx24110_state* state = NULL;
 588        int ret;
 589
 590        /* allocate memory for the internal state */
 591        state = kzalloc(sizeof(struct cx24110_state), GFP_KERNEL);
 592        if (state == NULL) goto error;
 593
 594        /* setup the state */
 595        state->config = config;
 596        state->i2c = i2c;
 597        state->lastber = 0;
 598        state->lastbler = 0;
 599        state->lastesn0 = 0;
 600
 601        /* check if the demod is there */
 602        ret = cx24110_readreg(state, 0x00);
 603        if ((ret != 0x5a) && (ret != 0x69)) goto error;
 604
 605        /* create dvb_frontend */
 606        memcpy(&state->frontend.ops, &cx24110_ops, sizeof(struct dvb_frontend_ops));
 607        state->frontend.demodulator_priv = state;
 608        return &state->frontend;
 609
 610error:
 611        kfree(state);
 612        return NULL;
 613}
 614
 615static const struct dvb_frontend_ops cx24110_ops = {
 616        .delsys = { SYS_DVBS },
 617        .info = {
 618                .name = "Conexant CX24110 DVB-S",
 619                .frequency_min_hz =  950 * MHz,
 620                .frequency_max_hz = 2150 * MHz,
 621                .frequency_stepsize_hz = 1011 * kHz,
 622                .frequency_tolerance_hz = 29500 * kHz,
 623                .symbol_rate_min = 1000000,
 624                .symbol_rate_max = 45000000,
 625                .caps = FE_CAN_INVERSION_AUTO |
 626                        FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
 627                        FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
 628                        FE_CAN_QPSK | FE_CAN_RECOVER
 629        },
 630
 631        .release = cx24110_release,
 632
 633        .init = cx24110_initfe,
 634        .write = _cx24110_pll_write,
 635        .set_frontend = cx24110_set_frontend,
 636        .get_frontend = cx24110_get_frontend,
 637        .read_status = cx24110_read_status,
 638        .read_ber = cx24110_read_ber,
 639        .read_signal_strength = cx24110_read_signal_strength,
 640        .read_snr = cx24110_read_snr,
 641        .read_ucblocks = cx24110_read_ucblocks,
 642
 643        .diseqc_send_master_cmd = cx24110_send_diseqc_msg,
 644        .set_tone = cx24110_set_tone,
 645        .set_voltage = cx24110_set_voltage,
 646        .diseqc_send_burst = cx24110_diseqc_send_burst,
 647};
 648
 649module_param(debug, int, 0644);
 650MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
 651
 652MODULE_DESCRIPTION("Conexant CX24110 DVB-S Demodulator driver");
 653MODULE_AUTHOR("Peter Hettkamp");
 654MODULE_LICENSE("GPL");
 655
 656EXPORT_SYMBOL(cx24110_attach);
 657