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