1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include "fc0012.h"
18#include "fc0012-priv.h"
19
20static int fc0012_writereg(struct fc0012_priv *priv, u8 reg, u8 val)
21{
22 u8 buf[2] = {reg, val};
23 struct i2c_msg msg = {
24 .addr = priv->cfg->i2c_address, .flags = 0, .buf = buf, .len = 2
25 };
26
27 if (i2c_transfer(priv->i2c, &msg, 1) != 1) {
28 dev_err(&priv->i2c->dev,
29 "%s: I2C write reg failed, reg: %02x, val: %02x\n",
30 KBUILD_MODNAME, reg, val);
31 return -EREMOTEIO;
32 }
33 return 0;
34}
35
36static int fc0012_readreg(struct fc0012_priv *priv, u8 reg, u8 *val)
37{
38 struct i2c_msg msg[2] = {
39 { .addr = priv->cfg->i2c_address, .flags = 0,
40 .buf = ®, .len = 1 },
41 { .addr = priv->cfg->i2c_address, .flags = I2C_M_RD,
42 .buf = val, .len = 1 },
43 };
44
45 if (i2c_transfer(priv->i2c, msg, 2) != 2) {
46 dev_err(&priv->i2c->dev,
47 "%s: I2C read reg failed, reg: %02x\n",
48 KBUILD_MODNAME, reg);
49 return -EREMOTEIO;
50 }
51 return 0;
52}
53
54static void fc0012_release(struct dvb_frontend *fe)
55{
56 kfree(fe->tuner_priv);
57 fe->tuner_priv = NULL;
58}
59
60static int fc0012_init(struct dvb_frontend *fe)
61{
62 struct fc0012_priv *priv = fe->tuner_priv;
63 int i, ret = 0;
64 unsigned char reg[] = {
65 0x00,
66 0x05,
67 0x10,
68 0x00,
69 0x00,
70 0x0f,
71 0x00,
72 0x00,
73 0xff,
74
75 0x6e,
76 0xb8,
77 0x82,
78
79 0xfc,
80 0x02,
81 0x00,
82 0x00,
83 0x00,
84 0x00,
85 0x1f,
86 0x08,
87
88 0x00,
89 0x04,
90 };
91
92 switch (priv->cfg->xtal_freq) {
93 case FC_XTAL_27_MHZ:
94 case FC_XTAL_28_8_MHZ:
95 reg[0x07] |= 0x20;
96 break;
97 case FC_XTAL_36_MHZ:
98 default:
99 break;
100 }
101
102 if (priv->cfg->dual_master)
103 reg[0x0c] |= 0x02;
104
105 if (priv->cfg->loop_through)
106 reg[0x09] |= 0x01;
107
108 if (fe->ops.i2c_gate_ctrl)
109 fe->ops.i2c_gate_ctrl(fe, 1);
110
111 for (i = 1; i < sizeof(reg); i++) {
112 ret = fc0012_writereg(priv, i, reg[i]);
113 if (ret)
114 break;
115 }
116
117 if (fe->ops.i2c_gate_ctrl)
118 fe->ops.i2c_gate_ctrl(fe, 0);
119
120 if (ret)
121 dev_err(&priv->i2c->dev, "%s: fc0012_writereg failed: %d\n",
122 KBUILD_MODNAME, ret);
123
124 return ret;
125}
126
127static int fc0012_set_params(struct dvb_frontend *fe)
128{
129 struct fc0012_priv *priv = fe->tuner_priv;
130 int i, ret = 0;
131 struct dtv_frontend_properties *p = &fe->dtv_property_cache;
132 u32 freq = p->frequency / 1000;
133 u32 delsys = p->delivery_system;
134 unsigned char reg[7], am, pm, multi, tmp;
135 unsigned long f_vco;
136 unsigned short xtal_freq_khz_2, xin, xdiv;
137 bool vco_select = false;
138
139 if (fe->callback) {
140 ret = fe->callback(priv->i2c, DVB_FRONTEND_COMPONENT_TUNER,
141 FC_FE_CALLBACK_VHF_ENABLE, (freq > 300000 ? 0 : 1));
142 if (ret)
143 goto exit;
144 }
145
146 switch (priv->cfg->xtal_freq) {
147 case FC_XTAL_27_MHZ:
148 xtal_freq_khz_2 = 27000 / 2;
149 break;
150 case FC_XTAL_36_MHZ:
151 xtal_freq_khz_2 = 36000 / 2;
152 break;
153 case FC_XTAL_28_8_MHZ:
154 default:
155 xtal_freq_khz_2 = 28800 / 2;
156 break;
157 }
158
159
160 if (freq < 37084) {
161 multi = 96;
162 reg[5] = 0x82;
163 reg[6] = 0x00;
164 } else if (freq < 55625) {
165 multi = 64;
166 reg[5] = 0x82;
167 reg[6] = 0x02;
168 } else if (freq < 74167) {
169 multi = 48;
170 reg[5] = 0x42;
171 reg[6] = 0x00;
172 } else if (freq < 111250) {
173 multi = 32;
174 reg[5] = 0x42;
175 reg[6] = 0x02;
176 } else if (freq < 148334) {
177 multi = 24;
178 reg[5] = 0x22;
179 reg[6] = 0x00;
180 } else if (freq < 222500) {
181 multi = 16;
182 reg[5] = 0x22;
183 reg[6] = 0x02;
184 } else if (freq < 296667) {
185 multi = 12;
186 reg[5] = 0x12;
187 reg[6] = 0x00;
188 } else if (freq < 445000) {
189 multi = 8;
190 reg[5] = 0x12;
191 reg[6] = 0x02;
192 } else if (freq < 593334) {
193 multi = 6;
194 reg[5] = 0x0a;
195 reg[6] = 0x00;
196 } else {
197 multi = 4;
198 reg[5] = 0x0a;
199 reg[6] = 0x02;
200 }
201
202 f_vco = freq * multi;
203
204 if (f_vco >= 3060000) {
205 reg[6] |= 0x08;
206 vco_select = true;
207 }
208
209 if (freq >= 45000) {
210
211 xdiv = (unsigned short)(f_vco / xtal_freq_khz_2);
212 if ((f_vco - xdiv * xtal_freq_khz_2) >= (xtal_freq_khz_2 / 2))
213 xdiv++;
214
215 pm = (unsigned char)(xdiv / 8);
216 am = (unsigned char)(xdiv - (8 * pm));
217
218 if (am < 2) {
219 reg[1] = am + 8;
220 reg[2] = pm - 1;
221 } else {
222 reg[1] = am;
223 reg[2] = pm;
224 }
225 } else {
226
227 reg[1] = 0x06;
228 reg[2] = 0x11;
229 }
230
231
232 reg[6] |= 0x20;
233
234
235
236 xin = (unsigned short)(f_vco - (f_vco / xtal_freq_khz_2) * xtal_freq_khz_2);
237 xin = (xin << 15) / xtal_freq_khz_2;
238 if (xin >= 16384)
239 xin += 32768;
240
241 reg[3] = xin >> 8;
242 reg[4] = xin & 0xff;
243
244 if (delsys == SYS_DVBT) {
245 reg[6] &= 0x3f;
246 switch (p->bandwidth_hz) {
247 case 6000000:
248 reg[6] |= 0x80;
249 break;
250 case 7000000:
251 reg[6] |= 0x40;
252 break;
253 case 8000000:
254 default:
255 break;
256 }
257 } else {
258 dev_err(&priv->i2c->dev, "%s: modulation type not supported!\n",
259 KBUILD_MODNAME);
260 return -EINVAL;
261 }
262
263
264 reg[5] |= 0x07;
265
266 if (fe->ops.i2c_gate_ctrl)
267 fe->ops.i2c_gate_ctrl(fe, 1);
268
269 for (i = 1; i <= 6; i++) {
270 ret = fc0012_writereg(priv, i, reg[i]);
271 if (ret)
272 goto exit;
273 }
274
275
276 ret = fc0012_writereg(priv, 0x0e, 0x80);
277 if (!ret)
278 ret = fc0012_writereg(priv, 0x0e, 0x00);
279
280
281 if (!ret)
282 ret = fc0012_writereg(priv, 0x0e, 0x00);
283
284 if (!ret) {
285 msleep(10);
286 ret = fc0012_readreg(priv, 0x0e, &tmp);
287 }
288 if (ret)
289 goto exit;
290
291
292 tmp &= 0x3f;
293
294 if (vco_select) {
295 if (tmp > 0x3c) {
296 reg[6] &= ~0x08;
297 ret = fc0012_writereg(priv, 0x06, reg[6]);
298 if (!ret)
299 ret = fc0012_writereg(priv, 0x0e, 0x80);
300 if (!ret)
301 ret = fc0012_writereg(priv, 0x0e, 0x00);
302 }
303 } else {
304 if (tmp < 0x02) {
305 reg[6] |= 0x08;
306 ret = fc0012_writereg(priv, 0x06, reg[6]);
307 if (!ret)
308 ret = fc0012_writereg(priv, 0x0e, 0x80);
309 if (!ret)
310 ret = fc0012_writereg(priv, 0x0e, 0x00);
311 }
312 }
313
314 priv->frequency = p->frequency;
315 priv->bandwidth = p->bandwidth_hz;
316
317exit:
318 if (fe->ops.i2c_gate_ctrl)
319 fe->ops.i2c_gate_ctrl(fe, 0);
320 if (ret)
321 dev_warn(&priv->i2c->dev, "%s: %s failed: %d\n",
322 KBUILD_MODNAME, __func__, ret);
323 return ret;
324}
325
326static int fc0012_get_frequency(struct dvb_frontend *fe, u32 *frequency)
327{
328 struct fc0012_priv *priv = fe->tuner_priv;
329 *frequency = priv->frequency;
330 return 0;
331}
332
333static int fc0012_get_if_frequency(struct dvb_frontend *fe, u32 *frequency)
334{
335 *frequency = 0;
336 return 0;
337}
338
339static int fc0012_get_bandwidth(struct dvb_frontend *fe, u32 *bandwidth)
340{
341 struct fc0012_priv *priv = fe->tuner_priv;
342 *bandwidth = priv->bandwidth;
343 return 0;
344}
345
346#define INPUT_ADC_LEVEL -8
347
348static int fc0012_get_rf_strength(struct dvb_frontend *fe, u16 *strength)
349{
350 struct fc0012_priv *priv = fe->tuner_priv;
351 int ret;
352 unsigned char tmp;
353 int int_temp, lna_gain, int_lna, tot_agc_gain, power;
354 static const int fc0012_lna_gain_table[] = {
355
356 -63, -58, -99, -73,
357 -63, -65, -54, -60,
358
359 71, 70, 68, 67,
360 65, 63, 61, 58,
361
362 197, 191, 188, 186,
363 184, 182, 181, 179,
364 };
365
366 if (fe->ops.i2c_gate_ctrl)
367 fe->ops.i2c_gate_ctrl(fe, 1);
368
369 ret = fc0012_writereg(priv, 0x12, 0x00);
370 if (ret)
371 goto err;
372
373 ret = fc0012_readreg(priv, 0x12, &tmp);
374 if (ret)
375 goto err;
376 int_temp = tmp;
377
378 ret = fc0012_readreg(priv, 0x13, &tmp);
379 if (ret)
380 goto err;
381 lna_gain = tmp & 0x1f;
382
383 if (fe->ops.i2c_gate_ctrl)
384 fe->ops.i2c_gate_ctrl(fe, 0);
385
386 if (lna_gain < ARRAY_SIZE(fc0012_lna_gain_table)) {
387 int_lna = fc0012_lna_gain_table[lna_gain];
388 tot_agc_gain = (abs((int_temp >> 5) - 7) - 2 +
389 (int_temp & 0x1f)) * 2;
390 power = INPUT_ADC_LEVEL - tot_agc_gain - int_lna / 10;
391
392 if (power >= 45)
393 *strength = 255;
394 else if (power < -95)
395 *strength = 0;
396 else
397 *strength = (power + 95) * 255 / 140;
398
399 *strength |= *strength << 8;
400 } else {
401 ret = -1;
402 }
403
404 goto exit;
405
406err:
407 if (fe->ops.i2c_gate_ctrl)
408 fe->ops.i2c_gate_ctrl(fe, 0);
409exit:
410 if (ret)
411 dev_warn(&priv->i2c->dev, "%s: %s failed: %d\n",
412 KBUILD_MODNAME, __func__, ret);
413 return ret;
414}
415
416static const struct dvb_tuner_ops fc0012_tuner_ops = {
417 .info = {
418 .name = "Fitipower FC0012",
419
420 .frequency_min_hz = 37 * MHz,
421 .frequency_max_hz = 862 * MHz,
422 },
423
424 .release = fc0012_release,
425
426 .init = fc0012_init,
427
428 .set_params = fc0012_set_params,
429
430 .get_frequency = fc0012_get_frequency,
431 .get_if_frequency = fc0012_get_if_frequency,
432 .get_bandwidth = fc0012_get_bandwidth,
433
434 .get_rf_strength = fc0012_get_rf_strength,
435};
436
437struct dvb_frontend *fc0012_attach(struct dvb_frontend *fe,
438 struct i2c_adapter *i2c, const struct fc0012_config *cfg)
439{
440 struct fc0012_priv *priv;
441 int ret;
442 u8 chip_id;
443
444 if (fe->ops.i2c_gate_ctrl)
445 fe->ops.i2c_gate_ctrl(fe, 1);
446
447 priv = kzalloc(sizeof(struct fc0012_priv), GFP_KERNEL);
448 if (!priv) {
449 ret = -ENOMEM;
450 dev_err(&i2c->dev, "%s: kzalloc() failed\n", KBUILD_MODNAME);
451 goto err;
452 }
453
454 priv->cfg = cfg;
455 priv->i2c = i2c;
456
457
458 ret = fc0012_readreg(priv, 0x00, &chip_id);
459 if (ret < 0)
460 goto err;
461
462 dev_dbg(&i2c->dev, "%s: chip_id=%02x\n", __func__, chip_id);
463
464 switch (chip_id) {
465 case 0xa1:
466 break;
467 default:
468 ret = -ENODEV;
469 goto err;
470 }
471
472 dev_info(&i2c->dev, "%s: Fitipower FC0012 successfully identified\n",
473 KBUILD_MODNAME);
474
475 if (priv->cfg->loop_through) {
476 ret = fc0012_writereg(priv, 0x09, 0x6f);
477 if (ret < 0)
478 goto err;
479 }
480
481
482
483
484
485 if (priv->cfg->clock_out) {
486 ret = fc0012_writereg(priv, 0x0b, 0x82);
487 if (ret < 0)
488 goto err;
489 }
490
491 fe->tuner_priv = priv;
492 memcpy(&fe->ops.tuner_ops, &fc0012_tuner_ops,
493 sizeof(struct dvb_tuner_ops));
494
495err:
496 if (fe->ops.i2c_gate_ctrl)
497 fe->ops.i2c_gate_ctrl(fe, 0);
498
499 if (ret) {
500 dev_dbg(&i2c->dev, "%s: failed: %d\n", __func__, ret);
501 kfree(priv);
502 return NULL;
503 }
504
505 return fe;
506}
507EXPORT_SYMBOL(fc0012_attach);
508
509MODULE_DESCRIPTION("Fitipower FC0012 silicon tuner driver");
510MODULE_AUTHOR("Hans-Frieder Vogt <hfvogt@gmx.net>");
511MODULE_LICENSE("GPL");
512MODULE_VERSION("0.6");
513