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