1 /*
2  * descriptions + helper functions for simple dvb plls.
3  *
4  * (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
5  *
6  *  This program is free software; you can redistribute it and/or modify
7  *  it under the terms of the GNU General Public License as published by
8  *  the Free Software Foundation; either version 2 of the License, or
9  *  (at your option) any later version.
10  *
11  *  This program is distributed in the hope that it will be useful,
12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
14  *  GNU General Public License for more details.
15  */
16 
17 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
18 
19 #include <linux/slab.h>
20 #include <linux/module.h>
21 #include <linux/dvb/frontend.h>
22 #include <asm/types.h>
23 
24 #include "dvb-pll.h"
25 
26 #define dprintk(fmt, arg...) \
27 	printk(KERN_DEBUG pr_fmt("%s: " fmt), __func__, ##arg)
28 
29 struct dvb_pll_priv {
30 	/* pll number */
31 	int nr;
32 
33 	/* i2c details */
34 	int pll_i2c_address;
35 	struct i2c_adapter *i2c;
36 
37 	/* the PLL descriptor */
38 	const struct dvb_pll_desc *pll_desc;
39 
40 	/* cached frequency/bandwidth */
41 	u32 frequency;
42 	u32 bandwidth;
43 };
44 
45 #define DVB_PLL_MAX 64
46 
47 static unsigned int dvb_pll_devcount;
48 
49 static int debug;
50 module_param(debug, int, 0644);
51 MODULE_PARM_DESC(debug, "enable verbose debug messages");
52 
53 static unsigned int id[DVB_PLL_MAX] =
54 	{ [ 0 ... (DVB_PLL_MAX-1) ] = DVB_PLL_UNDEFINED };
55 module_param_array(id, int, NULL, 0644);
56 MODULE_PARM_DESC(id, "force pll id to use (DEBUG ONLY)");
57 
58 /* ----------------------------------------------------------- */
59 
60 struct dvb_pll_desc {
61 	const char *name;
62 	u32  min;
63 	u32  max;
64 	u32  iffreq;
65 	void (*set)(struct dvb_frontend *fe, u8 *buf);
66 	u8   *initdata;
67 	u8   *initdata2;
68 	u8   *sleepdata;
69 	int  count;
70 	struct {
71 		u32 limit;
72 		u32 stepsize;
73 		u8  config;
74 		u8  cb;
75 	} entries[];
76 };
77 
78 /* ----------------------------------------------------------- */
79 /* descriptions                                                */
80 
81 static const struct dvb_pll_desc dvb_pll_thomson_dtt7579 = {
82 	.name  = "Thomson dtt7579",
83 	.min   = 177000000,
84 	.max   = 858000000,
85 	.iffreq= 36166667,
86 	.sleepdata = (u8[]){ 2, 0xb4, 0x03 },
87 	.count = 4,
88 	.entries = {
89 		{  443250000, 166667, 0xb4, 0x02 },
90 		{  542000000, 166667, 0xb4, 0x08 },
91 		{  771000000, 166667, 0xbc, 0x08 },
92 		{  999999999, 166667, 0xf4, 0x08 },
93 	},
94 };
95 
96 static void thomson_dtt759x_bw(struct dvb_frontend *fe, u8 *buf)
97 {
98 	u32 bw = fe->dtv_property_cache.bandwidth_hz;
99 	if (bw == 7000000)
100 		buf[3] |= 0x10;
101 }
102 
103 static const struct dvb_pll_desc dvb_pll_thomson_dtt759x = {
104 	.name  = "Thomson dtt759x",
105 	.min   = 177000000,
106 	.max   = 896000000,
107 	.set   = thomson_dtt759x_bw,
108 	.iffreq= 36166667,
109 	.sleepdata = (u8[]){ 2, 0x84, 0x03 },
110 	.count = 5,
111 	.entries = {
112 		{  264000000, 166667, 0xb4, 0x02 },
113 		{  470000000, 166667, 0xbc, 0x02 },
114 		{  735000000, 166667, 0xbc, 0x08 },
115 		{  835000000, 166667, 0xf4, 0x08 },
116 		{  999999999, 166667, 0xfc, 0x08 },
117 	},
118 };
119 
120 static void thomson_dtt7520x_bw(struct dvb_frontend *fe, u8 *buf)
121 {
122 	u32 bw = fe->dtv_property_cache.bandwidth_hz;
123 	if (bw == 8000000)
124 		buf[3] ^= 0x10;
125 }
126 
127 static const struct dvb_pll_desc dvb_pll_thomson_dtt7520x = {
128 	.name  = "Thomson dtt7520x",
129 	.min   = 185000000,
130 	.max   = 900000000,
131 	.set   = thomson_dtt7520x_bw,
132 	.iffreq = 36166667,
133 	.count = 7,
134 	.entries = {
135 		{  305000000, 166667, 0xb4, 0x12 },
136 		{  405000000, 166667, 0xbc, 0x12 },
137 		{  445000000, 166667, 0xbc, 0x12 },
138 		{  465000000, 166667, 0xf4, 0x18 },
139 		{  735000000, 166667, 0xfc, 0x18 },
140 		{  835000000, 166667, 0xbc, 0x18 },
141 		{  999999999, 166667, 0xfc, 0x18 },
142 	},
143 };
144 
145 static const struct dvb_pll_desc dvb_pll_lg_z201 = {
146 	.name  = "LG z201",
147 	.min   = 174000000,
148 	.max   = 862000000,
149 	.iffreq= 36166667,
150 	.sleepdata = (u8[]){ 2, 0xbc, 0x03 },
151 	.count = 5,
152 	.entries = {
153 		{  157500000, 166667, 0xbc, 0x01 },
154 		{  443250000, 166667, 0xbc, 0x02 },
155 		{  542000000, 166667, 0xbc, 0x04 },
156 		{  830000000, 166667, 0xf4, 0x04 },
157 		{  999999999, 166667, 0xfc, 0x04 },
158 	},
159 };
160 
161 static const struct dvb_pll_desc dvb_pll_unknown_1 = {
162 	.name  = "unknown 1", /* used by dntv live dvb-t */
163 	.min   = 174000000,
164 	.max   = 862000000,
165 	.iffreq= 36166667,
166 	.count = 9,
167 	.entries = {
168 		{  150000000, 166667, 0xb4, 0x01 },
169 		{  173000000, 166667, 0xbc, 0x01 },
170 		{  250000000, 166667, 0xb4, 0x02 },
171 		{  400000000, 166667, 0xbc, 0x02 },
172 		{  420000000, 166667, 0xf4, 0x02 },
173 		{  470000000, 166667, 0xfc, 0x02 },
174 		{  600000000, 166667, 0xbc, 0x08 },
175 		{  730000000, 166667, 0xf4, 0x08 },
176 		{  999999999, 166667, 0xfc, 0x08 },
177 	},
178 };
179 
180 /* Infineon TUA6010XS
181  * used in Thomson Cable Tuner
182  */
183 static const struct dvb_pll_desc dvb_pll_tua6010xs = {
184 	.name  = "Infineon TUA6010XS",
185 	.min   =  44250000,
186 	.max   = 858000000,
187 	.iffreq= 36125000,
188 	.count = 3,
189 	.entries = {
190 		{  115750000, 62500, 0x8e, 0x03 },
191 		{  403250000, 62500, 0x8e, 0x06 },
192 		{  999999999, 62500, 0x8e, 0x85 },
193 	},
194 };
195 
196 /* Panasonic env57h1xd5 (some Philips PLL ?) */
197 static const struct dvb_pll_desc dvb_pll_env57h1xd5 = {
198 	.name  = "Panasonic ENV57H1XD5",
199 	.min   =  44250000,
200 	.max   = 858000000,
201 	.iffreq= 36125000,
202 	.count = 4,
203 	.entries = {
204 		{  153000000, 166667, 0xc2, 0x41 },
205 		{  470000000, 166667, 0xc2, 0x42 },
206 		{  526000000, 166667, 0xc2, 0x84 },
207 		{  999999999, 166667, 0xc2, 0xa4 },
208 	},
209 };
210 
211 /* Philips TDA6650/TDA6651
212  * used in Panasonic ENV77H11D5
213  */
214 static void tda665x_bw(struct dvb_frontend *fe, u8 *buf)
215 {
216 	u32 bw = fe->dtv_property_cache.bandwidth_hz;
217 	if (bw == 8000000)
218 		buf[3] |= 0x08;
219 }
220 
221 static const struct dvb_pll_desc dvb_pll_tda665x = {
222 	.name  = "Philips TDA6650/TDA6651",
223 	.min   =  44250000,
224 	.max   = 858000000,
225 	.set   = tda665x_bw,
226 	.iffreq= 36166667,
227 	.initdata = (u8[]){ 4, 0x0b, 0xf5, 0x85, 0xab },
228 	.count = 12,
229 	.entries = {
230 		{   93834000, 166667, 0xca, 0x61 /* 011 0 0 0  01 */ },
231 		{  123834000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
232 		{  161000000, 166667, 0xca, 0xa1 /* 101 0 0 0  01 */ },
233 		{  163834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
234 		{  253834000, 166667, 0xca, 0x62 /* 011 0 0 0  10 */ },
235 		{  383834000, 166667, 0xca, 0xa2 /* 101 0 0 0  10 */ },
236 		{  443834000, 166667, 0xca, 0xc2 /* 110 0 0 0  10 */ },
237 		{  444000000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
238 		{  583834000, 166667, 0xca, 0x64 /* 011 0 0 1  00 */ },
239 		{  793834000, 166667, 0xca, 0xa4 /* 101 0 0 1  00 */ },
240 		{  444834000, 166667, 0xca, 0xc4 /* 110 0 0 1  00 */ },
241 		{  861000000, 166667, 0xca, 0xe4 /* 111 0 0 1  00 */ },
242 	}
243 };
244 
245 /* Infineon TUA6034
246  * used in LG TDTP E102P
247  */
248 static void tua6034_bw(struct dvb_frontend *fe, u8 *buf)
249 {
250 	u32 bw = fe->dtv_property_cache.bandwidth_hz;
251 	if (bw == 7000000)
252 		buf[3] |= 0x08;
253 }
254 
255 static const struct dvb_pll_desc dvb_pll_tua6034 = {
256 	.name  = "Infineon TUA6034",
257 	.min   =  44250000,
258 	.max   = 858000000,
259 	.iffreq= 36166667,
260 	.count = 3,
261 	.set   = tua6034_bw,
262 	.entries = {
263 		{  174500000, 62500, 0xce, 0x01 },
264 		{  230000000, 62500, 0xce, 0x02 },
265 		{  999999999, 62500, 0xce, 0x04 },
266 	},
267 };
268 
269 /* ALPS TDED4
270  * used in Nebula-Cards and USB boxes
271  */
272 static void tded4_bw(struct dvb_frontend *fe, u8 *buf)
273 {
274 	u32 bw = fe->dtv_property_cache.bandwidth_hz;
275 	if (bw == 8000000)
276 		buf[3] |= 0x04;
277 }
278 
279 static const struct dvb_pll_desc dvb_pll_tded4 = {
280 	.name = "ALPS TDED4",
281 	.min = 47000000,
282 	.max = 863000000,
283 	.iffreq= 36166667,
284 	.set   = tded4_bw,
285 	.count = 4,
286 	.entries = {
287 		{ 153000000, 166667, 0x85, 0x01 },
288 		{ 470000000, 166667, 0x85, 0x02 },
289 		{ 823000000, 166667, 0x85, 0x08 },
290 		{ 999999999, 166667, 0x85, 0x88 },
291 	}
292 };
293 
294 /* ALPS TDHU2
295  * used in AverTVHD MCE A180
296  */
297 static const struct dvb_pll_desc dvb_pll_tdhu2 = {
298 	.name = "ALPS TDHU2",
299 	.min = 54000000,
300 	.max = 864000000,
301 	.iffreq= 44000000,
302 	.count = 4,
303 	.entries = {
304 		{ 162000000, 62500, 0x85, 0x01 },
305 		{ 426000000, 62500, 0x85, 0x02 },
306 		{ 782000000, 62500, 0x85, 0x08 },
307 		{ 999999999, 62500, 0x85, 0x88 },
308 	}
309 };
310 
311 /* Samsung TBMV30111IN / TBMV30712IN1
312  * used in Air2PC ATSC - 2nd generation (nxt2002)
313  */
314 static const struct dvb_pll_desc dvb_pll_samsung_tbmv = {
315 	.name = "Samsung TBMV30111IN / TBMV30712IN1",
316 	.min = 54000000,
317 	.max = 860000000,
318 	.iffreq= 44000000,
319 	.count = 6,
320 	.entries = {
321 		{ 172000000, 166667, 0xb4, 0x01 },
322 		{ 214000000, 166667, 0xb4, 0x02 },
323 		{ 467000000, 166667, 0xbc, 0x02 },
324 		{ 721000000, 166667, 0xbc, 0x08 },
325 		{ 841000000, 166667, 0xf4, 0x08 },
326 		{ 999999999, 166667, 0xfc, 0x02 },
327 	}
328 };
329 
330 /*
331  * Philips SD1878 Tuner.
332  */
333 static const struct dvb_pll_desc dvb_pll_philips_sd1878_tda8261 = {
334 	.name  = "Philips SD1878",
335 	.min   =  950000,
336 	.max   = 2150000,
337 	.iffreq= 249, /* zero-IF, offset 249 is to round up */
338 	.count = 4,
339 	.entries = {
340 		{ 1250000, 500, 0xc4, 0x00},
341 		{ 1450000, 500, 0xc4, 0x40},
342 		{ 2050000, 500, 0xc4, 0x80},
343 		{ 2150000, 500, 0xc4, 0xc0},
344 	},
345 };
346 
347 static void opera1_bw(struct dvb_frontend *fe, u8 *buf)
348 {
349 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
350 	struct dvb_pll_priv *priv = fe->tuner_priv;
351 	u32 b_w  = (c->symbol_rate * 27) / 32000;
352 	struct i2c_msg msg = {
353 		.addr = priv->pll_i2c_address,
354 		.flags = 0,
355 		.buf = buf,
356 		.len = 4
357 	};
358 	int result;
359 	u8 lpf;
360 
361 	if (fe->ops.i2c_gate_ctrl)
362 		fe->ops.i2c_gate_ctrl(fe, 1);
363 
364 	result = i2c_transfer(priv->i2c, &msg, 1);
365 	if (result != 1)
366 		pr_err("%s: i2c_transfer failed:%d",
367 			__func__, result);
368 
369 	if (b_w <= 10000)
370 		lpf = 0xc;
371 	else if (b_w <= 12000)
372 		lpf = 0x2;
373 	else if (b_w <= 14000)
374 		lpf = 0xa;
375 	else if (b_w <= 16000)
376 		lpf = 0x6;
377 	else if (b_w <= 18000)
378 		lpf = 0xe;
379 	else if (b_w <= 20000)
380 		lpf = 0x1;
381 	else if (b_w <= 22000)
382 		lpf = 0x9;
383 	else if (b_w <= 24000)
384 		lpf = 0x5;
385 	else if (b_w <= 26000)
386 		lpf = 0xd;
387 	else if (b_w <= 28000)
388 		lpf = 0x3;
389 		else
390 		lpf = 0xb;
391 	buf[2] ^= 0x1c; /* Flip bits 3-5 */
392 	/* Set lpf */
393 	buf[2] |= ((lpf >> 2) & 0x3) << 3;
394 	buf[3] |= (lpf & 0x3) << 2;
395 
396 	return;
397 }
398 
399 static const struct dvb_pll_desc dvb_pll_opera1 = {
400 	.name  = "Opera Tuner",
401 	.min   =  900000,
402 	.max   = 2250000,
403 	.initdata = (u8[]){ 4, 0x08, 0xe5, 0xe1, 0x00 },
404 	.initdata2 = (u8[]){ 4, 0x08, 0xe5, 0xe5, 0x00 },
405 	.iffreq= 0,
406 	.set   = opera1_bw,
407 	.count = 8,
408 	.entries = {
409 		{ 1064000, 500, 0xf9, 0xc2 },
410 		{ 1169000, 500, 0xf9, 0xe2 },
411 		{ 1299000, 500, 0xf9, 0x20 },
412 		{ 1444000, 500, 0xf9, 0x40 },
413 		{ 1606000, 500, 0xf9, 0x60 },
414 		{ 1777000, 500, 0xf9, 0x80 },
415 		{ 1941000, 500, 0xf9, 0xa0 },
416 		{ 2250000, 500, 0xf9, 0xc0 },
417 	}
418 };
419 
420 static void samsung_dtos403ih102a_set(struct dvb_frontend *fe, u8 *buf)
421 {
422 	struct dvb_pll_priv *priv = fe->tuner_priv;
423 	struct i2c_msg msg = {
424 		.addr = priv->pll_i2c_address,
425 		.flags = 0,
426 		.buf = buf,
427 		.len = 4
428 	};
429 	int result;
430 
431 	if (fe->ops.i2c_gate_ctrl)
432 		fe->ops.i2c_gate_ctrl(fe, 1);
433 
434 	result = i2c_transfer(priv->i2c, &msg, 1);
435 	if (result != 1)
436 		pr_err("%s: i2c_transfer failed:%d",
437 			__func__, result);
438 
439 	buf[2] = 0x9e;
440 	buf[3] = 0x90;
441 
442 	return;
443 }
444 
445 /* unknown pll used in Samsung DTOS403IH102A DVB-C tuner */
446 static const struct dvb_pll_desc dvb_pll_samsung_dtos403ih102a = {
447 	.name   = "Samsung DTOS403IH102A",
448 	.min    =  44250000,
449 	.max    = 858000000,
450 	.iffreq =  36125000,
451 	.count  = 8,
452 	.set    = samsung_dtos403ih102a_set,
453 	.entries = {
454 		{ 135000000, 62500, 0xbe, 0x01 },
455 		{ 177000000, 62500, 0xf6, 0x01 },
456 		{ 370000000, 62500, 0xbe, 0x02 },
457 		{ 450000000, 62500, 0xf6, 0x02 },
458 		{ 466000000, 62500, 0xfe, 0x02 },
459 		{ 538000000, 62500, 0xbe, 0x08 },
460 		{ 826000000, 62500, 0xf6, 0x08 },
461 		{ 999999999, 62500, 0xfe, 0x08 },
462 	}
463 };
464 
465 /* Samsung TDTC9251DH0 DVB-T NIM, as used on AirStar 2 */
466 static const struct dvb_pll_desc dvb_pll_samsung_tdtc9251dh0 = {
467 	.name	= "Samsung TDTC9251DH0",
468 	.min	=  48000000,
469 	.max	= 863000000,
470 	.iffreq	=  36166667,
471 	.count	= 3,
472 	.entries = {
473 		{ 157500000, 166667, 0xcc, 0x09 },
474 		{ 443000000, 166667, 0xcc, 0x0a },
475 		{ 863000000, 166667, 0xcc, 0x08 },
476 	}
477 };
478 
479 /* Samsung TBDU18132 DVB-S NIM with TSA5059 PLL, used in SkyStar2 DVB-S 2.3 */
480 static const struct dvb_pll_desc dvb_pll_samsung_tbdu18132 = {
481 	.name = "Samsung TBDU18132",
482 	.min	=  950000,
483 	.max	= 2150000, /* guesses */
484 	.iffreq = 0,
485 	.count = 2,
486 	.entries = {
487 		{ 1550000, 125, 0x84, 0x82 },
488 		{ 4095937, 125, 0x84, 0x80 },
489 	}
490 	/* TSA5059 PLL has a 17 bit divisor rather than the 15 bits supported
491 	 * by this driver.  The two extra bits are 0x60 in the third byte.  15
492 	 * bits is enough for over 4 GHz, which is enough to cover the range
493 	 * of this tuner.  We could use the additional divisor bits by adding
494 	 * more entries, e.g.
495 	 { 0x0ffff * 125 + 125/2, 125, 0x84 | 0x20, },
496 	 { 0x17fff * 125 + 125/2, 125, 0x84 | 0x40, },
497 	 { 0x1ffff * 125 + 125/2, 125, 0x84 | 0x60, }, */
498 };
499 
500 /* Samsung TBMU24112 DVB-S NIM with SL1935 zero-IF tuner */
501 static const struct dvb_pll_desc dvb_pll_samsung_tbmu24112 = {
502 	.name = "Samsung TBMU24112",
503 	.min	=  950000,
504 	.max	= 2150000, /* guesses */
505 	.iffreq = 0,
506 	.count = 2,
507 	.entries = {
508 		{ 1500000, 125, 0x84, 0x18 },
509 		{ 9999999, 125, 0x84, 0x08 },
510 	}
511 };
512 
513 /* Alps TDEE4 DVB-C NIM, used on Cablestar 2 */
514 /* byte 4 : 1  *   *   AGD R3  R2  R1  R0
515  * byte 5 : C1 *   RE  RTS BS4 BS3 BS2 BS1
516  * AGD = 1, R3 R2 R1 R0 = 0 1 0 1 => byte 4 = 1**10101 = 0x95
517  * Range(MHz)  C1 *  RE RTS BS4 BS3 BS2 BS1  Byte 5
518  *  47 - 153   0  *  0   0   0   0   0   1   0x01
519  * 153 - 430   0  *  0   0   0   0   1   0   0x02
520  * 430 - 822   0  *  0   0   1   0   0   0   0x08
521  * 822 - 862   1  *  0   0   1   0   0   0   0x88 */
522 static const struct dvb_pll_desc dvb_pll_alps_tdee4 = {
523 	.name = "ALPS TDEE4",
524 	.min	=  47000000,
525 	.max	= 862000000,
526 	.iffreq	=  36125000,
527 	.count = 4,
528 	.entries = {
529 		{ 153000000, 62500, 0x95, 0x01 },
530 		{ 430000000, 62500, 0x95, 0x02 },
531 		{ 822000000, 62500, 0x95, 0x08 },
532 		{ 999999999, 62500, 0x95, 0x88 },
533 	}
534 };
535 
536 /* ----------------------------------------------------------- */
537 
538 static const struct dvb_pll_desc *pll_list[] = {
539 	[DVB_PLL_UNDEFINED]              = NULL,
540 	[DVB_PLL_THOMSON_DTT7579]        = &dvb_pll_thomson_dtt7579,
541 	[DVB_PLL_THOMSON_DTT759X]        = &dvb_pll_thomson_dtt759x,
542 	[DVB_PLL_THOMSON_DTT7520X]       = &dvb_pll_thomson_dtt7520x,
543 	[DVB_PLL_LG_Z201]                = &dvb_pll_lg_z201,
544 	[DVB_PLL_UNKNOWN_1]              = &dvb_pll_unknown_1,
545 	[DVB_PLL_TUA6010XS]              = &dvb_pll_tua6010xs,
546 	[DVB_PLL_ENV57H1XD5]             = &dvb_pll_env57h1xd5,
547 	[DVB_PLL_TUA6034]                = &dvb_pll_tua6034,
548 	[DVB_PLL_TDA665X]                = &dvb_pll_tda665x,
549 	[DVB_PLL_TDED4]                  = &dvb_pll_tded4,
550 	[DVB_PLL_TDEE4]                  = &dvb_pll_alps_tdee4,
551 	[DVB_PLL_TDHU2]                  = &dvb_pll_tdhu2,
552 	[DVB_PLL_SAMSUNG_TBMV]           = &dvb_pll_samsung_tbmv,
553 	[DVB_PLL_PHILIPS_SD1878_TDA8261] = &dvb_pll_philips_sd1878_tda8261,
554 	[DVB_PLL_OPERA1]                 = &dvb_pll_opera1,
555 	[DVB_PLL_SAMSUNG_DTOS403IH102A]  = &dvb_pll_samsung_dtos403ih102a,
556 	[DVB_PLL_SAMSUNG_TDTC9251DH0]    = &dvb_pll_samsung_tdtc9251dh0,
557 	[DVB_PLL_SAMSUNG_TBDU18132]	 = &dvb_pll_samsung_tbdu18132,
558 	[DVB_PLL_SAMSUNG_TBMU24112]      = &dvb_pll_samsung_tbmu24112,
559 };
560 
561 /* ----------------------------------------------------------- */
562 /* code                                                        */
563 
564 static int dvb_pll_configure(struct dvb_frontend *fe, u8 *buf,
565 			     const u32 frequency)
566 {
567 	struct dvb_pll_priv *priv = fe->tuner_priv;
568 	const struct dvb_pll_desc *desc = priv->pll_desc;
569 	u32 div;
570 	int i;
571 
572 	if (frequency && (frequency < desc->min || frequency > desc->max))
573 		return -EINVAL;
574 
575 	for (i = 0; i < desc->count; i++) {
576 		if (frequency > desc->entries[i].limit)
577 			continue;
578 		break;
579 	}
580 
581 	if (debug)
582 		dprintk("pll: %s: freq=%d | i=%d/%d\n", desc->name,
583 		       frequency, i, desc->count);
584 	if (i == desc->count)
585 		return -EINVAL;
586 
587 	div = (frequency + desc->iffreq +
588 	       desc->entries[i].stepsize/2) / desc->entries[i].stepsize;
589 	buf[0] = div >> 8;
590 	buf[1] = div & 0xff;
591 	buf[2] = desc->entries[i].config;
592 	buf[3] = desc->entries[i].cb;
593 
594 	if (desc->set)
595 		desc->set(fe, buf);
596 
597 	if (debug)
598 		dprintk("pll: %s: div=%d | buf=0x%02x,0x%02x,0x%02x,0x%02x\n",
599 		       desc->name, div, buf[0], buf[1], buf[2], buf[3]);
600 
601 	// calculate the frequency we set it to
602 	return (div * desc->entries[i].stepsize) - desc->iffreq;
603 }
604 
605 static void dvb_pll_release(struct dvb_frontend *fe)
606 {
607 	kfree(fe->tuner_priv);
608 	fe->tuner_priv = NULL;
609 }
610 
611 static int dvb_pll_sleep(struct dvb_frontend *fe)
612 {
613 	struct dvb_pll_priv *priv = fe->tuner_priv;
614 
615 	if (priv->i2c == NULL)
616 		return -EINVAL;
617 
618 	if (priv->pll_desc->sleepdata) {
619 		struct i2c_msg msg = { .flags = 0,
620 			.addr = priv->pll_i2c_address,
621 			.buf = priv->pll_desc->sleepdata + 1,
622 			.len = priv->pll_desc->sleepdata[0] };
623 
624 		int result;
625 
626 		if (fe->ops.i2c_gate_ctrl)
627 			fe->ops.i2c_gate_ctrl(fe, 1);
628 		if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
629 			return result;
630 		}
631 		return 0;
632 	}
633 	/* Shouldn't be called when initdata is NULL, maybe BUG()? */
634 	return -EINVAL;
635 }
636 
637 static int dvb_pll_set_params(struct dvb_frontend *fe)
638 {
639 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
640 	struct dvb_pll_priv *priv = fe->tuner_priv;
641 	u8 buf[4];
642 	struct i2c_msg msg =
643 		{ .addr = priv->pll_i2c_address, .flags = 0,
644 		  .buf = buf, .len = sizeof(buf) };
645 	int result;
646 	u32 frequency = 0;
647 
648 	if (priv->i2c == NULL)
649 		return -EINVAL;
650 
651 	result = dvb_pll_configure(fe, buf, c->frequency);
652 	if (result < 0)
653 		return result;
654 	else
655 		frequency = result;
656 
657 	if (fe->ops.i2c_gate_ctrl)
658 		fe->ops.i2c_gate_ctrl(fe, 1);
659 	if ((result = i2c_transfer(priv->i2c, &msg, 1)) != 1) {
660 		return result;
661 	}
662 
663 	priv->frequency = frequency;
664 	priv->bandwidth = c->bandwidth_hz;
665 
666 	return 0;
667 }
668 
669 static int dvb_pll_calc_regs(struct dvb_frontend *fe,
670 			     u8 *buf, int buf_len)
671 {
672 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
673 	struct dvb_pll_priv *priv = fe->tuner_priv;
674 	int result;
675 	u32 frequency = 0;
676 
677 	if (buf_len < 5)
678 		return -EINVAL;
679 
680 	result = dvb_pll_configure(fe, buf + 1, c->frequency);
681 	if (result < 0)
682 		return result;
683 	else
684 		frequency = result;
685 
686 	buf[0] = priv->pll_i2c_address;
687 
688 	priv->frequency = frequency;
689 	priv->bandwidth = c->bandwidth_hz;
690 
691 	return 5;
692 }
693 
694 static int dvb_pll_get_frequency(struct dvb_frontend *fe, u32 *frequency)
695 {
696 	struct dvb_pll_priv *priv = fe->tuner_priv;
697 	*frequency = priv->frequency;
698 	return 0;
699 }
700 
701 static int dvb_pll_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
702 {
703 	struct dvb_pll_priv *priv = fe->tuner_priv;
704 	*bandwidth = priv->bandwidth;
705 	return 0;
706 }
707 
708 static int dvb_pll_init(struct dvb_frontend *fe)
709 {
710 	struct dvb_pll_priv *priv = fe->tuner_priv;
711 
712 	if (priv->i2c == NULL)
713 		return -EINVAL;
714 
715 	if (priv->pll_desc->initdata) {
716 		struct i2c_msg msg = { .flags = 0,
717 			.addr = priv->pll_i2c_address,
718 			.buf = priv->pll_desc->initdata + 1,
719 			.len = priv->pll_desc->initdata[0] };
720 
721 		int result;
722 		if (fe->ops.i2c_gate_ctrl)
723 			fe->ops.i2c_gate_ctrl(fe, 1);
724 		result = i2c_transfer(priv->i2c, &msg, 1);
725 		if (result != 1)
726 			return result;
727 		if (priv->pll_desc->initdata2) {
728 			msg.buf = priv->pll_desc->initdata2 + 1;
729 			msg.len = priv->pll_desc->initdata2[0];
730 			if (fe->ops.i2c_gate_ctrl)
731 				fe->ops.i2c_gate_ctrl(fe, 1);
732 			result = i2c_transfer(priv->i2c, &msg, 1);
733 			if (result != 1)
734 				return result;
735 		}
736 		return 0;
737 	}
738 	/* Shouldn't be called when initdata is NULL, maybe BUG()? */
739 	return -EINVAL;
740 }
741 
742 static const struct dvb_tuner_ops dvb_pll_tuner_ops = {
743 	.release = dvb_pll_release,
744 	.sleep = dvb_pll_sleep,
745 	.init = dvb_pll_init,
746 	.set_params = dvb_pll_set_params,
747 	.calc_regs = dvb_pll_calc_regs,
748 	.get_frequency = dvb_pll_get_frequency,
749 	.get_bandwidth = dvb_pll_get_bandwidth,
750 };
751 
752 struct dvb_frontend *dvb_pll_attach(struct dvb_frontend *fe, int pll_addr,
753 				    struct i2c_adapter *i2c,
754 				    unsigned int pll_desc_id)
755 {
756 	u8 *b1;
757 	struct i2c_msg msg = { .addr = pll_addr, .flags = I2C_M_RD, .len = 1 };
758 	struct dvb_pll_priv *priv = NULL;
759 	int ret;
760 	const struct dvb_pll_desc *desc;
761 
762 	b1 = kmalloc(1, GFP_KERNEL);
763 	if (!b1)
764 		return NULL;
765 
766 	b1[0] = 0;
767 	msg.buf = b1;
768 
769 	if ((id[dvb_pll_devcount] > DVB_PLL_UNDEFINED) &&
770 	    (id[dvb_pll_devcount] < ARRAY_SIZE(pll_list)))
771 		pll_desc_id = id[dvb_pll_devcount];
772 
773 	BUG_ON(pll_desc_id < 1 || pll_desc_id >= ARRAY_SIZE(pll_list));
774 
775 	desc = pll_list[pll_desc_id];
776 
777 	if (i2c != NULL) {
778 		if (fe->ops.i2c_gate_ctrl)
779 			fe->ops.i2c_gate_ctrl(fe, 1);
780 
781 		ret = i2c_transfer (i2c, &msg, 1);
782 		if (ret != 1) {
783 			kfree(b1);
784 			return NULL;
785 		}
786 		if (fe->ops.i2c_gate_ctrl)
787 			     fe->ops.i2c_gate_ctrl(fe, 0);
788 	}
789 
790 	priv = kzalloc(sizeof(struct dvb_pll_priv), GFP_KERNEL);
791 	if (!priv) {
792 		kfree(b1);
793 		return NULL;
794 	}
795 
796 	priv->pll_i2c_address = pll_addr;
797 	priv->i2c = i2c;
798 	priv->pll_desc = desc;
799 	priv->nr = dvb_pll_devcount++;
800 
801 	memcpy(&fe->ops.tuner_ops, &dvb_pll_tuner_ops,
802 	       sizeof(struct dvb_tuner_ops));
803 
804 	strncpy(fe->ops.tuner_ops.info.name, desc->name,
805 		sizeof(fe->ops.tuner_ops.info.name));
806 	fe->ops.tuner_ops.info.frequency_min = desc->min;
807 	fe->ops.tuner_ops.info.frequency_max = desc->max;
808 	if (!desc->initdata)
809 		fe->ops.tuner_ops.init = NULL;
810 	if (!desc->sleepdata)
811 		fe->ops.tuner_ops.sleep = NULL;
812 
813 	fe->tuner_priv = priv;
814 
815 	if ((debug) || (id[priv->nr] == pll_desc_id)) {
816 		dprintk("dvb-pll[%d]", priv->nr);
817 		if (i2c != NULL)
818 			pr_cont(" %d-%04x", i2c_adapter_id(i2c), pll_addr);
819 		pr_cont(": id# %d (%s) attached, %s\n", pll_desc_id, desc->name,
820 		       id[priv->nr] == pll_desc_id ?
821 				"insmod option" : "autodetected");
822 	}
823 
824 	kfree(b1);
825 
826 	return fe;
827 }
828 EXPORT_SYMBOL(dvb_pll_attach);
829 
830 MODULE_DESCRIPTION("dvb pll library");
831 MODULE_AUTHOR("Gerd Knorr");
832 MODULE_LICENSE("GPL");
833