xref: /linux/drivers/media/dvb-frontends/tda10086.c (revision e7d759f31ca295d589f7420719c311870bb3166f)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2   /*
3      Driver for Philips tda10086 DVBS Demodulator
4 
5      (c) 2006 Andrew de Quincey
6 
7 
8    */
9 
10 #include <linux/init.h>
11 #include <linux/module.h>
12 #include <linux/device.h>
13 #include <linux/jiffies.h>
14 #include <linux/string.h>
15 #include <linux/slab.h>
16 
17 #include <media/dvb_frontend.h>
18 #include "tda10086.h"
19 
20 #define SACLK 96000000U
21 
22 struct tda10086_state {
23 	struct i2c_adapter* i2c;
24 	const struct tda10086_config* config;
25 	struct dvb_frontend frontend;
26 
27 	/* private demod data */
28 	u32 frequency;
29 	u32 symbol_rate;
30 	bool has_lock;
31 };
32 
33 static int debug;
34 #define dprintk(args...) \
35 	do { \
36 		if (debug) printk(KERN_DEBUG "tda10086: " args); \
37 	} while (0)
38 
39 static int tda10086_write_byte(struct tda10086_state *state, int reg, int data)
40 {
41 	int ret;
42 	u8 b0[] = { reg, data };
43 	struct i2c_msg msg = { .flags = 0, .buf = b0, .len = 2 };
44 
45 	msg.addr = state->config->demod_address;
46 	ret = i2c_transfer(state->i2c, &msg, 1);
47 
48 	if (ret != 1)
49 		dprintk("%s: error reg=0x%x, data=0x%x, ret=%i\n",
50 			__func__, reg, data, ret);
51 
52 	return (ret != 1) ? ret : 0;
53 }
54 
55 static int tda10086_read_byte(struct tda10086_state *state, int reg)
56 {
57 	int ret;
58 	u8 b0[] = { reg };
59 	u8 b1[] = { 0 };
60 	struct i2c_msg msg[] = {{ .flags = 0, .buf = b0, .len = 1 },
61 				{ .flags = I2C_M_RD, .buf = b1, .len = 1 }};
62 
63 	msg[0].addr = state->config->demod_address;
64 	msg[1].addr = state->config->demod_address;
65 	ret = i2c_transfer(state->i2c, msg, 2);
66 
67 	if (ret != 2) {
68 		dprintk("%s: error reg=0x%x, ret=%i\n", __func__, reg,
69 			ret);
70 		return ret;
71 	}
72 
73 	return b1[0];
74 }
75 
76 static int tda10086_write_mask(struct tda10086_state *state, int reg, int mask, int data)
77 {
78 	int val;
79 
80 	/* read a byte and check */
81 	val = tda10086_read_byte(state, reg);
82 	if (val < 0)
83 		return val;
84 
85 	/* mask if off */
86 	val = val & ~mask;
87 	val |= data & 0xff;
88 
89 	/* write it out again */
90 	return tda10086_write_byte(state, reg, val);
91 }
92 
93 static int tda10086_init(struct dvb_frontend* fe)
94 {
95 	struct tda10086_state* state = fe->demodulator_priv;
96 	u8 t22k_off = 0x80;
97 
98 	dprintk ("%s\n", __func__);
99 
100 	if (state->config->diseqc_tone)
101 		t22k_off = 0;
102 	/* reset */
103 	tda10086_write_byte(state, 0x00, 0x00);
104 	msleep(10);
105 
106 	/* misc setup */
107 	tda10086_write_byte(state, 0x01, 0x94);
108 	tda10086_write_byte(state, 0x02, 0x35); /* NOTE: TT drivers appear to disable CSWP */
109 	tda10086_write_byte(state, 0x03, 0xe4);
110 	tda10086_write_byte(state, 0x04, 0x43);
111 	tda10086_write_byte(state, 0x0c, 0x0c);
112 	tda10086_write_byte(state, 0x1b, 0xb0); /* noise threshold */
113 	tda10086_write_byte(state, 0x20, 0x89); /* misc */
114 	tda10086_write_byte(state, 0x30, 0x04); /* acquisition period length */
115 	tda10086_write_byte(state, 0x32, 0x00); /* irq off */
116 	tda10086_write_byte(state, 0x31, 0x56); /* setup AFC */
117 
118 	/* setup PLL (this assumes SACLK = 96MHz) */
119 	tda10086_write_byte(state, 0x55, 0x2c); /* misc PLL setup */
120 	if (state->config->xtal_freq == TDA10086_XTAL_16M) {
121 		tda10086_write_byte(state, 0x3a, 0x0b); /* M=12 */
122 		tda10086_write_byte(state, 0x3b, 0x01); /* P=2 */
123 	} else {
124 		tda10086_write_byte(state, 0x3a, 0x17); /* M=24 */
125 		tda10086_write_byte(state, 0x3b, 0x00); /* P=1 */
126 	}
127 	tda10086_write_mask(state, 0x55, 0x20, 0x00); /* powerup PLL */
128 
129 	/* setup TS interface */
130 	tda10086_write_byte(state, 0x11, 0x81);
131 	tda10086_write_byte(state, 0x12, 0x81);
132 	tda10086_write_byte(state, 0x19, 0x40); /* parallel mode A + MSBFIRST */
133 	tda10086_write_byte(state, 0x56, 0x80); /* powerdown WPLL - unused in the mode we use */
134 	tda10086_write_byte(state, 0x57, 0x08); /* bypass WPLL - unused in the mode we use */
135 	tda10086_write_byte(state, 0x10, 0x2a);
136 
137 	/* setup ADC */
138 	tda10086_write_byte(state, 0x58, 0x61); /* ADC setup */
139 	tda10086_write_mask(state, 0x58, 0x01, 0x00); /* powerup ADC */
140 
141 	/* setup AGC */
142 	tda10086_write_byte(state, 0x05, 0x0B);
143 	tda10086_write_byte(state, 0x37, 0x63);
144 	tda10086_write_byte(state, 0x3f, 0x0a); /* NOTE: flydvb varies it */
145 	tda10086_write_byte(state, 0x40, 0x64);
146 	tda10086_write_byte(state, 0x41, 0x4f);
147 	tda10086_write_byte(state, 0x42, 0x43);
148 
149 	/* setup viterbi */
150 	tda10086_write_byte(state, 0x1a, 0x11); /* VBER 10^6, DVB, QPSK */
151 
152 	/* setup carrier recovery */
153 	tda10086_write_byte(state, 0x3d, 0x80);
154 
155 	/* setup SEC */
156 	tda10086_write_byte(state, 0x36, t22k_off); /* all SEC off, 22k tone */
157 	tda10086_write_byte(state, 0x34, (((1<<19) * (22000/1000)) / (SACLK/1000)));
158 	tda10086_write_byte(state, 0x35, (((1<<19) * (22000/1000)) / (SACLK/1000)) >> 8);
159 
160 	return 0;
161 }
162 
163 static void tda10086_diseqc_wait(struct tda10086_state *state)
164 {
165 	unsigned long timeout = jiffies + msecs_to_jiffies(200);
166 	while (!(tda10086_read_byte(state, 0x50) & 0x01)) {
167 		if(time_after(jiffies, timeout)) {
168 			printk("%s: diseqc queue not ready, command may be lost.\n", __func__);
169 			break;
170 		}
171 		msleep(10);
172 	}
173 }
174 
175 static int tda10086_set_tone(struct dvb_frontend *fe,
176 			     enum fe_sec_tone_mode tone)
177 {
178 	struct tda10086_state* state = fe->demodulator_priv;
179 	u8 t22k_off = 0x80;
180 
181 	dprintk ("%s\n", __func__);
182 
183 	if (state->config->diseqc_tone)
184 		t22k_off = 0;
185 
186 	switch (tone) {
187 	case SEC_TONE_OFF:
188 		tda10086_write_byte(state, 0x36, t22k_off);
189 		break;
190 
191 	case SEC_TONE_ON:
192 		tda10086_write_byte(state, 0x36, 0x01 + t22k_off);
193 		break;
194 	}
195 
196 	return 0;
197 }
198 
199 static int tda10086_send_master_cmd (struct dvb_frontend* fe,
200 				    struct dvb_diseqc_master_cmd* cmd)
201 {
202 	struct tda10086_state* state = fe->demodulator_priv;
203 	int i;
204 	u8 oldval;
205 	u8 t22k_off = 0x80;
206 
207 	dprintk ("%s\n", __func__);
208 
209 	if (state->config->diseqc_tone)
210 		t22k_off = 0;
211 
212 	if (cmd->msg_len > 6)
213 		return -EINVAL;
214 	oldval = tda10086_read_byte(state, 0x36);
215 
216 	for(i=0; i< cmd->msg_len; i++) {
217 		tda10086_write_byte(state, 0x48+i, cmd->msg[i]);
218 	}
219 	tda10086_write_byte(state, 0x36, (0x08 + t22k_off)
220 					| ((cmd->msg_len - 1) << 4));
221 
222 	tda10086_diseqc_wait(state);
223 
224 	tda10086_write_byte(state, 0x36, oldval);
225 
226 	return 0;
227 }
228 
229 static int tda10086_send_burst(struct dvb_frontend *fe,
230 			       enum fe_sec_mini_cmd minicmd)
231 {
232 	struct tda10086_state* state = fe->demodulator_priv;
233 	u8 oldval = tda10086_read_byte(state, 0x36);
234 	u8 t22k_off = 0x80;
235 
236 	dprintk ("%s\n", __func__);
237 
238 	if (state->config->diseqc_tone)
239 		t22k_off = 0;
240 
241 	switch(minicmd) {
242 	case SEC_MINI_A:
243 		tda10086_write_byte(state, 0x36, 0x04 + t22k_off);
244 		break;
245 
246 	case SEC_MINI_B:
247 		tda10086_write_byte(state, 0x36, 0x06 + t22k_off);
248 		break;
249 	}
250 
251 	tda10086_diseqc_wait(state);
252 
253 	tda10086_write_byte(state, 0x36, oldval);
254 
255 	return 0;
256 }
257 
258 static int tda10086_set_inversion(struct tda10086_state *state,
259 				  struct dtv_frontend_properties *fe_params)
260 {
261 	u8 invval = 0x80;
262 
263 	dprintk ("%s %i %i\n", __func__, fe_params->inversion, state->config->invert);
264 
265 	switch(fe_params->inversion) {
266 	case INVERSION_OFF:
267 		if (state->config->invert)
268 			invval = 0x40;
269 		break;
270 	case INVERSION_ON:
271 		if (!state->config->invert)
272 			invval = 0x40;
273 		break;
274 	case INVERSION_AUTO:
275 		invval = 0x00;
276 		break;
277 	}
278 	tda10086_write_mask(state, 0x0c, 0xc0, invval);
279 
280 	return 0;
281 }
282 
283 static int tda10086_set_symbol_rate(struct tda10086_state *state,
284 				    struct dtv_frontend_properties *fe_params)
285 {
286 	u8 dfn = 0;
287 	u8 afs = 0;
288 	u8 byp = 0;
289 	u8 reg37 = 0x43;
290 	u8 reg42 = 0x43;
291 	u64 big;
292 	u32 tmp;
293 	u32 bdr;
294 	u32 bdri;
295 	u32 symbol_rate = fe_params->symbol_rate;
296 
297 	dprintk ("%s %i\n", __func__, symbol_rate);
298 
299 	/* setup the decimation and anti-aliasing filters.. */
300 	if (symbol_rate < SACLK / 10000 * 137) {
301 		dfn=4;
302 		afs=1;
303 	} else if (symbol_rate < SACLK / 10000 * 208) {
304 		dfn=4;
305 		afs=0;
306 	} else if (symbol_rate < SACLK / 10000 * 270) {
307 		dfn=3;
308 		afs=1;
309 	} else if (symbol_rate < SACLK / 10000 * 416) {
310 		dfn=3;
311 		afs=0;
312 	} else if (symbol_rate < SACLK / 10000 * 550) {
313 		dfn=2;
314 		afs=1;
315 	} else if (symbol_rate < SACLK / 10000 * 833) {
316 		dfn=2;
317 		afs=0;
318 	} else if (symbol_rate < SACLK / 10000 * 1100) {
319 		dfn=1;
320 		afs=1;
321 	} else if (symbol_rate < SACLK / 10000 * 1666) {
322 		dfn=1;
323 		afs=0;
324 	} else if (symbol_rate < SACLK / 10000 * 2200) {
325 		dfn=0;
326 		afs=1;
327 	} else if (symbol_rate < SACLK / 10000 * 3333) {
328 		dfn=0;
329 		afs=0;
330 	} else {
331 		reg37 = 0x63;
332 		reg42 = 0x4f;
333 		byp=1;
334 	}
335 
336 	/* calculate BDR */
337 	big = (1ULL<<21) * ((u64) symbol_rate/1000ULL) * (1ULL<<dfn);
338 	big += ((SACLK/1000ULL)-1ULL);
339 	do_div(big, (SACLK/1000ULL));
340 	bdr = big & 0xfffff;
341 
342 	/* calculate BDRI */
343 	tmp = (1<<dfn)*(symbol_rate/1000);
344 	bdri = ((32 * (SACLK/1000)) + (tmp-1)) / tmp;
345 
346 	tda10086_write_byte(state, 0x21, (afs << 7) | dfn);
347 	tda10086_write_mask(state, 0x20, 0x08, byp << 3);
348 	tda10086_write_byte(state, 0x06, bdr);
349 	tda10086_write_byte(state, 0x07, bdr >> 8);
350 	tda10086_write_byte(state, 0x08, bdr >> 16);
351 	tda10086_write_byte(state, 0x09, bdri);
352 	tda10086_write_byte(state, 0x37, reg37);
353 	tda10086_write_byte(state, 0x42, reg42);
354 
355 	return 0;
356 }
357 
358 static int tda10086_set_fec(struct tda10086_state *state,
359 			    struct dtv_frontend_properties *fe_params)
360 {
361 	u8 fecval;
362 
363 	dprintk("%s %i\n", __func__, fe_params->fec_inner);
364 
365 	switch (fe_params->fec_inner) {
366 	case FEC_1_2:
367 		fecval = 0x00;
368 		break;
369 	case FEC_2_3:
370 		fecval = 0x01;
371 		break;
372 	case FEC_3_4:
373 		fecval = 0x02;
374 		break;
375 	case FEC_4_5:
376 		fecval = 0x03;
377 		break;
378 	case FEC_5_6:
379 		fecval = 0x04;
380 		break;
381 	case FEC_6_7:
382 		fecval = 0x05;
383 		break;
384 	case FEC_7_8:
385 		fecval = 0x06;
386 		break;
387 	case FEC_8_9:
388 		fecval = 0x07;
389 		break;
390 	case FEC_AUTO:
391 		fecval = 0x08;
392 		break;
393 	default:
394 		return -1;
395 	}
396 	tda10086_write_byte(state, 0x0d, fecval);
397 
398 	return 0;
399 }
400 
401 static int tda10086_set_frontend(struct dvb_frontend *fe)
402 {
403 	struct dtv_frontend_properties *fe_params = &fe->dtv_property_cache;
404 	struct tda10086_state *state = fe->demodulator_priv;
405 	int ret;
406 	u32 freq = 0;
407 	int freqoff;
408 
409 	dprintk ("%s\n", __func__);
410 
411 	/* modify parameters for tuning */
412 	tda10086_write_byte(state, 0x02, 0x35);
413 	state->has_lock = false;
414 
415 	/* set params */
416 	if (fe->ops.tuner_ops.set_params) {
417 		fe->ops.tuner_ops.set_params(fe);
418 		if (fe->ops.i2c_gate_ctrl)
419 			fe->ops.i2c_gate_ctrl(fe, 0);
420 
421 		if (fe->ops.tuner_ops.get_frequency)
422 			fe->ops.tuner_ops.get_frequency(fe, &freq);
423 		if (fe->ops.i2c_gate_ctrl)
424 			fe->ops.i2c_gate_ctrl(fe, 0);
425 	}
426 
427 	/* calculate the frequency offset (in *Hz* not kHz) */
428 	freqoff = fe_params->frequency - freq;
429 	freqoff = ((1<<16) * freqoff) / (SACLK/1000);
430 	tda10086_write_byte(state, 0x3d, 0x80 | ((freqoff >> 8) & 0x7f));
431 	tda10086_write_byte(state, 0x3e, freqoff);
432 
433 	if ((ret = tda10086_set_inversion(state, fe_params)) < 0)
434 		return ret;
435 	if ((ret = tda10086_set_symbol_rate(state, fe_params)) < 0)
436 		return ret;
437 	if ((ret = tda10086_set_fec(state, fe_params)) < 0)
438 		return ret;
439 
440 	/* soft reset + disable TS output until lock */
441 	tda10086_write_mask(state, 0x10, 0x40, 0x40);
442 	tda10086_write_mask(state, 0x00, 0x01, 0x00);
443 
444 	state->symbol_rate = fe_params->symbol_rate;
445 	state->frequency = fe_params->frequency;
446 	return 0;
447 }
448 
449 static int tda10086_get_frontend(struct dvb_frontend *fe,
450 				 struct dtv_frontend_properties *fe_params)
451 {
452 	struct tda10086_state* state = fe->demodulator_priv;
453 	u8 val;
454 	int tmp;
455 	u64 tmp64;
456 
457 	dprintk ("%s\n", __func__);
458 
459 	/* check for invalid symbol rate */
460 	if (fe_params->symbol_rate < 500000)
461 		return -EINVAL;
462 
463 	/* calculate the updated frequency (note: we convert from Hz->kHz) */
464 	tmp64 = ((u64)tda10086_read_byte(state, 0x52)
465 		| (tda10086_read_byte(state, 0x51) << 8));
466 	if (tmp64 & 0x8000)
467 		tmp64 |= 0xffffffffffff0000ULL;
468 	tmp64 = (tmp64 * (SACLK/1000ULL));
469 	do_div(tmp64, (1ULL<<15) * (1ULL<<1));
470 	fe_params->frequency = (int) state->frequency + (int) tmp64;
471 
472 	/* the inversion */
473 	val = tda10086_read_byte(state, 0x0c);
474 	if (val & 0x80) {
475 		switch(val & 0x40) {
476 		case 0x00:
477 			fe_params->inversion = INVERSION_OFF;
478 			if (state->config->invert)
479 				fe_params->inversion = INVERSION_ON;
480 			break;
481 		default:
482 			fe_params->inversion = INVERSION_ON;
483 			if (state->config->invert)
484 				fe_params->inversion = INVERSION_OFF;
485 			break;
486 		}
487 	} else {
488 		tda10086_read_byte(state, 0x0f);
489 		switch(val & 0x02) {
490 		case 0x00:
491 			fe_params->inversion = INVERSION_OFF;
492 			if (state->config->invert)
493 				fe_params->inversion = INVERSION_ON;
494 			break;
495 		default:
496 			fe_params->inversion = INVERSION_ON;
497 			if (state->config->invert)
498 				fe_params->inversion = INVERSION_OFF;
499 			break;
500 		}
501 	}
502 
503 	/* calculate the updated symbol rate */
504 	tmp = tda10086_read_byte(state, 0x1d);
505 	if (tmp & 0x80)
506 		tmp |= 0xffffff00;
507 	tmp = (tmp * 480 * (1<<1)) / 128;
508 	tmp = ((state->symbol_rate/1000) * tmp) / (1000000/1000);
509 	fe_params->symbol_rate = state->symbol_rate + tmp;
510 
511 	/* the FEC */
512 	val = (tda10086_read_byte(state, 0x0d) & 0x70) >> 4;
513 	switch(val) {
514 	case 0x00:
515 		fe_params->fec_inner = FEC_1_2;
516 		break;
517 	case 0x01:
518 		fe_params->fec_inner = FEC_2_3;
519 		break;
520 	case 0x02:
521 		fe_params->fec_inner = FEC_3_4;
522 		break;
523 	case 0x03:
524 		fe_params->fec_inner = FEC_4_5;
525 		break;
526 	case 0x04:
527 		fe_params->fec_inner = FEC_5_6;
528 		break;
529 	case 0x05:
530 		fe_params->fec_inner = FEC_6_7;
531 		break;
532 	case 0x06:
533 		fe_params->fec_inner = FEC_7_8;
534 		break;
535 	case 0x07:
536 		fe_params->fec_inner = FEC_8_9;
537 		break;
538 	}
539 
540 	return 0;
541 }
542 
543 static int tda10086_read_status(struct dvb_frontend *fe,
544 				enum fe_status *fe_status)
545 {
546 	struct tda10086_state* state = fe->demodulator_priv;
547 	u8 val;
548 
549 	dprintk ("%s\n", __func__);
550 
551 	val = tda10086_read_byte(state, 0x0e);
552 	*fe_status = 0;
553 	if (val & 0x01)
554 		*fe_status |= FE_HAS_SIGNAL;
555 	if (val & 0x02)
556 		*fe_status |= FE_HAS_CARRIER;
557 	if (val & 0x04)
558 		*fe_status |= FE_HAS_VITERBI;
559 	if (val & 0x08)
560 		*fe_status |= FE_HAS_SYNC;
561 	if (val & 0x10) {
562 		*fe_status |= FE_HAS_LOCK;
563 		if (!state->has_lock) {
564 			state->has_lock = true;
565 			/* modify parameters for stable reception */
566 			tda10086_write_byte(state, 0x02, 0x00);
567 		}
568 	}
569 
570 	return 0;
571 }
572 
573 static int tda10086_read_signal_strength(struct dvb_frontend* fe, u16 * signal)
574 {
575 	struct tda10086_state* state = fe->demodulator_priv;
576 	u8 _str;
577 
578 	dprintk ("%s\n", __func__);
579 
580 	_str = 0xff - tda10086_read_byte(state, 0x43);
581 	*signal = (_str << 8) | _str;
582 
583 	return 0;
584 }
585 
586 static int tda10086_read_snr(struct dvb_frontend* fe, u16 * snr)
587 {
588 	struct tda10086_state* state = fe->demodulator_priv;
589 	u8 _snr;
590 
591 	dprintk ("%s\n", __func__);
592 
593 	_snr = 0xff - tda10086_read_byte(state, 0x1c);
594 	*snr = (_snr << 8) | _snr;
595 
596 	return 0;
597 }
598 
599 static int tda10086_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks)
600 {
601 	struct tda10086_state* state = fe->demodulator_priv;
602 
603 	dprintk ("%s\n", __func__);
604 
605 	/* read it */
606 	*ucblocks = tda10086_read_byte(state, 0x18) & 0x7f;
607 
608 	/* reset counter */
609 	tda10086_write_byte(state, 0x18, 0x00);
610 	tda10086_write_byte(state, 0x18, 0x80);
611 
612 	return 0;
613 }
614 
615 static int tda10086_read_ber(struct dvb_frontend* fe, u32* ber)
616 {
617 	struct tda10086_state* state = fe->demodulator_priv;
618 
619 	dprintk ("%s\n", __func__);
620 
621 	/* read it */
622 	*ber = 0;
623 	*ber |= tda10086_read_byte(state, 0x15);
624 	*ber |= tda10086_read_byte(state, 0x16) << 8;
625 	*ber |= (tda10086_read_byte(state, 0x17) & 0xf) << 16;
626 
627 	return 0;
628 }
629 
630 static int tda10086_sleep(struct dvb_frontend* fe)
631 {
632 	struct tda10086_state* state = fe->demodulator_priv;
633 
634 	dprintk ("%s\n", __func__);
635 
636 	tda10086_write_mask(state, 0x00, 0x08, 0x08);
637 
638 	return 0;
639 }
640 
641 static int tda10086_i2c_gate_ctrl(struct dvb_frontend* fe, int enable)
642 {
643 	struct tda10086_state* state = fe->demodulator_priv;
644 
645 	dprintk ("%s\n", __func__);
646 
647 	if (enable) {
648 		tda10086_write_mask(state, 0x00, 0x10, 0x10);
649 	} else {
650 		tda10086_write_mask(state, 0x00, 0x10, 0x00);
651 	}
652 
653 	return 0;
654 }
655 
656 static int tda10086_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings)
657 {
658 	struct dtv_frontend_properties *p = &fe->dtv_property_cache;
659 
660 	if (p->symbol_rate > 20000000) {
661 		fesettings->min_delay_ms = 50;
662 		fesettings->step_size = 2000;
663 		fesettings->max_drift = 8000;
664 	} else if (p->symbol_rate > 12000000) {
665 		fesettings->min_delay_ms = 100;
666 		fesettings->step_size = 1500;
667 		fesettings->max_drift = 9000;
668 	} else if (p->symbol_rate > 8000000) {
669 		fesettings->min_delay_ms = 100;
670 		fesettings->step_size = 1000;
671 		fesettings->max_drift = 8000;
672 	} else if (p->symbol_rate > 4000000) {
673 		fesettings->min_delay_ms = 100;
674 		fesettings->step_size = 500;
675 		fesettings->max_drift = 7000;
676 	} else if (p->symbol_rate > 2000000) {
677 		fesettings->min_delay_ms = 200;
678 		fesettings->step_size = p->symbol_rate / 8000;
679 		fesettings->max_drift = 14 * fesettings->step_size;
680 	} else {
681 		fesettings->min_delay_ms = 200;
682 		fesettings->step_size =  p->symbol_rate / 8000;
683 		fesettings->max_drift = 18 * fesettings->step_size;
684 	}
685 
686 	return 0;
687 }
688 
689 static void tda10086_release(struct dvb_frontend* fe)
690 {
691 	struct tda10086_state *state = fe->demodulator_priv;
692 	tda10086_sleep(fe);
693 	kfree(state);
694 }
695 
696 static const struct dvb_frontend_ops tda10086_ops = {
697 	.delsys = { SYS_DVBS },
698 	.info = {
699 		.name     = "Philips TDA10086 DVB-S",
700 		.frequency_min_hz      =  950 * MHz,
701 		.frequency_max_hz      = 2150 * MHz,
702 		.frequency_stepsize_hz =  125 * kHz,
703 		.symbol_rate_min  = 1000000,
704 		.symbol_rate_max  = 45000000,
705 		.caps = FE_CAN_INVERSION_AUTO |
706 			FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
707 			FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
708 			FE_CAN_QPSK
709 	},
710 
711 	.release = tda10086_release,
712 
713 	.init = tda10086_init,
714 	.sleep = tda10086_sleep,
715 	.i2c_gate_ctrl = tda10086_i2c_gate_ctrl,
716 
717 	.set_frontend = tda10086_set_frontend,
718 	.get_frontend = tda10086_get_frontend,
719 	.get_tune_settings = tda10086_get_tune_settings,
720 
721 	.read_status = tda10086_read_status,
722 	.read_ber = tda10086_read_ber,
723 	.read_signal_strength = tda10086_read_signal_strength,
724 	.read_snr = tda10086_read_snr,
725 	.read_ucblocks = tda10086_read_ucblocks,
726 
727 	.diseqc_send_master_cmd = tda10086_send_master_cmd,
728 	.diseqc_send_burst = tda10086_send_burst,
729 	.set_tone = tda10086_set_tone,
730 };
731 
732 struct dvb_frontend* tda10086_attach(const struct tda10086_config* config,
733 				     struct i2c_adapter* i2c)
734 {
735 	struct tda10086_state *state;
736 
737 	dprintk ("%s\n", __func__);
738 
739 	/* allocate memory for the internal state */
740 	state = kzalloc(sizeof(struct tda10086_state), GFP_KERNEL);
741 	if (!state)
742 		return NULL;
743 
744 	/* setup the state */
745 	state->config = config;
746 	state->i2c = i2c;
747 
748 	/* check if the demod is there */
749 	if (tda10086_read_byte(state, 0x1e) != 0xe1) {
750 		kfree(state);
751 		return NULL;
752 	}
753 
754 	/* create dvb_frontend */
755 	memcpy(&state->frontend.ops, &tda10086_ops, sizeof(struct dvb_frontend_ops));
756 	state->frontend.demodulator_priv = state;
757 	return &state->frontend;
758 }
759 
760 module_param(debug, int, 0644);
761 MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
762 
763 MODULE_DESCRIPTION("Philips TDA10086 DVB-S Demodulator");
764 MODULE_AUTHOR("Andrew de Quincey");
765 MODULE_LICENSE("GPL");
766 
767 EXPORT_SYMBOL_GPL(tda10086_attach);
768