blob: f2c8faac6f36426e0c7beb3f361e223b3b12cfcd [file] [log] [blame]
Andrew de Quincey6bca3582006-08-08 09:10:10 -03001 /*
2 Driver for Philips tda10086 DVBS Demodulator
3
4 (c) 2006 Andrew de Quincey
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
15 GNU General Public License for more details.
16
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.
20
21 */
22
23#include <linux/init.h>
24#include <linux/module.h>
Andrew de Quincey6bca3582006-08-08 09:10:10 -030025#include <linux/device.h>
26#include <linux/jiffies.h>
27#include <linux/string.h>
28#include <linux/slab.h>
29
30#include "dvb_frontend.h"
31#include "tda10086.h"
32
33#define SACLK 96000000
34
35struct tda10086_state {
36 struct i2c_adapter* i2c;
37 const struct tda10086_config* config;
38 struct dvb_frontend frontend;
39
40 /* private demod data */
41 u32 frequency;
42 u32 symbol_rate;
Oliver Endrissc6604152007-05-28 18:06:27 -030043 bool has_lock;
Andrew de Quincey6bca3582006-08-08 09:10:10 -030044};
45
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -030046static int debug;
Andrew de Quincey6bca3582006-08-08 09:10:10 -030047#define dprintk(args...) \
48 do { \
49 if (debug) printk(KERN_DEBUG "tda10086: " args); \
50 } while (0)
51
52static int tda10086_write_byte(struct tda10086_state *state, int reg, int data)
53{
54 int ret;
55 u8 b0[] = { reg, data };
56 struct i2c_msg msg = { .flags = 0, .buf = b0, .len = 2 };
57
58 msg.addr = state->config->demod_address;
59 ret = i2c_transfer(state->i2c, &msg, 1);
60
61 if (ret != 1)
62 dprintk("%s: error reg=0x%x, data=0x%x, ret=%i\n",
Harvey Harrison271ddbf2008-04-08 23:20:00 -030063 __func__, reg, data, ret);
Andrew de Quincey6bca3582006-08-08 09:10:10 -030064
65 return (ret != 1) ? ret : 0;
66}
67
68static int tda10086_read_byte(struct tda10086_state *state, int reg)
69{
70 int ret;
71 u8 b0[] = { reg };
72 u8 b1[] = { 0 };
73 struct i2c_msg msg[] = {{ .flags = 0, .buf = b0, .len = 1 },
74 { .flags = I2C_M_RD, .buf = b1, .len = 1 }};
75
76 msg[0].addr = state->config->demod_address;
77 msg[1].addr = state->config->demod_address;
78 ret = i2c_transfer(state->i2c, msg, 2);
79
80 if (ret != 2) {
Harvey Harrison271ddbf2008-04-08 23:20:00 -030081 dprintk("%s: error reg=0x%x, ret=%i\n", __func__, reg,
Andrew de Quincey6bca3582006-08-08 09:10:10 -030082 ret);
83 return ret;
84 }
85
86 return b1[0];
87}
88
89static int tda10086_write_mask(struct tda10086_state *state, int reg, int mask, int data)
90{
91 int val;
92
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -030093 /* read a byte and check */
Andrew de Quincey6bca3582006-08-08 09:10:10 -030094 val = tda10086_read_byte(state, reg);
95 if (val < 0)
96 return val;
97
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -030098 /* mask if off */
Andrew de Quincey6bca3582006-08-08 09:10:10 -030099 val = val & ~mask;
100 val |= data & 0xff;
101
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300102 /* write it out again */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300103 return tda10086_write_byte(state, reg, val);
104}
105
106static int tda10086_init(struct dvb_frontend* fe)
107{
108 struct tda10086_state* state = fe->demodulator_priv;
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300109 u8 t22k_off = 0x80;
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300110
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300111 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300112
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300113 if (state->config->diseqc_tone)
114 t22k_off = 0;
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300115 /* reset */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300116 tda10086_write_byte(state, 0x00, 0x00);
117 msleep(10);
118
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300119 /* misc setup */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300120 tda10086_write_byte(state, 0x01, 0x94);
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300121 tda10086_write_byte(state, 0x02, 0x35); /* NOTE: TT drivers appear to disable CSWP */
Oliver Endrissc6604152007-05-28 18:06:27 -0300122 tda10086_write_byte(state, 0x03, 0xe4);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300123 tda10086_write_byte(state, 0x04, 0x43);
124 tda10086_write_byte(state, 0x0c, 0x0c);
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300125 tda10086_write_byte(state, 0x1b, 0xb0); /* noise threshold */
126 tda10086_write_byte(state, 0x20, 0x89); /* misc */
127 tda10086_write_byte(state, 0x30, 0x04); /* acquisition period length */
128 tda10086_write_byte(state, 0x32, 0x00); /* irq off */
129 tda10086_write_byte(state, 0x31, 0x56); /* setup AFC */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300130
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300131 /* setup PLL (this assumes SACLK = 96MHz) */
132 tda10086_write_byte(state, 0x55, 0x2c); /* misc PLL setup */
Hartmut Hackmann9a1b04e2008-04-09 23:07:11 -0300133 if (state->config->xtal_freq == TDA10086_XTAL_16M) {
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300134 tda10086_write_byte(state, 0x3a, 0x0b); /* M=12 */
135 tda10086_write_byte(state, 0x3b, 0x01); /* P=2 */
Hartmut Hackmann9a1b04e2008-04-09 23:07:11 -0300136 } else {
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300137 tda10086_write_byte(state, 0x3a, 0x17); /* M=24 */
138 tda10086_write_byte(state, 0x3b, 0x00); /* P=1 */
Hartmut Hackmann9a1b04e2008-04-09 23:07:11 -0300139 }
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300140 tda10086_write_mask(state, 0x55, 0x20, 0x00); /* powerup PLL */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300141
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300142 /* setup TS interface */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300143 tda10086_write_byte(state, 0x11, 0x81);
144 tda10086_write_byte(state, 0x12, 0x81);
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300145 tda10086_write_byte(state, 0x19, 0x40); /* parallel mode A + MSBFIRST */
146 tda10086_write_byte(state, 0x56, 0x80); /* powerdown WPLL - unused in the mode we use */
147 tda10086_write_byte(state, 0x57, 0x08); /* bypass WPLL - unused in the mode we use */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300148 tda10086_write_byte(state, 0x10, 0x2a);
149
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300150 /* setup ADC */
151 tda10086_write_byte(state, 0x58, 0x61); /* ADC setup */
152 tda10086_write_mask(state, 0x58, 0x01, 0x00); /* powerup ADC */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300153
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300154 /* setup AGC */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300155 tda10086_write_byte(state, 0x05, 0x0B);
156 tda10086_write_byte(state, 0x37, 0x63);
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300157 tda10086_write_byte(state, 0x3f, 0x0a); /* NOTE: flydvb varies it */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300158 tda10086_write_byte(state, 0x40, 0x64);
159 tda10086_write_byte(state, 0x41, 0x4f);
160 tda10086_write_byte(state, 0x42, 0x43);
161
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300162 /* setup viterbi */
163 tda10086_write_byte(state, 0x1a, 0x11); /* VBER 10^6, DVB, QPSK */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300164
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300165 /* setup carrier recovery */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300166 tda10086_write_byte(state, 0x3d, 0x80);
167
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300168 /* setup SEC */
169 tda10086_write_byte(state, 0x36, t22k_off); /* all SEC off, 22k tone */
170 tda10086_write_byte(state, 0x34, (((1<<19) * (22000/1000)) / (SACLK/1000)));
171 tda10086_write_byte(state, 0x35, (((1<<19) * (22000/1000)) / (SACLK/1000)) >> 8);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300172
173 return 0;
174}
175
176static void tda10086_diseqc_wait(struct tda10086_state *state)
177{
178 unsigned long timeout = jiffies + msecs_to_jiffies(200);
179 while (!(tda10086_read_byte(state, 0x50) & 0x01)) {
180 if(time_after(jiffies, timeout)) {
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300181 printk("%s: diseqc queue not ready, command may be lost.\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300182 break;
183 }
184 msleep(10);
185 }
186}
187
188static int tda10086_set_tone (struct dvb_frontend* fe, fe_sec_tone_mode_t tone)
189{
190 struct tda10086_state* state = fe->demodulator_priv;
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300191 u8 t22k_off = 0x80;
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300192
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300193 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300194
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300195 if (state->config->diseqc_tone)
196 t22k_off = 0;
197
Hartmut Hackmann33f77712007-11-08 08:54:53 -0300198 switch (tone) {
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300199 case SEC_TONE_OFF:
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300200 tda10086_write_byte(state, 0x36, t22k_off);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300201 break;
202
203 case SEC_TONE_ON:
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300204 tda10086_write_byte(state, 0x36, 0x01 + t22k_off);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300205 break;
206 }
207
208 return 0;
209}
210
211static int tda10086_send_master_cmd (struct dvb_frontend* fe,
212 struct dvb_diseqc_master_cmd* cmd)
213{
214 struct tda10086_state* state = fe->demodulator_priv;
215 int i;
216 u8 oldval;
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300217 u8 t22k_off = 0x80;
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300218
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300219 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300220
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300221 if (state->config->diseqc_tone)
222 t22k_off = 0;
223
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300224 if (cmd->msg_len > 6)
225 return -EINVAL;
226 oldval = tda10086_read_byte(state, 0x36);
227
228 for(i=0; i< cmd->msg_len; i++) {
229 tda10086_write_byte(state, 0x48+i, cmd->msg[i]);
230 }
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300231 tda10086_write_byte(state, 0x36, (0x08 + t22k_off)
232 | ((cmd->msg_len - 1) << 4));
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300233
234 tda10086_diseqc_wait(state);
235
236 tda10086_write_byte(state, 0x36, oldval);
237
238 return 0;
239}
240
241static int tda10086_send_burst (struct dvb_frontend* fe, fe_sec_mini_cmd_t minicmd)
242{
243 struct tda10086_state* state = fe->demodulator_priv;
244 u8 oldval = tda10086_read_byte(state, 0x36);
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300245 u8 t22k_off = 0x80;
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300246
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300247 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300248
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300249 if (state->config->diseqc_tone)
250 t22k_off = 0;
251
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300252 switch(minicmd) {
253 case SEC_MINI_A:
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300254 tda10086_write_byte(state, 0x36, 0x04 + t22k_off);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300255 break;
256
257 case SEC_MINI_B:
Hartmut Hackmannea75baf2008-02-09 23:54:24 -0300258 tda10086_write_byte(state, 0x36, 0x06 + t22k_off);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300259 break;
260 }
261
262 tda10086_diseqc_wait(state);
263
264 tda10086_write_byte(state, 0x36, oldval);
265
266 return 0;
267}
268
269static int tda10086_set_inversion(struct tda10086_state *state,
270 struct dvb_frontend_parameters *fe_params)
271{
272 u8 invval = 0x80;
273
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300274 dprintk ("%s %i %i\n", __func__, fe_params->inversion, state->config->invert);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300275
276 switch(fe_params->inversion) {
277 case INVERSION_OFF:
278 if (state->config->invert)
279 invval = 0x40;
280 break;
281 case INVERSION_ON:
282 if (!state->config->invert)
283 invval = 0x40;
284 break;
285 case INVERSION_AUTO:
286 invval = 0x00;
287 break;
288 }
289 tda10086_write_mask(state, 0x0c, 0xc0, invval);
290
291 return 0;
292}
293
294static int tda10086_set_symbol_rate(struct tda10086_state *state,
295 struct dvb_frontend_parameters *fe_params)
296{
297 u8 dfn = 0;
298 u8 afs = 0;
299 u8 byp = 0;
300 u8 reg37 = 0x43;
301 u8 reg42 = 0x43;
302 u64 big;
303 u32 tmp;
304 u32 bdr;
305 u32 bdri;
306 u32 symbol_rate = fe_params->u.qpsk.symbol_rate;
307
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300308 dprintk ("%s %i\n", __func__, symbol_rate);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300309
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300310 /* setup the decimation and anti-aliasing filters.. */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300311 if (symbol_rate < (u32) (SACLK * 0.0137)) {
312 dfn=4;
313 afs=1;
314 } else if (symbol_rate < (u32) (SACLK * 0.0208)) {
315 dfn=4;
316 afs=0;
317 } else if (symbol_rate < (u32) (SACLK * 0.0270)) {
318 dfn=3;
319 afs=1;
320 } else if (symbol_rate < (u32) (SACLK * 0.0416)) {
321 dfn=3;
322 afs=0;
323 } else if (symbol_rate < (u32) (SACLK * 0.0550)) {
324 dfn=2;
325 afs=1;
326 } else if (symbol_rate < (u32) (SACLK * 0.0833)) {
327 dfn=2;
328 afs=0;
329 } else if (symbol_rate < (u32) (SACLK * 0.1100)) {
330 dfn=1;
331 afs=1;
332 } else if (symbol_rate < (u32) (SACLK * 0.1666)) {
333 dfn=1;
334 afs=0;
335 } else if (symbol_rate < (u32) (SACLK * 0.2200)) {
336 dfn=0;
337 afs=1;
338 } else if (symbol_rate < (u32) (SACLK * 0.3333)) {
339 dfn=0;
340 afs=0;
341 } else {
342 reg37 = 0x63;
343 reg42 = 0x4f;
344 byp=1;
345 }
346
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300347 /* calculate BDR */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300348 big = (1ULL<<21) * ((u64) symbol_rate/1000ULL) * (1ULL<<dfn);
349 big += ((SACLK/1000ULL)-1ULL);
350 do_div(big, (SACLK/1000ULL));
351 bdr = big & 0xfffff;
352
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300353 /* calculate BDRI */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300354 tmp = (1<<dfn)*(symbol_rate/1000);
355 bdri = ((32 * (SACLK/1000)) + (tmp-1)) / tmp;
356
357 tda10086_write_byte(state, 0x21, (afs << 7) | dfn);
358 tda10086_write_mask(state, 0x20, 0x08, byp << 3);
359 tda10086_write_byte(state, 0x06, bdr);
360 tda10086_write_byte(state, 0x07, bdr >> 8);
361 tda10086_write_byte(state, 0x08, bdr >> 16);
362 tda10086_write_byte(state, 0x09, bdri);
363 tda10086_write_byte(state, 0x37, reg37);
364 tda10086_write_byte(state, 0x42, reg42);
365
366 return 0;
367}
368
369static int tda10086_set_fec(struct tda10086_state *state,
370 struct dvb_frontend_parameters *fe_params)
371{
372 u8 fecval;
373
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300374 dprintk ("%s %i\n", __func__, fe_params->u.qpsk.fec_inner);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300375
376 switch(fe_params->u.qpsk.fec_inner) {
377 case FEC_1_2:
378 fecval = 0x00;
379 break;
380 case FEC_2_3:
381 fecval = 0x01;
382 break;
383 case FEC_3_4:
384 fecval = 0x02;
385 break;
386 case FEC_4_5:
387 fecval = 0x03;
388 break;
389 case FEC_5_6:
390 fecval = 0x04;
391 break;
392 case FEC_6_7:
393 fecval = 0x05;
394 break;
395 case FEC_7_8:
396 fecval = 0x06;
397 break;
398 case FEC_8_9:
399 fecval = 0x07;
400 break;
401 case FEC_AUTO:
402 fecval = 0x08;
403 break;
404 default:
405 return -1;
406 }
407 tda10086_write_byte(state, 0x0d, fecval);
408
409 return 0;
410}
411
412static int tda10086_set_frontend(struct dvb_frontend* fe,
413 struct dvb_frontend_parameters *fe_params)
414{
415 struct tda10086_state *state = fe->demodulator_priv;
416 int ret;
417 u32 freq = 0;
418 int freqoff;
419
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300420 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300421
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300422 /* modify parameters for tuning */
Oliver Endrissc6604152007-05-28 18:06:27 -0300423 tda10086_write_byte(state, 0x02, 0x35);
424 state->has_lock = false;
425
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300426 /* set params */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300427 if (fe->ops.tuner_ops.set_params) {
428 fe->ops.tuner_ops.set_params(fe, fe_params);
429 if (fe->ops.i2c_gate_ctrl)
430 fe->ops.i2c_gate_ctrl(fe, 0);
431
432 if (fe->ops.tuner_ops.get_frequency)
433 fe->ops.tuner_ops.get_frequency(fe, &freq);
434 if (fe->ops.i2c_gate_ctrl)
435 fe->ops.i2c_gate_ctrl(fe, 0);
436 }
437
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300438 /* calcluate the frequency offset (in *Hz* not kHz) */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300439 freqoff = fe_params->frequency - freq;
440 freqoff = ((1<<16) * freqoff) / (SACLK/1000);
441 tda10086_write_byte(state, 0x3d, 0x80 | ((freqoff >> 8) & 0x7f));
442 tda10086_write_byte(state, 0x3e, freqoff);
443
444 if ((ret = tda10086_set_inversion(state, fe_params)) < 0)
445 return ret;
446 if ((ret = tda10086_set_symbol_rate(state, fe_params)) < 0)
447 return ret;
448 if ((ret = tda10086_set_fec(state, fe_params)) < 0)
449 return ret;
450
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300451 /* soft reset + disable TS output until lock */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300452 tda10086_write_mask(state, 0x10, 0x40, 0x40);
453 tda10086_write_mask(state, 0x00, 0x01, 0x00);
454
455 state->symbol_rate = fe_params->u.qpsk.symbol_rate;
456 state->frequency = fe_params->frequency;
457 return 0;
458}
459
460static int tda10086_get_frontend(struct dvb_frontend* fe, struct dvb_frontend_parameters *fe_params)
461{
462 struct tda10086_state* state = fe->demodulator_priv;
463 u8 val;
464 int tmp;
465 u64 tmp64;
466
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300467 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300468
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300469 /* check for invalid symbol rate */
Andrew de Quincey221a09d2006-11-22 18:01:21 -0300470 if (fe_params->u.qpsk.symbol_rate < 500000)
471 return -EINVAL;
472
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300473 /* calculate the updated frequency (note: we convert from Hz->kHz) */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300474 tmp64 = tda10086_read_byte(state, 0x52);
475 tmp64 |= (tda10086_read_byte(state, 0x51) << 8);
476 if (tmp64 & 0x8000)
477 tmp64 |= 0xffffffffffff0000ULL;
478 tmp64 = (tmp64 * (SACLK/1000ULL));
479 do_div(tmp64, (1ULL<<15) * (1ULL<<1));
480 fe_params->frequency = (int) state->frequency + (int) tmp64;
481
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300482 /* the inversion */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300483 val = tda10086_read_byte(state, 0x0c);
484 if (val & 0x80) {
485 switch(val & 0x40) {
486 case 0x00:
487 fe_params->inversion = INVERSION_OFF;
488 if (state->config->invert)
489 fe_params->inversion = INVERSION_ON;
490 break;
491 default:
492 fe_params->inversion = INVERSION_ON;
493 if (state->config->invert)
494 fe_params->inversion = INVERSION_OFF;
495 break;
496 }
497 } else {
498 tda10086_read_byte(state, 0x0f);
499 switch(val & 0x02) {
500 case 0x00:
501 fe_params->inversion = INVERSION_OFF;
502 if (state->config->invert)
503 fe_params->inversion = INVERSION_ON;
504 break;
505 default:
506 fe_params->inversion = INVERSION_ON;
507 if (state->config->invert)
508 fe_params->inversion = INVERSION_OFF;
509 break;
510 }
511 }
512
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300513 /* calculate the updated symbol rate */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300514 tmp = tda10086_read_byte(state, 0x1d);
515 if (tmp & 0x80)
516 tmp |= 0xffffff00;
517 tmp = (tmp * 480 * (1<<1)) / 128;
518 tmp = ((state->symbol_rate/1000) * tmp) / (1000000/1000);
519 fe_params->u.qpsk.symbol_rate = state->symbol_rate + tmp;
520
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300521 /* the FEC */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300522 val = (tda10086_read_byte(state, 0x0d) & 0x70) >> 4;
523 switch(val) {
524 case 0x00:
525 fe_params->u.qpsk.fec_inner = FEC_1_2;
526 break;
527 case 0x01:
528 fe_params->u.qpsk.fec_inner = FEC_2_3;
529 break;
530 case 0x02:
531 fe_params->u.qpsk.fec_inner = FEC_3_4;
532 break;
533 case 0x03:
534 fe_params->u.qpsk.fec_inner = FEC_4_5;
535 break;
536 case 0x04:
537 fe_params->u.qpsk.fec_inner = FEC_5_6;
538 break;
539 case 0x05:
540 fe_params->u.qpsk.fec_inner = FEC_6_7;
541 break;
542 case 0x06:
543 fe_params->u.qpsk.fec_inner = FEC_7_8;
544 break;
545 case 0x07:
546 fe_params->u.qpsk.fec_inner = FEC_8_9;
547 break;
548 }
549
550 return 0;
551}
552
553static int tda10086_read_status(struct dvb_frontend* fe, fe_status_t *fe_status)
554{
555 struct tda10086_state* state = fe->demodulator_priv;
556 u8 val;
557
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300558 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300559
560 val = tda10086_read_byte(state, 0x0e);
561 *fe_status = 0;
562 if (val & 0x01)
563 *fe_status |= FE_HAS_SIGNAL;
564 if (val & 0x02)
565 *fe_status |= FE_HAS_CARRIER;
566 if (val & 0x04)
567 *fe_status |= FE_HAS_VITERBI;
568 if (val & 0x08)
569 *fe_status |= FE_HAS_SYNC;
Oliver Endrissc6604152007-05-28 18:06:27 -0300570 if (val & 0x10) {
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300571 *fe_status |= FE_HAS_LOCK;
Oliver Endrissc6604152007-05-28 18:06:27 -0300572 if (!state->has_lock) {
573 state->has_lock = true;
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300574 /* modify parameters for stable reception */
Oliver Endrissc6604152007-05-28 18:06:27 -0300575 tda10086_write_byte(state, 0x02, 0x00);
576 }
577 }
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300578
579 return 0;
580}
581
582static int tda10086_read_signal_strength(struct dvb_frontend* fe, u16 * signal)
583{
584 struct tda10086_state* state = fe->demodulator_priv;
585 u8 _str;
586
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300587 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300588
Oliver Endrissc6604152007-05-28 18:06:27 -0300589 _str = 0xff - tda10086_read_byte(state, 0x43);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300590 *signal = (_str << 8) | _str;
591
592 return 0;
593}
594
595static int tda10086_read_snr(struct dvb_frontend* fe, u16 * snr)
596{
597 struct tda10086_state* state = fe->demodulator_priv;
598 u8 _snr;
599
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300600 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300601
Oliver Endrissc6604152007-05-28 18:06:27 -0300602 _snr = 0xff - tda10086_read_byte(state, 0x1c);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300603 *snr = (_snr << 8) | _snr;
604
605 return 0;
606}
607
608static int tda10086_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks)
609{
610 struct tda10086_state* state = fe->demodulator_priv;
611
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300612 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300613
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300614 /* read it */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300615 *ucblocks = tda10086_read_byte(state, 0x18) & 0x7f;
616
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300617 /* reset counter */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300618 tda10086_write_byte(state, 0x18, 0x00);
619 tda10086_write_byte(state, 0x18, 0x80);
620
621 return 0;
622}
623
624static int tda10086_read_ber(struct dvb_frontend* fe, u32* ber)
625{
626 struct tda10086_state* state = fe->demodulator_priv;
627
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300628 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300629
Hartmut Hackmannb1c54fe2008-04-13 21:09:11 -0300630 /* read it */
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300631 *ber = 0;
632 *ber |= tda10086_read_byte(state, 0x15);
633 *ber |= tda10086_read_byte(state, 0x16) << 8;
634 *ber |= (tda10086_read_byte(state, 0x17) & 0xf) << 16;
635
636 return 0;
637}
638
639static int tda10086_sleep(struct dvb_frontend* fe)
640{
641 struct tda10086_state* state = fe->demodulator_priv;
642
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300643 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300644
645 tda10086_write_mask(state, 0x00, 0x08, 0x08);
646
647 return 0;
648}
649
650static int tda10086_i2c_gate_ctrl(struct dvb_frontend* fe, int enable)
651{
652 struct tda10086_state* state = fe->demodulator_priv;
653
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300654 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300655
656 if (enable) {
657 tda10086_write_mask(state, 0x00, 0x10, 0x10);
658 } else {
659 tda10086_write_mask(state, 0x00, 0x10, 0x00);
660 }
661
662 return 0;
663}
664
665static int tda10086_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings)
666{
667 if (fesettings->parameters.u.qpsk.symbol_rate > 20000000) {
668 fesettings->min_delay_ms = 50;
669 fesettings->step_size = 2000;
670 fesettings->max_drift = 8000;
671 } else if (fesettings->parameters.u.qpsk.symbol_rate > 12000000) {
672 fesettings->min_delay_ms = 100;
673 fesettings->step_size = 1500;
674 fesettings->max_drift = 9000;
675 } else if (fesettings->parameters.u.qpsk.symbol_rate > 8000000) {
676 fesettings->min_delay_ms = 100;
677 fesettings->step_size = 1000;
678 fesettings->max_drift = 8000;
679 } else if (fesettings->parameters.u.qpsk.symbol_rate > 4000000) {
680 fesettings->min_delay_ms = 100;
681 fesettings->step_size = 500;
682 fesettings->max_drift = 7000;
683 } else if (fesettings->parameters.u.qpsk.symbol_rate > 2000000) {
684 fesettings->min_delay_ms = 200;
685 fesettings->step_size = (fesettings->parameters.u.qpsk.symbol_rate / 8000);
686 fesettings->max_drift = 14 * fesettings->step_size;
687 } else {
688 fesettings->min_delay_ms = 200;
689 fesettings->step_size = (fesettings->parameters.u.qpsk.symbol_rate / 8000);
690 fesettings->max_drift = 18 * fesettings->step_size;
691 }
692
693 return 0;
694}
695
696static void tda10086_release(struct dvb_frontend* fe)
697{
698 struct tda10086_state *state = fe->demodulator_priv;
699 tda10086_sleep(fe);
700 kfree(state);
701}
702
703static struct dvb_frontend_ops tda10086_ops = {
704
705 .info = {
706 .name = "Philips TDA10086 DVB-S",
707 .type = FE_QPSK,
708 .frequency_min = 950000,
709 .frequency_max = 2150000,
710 .frequency_stepsize = 125, /* kHz for QPSK frontends */
711 .symbol_rate_min = 1000000,
712 .symbol_rate_max = 45000000,
713 .caps = FE_CAN_INVERSION_AUTO |
714 FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
715 FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
716 FE_CAN_QPSK
717 },
718
719 .release = tda10086_release,
720
721 .init = tda10086_init,
722 .sleep = tda10086_sleep,
723 .i2c_gate_ctrl = tda10086_i2c_gate_ctrl,
724
725 .set_frontend = tda10086_set_frontend,
726 .get_frontend = tda10086_get_frontend,
727 .get_tune_settings = tda10086_get_tune_settings,
728
729 .read_status = tda10086_read_status,
730 .read_ber = tda10086_read_ber,
731 .read_signal_strength = tda10086_read_signal_strength,
732 .read_snr = tda10086_read_snr,
733 .read_ucblocks = tda10086_read_ucblocks,
734
735 .diseqc_send_master_cmd = tda10086_send_master_cmd,
736 .diseqc_send_burst = tda10086_send_burst,
737 .set_tone = tda10086_set_tone,
738};
739
740struct dvb_frontend* tda10086_attach(const struct tda10086_config* config,
741 struct i2c_adapter* i2c)
742{
743 struct tda10086_state *state;
744
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300745 dprintk ("%s\n", __func__);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300746
747 /* allocate memory for the internal state */
Matthias Schwarzott084e24a2009-08-10 22:51:01 -0300748 state = kzalloc(sizeof(struct tda10086_state), GFP_KERNEL);
Andrew de Quincey6bca3582006-08-08 09:10:10 -0300749 if (!state)
750 return NULL;
751
752 /* setup the state */
753 state->config = config;
754 state->i2c = i2c;
755
756 /* check if the demod is there */
757 if (tda10086_read_byte(state, 0x1e) != 0xe1) {
758 kfree(state);
759 return NULL;
760 }
761
762 /* create dvb_frontend */
763 memcpy(&state->frontend.ops, &tda10086_ops, sizeof(struct dvb_frontend_ops));
764 state->frontend.demodulator_priv = state;
765 return &state->frontend;
766}
767
768module_param(debug, int, 0644);
769MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
770
771MODULE_DESCRIPTION("Philips TDA10086 DVB-S Demodulator");
772MODULE_AUTHOR("Andrew de Quincey");
773MODULE_LICENSE("GPL");
774
775EXPORT_SYMBOL(tda10086_attach);