?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
sh_eth: fix EESIPR values for SH77{34|63}
[linux/fpc-iii.git] / drivers / media / dvb-frontends / cx24120.c
blob7f11dcc94d854c08bbe4bd5637790bf9517ab1da
1 /*
2 Conexant cx24120/cx24118 - DVBS/S2 Satellite demod/tuner driver
3
4 Copyright (C) 2008 Patrick Boettcher <pb@linuxtv.org>
5 Copyright (C) 2009 Sergey Tyurin <forum.free-x.de>
6 Updated 2012 by Jannis Achstetter <jannis_achstetter@web.de>
7 Copyright (C) 2015 Jemma Denson <jdenson@gmail.com>
8 April 2015
9 Refactored & simplified driver
10 Updated to work with delivery system supplied by DVBv5
11 Add frequency, fec & pilot to get_frontend
12
13 Cards supported: Technisat Skystar S2
14
15 This program is free software; you can redistribute it and/or modify
16 it under the terms of the GNU General Public License as published by
17 the Free Software Foundation; either version 2 of the License, or
18 (at your option) any later version.
19
20 This program is distributed in the hope that it will be useful,
21 but WITHOUT ANY WARRANTY; without even the implied warranty of
22 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
23 GNU General Public License for more details.
24 */
25
26 #include <linux/slab.h>
27 #include <linux/kernel.h>
28 #include <linux/module.h>
29 #include <linux/moduleparam.h>
30 #include <linux/init.h>
31 #include <linux/firmware.h>
32 #include "dvb_frontend.h"
33 #include "cx24120.h"
34
35 #define CX24120_SEARCH_RANGE_KHZ 5000
36 #define CX24120_FIRMWARE "dvb-fe-cx24120-1.20.58.2.fw"
37
38 /* cx24120 i2c registers */
39 #define CX24120_REG_CMD_START 0x00 /* write cmd_id */
40 #define CX24120_REG_CMD_ARGS 0x01 /* write command arguments */
41 #define CX24120_REG_CMD_END 0x1f /* write 0x01 for end */
42
43 #define CX24120_REG_MAILBOX 0x33
44 #define CX24120_REG_FREQ3 0x34 /* frequency */
45 #define CX24120_REG_FREQ2 0x35
46 #define CX24120_REG_FREQ1 0x36
47
48 #define CX24120_REG_FECMODE 0x39 /* FEC status */
49 #define CX24120_REG_STATUS 0x3a /* Tuner status */
50 #define CX24120_REG_SIGSTR_H 0x3a /* Signal strength high */
51 #define CX24120_REG_SIGSTR_L 0x3b /* Signal strength low byte */
52 #define CX24120_REG_QUALITY_H 0x40 /* SNR high byte */
53 #define CX24120_REG_QUALITY_L 0x41 /* SNR low byte */
54
55 #define CX24120_REG_BER_HH 0x47 /* BER high byte of high word */
56 #define CX24120_REG_BER_HL 0x48 /* BER low byte of high word */
57 #define CX24120_REG_BER_LH 0x49 /* BER high byte of low word */
58 #define CX24120_REG_BER_LL 0x4a /* BER low byte of low word */
59
60 #define CX24120_REG_UCB_H 0x50 /* UCB high byte */
61 #define CX24120_REG_UCB_L 0x51 /* UCB low byte */
62
63 #define CX24120_REG_CLKDIV 0xe6
64 #define CX24120_REG_RATEDIV 0xf0
65
66 #define CX24120_REG_REVISION 0xff /* Chip revision (ro) */
67
68 /* Command messages */
69 enum command_message_id {
70 CMD_VCO_SET = 0x10, /* cmd.len = 12; */
71 CMD_TUNEREQUEST = 0x11, /* cmd.len = 15; */
72
73 CMD_MPEG_ONOFF = 0x13, /* cmd.len = 4; */
74 CMD_MPEG_INIT = 0x14, /* cmd.len = 7; */
75 CMD_BANDWIDTH = 0x15, /* cmd.len = 12; */
76 CMD_CLOCK_READ = 0x16, /* read clock */
77 CMD_CLOCK_SET = 0x17, /* cmd.len = 10; */
78
79 CMD_DISEQC_MSG1 = 0x20, /* cmd.len = 11; */
80 CMD_DISEQC_MSG2 = 0x21, /* cmd.len = d->msg_len + 6; */
81 CMD_SETVOLTAGE = 0x22, /* cmd.len = 2; */
82 CMD_SETTONE = 0x23, /* cmd.len = 4; */
83 CMD_DISEQC_BURST = 0x24, /* cmd.len not used !!! */
84
85 CMD_READ_SNR = 0x1a, /* Read signal strength */
86 CMD_START_TUNER = 0x1b, /* ??? */
87
88 CMD_FWVERSION = 0x35,
89
90 CMD_BER_CTRL = 0x3c, /* cmd.len = 0x03; */
91 };
92
93 #define CX24120_MAX_CMD_LEN 30
94
95 /* pilot mask */
96 #define CX24120_PILOT_OFF 0x00
97 #define CX24120_PILOT_ON 0x40
98 #define CX24120_PILOT_AUTO 0x80
99
100 /* signal status */
101 #define CX24120_HAS_SIGNAL 0x01
102 #define CX24120_HAS_CARRIER 0x02
103 #define CX24120_HAS_VITERBI 0x04
104 #define CX24120_HAS_LOCK 0x08
105 #define CX24120_HAS_UNK1 0x10
106 #define CX24120_HAS_UNK2 0x20
107 #define CX24120_STATUS_MASK 0x0f
108 #define CX24120_SIGNAL_MASK 0xc0
109
110 /* ber window */
111 #define CX24120_BER_WINDOW 16
112 #define CX24120_BER_WSIZE ((1 << CX24120_BER_WINDOW) * 208 * 8)
113
114 #define info(args...) pr_info("cx24120: " args)
115 #define err(args...) pr_err("cx24120: ### ERROR: " args)
116
117 /* The Demod/Tuner can't easily provide these, we cache them */
118 struct cx24120_tuning {
119 u32 frequency;
120 u32 symbol_rate;
121 enum fe_spectral_inversion inversion;
122 enum fe_code_rate fec;
123
124 enum fe_delivery_system delsys;
125 enum fe_modulation modulation;
126 enum fe_pilot pilot;
127
128 /* Demod values */
129 u8 fec_val;
130 u8 fec_mask;
131 u8 clkdiv;
132 u8 ratediv;
133 u8 inversion_val;
134 u8 pilot_val;
135 };
136
137 /* Private state */
138 struct cx24120_state {
139 struct i2c_adapter *i2c;
140 const struct cx24120_config *config;
141 struct dvb_frontend frontend;
142
143 u8 cold_init;
144 u8 mpeg_enabled;
145 u8 need_clock_set;
146
147 /* current and next tuning parameters */
148 struct cx24120_tuning dcur;
149 struct cx24120_tuning dnxt;
150
151 enum fe_status fe_status;
152
153 /* dvbv5 stats calculations */
154 u32 bitrate;
155 u32 berw_usecs;
156 u32 ber_prev;
157 u32 ucb_offset;
158 unsigned long ber_jiffies_stats;
159 unsigned long per_jiffies_stats;
160 };
161
162 /* Command message to firmware */
163 struct cx24120_cmd {
164 u8 id;
165 u8 len;
166 u8 arg[CX24120_MAX_CMD_LEN];
167 };
168
169 /* Read single register */
170 static int cx24120_readreg(struct cx24120_state *state, u8 reg)
171 {
172 int ret;
173 u8 buf = 0;
174 struct i2c_msg msg[] = {
175 {
176 .addr = state->config->i2c_addr,
177 .flags = 0,
178 .len = 1,
179 .buf = &reg
180 }, {
181 .addr = state->config->i2c_addr,
182 .flags = I2C_M_RD,
183 .len = 1,
184 .buf = &buf
185 }
186 };
187
188 ret = i2c_transfer(state->i2c, msg, 2);
189 if (ret != 2) {
190 err("Read error: reg=0x%02x, ret=%i)\n", reg, ret);
191 return ret;
192 }
193
194 dev_dbg(&state->i2c->dev, "reg=0x%02x; data=0x%02x\n", reg, buf);
195
196 return buf;
197 }
198
199 /* Write single register */
200 static int cx24120_writereg(struct cx24120_state *state, u8 reg, u8 data)
201 {
202 u8 buf[] = { reg, data };
203 struct i2c_msg msg = {
204 .addr = state->config->i2c_addr,
205 .flags = 0,
206 .buf = buf,
207 .len = 2
208 };
209 int ret;
210
211 ret = i2c_transfer(state->i2c, &msg, 1);
212 if (ret != 1) {
213 err("Write error: i2c_write error(err == %i, 0x%02x: 0x%02x)\n",
214 ret, reg, data);
215 return ret;
216 }
217
218 dev_dbg(&state->i2c->dev, "reg=0x%02x; data=0x%02x\n", reg, data);
219
220 return 0;
221 }
222
223 /* Write multiple registers in chunks of i2c_wr_max-sized buffers */
224 static int cx24120_writeregs(struct cx24120_state *state,
225 u8 reg, const u8 *values, u16 len, u8 incr)
226 {
227 int ret;
228 u16 max = state->config->i2c_wr_max > 0 ?
229 state->config->i2c_wr_max :
230 len;
231
232 struct i2c_msg msg = {
233 .addr = state->config->i2c_addr,
234 .flags = 0,
235 };
236
237 msg.buf = kmalloc(max + 1, GFP_KERNEL);
238 if (!msg.buf)
239 return -ENOMEM;
240
241 while (len) {
242 msg.buf[0] = reg;
243 msg.len = len > max ? max : len;
244 memcpy(&msg.buf[1], values, msg.len);
245
246 len -= msg.len; /* data length revers counter */
247 values += msg.len; /* incr data pointer */
248
249 if (incr)
250 reg += msg.len;
251 msg.len++; /* don't forget the addr byte */
252
253 ret = i2c_transfer(state->i2c, &msg, 1);
254 if (ret != 1) {
255 err("i2c_write error(err == %i, 0x%02x)\n", ret, reg);
256 goto out;
257 }
258
259 dev_dbg(&state->i2c->dev, "reg=0x%02x; data=%*ph\n",
260 reg, msg.len - 1, msg.buf + 1);
261 }
262
263 ret = 0;
264
265 out:
266 kfree(msg.buf);
267 return ret;
268 }
269
270 static const struct dvb_frontend_ops cx24120_ops;
271
272 struct dvb_frontend *cx24120_attach(const struct cx24120_config *config,
273 struct i2c_adapter *i2c)
274 {
275 struct cx24120_state *state;
276 int demod_rev;
277
278 info("Conexant cx24120/cx24118 - DVBS/S2 Satellite demod/tuner\n");
279 state = kzalloc(sizeof(*state), GFP_KERNEL);
280 if (!state) {
281 err("Unable to allocate memory for cx24120_state\n");
282 goto error;
283 }
284
285 /* setup the state */
286 state->config = config;
287 state->i2c = i2c;
288
289 /* check if the demod is present and has proper type */
290 demod_rev = cx24120_readreg(state, CX24120_REG_REVISION);
291 switch (demod_rev) {
292 case 0x07:
293 info("Demod cx24120 rev. 0x07 detected.\n");
294 break;
295 case 0x05:
296 info("Demod cx24120 rev. 0x05 detected.\n");
297 break;
298 default:
299 err("Unsupported demod revision: 0x%x detected.\n", demod_rev);
300 goto error;
301 }
302
303 /* create dvb_frontend */
304 state->cold_init = 0;
305 memcpy(&state->frontend.ops, &cx24120_ops,
306 sizeof(struct dvb_frontend_ops));
307 state->frontend.demodulator_priv = state;
308
309 info("Conexant cx24120/cx24118 attached.\n");
310 return &state->frontend;
311
312 error:
313 kfree(state);
314 return NULL;
315 }
316 EXPORT_SYMBOL(cx24120_attach);
317
318 static int cx24120_test_rom(struct cx24120_state *state)
319 {
320 int err, ret;
321
322 err = cx24120_readreg(state, 0xfd);
323 if (err & 4) {
324 ret = cx24120_readreg(state, 0xdf) & 0xfe;
325 err = cx24120_writereg(state, 0xdf, ret);
326 }
327 return err;
328 }
329
330 static int cx24120_read_snr(struct dvb_frontend *fe, u16 *snr)
331 {
332 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
333
334 if (c->cnr.stat[0].scale != FE_SCALE_DECIBEL)
335 *snr = 0;
336 else
337 *snr = div_s64(c->cnr.stat[0].svalue, 100);
338
339 return 0;
340 }
341
342 static int cx24120_read_ber(struct dvb_frontend *fe, u32 *ber)
343 {
344 struct cx24120_state *state = fe->demodulator_priv;
345 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
346
347 if (c->post_bit_error.stat[0].scale != FE_SCALE_COUNTER) {
348 *ber = 0;
349 return 0;
350 }
351
352 *ber = c->post_bit_error.stat[0].uvalue - state->ber_prev;
353 state->ber_prev = c->post_bit_error.stat[0].uvalue;
354
355 return 0;
356 }
357
358 static int cx24120_msg_mpeg_output_global_config(struct cx24120_state *state,
359 u8 flag);
360
361 /* Check if we're running a command that needs to disable mpeg out */
362 static void cx24120_check_cmd(struct cx24120_state *state, u8 id)
363 {
364 switch (id) {
365 case CMD_TUNEREQUEST:
366 case CMD_CLOCK_READ:
367 case CMD_DISEQC_MSG1:
368 case CMD_DISEQC_MSG2:
369 case CMD_SETVOLTAGE:
370 case CMD_SETTONE:
371 case CMD_DISEQC_BURST:
372 cx24120_msg_mpeg_output_global_config(state, 0);
373 /* Old driver would do a msleep(100) here */
374 default:
375 return;
376 }
377 }
378
379 /* Send a message to the firmware */
380 static int cx24120_message_send(struct cx24120_state *state,
381 struct cx24120_cmd *cmd)
382 {
383 int ficus;
384
385 if (state->mpeg_enabled) {
386 /* Disable mpeg out on certain commands */
387 cx24120_check_cmd(state, cmd->id);
388 }
389
390 cx24120_writereg(state, CX24120_REG_CMD_START, cmd->id);
391 cx24120_writeregs(state, CX24120_REG_CMD_ARGS, &cmd->arg[0],
392 cmd->len, 1);
393 cx24120_writereg(state, CX24120_REG_CMD_END, 0x01);
394
395 ficus = 1000;
396 while (cx24120_readreg(state, CX24120_REG_CMD_END)) {
397 msleep(20);
398 ficus -= 20;
399 if (ficus == 0) {
400 err("Error sending message to firmware\n");
401 return -EREMOTEIO;
402 }
403 }
404 dev_dbg(&state->i2c->dev, "sent message 0x%02x\n", cmd->id);
405
406 return 0;
407 }
408
409 /* Send a message and fill arg[] with the results */
410 static int cx24120_message_sendrcv(struct cx24120_state *state,
411 struct cx24120_cmd *cmd, u8 numreg)
412 {
413 int ret, i;
414
415 if (numreg > CX24120_MAX_CMD_LEN) {
416 err("Too many registers to read. cmd->reg = %d", numreg);
417 return -EREMOTEIO;
418 }
419
420 ret = cx24120_message_send(state, cmd);
421 if (ret != 0)
422 return ret;
423
424 if (!numreg)
425 return 0;
426
427 /* Read numreg registers starting from register cmd->len */
428 for (i = 0; i < numreg; i++)
429 cmd->arg[i] = cx24120_readreg(state, (cmd->len + i + 1));
430
431 return 0;
432 }
433
434 static int cx24120_read_signal_strength(struct dvb_frontend *fe,
435 u16 *signal_strength)
436 {
437 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
438
439 if (c->strength.stat[0].scale != FE_SCALE_RELATIVE)
440 *signal_strength = 0;
441 else
442 *signal_strength = c->strength.stat[0].uvalue;
443
444 return 0;
445 }
446
447 static int cx24120_msg_mpeg_output_global_config(struct cx24120_state *state,
448 u8 enable)
449 {
450 struct cx24120_cmd cmd;
451 int ret;
452
453 cmd.id = CMD_MPEG_ONOFF;
454 cmd.len = 4;
455 cmd.arg[0] = 0x01;
456 cmd.arg[1] = 0x00;
457 cmd.arg[2] = enable ? 0 : (u8)(-1);
458 cmd.arg[3] = 0x01;
459
460 ret = cx24120_message_send(state, &cmd);
461 if (ret != 0) {
462 dev_dbg(&state->i2c->dev, "failed to %s MPEG output\n",
463 enable ? "enable" : "disable");
464 return ret;
465 }
466
467 state->mpeg_enabled = enable;
468 dev_dbg(&state->i2c->dev, "MPEG output %s\n",
469 enable ? "enabled" : "disabled");
470
471 return 0;
472 }
473
474 static int cx24120_msg_mpeg_output_config(struct cx24120_state *state, u8 seq)
475 {
476 struct cx24120_cmd cmd;
477 struct cx24120_initial_mpeg_config i =
478 state->config->initial_mpeg_config;
479
480 cmd.id = CMD_MPEG_INIT;
481 cmd.len = 7;
482 cmd.arg[0] = seq; /* sequental number - can be 0,1,2 */
483 cmd.arg[1] = ((i.x1 & 0x01) << 1) | ((i.x1 >> 1) & 0x01);
484 cmd.arg[2] = 0x05;
485 cmd.arg[3] = 0x02;
486 cmd.arg[4] = ((i.x2 >> 1) & 0x01);
487 cmd.arg[5] = (i.x2 & 0xf0) | (i.x3 & 0x0f);
488 cmd.arg[6] = 0x10;
489
490 return cx24120_message_send(state, &cmd);
491 }
492
493 static int cx24120_diseqc_send_burst(struct dvb_frontend *fe,
494 enum fe_sec_mini_cmd burst)
495 {
496 struct cx24120_state *state = fe->demodulator_priv;
497 struct cx24120_cmd cmd;
498
499 dev_dbg(&state->i2c->dev, "\n");
500
501 /*
502 * Yes, cmd.len is set to zero. The old driver
503 * didn't specify any len, but also had a
504 * memset 0 before every use of the cmd struct
505 * which would have set it to zero.
506 * This quite probably needs looking into.
507 */
508 cmd.id = CMD_DISEQC_BURST;
509 cmd.len = 0;
510 cmd.arg[0] = 0x00;
511 cmd.arg[1] = (burst == SEC_MINI_B) ? 0x01 : 0x00;
512
513 return cx24120_message_send(state, &cmd);
514 }
515
516 static int cx24120_set_tone(struct dvb_frontend *fe, enum fe_sec_tone_mode tone)
517 {
518 struct cx24120_state *state = fe->demodulator_priv;
519 struct cx24120_cmd cmd;
520
521 dev_dbg(&state->i2c->dev, "(%d)\n", tone);
522
523 if ((tone != SEC_TONE_ON) && (tone != SEC_TONE_OFF)) {
524 err("Invalid tone=%d\n", tone);
525 return -EINVAL;
526 }
527
528 cmd.id = CMD_SETTONE;
529 cmd.len = 4;
530 cmd.arg[0] = 0x00;
531 cmd.arg[1] = 0x00;
532 cmd.arg[2] = 0x00;
533 cmd.arg[3] = (tone == SEC_TONE_ON) ? 0x01 : 0x00;
534
535 return cx24120_message_send(state, &cmd);
536 }
537
538 static int cx24120_set_voltage(struct dvb_frontend *fe,
539 enum fe_sec_voltage voltage)
540 {
541 struct cx24120_state *state = fe->demodulator_priv;
542 struct cx24120_cmd cmd;
543
544 dev_dbg(&state->i2c->dev, "(%d)\n", voltage);
545
546 cmd.id = CMD_SETVOLTAGE;
547 cmd.len = 2;
548 cmd.arg[0] = 0x00;
549 cmd.arg[1] = (voltage == SEC_VOLTAGE_18) ? 0x01 : 0x00;
550
551 return cx24120_message_send(state, &cmd);
552 }
553
554 static int cx24120_send_diseqc_msg(struct dvb_frontend *fe,
555 struct dvb_diseqc_master_cmd *d)
556 {
557 struct cx24120_state *state = fe->demodulator_priv;
558 struct cx24120_cmd cmd;
559 int back_count;
560
561 dev_dbg(&state->i2c->dev, "\n");
562
563 cmd.id = CMD_DISEQC_MSG1;
564 cmd.len = 11;
565 cmd.arg[0] = 0x00;
566 cmd.arg[1] = 0x00;
567 cmd.arg[2] = 0x03;
568 cmd.arg[3] = 0x16;
569 cmd.arg[4] = 0x28;
570 cmd.arg[5] = 0x01;
571 cmd.arg[6] = 0x01;
572 cmd.arg[7] = 0x14;
573 cmd.arg[8] = 0x19;
574 cmd.arg[9] = 0x14;
575 cmd.arg[10] = 0x1e;
576
577 if (cx24120_message_send(state, &cmd)) {
578 err("send 1st message(0x%x) failed\n", cmd.id);
579 return -EREMOTEIO;
580 }
581
582 cmd.id = CMD_DISEQC_MSG2;
583 cmd.len = d->msg_len + 6;
584 cmd.arg[0] = 0x00;
585 cmd.arg[1] = 0x01;
586 cmd.arg[2] = 0x02;
587 cmd.arg[3] = 0x00;
588 cmd.arg[4] = 0x00;
589 cmd.arg[5] = d->msg_len;
590
591 memcpy(&cmd.arg[6], &d->msg, d->msg_len);
592
593 if (cx24120_message_send(state, &cmd)) {
594 err("send 2nd message(0x%x) failed\n", cmd.id);
595 return -EREMOTEIO;
596 }
597
598 back_count = 500;
599 do {
600 if (!(cx24120_readreg(state, 0x93) & 0x01)) {
601 dev_dbg(&state->i2c->dev, "diseqc sequence sent\n");
602 return 0;
603 }
604 msleep(20);
605 back_count -= 20;
606 } while (back_count);
607
608 err("Too long waiting for diseqc.\n");
609 return -ETIMEDOUT;
610 }
611
612 static void cx24120_get_stats(struct cx24120_state *state)
613 {
614 struct dvb_frontend *fe = &state->frontend;
615 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
616 struct cx24120_cmd cmd;
617 int ret, cnr, msecs;
618 u16 sig, ucb;
619 u32 ber;
620
621 dev_dbg(&state->i2c->dev, "\n");
622
623 /* signal strength */
624 if (state->fe_status & FE_HAS_SIGNAL) {
625 cmd.id = CMD_READ_SNR;
626 cmd.len = 1;
627 cmd.arg[0] = 0x00;
628
629 ret = cx24120_message_send(state, &cmd);
630 if (ret != 0) {
631 err("error reading signal strength\n");
632 return;
633 }
634
635 /* raw */
636 sig = cx24120_readreg(state, CX24120_REG_SIGSTR_H) >> 6;
637 sig = sig << 8;
638 sig |= cx24120_readreg(state, CX24120_REG_SIGSTR_L);
639 dev_dbg(&state->i2c->dev,
640 "signal strength from firmware = 0x%x\n", sig);
641
642 /* cooked */
643 sig = -100 * sig + 94324;
644
645 c->strength.stat[0].scale = FE_SCALE_RELATIVE;
646 c->strength.stat[0].uvalue = sig;
647 } else {
648 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
649 }
650
651 /* CNR */
652 if (state->fe_status & FE_HAS_VITERBI) {
653 cnr = cx24120_readreg(state, CX24120_REG_QUALITY_H) << 8;
654 cnr |= cx24120_readreg(state, CX24120_REG_QUALITY_L);
655 dev_dbg(&state->i2c->dev, "read SNR index = %d\n", cnr);
656
657 /* guessed - seems about right */
658 cnr = cnr * 100;
659
660 c->cnr.stat[0].scale = FE_SCALE_DECIBEL;
661 c->cnr.stat[0].svalue = cnr;
662 } else {
663 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
664 }
665
666 /* BER & UCB require lock */
667 if (!(state->fe_status & FE_HAS_LOCK)) {
668 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
669 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
670 c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
671 c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
672 return;
673 }
674
675 /* BER */
676 if (time_after(jiffies, state->ber_jiffies_stats)) {
677 msecs = (state->berw_usecs + 500) / 1000;
678 state->ber_jiffies_stats = jiffies + msecs_to_jiffies(msecs);
679
680 ber = cx24120_readreg(state, CX24120_REG_BER_HH) << 24;
681 ber |= cx24120_readreg(state, CX24120_REG_BER_HL) << 16;
682 ber |= cx24120_readreg(state, CX24120_REG_BER_LH) << 8;
683 ber |= cx24120_readreg(state, CX24120_REG_BER_LL);
684 dev_dbg(&state->i2c->dev, "read BER index = %d\n", ber);
685
686 c->post_bit_error.stat[0].scale = FE_SCALE_COUNTER;
687 c->post_bit_error.stat[0].uvalue += ber;
688
689 c->post_bit_count.stat[0].scale = FE_SCALE_COUNTER;
690 c->post_bit_count.stat[0].uvalue += CX24120_BER_WSIZE;
691 }
692
693 /* UCB */
694 if (time_after(jiffies, state->per_jiffies_stats)) {
695 state->per_jiffies_stats = jiffies + msecs_to_jiffies(1000);
696
697 ucb = cx24120_readreg(state, CX24120_REG_UCB_H) << 8;
698 ucb |= cx24120_readreg(state, CX24120_REG_UCB_L);
699 dev_dbg(&state->i2c->dev, "ucblocks = %d\n", ucb);
700
701 /* handle reset */
702 if (ucb < state->ucb_offset)
703 state->ucb_offset = c->block_error.stat[0].uvalue;
704
705 c->block_error.stat[0].scale = FE_SCALE_COUNTER;
706 c->block_error.stat[0].uvalue = ucb + state->ucb_offset;
707
708 c->block_count.stat[0].scale = FE_SCALE_COUNTER;
709 c->block_count.stat[0].uvalue += state->bitrate / 8 / 208;
710 }
711 }
712
713 static void cx24120_set_clock_ratios(struct dvb_frontend *fe);
714
715 /* Read current tuning status */
716 static int cx24120_read_status(struct dvb_frontend *fe, enum fe_status *status)
717 {
718 struct cx24120_state *state = fe->demodulator_priv;
719 int lock;
720
721 lock = cx24120_readreg(state, CX24120_REG_STATUS);
722
723 dev_dbg(&state->i2c->dev, "status = 0x%02x\n", lock);
724
725 *status = 0;
726
727 if (lock & CX24120_HAS_SIGNAL)
728 *status = FE_HAS_SIGNAL;
729 if (lock & CX24120_HAS_CARRIER)
730 *status |= FE_HAS_CARRIER;
731 if (lock & CX24120_HAS_VITERBI)
732 *status |= FE_HAS_VITERBI | FE_HAS_SYNC;
733 if (lock & CX24120_HAS_LOCK)
734 *status |= FE_HAS_LOCK;
735
736 /*
737 * TODO: is FE_HAS_SYNC in the right place?
738 * Other cx241xx drivers have this slightly
739 * different
740 */
741
742 state->fe_status = *status;
743 cx24120_get_stats(state);
744
745 /* Set the clock once tuned in */
746 if (state->need_clock_set && *status & FE_HAS_LOCK) {
747 /* Set clock ratios */
748 cx24120_set_clock_ratios(fe);
749
750 /* Old driver would do a msleep(200) here */
751
752 /* Renable mpeg output */
753 if (!state->mpeg_enabled)
754 cx24120_msg_mpeg_output_global_config(state, 1);
755
756 state->need_clock_set = 0;
757 }
758
759 return 0;
760 }
761
762 /*
763 * FEC & modulation lookup table
764 * Used for decoding the REG_FECMODE register
765 * once tuned in.
766 */
767 struct cx24120_modfec {
768 enum fe_delivery_system delsys;
769 enum fe_modulation mod;
770 enum fe_code_rate fec;
771 u8 val;
772 };
773
774 static const struct cx24120_modfec modfec_lookup_table[] = {
775 /*delsys mod fec val */
776 { SYS_DVBS, QPSK, FEC_1_2, 0x01 },
777 { SYS_DVBS, QPSK, FEC_2_3, 0x02 },
778 { SYS_DVBS, QPSK, FEC_3_4, 0x03 },
779 { SYS_DVBS, QPSK, FEC_4_5, 0x04 },
780 { SYS_DVBS, QPSK, FEC_5_6, 0x05 },
781 { SYS_DVBS, QPSK, FEC_6_7, 0x06 },
782 { SYS_DVBS, QPSK, FEC_7_8, 0x07 },
783
784 { SYS_DVBS2, QPSK, FEC_1_2, 0x04 },
785 { SYS_DVBS2, QPSK, FEC_3_5, 0x05 },
786 { SYS_DVBS2, QPSK, FEC_2_3, 0x06 },
787 { SYS_DVBS2, QPSK, FEC_3_4, 0x07 },
788 { SYS_DVBS2, QPSK, FEC_4_5, 0x08 },
789 { SYS_DVBS2, QPSK, FEC_5_6, 0x09 },
790 { SYS_DVBS2, QPSK, FEC_8_9, 0x0a },
791 { SYS_DVBS2, QPSK, FEC_9_10, 0x0b },
792
793 { SYS_DVBS2, PSK_8, FEC_3_5, 0x0c },
794 { SYS_DVBS2, PSK_8, FEC_2_3, 0x0d },
795 { SYS_DVBS2, PSK_8, FEC_3_4, 0x0e },
796 { SYS_DVBS2, PSK_8, FEC_5_6, 0x0f },
797 { SYS_DVBS2, PSK_8, FEC_8_9, 0x10 },
798 { SYS_DVBS2, PSK_8, FEC_9_10, 0x11 },
799 };
800
801 /* Retrieve current fec, modulation & pilot values */
802 static int cx24120_get_fec(struct dvb_frontend *fe)
803 {
804 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
805 struct cx24120_state *state = fe->demodulator_priv;
806 int idx;
807 int ret;
808 int fec;
809
810 ret = cx24120_readreg(state, CX24120_REG_FECMODE);
811 fec = ret & 0x3f; /* Lower 6 bits */
812
813 dev_dbg(&state->i2c->dev, "raw fec = %d\n", fec);
814
815 for (idx = 0; idx < ARRAY_SIZE(modfec_lookup_table); idx++) {
816 if (modfec_lookup_table[idx].delsys != state->dcur.delsys)
817 continue;
818 if (modfec_lookup_table[idx].val != fec)
819 continue;
820
821 break; /* found */
822 }
823
824 if (idx >= ARRAY_SIZE(modfec_lookup_table)) {
825 dev_dbg(&state->i2c->dev, "couldn't find fec!\n");
826 return -EINVAL;
827 }
828
829 /* save values back to cache */
830 c->modulation = modfec_lookup_table[idx].mod;
831 c->fec_inner = modfec_lookup_table[idx].fec;
832 c->pilot = (ret & 0x80) ? PILOT_ON : PILOT_OFF;
833
834 dev_dbg(&state->i2c->dev, "mod(%d), fec(%d), pilot(%d)\n",
835 c->modulation, c->fec_inner, c->pilot);
836
837 return 0;
838 }
839
840 /* Calculate ber window time */
841 static void cx24120_calculate_ber_window(struct cx24120_state *state, u32 rate)
842 {
843 struct dvb_frontend *fe = &state->frontend;
844 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
845 u64 tmp;
846
847 /*
848 * Calculate bitrate from rate in the clock ratios table.
849 * This isn't *exactly* right but close enough.
850 */
851 tmp = (u64)c->symbol_rate * rate;
852 do_div(tmp, 256);
853 state->bitrate = tmp;
854
855 /* usecs per ber window */
856 tmp = 1000000ULL * CX24120_BER_WSIZE;
857 do_div(tmp, state->bitrate);
858 state->berw_usecs = tmp;
859
860 dev_dbg(&state->i2c->dev, "bitrate: %u, berw_usecs: %u\n",
861 state->bitrate, state->berw_usecs);
862 }
863
864 /*
865 * Clock ratios lookup table
866 *
867 * Values obtained from much larger table in old driver
868 * which had numerous entries which would never match.
869 *
870 * There's probably some way of calculating these but I
871 * can't determine the pattern
872 */
873 struct cx24120_clock_ratios_table {
874 enum fe_delivery_system delsys;
875 enum fe_pilot pilot;
876 enum fe_modulation mod;
877 enum fe_code_rate fec;
878 u32 m_rat;
879 u32 n_rat;
880 u32 rate;
881 };
882
883 static const struct cx24120_clock_ratios_table clock_ratios_table[] = {
884 /*delsys pilot mod fec m_rat n_rat rate */
885 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_1_2, 273088, 254505, 274 },
886 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_3_5, 17272, 13395, 330 },
887 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_2_3, 24344, 16967, 367 },
888 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_3_4, 410788, 254505, 413 },
889 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_4_5, 438328, 254505, 440 },
890 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_5_6, 30464, 16967, 459 },
891 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_8_9, 487832, 254505, 490 },
892 { SYS_DVBS2, PILOT_OFF, QPSK, FEC_9_10, 493952, 254505, 496 },
893 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_3_5, 328168, 169905, 494 },
894 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_2_3, 24344, 11327, 550 },
895 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_3_4, 410788, 169905, 618 },
896 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_5_6, 30464, 11327, 688 },
897 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_8_9, 487832, 169905, 735 },
898 { SYS_DVBS2, PILOT_OFF, PSK_8, FEC_9_10, 493952, 169905, 744 },
899 { SYS_DVBS2, PILOT_ON, QPSK, FEC_1_2, 273088, 260709, 268 },
900 { SYS_DVBS2, PILOT_ON, QPSK, FEC_3_5, 328168, 260709, 322 },
901 { SYS_DVBS2, PILOT_ON, QPSK, FEC_2_3, 121720, 86903, 358 },
902 { SYS_DVBS2, PILOT_ON, QPSK, FEC_3_4, 410788, 260709, 403 },
903 { SYS_DVBS2, PILOT_ON, QPSK, FEC_4_5, 438328, 260709, 430 },
904 { SYS_DVBS2, PILOT_ON, QPSK, FEC_5_6, 152320, 86903, 448 },
905 { SYS_DVBS2, PILOT_ON, QPSK, FEC_8_9, 487832, 260709, 479 },
906 { SYS_DVBS2, PILOT_ON, QPSK, FEC_9_10, 493952, 260709, 485 },
907 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_3_5, 328168, 173853, 483 },
908 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_2_3, 121720, 57951, 537 },
909 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_3_4, 410788, 173853, 604 },
910 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_5_6, 152320, 57951, 672 },
911 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_8_9, 487832, 173853, 718 },
912 { SYS_DVBS2, PILOT_ON, PSK_8, FEC_9_10, 493952, 173853, 727 },
913 { SYS_DVBS, PILOT_OFF, QPSK, FEC_1_2, 152592, 152592, 256 },
914 { SYS_DVBS, PILOT_OFF, QPSK, FEC_2_3, 305184, 228888, 341 },
915 { SYS_DVBS, PILOT_OFF, QPSK, FEC_3_4, 457776, 305184, 384 },
916 { SYS_DVBS, PILOT_OFF, QPSK, FEC_5_6, 762960, 457776, 427 },
917 { SYS_DVBS, PILOT_OFF, QPSK, FEC_7_8, 1068144, 610368, 448 },
918 };
919
920 /* Set clock ratio from lookup table */
921 static void cx24120_set_clock_ratios(struct dvb_frontend *fe)
922 {
923 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
924 struct cx24120_state *state = fe->demodulator_priv;
925 struct cx24120_cmd cmd;
926 int ret, idx;
927
928 /* Find fec, modulation, pilot */
929 ret = cx24120_get_fec(fe);
930 if (ret != 0)
931 return;
932
933 /* Find the clock ratios in the lookup table */
934 for (idx = 0; idx < ARRAY_SIZE(clock_ratios_table); idx++) {
935 if (clock_ratios_table[idx].delsys != state->dcur.delsys)
936 continue;
937 if (clock_ratios_table[idx].mod != c->modulation)
938 continue;
939 if (clock_ratios_table[idx].fec != c->fec_inner)
940 continue;
941 if (clock_ratios_table[idx].pilot != c->pilot)
942 continue;
943
944 break; /* found */
945 }
946
947 if (idx >= ARRAY_SIZE(clock_ratios_table)) {
948 info("Clock ratio not found - data reception in danger\n");
949 return;
950 }
951
952 /* Read current values? */
953 cmd.id = CMD_CLOCK_READ;
954 cmd.len = 1;
955 cmd.arg[0] = 0x00;
956 ret = cx24120_message_sendrcv(state, &cmd, 6);
957 if (ret != 0)
958 return;
959 /* in cmd[0]-[5] - result */
960
961 dev_dbg(&state->i2c->dev, "m=%d, n=%d; idx: %d m=%d, n=%d, rate=%d\n",
962 cmd.arg[2] | (cmd.arg[1] << 8) | (cmd.arg[0] << 16),
963 cmd.arg[5] | (cmd.arg[4] << 8) | (cmd.arg[3] << 16),
964 idx,
965 clock_ratios_table[idx].m_rat,
966 clock_ratios_table[idx].n_rat,
967 clock_ratios_table[idx].rate);
968
969 /* Set the clock */
970 cmd.id = CMD_CLOCK_SET;
971 cmd.len = 10;
972 cmd.arg[0] = 0;
973 cmd.arg[1] = 0x10;
974 cmd.arg[2] = (clock_ratios_table[idx].m_rat >> 16) & 0xff;
975 cmd.arg[3] = (clock_ratios_table[idx].m_rat >> 8) & 0xff;
976 cmd.arg[4] = (clock_ratios_table[idx].m_rat >> 0) & 0xff;
977 cmd.arg[5] = (clock_ratios_table[idx].n_rat >> 16) & 0xff;
978 cmd.arg[6] = (clock_ratios_table[idx].n_rat >> 8) & 0xff;
979 cmd.arg[7] = (clock_ratios_table[idx].n_rat >> 0) & 0xff;
980 cmd.arg[8] = (clock_ratios_table[idx].rate >> 8) & 0xff;
981 cmd.arg[9] = (clock_ratios_table[idx].rate >> 0) & 0xff;
982
983 cx24120_message_send(state, &cmd);
984
985 /* Calculate ber window rates for stat work */
986 cx24120_calculate_ber_window(state, clock_ratios_table[idx].rate);
987 }
988
989 /* Set inversion value */
990 static int cx24120_set_inversion(struct cx24120_state *state,
991 enum fe_spectral_inversion inversion)
992 {
993 dev_dbg(&state->i2c->dev, "(%d)\n", inversion);
994
995 switch (inversion) {
996 case INVERSION_OFF:
997 state->dnxt.inversion_val = 0x00;
998 break;
999 case INVERSION_ON:
1000 state->dnxt.inversion_val = 0x04;
1001 break;
1002 case INVERSION_AUTO:
1003 state->dnxt.inversion_val = 0x0c;
1004 break;
1005 default:
1006 return -EINVAL;
1007 }
1008
1009 state->dnxt.inversion = inversion;
1010
1011 return 0;
1012 }
1013
1014 /* FEC lookup table for tuning */
1015 struct cx24120_modfec_table {
1016 enum fe_delivery_system delsys;
1017 enum fe_modulation mod;
1018 enum fe_code_rate fec;
1019 u8 val;
1020 };
1021
1022 static const struct cx24120_modfec_table modfec_table[] = {
1023 /*delsys mod fec val */
1024 { SYS_DVBS, QPSK, FEC_1_2, 0x2e },
1025 { SYS_DVBS, QPSK, FEC_2_3, 0x2f },
1026 { SYS_DVBS, QPSK, FEC_3_4, 0x30 },
1027 { SYS_DVBS, QPSK, FEC_5_6, 0x31 },
1028 { SYS_DVBS, QPSK, FEC_6_7, 0x32 },
1029 { SYS_DVBS, QPSK, FEC_7_8, 0x33 },
1030
1031 { SYS_DVBS2, QPSK, FEC_1_2, 0x04 },
1032 { SYS_DVBS2, QPSK, FEC_3_5, 0x05 },
1033 { SYS_DVBS2, QPSK, FEC_2_3, 0x06 },
1034 { SYS_DVBS2, QPSK, FEC_3_4, 0x07 },
1035 { SYS_DVBS2, QPSK, FEC_4_5, 0x08 },
1036 { SYS_DVBS2, QPSK, FEC_5_6, 0x09 },
1037 { SYS_DVBS2, QPSK, FEC_8_9, 0x0a },
1038 { SYS_DVBS2, QPSK, FEC_9_10, 0x0b },
1039
1040 { SYS_DVBS2, PSK_8, FEC_3_5, 0x0c },
1041 { SYS_DVBS2, PSK_8, FEC_2_3, 0x0d },
1042 { SYS_DVBS2, PSK_8, FEC_3_4, 0x0e },
1043 { SYS_DVBS2, PSK_8, FEC_5_6, 0x0f },
1044 { SYS_DVBS2, PSK_8, FEC_8_9, 0x10 },
1045 { SYS_DVBS2, PSK_8, FEC_9_10, 0x11 },
1046 };
1047
1048 /* Set fec_val & fec_mask values from delsys, modulation & fec */
1049 static int cx24120_set_fec(struct cx24120_state *state, enum fe_modulation mod,
1050 enum fe_code_rate fec)
1051 {
1052 int idx;
1053
1054 dev_dbg(&state->i2c->dev, "(0x%02x,0x%02x)\n", mod, fec);
1055
1056 state->dnxt.fec = fec;
1057
1058 /* Lookup fec_val from modfec table */
1059 for (idx = 0; idx < ARRAY_SIZE(modfec_table); idx++) {
1060 if (modfec_table[idx].delsys != state->dnxt.delsys)
1061 continue;
1062 if (modfec_table[idx].mod != mod)
1063 continue;
1064 if (modfec_table[idx].fec != fec)
1065 continue;
1066
1067 /* found */
1068 state->dnxt.fec_mask = 0x00;
1069 state->dnxt.fec_val = modfec_table[idx].val;
1070 return 0;
1071 }
1072
1073 if (state->dnxt.delsys == SYS_DVBS2) {
1074 /* DVBS2 auto is 0x00/0x00 */
1075 state->dnxt.fec_mask = 0x00;
1076 state->dnxt.fec_val = 0x00;
1077 } else {
1078 /* Set DVB-S to auto */
1079 state->dnxt.fec_val = 0x2e;
1080 state->dnxt.fec_mask = 0xac;
1081 }
1082
1083 return 0;
1084 }
1085
1086 /* Set pilot */
1087 static int cx24120_set_pilot(struct cx24120_state *state, enum fe_pilot pilot)
1088 {
1089 dev_dbg(&state->i2c->dev, "(%d)\n", pilot);
1090
1091 /* Pilot only valid in DVBS2 */
1092 if (state->dnxt.delsys != SYS_DVBS2) {
1093 state->dnxt.pilot_val = CX24120_PILOT_OFF;
1094 return 0;
1095 }
1096
1097 switch (pilot) {
1098 case PILOT_OFF:
1099 state->dnxt.pilot_val = CX24120_PILOT_OFF;
1100 break;
1101 case PILOT_ON:
1102 state->dnxt.pilot_val = CX24120_PILOT_ON;
1103 break;
1104 case PILOT_AUTO:
1105 default:
1106 state->dnxt.pilot_val = CX24120_PILOT_AUTO;
1107 }
1108
1109 return 0;
1110 }
1111
1112 /* Set symbol rate */
1113 static int cx24120_set_symbolrate(struct cx24120_state *state, u32 rate)
1114 {
1115 dev_dbg(&state->i2c->dev, "(%d)\n", rate);
1116
1117 state->dnxt.symbol_rate = rate;
1118
1119 /* Check symbol rate */
1120 if (rate > 31000000) {
1121 state->dnxt.clkdiv = (-(rate < 31000001) & 3) + 2;
1122 state->dnxt.ratediv = (-(rate < 31000001) & 6) + 4;
1123 } else {
1124 state->dnxt.clkdiv = 3;
1125 state->dnxt.ratediv = 6;
1126 }
1127
1128 return 0;
1129 }
1130
1131 /* Overwrite the current tuning params, we are about to tune */
1132 static void cx24120_clone_params(struct dvb_frontend *fe)
1133 {
1134 struct cx24120_state *state = fe->demodulator_priv;
1135
1136 state->dcur = state->dnxt;
1137 }
1138
1139 static int cx24120_set_frontend(struct dvb_frontend *fe)
1140 {
1141 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1142 struct cx24120_state *state = fe->demodulator_priv;
1143 struct cx24120_cmd cmd;
1144 int ret;
1145
1146 switch (c->delivery_system) {
1147 case SYS_DVBS2:
1148 dev_dbg(&state->i2c->dev, "DVB-S2\n");
1149 break;
1150 case SYS_DVBS:
1151 dev_dbg(&state->i2c->dev, "DVB-S\n");
1152 break;
1153 default:
1154 dev_dbg(&state->i2c->dev,
1155 "delivery system(%d) not supported\n",
1156 c->delivery_system);
1157 return -EINVAL;
1158 }
1159
1160 state->dnxt.delsys = c->delivery_system;
1161 state->dnxt.modulation = c->modulation;
1162 state->dnxt.frequency = c->frequency;
1163 state->dnxt.pilot = c->pilot;
1164
1165 ret = cx24120_set_inversion(state, c->inversion);
1166 if (ret != 0)
1167 return ret;
1168
1169 ret = cx24120_set_fec(state, c->modulation, c->fec_inner);
1170 if (ret != 0)
1171 return ret;
1172
1173 ret = cx24120_set_pilot(state, c->pilot);
1174 if (ret != 0)
1175 return ret;
1176
1177 ret = cx24120_set_symbolrate(state, c->symbol_rate);
1178 if (ret != 0)
1179 return ret;
1180
1181 /* discard the 'current' tuning parameters and prepare to tune */
1182 cx24120_clone_params(fe);
1183
1184 dev_dbg(&state->i2c->dev,
1185 "delsys = %d\n", state->dcur.delsys);
1186 dev_dbg(&state->i2c->dev,
1187 "modulation = %d\n", state->dcur.modulation);
1188 dev_dbg(&state->i2c->dev,
1189 "frequency = %d\n", state->dcur.frequency);
1190 dev_dbg(&state->i2c->dev,
1191 "pilot = %d (val = 0x%02x)\n",
1192 state->dcur.pilot, state->dcur.pilot_val);
1193 dev_dbg(&state->i2c->dev,
1194 "symbol_rate = %d (clkdiv/ratediv = 0x%02x/0x%02x)\n",
1195 state->dcur.symbol_rate,
1196 state->dcur.clkdiv, state->dcur.ratediv);
1197 dev_dbg(&state->i2c->dev,
1198 "FEC = %d (mask/val = 0x%02x/0x%02x)\n",
1199 state->dcur.fec, state->dcur.fec_mask, state->dcur.fec_val);
1200 dev_dbg(&state->i2c->dev,
1201 "Inversion = %d (val = 0x%02x)\n",
1202 state->dcur.inversion, state->dcur.inversion_val);
1203
1204 /* Flag that clock needs to be set after tune */
1205 state->need_clock_set = 1;
1206
1207 /* Tune in */
1208 cmd.id = CMD_TUNEREQUEST;
1209 cmd.len = 15;
1210 cmd.arg[0] = 0;
1211 cmd.arg[1] = (state->dcur.frequency & 0xff0000) >> 16;
1212 cmd.arg[2] = (state->dcur.frequency & 0x00ff00) >> 8;
1213 cmd.arg[3] = (state->dcur.frequency & 0x0000ff);
1214 cmd.arg[4] = ((state->dcur.symbol_rate / 1000) & 0xff00) >> 8;
1215 cmd.arg[5] = ((state->dcur.symbol_rate / 1000) & 0x00ff);
1216 cmd.arg[6] = state->dcur.inversion;
1217 cmd.arg[7] = state->dcur.fec_val | state->dcur.pilot_val;
1218 cmd.arg[8] = CX24120_SEARCH_RANGE_KHZ >> 8;
1219 cmd.arg[9] = CX24120_SEARCH_RANGE_KHZ & 0xff;
1220 cmd.arg[10] = 0; /* maybe rolloff? */
1221 cmd.arg[11] = state->dcur.fec_mask;
1222 cmd.arg[12] = state->dcur.ratediv;
1223 cmd.arg[13] = state->dcur.clkdiv;
1224 cmd.arg[14] = 0;
1225
1226 /* Send tune command */
1227 ret = cx24120_message_send(state, &cmd);
1228 if (ret != 0)
1229 return ret;
1230
1231 /* Write symbol rate values */
1232 ret = cx24120_writereg(state, CX24120_REG_CLKDIV, state->dcur.clkdiv);
1233 ret = cx24120_readreg(state, CX24120_REG_RATEDIV);
1234 ret &= 0xfffffff0;
1235 ret |= state->dcur.ratediv;
1236 ret = cx24120_writereg(state, CX24120_REG_RATEDIV, ret);
1237
1238 return 0;
1239 }
1240
1241 /* Set vco from config */
1242 static int cx24120_set_vco(struct cx24120_state *state)
1243 {
1244 struct cx24120_cmd cmd;
1245 u32 nxtal_khz, vco;
1246 u64 inv_vco;
1247 u32 xtal_khz = state->config->xtal_khz;
1248
1249 nxtal_khz = xtal_khz * 4;
1250 vco = nxtal_khz * 10;
1251 inv_vco = DIV_ROUND_CLOSEST_ULL(0x400000000ULL, vco);
1252
1253 dev_dbg(&state->i2c->dev, "xtal=%d, vco=%d, inv_vco=%lld\n",
1254 xtal_khz, vco, inv_vco);
1255
1256 cmd.id = CMD_VCO_SET;
1257 cmd.len = 12;
1258 cmd.arg[0] = (vco >> 16) & 0xff;
1259 cmd.arg[1] = (vco >> 8) & 0xff;
1260 cmd.arg[2] = vco & 0xff;
1261 cmd.arg[3] = (inv_vco >> 8) & 0xff;
1262 cmd.arg[4] = (inv_vco) & 0xff;
1263 cmd.arg[5] = 0x03;
1264 cmd.arg[6] = (nxtal_khz >> 8) & 0xff;
1265 cmd.arg[7] = nxtal_khz & 0xff;
1266 cmd.arg[8] = 0x06;
1267 cmd.arg[9] = 0x03;
1268 cmd.arg[10] = (xtal_khz >> 16) & 0xff;
1269 cmd.arg[11] = xtal_khz & 0xff;
1270
1271 return cx24120_message_send(state, &cmd);
1272 }
1273
1274 static int cx24120_init(struct dvb_frontend *fe)
1275 {
1276 const struct firmware *fw;
1277 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1278 struct cx24120_state *state = fe->demodulator_priv;
1279 struct cx24120_cmd cmd;
1280 u8 reg;
1281 int ret, i;
1282 unsigned char vers[4];
1283
1284 if (state->cold_init)
1285 return 0;
1286
1287 /* ???? */
1288 cx24120_writereg(state, 0xea, 0x00);
1289 cx24120_test_rom(state);
1290 reg = cx24120_readreg(state, 0xfb) & 0xfe;
1291 cx24120_writereg(state, 0xfb, reg);
1292 reg = cx24120_readreg(state, 0xfc) & 0xfe;
1293 cx24120_writereg(state, 0xfc, reg);
1294 cx24120_writereg(state, 0xc3, 0x04);
1295 cx24120_writereg(state, 0xc4, 0x04);
1296 cx24120_writereg(state, 0xce, 0x00);
1297 cx24120_writereg(state, 0xcf, 0x00);
1298 reg = cx24120_readreg(state, 0xea) & 0xfe;
1299 cx24120_writereg(state, 0xea, reg);
1300 cx24120_writereg(state, 0xeb, 0x0c);
1301 cx24120_writereg(state, 0xec, 0x06);
1302 cx24120_writereg(state, 0xed, 0x05);
1303 cx24120_writereg(state, 0xee, 0x03);
1304 cx24120_writereg(state, 0xef, 0x05);
1305 cx24120_writereg(state, 0xf3, 0x03);
1306 cx24120_writereg(state, 0xf4, 0x44);
1307
1308 for (i = 0; i < 3; i++) {
1309 cx24120_writereg(state, 0xf0 + i, 0x04);
1310 cx24120_writereg(state, 0xe6 + i, 0x02);
1311 }
1312
1313 cx24120_writereg(state, 0xea, (reg | 0x01));
1314 for (i = 0; i < 6; i += 2) {
1315 cx24120_writereg(state, 0xc5 + i, 0x00);
1316 cx24120_writereg(state, 0xc6 + i, 0x00);
1317 }
1318
1319 cx24120_writereg(state, 0xe4, 0x03);
1320 cx24120_writereg(state, 0xeb, 0x0a);
1321
1322 dev_dbg(&state->i2c->dev, "requesting firmware (%s) to download...\n",
1323 CX24120_FIRMWARE);
1324
1325 ret = state->config->request_firmware(fe, &fw, CX24120_FIRMWARE);
1326 if (ret) {
1327 err("Could not load firmware (%s): %d\n", CX24120_FIRMWARE,
1328 ret);
1329 return ret;
1330 }
1331
1332 dev_dbg(&state->i2c->dev,
1333 "Firmware found, size %d bytes (%02x %02x .. %02x %02x)\n",
1334 (int)fw->size, /* firmware_size in bytes */
1335 fw->data[0], /* fw 1st byte */
1336 fw->data[1], /* fw 2d byte */
1337 fw->data[fw->size - 2], /* fw before last byte */
1338 fw->data[fw->size - 1]); /* fw last byte */
1339
1340 cx24120_test_rom(state);
1341 reg = cx24120_readreg(state, 0xfb) & 0xfe;
1342 cx24120_writereg(state, 0xfb, reg);
1343 cx24120_writereg(state, 0xe0, 0x76);
1344 cx24120_writereg(state, 0xf7, 0x81);
1345 cx24120_writereg(state, 0xf8, 0x00);
1346 cx24120_writereg(state, 0xf9, 0x00);
1347 cx24120_writeregs(state, 0xfa, fw->data, (fw->size - 1), 0x00);
1348 cx24120_writereg(state, 0xf7, 0xc0);
1349 cx24120_writereg(state, 0xe0, 0x00);
1350 reg = (fw->size - 2) & 0x00ff;
1351 cx24120_writereg(state, 0xf8, reg);
1352 reg = ((fw->size - 2) >> 8) & 0x00ff;
1353 cx24120_writereg(state, 0xf9, reg);
1354 cx24120_writereg(state, 0xf7, 0x00);
1355 cx24120_writereg(state, 0xdc, 0x00);
1356 cx24120_writereg(state, 0xdc, 0x07);
1357 msleep(500);
1358
1359 /* Check final byte matches final byte of firmware */
1360 reg = cx24120_readreg(state, 0xe1);
1361 if (reg == fw->data[fw->size - 1]) {
1362 dev_dbg(&state->i2c->dev, "Firmware uploaded successfully\n");
1363 ret = 0;
1364 } else {
1365 err("Firmware upload failed. Last byte returned=0x%x\n", ret);
1366 ret = -EREMOTEIO;
1367 }
1368 cx24120_writereg(state, 0xdc, 0x00);
1369 release_firmware(fw);
1370 if (ret != 0)
1371 return ret;
1372
1373 /* Start tuner */
1374 cmd.id = CMD_START_TUNER;
1375 cmd.len = 3;
1376 cmd.arg[0] = 0x00;
1377 cmd.arg[1] = 0x00;
1378 cmd.arg[2] = 0x00;
1379
1380 if (cx24120_message_send(state, &cmd) != 0) {
1381 err("Error tuner start! :(\n");
1382 return -EREMOTEIO;
1383 }
1384
1385 /* Set VCO */
1386 ret = cx24120_set_vco(state);
1387 if (ret != 0) {
1388 err("Error set VCO! :(\n");
1389 return ret;
1390 }
1391
1392 /* set bandwidth */
1393 cmd.id = CMD_BANDWIDTH;
1394 cmd.len = 12;
1395 cmd.arg[0] = 0x00;
1396 cmd.arg[1] = 0x00;
1397 cmd.arg[2] = 0x00;
1398 cmd.arg[3] = 0x00;
1399 cmd.arg[4] = 0x05;
1400 cmd.arg[5] = 0x02;
1401 cmd.arg[6] = 0x02;
1402 cmd.arg[7] = 0x00;
1403 cmd.arg[8] = 0x05;
1404 cmd.arg[9] = 0x02;
1405 cmd.arg[10] = 0x02;
1406 cmd.arg[11] = 0x00;
1407
1408 if (cx24120_message_send(state, &cmd)) {
1409 err("Error set bandwidth!\n");
1410 return -EREMOTEIO;
1411 }
1412
1413 reg = cx24120_readreg(state, 0xba);
1414 if (reg > 3) {
1415 dev_dbg(&state->i2c->dev, "Reset-readreg 0xba: %x\n", ret);
1416 err("Error initialising tuner!\n");
1417 return -EREMOTEIO;
1418 }
1419
1420 dev_dbg(&state->i2c->dev, "Tuner initialised correctly.\n");
1421
1422 /* Initialise mpeg outputs */
1423 cx24120_writereg(state, 0xeb, 0x0a);
1424 if (cx24120_msg_mpeg_output_global_config(state, 0) ||
1425 cx24120_msg_mpeg_output_config(state, 0) ||
1426 cx24120_msg_mpeg_output_config(state, 1) ||
1427 cx24120_msg_mpeg_output_config(state, 2)) {
1428 err("Error initialising mpeg output. :(\n");
1429 return -EREMOTEIO;
1430 }
1431
1432 /* Set size of BER window */
1433 cmd.id = CMD_BER_CTRL;
1434 cmd.len = 3;
1435 cmd.arg[0] = 0x00;
1436 cmd.arg[1] = CX24120_BER_WINDOW;
1437 cmd.arg[2] = CX24120_BER_WINDOW;
1438 if (cx24120_message_send(state, &cmd)) {
1439 err("Error setting ber window\n");
1440 return -EREMOTEIO;
1441 }
1442
1443 /* Firmware CMD 35: Get firmware version */
1444 cmd.id = CMD_FWVERSION;
1445 cmd.len = 1;
1446 for (i = 0; i < 4; i++) {
1447 cmd.arg[0] = i;
1448 ret = cx24120_message_send(state, &cmd);
1449 if (ret != 0)
1450 return ret;
1451 vers[i] = cx24120_readreg(state, CX24120_REG_MAILBOX);
1452 }
1453 info("FW version %i.%i.%i.%i\n", vers[0], vers[1], vers[2], vers[3]);
1454
1455 /* init stats here in order signal app which stats are supported */
1456 c->strength.len = 1;
1457 c->strength.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1458 c->cnr.len = 1;
1459 c->cnr.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1460 c->post_bit_error.len = 1;
1461 c->post_bit_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1462 c->post_bit_count.len = 1;
1463 c->post_bit_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1464 c->block_error.len = 1;
1465 c->block_error.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1466 c->block_count.len = 1;
1467 c->block_count.stat[0].scale = FE_SCALE_NOT_AVAILABLE;
1468
1469 state->cold_init = 1;
1470
1471 return 0;
1472 }
1473
1474 static int cx24120_tune(struct dvb_frontend *fe, bool re_tune,
1475 unsigned int mode_flags, unsigned int *delay,
1476 enum fe_status *status)
1477 {
1478 struct cx24120_state *state = fe->demodulator_priv;
1479 int ret;
1480
1481 dev_dbg(&state->i2c->dev, "(%d)\n", re_tune);
1482
1483 /* TODO: Do we need to set delay? */
1484
1485 if (re_tune) {
1486 ret = cx24120_set_frontend(fe);
1487 if (ret)
1488 return ret;
1489 }
1490
1491 return cx24120_read_status(fe, status);
1492 }
1493
1494 static int cx24120_get_algo(struct dvb_frontend *fe)
1495 {
1496 return DVBFE_ALGO_HW;
1497 }
1498
1499 static int cx24120_sleep(struct dvb_frontend *fe)
1500 {
1501 return 0;
1502 }
1503
1504 static int cx24120_get_frontend(struct dvb_frontend *fe,
1505 struct dtv_frontend_properties *c)
1506 {
1507 struct cx24120_state *state = fe->demodulator_priv;
1508 u8 freq1, freq2, freq3;
1509 int status;
1510
1511 dev_dbg(&state->i2c->dev, "\n");
1512
1513 /* don't return empty data if we're not tuned in */
1514 status = cx24120_readreg(state, CX24120_REG_STATUS);
1515 if (!(status & CX24120_HAS_LOCK))
1516 return 0;
1517
1518 /* Get frequency */
1519 freq1 = cx24120_readreg(state, CX24120_REG_FREQ1);
1520 freq2 = cx24120_readreg(state, CX24120_REG_FREQ2);
1521 freq3 = cx24120_readreg(state, CX24120_REG_FREQ3);
1522 c->frequency = (freq3 << 16) | (freq2 << 8) | freq1;
1523 dev_dbg(&state->i2c->dev, "frequency = %d\n", c->frequency);
1524
1525 /* Get modulation, fec, pilot */
1526 cx24120_get_fec(fe);
1527
1528 return 0;
1529 }
1530
1531 static void cx24120_release(struct dvb_frontend *fe)
1532 {
1533 struct cx24120_state *state = fe->demodulator_priv;
1534
1535 dev_dbg(&state->i2c->dev, "Clear state structure\n");
1536 kfree(state);
1537 }
1538
1539 static int cx24120_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
1540 {
1541 struct cx24120_state *state = fe->demodulator_priv;
1542 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1543
1544 if (c->block_error.stat[0].scale != FE_SCALE_COUNTER) {
1545 *ucblocks = 0;
1546 return 0;
1547 }
1548
1549 *ucblocks = c->block_error.stat[0].uvalue - state->ucb_offset;
1550
1551 return 0;
1552 }
1553
1554 static const struct dvb_frontend_ops cx24120_ops = {
1555 .delsys = { SYS_DVBS, SYS_DVBS2 },
1556 .info = {
1557 .name = "Conexant CX24120/CX24118",
1558 .frequency_min = 950000,
1559 .frequency_max = 2150000,
1560 .frequency_stepsize = 1011, /* kHz for QPSK frontends */
1561 .frequency_tolerance = 5000,
1562 .symbol_rate_min = 1000000,
1563 .symbol_rate_max = 45000000,
1564 .caps = FE_CAN_INVERSION_AUTO |
1565 FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
1566 FE_CAN_FEC_4_5 | FE_CAN_FEC_5_6 | FE_CAN_FEC_6_7 |
1567 FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
1568 FE_CAN_2G_MODULATION |
1569 FE_CAN_QPSK | FE_CAN_RECOVER
1570 },
1571 .release = cx24120_release,
1572
1573 .init = cx24120_init,
1574 .sleep = cx24120_sleep,
1575
1576 .tune = cx24120_tune,
1577 .get_frontend_algo = cx24120_get_algo,
1578 .set_frontend = cx24120_set_frontend,
1579
1580 .get_frontend = cx24120_get_frontend,
1581 .read_status = cx24120_read_status,
1582 .read_ber = cx24120_read_ber,
1583 .read_signal_strength = cx24120_read_signal_strength,
1584 .read_snr = cx24120_read_snr,
1585 .read_ucblocks = cx24120_read_ucblocks,
1586
1587 .diseqc_send_master_cmd = cx24120_send_diseqc_msg,
1588
1589 .diseqc_send_burst = cx24120_diseqc_send_burst,
1590 .set_tone = cx24120_set_tone,
1591 .set_voltage = cx24120_set_voltage,
1592 };
1593
1594 MODULE_DESCRIPTION("DVB Frontend module for Conexant CX24120/CX24118 hardware");
1595 MODULE_AUTHOR("Jemma Denson");
1596 MODULE_LICENSE("GPL");
Linux with added FPC-III support