1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3  * NXP TDA10071 + Conexant CX24118A DVB-S/S2 demodulator + tuner driver
4  *
5  * Copyright (C) 2011 Antti Palosaari <crope@iki.fi>
6  */
7 
8 #include "tda10071_priv.h"
9 
10 static const struct dvb_frontend_ops tda10071_ops;
11 
12 /*
13  * XXX: regmap_update_bits() does not fit our needs as it does not support
14  * partially volatile registers. Also it performs register read even mask is as
15  * wide as register value.
16  */
17 /* write single register with mask */
18 static int tda10071_wr_reg_mask(struct tda10071_dev *dev,
19 				u8 reg, u8 val, u8 mask)
20 {
21 	int ret;
22 	u8 tmp;
23 
24 	/* no need for read if whole reg is written */
25 	if (mask != 0xff) {
26 		ret = regmap_bulk_read(dev->regmap, reg, &tmp, 1);
27 		if (ret)
28 			return ret;
29 
30 		val &= mask;
31 		tmp &= ~mask;
32 		val |= tmp;
33 	}
34 
35 	return regmap_bulk_write(dev->regmap, reg, &val, 1);
36 }
37 
38 /* execute firmware command */
39 static int tda10071_cmd_execute(struct tda10071_dev *dev,
40 	struct tda10071_cmd *cmd)
41 {
42 	struct i2c_client *client = dev->client;
43 	int ret, i;
44 	unsigned int uitmp;
45 
46 	if (!dev->warm) {
47 		ret = -EFAULT;
48 		goto error;
49 	}
50 
51 	mutex_lock(&dev->cmd_execute_mutex);
52 
53 	/* write cmd and args for firmware */
54 	ret = regmap_bulk_write(dev->regmap, 0x00, cmd->args, cmd->len);
55 	if (ret)
56 		goto error_mutex_unlock;
57 
58 	/* start cmd execution */
59 	ret = regmap_write(dev->regmap, 0x1f, 1);
60 	if (ret)
61 		goto error_mutex_unlock;
62 
63 	/* wait cmd execution terminate */
64 	for (i = 1000, uitmp = 1; i && uitmp; i--) {
65 		ret = regmap_read(dev->regmap, 0x1f, &uitmp);
66 		if (ret)
67 			goto error_mutex_unlock;
68 
69 		usleep_range(200, 5000);
70 	}
71 
72 	mutex_unlock(&dev->cmd_execute_mutex);
73 	dev_dbg(&client->dev, "loop=%d\n", i);
74 
75 	if (i == 0) {
76 		ret = -ETIMEDOUT;
77 		goto error;
78 	}
79 
80 	return ret;
81 error_mutex_unlock:
82 	mutex_unlock(&dev->cmd_execute_mutex);
83 error:
84 	dev_dbg(&client->dev, "failed=%d\n", ret);
85 	return ret;
86 }
87 
88 static int tda10071_set_tone(struct dvb_frontend *fe,
89 	enum fe_sec_tone_mode fe_sec_tone_mode)
90 {
91 	struct tda10071_dev *dev = fe->demodulator_priv;
92 	struct i2c_client *client = dev->client;
93 	struct tda10071_cmd cmd;
94 	int ret;
95 	u8 tone;
96 
97 	if (!dev->warm) {
98 		ret = -EFAULT;
99 		goto error;
100 	}
101 
102 	dev_dbg(&client->dev, "tone_mode=%d\n", fe_sec_tone_mode);
103 
104 	switch (fe_sec_tone_mode) {
105 	case SEC_TONE_ON:
106 		tone = 1;
107 		break;
108 	case SEC_TONE_OFF:
109 		tone = 0;
110 		break;
111 	default:
112 		dev_dbg(&client->dev, "invalid fe_sec_tone_mode\n");
113 		ret = -EINVAL;
114 		goto error;
115 	}
116 
117 	cmd.args[0] = CMD_LNB_PCB_CONFIG;
118 	cmd.args[1] = 0;
119 	cmd.args[2] = 0x00;
120 	cmd.args[3] = 0x00;
121 	cmd.args[4] = tone;
122 	cmd.len = 5;
123 	ret = tda10071_cmd_execute(dev, &cmd);
124 	if (ret)
125 		goto error;
126 
127 	return ret;
128 error:
129 	dev_dbg(&client->dev, "failed=%d\n", ret);
130 	return ret;
131 }
132 
133 static int tda10071_set_voltage(struct dvb_frontend *fe,
134 	enum fe_sec_voltage fe_sec_voltage)
135 {
136 	struct tda10071_dev *dev = fe->demodulator_priv;
137 	struct i2c_client *client = dev->client;
138 	struct tda10071_cmd cmd;
139 	int ret;
140 	u8 voltage;
141 
142 	if (!dev->warm) {
143 		ret = -EFAULT;
144 		goto error;
145 	}
146 
147 	dev_dbg(&client->dev, "voltage=%d\n", fe_sec_voltage);
148 
149 	switch (fe_sec_voltage) {
150 	case SEC_VOLTAGE_13:
151 		voltage = 0;
152 		break;
153 	case SEC_VOLTAGE_18:
154 		voltage = 1;
155 		break;
156 	case SEC_VOLTAGE_OFF:
157 		voltage = 0;
158 		break;
159 	default:
160 		dev_dbg(&client->dev, "invalid fe_sec_voltage\n");
161 		ret = -EINVAL;
162 		goto error;
163 	}
164 
165 	cmd.args[0] = CMD_LNB_SET_DC_LEVEL;
166 	cmd.args[1] = 0;
167 	cmd.args[2] = voltage;
168 	cmd.len = 3;
169 	ret = tda10071_cmd_execute(dev, &cmd);
170 	if (ret)
171 		goto error;
172 
173 	return ret;
174 error:
175 	dev_dbg(&client->dev, "failed=%d\n", ret);
176 	return ret;
177 }
178 
179 static int tda10071_diseqc_send_master_cmd(struct dvb_frontend *fe,
180 	struct dvb_diseqc_master_cmd *diseqc_cmd)
181 {
182 	struct tda10071_dev *dev = fe->demodulator_priv;
183 	struct i2c_client *client = dev->client;
184 	struct tda10071_cmd cmd;
185 	int ret, i;
186 	unsigned int uitmp;
187 
188 	if (!dev->warm) {
189 		ret = -EFAULT;
190 		goto error;
191 	}
192 
193 	dev_dbg(&client->dev, "msg_len=%d\n", diseqc_cmd->msg_len);
194 
195 	if (diseqc_cmd->msg_len < 3 || diseqc_cmd->msg_len > 6) {
196 		ret = -EINVAL;
197 		goto error;
198 	}
199 
200 	/* wait LNB TX */
201 	for (i = 500, uitmp = 0; i && !uitmp; i--) {
202 		ret = regmap_read(dev->regmap, 0x47, &uitmp);
203 		if (ret)
204 			goto error;
205 		uitmp = (uitmp >> 0) & 1;
206 		usleep_range(10000, 20000);
207 	}
208 
209 	dev_dbg(&client->dev, "loop=%d\n", i);
210 
211 	if (i == 0) {
212 		ret = -ETIMEDOUT;
213 		goto error;
214 	}
215 
216 	ret = regmap_update_bits(dev->regmap, 0x47, 0x01, 0x00);
217 	if (ret)
218 		goto error;
219 
220 	cmd.args[0] = CMD_LNB_SEND_DISEQC;
221 	cmd.args[1] = 0;
222 	cmd.args[2] = 0;
223 	cmd.args[3] = 0;
224 	cmd.args[4] = 2;
225 	cmd.args[5] = 0;
226 	cmd.args[6] = diseqc_cmd->msg_len;
227 	memcpy(&cmd.args[7], diseqc_cmd->msg, diseqc_cmd->msg_len);
228 	cmd.len = 7 + diseqc_cmd->msg_len;
229 	ret = tda10071_cmd_execute(dev, &cmd);
230 	if (ret)
231 		goto error;
232 
233 	return ret;
234 error:
235 	dev_dbg(&client->dev, "failed=%d\n", ret);
236 	return ret;
237 }
238 
239 static int tda10071_diseqc_recv_slave_reply(struct dvb_frontend *fe,
240 	struct dvb_diseqc_slave_reply *reply)
241 {
242 	struct tda10071_dev *dev = fe->demodulator_priv;
243 	struct i2c_client *client = dev->client;
244 	struct tda10071_cmd cmd;
245 	int ret, i;
246 	unsigned int uitmp;
247 
248 	if (!dev->warm) {
249 		ret = -EFAULT;
250 		goto error;
251 	}
252 
253 	dev_dbg(&client->dev, "\n");
254 
255 	/* wait LNB RX */
256 	for (i = 500, uitmp = 0; i && !uitmp; i--) {
257 		ret = regmap_read(dev->regmap, 0x47, &uitmp);
258 		if (ret)
259 			goto error;
260 		uitmp = (uitmp >> 1) & 1;
261 		usleep_range(10000, 20000);
262 	}
263 
264 	dev_dbg(&client->dev, "loop=%d\n", i);
265 
266 	if (i == 0) {
267 		ret = -ETIMEDOUT;
268 		goto error;
269 	}
270 
271 	/* reply len */
272 	ret = regmap_read(dev->regmap, 0x46, &uitmp);
273 	if (ret)
274 		goto error;
275 
276 	reply->msg_len = uitmp & 0x1f; /* [4:0] */
277 	if (reply->msg_len > sizeof(reply->msg))
278 		reply->msg_len = sizeof(reply->msg); /* truncate API max */
279 
280 	/* read reply */
281 	cmd.args[0] = CMD_LNB_UPDATE_REPLY;
282 	cmd.args[1] = 0;
283 	cmd.len = 2;
284 	ret = tda10071_cmd_execute(dev, &cmd);
285 	if (ret)
286 		goto error;
287 
288 	ret = regmap_bulk_read(dev->regmap, cmd.len, reply->msg,
289 			       reply->msg_len);
290 	if (ret)
291 		goto error;
292 
293 	return ret;
294 error:
295 	dev_dbg(&client->dev, "failed=%d\n", ret);
296 	return ret;
297 }
298 
299 static int tda10071_diseqc_send_burst(struct dvb_frontend *fe,
300 	enum fe_sec_mini_cmd fe_sec_mini_cmd)
301 {
302 	struct tda10071_dev *dev = fe->demodulator_priv;
303 	struct i2c_client *client = dev->client;
304 	struct tda10071_cmd cmd;
305 	int ret, i;
306 	unsigned int uitmp;
307 	u8 burst;
308 
309 	if (!dev->warm) {
310 		ret = -EFAULT;
311 		goto error;
312 	}
313 
314 	dev_dbg(&client->dev, "fe_sec_mini_cmd=%d\n", fe_sec_mini_cmd);
315 
316 	switch (fe_sec_mini_cmd) {
317 	case SEC_MINI_A:
318 		burst = 0;
319 		break;
320 	case SEC_MINI_B:
321 		burst = 1;
322 		break;
323 	default:
324 		dev_dbg(&client->dev, "invalid fe_sec_mini_cmd\n");
325 		ret = -EINVAL;
326 		goto error;
327 	}
328 
329 	/* wait LNB TX */
330 	for (i = 500, uitmp = 0; i && !uitmp; i--) {
331 		ret = regmap_read(dev->regmap, 0x47, &uitmp);
332 		if (ret)
333 			goto error;
334 		uitmp = (uitmp >> 0) & 1;
335 		usleep_range(10000, 20000);
336 	}
337 
338 	dev_dbg(&client->dev, "loop=%d\n", i);
339 
340 	if (i == 0) {
341 		ret = -ETIMEDOUT;
342 		goto error;
343 	}
344 
345 	ret = regmap_update_bits(dev->regmap, 0x47, 0x01, 0x00);
346 	if (ret)
347 		goto error;
348 
349 	cmd.args[0] = CMD_LNB_SEND_TONEBURST;
350 	cmd.args[1] = 0;
351 	cmd.args[2] = burst;
352 	cmd.len = 3;
353 	ret = tda10071_cmd_execute(dev, &cmd);
354 	if (ret)
355 		goto error;
356 
357 	return ret;
358 error:
359 	dev_dbg(&client->dev, "failed=%d\n", ret);
360 	return ret;
361 }
362 
363 static int tda10071_read_status(struct dvb_frontend *fe, enum fe_status *status)
364 {
365 	struct tda10071_dev *dev = fe->demodulator_priv;
366 	struct i2c_client *client = dev->client;
367 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
368 	struct tda10071_cmd cmd;
369 	int ret;
370 	unsigned int uitmp;
371 	u8 buf[8];
372 
373 	*status = 0;
374 
375 	if (!dev->warm) {
376 		ret = 0;
377 		goto error;
378 	}
379 
380 	ret = regmap_read(dev->regmap, 0x39, &uitmp);
381 	if (ret)
382 		goto error;
383 
384 	/* 0x39[0] tuner PLL */
385 	if (uitmp & 0x02) /* demod PLL */
386 		*status |= FE_HAS_SIGNAL | FE_HAS_CARRIER;
387 	if (uitmp & 0x04) /* viterbi or LDPC*/
388 		*status |= FE_HAS_VITERBI;
389 	if (uitmp & 0x08) /* RS or BCH */
390 		*status |= FE_HAS_SYNC | FE_HAS_LOCK;
391 
392 	dev->fe_status = *status;
393 
394 	/* signal strength */
395 	if (dev->fe_status & FE_HAS_SIGNAL) {
396 		cmd.args[0] = CMD_GET_AGCACC;
397 		cmd.args[1] = 0;
398 		cmd.len = 2;
399 		ret = tda10071_cmd_execute(dev, &cmd);
400 		if (ret)
401 			goto error;
402 
403 		/* input power estimate dBm */
404 		ret = regmap_read(dev->regmap, 0x50, &uitmp);
405 		if (ret)
406 			goto error;
407 
408 		c->strength.stat[0].scale = FE_SCALE_DECIBEL;
409 		c->strength.stat[0].svalue = (int) (uitmp - 256) * 1000;
410 	} else {
411 		c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
412 	}
413 
414 	/* CNR */
415 	if (dev->fe_status & FE_HAS_VITERBI) {
416 		/* Es/No */
417 		ret = regmap_bulk_read(dev->regmap, 0x3a, buf, 2);
418 		if (ret)
419 			goto error;
420 
421 		c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
422 		c->cnr.stat[0].svalue = (buf[0] << 8 | buf[1] << 0) * 100;
423 	} else {
424 		c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
425 	}
426 
427 	/* UCB/PER/BER */
428 	if (dev->fe_status & FE_HAS_LOCK) {
429 		/* TODO: report total bits/packets */
430 		u8 delivery_system, reg, len;
431 
432 		switch (dev->delivery_system) {
433 		case SYS_DVBS:
434 			reg = 0x4c;
435 			len = 8;
436 			delivery_system = 1;
437 			break;
438 		case SYS_DVBS2:
439 			reg = 0x4d;
440 			len = 4;
441 			delivery_system = 0;
442 			break;
443 		default:
444 			ret = -EINVAL;
445 			goto error;
446 		}
447 
448 		ret = regmap_read(dev->regmap, reg, &uitmp);
449 		if (ret)
450 			goto error;
451 
452 		if (dev->meas_count == uitmp) {
453 			dev_dbg(&client->dev, "meas not ready=%02x\n", uitmp);
454 			ret = 0;
455 			goto error;
456 		} else {
457 			dev->meas_count = uitmp;
458 		}
459 
460 		cmd.args[0] = CMD_BER_UPDATE_COUNTERS;
461 		cmd.args[1] = 0;
462 		cmd.args[2] = delivery_system;
463 		cmd.len = 3;
464 		ret = tda10071_cmd_execute(dev, &cmd);
465 		if (ret)
466 			goto error;
467 
468 		ret = regmap_bulk_read(dev->regmap, cmd.len, buf, len);
469 		if (ret)
470 			goto error;
471 
472 		if (dev->delivery_system == SYS_DVBS) {
473 			u32 bit_error = buf[0] << 24 | buf[1] << 16 |
474 					buf[2] << 8 | buf[3] << 0;
475 
476 			dev->dvbv3_ber = bit_error;
477 			dev->post_bit_error += bit_error;
478 			c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
479 			c->post_bit_error.stat[0].uvalue = dev->post_bit_error;
480 			dev->block_error += buf[4] << 8 | buf[5] << 0;
481 			c->block_error.stat[0].scale = FE_SCALE_COUNTER;
482 			c->block_error.stat[0].uvalue = dev->block_error;
483 		} else {
484 			dev->dvbv3_ber = buf[0] << 8 | buf[1] << 0;
485 			dev->post_bit_error += buf[0] << 8 | buf[1] << 0;
486 			c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
487 			c->post_bit_error.stat[0].uvalue = dev->post_bit_error;
488 			c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
489 		}
490 	} else {
491 		c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
492 		c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
493 	}
494 
495 	return ret;
496 error:
497 	dev_dbg(&client->dev, "failed=%d\n", ret);
498 	return ret;
499 }
500 
501 static int tda10071_read_snr(struct dvb_frontend *fe, u16 *snr)
502 {
503 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
504 
505 	if (c->cnr.stat[0].scale == FE_SCALE_DECIBEL)
506 		*snr = div_s64(c->cnr.stat[0].svalue, 100);
507 	else
508 		*snr = 0;
509 	return 0;
510 }
511 
512 static int tda10071_read_signal_strength(struct dvb_frontend *fe, u16 *strength)
513 {
514 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
515 	unsigned int uitmp;
516 
517 	if (c->strength.stat[0].scale == FE_SCALE_DECIBEL) {
518 		uitmp = div_s64(c->strength.stat[0].svalue, 1000) + 256;
519 		uitmp = clamp(uitmp, 181U, 236U); /* -75dBm - -20dBm */
520 		/* scale value to 0x0000-0xffff */
521 		*strength = (uitmp-181) * 0xffff / (236-181);
522 	} else {
523 		*strength = 0;
524 	}
525 	return 0;
526 }
527 
528 static int tda10071_read_ber(struct dvb_frontend *fe, u32 *ber)
529 {
530 	struct tda10071_dev *dev = fe->demodulator_priv;
531 
532 	*ber = dev->dvbv3_ber;
533 	return 0;
534 }
535 
536 static int tda10071_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
537 {
538 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
539 
540 	if (c->block_error.stat[0].scale == FE_SCALE_COUNTER)
541 		*ucblocks = c->block_error.stat[0].uvalue;
542 	else
543 		*ucblocks = 0;
544 	return 0;
545 }
546 
547 static int tda10071_set_frontend(struct dvb_frontend *fe)
548 {
549 	struct tda10071_dev *dev = fe->demodulator_priv;
550 	struct i2c_client *client = dev->client;
551 	struct tda10071_cmd cmd;
552 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
553 	int ret, i;
554 	u8 mode, rolloff, pilot, inversion, div;
555 	enum fe_modulation modulation;
556 
557 	dev_dbg(&client->dev,
558 		"delivery_system=%d modulation=%d frequency=%u symbol_rate=%d inversion=%d pilot=%d rolloff=%d\n",
559 		c->delivery_system, c->modulation, c->frequency, c->symbol_rate,
560 		c->inversion, c->pilot, c->rolloff);
561 
562 	dev->delivery_system = SYS_UNDEFINED;
563 
564 	if (!dev->warm) {
565 		ret = -EFAULT;
566 		goto error;
567 	}
568 
569 	switch (c->inversion) {
570 	case INVERSION_OFF:
571 		inversion = 1;
572 		break;
573 	case INVERSION_ON:
574 		inversion = 0;
575 		break;
576 	case INVERSION_AUTO:
577 		/* 2 = auto; try first on then off
578 		 * 3 = auto; try first off then on */
579 		inversion = 3;
580 		break;
581 	default:
582 		dev_dbg(&client->dev, "invalid inversion\n");
583 		ret = -EINVAL;
584 		goto error;
585 	}
586 
587 	switch (c->delivery_system) {
588 	case SYS_DVBS:
589 		modulation = QPSK;
590 		rolloff = 0;
591 		pilot = 2;
592 		break;
593 	case SYS_DVBS2:
594 		modulation = c->modulation;
595 
596 		switch (c->rolloff) {
597 		case ROLLOFF_20:
598 			rolloff = 2;
599 			break;
600 		case ROLLOFF_25:
601 			rolloff = 1;
602 			break;
603 		case ROLLOFF_35:
604 			rolloff = 0;
605 			break;
606 		case ROLLOFF_AUTO:
607 		default:
608 			dev_dbg(&client->dev, "invalid rolloff\n");
609 			ret = -EINVAL;
610 			goto error;
611 		}
612 
613 		switch (c->pilot) {
614 		case PILOT_OFF:
615 			pilot = 0;
616 			break;
617 		case PILOT_ON:
618 			pilot = 1;
619 			break;
620 		case PILOT_AUTO:
621 			pilot = 2;
622 			break;
623 		default:
624 			dev_dbg(&client->dev, "invalid pilot\n");
625 			ret = -EINVAL;
626 			goto error;
627 		}
628 		break;
629 	default:
630 		dev_dbg(&client->dev, "invalid delivery_system\n");
631 		ret = -EINVAL;
632 		goto error;
633 	}
634 
635 	for (i = 0, mode = 0xff; i < ARRAY_SIZE(TDA10071_MODCOD); i++) {
636 		if (c->delivery_system == TDA10071_MODCOD[i].delivery_system &&
637 			modulation == TDA10071_MODCOD[i].modulation &&
638 			c->fec_inner == TDA10071_MODCOD[i].fec) {
639 			mode = TDA10071_MODCOD[i].val;
640 			dev_dbg(&client->dev, "mode found=%02x\n", mode);
641 			break;
642 		}
643 	}
644 
645 	if (mode == 0xff) {
646 		dev_dbg(&client->dev, "invalid parameter combination\n");
647 		ret = -EINVAL;
648 		goto error;
649 	}
650 
651 	if (c->symbol_rate <= 5000000)
652 		div = 14;
653 	else
654 		div = 4;
655 
656 	ret = regmap_write(dev->regmap, 0x81, div);
657 	if (ret)
658 		goto error;
659 
660 	ret = regmap_write(dev->regmap, 0xe3, div);
661 	if (ret)
662 		goto error;
663 
664 	cmd.args[0] = CMD_CHANGE_CHANNEL;
665 	cmd.args[1] = 0;
666 	cmd.args[2] = mode;
667 	cmd.args[3] = (c->frequency >> 16) & 0xff;
668 	cmd.args[4] = (c->frequency >>  8) & 0xff;
669 	cmd.args[5] = (c->frequency >>  0) & 0xff;
670 	cmd.args[6] = ((c->symbol_rate / 1000) >> 8) & 0xff;
671 	cmd.args[7] = ((c->symbol_rate / 1000) >> 0) & 0xff;
672 	cmd.args[8] = ((tda10071_ops.info.frequency_tolerance_hz / 1000) >> 8) & 0xff;
673 	cmd.args[9] = ((tda10071_ops.info.frequency_tolerance_hz / 1000) >> 0) & 0xff;
674 	cmd.args[10] = rolloff;
675 	cmd.args[11] = inversion;
676 	cmd.args[12] = pilot;
677 	cmd.args[13] = 0x00;
678 	cmd.args[14] = 0x00;
679 	cmd.len = 15;
680 	ret = tda10071_cmd_execute(dev, &cmd);
681 	if (ret)
682 		goto error;
683 
684 	dev->delivery_system = c->delivery_system;
685 
686 	return ret;
687 error:
688 	dev_dbg(&client->dev, "failed=%d\n", ret);
689 	return ret;
690 }
691 
692 static int tda10071_get_frontend(struct dvb_frontend *fe,
693 				 struct dtv_frontend_properties *c)
694 {
695 	struct tda10071_dev *dev = fe->demodulator_priv;
696 	struct i2c_client *client = dev->client;
697 	int ret, i;
698 	u8 buf[5], tmp;
699 
700 	if (!dev->warm || !(dev->fe_status & FE_HAS_LOCK)) {
701 		ret = 0;
702 		goto error;
703 	}
704 
705 	ret = regmap_bulk_read(dev->regmap, 0x30, buf, 5);
706 	if (ret)
707 		goto error;
708 
709 	tmp = buf[0] & 0x3f;
710 	for (i = 0; i < ARRAY_SIZE(TDA10071_MODCOD); i++) {
711 		if (tmp == TDA10071_MODCOD[i].val) {
712 			c->modulation = TDA10071_MODCOD[i].modulation;
713 			c->fec_inner = TDA10071_MODCOD[i].fec;
714 			c->delivery_system = TDA10071_MODCOD[i].delivery_system;
715 		}
716 	}
717 
718 	switch ((buf[1] >> 0) & 0x01) {
719 	case 0:
720 		c->inversion = INVERSION_ON;
721 		break;
722 	case 1:
723 		c->inversion = INVERSION_OFF;
724 		break;
725 	}
726 
727 	switch ((buf[1] >> 7) & 0x01) {
728 	case 0:
729 		c->pilot = PILOT_OFF;
730 		break;
731 	case 1:
732 		c->pilot = PILOT_ON;
733 		break;
734 	}
735 
736 	c->frequency = (buf[2] << 16) | (buf[3] << 8) | (buf[4] << 0);
737 
738 	ret = regmap_bulk_read(dev->regmap, 0x52, buf, 3);
739 	if (ret)
740 		goto error;
741 
742 	c->symbol_rate = ((buf[0] << 16) | (buf[1] << 8) | (buf[2] << 0)) * 1000;
743 
744 	return ret;
745 error:
746 	dev_dbg(&client->dev, "failed=%d\n", ret);
747 	return ret;
748 }
749 
750 static int tda10071_init(struct dvb_frontend *fe)
751 {
752 	struct tda10071_dev *dev = fe->demodulator_priv;
753 	struct i2c_client *client = dev->client;
754 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
755 	struct tda10071_cmd cmd;
756 	int ret, i, len, remaining, fw_size;
757 	unsigned int uitmp;
758 	const struct firmware *fw;
759 	u8 *fw_file = TDA10071_FIRMWARE;
760 	u8 tmp, buf[4];
761 	struct tda10071_reg_val_mask tab[] = {
762 		{ 0xcd, 0x00, 0x07 },
763 		{ 0x80, 0x00, 0x02 },
764 		{ 0xcd, 0x00, 0xc0 },
765 		{ 0xce, 0x00, 0x1b },
766 		{ 0x9d, 0x00, 0x01 },
767 		{ 0x9d, 0x00, 0x02 },
768 		{ 0x9e, 0x00, 0x01 },
769 		{ 0x87, 0x00, 0x80 },
770 		{ 0xce, 0x00, 0x08 },
771 		{ 0xce, 0x00, 0x10 },
772 	};
773 	struct tda10071_reg_val_mask tab2[] = {
774 		{ 0xf1, 0x70, 0xff },
775 		{ 0x88, dev->pll_multiplier, 0x3f },
776 		{ 0x89, 0x00, 0x10 },
777 		{ 0x89, 0x10, 0x10 },
778 		{ 0xc0, 0x01, 0x01 },
779 		{ 0xc0, 0x00, 0x01 },
780 		{ 0xe0, 0xff, 0xff },
781 		{ 0xe0, 0x00, 0xff },
782 		{ 0x96, 0x1e, 0x7e },
783 		{ 0x8b, 0x08, 0x08 },
784 		{ 0x8b, 0x00, 0x08 },
785 		{ 0x8f, 0x1a, 0x7e },
786 		{ 0x8c, 0x68, 0xff },
787 		{ 0x8d, 0x08, 0xff },
788 		{ 0x8e, 0x4c, 0xff },
789 		{ 0x8f, 0x01, 0x01 },
790 		{ 0x8b, 0x04, 0x04 },
791 		{ 0x8b, 0x00, 0x04 },
792 		{ 0x87, 0x05, 0x07 },
793 		{ 0x80, 0x00, 0x20 },
794 		{ 0xc8, 0x01, 0xff },
795 		{ 0xb4, 0x47, 0xff },
796 		{ 0xb5, 0x9c, 0xff },
797 		{ 0xb6, 0x7d, 0xff },
798 		{ 0xba, 0x00, 0x03 },
799 		{ 0xb7, 0x47, 0xff },
800 		{ 0xb8, 0x9c, 0xff },
801 		{ 0xb9, 0x7d, 0xff },
802 		{ 0xba, 0x00, 0x0c },
803 		{ 0xc8, 0x00, 0xff },
804 		{ 0xcd, 0x00, 0x04 },
805 		{ 0xcd, 0x00, 0x20 },
806 		{ 0xe8, 0x02, 0xff },
807 		{ 0xcf, 0x20, 0xff },
808 		{ 0x9b, 0xd7, 0xff },
809 		{ 0x9a, 0x01, 0x03 },
810 		{ 0xa8, 0x05, 0x0f },
811 		{ 0xa8, 0x65, 0xf0 },
812 		{ 0xa6, 0xa0, 0xf0 },
813 		{ 0x9d, 0x50, 0xfc },
814 		{ 0x9e, 0x20, 0xe0 },
815 		{ 0xa3, 0x1c, 0x7c },
816 		{ 0xd5, 0x03, 0x03 },
817 	};
818 
819 	if (dev->warm) {
820 		/* warm state - wake up device from sleep */
821 
822 		for (i = 0; i < ARRAY_SIZE(tab); i++) {
823 			ret = tda10071_wr_reg_mask(dev, tab[i].reg,
824 				tab[i].val, tab[i].mask);
825 			if (ret)
826 				goto error;
827 		}
828 
829 		cmd.args[0] = CMD_SET_SLEEP_MODE;
830 		cmd.args[1] = 0;
831 		cmd.args[2] = 0;
832 		cmd.len = 3;
833 		ret = tda10071_cmd_execute(dev, &cmd);
834 		if (ret)
835 			goto error;
836 	} else {
837 		/* cold state - try to download firmware */
838 
839 		/* request the firmware, this will block and timeout */
840 		ret = request_firmware(&fw, fw_file, &client->dev);
841 		if (ret) {
842 			dev_err(&client->dev,
843 				"did not find the firmware file '%s' (status %d). You can use <kernel_dir>/scripts/get_dvb_firmware to get the firmware\n",
844 				fw_file, ret);
845 			goto error;
846 		}
847 
848 		/* init */
849 		for (i = 0; i < ARRAY_SIZE(tab2); i++) {
850 			ret = tda10071_wr_reg_mask(dev, tab2[i].reg,
851 				tab2[i].val, tab2[i].mask);
852 			if (ret)
853 				goto error_release_firmware;
854 		}
855 
856 		/*  download firmware */
857 		ret = regmap_write(dev->regmap, 0xe0, 0x7f);
858 		if (ret)
859 			goto error_release_firmware;
860 
861 		ret = regmap_write(dev->regmap, 0xf7, 0x81);
862 		if (ret)
863 			goto error_release_firmware;
864 
865 		ret = regmap_write(dev->regmap, 0xf8, 0x00);
866 		if (ret)
867 			goto error_release_firmware;
868 
869 		ret = regmap_write(dev->regmap, 0xf9, 0x00);
870 		if (ret)
871 			goto error_release_firmware;
872 
873 		dev_info(&client->dev,
874 			 "found a '%s' in cold state, will try to load a firmware\n",
875 			 tda10071_ops.info.name);
876 		dev_info(&client->dev, "downloading firmware from file '%s'\n",
877 			 fw_file);
878 
879 		/* do not download last byte */
880 		fw_size = fw->size - 1;
881 
882 		for (remaining = fw_size; remaining > 0;
883 			remaining -= (dev->i2c_wr_max - 1)) {
884 			len = remaining;
885 			if (len > (dev->i2c_wr_max - 1))
886 				len = (dev->i2c_wr_max - 1);
887 
888 			ret = regmap_bulk_write(dev->regmap, 0xfa,
889 				(u8 *) &fw->data[fw_size - remaining], len);
890 			if (ret) {
891 				dev_err(&client->dev,
892 					"firmware download failed=%d\n", ret);
893 				goto error_release_firmware;
894 			}
895 		}
896 		release_firmware(fw);
897 
898 		ret = regmap_write(dev->regmap, 0xf7, 0x0c);
899 		if (ret)
900 			goto error;
901 
902 		ret = regmap_write(dev->regmap, 0xe0, 0x00);
903 		if (ret)
904 			goto error;
905 
906 		/* wait firmware start */
907 		msleep(250);
908 
909 		/* firmware status */
910 		ret = regmap_read(dev->regmap, 0x51, &uitmp);
911 		if (ret)
912 			goto error;
913 
914 		if (uitmp) {
915 			dev_info(&client->dev, "firmware did not run\n");
916 			ret = -EFAULT;
917 			goto error;
918 		} else {
919 			dev->warm = true;
920 		}
921 
922 		cmd.args[0] = CMD_GET_FW_VERSION;
923 		cmd.len = 1;
924 		ret = tda10071_cmd_execute(dev, &cmd);
925 		if (ret)
926 			goto error;
927 
928 		ret = regmap_bulk_read(dev->regmap, cmd.len, buf, 4);
929 		if (ret)
930 			goto error;
931 
932 		dev_info(&client->dev, "firmware version %d.%d.%d.%d\n",
933 			 buf[0], buf[1], buf[2], buf[3]);
934 		dev_info(&client->dev, "found a '%s' in warm state\n",
935 			 tda10071_ops.info.name);
936 
937 		ret = regmap_bulk_read(dev->regmap, 0x81, buf, 2);
938 		if (ret)
939 			goto error;
940 
941 		cmd.args[0] = CMD_DEMOD_INIT;
942 		cmd.args[1] = ((dev->clk / 1000) >> 8) & 0xff;
943 		cmd.args[2] = ((dev->clk / 1000) >> 0) & 0xff;
944 		cmd.args[3] = buf[0];
945 		cmd.args[4] = buf[1];
946 		cmd.args[5] = dev->pll_multiplier;
947 		cmd.args[6] = dev->spec_inv;
948 		cmd.args[7] = 0x00;
949 		cmd.len = 8;
950 		ret = tda10071_cmd_execute(dev, &cmd);
951 		if (ret)
952 			goto error;
953 
954 		if (dev->tuner_i2c_addr)
955 			tmp = dev->tuner_i2c_addr;
956 		else
957 			tmp = 0x14;
958 
959 		cmd.args[0] = CMD_TUNER_INIT;
960 		cmd.args[1] = 0x00;
961 		cmd.args[2] = 0x00;
962 		cmd.args[3] = 0x00;
963 		cmd.args[4] = 0x00;
964 		cmd.args[5] = tmp;
965 		cmd.args[6] = 0x00;
966 		cmd.args[7] = 0x03;
967 		cmd.args[8] = 0x02;
968 		cmd.args[9] = 0x02;
969 		cmd.args[10] = 0x00;
970 		cmd.args[11] = 0x00;
971 		cmd.args[12] = 0x00;
972 		cmd.args[13] = 0x00;
973 		cmd.args[14] = 0x00;
974 		cmd.len = 15;
975 		ret = tda10071_cmd_execute(dev, &cmd);
976 		if (ret)
977 			goto error;
978 
979 		cmd.args[0] = CMD_MPEG_CONFIG;
980 		cmd.args[1] = 0;
981 		cmd.args[2] = dev->ts_mode;
982 		cmd.args[3] = 0x00;
983 		cmd.args[4] = 0x04;
984 		cmd.args[5] = 0x00;
985 		cmd.len = 6;
986 		ret = tda10071_cmd_execute(dev, &cmd);
987 		if (ret)
988 			goto error;
989 
990 		ret = regmap_update_bits(dev->regmap, 0xf0, 0x01, 0x01);
991 		if (ret)
992 			goto error;
993 
994 		cmd.args[0] = CMD_LNB_CONFIG;
995 		cmd.args[1] = 0;
996 		cmd.args[2] = 150;
997 		cmd.args[3] = 3;
998 		cmd.args[4] = 22;
999 		cmd.args[5] = 1;
1000 		cmd.args[6] = 1;
1001 		cmd.args[7] = 30;
1002 		cmd.args[8] = 30;
1003 		cmd.args[9] = 30;
1004 		cmd.args[10] = 30;
1005 		cmd.len = 11;
1006 		ret = tda10071_cmd_execute(dev, &cmd);
1007 		if (ret)
1008 			goto error;
1009 
1010 		cmd.args[0] = CMD_BER_CONTROL;
1011 		cmd.args[1] = 0;
1012 		cmd.args[2] = 14;
1013 		cmd.args[3] = 14;
1014 		cmd.len = 4;
1015 		ret = tda10071_cmd_execute(dev, &cmd);
1016 		if (ret)
1017 			goto error;
1018 	}
1019 
1020 	/* init stats here in order signal app which stats are supported */
1021 	c->strength.len = 1;
1022 	c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1023 	c->cnr.len = 1;
1024 	c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1025 	c->post_bit_error.len = 1;
1026 	c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1027 	c->block_error.len = 1;
1028 	c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1029 
1030 	return ret;
1031 error_release_firmware:
1032 	release_firmware(fw);
1033 error:
1034 	dev_dbg(&client->dev, "failed=%d\n", ret);
1035 	return ret;
1036 }
1037 
1038 static int tda10071_sleep(struct dvb_frontend *fe)
1039 {
1040 	struct tda10071_dev *dev = fe->demodulator_priv;
1041 	struct i2c_client *client = dev->client;
1042 	struct tda10071_cmd cmd;
1043 	int ret, i;
1044 	struct tda10071_reg_val_mask tab[] = {
1045 		{ 0xcd, 0x07, 0x07 },
1046 		{ 0x80, 0x02, 0x02 },
1047 		{ 0xcd, 0xc0, 0xc0 },
1048 		{ 0xce, 0x1b, 0x1b },
1049 		{ 0x9d, 0x01, 0x01 },
1050 		{ 0x9d, 0x02, 0x02 },
1051 		{ 0x9e, 0x01, 0x01 },
1052 		{ 0x87, 0x80, 0x80 },
1053 		{ 0xce, 0x08, 0x08 },
1054 		{ 0xce, 0x10, 0x10 },
1055 	};
1056 
1057 	if (!dev->warm) {
1058 		ret = -EFAULT;
1059 		goto error;
1060 	}
1061 
1062 	cmd.args[0] = CMD_SET_SLEEP_MODE;
1063 	cmd.args[1] = 0;
1064 	cmd.args[2] = 1;
1065 	cmd.len = 3;
1066 	ret = tda10071_cmd_execute(dev, &cmd);
1067 	if (ret)
1068 		goto error;
1069 
1070 	for (i = 0; i < ARRAY_SIZE(tab); i++) {
1071 		ret = tda10071_wr_reg_mask(dev, tab[i].reg, tab[i].val,
1072 			tab[i].mask);
1073 		if (ret)
1074 			goto error;
1075 	}
1076 
1077 	return ret;
1078 error:
1079 	dev_dbg(&client->dev, "failed=%d\n", ret);
1080 	return ret;
1081 }
1082 
1083 static int tda10071_get_tune_settings(struct dvb_frontend *fe,
1084 	struct dvb_frontend_tune_settings *s)
1085 {
1086 	s->min_delay_ms = 8000;
1087 	s->step_size = 0;
1088 	s->max_drift = 0;
1089 
1090 	return 0;
1091 }
1092 
1093 static const struct dvb_frontend_ops tda10071_ops = {
1094 	.delsys = { SYS_DVBS, SYS_DVBS2 },
1095 	.info = {
1096 		.name = "NXP TDA10071",
1097 		.frequency_min_hz    =  950 * MHz,
1098 		.frequency_max_hz    = 2150 * MHz,
1099 		.frequency_tolerance_hz = 5 * MHz,
1100 		.symbol_rate_min = 1000000,
1101 		.symbol_rate_max = 45000000,
1102 		.caps = FE_CAN_INVERSION_AUTO |
1103 			FE_CAN_FEC_1_2 |
1104 			FE_CAN_FEC_2_3 |
1105 			FE_CAN_FEC_3_4 |
1106 			FE_CAN_FEC_4_5 |
1107 			FE_CAN_FEC_5_6 |
1108 			FE_CAN_FEC_6_7 |
1109 			FE_CAN_FEC_7_8 |
1110 			FE_CAN_FEC_8_9 |
1111 			FE_CAN_FEC_AUTO |
1112 			FE_CAN_QPSK |
1113 			FE_CAN_RECOVER |
1114 			FE_CAN_2G_MODULATION
1115 	},
1116 
1117 	.get_tune_settings = tda10071_get_tune_settings,
1118 
1119 	.init = tda10071_init,
1120 	.sleep = tda10071_sleep,
1121 
1122 	.set_frontend = tda10071_set_frontend,
1123 	.get_frontend = tda10071_get_frontend,
1124 
1125 	.read_status = tda10071_read_status,
1126 	.read_snr = tda10071_read_snr,
1127 	.read_signal_strength = tda10071_read_signal_strength,
1128 	.read_ber = tda10071_read_ber,
1129 	.read_ucblocks = tda10071_read_ucblocks,
1130 
1131 	.diseqc_send_master_cmd = tda10071_diseqc_send_master_cmd,
1132 	.diseqc_recv_slave_reply = tda10071_diseqc_recv_slave_reply,
1133 	.diseqc_send_burst = tda10071_diseqc_send_burst,
1134 
1135 	.set_tone = tda10071_set_tone,
1136 	.set_voltage = tda10071_set_voltage,
1137 };
1138 
1139 static struct dvb_frontend *tda10071_get_dvb_frontend(struct i2c_client *client)
1140 {
1141 	struct tda10071_dev *dev = i2c_get_clientdata(client);
1142 
1143 	dev_dbg(&client->dev, "\n");
1144 
1145 	return &dev->fe;
1146 }
1147 
1148 static int tda10071_probe(struct i2c_client *client,
1149 			const struct i2c_device_id *id)
1150 {
1151 	struct tda10071_dev *dev;
1152 	struct tda10071_platform_data *pdata = client->dev.platform_data;
1153 	int ret;
1154 	unsigned int uitmp;
1155 	static const struct regmap_config regmap_config = {
1156 		.reg_bits = 8,
1157 		.val_bits = 8,
1158 	};
1159 
1160 	dev = kzalloc(sizeof(*dev), GFP_KERNEL);
1161 	if (!dev) {
1162 		ret = -ENOMEM;
1163 		goto err;
1164 	}
1165 
1166 	dev->client = client;
1167 	mutex_init(&dev->cmd_execute_mutex);
1168 	dev->clk = pdata->clk;
1169 	dev->i2c_wr_max = pdata->i2c_wr_max;
1170 	dev->ts_mode = pdata->ts_mode;
1171 	dev->spec_inv = pdata->spec_inv;
1172 	dev->pll_multiplier = pdata->pll_multiplier;
1173 	dev->tuner_i2c_addr = pdata->tuner_i2c_addr;
1174 	dev->regmap = devm_regmap_init_i2c(client, &regmap_config);
1175 	if (IS_ERR(dev->regmap)) {
1176 		ret = PTR_ERR(dev->regmap);
1177 		goto err_kfree;
1178 	}
1179 
1180 	/* chip ID */
1181 	ret = regmap_read(dev->regmap, 0xff, &uitmp);
1182 	if (ret)
1183 		goto err_kfree;
1184 	if (uitmp != 0x0f) {
1185 		ret = -ENODEV;
1186 		goto err_kfree;
1187 	}
1188 
1189 	/* chip type */
1190 	ret = regmap_read(dev->regmap, 0xdd, &uitmp);
1191 	if (ret)
1192 		goto err_kfree;
1193 	if (uitmp != 0x00) {
1194 		ret = -ENODEV;
1195 		goto err_kfree;
1196 	}
1197 
1198 	/* chip version */
1199 	ret = regmap_read(dev->regmap, 0xfe, &uitmp);
1200 	if (ret)
1201 		goto err_kfree;
1202 	if (uitmp != 0x01) {
1203 		ret = -ENODEV;
1204 		goto err_kfree;
1205 	}
1206 
1207 	/* create dvb_frontend */
1208 	memcpy(&dev->fe.ops, &tda10071_ops, sizeof(struct dvb_frontend_ops));
1209 	dev->fe.demodulator_priv = dev;
1210 	i2c_set_clientdata(client, dev);
1211 
1212 	/* setup callbacks */
1213 	pdata->get_dvb_frontend = tda10071_get_dvb_frontend;
1214 
1215 	dev_info(&client->dev, "NXP TDA10071 successfully identified\n");
1216 	return 0;
1217 err_kfree:
1218 	kfree(dev);
1219 err:
1220 	dev_dbg(&client->dev, "failed=%d\n", ret);
1221 	return ret;
1222 }
1223 
1224 static void tda10071_remove(struct i2c_client *client)
1225 {
1226 	struct tda10071_dev *dev = i2c_get_clientdata(client);
1227 
1228 	dev_dbg(&client->dev, "\n");
1229 
1230 	kfree(dev);
1231 }
1232 
1233 static const struct i2c_device_id tda10071_id_table[] = {
1234 	{"tda10071_cx24118", 0},
1235 	{}
1236 };
1237 MODULE_DEVICE_TABLE(i2c, tda10071_id_table);
1238 
1239 static struct i2c_driver tda10071_driver = {
1240 	.driver = {
1241 		.name	= "tda10071",
1242 		.suppress_bind_attrs = true,
1243 	},
1244 	.probe		= tda10071_probe,
1245 	.remove		= tda10071_remove,
1246 	.id_table	= tda10071_id_table,
1247 };
1248 
1249 module_i2c_driver(tda10071_driver);
1250 
1251 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1252 MODULE_DESCRIPTION("NXP TDA10071 DVB-S/S2 demodulator driver");
1253 MODULE_LICENSE("GPL");
1254 MODULE_FIRMWARE(TDA10071_FIRMWARE);
1255