drivers/media/dvb/frontends/cx24116.c

   1 /*
   2     Conexant cx24116/cx24118 - DVBS/S2 Satellite demod/tuner driver
   3
   4     Copyright (C) 2006-2008 Steven Toth <stoth@hauppauge.com>
   5     Copyright (C) 2006-2007 Georg Acher
   6     Copyright (C) 2007-2008 Darron Broad
   7         March 2007
   8             Fixed some bugs.
   9             Added diseqc support.
  10             Added corrected signal strength support.
  11         August 2007
  12             Sync with legacy version.
  13             Some clean ups.
  14     Copyright (C) 2008 Igor Liplianin
  15         September, 9th 2008
  16             Fixed locking on high symbol rates (>30000).
  17             Implement MPEG initialization parameter.
  18         January, 17th 2009
  19             Fill set_voltage with actually control voltage code.
  20             Correct set tone to not affect voltage.
  21
  22     This program is free software; you can redistribute it and/or modify
  23     it under the terms of the GNU General Public License as published by
  24     the Free Software Foundation; either version 2 of the License, or
  25     (at your option) any later version.
  26
  27     This program is distributed in the hope that it will be useful,
  28     but WITHOUT ANY WARRANTY; without even the implied warranty of
  29     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  30     GNU General Public License for more details.
  31
  32     You should have received a copy of the GNU General Public License
  33     along with this program; if not, write to the Free Software
  34     Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  35 */
  36
  37 #include <linux/slab.h>
  38 #include <linux/kernel.h>
  39 #include <linux/module.h>
  40 #include <linux/moduleparam.h>
  41 #include <linux/init.h>
  42 #include <linux/firmware.h>
  43
  44 #include "dvb_frontend.h"
  45 #include "cx24116.h"
  46
  47 static int debug;
  48 module_param(debug, int, 0644);
  49 MODULE_PARM_DESC(debug, "Activates frontend debugging (default:0)");
  50
  51 #define dprintk(args...) \
  52         do { \
  53                 if (debug) \
  54                         printk(KERN_INFO "cx24116: " args); \
  55         } while (0)
  56
  57 #define CX24116_DEFAULT_FIRMWARE "dvb-fe-cx24116.fw"
  58 #define CX24116_SEARCH_RANGE_KHZ 5000
  59
  60 /* known registers */
  61 #define CX24116_REG_COMMAND (0x00)      /* command args 0x00..0x1e */
  62 #define CX24116_REG_EXECUTE (0x1f)      /* execute command */
  63 #define CX24116_REG_MAILBOX (0x96)      /* FW or multipurpose mailbox? */
  64 #define CX24116_REG_RESET   (0x20)      /* reset status > 0     */
  65 #define CX24116_REG_SIGNAL  (0x9e)      /* signal low           */
  66 #define CX24116_REG_SSTATUS (0x9d)      /* signal high / status */
  67 #define CX24116_REG_QUALITY8 (0xa3)
  68 #define CX24116_REG_QSTATUS (0xbc)
  69 #define CX24116_REG_QUALITY0 (0xd5)
  70 #define CX24116_REG_BER0    (0xc9)
  71 #define CX24116_REG_BER8    (0xc8)
  72 #define CX24116_REG_BER16   (0xc7)
  73 #define CX24116_REG_BER24   (0xc6)
  74 #define CX24116_REG_UCB0    (0xcb)
  75 #define CX24116_REG_UCB8    (0xca)
  76 #define CX24116_REG_CLKDIV  (0xf3)
  77 #define CX24116_REG_RATEDIV (0xf9)
  78
  79 /* configured fec (not tuned) or actual FEC (tuned) 1=1/2 2=2/3 etc */
  80 #define CX24116_REG_FECSTATUS (0x9c)
  81
  82 /* FECSTATUS bits */
  83 /* mask to determine configured fec (not tuned) or actual fec (tuned) */
  84 #define CX24116_FEC_FECMASK   (0x1f)
  85
  86 /* Select DVB-S demodulator, else DVB-S2 */
  87 #define CX24116_FEC_DVBS      (0x20)
  88 #define CX24116_FEC_UNKNOWN   (0x40)    /* Unknown/unused */
  89
  90 /* Pilot mode requested when tuning else always reset when tuned */
  91 #define CX24116_FEC_PILOT     (0x80)
  92
  93 /* arg buffer size */
  94 #define CX24116_ARGLEN (0x1e)
  95
  96 /* rolloff */
  97 #define CX24116_ROLLOFF_020 (0x00)
  98 #define CX24116_ROLLOFF_025 (0x01)
  99 #define CX24116_ROLLOFF_035 (0x02)
 100
 101 /* pilot bit */
 102 #define CX24116_PILOT_OFF (0x00)
 103 #define CX24116_PILOT_ON (0x40)
 104
 105 /* signal status */
 106 #define CX24116_HAS_SIGNAL   (0x01)
 107 #define CX24116_HAS_CARRIER  (0x02)
 108 #define CX24116_HAS_VITERBI  (0x04)
 109 #define CX24116_HAS_SYNCLOCK (0x08)
 110 #define CX24116_HAS_UNKNOWN1 (0x10)
 111 #define CX24116_HAS_UNKNOWN2 (0x20)
 112 #define CX24116_STATUS_MASK  (0x0f)
 113 #define CX24116_SIGNAL_MASK  (0xc0)
 114
 115 #define CX24116_DISEQC_TONEOFF   (0)    /* toneburst never sent */
 116 #define CX24116_DISEQC_TONECACHE (1)    /* toneburst cached     */
 117 #define CX24116_DISEQC_MESGCACHE (2)    /* message cached       */
 118
 119 /* arg offset for DiSEqC */
 120 #define CX24116_DISEQC_BURST  (1)
 121 #define CX24116_DISEQC_ARG2_2 (2)   /* unknown value=2 */
 122 #define CX24116_DISEQC_ARG3_0 (3)   /* unknown value=0 */
 123 #define CX24116_DISEQC_ARG4_0 (4)   /* unknown value=0 */
 124 #define CX24116_DISEQC_MSGLEN (5)
 125 #define CX24116_DISEQC_MSGOFS (6)
 126
 127 /* DiSEqC burst */
 128 #define CX24116_DISEQC_MINI_A (0)
 129 #define CX24116_DISEQC_MINI_B (1)
 130
 131 /* DiSEqC tone burst */
 132 static int toneburst = 1;
 133 module_param(toneburst, int, 0644);
 134 MODULE_PARM_DESC(toneburst, "DiSEqC toneburst 0=OFF, 1=TONE CACHE, "\
 135         "2=MESSAGE CACHE (default:1)");
 136
 137 /* SNR measurements */
 138 static int esno_snr;
 139 module_param(esno_snr, int, 0644);
 140 MODULE_PARM_DESC(debug, "SNR return units, 0=PERCENTAGE 0-100, "\
 141         "1=ESNO(db * 10) (default:0)");
 142
 143 enum cmds {
 144         CMD_SET_VCO     = 0x10,
 145         CMD_TUNEREQUEST = 0x11,
 146         CMD_MPEGCONFIG  = 0x13,
 147         CMD_TUNERINIT   = 0x14,
 148         CMD_BANDWIDTH   = 0x15,
 149         CMD_GETAGC      = 0x19,
 150         CMD_LNBCONFIG   = 0x20,
 151         CMD_LNBSEND     = 0x21, /* Formerly CMD_SEND_DISEQC */
 152         CMD_LNBDCLEVEL  = 0x22,
 153         CMD_SET_TONE    = 0x23,
 154         CMD_UPDFWVERS   = 0x35,
 155         CMD_TUNERSLEEP  = 0x36,
 156         CMD_AGCCONTROL  = 0x3b, /* Unknown */
 157 };
 158
 159 /* The Demod/Tuner can't easily provide these, we cache them */
 160 struct cx24116_tuning {
 161         u32 frequency;
 162         u32 symbol_rate;
 163         fe_spectral_inversion_t inversion;
 164         fe_code_rate_t fec;
 165
 166         fe_delivery_system_t delsys;
 167         fe_modulation_t modulation;
 168         fe_pilot_t pilot;
 169         fe_rolloff_t rolloff;
 170
 171         /* Demod values */
 172         u8 fec_val;
 173         u8 fec_mask;
 174         u8 inversion_val;
 175         u8 pilot_val;
 176         u8 rolloff_val;
 177 };
 178
 179 /* Basic commands that are sent to the firmware */
 180 struct cx24116_cmd {
 181         u8 len;
 182         u8 args[CX24116_ARGLEN];
 183 };
 184
 185 struct cx24116_state {
 186         struct i2c_adapter *i2c;
 187         const struct cx24116_config *config;
 188
 189         struct dvb_frontend frontend;
 190
 191         struct cx24116_tuning dcur;
 192         struct cx24116_tuning dnxt;
 193
 194         u8 skip_fw_load;
 195         u8 burst;
 196         struct cx24116_cmd dsec_cmd;
 197 };
 198
 199 static int cx24116_writereg(struct cx24116_state *state, int reg, int data)
 200 {
 201         u8 buf[] = { reg, data };
 202         struct i2c_msg msg = { .addr = state->config->demod_address,
 203                 .flags = 0, .buf = buf, .len = 2 };
 204         int err;
 205
 206         if (debug > 1)
 207                 printk("cx24116: %s: write reg 0x%02x, value 0x%02x\n",
 208                         __func__, reg, data);
 209
 210         err = i2c_transfer(state->i2c, &msg, 1);
 211         if (err != 1) {
 212                 printk(KERN_ERR "%s: writereg error(err == %i, reg == 0x%02x,"
 213                          " value == 0x%02x)\n", __func__, err, reg, data);
 214                 return -EREMOTEIO;
 215         }
 216
 217         return 0;
 218 }
 219
 220 /* Bulk byte writes to a single I2C address, for 32k firmware load */
 221 static int cx24116_writeregN(struct cx24116_state *state, int reg,
 222                              const u8 *data, u16 len)
 223 {
 224         int ret = -EREMOTEIO;
 225         struct i2c_msg msg;
 226         u8 *buf;
 227
 228         buf = kmalloc(len + 1, GFP_KERNEL);
 229         if (buf == NULL) {
 230                 printk("Unable to kmalloc\n");
 231                 ret = -ENOMEM;
 232                 goto error;
 233         }
 234
 235         *(buf) = reg;
 236         memcpy(buf + 1, data, len);
 237
 238         msg.addr = state->config->demod_address;
 239         msg.flags = 0;
 240         msg.buf = buf;
 241         msg.len = len + 1;
 242
 243         if (debug > 1)
 244                 printk(KERN_INFO "cx24116: %s:  write regN 0x%02x, len = %d\n",
 245                         __func__, reg, len);
 246
 247         ret = i2c_transfer(state->i2c, &msg, 1);
 248         if (ret != 1) {
 249                 printk(KERN_ERR "%s: writereg error(err == %i, reg == 0x%02x\n",
 250                          __func__, ret, reg);
 251                 ret = -EREMOTEIO;
 252         }
 253
 254 error:
 255         kfree(buf);
 256
 257         return ret;
 258 }
 259
 260 static int cx24116_readreg(struct cx24116_state *state, u8 reg)
 261 {
 262         int ret;
 263         u8 b0[] = { reg };
 264         u8 b1[] = { 0 };
 265         struct i2c_msg msg[] = {
 266                 { .addr = state->config->demod_address, .flags = 0,
 267                         .buf = b0, .len = 1 },
 268                 { .addr = state->config->demod_address, .flags = I2C_M_RD,
 269                         .buf = b1, .len = 1 }
 270         };
 271
 272         ret = i2c_transfer(state->i2c, msg, 2);
 273
 274         if (ret != 2) {
 275                 printk(KERN_ERR "%s: reg=0x%x (error=%d)\n",
 276                         __func__, reg, ret);
 277                 return ret;
 278         }
 279
 280         if (debug > 1)
 281                 printk(KERN_INFO "cx24116: read reg 0x%02x, value 0x%02x\n",
 282                         reg, b1[0]);
 283
 284         return b1[0];
 285 }
 286
 287 static int cx24116_set_inversion(struct cx24116_state *state,
 288         fe_spectral_inversion_t inversion)
 289 {
 290         dprintk("%s(%d)\n", __func__, inversion);
 291
 292         switch (inversion) {
 293         case INVERSION_OFF:
 294                 state->dnxt.inversion_val = 0x00;
 295                 break;
 296         case INVERSION_ON:
 297                 state->dnxt.inversion_val = 0x04;
 298                 break;
 299         case INVERSION_AUTO:
 300                 state->dnxt.inversion_val = 0x0C;
 301                 break;
 302         default:
 303                 return -EINVAL;
 304         }
 305
 306         state->dnxt.inversion = inversion;
 307
 308         return 0;
 309 }
 310
 311 /*
 312  * modfec (modulation and FEC)
 313  * ===========================
 314  *
 315  * MOD          FEC             mask/val    standard
 316  * ----         --------        ----------- --------
 317  * QPSK         FEC_1_2         0x02 0x02+X DVB-S
 318  * QPSK         FEC_2_3         0x04 0x02+X DVB-S
 319  * QPSK         FEC_3_4         0x08 0x02+X DVB-S
 320  * QPSK         FEC_4_5         0x10 0x02+X DVB-S (?)
 321  * QPSK         FEC_5_6         0x20 0x02+X DVB-S
 322  * QPSK         FEC_6_7         0x40 0x02+X DVB-S
 323  * QPSK         FEC_7_8         0x80 0x02+X DVB-S
 324  * QPSK         FEC_8_9         0x01 0x02+X DVB-S (?) (NOT SUPPORTED?)
 325  * QPSK         AUTO            0xff 0x02+X DVB-S
 326  *
 327  * For DVB-S high byte probably represents FEC
 328  * and low byte selects the modulator. The high
 329  * byte is search range mask. Bit 5 may turn
 330  * on DVB-S and remaining bits represent some
 331  * kind of calibration (how/what i do not know).
 332  *
 333  * Eg.(2/3) szap "Zone Horror"
 334  *
 335  * mask/val = 0x04, 0x20
 336  * status 1f | signal c3c0 | snr a333 | ber 00000098 | unc 0 | FE_HAS_LOCK
 337  *
 338  * mask/val = 0x04, 0x30
 339  * status 1f | signal c3c0 | snr a333 | ber 00000000 | unc 0 | FE_HAS_LOCK
 340  *
 341  * After tuning FECSTATUS contains actual FEC
 342  * in use numbered 1 through to 8 for 1/2 .. 2/3 etc
 343  *
 344  * NBC=NOT/NON BACKWARD COMPATIBLE WITH DVB-S (DVB-S2 only)
 345  *
 346  * NBC-QPSK     FEC_1_2         0x00, 0x04      DVB-S2
 347  * NBC-QPSK     FEC_3_5         0x00, 0x05      DVB-S2
 348  * NBC-QPSK     FEC_2_3         0x00, 0x06      DVB-S2
 349  * NBC-QPSK     FEC_3_4         0x00, 0x07      DVB-S2
 350  * NBC-QPSK     FEC_4_5         0x00, 0x08      DVB-S2
 351  * NBC-QPSK     FEC_5_6         0x00, 0x09      DVB-S2
 352  * NBC-QPSK     FEC_8_9         0x00, 0x0a      DVB-S2
 353  * NBC-QPSK     FEC_9_10        0x00, 0x0b      DVB-S2
 354  *
 355  * NBC-8PSK     FEC_3_5         0x00, 0x0c      DVB-S2
 356  * NBC-8PSK     FEC_2_3         0x00, 0x0d      DVB-S2
 357  * NBC-8PSK     FEC_3_4         0x00, 0x0e      DVB-S2
 358  * NBC-8PSK     FEC_5_6         0x00, 0x0f      DVB-S2
 359  * NBC-8PSK     FEC_8_9         0x00, 0x10      DVB-S2
 360  * NBC-8PSK     FEC_9_10        0x00, 0x11      DVB-S2
 361  *
 362  * For DVB-S2 low bytes selects both modulator
 363  * and FEC. High byte is meaningless here. To
 364  * set pilot, bit 6 (0x40) is set. When inspecting
 365  * FECSTATUS bit 7 (0x80) represents the pilot
 366  * selection whilst not tuned. When tuned, actual FEC
 367  * in use is found in FECSTATUS as per above. Pilot
 368  * value is reset.
 369  */
 370
 371 /* A table of modulation, fec and configuration bytes for the demod.
 372  * Not all S2 mmodulation schemes are support and not all rates with
 373  * a scheme are support. Especially, no auto detect when in S2 mode.
 374  */
 375 static struct cx24116_modfec {
 376         fe_delivery_system_t delivery_system;
 377         fe_modulation_t modulation;
 378         fe_code_rate_t fec;
 379         u8 mask;        /* In DVBS mode this is used to autodetect */
 380         u8 val;         /* Passed to the firmware to indicate mode selection */
 381 } CX24116_MODFEC_MODES[] = {
 382  /* QPSK. For unknown rates we set hardware to auto detect 0xfe 0x30 */
 383
 384  /*mod   fec       mask  val */
 385  { SYS_DVBS, QPSK, FEC_NONE, 0xfe, 0x30 },
 386  { SYS_DVBS, QPSK, FEC_1_2,  0x02, 0x2e }, /* 00000010 00101110 */
 387  { SYS_DVBS, QPSK, FEC_2_3,  0x04, 0x2f }, /* 00000100 00101111 */
 388  { SYS_DVBS, QPSK, FEC_3_4,  0x08, 0x30 }, /* 00001000 00110000 */
 389  { SYS_DVBS, QPSK, FEC_4_5,  0xfe, 0x30 }, /* 000?0000 ?        */
 390  { SYS_DVBS, QPSK, FEC_5_6,  0x20, 0x31 }, /* 00100000 00110001 */
 391  { SYS_DVBS, QPSK, FEC_6_7,  0xfe, 0x30 }, /* 0?000000 ?        */
 392  { SYS_DVBS, QPSK, FEC_7_8,  0x80, 0x32 }, /* 10000000 00110010 */
 393  { SYS_DVBS, QPSK, FEC_8_9,  0xfe, 0x30 }, /* 0000000? ?        */
 394  { SYS_DVBS, QPSK, FEC_AUTO, 0xfe, 0x30 },
 395  /* NBC-QPSK */
 396  { SYS_DVBS2, QPSK, FEC_1_2,  0x00, 0x04 },
 397  { SYS_DVBS2, QPSK, FEC_3_5,  0x00, 0x05 },
 398  { SYS_DVBS2, QPSK, FEC_2_3,  0x00, 0x06 },
 399  { SYS_DVBS2, QPSK, FEC_3_4,  0x00, 0x07 },
 400  { SYS_DVBS2, QPSK, FEC_4_5,  0x00, 0x08 },
 401  { SYS_DVBS2, QPSK, FEC_5_6,  0x00, 0x09 },
 402  { SYS_DVBS2, QPSK, FEC_8_9,  0x00, 0x0a },
 403  { SYS_DVBS2, QPSK, FEC_9_10, 0x00, 0x0b },
 404  /* 8PSK */
 405  { SYS_DVBS2, PSK_8, FEC_3_5,  0x00, 0x0c },
 406  { SYS_DVBS2, PSK_8, FEC_2_3,  0x00, 0x0d },
 407  { SYS_DVBS2, PSK_8, FEC_3_4,  0x00, 0x0e },
 408  { SYS_DVBS2, PSK_8, FEC_5_6,  0x00, 0x0f },
 409  { SYS_DVBS2, PSK_8, FEC_8_9,  0x00, 0x10 },
 410  { SYS_DVBS2, PSK_8, FEC_9_10, 0x00, 0x11 },
 411  /*
 412   * `val' can be found in the FECSTATUS register when tuning.
 413   * FECSTATUS will give the actual FEC in use if tuning was successful.
 414   */
 415 };
 416
 417 static int cx24116_lookup_fecmod(struct cx24116_state *state,
 418         fe_delivery_system_t d, fe_modulation_t m, fe_code_rate_t f)
 419 {
 420         int i, ret = -EOPNOTSUPP;
 421
 422         dprintk("%s(0x%02x,0x%02x)\n", __func__, m, f);
 423
 424         for (i = 0; i < ARRAY_SIZE(CX24116_MODFEC_MODES); i++) {
 425                 if ((d == CX24116_MODFEC_MODES[i].delivery_system) &&
 426                         (m == CX24116_MODFEC_MODES[i].modulation) &&
 427                         (f == CX24116_MODFEC_MODES[i].fec)) {
 428                                 ret = i;
 429                                 break;
 430                         }
 431         }
 432
 433         return ret;
 434 }
 435
 436 static int cx24116_set_fec(struct cx24116_state *state,
 437         fe_delivery_system_t delsys, fe_modulation_t mod, fe_code_rate_t fec)
 438 {
 439         int ret = 0;
 440
 441         dprintk("%s(0x%02x,0x%02x)\n", __func__, mod, fec);
 442
 443         ret = cx24116_lookup_fecmod(state, delsys, mod, fec);
 444
 445         if (ret < 0)
 446                 return ret;
 447
 448         state->dnxt.fec = fec;
 449         state->dnxt.fec_val = CX24116_MODFEC_MODES[ret].val;
 450         state->dnxt.fec_mask = CX24116_MODFEC_MODES[ret].mask;
 451         dprintk("%s() mask/val = 0x%02x/0x%02x\n", __func__,
 452                 state->dnxt.fec_mask, state->dnxt.fec_val);
 453
 454         return 0;
 455 }
 456
 457 static int cx24116_set_symbolrate(struct cx24116_state *state, u32 rate)
 458 {
 459         dprintk("%s(%d)\n", __func__, rate);
 460
 461         /*  check if symbol rate is within limits */
 462         if ((rate > state->frontend.ops.info.symbol_rate_max) ||
 463             (rate < state->frontend.ops.info.symbol_rate_min)) {
 464                 dprintk("%s() unsupported symbol_rate = %d\n", __func__, rate);
 465                 return -EOPNOTSUPP;
 466         }
 467
 468         state->dnxt.symbol_rate = rate;
 469         dprintk("%s() symbol_rate = %d\n", __func__, rate);
 470
 471         return 0;
 472 }
 473
 474 static int cx24116_load_firmware(struct dvb_frontend *fe,
 475         const struct firmware *fw);
 476
 477 static int cx24116_firmware_ondemand(struct dvb_frontend *fe)
 478 {
 479         struct cx24116_state *state = fe->demodulator_priv;
 480         const struct firmware *fw;
 481         int ret = 0;
 482
 483         dprintk("%s()\n", __func__);
 484
 485         if (cx24116_readreg(state, 0x20) > 0) {
 486
 487                 if (state->skip_fw_load)
 488                         return 0;
 489
 490                 /* Load firmware */
 491                 /* request the firmware, this will block until loaded */
 492                 printk(KERN_INFO "%s: Waiting for firmware upload (%s)...\n",
 493                         __func__, CX24116_DEFAULT_FIRMWARE);
 494                 ret = request_firmware(&fw, CX24116_DEFAULT_FIRMWARE,
 495                         state->i2c->dev.parent);
 496                 printk(KERN_INFO "%s: Waiting for firmware upload(2)...\n",
 497                         __func__);
 498                 if (ret) {
 499                         printk(KERN_ERR "%s: No firmware uploaded "
 500                                 "(timeout or file not found?)\n", __func__);
 501                         return ret;
 502                 }
 503
 504                 /* Make sure we don't recurse back through here
 505                  * during loading */
 506                 state->skip_fw_load = 1;
 507
 508                 ret = cx24116_load_firmware(fe, fw);
 509                 if (ret)
 510                         printk(KERN_ERR "%s: Writing firmware to device failed\n",
 511                                 __func__);
 512
 513                 release_firmware(fw);
 514
 515                 printk(KERN_INFO "%s: Firmware upload %s\n", __func__,
 516                         ret == 0 ? "complete" : "failed");
 517
 518                 /* Ensure firmware is always loaded if required */
 519                 state->skip_fw_load = 0;
 520         }
 521
 522         return ret;
 523 }
 524
 525 /* Take a basic firmware command structure, format it
 526  * and forward it for processing
 527  */
 528 static int cx24116_cmd_execute(struct dvb_frontend *fe, struct cx24116_cmd *cmd)
 529 {
 530         struct cx24116_state *state = fe->demodulator_priv;
 531         int i, ret;
 532
 533         dprintk("%s()\n", __func__);
 534
 535         /* Load the firmware if required */
 536         ret = cx24116_firmware_ondemand(fe);
 537         if (ret != 0) {
 538                 printk(KERN_ERR "%s(): Unable initialise the firmware\n",
 539                         __func__);
 540                 return ret;
 541         }
 542
 543         /* Write the command */
 544         for (i = 0; i < cmd->len ; i++) {
 545                 dprintk("%s: 0x%02x == 0x%02x\n", __func__, i, cmd->args[i]);
 546                 cx24116_writereg(state, i, cmd->args[i]);
 547         }
 548
 549         /* Start execution and wait for cmd to terminate */
 550         cx24116_writereg(state, CX24116_REG_EXECUTE, 0x01);
 551         while (cx24116_readreg(state, CX24116_REG_EXECUTE)) {
 552                 msleep(10);
 553                 if (i++ > 64) {
 554                         /* Avoid looping forever if the firmware does
 555                                 not respond */
 556                         printk(KERN_WARNING "%s() Firmware not responding\n",
 557                                 __func__);
 558                         return -EREMOTEIO;
 559                 }
 560         }
 561         return 0;
 562 }
 563
 564 static int cx24116_load_firmware(struct dvb_frontend *fe,
 565         const struct firmware *fw)
 566 {
 567         struct cx24116_state *state = fe->demodulator_priv;
 568         struct cx24116_cmd cmd;
 569         int i, ret;
 570         unsigned char vers[4];
 571
 572         dprintk("%s\n", __func__);
 573         dprintk("Firmware is %zu bytes (%02x %02x .. %02x %02x)\n",
 574                         fw->size,
 575                         fw->data[0],
 576                         fw->data[1],
 577                         fw->data[fw->size-2],
 578                         fw->data[fw->size-1]);
 579
 580         /* Toggle 88x SRST pin to reset demod */
 581         if (state->config->reset_device)
 582                 state->config->reset_device(fe);
 583
 584         /* Begin the firmware load process */
 585         /* Prepare the demod, load the firmware, cleanup after load */
 586
 587         /* Init PLL */
 588         cx24116_writereg(state, 0xE5, 0x00);
 589         cx24116_writereg(state, 0xF1, 0x08);
 590         cx24116_writereg(state, 0xF2, 0x13);
 591
 592         /* Start PLL */
 593         cx24116_writereg(state, 0xe0, 0x03);
 594         cx24116_writereg(state, 0xe0, 0x00);
 595
 596         /* Unknown */
 597         cx24116_writereg(state, CX24116_REG_CLKDIV, 0x46);
 598         cx24116_writereg(state, CX24116_REG_RATEDIV, 0x00);
 599
 600         /* Unknown */
 601         cx24116_writereg(state, 0xF0, 0x03);
 602         cx24116_writereg(state, 0xF4, 0x81);
 603         cx24116_writereg(state, 0xF5, 0x00);
 604         cx24116_writereg(state, 0xF6, 0x00);
 605
 606         /* write the entire firmware as one transaction */
 607         cx24116_writeregN(state, 0xF7, fw->data, fw->size);
 608
 609         cx24116_writereg(state, 0xF4, 0x10);
 610         cx24116_writereg(state, 0xF0, 0x00);
 611         cx24116_writereg(state, 0xF8, 0x06);
 612
 613         /* Firmware CMD 10: VCO config */
 614         cmd.args[0x00] = CMD_SET_VCO;
 615         cmd.args[0x01] = 0x05;
 616         cmd.args[0x02] = 0xdc;
 617         cmd.args[0x03] = 0xda;
 618         cmd.args[0x04] = 0xae;
 619         cmd.args[0x05] = 0xaa;
 620         cmd.args[0x06] = 0x04;
 621         cmd.args[0x07] = 0x9d;
 622         cmd.args[0x08] = 0xfc;
 623         cmd.args[0x09] = 0x06;
 624         cmd.len = 0x0a;
 625         ret = cx24116_cmd_execute(fe, &cmd);
 626         if (ret != 0)
 627                 return ret;
 628
 629         cx24116_writereg(state, CX24116_REG_SSTATUS, 0x00);
 630
 631         /* Firmware CMD 14: Tuner config */
 632         cmd.args[0x00] = CMD_TUNERINIT;
 633         cmd.args[0x01] = 0x00;
 634         cmd.args[0x02] = 0x00;
 635         cmd.len = 0x03;
 636         ret = cx24116_cmd_execute(fe, &cmd);
 637         if (ret != 0)
 638                 return ret;
 639
 640         cx24116_writereg(state, 0xe5, 0x00);
 641
 642         /* Firmware CMD 13: MPEG config */
 643         cmd.args[0x00] = CMD_MPEGCONFIG;
 644         cmd.args[0x01] = 0x01;
 645         cmd.args[0x02] = 0x75;
 646         cmd.args[0x03] = 0x00;
 647         if (state->config->mpg_clk_pos_pol)
 648                 cmd.args[0x04] = state->config->mpg_clk_pos_pol;
 649         else
 650                 cmd.args[0x04] = 0x02;
 651         cmd.args[0x05] = 0x00;
 652         cmd.len = 0x06;
 653         ret = cx24116_cmd_execute(fe, &cmd);
 654         if (ret != 0)
 655                 return ret;
 656
 657         /* Firmware CMD 35: Get firmware version */
 658         cmd.args[0x00] = CMD_UPDFWVERS;
 659         cmd.len = 0x02;
 660         for (i = 0; i < 4; i++) {
 661                 cmd.args[0x01] = i;
 662                 ret = cx24116_cmd_execute(fe, &cmd);
 663                 if (ret != 0)
 664                         return ret;
 665                 vers[i] = cx24116_readreg(state, CX24116_REG_MAILBOX);
 666         }
 667         printk(KERN_INFO "%s: FW version %i.%i.%i.%i\n", __func__,
 668                 vers[0], vers[1], vers[2], vers[3]);
 669
 670         return 0;
 671 }
 672
 673 static int cx24116_read_status(struct dvb_frontend *fe, fe_status_t *status)
 674 {
 675         struct cx24116_state *state = fe->demodulator_priv;
 676
 677         int lock = cx24116_readreg(state, CX24116_REG_SSTATUS) &
 678                 CX24116_STATUS_MASK;
 679
 680         dprintk("%s: status = 0x%02x\n", __func__, lock);
 681
 682         *status = 0;
 683
 684         if (lock & CX24116_HAS_SIGNAL)
 685                 *status |= FE_HAS_SIGNAL;
 686         if (lock & CX24116_HAS_CARRIER)
 687                 *status |= FE_HAS_CARRIER;
 688         if (lock & CX24116_HAS_VITERBI)
 689                 *status |= FE_HAS_VITERBI;
 690         if (lock & CX24116_HAS_SYNCLOCK)
 691                 *status |= FE_HAS_SYNC | FE_HAS_LOCK;
 692
 693         return 0;
 694 }
 695
 696 static int cx24116_read_ber(struct dvb_frontend *fe, u32 *ber)
 697 {
 698         struct cx24116_state *state = fe->demodulator_priv;
 699
 700         dprintk("%s()\n", __func__);
 701
 702         *ber =  (cx24116_readreg(state, CX24116_REG_BER24) << 24) |
 703                 (cx24116_readreg(state, CX24116_REG_BER16) << 16) |
 704                 (cx24116_readreg(state, CX24116_REG_BER8)  << 8)  |
 705                  cx24116_readreg(state, CX24116_REG_BER0);
 706
 707         return 0;
 708 }
 709
 710 /* TODO Determine function and scale appropriately */
 711 static int cx24116_read_signal_strength(struct dvb_frontend *fe,
 712         u16 *signal_strength)
 713 {
 714         struct cx24116_state *state = fe->demodulator_priv;
 715         struct cx24116_cmd cmd;
 716         int ret;
 717         u16 sig_reading;
 718
 719         dprintk("%s()\n", __func__);
 720
 721         /* Firmware CMD 19: Get AGC */
 722         cmd.args[0x00] = CMD_GETAGC;
 723         cmd.len = 0x01;
 724         ret = cx24116_cmd_execute(fe, &cmd);
 725         if (ret != 0)
 726                 return ret;
 727
 728         sig_reading =
 729                 (cx24116_readreg(state,
 730                         CX24116_REG_SSTATUS) & CX24116_SIGNAL_MASK) |
 731                 (cx24116_readreg(state, CX24116_REG_SIGNAL) << 6);
 732         *signal_strength = 0 - sig_reading;
 733
 734         dprintk("%s: raw / cooked = 0x%04x / 0x%04x\n",
 735                 __func__, sig_reading, *signal_strength);
 736
 737         return 0;
 738 }
 739
 740 /* SNR (0..100)% = (sig & 0xf0) * 10 + (sig & 0x0f) * 10 / 16 */
 741 static int cx24116_read_snr_pct(struct dvb_frontend *fe, u16 *snr)
 742 {
 743         struct cx24116_state *state = fe->demodulator_priv;
 744         u8 snr_reading;
 745         static const u32 snr_tab[] = { /* 10 x Table (rounded up) */
 746                 0x00000, 0x0199A, 0x03333, 0x04ccD, 0x06667,
 747                 0x08000, 0x0999A, 0x0b333, 0x0cccD, 0x0e667,
 748                 0x10000, 0x1199A, 0x13333, 0x14ccD, 0x16667,
 749                 0x18000 };
 750
 751         dprintk("%s()\n", __func__);
 752
 753         snr_reading = cx24116_readreg(state, CX24116_REG_QUALITY0);
 754
 755         if (snr_reading >= 0xa0 /* 100% */)
 756                 *snr = 0xffff;
 757         else
 758                 *snr = snr_tab[(snr_reading & 0xf0) >> 4] +
 759                         (snr_tab[(snr_reading & 0x0f)] >> 4);
 760
 761         dprintk("%s: raw / cooked = 0x%02x / 0x%04x\n", __func__,
 762                 snr_reading, *snr);
 763
 764         return 0;
 765 }
 766
 767 /* The reelbox patches show the value in the registers represents
 768  * ESNO, from 0->30db (values 0->300). We provide this value by
 769  * default.
 770  */
 771 static int cx24116_read_snr_esno(struct dvb_frontend *fe, u16 *snr)
 772 {
 773         struct cx24116_state *state = fe->demodulator_priv;
 774
 775         dprintk("%s()\n", __func__);
 776
 777         *snr = cx24116_readreg(state, CX24116_REG_QUALITY8) << 8 |
 778                 cx24116_readreg(state, CX24116_REG_QUALITY0);
 779
 780         dprintk("%s: raw 0x%04x\n", __func__, *snr);
 781
 782         return 0;
 783 }
 784
 785 static int cx24116_read_snr(struct dvb_frontend *fe, u16 *snr)
 786 {
 787         if (esno_snr == 1)
 788                 return cx24116_read_snr_esno(fe, snr);
 789         else
 790                 return cx24116_read_snr_pct(fe, snr);
 791 }
 792
 793 static int cx24116_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
 794 {
 795         struct cx24116_state *state = fe->demodulator_priv;
 796
 797         dprintk("%s()\n", __func__);
 798
 799         *ucblocks = (cx24116_readreg(state, CX24116_REG_UCB8) << 8) |
 800                 cx24116_readreg(state, CX24116_REG_UCB0);
 801
 802         return 0;
 803 }
 804
 805 /* Overwrite the current tuning params, we are about to tune */
 806 static void cx24116_clone_params(struct dvb_frontend *fe)
 807 {
 808         struct cx24116_state *state = fe->demodulator_priv;
 809         memcpy(&state->dcur, &state->dnxt, sizeof(state->dcur));
 810 }
 811
 812 /* Wait for LNB */
 813 static int cx24116_wait_for_lnb(struct dvb_frontend *fe)
 814 {
 815         struct cx24116_state *state = fe->demodulator_priv;
 816         int i;
 817
 818         dprintk("%s() qstatus = 0x%02x\n", __func__,
 819                 cx24116_readreg(state, CX24116_REG_QSTATUS));
 820
 821         /* Wait for up to 300 ms */
 822         for (i = 0; i < 30 ; i++) {
 823                 if (cx24116_readreg(state, CX24116_REG_QSTATUS) & 0x20)
 824                         return 0;
 825                 msleep(10);
 826         }
 827
 828         dprintk("%s(): LNB not ready\n", __func__);
 829
 830         return -ETIMEDOUT; /* -EBUSY ? */
 831 }
 832
 833 static int cx24116_set_voltage(struct dvb_frontend *fe,
 834         fe_sec_voltage_t voltage)
 835 {
 836         struct cx24116_cmd cmd;
 837         int ret;
 838
 839         dprintk("%s: %s\n", __func__,
 840                 voltage == SEC_VOLTAGE_13 ? "SEC_VOLTAGE_13" :
 841                 voltage == SEC_VOLTAGE_18 ? "SEC_VOLTAGE_18" : "??");
 842
 843         /* Wait for LNB ready */
 844         ret = cx24116_wait_for_lnb(fe);
 845         if (ret != 0)
 846                 return ret;
 847
 848         /* Wait for voltage/min repeat delay */
 849         msleep(100);
 850
 851         cmd.args[0x00] = CMD_LNBDCLEVEL;
 852         cmd.args[0x01] = (voltage == SEC_VOLTAGE_18 ? 0x01 : 0x00);
 853         cmd.len = 0x02;
 854
 855         /* Min delay time before DiSEqC send */
 856         msleep(15);
 857
 858         return cx24116_cmd_execute(fe, &cmd);
 859 }
 860
 861 static int cx24116_set_tone(struct dvb_frontend *fe,
 862         fe_sec_tone_mode_t tone)
 863 {
 864         struct cx24116_cmd cmd;
 865         int ret;
 866
 867         dprintk("%s(%d)\n", __func__, tone);
 868         if ((tone != SEC_TONE_ON) && (tone != SEC_TONE_OFF)) {
 869                 printk(KERN_ERR "%s: Invalid, tone=%d\n", __func__, tone);
 870                 return -EINVAL;
 871         }
 872
 873         /* Wait for LNB ready */
 874         ret = cx24116_wait_for_lnb(fe);
 875         if (ret != 0)
 876                 return ret;
 877
 878         /* Min delay time after DiSEqC send */
 879         msleep(15); /* XXX determine is FW does this, see send_diseqc/burst */
 880
 881         /* Now we set the tone */
 882         cmd.args[0x00] = CMD_SET_TONE;
 883         cmd.args[0x01] = 0x00;
 884         cmd.args[0x02] = 0x00;
 885
 886         switch (tone) {
 887         case SEC_TONE_ON:
 888                 dprintk("%s: setting tone on\n", __func__);
 889                 cmd.args[0x03] = 0x01;
 890                 break;
 891         case SEC_TONE_OFF:
 892                 dprintk("%s: setting tone off\n", __func__);
 893                 cmd.args[0x03] = 0x00;
 894                 break;
 895         }
 896         cmd.len = 0x04;
 897
 898         /* Min delay time before DiSEqC send */
 899         msleep(15); /* XXX determine is FW does this, see send_diseqc/burst */
 900
 901         return cx24116_cmd_execute(fe, &cmd);
 902 }
 903
 904 /* Initialise DiSEqC */
 905 static int cx24116_diseqc_init(struct dvb_frontend *fe)
 906 {
 907         struct cx24116_state *state = fe->demodulator_priv;
 908         struct cx24116_cmd cmd;
 909         int ret;
 910
 911         /* Firmware CMD 20: LNB/DiSEqC config */
 912         cmd.args[0x00] = CMD_LNBCONFIG;
 913         cmd.args[0x01] = 0x00;
 914         cmd.args[0x02] = 0x10;
 915         cmd.args[0x03] = 0x00;
 916         cmd.args[0x04] = 0x8f;
 917         cmd.args[0x05] = 0x28;
 918         cmd.args[0x06] = (toneburst == CX24116_DISEQC_TONEOFF) ? 0x00 : 0x01;
 919         cmd.args[0x07] = 0x01;
 920         cmd.len = 0x08;
 921         ret = cx24116_cmd_execute(fe, &cmd);
 922         if (ret != 0)
 923                 return ret;
 924
 925         /* Prepare a DiSEqC command */
 926         state->dsec_cmd.args[0x00] = CMD_LNBSEND;
 927
 928         /* DiSEqC burst */
 929         state->dsec_cmd.args[CX24116_DISEQC_BURST]  = CX24116_DISEQC_MINI_A;
 930
 931         /* Unknown */
 932         state->dsec_cmd.args[CX24116_DISEQC_ARG2_2] = 0x02;
 933         state->dsec_cmd.args[CX24116_DISEQC_ARG3_0] = 0x00;
 934         /* Continuation flag? */
 935         state->dsec_cmd.args[CX24116_DISEQC_ARG4_0] = 0x00;
 936
 937         /* DiSEqC message length */
 938         state->dsec_cmd.args[CX24116_DISEQC_MSGLEN] = 0x00;
 939
 940         /* Command length */
 941         state->dsec_cmd.len = CX24116_DISEQC_MSGOFS;
 942
 943         return 0;
 944 }
 945
 946 /* Send DiSEqC message with derived burst (hack) || previous burst */
 947 static int cx24116_send_diseqc_msg(struct dvb_frontend *fe,
 948         struct dvb_diseqc_master_cmd *d)
 949 {
 950         struct cx24116_state *state = fe->demodulator_priv;
 951         int i, ret;
 952
 953         /* Dump DiSEqC message */
 954         if (debug) {
 955                 printk(KERN_INFO "cx24116: %s(", __func__);
 956                 for (i = 0 ; i < d->msg_len ;) {
 957                         printk(KERN_INFO "0x%02x", d->msg[i]);
 958                         if (++i < d->msg_len)
 959                                 printk(KERN_INFO ", ");
 960                 }
 961                 printk(") toneburst=%d\n", toneburst);
 962         }
 963
 964         /* Validate length */
 965         if (d->msg_len > (CX24116_ARGLEN - CX24116_DISEQC_MSGOFS))
 966                 return -EINVAL;
 967
 968         /* DiSEqC message */
 969         for (i = 0; i < d->msg_len; i++)
 970                 state->dsec_cmd.args[CX24116_DISEQC_MSGOFS + i] = d->msg[i];
 971
 972         /* DiSEqC message length */
 973         state->dsec_cmd.args[CX24116_DISEQC_MSGLEN] = d->msg_len;
 974
 975         /* Command length */
 976         state->dsec_cmd.len = CX24116_DISEQC_MSGOFS +
 977                 state->dsec_cmd.args[CX24116_DISEQC_MSGLEN];
 978
 979         /* DiSEqC toneburst */
 980         if (toneburst == CX24116_DISEQC_MESGCACHE)
 981                 /* Message is cached */
 982                 return 0;
 983
 984         else if (toneburst == CX24116_DISEQC_TONEOFF)
 985                 /* Message is sent without burst */
 986                 state->dsec_cmd.args[CX24116_DISEQC_BURST] = 0;
 987
 988         else if (toneburst == CX24116_DISEQC_TONECACHE) {
 989                 /*
 990                  * Message is sent with derived else cached burst
 991                  *
 992                  * WRITE PORT GROUP COMMAND 38
 993                  *
 994                  * 0/A/A: E0 10 38 F0..F3
 995                  * 1/B/B: E0 10 38 F4..F7
 996                  * 2/C/A: E0 10 38 F8..FB
 997                  * 3/D/B: E0 10 38 FC..FF
 998                  *
 999                  * databyte[3]= 8421:8421
1000                  *              ABCD:WXYZ
1001                  *              CLR :SET
1002                  *
1003                  *              WX= PORT SELECT 0..3    (X=TONEBURST)
1004                  *              Y = VOLTAGE             (0=13V, 1=18V)
1005                  *              Z = BAND                (0=LOW, 1=HIGH(22K))
1006                  */
1007                 if (d->msg_len >= 4 && d->msg[2] == 0x38)
1008                         state->dsec_cmd.args[CX24116_DISEQC_BURST] =
1009                                 ((d->msg[3] & 4) >> 2);
1010                 if (debug)
1011                         dprintk("%s burst=%d\n", __func__,
1012                                 state->dsec_cmd.args[CX24116_DISEQC_BURST]);
1013         }
1014
1015         /* Wait for LNB ready */
1016         ret = cx24116_wait_for_lnb(fe);
1017         if (ret != 0)
1018                 return ret;
1019
1020         /* Wait for voltage/min repeat delay */
1021         msleep(100);
1022
1023         /* Command */
1024         ret = cx24116_cmd_execute(fe, &state->dsec_cmd);
1025         if (ret != 0)
1026                 return ret;
1027         /*
1028          * Wait for send
1029          *
1030          * Eutelsat spec:
1031          * >15ms delay          + (XXX determine if FW does this, see set_tone)
1032          *  13.5ms per byte     +
1033          * >15ms delay          +
1034          *  12.5ms burst        +
1035          * >15ms delay            (XXX determine if FW does this, see set_tone)
1036          */
1037         msleep((state->dsec_cmd.args[CX24116_DISEQC_MSGLEN] << 4) +
1038                 ((toneburst == CX24116_DISEQC_TONEOFF) ? 30 : 60));
1039
1040         return 0;
1041 }
1042
1043 /* Send DiSEqC burst */
1044 static int cx24116_diseqc_send_burst(struct dvb_frontend *fe,
1045         fe_sec_mini_cmd_t burst)
1046 {
1047         struct cx24116_state *state = fe->demodulator_priv;
1048         int ret;
1049
1050         dprintk("%s(%d) toneburst=%d\n", __func__, burst, toneburst);
1051
1052         /* DiSEqC burst */
1053         if (burst == SEC_MINI_A)
1054                 state->dsec_cmd.args[CX24116_DISEQC_BURST] =
1055                         CX24116_DISEQC_MINI_A;
1056         else if (burst == SEC_MINI_B)
1057                 state->dsec_cmd.args[CX24116_DISEQC_BURST] =
1058                         CX24116_DISEQC_MINI_B;
1059         else
1060                 return -EINVAL;
1061
1062         /* DiSEqC toneburst */
1063         if (toneburst != CX24116_DISEQC_MESGCACHE)
1064                 /* Burst is cached */
1065                 return 0;
1066
1067         /* Burst is to be sent with cached message */
1068
1069         /* Wait for LNB ready */
1070         ret = cx24116_wait_for_lnb(fe);
1071         if (ret != 0)
1072                 return ret;
1073
1074         /* Wait for voltage/min repeat delay */
1075         msleep(100);
1076
1077         /* Command */
1078         ret = cx24116_cmd_execute(fe, &state->dsec_cmd);
1079         if (ret != 0)
1080                 return ret;
1081
1082         /*
1083          * Wait for send
1084          *
1085          * Eutelsat spec:
1086          * >15ms delay          + (XXX determine if FW does this, see set_tone)
1087          *  13.5ms per byte     +
1088          * >15ms delay          +
1089          *  12.5ms burst        +
1090          * >15ms delay            (XXX determine if FW does this, see set_tone)
1091          */
1092         msleep((state->dsec_cmd.args[CX24116_DISEQC_MSGLEN] << 4) + 60);
1093
1094         return 0;
1095 }
1096
1097 static void cx24116_release(struct dvb_frontend *fe)
1098 {
1099         struct cx24116_state *state = fe->demodulator_priv;
1100         dprintk("%s\n", __func__);
1101         kfree(state);
1102 }
1103
1104 static struct dvb_frontend_ops cx24116_ops;
1105
1106 struct dvb_frontend *cx24116_attach(const struct cx24116_config *config,
1107         struct i2c_adapter *i2c)
1108 {
1109         struct cx24116_state *state = NULL;
1110         int ret;
1111
1112         dprintk("%s\n", __func__);
1113
1114         /* allocate memory for the internal state */
1115         state = kzalloc(sizeof(struct cx24116_state), GFP_KERNEL);
1116         if (state == NULL)
1117                 goto error1;
1118
1119         state->config = config;
1120         state->i2c = i2c;
1121
1122         /* check if the demod is present */
1123         ret = (cx24116_readreg(state, 0xFF) << 8) |
1124                 cx24116_readreg(state, 0xFE);
1125         if (ret != 0x0501) {
1126                 printk(KERN_INFO "Invalid probe, probably not a CX24116 device\n");
1127                 goto error2;
1128         }
1129
1130         /* create dvb_frontend */
1131         memcpy(&state->frontend.ops, &cx24116_ops,
1132                 sizeof(struct dvb_frontend_ops));
1133         state->frontend.demodulator_priv = state;
1134         return &state->frontend;
1135
1136 error2: kfree(state);
1137 error1: return NULL;
1138 }
1139 EXPORT_SYMBOL(cx24116_attach);
1140
1141 /*
1142  * Initialise or wake up device
1143  *
1144  * Power config will reset and load initial firmware if required
1145  */
1146 static int cx24116_initfe(struct dvb_frontend *fe)
1147 {
1148         struct cx24116_state *state = fe->demodulator_priv;
1149         struct cx24116_cmd cmd;
1150         int ret;
1151
1152         dprintk("%s()\n", __func__);
1153
1154         /* Power on */
1155         cx24116_writereg(state, 0xe0, 0);
1156         cx24116_writereg(state, 0xe1, 0);
1157         cx24116_writereg(state, 0xea, 0);
1158
1159         /* Firmware CMD 36: Power config */
1160         cmd.args[0x00] = CMD_TUNERSLEEP;
1161         cmd.args[0x01] = 0;
1162         cmd.len = 0x02;
1163         ret = cx24116_cmd_execute(fe, &cmd);
1164         if (ret != 0)
1165                 return ret;
1166
1167         ret = cx24116_diseqc_init(fe);
1168         if (ret != 0)
1169                 return ret;
1170
1171         /* HVR-4000 needs this */
1172         return cx24116_set_voltage(fe, SEC_VOLTAGE_13);
1173 }
1174
1175 /*
1176  * Put device to sleep
1177  */
1178 static int cx24116_sleep(struct dvb_frontend *fe)
1179 {
1180         struct cx24116_state *state = fe->demodulator_priv;
1181         struct cx24116_cmd cmd;
1182         int ret;
1183
1184         dprintk("%s()\n", __func__);
1185
1186         /* Firmware CMD 36: Power config */
1187         cmd.args[0x00] = CMD_TUNERSLEEP;
1188         cmd.args[0x01] = 1;
1189         cmd.len = 0x02;
1190         ret = cx24116_cmd_execute(fe, &cmd);
1191         if (ret != 0)
1192                 return ret;
1193
1194         /* Power off (Shutdown clocks) */
1195         cx24116_writereg(state, 0xea, 0xff);
1196         cx24116_writereg(state, 0xe1, 1);
1197         cx24116_writereg(state, 0xe0, 1);
1198
1199         return 0;
1200 }
1201
1202 static int cx24116_set_property(struct dvb_frontend *fe,
1203         struct dtv_property *tvp)
1204 {
1205         dprintk("%s(..)\n", __func__);
1206         return 0;
1207 }
1208
1209 static int cx24116_get_property(struct dvb_frontend *fe,
1210         struct dtv_property *tvp)
1211 {
1212         dprintk("%s(..)\n", __func__);
1213         return 0;
1214 }
1215
1216 /* dvb-core told us to tune, the tv property cache will be complete,
1217  * it's safe for is to pull values and use them for tuning purposes.
1218  */
1219 static int cx24116_set_frontend(struct dvb_frontend *fe,
1220         struct dvb_frontend_parameters *p)
1221 {
1222         struct cx24116_state *state = fe->demodulator_priv;
1223         struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1224         struct cx24116_cmd cmd;
1225         fe_status_t tunerstat;
1226         int i, status, ret, retune = 1;
1227
1228         dprintk("%s()\n", __func__);
1229
1230         switch (c->delivery_system) {
1231         case SYS_DVBS:
1232                 dprintk("%s: DVB-S delivery system selected\n", __func__);
1233
1234                 /* Only QPSK is supported for DVB-S */
1235                 if (c->modulation != QPSK) {
1236                         dprintk("%s: unsupported modulation selected (%d)\n",
1237                                 __func__, c->modulation);
1238                         return -EOPNOTSUPP;
1239                 }
1240
1241                 /* Pilot doesn't exist in DVB-S, turn bit off */
1242                 state->dnxt.pilot_val = CX24116_PILOT_OFF;
1243
1244                 /* DVB-S only supports 0.35 */
1245                 if (c->rolloff != ROLLOFF_35) {
1246                         dprintk("%s: unsupported rolloff selected (%d)\n",
1247                                 __func__, c->rolloff);
1248                         return -EOPNOTSUPP;
1249                 }
1250                 state->dnxt.rolloff_val = CX24116_ROLLOFF_035;
1251                 break;
1252
1253         case SYS_DVBS2:
1254                 dprintk("%s: DVB-S2 delivery system selected\n", __func__);
1255
1256                 /*
1257                  * NBC 8PSK/QPSK with DVB-S is supported for DVB-S2,
1258                  * but not hardware auto detection
1259                  */
1260                 if (c->modulation != PSK_8 && c->modulation != QPSK) {
1261                         dprintk("%s: unsupported modulation selected (%d)\n",
1262                                 __func__, c->modulation);
1263                         return -EOPNOTSUPP;
1264                 }
1265
1266                 switch (c->pilot) {
1267                 case PILOT_AUTO:        /* Not supported but emulated */
1268                         state->dnxt.pilot_val = (c->modulation == QPSK)
1269                                 ? CX24116_PILOT_OFF : CX24116_PILOT_ON;
1270                         retune++;
1271                         break;
1272                 case PILOT_OFF:
1273                         state->dnxt.pilot_val = CX24116_PILOT_OFF;
1274                         break;
1275                 case PILOT_ON:
1276                         state->dnxt.pilot_val = CX24116_PILOT_ON;
1277                         break;
1278                 default:
1279                         dprintk("%s: unsupported pilot mode selected (%d)\n",
1280                                 __func__, c->pilot);
1281                         return -EOPNOTSUPP;
1282                 }
1283
1284                 switch (c->rolloff) {
1285                 case ROLLOFF_20:
1286                         state->dnxt.rolloff_val = CX24116_ROLLOFF_020;
1287                         break;
1288                 case ROLLOFF_25:
1289                         state->dnxt.rolloff_val = CX24116_ROLLOFF_025;
1290                         break;
1291                 case ROLLOFF_35:
1292                         state->dnxt.rolloff_val = CX24116_ROLLOFF_035;
1293                         break;
1294                 case ROLLOFF_AUTO:      /* Rolloff must be explicit */
1295                 default:
1296                         dprintk("%s: unsupported rolloff selected (%d)\n",
1297                                 __func__, c->rolloff);
1298                         return -EOPNOTSUPP;
1299                 }
1300                 break;
1301
1302         default:
1303                 dprintk("%s: unsupported delivery system selected (%d)\n",
1304                         __func__, c->delivery_system);
1305                 return -EOPNOTSUPP;
1306         }
1307         state->dnxt.delsys = c->delivery_system;
1308         state->dnxt.modulation = c->modulation;
1309         state->dnxt.frequency = c->frequency;
1310         state->dnxt.pilot = c->pilot;
1311         state->dnxt.rolloff = c->rolloff;
1312
1313         ret = cx24116_set_inversion(state, c->inversion);
1314         if (ret !=  0)
1315                 return ret;
1316
1317         /* FEC_NONE/AUTO for DVB-S2 is not supported and detected here */
1318         ret = cx24116_set_fec(state, c->delivery_system, c->modulation, c->fec_inner);
1319         if (ret !=  0)
1320                 return ret;
1321
1322         ret = cx24116_set_symbolrate(state, c->symbol_rate);
1323         if (ret !=  0)
1324                 return ret;
1325
1326         /* discard the 'current' tuning parameters and prepare to tune */
1327         cx24116_clone_params(fe);
1328
1329         dprintk("%s:   delsys      = %d\n", __func__, state->dcur.delsys);
1330         dprintk("%s:   modulation  = %d\n", __func__, state->dcur.modulation);
1331         dprintk("%s:   frequency   = %d\n", __func__, state->dcur.frequency);
1332         dprintk("%s:   pilot       = %d (val = 0x%02x)\n", __func__,
1333                 state->dcur.pilot, state->dcur.pilot_val);
1334         dprintk("%s:   retune      = %d\n", __func__, retune);
1335         dprintk("%s:   rolloff     = %d (val = 0x%02x)\n", __func__,
1336                 state->dcur.rolloff, state->dcur.rolloff_val);
1337         dprintk("%s:   symbol_rate = %d\n", __func__, state->dcur.symbol_rate);
1338         dprintk("%s:   FEC         = %d (mask/val = 0x%02x/0x%02x)\n", __func__,
1339                 state->dcur.fec, state->dcur.fec_mask, state->dcur.fec_val);
1340         dprintk("%s:   Inversion   = %d (val = 0x%02x)\n", __func__,
1341                 state->dcur.inversion, state->dcur.inversion_val);
1342
1343         /* This is also done in advise/acquire on HVR4000 but not on LITE */
1344         if (state->config->set_ts_params)
1345                 state->config->set_ts_params(fe, 0);
1346
1347         /* Set/Reset B/W */
1348         cmd.args[0x00] = CMD_BANDWIDTH;
1349         cmd.args[0x01] = 0x01;
1350         cmd.len = 0x02;
1351         ret = cx24116_cmd_execute(fe, &cmd);
1352         if (ret != 0)
1353                 return ret;
1354
1355         /* Prepare a tune request */
1356         cmd.args[0x00] = CMD_TUNEREQUEST;
1357
1358         /* Frequency */
1359         cmd.args[0x01] = (state->dcur.frequency & 0xff0000) >> 16;
1360         cmd.args[0x02] = (state->dcur.frequency & 0x00ff00) >> 8;
1361         cmd.args[0x03] = (state->dcur.frequency & 0x0000ff);
1362
1363         /* Symbol Rate */
1364         cmd.args[0x04] = ((state->dcur.symbol_rate / 1000) & 0xff00) >> 8;
1365         cmd.args[0x05] = ((state->dcur.symbol_rate / 1000) & 0x00ff);
1366
1367         /* Automatic Inversion */
1368         cmd.args[0x06] = state->dcur.inversion_val;
1369
1370         /* Modulation / FEC / Pilot */
1371         cmd.args[0x07] = state->dcur.fec_val | state->dcur.pilot_val;
1372
1373         cmd.args[0x08] = CX24116_SEARCH_RANGE_KHZ >> 8;
1374         cmd.args[0x09] = CX24116_SEARCH_RANGE_KHZ & 0xff;
1375         cmd.args[0x0a] = 0x00;
1376         cmd.args[0x0b] = 0x00;
1377         cmd.args[0x0c] = state->dcur.rolloff_val;
1378         cmd.args[0x0d] = state->dcur.fec_mask;
1379
1380         if (state->dcur.symbol_rate > 30000000) {
1381                 cmd.args[0x0e] = 0x04;
1382                 cmd.args[0x0f] = 0x00;
1383                 cmd.args[0x10] = 0x01;
1384                 cmd.args[0x11] = 0x77;
1385                 cmd.args[0x12] = 0x36;
1386                 cx24116_writereg(state, CX24116_REG_CLKDIV, 0x44);
1387                 cx24116_writereg(state, CX24116_REG_RATEDIV, 0x01);
1388         } else {
1389                 cmd.args[0x0e] = 0x06;
1390                 cmd.args[0x0f] = 0x00;
1391                 cmd.args[0x10] = 0x00;
1392                 cmd.args[0x11] = 0xFA;
1393                 cmd.args[0x12] = 0x24;
1394                 cx24116_writereg(state, CX24116_REG_CLKDIV, 0x46);
1395                 cx24116_writereg(state, CX24116_REG_RATEDIV, 0x00);
1396         }
1397
1398         cmd.len = 0x13;
1399
1400         /* We need to support pilot and non-pilot tuning in the
1401          * driver automatically. This is a workaround for because
1402          * the demod does not support autodetect.
1403          */
1404         do {
1405                 /* Reset status register */
1406                 status = cx24116_readreg(state, CX24116_REG_SSTATUS)
1407                         & CX24116_SIGNAL_MASK;
1408                 cx24116_writereg(state, CX24116_REG_SSTATUS, status);
1409
1410                 /* Tune */
1411                 ret = cx24116_cmd_execute(fe, &cmd);
1412                 if (ret != 0)
1413                         break;
1414
1415                 /*
1416                  * Wait for up to 500 ms before retrying
1417                  *
1418                  * If we are able to tune then generally it occurs within 100ms.
1419                  * If it takes longer, try a different toneburst setting.
1420                  */
1421                 for (i = 0; i < 50 ; i++) {
1422                         cx24116_read_status(fe, &tunerstat);
1423                         status = tunerstat & (FE_HAS_SIGNAL | FE_HAS_SYNC);
1424                         if (status == (FE_HAS_SIGNAL | FE_HAS_SYNC)) {
1425                                 dprintk("%s: Tuned\n", __func__);
1426                                 goto tuned;
1427                         }
1428                         msleep(10);
1429                 }
1430
1431                 dprintk("%s: Not tuned\n", __func__);
1432
1433                 /* Toggle pilot bit when in auto-pilot */
1434                 if (state->dcur.pilot == PILOT_AUTO)
1435                         cmd.args[0x07] ^= CX24116_PILOT_ON;
1436         } while (--retune);
1437
1438 tuned:  /* Set/Reset B/W */
1439         cmd.args[0x00] = CMD_BANDWIDTH;
1440         cmd.args[0x01] = 0x00;
1441         cmd.len = 0x02;
1442         ret = cx24116_cmd_execute(fe, &cmd);
1443         if (ret != 0)
1444                 return ret;
1445
1446         return ret;
1447 }
1448
1449 static int cx24116_tune(struct dvb_frontend *fe, struct dvb_frontend_parameters *params,
1450         unsigned int mode_flags, unsigned int *delay, fe_status_t *status)
1451 {
1452         *delay = HZ / 5;
1453         if (params) {
1454                 int ret = cx24116_set_frontend(fe, params);
1455                 if (ret)
1456                         return ret;
1457         }
1458         return cx24116_read_status(fe, status);
1459 }
1460
1461 static int cx24116_get_algo(struct dvb_frontend *fe)
1462 {
1463         return DVBFE_ALGO_HW;
1464 }
1465
1466 static struct dvb_frontend_ops cx24116_ops = {
1467
1468         .info = {
1469                 .name = "Conexant CX24116/CX24118",
1470                 .type = FE_QPSK,
1471                 .frequency_min = 950000,
1472                 .frequency_max = 2150000,
1473                 .frequency_stepsize = 1011, /* kHz for QPSK frontends */
1474                 .frequency_tolerance = 5000,
1475                 .symbol_rate_min = 1000000,
1476                 .symbol_rate_max = 45000000,
1477                 .caps = FE_CAN_INVERSION_AUTO |
1478                         FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
1479                         FE_CAN_FEC_4_5 | FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 |
1480                         FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
1481                         FE_CAN_2G_MODULATION |
1482                         FE_CAN_QPSK | FE_CAN_RECOVER
1483         },
1484
1485         .release = cx24116_release,
1486
1487         .init = cx24116_initfe,
1488         .sleep = cx24116_sleep,
1489         .read_status = cx24116_read_status,
1490         .read_ber = cx24116_read_ber,
1491         .read_signal_strength = cx24116_read_signal_strength,
1492         .read_snr = cx24116_read_snr,
1493         .read_ucblocks = cx24116_read_ucblocks,
1494         .set_tone = cx24116_set_tone,
1495         .set_voltage = cx24116_set_voltage,
1496         .diseqc_send_master_cmd = cx24116_send_diseqc_msg,
1497         .diseqc_send_burst = cx24116_diseqc_send_burst,
1498         .get_frontend_algo = cx24116_get_algo,
1499         .tune = cx24116_tune,
1500
1501         .set_property = cx24116_set_property,
1502         .get_property = cx24116_get_property,
1503         .set_frontend = cx24116_set_frontend,
1504 };
1505
1506 MODULE_DESCRIPTION("DVB Frontend module for Conexant cx24116/cx24118 hardware");
1507 MODULE_AUTHOR("Steven Toth");
1508 MODULE_LICENSE("GPL");
1509