xref: /linux/drivers/media/tuners/tda18271-common.c (revision da1d9caf95def6f0320819cf941c9fd1069ba9e1)
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3     tda18271-common.c - driver for the Philips / NXP TDA18271 silicon tuner
4 
5     Copyright (C) 2007, 2008 Michael Krufky <mkrufky@linuxtv.org>
6 
7 */
8 
9 #include "tda18271-priv.h"
10 
11 static int tda18271_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
12 {
13 	struct tda18271_priv *priv = fe->tuner_priv;
14 	enum tda18271_i2c_gate gate;
15 	int ret = 0;
16 
17 	switch (priv->gate) {
18 	case TDA18271_GATE_DIGITAL:
19 	case TDA18271_GATE_ANALOG:
20 		gate = priv->gate;
21 		break;
22 	case TDA18271_GATE_AUTO:
23 	default:
24 		switch (priv->mode) {
25 		case TDA18271_DIGITAL:
26 			gate = TDA18271_GATE_DIGITAL;
27 			break;
28 		case TDA18271_ANALOG:
29 		default:
30 			gate = TDA18271_GATE_ANALOG;
31 			break;
32 		}
33 	}
34 
35 	switch (gate) {
36 	case TDA18271_GATE_ANALOG:
37 		if (fe->ops.analog_ops.i2c_gate_ctrl)
38 			ret = fe->ops.analog_ops.i2c_gate_ctrl(fe, enable);
39 		break;
40 	case TDA18271_GATE_DIGITAL:
41 		if (fe->ops.i2c_gate_ctrl)
42 			ret = fe->ops.i2c_gate_ctrl(fe, enable);
43 		break;
44 	default:
45 		ret = -EINVAL;
46 		break;
47 	}
48 
49 	return ret;
50 };
51 
52 /*---------------------------------------------------------------------*/
53 
54 static void tda18271_dump_regs(struct dvb_frontend *fe, int extended)
55 {
56 	struct tda18271_priv *priv = fe->tuner_priv;
57 	unsigned char *regs = priv->tda18271_regs;
58 
59 	tda_reg("=== TDA18271 REG DUMP ===\n");
60 	tda_reg("ID_BYTE            = 0x%02x\n", 0xff & regs[R_ID]);
61 	tda_reg("THERMO_BYTE        = 0x%02x\n", 0xff & regs[R_TM]);
62 	tda_reg("POWER_LEVEL_BYTE   = 0x%02x\n", 0xff & regs[R_PL]);
63 	tda_reg("EASY_PROG_BYTE_1   = 0x%02x\n", 0xff & regs[R_EP1]);
64 	tda_reg("EASY_PROG_BYTE_2   = 0x%02x\n", 0xff & regs[R_EP2]);
65 	tda_reg("EASY_PROG_BYTE_3   = 0x%02x\n", 0xff & regs[R_EP3]);
66 	tda_reg("EASY_PROG_BYTE_4   = 0x%02x\n", 0xff & regs[R_EP4]);
67 	tda_reg("EASY_PROG_BYTE_5   = 0x%02x\n", 0xff & regs[R_EP5]);
68 	tda_reg("CAL_POST_DIV_BYTE  = 0x%02x\n", 0xff & regs[R_CPD]);
69 	tda_reg("CAL_DIV_BYTE_1     = 0x%02x\n", 0xff & regs[R_CD1]);
70 	tda_reg("CAL_DIV_BYTE_2     = 0x%02x\n", 0xff & regs[R_CD2]);
71 	tda_reg("CAL_DIV_BYTE_3     = 0x%02x\n", 0xff & regs[R_CD3]);
72 	tda_reg("MAIN_POST_DIV_BYTE = 0x%02x\n", 0xff & regs[R_MPD]);
73 	tda_reg("MAIN_DIV_BYTE_1    = 0x%02x\n", 0xff & regs[R_MD1]);
74 	tda_reg("MAIN_DIV_BYTE_2    = 0x%02x\n", 0xff & regs[R_MD2]);
75 	tda_reg("MAIN_DIV_BYTE_3    = 0x%02x\n", 0xff & regs[R_MD3]);
76 
77 	/* only dump extended regs if DBG_ADV is set */
78 	if (!(tda18271_debug & DBG_ADV))
79 		return;
80 
81 	/* W indicates write-only registers.
82 	 * Register dump for write-only registers shows last value written. */
83 
84 	tda_reg("EXTENDED_BYTE_1    = 0x%02x\n", 0xff & regs[R_EB1]);
85 	tda_reg("EXTENDED_BYTE_2    = 0x%02x\n", 0xff & regs[R_EB2]);
86 	tda_reg("EXTENDED_BYTE_3    = 0x%02x\n", 0xff & regs[R_EB3]);
87 	tda_reg("EXTENDED_BYTE_4    = 0x%02x\n", 0xff & regs[R_EB4]);
88 	tda_reg("EXTENDED_BYTE_5    = 0x%02x\n", 0xff & regs[R_EB5]);
89 	tda_reg("EXTENDED_BYTE_6    = 0x%02x\n", 0xff & regs[R_EB6]);
90 	tda_reg("EXTENDED_BYTE_7    = 0x%02x\n", 0xff & regs[R_EB7]);
91 	tda_reg("EXTENDED_BYTE_8    = 0x%02x\n", 0xff & regs[R_EB8]);
92 	tda_reg("EXTENDED_BYTE_9  W = 0x%02x\n", 0xff & regs[R_EB9]);
93 	tda_reg("EXTENDED_BYTE_10   = 0x%02x\n", 0xff & regs[R_EB10]);
94 	tda_reg("EXTENDED_BYTE_11   = 0x%02x\n", 0xff & regs[R_EB11]);
95 	tda_reg("EXTENDED_BYTE_12   = 0x%02x\n", 0xff & regs[R_EB12]);
96 	tda_reg("EXTENDED_BYTE_13   = 0x%02x\n", 0xff & regs[R_EB13]);
97 	tda_reg("EXTENDED_BYTE_14   = 0x%02x\n", 0xff & regs[R_EB14]);
98 	tda_reg("EXTENDED_BYTE_15   = 0x%02x\n", 0xff & regs[R_EB15]);
99 	tda_reg("EXTENDED_BYTE_16 W = 0x%02x\n", 0xff & regs[R_EB16]);
100 	tda_reg("EXTENDED_BYTE_17 W = 0x%02x\n", 0xff & regs[R_EB17]);
101 	tda_reg("EXTENDED_BYTE_18   = 0x%02x\n", 0xff & regs[R_EB18]);
102 	tda_reg("EXTENDED_BYTE_19 W = 0x%02x\n", 0xff & regs[R_EB19]);
103 	tda_reg("EXTENDED_BYTE_20 W = 0x%02x\n", 0xff & regs[R_EB20]);
104 	tda_reg("EXTENDED_BYTE_21   = 0x%02x\n", 0xff & regs[R_EB21]);
105 	tda_reg("EXTENDED_BYTE_22   = 0x%02x\n", 0xff & regs[R_EB22]);
106 	tda_reg("EXTENDED_BYTE_23   = 0x%02x\n", 0xff & regs[R_EB23]);
107 }
108 
109 int tda18271_read_regs(struct dvb_frontend *fe)
110 {
111 	struct tda18271_priv *priv = fe->tuner_priv;
112 	unsigned char *regs = priv->tda18271_regs;
113 	unsigned char buf = 0x00;
114 	int ret;
115 	struct i2c_msg msg[] = {
116 		{ .addr = priv->i2c_props.addr, .flags = 0,
117 		  .buf = &buf, .len = 1 },
118 		{ .addr = priv->i2c_props.addr, .flags = I2C_M_RD,
119 		  .buf = regs, .len = 16 }
120 	};
121 
122 	tda18271_i2c_gate_ctrl(fe, 1);
123 
124 	/* read all registers */
125 	ret = i2c_transfer(priv->i2c_props.adap, msg, 2);
126 
127 	tda18271_i2c_gate_ctrl(fe, 0);
128 
129 	if (ret != 2)
130 		tda_err("ERROR: i2c_transfer returned: %d\n", ret);
131 
132 	if (tda18271_debug & DBG_REG)
133 		tda18271_dump_regs(fe, 0);
134 
135 	return (ret == 2 ? 0 : ret);
136 }
137 
138 int tda18271_read_extended(struct dvb_frontend *fe)
139 {
140 	struct tda18271_priv *priv = fe->tuner_priv;
141 	unsigned char *regs = priv->tda18271_regs;
142 	unsigned char regdump[TDA18271_NUM_REGS];
143 	unsigned char buf = 0x00;
144 	int ret, i;
145 	struct i2c_msg msg[] = {
146 		{ .addr = priv->i2c_props.addr, .flags = 0,
147 		  .buf = &buf, .len = 1 },
148 		{ .addr = priv->i2c_props.addr, .flags = I2C_M_RD,
149 		  .buf = regdump, .len = TDA18271_NUM_REGS }
150 	};
151 
152 	tda18271_i2c_gate_ctrl(fe, 1);
153 
154 	/* read all registers */
155 	ret = i2c_transfer(priv->i2c_props.adap, msg, 2);
156 
157 	tda18271_i2c_gate_ctrl(fe, 0);
158 
159 	if (ret != 2)
160 		tda_err("ERROR: i2c_transfer returned: %d\n", ret);
161 
162 	for (i = 0; i < TDA18271_NUM_REGS; i++) {
163 		/* don't update write-only registers */
164 		if ((i != R_EB9)  &&
165 		    (i != R_EB16) &&
166 		    (i != R_EB17) &&
167 		    (i != R_EB19) &&
168 		    (i != R_EB20))
169 			regs[i] = regdump[i];
170 	}
171 
172 	if (tda18271_debug & DBG_REG)
173 		tda18271_dump_regs(fe, 1);
174 
175 	return (ret == 2 ? 0 : ret);
176 }
177 
178 static int __tda18271_write_regs(struct dvb_frontend *fe, int idx, int len,
179 			bool lock_i2c)
180 {
181 	struct tda18271_priv *priv = fe->tuner_priv;
182 	unsigned char *regs = priv->tda18271_regs;
183 	unsigned char buf[TDA18271_NUM_REGS + 1];
184 	struct i2c_msg msg = { .addr = priv->i2c_props.addr, .flags = 0,
185 			       .buf = buf };
186 	int i, ret = 1, max;
187 
188 	BUG_ON((len == 0) || (idx + len > sizeof(buf)));
189 
190 	switch (priv->small_i2c) {
191 	case TDA18271_03_BYTE_CHUNK_INIT:
192 		max = 3;
193 		break;
194 	case TDA18271_08_BYTE_CHUNK_INIT:
195 		max = 8;
196 		break;
197 	case TDA18271_16_BYTE_CHUNK_INIT:
198 		max = 16;
199 		break;
200 	case TDA18271_39_BYTE_CHUNK_INIT:
201 	default:
202 		max = 39;
203 	}
204 
205 
206 	/*
207 	 * If lock_i2c is true, it will take the I2C bus for tda18271 private
208 	 * usage during the entire write ops, as otherwise, bad things could
209 	 * happen.
210 	 * During device init, several write operations will happen. So,
211 	 * tda18271_init_regs controls the I2C lock directly,
212 	 * disabling lock_i2c here.
213 	 */
214 	if (lock_i2c) {
215 		tda18271_i2c_gate_ctrl(fe, 1);
216 		i2c_lock_bus(priv->i2c_props.adap, I2C_LOCK_SEGMENT);
217 	}
218 	while (len) {
219 		if (max > len)
220 			max = len;
221 
222 		buf[0] = idx;
223 		for (i = 1; i <= max; i++)
224 			buf[i] = regs[idx - 1 + i];
225 
226 		msg.len = max + 1;
227 
228 		/* write registers */
229 		ret = __i2c_transfer(priv->i2c_props.adap, &msg, 1);
230 		if (ret != 1)
231 			break;
232 
233 		idx += max;
234 		len -= max;
235 	}
236 	if (lock_i2c) {
237 		i2c_unlock_bus(priv->i2c_props.adap, I2C_LOCK_SEGMENT);
238 		tda18271_i2c_gate_ctrl(fe, 0);
239 	}
240 
241 	if (ret != 1)
242 		tda_err("ERROR: idx = 0x%x, len = %d, i2c_transfer returned: %d\n",
243 			idx, max, ret);
244 
245 	return (ret == 1 ? 0 : ret);
246 }
247 
248 int tda18271_write_regs(struct dvb_frontend *fe, int idx, int len)
249 {
250 	return __tda18271_write_regs(fe, idx, len, true);
251 }
252 
253 /*---------------------------------------------------------------------*/
254 
255 static int __tda18271_charge_pump_source(struct dvb_frontend *fe,
256 					 enum tda18271_pll pll, int force,
257 					 bool lock_i2c)
258 {
259 	struct tda18271_priv *priv = fe->tuner_priv;
260 	unsigned char *regs = priv->tda18271_regs;
261 
262 	int r_cp = (pll == TDA18271_CAL_PLL) ? R_EB7 : R_EB4;
263 
264 	regs[r_cp] &= ~0x20;
265 	regs[r_cp] |= ((force & 1) << 5);
266 
267 	return __tda18271_write_regs(fe, r_cp, 1, lock_i2c);
268 }
269 
270 int tda18271_charge_pump_source(struct dvb_frontend *fe,
271 				enum tda18271_pll pll, int force)
272 {
273 	return __tda18271_charge_pump_source(fe, pll, force, true);
274 }
275 
276 
277 int tda18271_init_regs(struct dvb_frontend *fe)
278 {
279 	struct tda18271_priv *priv = fe->tuner_priv;
280 	unsigned char *regs = priv->tda18271_regs;
281 
282 	tda_dbg("initializing registers for device @ %d-%04x\n",
283 		i2c_adapter_id(priv->i2c_props.adap),
284 		priv->i2c_props.addr);
285 
286 	/*
287 	 * Don't let any other I2C transfer to happen at adapter during init,
288 	 * as those could cause bad things
289 	 */
290 	tda18271_i2c_gate_ctrl(fe, 1);
291 	i2c_lock_bus(priv->i2c_props.adap, I2C_LOCK_SEGMENT);
292 
293 	/* initialize registers */
294 	switch (priv->id) {
295 	case TDA18271HDC1:
296 		regs[R_ID]   = 0x83;
297 		break;
298 	case TDA18271HDC2:
299 		regs[R_ID]   = 0x84;
300 		break;
301 	}
302 
303 	regs[R_TM]   = 0x08;
304 	regs[R_PL]   = 0x80;
305 	regs[R_EP1]  = 0xc6;
306 	regs[R_EP2]  = 0xdf;
307 	regs[R_EP3]  = 0x16;
308 	regs[R_EP4]  = 0x60;
309 	regs[R_EP5]  = 0x80;
310 	regs[R_CPD]  = 0x80;
311 	regs[R_CD1]  = 0x00;
312 	regs[R_CD2]  = 0x00;
313 	regs[R_CD3]  = 0x00;
314 	regs[R_MPD]  = 0x00;
315 	regs[R_MD1]  = 0x00;
316 	regs[R_MD2]  = 0x00;
317 	regs[R_MD3]  = 0x00;
318 
319 	switch (priv->id) {
320 	case TDA18271HDC1:
321 		regs[R_EB1]  = 0xff;
322 		break;
323 	case TDA18271HDC2:
324 		regs[R_EB1]  = 0xfc;
325 		break;
326 	}
327 
328 	regs[R_EB2]  = 0x01;
329 	regs[R_EB3]  = 0x84;
330 	regs[R_EB4]  = 0x41;
331 	regs[R_EB5]  = 0x01;
332 	regs[R_EB6]  = 0x84;
333 	regs[R_EB7]  = 0x40;
334 	regs[R_EB8]  = 0x07;
335 	regs[R_EB9]  = 0x00;
336 	regs[R_EB10] = 0x00;
337 	regs[R_EB11] = 0x96;
338 
339 	switch (priv->id) {
340 	case TDA18271HDC1:
341 		regs[R_EB12] = 0x0f;
342 		break;
343 	case TDA18271HDC2:
344 		regs[R_EB12] = 0x33;
345 		break;
346 	}
347 
348 	regs[R_EB13] = 0xc1;
349 	regs[R_EB14] = 0x00;
350 	regs[R_EB15] = 0x8f;
351 	regs[R_EB16] = 0x00;
352 	regs[R_EB17] = 0x00;
353 
354 	switch (priv->id) {
355 	case TDA18271HDC1:
356 		regs[R_EB18] = 0x00;
357 		break;
358 	case TDA18271HDC2:
359 		regs[R_EB18] = 0x8c;
360 		break;
361 	}
362 
363 	regs[R_EB19] = 0x00;
364 	regs[R_EB20] = 0x20;
365 
366 	switch (priv->id) {
367 	case TDA18271HDC1:
368 		regs[R_EB21] = 0x33;
369 		break;
370 	case TDA18271HDC2:
371 		regs[R_EB21] = 0xb3;
372 		break;
373 	}
374 
375 	regs[R_EB22] = 0x48;
376 	regs[R_EB23] = 0xb0;
377 
378 	__tda18271_write_regs(fe, 0x00, TDA18271_NUM_REGS, false);
379 
380 	/* setup agc1 gain */
381 	regs[R_EB17] = 0x00;
382 	__tda18271_write_regs(fe, R_EB17, 1, false);
383 	regs[R_EB17] = 0x03;
384 	__tda18271_write_regs(fe, R_EB17, 1, false);
385 	regs[R_EB17] = 0x43;
386 	__tda18271_write_regs(fe, R_EB17, 1, false);
387 	regs[R_EB17] = 0x4c;
388 	__tda18271_write_regs(fe, R_EB17, 1, false);
389 
390 	/* setup agc2 gain */
391 	if ((priv->id) == TDA18271HDC1) {
392 		regs[R_EB20] = 0xa0;
393 		__tda18271_write_regs(fe, R_EB20, 1, false);
394 		regs[R_EB20] = 0xa7;
395 		__tda18271_write_regs(fe, R_EB20, 1, false);
396 		regs[R_EB20] = 0xe7;
397 		__tda18271_write_regs(fe, R_EB20, 1, false);
398 		regs[R_EB20] = 0xec;
399 		__tda18271_write_regs(fe, R_EB20, 1, false);
400 	}
401 
402 	/* image rejection calibration */
403 
404 	/* low-band */
405 	regs[R_EP3] = 0x1f;
406 	regs[R_EP4] = 0x66;
407 	regs[R_EP5] = 0x81;
408 	regs[R_CPD] = 0xcc;
409 	regs[R_CD1] = 0x6c;
410 	regs[R_CD2] = 0x00;
411 	regs[R_CD3] = 0x00;
412 	regs[R_MPD] = 0xcd;
413 	regs[R_MD1] = 0x77;
414 	regs[R_MD2] = 0x08;
415 	regs[R_MD3] = 0x00;
416 
417 	__tda18271_write_regs(fe, R_EP3, 11, false);
418 
419 	if ((priv->id) == TDA18271HDC2) {
420 		/* main pll cp source on */
421 		__tda18271_charge_pump_source(fe, TDA18271_MAIN_PLL, 1, false);
422 		msleep(1);
423 
424 		/* main pll cp source off */
425 		__tda18271_charge_pump_source(fe, TDA18271_MAIN_PLL, 0, false);
426 	}
427 
428 	msleep(5); /* pll locking */
429 
430 	/* launch detector */
431 	__tda18271_write_regs(fe, R_EP1, 1, false);
432 	msleep(5); /* wanted low measurement */
433 
434 	regs[R_EP5] = 0x85;
435 	regs[R_CPD] = 0xcb;
436 	regs[R_CD1] = 0x66;
437 	regs[R_CD2] = 0x70;
438 
439 	__tda18271_write_regs(fe, R_EP3, 7, false);
440 	msleep(5); /* pll locking */
441 
442 	/* launch optimization algorithm */
443 	__tda18271_write_regs(fe, R_EP2, 1, false);
444 	msleep(30); /* image low optimization completion */
445 
446 	/* mid-band */
447 	regs[R_EP5] = 0x82;
448 	regs[R_CPD] = 0xa8;
449 	regs[R_CD2] = 0x00;
450 	regs[R_MPD] = 0xa9;
451 	regs[R_MD1] = 0x73;
452 	regs[R_MD2] = 0x1a;
453 
454 	__tda18271_write_regs(fe, R_EP3, 11, false);
455 	msleep(5); /* pll locking */
456 
457 	/* launch detector */
458 	__tda18271_write_regs(fe, R_EP1, 1, false);
459 	msleep(5); /* wanted mid measurement */
460 
461 	regs[R_EP5] = 0x86;
462 	regs[R_CPD] = 0xa8;
463 	regs[R_CD1] = 0x66;
464 	regs[R_CD2] = 0xa0;
465 
466 	__tda18271_write_regs(fe, R_EP3, 7, false);
467 	msleep(5); /* pll locking */
468 
469 	/* launch optimization algorithm */
470 	__tda18271_write_regs(fe, R_EP2, 1, false);
471 	msleep(30); /* image mid optimization completion */
472 
473 	/* high-band */
474 	regs[R_EP5] = 0x83;
475 	regs[R_CPD] = 0x98;
476 	regs[R_CD1] = 0x65;
477 	regs[R_CD2] = 0x00;
478 	regs[R_MPD] = 0x99;
479 	regs[R_MD1] = 0x71;
480 	regs[R_MD2] = 0xcd;
481 
482 	__tda18271_write_regs(fe, R_EP3, 11, false);
483 	msleep(5); /* pll locking */
484 
485 	/* launch detector */
486 	__tda18271_write_regs(fe, R_EP1, 1, false);
487 	msleep(5); /* wanted high measurement */
488 
489 	regs[R_EP5] = 0x87;
490 	regs[R_CD1] = 0x65;
491 	regs[R_CD2] = 0x50;
492 
493 	__tda18271_write_regs(fe, R_EP3, 7, false);
494 	msleep(5); /* pll locking */
495 
496 	/* launch optimization algorithm */
497 	__tda18271_write_regs(fe, R_EP2, 1, false);
498 	msleep(30); /* image high optimization completion */
499 
500 	/* return to normal mode */
501 	regs[R_EP4] = 0x64;
502 	__tda18271_write_regs(fe, R_EP4, 1, false);
503 
504 	/* synchronize */
505 	__tda18271_write_regs(fe, R_EP1, 1, false);
506 
507 	i2c_unlock_bus(priv->i2c_props.adap, I2C_LOCK_SEGMENT);
508 	tda18271_i2c_gate_ctrl(fe, 0);
509 
510 	return 0;
511 }
512 
513 /*---------------------------------------------------------------------*/
514 
515 /*
516  *  Standby modes, EP3 [7:5]
517  *
518  *  | SM  || SM_LT || SM_XT || mode description
519  *  |=====\\=======\\=======\\====================================
520  *  |  0  ||   0   ||   0   || normal mode
521  *  |-----||-------||-------||------------------------------------
522  *  |     ||       ||       || standby mode w/ slave tuner output
523  *  |  1  ||   0   ||   0   || & loop through & xtal oscillator on
524  *  |-----||-------||-------||------------------------------------
525  *  |  1  ||   1   ||   0   || standby mode w/ xtal oscillator on
526  *  |-----||-------||-------||------------------------------------
527  *  |  1  ||   1   ||   1   || power off
528  *
529  */
530 
531 int tda18271_set_standby_mode(struct dvb_frontend *fe,
532 			      int sm, int sm_lt, int sm_xt)
533 {
534 	struct tda18271_priv *priv = fe->tuner_priv;
535 	unsigned char *regs = priv->tda18271_regs;
536 
537 	if (tda18271_debug & DBG_ADV)
538 		tda_dbg("sm = %d, sm_lt = %d, sm_xt = %d\n", sm, sm_lt, sm_xt);
539 
540 	regs[R_EP3]  &= ~0xe0; /* clear sm, sm_lt, sm_xt */
541 	regs[R_EP3]  |= (sm    ? (1 << 7) : 0) |
542 			(sm_lt ? (1 << 6) : 0) |
543 			(sm_xt ? (1 << 5) : 0);
544 
545 	return tda18271_write_regs(fe, R_EP3, 1);
546 }
547 
548 /*---------------------------------------------------------------------*/
549 
550 int tda18271_calc_main_pll(struct dvb_frontend *fe, u32 freq)
551 {
552 	/* sets main post divider & divider bytes, but does not write them */
553 	struct tda18271_priv *priv = fe->tuner_priv;
554 	unsigned char *regs = priv->tda18271_regs;
555 	u8 d, pd;
556 	u32 div;
557 
558 	int ret = tda18271_lookup_pll_map(fe, MAIN_PLL, &freq, &pd, &d);
559 	if (tda_fail(ret))
560 		goto fail;
561 
562 	regs[R_MPD]   = (0x7f & pd);
563 
564 	div =  ((d * (freq / 1000)) << 7) / 125;
565 
566 	regs[R_MD1]   = 0x7f & (div >> 16);
567 	regs[R_MD2]   = 0xff & (div >> 8);
568 	regs[R_MD3]   = 0xff & div;
569 fail:
570 	return ret;
571 }
572 
573 int tda18271_calc_cal_pll(struct dvb_frontend *fe, u32 freq)
574 {
575 	/* sets cal post divider & divider bytes, but does not write them */
576 	struct tda18271_priv *priv = fe->tuner_priv;
577 	unsigned char *regs = priv->tda18271_regs;
578 	u8 d, pd;
579 	u32 div;
580 
581 	int ret = tda18271_lookup_pll_map(fe, CAL_PLL, &freq, &pd, &d);
582 	if (tda_fail(ret))
583 		goto fail;
584 
585 	regs[R_CPD]   = pd;
586 
587 	div =  ((d * (freq / 1000)) << 7) / 125;
588 
589 	regs[R_CD1]   = 0x7f & (div >> 16);
590 	regs[R_CD2]   = 0xff & (div >> 8);
591 	regs[R_CD3]   = 0xff & div;
592 fail:
593 	return ret;
594 }
595 
596 /*---------------------------------------------------------------------*/
597 
598 int tda18271_calc_bp_filter(struct dvb_frontend *fe, u32 *freq)
599 {
600 	/* sets bp filter bits, but does not write them */
601 	struct tda18271_priv *priv = fe->tuner_priv;
602 	unsigned char *regs = priv->tda18271_regs;
603 	u8 val;
604 
605 	int ret = tda18271_lookup_map(fe, BP_FILTER, freq, &val);
606 	if (tda_fail(ret))
607 		goto fail;
608 
609 	regs[R_EP1]  &= ~0x07; /* clear bp filter bits */
610 	regs[R_EP1]  |= (0x07 & val);
611 fail:
612 	return ret;
613 }
614 
615 int tda18271_calc_km(struct dvb_frontend *fe, u32 *freq)
616 {
617 	/* sets K & M bits, but does not write them */
618 	struct tda18271_priv *priv = fe->tuner_priv;
619 	unsigned char *regs = priv->tda18271_regs;
620 	u8 val;
621 
622 	int ret = tda18271_lookup_map(fe, RF_CAL_KMCO, freq, &val);
623 	if (tda_fail(ret))
624 		goto fail;
625 
626 	regs[R_EB13] &= ~0x7c; /* clear k & m bits */
627 	regs[R_EB13] |= (0x7c & val);
628 fail:
629 	return ret;
630 }
631 
632 int tda18271_calc_rf_band(struct dvb_frontend *fe, u32 *freq)
633 {
634 	/* sets rf band bits, but does not write them */
635 	struct tda18271_priv *priv = fe->tuner_priv;
636 	unsigned char *regs = priv->tda18271_regs;
637 	u8 val;
638 
639 	int ret = tda18271_lookup_map(fe, RF_BAND, freq, &val);
640 	if (tda_fail(ret))
641 		goto fail;
642 
643 	regs[R_EP2]  &= ~0xe0; /* clear rf band bits */
644 	regs[R_EP2]  |= (0xe0 & (val << 5));
645 fail:
646 	return ret;
647 }
648 
649 int tda18271_calc_gain_taper(struct dvb_frontend *fe, u32 *freq)
650 {
651 	/* sets gain taper bits, but does not write them */
652 	struct tda18271_priv *priv = fe->tuner_priv;
653 	unsigned char *regs = priv->tda18271_regs;
654 	u8 val;
655 
656 	int ret = tda18271_lookup_map(fe, GAIN_TAPER, freq, &val);
657 	if (tda_fail(ret))
658 		goto fail;
659 
660 	regs[R_EP2]  &= ~0x1f; /* clear gain taper bits */
661 	regs[R_EP2]  |= (0x1f & val);
662 fail:
663 	return ret;
664 }
665 
666 int tda18271_calc_ir_measure(struct dvb_frontend *fe, u32 *freq)
667 {
668 	/* sets IR Meas bits, but does not write them */
669 	struct tda18271_priv *priv = fe->tuner_priv;
670 	unsigned char *regs = priv->tda18271_regs;
671 	u8 val;
672 
673 	int ret = tda18271_lookup_map(fe, IR_MEASURE, freq, &val);
674 	if (tda_fail(ret))
675 		goto fail;
676 
677 	regs[R_EP5] &= ~0x07;
678 	regs[R_EP5] |= (0x07 & val);
679 fail:
680 	return ret;
681 }
682 
683 int tda18271_calc_rf_cal(struct dvb_frontend *fe, u32 *freq)
684 {
685 	/* sets rf cal byte (RFC_Cprog), but does not write it */
686 	struct tda18271_priv *priv = fe->tuner_priv;
687 	unsigned char *regs = priv->tda18271_regs;
688 	u8 val;
689 
690 	int ret = tda18271_lookup_map(fe, RF_CAL, freq, &val);
691 	/* The TDA18271HD/C1 rf_cal map lookup is expected to go out of range
692 	 * for frequencies above 61.1 MHz.  In these cases, the internal RF
693 	 * tracking filters calibration mechanism is used.
694 	 *
695 	 * There is no need to warn the user about this.
696 	 */
697 	if (ret < 0)
698 		goto fail;
699 
700 	regs[R_EB14] = val;
701 fail:
702 	return ret;
703 }
704 
705 void _tda_printk(struct tda18271_priv *state, const char *level,
706 		 const char *func, const char *fmt, ...)
707 {
708 	struct va_format vaf;
709 	va_list args;
710 
711 	va_start(args, fmt);
712 
713 	vaf.fmt = fmt;
714 	vaf.va = &args;
715 
716 	if (state)
717 		printk("%s%s: [%d-%04x|%c] %pV",
718 		       level, func, i2c_adapter_id(state->i2c_props.adap),
719 		       state->i2c_props.addr,
720 		       (state->role == TDA18271_MASTER) ? 'M' : 'S',
721 		       &vaf);
722 	else
723 		printk("%s%s: %pV", level, func, &vaf);
724 
725 	va_end(args);
726 }
727