PM / sleep: Asynchronous threads for suspend_noirq
[linux/fpc-iii.git] / drivers / media / dvb-frontends / dib0070.c
blob3b024bfe980aec8ef10cc5f5ae6fb78ff647e68e
1 /*
2 * Linux-DVB Driver for DiBcom's DiB0070 base-band RF Tuner.
4 * Copyright (C) 2005-9 DiBcom (http://www.dibcom.fr/)
6 * This program is free software; you can redistribute it and/or
7 * modify it under the terms of the GNU General Public License as
8 * published by the Free Software Foundation; either version 2 of the
9 * License, or (at your option) any later version.
11 * This program is distributed in the hope that it will be useful, but
12 * WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
17 * You should have received a copy of the GNU General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
22 * This code is more or less generated from another driver, please
23 * excuse some codingstyle oddities.
27 #include <linux/kernel.h>
28 #include <linux/slab.h>
29 #include <linux/i2c.h>
30 #include <linux/mutex.h>
32 #include "dvb_frontend.h"
34 #include "dib0070.h"
35 #include "dibx000_common.h"
37 static int debug;
38 module_param(debug, int, 0644);
39 MODULE_PARM_DESC(debug, "turn on debugging (default: 0)");
41 #define dprintk(args...) do { \
42 if (debug) { \
43 printk(KERN_DEBUG "DiB0070: "); \
44 printk(args); \
45 printk("\n"); \
46 } \
47 } while (0)
49 #define DIB0070_P1D 0x00
50 #define DIB0070_P1F 0x01
51 #define DIB0070_P1G 0x03
52 #define DIB0070S_P1A 0x02
54 struct dib0070_state {
55 struct i2c_adapter *i2c;
56 struct dvb_frontend *fe;
57 const struct dib0070_config *cfg;
58 u16 wbd_ff_offset;
59 u8 revision;
61 enum frontend_tune_state tune_state;
62 u32 current_rf;
64 /* for the captrim binary search */
65 s8 step;
66 u16 adc_diff;
68 s8 captrim;
69 s8 fcaptrim;
70 u16 lo4;
72 const struct dib0070_tuning *current_tune_table_index;
73 const struct dib0070_lna_match *lna_match;
75 u8 wbd_gain_current;
76 u16 wbd_offset_3_3[2];
78 /* for the I2C transfer */
79 struct i2c_msg msg[2];
80 u8 i2c_write_buffer[3];
81 u8 i2c_read_buffer[2];
82 struct mutex i2c_buffer_lock;
85 static u16 dib0070_read_reg(struct dib0070_state *state, u8 reg)
87 u16 ret;
89 if (mutex_lock_interruptible(&state->i2c_buffer_lock) < 0) {
90 dprintk("could not acquire lock");
91 return 0;
94 state->i2c_write_buffer[0] = reg;
96 memset(state->msg, 0, 2 * sizeof(struct i2c_msg));
97 state->msg[0].addr = state->cfg->i2c_address;
98 state->msg[0].flags = 0;
99 state->msg[0].buf = state->i2c_write_buffer;
100 state->msg[0].len = 1;
101 state->msg[1].addr = state->cfg->i2c_address;
102 state->msg[1].flags = I2C_M_RD;
103 state->msg[1].buf = state->i2c_read_buffer;
104 state->msg[1].len = 2;
106 if (i2c_transfer(state->i2c, state->msg, 2) != 2) {
107 printk(KERN_WARNING "DiB0070 I2C read failed\n");
108 ret = 0;
109 } else
110 ret = (state->i2c_read_buffer[0] << 8)
111 | state->i2c_read_buffer[1];
113 mutex_unlock(&state->i2c_buffer_lock);
114 return ret;
117 static int dib0070_write_reg(struct dib0070_state *state, u8 reg, u16 val)
119 int ret;
121 if (mutex_lock_interruptible(&state->i2c_buffer_lock) < 0) {
122 dprintk("could not acquire lock");
123 return -EINVAL;
125 state->i2c_write_buffer[0] = reg;
126 state->i2c_write_buffer[1] = val >> 8;
127 state->i2c_write_buffer[2] = val & 0xff;
129 memset(state->msg, 0, sizeof(struct i2c_msg));
130 state->msg[0].addr = state->cfg->i2c_address;
131 state->msg[0].flags = 0;
132 state->msg[0].buf = state->i2c_write_buffer;
133 state->msg[0].len = 3;
135 if (i2c_transfer(state->i2c, state->msg, 1) != 1) {
136 printk(KERN_WARNING "DiB0070 I2C write failed\n");
137 ret = -EREMOTEIO;
138 } else
139 ret = 0;
141 mutex_unlock(&state->i2c_buffer_lock);
142 return ret;
145 #define HARD_RESET(state) do { \
146 state->cfg->sleep(state->fe, 0); \
147 if (state->cfg->reset) { \
148 state->cfg->reset(state->fe,1); msleep(10); \
149 state->cfg->reset(state->fe,0); msleep(10); \
151 } while (0)
153 static int dib0070_set_bandwidth(struct dvb_frontend *fe)
155 struct dib0070_state *state = fe->tuner_priv;
156 u16 tmp = dib0070_read_reg(state, 0x02) & 0x3fff;
158 if (state->fe->dtv_property_cache.bandwidth_hz/1000 > 7000)
159 tmp |= (0 << 14);
160 else if (state->fe->dtv_property_cache.bandwidth_hz/1000 > 6000)
161 tmp |= (1 << 14);
162 else if (state->fe->dtv_property_cache.bandwidth_hz/1000 > 5000)
163 tmp |= (2 << 14);
164 else
165 tmp |= (3 << 14);
167 dib0070_write_reg(state, 0x02, tmp);
169 /* sharpen the BB filter in ISDB-T to have higher immunity to adjacent channels */
170 if (state->fe->dtv_property_cache.delivery_system == SYS_ISDBT) {
171 u16 value = dib0070_read_reg(state, 0x17);
173 dib0070_write_reg(state, 0x17, value & 0xfffc);
174 tmp = dib0070_read_reg(state, 0x01) & 0x01ff;
175 dib0070_write_reg(state, 0x01, tmp | (60 << 9));
177 dib0070_write_reg(state, 0x17, value);
179 return 0;
182 static int dib0070_captrim(struct dib0070_state *state, enum frontend_tune_state *tune_state)
184 int8_t step_sign;
185 u16 adc;
186 int ret = 0;
188 if (*tune_state == CT_TUNER_STEP_0) {
190 dib0070_write_reg(state, 0x0f, 0xed10);
191 dib0070_write_reg(state, 0x17, 0x0034);
193 dib0070_write_reg(state, 0x18, 0x0032);
194 state->step = state->captrim = state->fcaptrim = 64;
195 state->adc_diff = 3000;
196 ret = 20;
198 *tune_state = CT_TUNER_STEP_1;
199 } else if (*tune_state == CT_TUNER_STEP_1) {
200 state->step /= 2;
201 dib0070_write_reg(state, 0x14, state->lo4 | state->captrim);
202 ret = 15;
204 *tune_state = CT_TUNER_STEP_2;
205 } else if (*tune_state == CT_TUNER_STEP_2) {
207 adc = dib0070_read_reg(state, 0x19);
209 dprintk("CAPTRIM=%hd; ADC = %hd (ADC) & %dmV", state->captrim, adc, (u32) adc*(u32)1800/(u32)1024);
211 if (adc >= 400) {
212 adc -= 400;
213 step_sign = -1;
214 } else {
215 adc = 400 - adc;
216 step_sign = 1;
219 if (adc < state->adc_diff) {
220 dprintk("CAPTRIM=%hd is closer to target (%hd/%hd)", state->captrim, adc, state->adc_diff);
221 state->adc_diff = adc;
222 state->fcaptrim = state->captrim;
227 state->captrim += (step_sign * state->step);
229 if (state->step >= 1)
230 *tune_state = CT_TUNER_STEP_1;
231 else
232 *tune_state = CT_TUNER_STEP_3;
234 } else if (*tune_state == CT_TUNER_STEP_3) {
235 dib0070_write_reg(state, 0x14, state->lo4 | state->fcaptrim);
236 dib0070_write_reg(state, 0x18, 0x07ff);
237 *tune_state = CT_TUNER_STEP_4;
240 return ret;
243 static int dib0070_set_ctrl_lo5(struct dvb_frontend *fe, u8 vco_bias_trim, u8 hf_div_trim, u8 cp_current, u8 third_order_filt)
245 struct dib0070_state *state = fe->tuner_priv;
246 u16 lo5 = (third_order_filt << 14) | (0 << 13) | (1 << 12) | (3 << 9) | (cp_current << 6) | (hf_div_trim << 3) | (vco_bias_trim << 0);
247 dprintk("CTRL_LO5: 0x%x", lo5);
248 return dib0070_write_reg(state, 0x15, lo5);
251 void dib0070_ctrl_agc_filter(struct dvb_frontend *fe, u8 open)
253 struct dib0070_state *state = fe->tuner_priv;
255 if (open) {
256 dib0070_write_reg(state, 0x1b, 0xff00);
257 dib0070_write_reg(state, 0x1a, 0x0000);
258 } else {
259 dib0070_write_reg(state, 0x1b, 0x4112);
260 if (state->cfg->vga_filter != 0) {
261 dib0070_write_reg(state, 0x1a, state->cfg->vga_filter);
262 dprintk("vga filter register is set to %x", state->cfg->vga_filter);
263 } else
264 dib0070_write_reg(state, 0x1a, 0x0009);
268 EXPORT_SYMBOL(dib0070_ctrl_agc_filter);
269 struct dib0070_tuning {
270 u32 max_freq; /* for every frequency less than or equal to that field: this information is correct */
271 u8 switch_trim;
272 u8 vco_band;
273 u8 hfdiv;
274 u8 vco_multi;
275 u8 presc;
276 u8 wbdmux;
277 u16 tuner_enable;
280 struct dib0070_lna_match {
281 u32 max_freq; /* for every frequency less than or equal to that field: this information is correct */
282 u8 lna_band;
285 static const struct dib0070_tuning dib0070s_tuning_table[] = {
286 { 570000, 2, 1, 3, 6, 6, 2, 0x4000 | 0x0800 }, /* UHF */
287 { 700000, 2, 0, 2, 4, 2, 2, 0x4000 | 0x0800 },
288 { 863999, 2, 1, 2, 4, 2, 2, 0x4000 | 0x0800 },
289 { 1500000, 0, 1, 1, 2, 2, 4, 0x2000 | 0x0400 }, /* LBAND */
290 { 1600000, 0, 1, 1, 2, 2, 4, 0x2000 | 0x0400 },
291 { 2000000, 0, 1, 1, 2, 2, 4, 0x2000 | 0x0400 },
292 { 0xffffffff, 0, 0, 8, 1, 2, 1, 0x8000 | 0x1000 }, /* SBAND */
295 static const struct dib0070_tuning dib0070_tuning_table[] = {
296 { 115000, 1, 0, 7, 24, 2, 1, 0x8000 | 0x1000 }, /* FM below 92MHz cannot be tuned */
297 { 179500, 1, 0, 3, 16, 2, 1, 0x8000 | 0x1000 }, /* VHF */
298 { 189999, 1, 1, 3, 16, 2, 1, 0x8000 | 0x1000 },
299 { 250000, 1, 0, 6, 12, 2, 1, 0x8000 | 0x1000 },
300 { 569999, 2, 1, 5, 6, 2, 2, 0x4000 | 0x0800 }, /* UHF */
301 { 699999, 2, 0, 1, 4, 2, 2, 0x4000 | 0x0800 },
302 { 863999, 2, 1, 1, 4, 2, 2, 0x4000 | 0x0800 },
303 { 0xffffffff, 0, 1, 0, 2, 2, 4, 0x2000 | 0x0400 }, /* LBAND or everything higher than UHF */
306 static const struct dib0070_lna_match dib0070_lna_flip_chip[] = {
307 { 180000, 0 }, /* VHF */
308 { 188000, 1 },
309 { 196400, 2 },
310 { 250000, 3 },
311 { 550000, 0 }, /* UHF */
312 { 590000, 1 },
313 { 666000, 3 },
314 { 864000, 5 },
315 { 1500000, 0 }, /* LBAND or everything higher than UHF */
316 { 1600000, 1 },
317 { 2000000, 3 },
318 { 0xffffffff, 7 },
321 static const struct dib0070_lna_match dib0070_lna[] = {
322 { 180000, 0 }, /* VHF */
323 { 188000, 1 },
324 { 196400, 2 },
325 { 250000, 3 },
326 { 550000, 2 }, /* UHF */
327 { 650000, 3 },
328 { 750000, 5 },
329 { 850000, 6 },
330 { 864000, 7 },
331 { 1500000, 0 }, /* LBAND or everything higher than UHF */
332 { 1600000, 1 },
333 { 2000000, 3 },
334 { 0xffffffff, 7 },
337 #define LPF 100
338 static int dib0070_tune_digital(struct dvb_frontend *fe)
340 struct dib0070_state *state = fe->tuner_priv;
342 const struct dib0070_tuning *tune;
343 const struct dib0070_lna_match *lna_match;
345 enum frontend_tune_state *tune_state = &state->tune_state;
346 int ret = 10; /* 1ms is the default delay most of the time */
348 u8 band = (u8)BAND_OF_FREQUENCY(fe->dtv_property_cache.frequency/1000);
349 u32 freq = fe->dtv_property_cache.frequency/1000 + (band == BAND_VHF ? state->cfg->freq_offset_khz_vhf : state->cfg->freq_offset_khz_uhf);
351 #ifdef CONFIG_SYS_ISDBT
352 if (state->fe->dtv_property_cache.delivery_system == SYS_ISDBT && state->fe->dtv_property_cache.isdbt_sb_mode == 1)
353 if (((state->fe->dtv_property_cache.isdbt_sb_segment_count % 2)
354 && (state->fe->dtv_property_cache.isdbt_sb_segment_idx == ((state->fe->dtv_property_cache.isdbt_sb_segment_count / 2) + 1)))
355 || (((state->fe->dtv_property_cache.isdbt_sb_segment_count % 2) == 0)
356 && (state->fe->dtv_property_cache.isdbt_sb_segment_idx == (state->fe->dtv_property_cache.isdbt_sb_segment_count / 2)))
357 || (((state->fe->dtv_property_cache.isdbt_sb_segment_count % 2) == 0)
358 && (state->fe->dtv_property_cache.isdbt_sb_segment_idx == ((state->fe->dtv_property_cache.isdbt_sb_segment_count / 2) + 1))))
359 freq += 850;
360 #endif
361 if (state->current_rf != freq) {
363 switch (state->revision) {
364 case DIB0070S_P1A:
365 tune = dib0070s_tuning_table;
366 lna_match = dib0070_lna;
367 break;
368 default:
369 tune = dib0070_tuning_table;
370 if (state->cfg->flip_chip)
371 lna_match = dib0070_lna_flip_chip;
372 else
373 lna_match = dib0070_lna;
374 break;
376 while (freq > tune->max_freq) /* find the right one */
377 tune++;
378 while (freq > lna_match->max_freq) /* find the right one */
379 lna_match++;
381 state->current_tune_table_index = tune;
382 state->lna_match = lna_match;
385 if (*tune_state == CT_TUNER_START) {
386 dprintk("Tuning for Band: %hd (%d kHz)", band, freq);
387 if (state->current_rf != freq) {
388 u8 REFDIV;
389 u32 FBDiv, Rest, FREF, VCOF_kHz;
390 u8 Den;
392 state->current_rf = freq;
393 state->lo4 = (state->current_tune_table_index->vco_band << 11) | (state->current_tune_table_index->hfdiv << 7);
396 dib0070_write_reg(state, 0x17, 0x30);
399 VCOF_kHz = state->current_tune_table_index->vco_multi * freq * 2;
401 switch (band) {
402 case BAND_VHF:
403 REFDIV = (u8) ((state->cfg->clock_khz + 9999) / 10000);
404 break;
405 case BAND_FM:
406 REFDIV = (u8) ((state->cfg->clock_khz) / 1000);
407 break;
408 default:
409 REFDIV = (u8) (state->cfg->clock_khz / 10000);
410 break;
412 FREF = state->cfg->clock_khz / REFDIV;
416 switch (state->revision) {
417 case DIB0070S_P1A:
418 FBDiv = (VCOF_kHz / state->current_tune_table_index->presc / FREF);
419 Rest = (VCOF_kHz / state->current_tune_table_index->presc) - FBDiv * FREF;
420 break;
422 case DIB0070_P1G:
423 case DIB0070_P1F:
424 default:
425 FBDiv = (freq / (FREF / 2));
426 Rest = 2 * freq - FBDiv * FREF;
427 break;
430 if (Rest < LPF)
431 Rest = 0;
432 else if (Rest < 2 * LPF)
433 Rest = 2 * LPF;
434 else if (Rest > (FREF - LPF)) {
435 Rest = 0;
436 FBDiv += 1;
437 } else if (Rest > (FREF - 2 * LPF))
438 Rest = FREF - 2 * LPF;
439 Rest = (Rest * 6528) / (FREF / 10);
441 Den = 1;
442 if (Rest > 0) {
443 state->lo4 |= (1 << 14) | (1 << 12);
444 Den = 255;
448 dib0070_write_reg(state, 0x11, (u16)FBDiv);
449 dib0070_write_reg(state, 0x12, (Den << 8) | REFDIV);
450 dib0070_write_reg(state, 0x13, (u16) Rest);
452 if (state->revision == DIB0070S_P1A) {
454 if (band == BAND_SBAND) {
455 dib0070_set_ctrl_lo5(fe, 2, 4, 3, 0);
456 dib0070_write_reg(state, 0x1d, 0xFFFF);
457 } else
458 dib0070_set_ctrl_lo5(fe, 5, 4, 3, 1);
461 dib0070_write_reg(state, 0x20,
462 0x0040 | 0x0020 | 0x0010 | 0x0008 | 0x0002 | 0x0001 | state->current_tune_table_index->tuner_enable);
464 dprintk("REFDIV: %hd, FREF: %d", REFDIV, FREF);
465 dprintk("FBDIV: %d, Rest: %d", FBDiv, Rest);
466 dprintk("Num: %hd, Den: %hd, SD: %hd", (u16) Rest, Den, (state->lo4 >> 12) & 0x1);
467 dprintk("HFDIV code: %hd", state->current_tune_table_index->hfdiv);
468 dprintk("VCO = %hd", state->current_tune_table_index->vco_band);
469 dprintk("VCOF: ((%hd*%d) << 1))", state->current_tune_table_index->vco_multi, freq);
471 *tune_state = CT_TUNER_STEP_0;
472 } else { /* we are already tuned to this frequency - the configuration is correct */
473 ret = 50; /* wakeup time */
474 *tune_state = CT_TUNER_STEP_5;
476 } else if ((*tune_state > CT_TUNER_START) && (*tune_state < CT_TUNER_STEP_4)) {
478 ret = dib0070_captrim(state, tune_state);
480 } else if (*tune_state == CT_TUNER_STEP_4) {
481 const struct dib0070_wbd_gain_cfg *tmp = state->cfg->wbd_gain;
482 if (tmp != NULL) {
483 while (freq/1000 > tmp->freq) /* find the right one */
484 tmp++;
485 dib0070_write_reg(state, 0x0f,
486 (0 << 15) | (1 << 14) | (3 << 12)
487 | (tmp->wbd_gain_val << 9) | (0 << 8) | (1 << 7)
488 | (state->current_tune_table_index->wbdmux << 0));
489 state->wbd_gain_current = tmp->wbd_gain_val;
490 } else {
491 dib0070_write_reg(state, 0x0f,
492 (0 << 15) | (1 << 14) | (3 << 12) | (6 << 9) | (0 << 8) | (1 << 7) | (state->current_tune_table_index->
493 wbdmux << 0));
494 state->wbd_gain_current = 6;
497 dib0070_write_reg(state, 0x06, 0x3fff);
498 dib0070_write_reg(state, 0x07,
499 (state->current_tune_table_index->switch_trim << 11) | (7 << 8) | (state->lna_match->lna_band << 3) | (3 << 0));
500 dib0070_write_reg(state, 0x08, (state->lna_match->lna_band << 10) | (3 << 7) | (127));
501 dib0070_write_reg(state, 0x0d, 0x0d80);
504 dib0070_write_reg(state, 0x18, 0x07ff);
505 dib0070_write_reg(state, 0x17, 0x0033);
508 *tune_state = CT_TUNER_STEP_5;
509 } else if (*tune_state == CT_TUNER_STEP_5) {
510 dib0070_set_bandwidth(fe);
511 *tune_state = CT_TUNER_STOP;
512 } else {
513 ret = FE_CALLBACK_TIME_NEVER; /* tuner finished, time to call again infinite */
515 return ret;
519 static int dib0070_tune(struct dvb_frontend *fe)
521 struct dib0070_state *state = fe->tuner_priv;
522 uint32_t ret;
524 state->tune_state = CT_TUNER_START;
526 do {
527 ret = dib0070_tune_digital(fe);
528 if (ret != FE_CALLBACK_TIME_NEVER)
529 msleep(ret/10);
530 else
531 break;
532 } while (state->tune_state != CT_TUNER_STOP);
534 return 0;
537 static int dib0070_wakeup(struct dvb_frontend *fe)
539 struct dib0070_state *state = fe->tuner_priv;
540 if (state->cfg->sleep)
541 state->cfg->sleep(fe, 0);
542 return 0;
545 static int dib0070_sleep(struct dvb_frontend *fe)
547 struct dib0070_state *state = fe->tuner_priv;
548 if (state->cfg->sleep)
549 state->cfg->sleep(fe, 1);
550 return 0;
553 u8 dib0070_get_rf_output(struct dvb_frontend *fe)
555 struct dib0070_state *state = fe->tuner_priv;
556 return (dib0070_read_reg(state, 0x07) >> 11) & 0x3;
558 EXPORT_SYMBOL(dib0070_get_rf_output);
560 int dib0070_set_rf_output(struct dvb_frontend *fe, u8 no)
562 struct dib0070_state *state = fe->tuner_priv;
563 u16 rxrf2 = dib0070_read_reg(state, 0x07) & 0xfe7ff;
564 if (no > 3)
565 no = 3;
566 if (no < 1)
567 no = 1;
568 return dib0070_write_reg(state, 0x07, rxrf2 | (no << 11));
570 EXPORT_SYMBOL(dib0070_set_rf_output);
572 static const u16 dib0070_p1f_defaults[] =
575 7, 0x02,
576 0x0008,
577 0x0000,
578 0x0000,
579 0x0000,
580 0x0000,
581 0x0002,
582 0x0100,
584 3, 0x0d,
585 0x0d80,
586 0x0001,
587 0x0000,
589 4, 0x11,
590 0x0000,
591 0x0103,
592 0x0000,
593 0x0000,
595 3, 0x16,
596 0x0004 | 0x0040,
597 0x0030,
598 0x07ff,
600 6, 0x1b,
601 0x4112,
602 0xff00,
603 0xc07f,
604 0x0000,
605 0x0180,
606 0x4000 | 0x0800 | 0x0040 | 0x0020 | 0x0010 | 0x0008 | 0x0002 | 0x0001,
611 static u16 dib0070_read_wbd_offset(struct dib0070_state *state, u8 gain)
613 u16 tuner_en = dib0070_read_reg(state, 0x20);
614 u16 offset;
616 dib0070_write_reg(state, 0x18, 0x07ff);
617 dib0070_write_reg(state, 0x20, 0x0800 | 0x4000 | 0x0040 | 0x0020 | 0x0010 | 0x0008 | 0x0002 | 0x0001);
618 dib0070_write_reg(state, 0x0f, (1 << 14) | (2 << 12) | (gain << 9) | (1 << 8) | (1 << 7) | (0 << 0));
619 msleep(9);
620 offset = dib0070_read_reg(state, 0x19);
621 dib0070_write_reg(state, 0x20, tuner_en);
622 return offset;
625 static void dib0070_wbd_offset_calibration(struct dib0070_state *state)
627 u8 gain;
628 for (gain = 6; gain < 8; gain++) {
629 state->wbd_offset_3_3[gain - 6] = ((dib0070_read_wbd_offset(state, gain) * 8 * 18 / 33 + 1) / 2);
630 dprintk("Gain: %d, WBDOffset (3.3V) = %hd", gain, state->wbd_offset_3_3[gain-6]);
634 u16 dib0070_wbd_offset(struct dvb_frontend *fe)
636 struct dib0070_state *state = fe->tuner_priv;
637 const struct dib0070_wbd_gain_cfg *tmp = state->cfg->wbd_gain;
638 u32 freq = fe->dtv_property_cache.frequency/1000;
640 if (tmp != NULL) {
641 while (freq/1000 > tmp->freq) /* find the right one */
642 tmp++;
643 state->wbd_gain_current = tmp->wbd_gain_val;
644 } else
645 state->wbd_gain_current = 6;
647 return state->wbd_offset_3_3[state->wbd_gain_current - 6];
649 EXPORT_SYMBOL(dib0070_wbd_offset);
651 #define pgm_read_word(w) (*w)
652 static int dib0070_reset(struct dvb_frontend *fe)
654 struct dib0070_state *state = fe->tuner_priv;
655 u16 l, r, *n;
657 HARD_RESET(state);
660 #ifndef FORCE_SBAND_TUNER
661 if ((dib0070_read_reg(state, 0x22) >> 9) & 0x1)
662 state->revision = (dib0070_read_reg(state, 0x1f) >> 8) & 0xff;
663 else
664 #else
665 #warning forcing SBAND
666 #endif
667 state->revision = DIB0070S_P1A;
669 /* P1F or not */
670 dprintk("Revision: %x", state->revision);
672 if (state->revision == DIB0070_P1D) {
673 dprintk("Error: this driver is not to be used meant for P1D or earlier");
674 return -EINVAL;
677 n = (u16 *) dib0070_p1f_defaults;
678 l = pgm_read_word(n++);
679 while (l) {
680 r = pgm_read_word(n++);
681 do {
682 dib0070_write_reg(state, (u8)r, pgm_read_word(n++));
683 r++;
684 } while (--l);
685 l = pgm_read_word(n++);
688 if (state->cfg->force_crystal_mode != 0)
689 r = state->cfg->force_crystal_mode;
690 else if (state->cfg->clock_khz >= 24000)
691 r = 1;
692 else
693 r = 2;
696 r |= state->cfg->osc_buffer_state << 3;
698 dib0070_write_reg(state, 0x10, r);
699 dib0070_write_reg(state, 0x1f, (1 << 8) | ((state->cfg->clock_pad_drive & 0xf) << 5));
701 if (state->cfg->invert_iq) {
702 r = dib0070_read_reg(state, 0x02) & 0xffdf;
703 dib0070_write_reg(state, 0x02, r | (1 << 5));
706 if (state->revision == DIB0070S_P1A)
707 dib0070_set_ctrl_lo5(fe, 2, 4, 3, 0);
708 else
709 dib0070_set_ctrl_lo5(fe, 5, 4, state->cfg->charge_pump, state->cfg->enable_third_order_filter);
711 dib0070_write_reg(state, 0x01, (54 << 9) | 0xc8);
713 dib0070_wbd_offset_calibration(state);
715 return 0;
718 static int dib0070_get_frequency(struct dvb_frontend *fe, u32 *frequency)
720 struct dib0070_state *state = fe->tuner_priv;
722 *frequency = 1000 * state->current_rf;
723 return 0;
726 static int dib0070_release(struct dvb_frontend *fe)
728 kfree(fe->tuner_priv);
729 fe->tuner_priv = NULL;
730 return 0;
733 static const struct dvb_tuner_ops dib0070_ops = {
734 .info = {
735 .name = "DiBcom DiB0070",
736 .frequency_min = 45000000,
737 .frequency_max = 860000000,
738 .frequency_step = 1000,
740 .release = dib0070_release,
742 .init = dib0070_wakeup,
743 .sleep = dib0070_sleep,
744 .set_params = dib0070_tune,
746 .get_frequency = dib0070_get_frequency,
747 // .get_bandwidth = dib0070_get_bandwidth
750 struct dvb_frontend *dib0070_attach(struct dvb_frontend *fe, struct i2c_adapter *i2c, struct dib0070_config *cfg)
752 struct dib0070_state *state = kzalloc(sizeof(struct dib0070_state), GFP_KERNEL);
753 if (state == NULL)
754 return NULL;
756 state->cfg = cfg;
757 state->i2c = i2c;
758 state->fe = fe;
759 mutex_init(&state->i2c_buffer_lock);
760 fe->tuner_priv = state;
762 if (dib0070_reset(fe) != 0)
763 goto free_mem;
765 printk(KERN_INFO "DiB0070: successfully identified\n");
766 memcpy(&fe->ops.tuner_ops, &dib0070_ops, sizeof(struct dvb_tuner_ops));
768 fe->tuner_priv = state;
769 return fe;
771 free_mem:
772 kfree(state);
773 fe->tuner_priv = NULL;
774 return NULL;
776 EXPORT_SYMBOL(dib0070_attach);
778 MODULE_AUTHOR("Patrick Boettcher <pboettcher@dibcom.fr>");
779 MODULE_DESCRIPTION("Driver for the DiBcom 0070 base-band RF Tuner");
780 MODULE_LICENSE("GPL");