blob: 83e6f1a1b7009cae02fb0c3579901a2d032be126 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -03002 Driver for Zarlink VP310/MT312/ZL10313 Satellite Channel Decoder
Linus Torvalds1da177e2005-04-16 15:20:36 -07003
4 Copyright (C) 2003 Andreas Oberritter <obi@linuxtv.org>
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -03005 Copyright (C) 2008 Matthias Schwarzott <zzam@gentoo.org>
Linus Torvalds1da177e2005-04-16 15:20:36 -07006
7 This program is free software; you can redistribute it and/or modify
8 it under the terms of the GNU General Public License as published by
9 the Free Software Foundation; either version 2 of the License, or
10 (at your option) any later version.
11
12 This program is distributed in the hope that it will be useful,
13 but WITHOUT ANY WARRANTY; without even the implied warranty of
14 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15
16 GNU General Public License for more details.
17
18 You should have received a copy of the GNU General Public License
19 along with this program; if not, write to the Free Software
20 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21
22 References:
23 http://products.zarlink.com/product_profiles/MT312.htm
24 http://products.zarlink.com/product_profiles/SL1935.htm
25*/
26
27#include <linux/delay.h>
28#include <linux/errno.h>
29#include <linux/init.h>
30#include <linux/kernel.h>
31#include <linux/module.h>
Tim Schmielau4e57b682005-10-30 15:03:48 -080032#include <linux/string.h>
33#include <linux/slab.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070034
35#include "dvb_frontend.h"
36#include "mt312_priv.h"
37#include "mt312.h"
38
39
40struct mt312_state {
Matthias Schwarzott89f64752007-12-21 08:56:44 -030041 struct i2c_adapter *i2c;
Linus Torvalds1da177e2005-04-16 15:20:36 -070042 /* configuration settings */
Matthias Schwarzott89f64752007-12-21 08:56:44 -030043 const struct mt312_config *config;
Linus Torvalds1da177e2005-04-16 15:20:36 -070044 struct dvb_frontend frontend;
45
46 u8 id;
Matthias Schwarzott111221f2008-04-12 15:04:48 -030047 unsigned long xtal;
48 u8 freq_mult;
Linus Torvalds1da177e2005-04-16 15:20:36 -070049};
50
51static int debug;
52#define dprintk(args...) \
53 do { \
Matthias Schwarzott89f64752007-12-21 08:56:44 -030054 if (debug) \
55 printk(KERN_DEBUG "mt312: " args); \
Linus Torvalds1da177e2005-04-16 15:20:36 -070056 } while (0)
57
Linus Torvalds1da177e2005-04-16 15:20:36 -070058#define MT312_PLL_CLK 10000000UL /* 10 MHz */
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -030059#define MT312_PLL_CLK_10_111 10111000UL /* 10.111 MHz */
Linus Torvalds1da177e2005-04-16 15:20:36 -070060
Matthias Schwarzott89f64752007-12-21 08:56:44 -030061static int mt312_read(struct mt312_state *state, const enum mt312_reg_addr reg,
Matthias Schwarzott1881ee82008-04-12 15:04:46 -030062 u8 *buf, const size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -070063{
64 int ret;
65 struct i2c_msg msg[2];
66 u8 regbuf[1] = { reg };
67
68 msg[0].addr = state->config->demod_address;
69 msg[0].flags = 0;
70 msg[0].buf = regbuf;
71 msg[0].len = 1;
72 msg[1].addr = state->config->demod_address;
73 msg[1].flags = I2C_M_RD;
74 msg[1].buf = buf;
75 msg[1].len = count;
76
77 ret = i2c_transfer(state->i2c, msg, 2);
78
79 if (ret != 2) {
Matthias Schwarzott302e8ac2009-05-20 04:57:10 -030080 printk(KERN_DEBUG "%s: ret == %d\n", __func__, ret);
Linus Torvalds1da177e2005-04-16 15:20:36 -070081 return -EREMOTEIO;
82 }
83
Matthias Schwarzott89f64752007-12-21 08:56:44 -030084 if (debug) {
Linus Torvalds1da177e2005-04-16 15:20:36 -070085 int i;
86 dprintk("R(%d):", reg & 0x7f);
87 for (i = 0; i < count; i++)
Matthias Schwarzott0389b342009-07-02 16:17:28 -030088 printk(KERN_CONT " %02x", buf[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -070089 printk("\n");
90 }
91
92 return 0;
93}
94
Matthias Schwarzott89f64752007-12-21 08:56:44 -030095static int mt312_write(struct mt312_state *state, const enum mt312_reg_addr reg,
Matthias Schwarzott1881ee82008-04-12 15:04:46 -030096 const u8 *src, const size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -070097{
98 int ret;
99 u8 buf[count + 1];
100 struct i2c_msg msg;
101
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300102 if (debug) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700103 int i;
104 dprintk("W(%d):", reg & 0x7f);
105 for (i = 0; i < count; i++)
Matthias Schwarzott0389b342009-07-02 16:17:28 -0300106 printk(KERN_CONT " %02x", src[i]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 printk("\n");
108 }
109
110 buf[0] = reg;
111 memcpy(&buf[1], src, count);
112
113 msg.addr = state->config->demod_address;
114 msg.flags = 0;
115 msg.buf = buf;
116 msg.len = count + 1;
117
118 ret = i2c_transfer(state->i2c, &msg, 1);
119
120 if (ret != 1) {
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300121 dprintk("%s: ret == %d\n", __func__, ret);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700122 return -EREMOTEIO;
123 }
124
125 return 0;
126}
127
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300128static inline int mt312_readreg(struct mt312_state *state,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129 const enum mt312_reg_addr reg, u8 *val)
130{
131 return mt312_read(state, reg, val, 1);
132}
133
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300134static inline int mt312_writereg(struct mt312_state *state,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700135 const enum mt312_reg_addr reg, const u8 val)
136{
137 return mt312_write(state, reg, &val, 1);
138}
139
140static inline u32 mt312_div(u32 a, u32 b)
141{
142 return (a + (b / 2)) / b;
143}
144
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300145static int mt312_reset(struct mt312_state *state, const u8 full)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146{
147 return mt312_writereg(state, RESET, full ? 0x80 : 0x40);
148}
149
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300150static int mt312_get_inversion(struct mt312_state *state,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700151 fe_spectral_inversion_t *i)
152{
153 int ret;
154 u8 vit_mode;
155
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300156 ret = mt312_readreg(state, VIT_MODE, &vit_mode);
157 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158 return ret;
159
160 if (vit_mode & 0x80) /* auto inversion was used */
161 *i = (vit_mode & 0x40) ? INVERSION_ON : INVERSION_OFF;
162
163 return 0;
164}
165
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300166static int mt312_get_symbol_rate(struct mt312_state *state, u32 *sr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700167{
168 int ret;
169 u8 sym_rate_h;
170 u8 dec_ratio;
171 u16 sym_rat_op;
172 u16 monitor;
173 u8 buf[2];
174
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300175 ret = mt312_readreg(state, SYM_RATE_H, &sym_rate_h);
176 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177 return ret;
178
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300179 if (sym_rate_h & 0x80) {
180 /* symbol rate search was used */
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300181 ret = mt312_writereg(state, MON_CTRL, 0x03);
182 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 return ret;
184
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300185 ret = mt312_read(state, MONITOR_H, buf, sizeof(buf));
186 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700187 return ret;
188
189 monitor = (buf[0] << 8) | buf[1];
190
Matthias Schwarzott0b6a3342007-12-21 08:58:09 -0300191 dprintk("sr(auto) = %u\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192 mt312_div(monitor * 15625, 4));
193 } else {
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300194 ret = mt312_writereg(state, MON_CTRL, 0x05);
195 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 return ret;
197
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300198 ret = mt312_read(state, MONITOR_H, buf, sizeof(buf));
199 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700200 return ret;
201
202 dec_ratio = ((buf[0] >> 5) & 0x07) * 32;
203
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300204 ret = mt312_read(state, SYM_RAT_OP_H, buf, sizeof(buf));
205 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700206 return ret;
207
208 sym_rat_op = (buf[0] << 8) | buf[1];
209
Matthias Schwarzott0b6a3342007-12-21 08:58:09 -0300210 dprintk("sym_rat_op=%d dec_ratio=%d\n",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700211 sym_rat_op, dec_ratio);
Matthias Schwarzott0b6a3342007-12-21 08:58:09 -0300212 dprintk("*sr(manual) = %lu\n",
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300213 (((state->xtal * 8192) / (sym_rat_op + 8192)) *
Linus Torvalds1da177e2005-04-16 15:20:36 -0700214 2) - dec_ratio);
215 }
216
217 return 0;
218}
219
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300220static int mt312_get_code_rate(struct mt312_state *state, fe_code_rate_t *cr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700221{
222 const fe_code_rate_t fec_tab[8] =
223 { FEC_1_2, FEC_2_3, FEC_3_4, FEC_5_6, FEC_6_7, FEC_7_8,
224 FEC_AUTO, FEC_AUTO };
225
226 int ret;
227 u8 fec_status;
228
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300229 ret = mt312_readreg(state, FEC_STATUS, &fec_status);
230 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231 return ret;
232
233 *cr = fec_tab[(fec_status >> 4) & 0x07];
234
235 return 0;
236}
237
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300238static int mt312_initfe(struct dvb_frontend *fe)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700239{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700240 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 int ret;
242 u8 buf[2];
243
244 /* wake up */
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300245 ret = mt312_writereg(state, CONFIG,
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300246 (state->freq_mult == 6 ? 0x88 : 0x8c));
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300247 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700248 return ret;
249
250 /* wait at least 150 usec */
251 udelay(150);
252
253 /* full reset */
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300254 ret = mt312_reset(state, 1);
255 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700256 return ret;
257
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300258/* Per datasheet, write correct values. 09/28/03 ACCJr.
259 * If we don't do this, we won't get FE_HAS_VITERBI in the VP310. */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700260 {
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300261 u8 buf_def[8] = { 0x14, 0x12, 0x03, 0x02,
262 0x01, 0x00, 0x00, 0x00 };
Linus Torvalds1da177e2005-04-16 15:20:36 -0700263
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300264 ret = mt312_write(state, VIT_SETUP, buf_def, sizeof(buf_def));
265 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266 return ret;
267 }
268
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300269 switch (state->id) {
270 case ID_ZL10313:
271 /* enable ADC */
272 ret = mt312_writereg(state, GPP_CTRL, 0x80);
273 if (ret < 0)
274 return ret;
275
276 /* configure ZL10313 for optimal ADC performance */
277 buf[0] = 0x80;
278 buf[1] = 0xB0;
279 ret = mt312_write(state, HW_CTRL, buf, 2);
280 if (ret < 0)
281 return ret;
282
283 /* enable MPEG output and ADCs */
284 ret = mt312_writereg(state, HW_CTRL, 0x00);
285 if (ret < 0)
286 return ret;
287
288 ret = mt312_writereg(state, MPEG_CTRL, 0x00);
289 if (ret < 0)
290 return ret;
291
292 break;
293 }
294
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 /* SYS_CLK */
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300296 buf[0] = mt312_div(state->xtal * state->freq_mult * 2, 1000000);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700297
298 /* DISEQC_RATIO */
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300299 buf[1] = mt312_div(state->xtal, 22000 * 4);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700300
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300301 ret = mt312_write(state, SYS_CLK, buf, sizeof(buf));
302 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700303 return ret;
304
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300305 ret = mt312_writereg(state, SNR_THS_HIGH, 0x32);
306 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700307 return ret;
308
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300309 /* different MOCLK polarity */
310 switch (state->id) {
311 case ID_ZL10313:
312 buf[0] = 0x33;
313 break;
314 default:
315 buf[0] = 0x53;
316 break;
317 }
318
319 ret = mt312_writereg(state, OP_CTRL, buf[0]);
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300320 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700321 return ret;
322
323 /* TS_SW_LIM */
324 buf[0] = 0x8c;
325 buf[1] = 0x98;
326
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300327 ret = mt312_write(state, TS_SW_LIM_L, buf, sizeof(buf));
328 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700329 return ret;
330
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300331 ret = mt312_writereg(state, CS_SW_LIM, 0x69);
332 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700333 return ret;
334
Linus Torvalds1da177e2005-04-16 15:20:36 -0700335 return 0;
336}
337
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300338static int mt312_send_master_cmd(struct dvb_frontend *fe,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700339 struct dvb_diseqc_master_cmd *c)
340{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700341 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700342 int ret;
343 u8 diseqc_mode;
344
345 if ((c->msg_len == 0) || (c->msg_len > sizeof(c->msg)))
346 return -EINVAL;
347
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300348 ret = mt312_readreg(state, DISEQC_MODE, &diseqc_mode);
349 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700350 return ret;
351
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300352 ret = mt312_write(state, (0x80 | DISEQC_INSTR), c->msg, c->msg_len);
353 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700354 return ret;
355
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300356 ret = mt312_writereg(state, DISEQC_MODE,
357 (diseqc_mode & 0x40) | ((c->msg_len - 1) << 3)
358 | 0x04);
359 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 return ret;
361
Matthias Schwarzott82cd2df2008-04-12 15:04:47 -0300362 /* is there a better way to wait for message to be transmitted */
363 msleep(100);
364
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 /* set DISEQC_MODE[2:0] to zero if a return message is expected */
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300366 if (c->msg[0] & 0x02) {
367 ret = mt312_writereg(state, DISEQC_MODE, (diseqc_mode & 0x40));
368 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700369 return ret;
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300370 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700371
372 return 0;
373}
374
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300375static int mt312_send_burst(struct dvb_frontend *fe, const fe_sec_mini_cmd_t c)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700377 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700378 const u8 mini_tab[2] = { 0x02, 0x03 };
379
380 int ret;
381 u8 diseqc_mode;
382
383 if (c > SEC_MINI_B)
384 return -EINVAL;
385
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300386 ret = mt312_readreg(state, DISEQC_MODE, &diseqc_mode);
387 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700388 return ret;
389
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300390 ret = mt312_writereg(state, DISEQC_MODE,
391 (diseqc_mode & 0x40) | mini_tab[c]);
392 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700393 return ret;
394
395 return 0;
396}
397
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300398static int mt312_set_tone(struct dvb_frontend *fe, const fe_sec_tone_mode_t t)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700400 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700401 const u8 tone_tab[2] = { 0x01, 0x00 };
402
403 int ret;
404 u8 diseqc_mode;
405
406 if (t > SEC_TONE_OFF)
407 return -EINVAL;
408
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300409 ret = mt312_readreg(state, DISEQC_MODE, &diseqc_mode);
410 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 return ret;
412
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300413 ret = mt312_writereg(state, DISEQC_MODE,
414 (diseqc_mode & 0x40) | tone_tab[t]);
415 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 return ret;
417
418 return 0;
419}
420
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300421static int mt312_set_voltage(struct dvb_frontend *fe, const fe_sec_voltage_t v)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700422{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700423 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700424 const u8 volt_tab[3] = { 0x00, 0x40, 0x00 };
Matthias Schwarzott11d3f322008-04-12 15:04:50 -0300425 u8 val;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426
427 if (v > SEC_VOLTAGE_OFF)
428 return -EINVAL;
429
Matthias Schwarzott11d3f322008-04-12 15:04:50 -0300430 val = volt_tab[v];
431 if (state->config->voltage_inverted)
432 val ^= 0x40;
433
434 return mt312_writereg(state, DISEQC_MODE, val);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700435}
436
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300437static int mt312_read_status(struct dvb_frontend *fe, fe_status_t *s)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700438{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700439 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440 int ret;
441 u8 status[3];
442
443 *s = 0;
444
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300445 ret = mt312_read(state, QPSK_STAT_H, status, sizeof(status));
446 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447 return ret;
448
Matthias Schwarzott0b6a3342007-12-21 08:58:09 -0300449 dprintk("QPSK_STAT_H: 0x%02x, QPSK_STAT_L: 0x%02x,"
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300450 " FEC_STATUS: 0x%02x\n", status[0], status[1], status[2]);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451
452 if (status[0] & 0xc0)
453 *s |= FE_HAS_SIGNAL; /* signal noise ratio */
454 if (status[0] & 0x04)
455 *s |= FE_HAS_CARRIER; /* qpsk carrier lock */
456 if (status[2] & 0x02)
457 *s |= FE_HAS_VITERBI; /* viterbi lock */
458 if (status[2] & 0x04)
459 *s |= FE_HAS_SYNC; /* byte align lock */
460 if (status[0] & 0x01)
461 *s |= FE_HAS_LOCK; /* qpsk lock */
462
463 return 0;
464}
465
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300466static int mt312_read_ber(struct dvb_frontend *fe, u32 *ber)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700467{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700468 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700469 int ret;
470 u8 buf[3];
471
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300472 ret = mt312_read(state, RS_BERCNT_H, buf, 3);
473 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700474 return ret;
475
476 *ber = ((buf[0] << 16) | (buf[1] << 8) | buf[2]) * 64;
477
478 return 0;
479}
480
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300481static int mt312_read_signal_strength(struct dvb_frontend *fe,
482 u16 *signal_strength)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700483{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700484 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700485 int ret;
486 u8 buf[3];
487 u16 agc;
488 s16 err_db;
489
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300490 ret = mt312_read(state, AGC_H, buf, sizeof(buf));
491 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700492 return ret;
493
494 agc = (buf[0] << 6) | (buf[1] >> 2);
495 err_db = (s16) (((buf[1] & 0x03) << 14) | buf[2] << 6) >> 6;
496
497 *signal_strength = agc;
498
Matthias Schwarzott0b6a3342007-12-21 08:58:09 -0300499 dprintk("agc=%08x err_db=%hd\n", agc, err_db);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700500
501 return 0;
502}
503
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300504static int mt312_read_snr(struct dvb_frontend *fe, u16 *snr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700506 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 int ret;
508 u8 buf[2];
509
Matthias Schwarzott1881ee82008-04-12 15:04:46 -0300510 ret = mt312_read(state, M_SNR_H, buf, sizeof(buf));
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300511 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512 return ret;
513
514 *snr = 0xFFFF - ((((buf[0] & 0x7f) << 8) | buf[1]) << 1);
515
516 return 0;
517}
518
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300519static int mt312_read_ucblocks(struct dvb_frontend *fe, u32 *ubc)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700520{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700521 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700522 int ret;
523 u8 buf[2];
524
Matthias Schwarzott1881ee82008-04-12 15:04:46 -0300525 ret = mt312_read(state, RS_UBC_H, buf, sizeof(buf));
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300526 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527 return ret;
528
529 *ubc = (buf[0] << 8) | buf[1];
530
531 return 0;
532}
533
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300534static int mt312_set_frontend(struct dvb_frontend *fe,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700535 struct dvb_frontend_parameters *p)
536{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700537 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538 int ret;
539 u8 buf[5], config_val;
540 u16 sr;
541
542 const u8 fec_tab[10] =
543 { 0x00, 0x01, 0x02, 0x04, 0x3f, 0x08, 0x10, 0x20, 0x3f, 0x3f };
544 const u8 inv_tab[3] = { 0x00, 0x40, 0x80 };
545
Harvey Harrison271ddbf2008-04-08 23:20:00 -0300546 dprintk("%s: Freq %d\n", __func__, p->frequency);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547
Patrick Boettcherdea74862006-05-14 05:01:31 -0300548 if ((p->frequency < fe->ops.info.frequency_min)
549 || (p->frequency > fe->ops.info.frequency_max))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700550 return -EINVAL;
551
552 if ((p->inversion < INVERSION_OFF)
553 || (p->inversion > INVERSION_ON))
554 return -EINVAL;
555
Patrick Boettcherdea74862006-05-14 05:01:31 -0300556 if ((p->u.qpsk.symbol_rate < fe->ops.info.symbol_rate_min)
557 || (p->u.qpsk.symbol_rate > fe->ops.info.symbol_rate_max))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558 return -EINVAL;
559
560 if ((p->u.qpsk.fec_inner < FEC_NONE)
561 || (p->u.qpsk.fec_inner > FEC_AUTO))
562 return -EINVAL;
563
564 if ((p->u.qpsk.fec_inner == FEC_4_5)
565 || (p->u.qpsk.fec_inner == FEC_8_9))
566 return -EINVAL;
567
568 switch (state->id) {
569 case ID_VP310:
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300570 /* For now we will do this only for the VP310.
571 * It should be better for the mt312 as well,
572 * but tuning will be slower. ACCJr 09/29/03
573 */
Alexey Dobriyan682e8522006-01-10 00:09:16 +0300574 ret = mt312_readreg(state, CONFIG, &config_val);
575 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576 return ret;
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300577 if (p->u.qpsk.symbol_rate >= 30000000) {
578 /* Note that 30MS/s should use 90MHz */
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300579 if (state->freq_mult == 6) {
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300580 /* We are running 60MHz */
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300581 state->freq_mult = 9;
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300582 ret = mt312_initfe(fe);
583 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700584 return ret;
585 }
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300586 } else {
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300587 if (state->freq_mult == 9) {
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300588 /* We are running 90MHz */
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300589 state->freq_mult = 6;
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300590 ret = mt312_initfe(fe);
591 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700592 return ret;
593 }
594 }
595 break;
596
597 case ID_MT312:
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300598 case ID_ZL10313:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599 break;
600
601 default:
602 return -EINVAL;
603 }
604
Patrick Boettcherdea74862006-05-14 05:01:31 -0300605 if (fe->ops.tuner_ops.set_params) {
606 fe->ops.tuner_ops.set_params(fe, p);
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300607 if (fe->ops.i2c_gate_ctrl)
608 fe->ops.i2c_gate_ctrl(fe, 0);
Andrew de Quinceya81870e2006-04-18 17:47:09 -0300609 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700610
611 /* sr = (u16)(sr * 256.0 / 1000000.0) */
612 sr = mt312_div(p->u.qpsk.symbol_rate * 4, 15625);
613
614 /* SYM_RATE */
615 buf[0] = (sr >> 8) & 0x3f;
616 buf[1] = (sr >> 0) & 0xff;
617
618 /* VIT_MODE */
619 buf[2] = inv_tab[p->inversion] | fec_tab[p->u.qpsk.fec_inner];
620
621 /* QPSK_CTRL */
622 buf[3] = 0x40; /* swap I and Q before QPSK demodulation */
623
624 if (p->u.qpsk.symbol_rate < 10000000)
625 buf[3] |= 0x04; /* use afc mode */
626
627 /* GO */
628 buf[4] = 0x01;
629
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300630 ret = mt312_write(state, SYM_RATE_H, buf, sizeof(buf));
631 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700632 return ret;
633
Mauro Carvalho Chehab9101e622005-12-12 00:37:24 -0800634 mt312_reset(state, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700635
636 return 0;
637}
638
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300639static int mt312_get_frontend(struct dvb_frontend *fe,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700640 struct dvb_frontend_parameters *p)
641{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700642 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700643 int ret;
644
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300645 ret = mt312_get_inversion(state, &p->inversion);
646 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700647 return ret;
648
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300649 ret = mt312_get_symbol_rate(state, &p->u.qpsk.symbol_rate);
650 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651 return ret;
652
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300653 ret = mt312_get_code_rate(state, &p->u.qpsk.fec_inner);
654 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700655 return ret;
656
657 return 0;
658}
659
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300660static int mt312_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
Andrew de Quinceya81870e2006-04-18 17:47:09 -0300661{
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300662 struct mt312_state *state = fe->demodulator_priv;
Andrew de Quinceya81870e2006-04-18 17:47:09 -0300663
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300664 u8 val = 0x00;
665 int ret;
666
667 switch (state->id) {
668 case ID_ZL10313:
669 ret = mt312_readreg(state, GPP_CTRL, &val);
670 if (ret < 0)
671 goto error;
672
Lucas De Marchi25985ed2011-03-30 22:57:33 -0300673 /* preserve this bit to not accidentally shutdown ADC */
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300674 val &= 0x80;
675 break;
Andrew de Quinceya81870e2006-04-18 17:47:09 -0300676 }
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300677
678 if (enable)
679 val |= 0x40;
680 else
681 val &= ~0x40;
682
683 ret = mt312_writereg(state, GPP_CTRL, val);
684
685error:
686 return ret;
Andrew de Quinceya81870e2006-04-18 17:47:09 -0300687}
688
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300689static int mt312_sleep(struct dvb_frontend *fe)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700690{
Johannes Stezenbachb8742702005-05-16 21:54:31 -0700691 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692 int ret;
693 u8 config;
694
695 /* reset all registers to defaults */
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300696 ret = mt312_reset(state, 1);
697 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700698 return ret;
699
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300700 if (state->id == ID_ZL10313) {
701 /* reset ADC */
702 ret = mt312_writereg(state, GPP_CTRL, 0x00);
703 if (ret < 0)
704 return ret;
705
706 /* full shutdown of ADCs, mpeg bus tristated */
707 ret = mt312_writereg(state, HW_CTRL, 0x0d);
708 if (ret < 0)
709 return ret;
710 }
711
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300712 ret = mt312_readreg(state, CONFIG, &config);
713 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700714 return ret;
715
716 /* enter standby */
Matthias Schwarzott994fc28b2007-12-24 07:12:55 -0300717 ret = mt312_writereg(state, CONFIG, config & 0x7f);
718 if (ret < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700719 return ret;
720
721 return 0;
722}
723
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300724static int mt312_get_tune_settings(struct dvb_frontend *fe,
725 struct dvb_frontend_tune_settings *fesettings)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700726{
727 fesettings->min_delay_ms = 50;
728 fesettings->step_size = 0;
729 fesettings->max_drift = 0;
730 return 0;
731}
732
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300733static void mt312_release(struct dvb_frontend *fe)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700734{
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300735 struct mt312_state *state = fe->demodulator_priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700736 kfree(state);
737}
738
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300739#define MT312_SYS_CLK 90000000UL /* 90 MHz */
Matthias Schwarzotte4671b62008-04-30 12:21:04 -0300740static struct dvb_frontend_ops mt312_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700741
742 .info = {
743 .name = "Zarlink ???? DVB-S",
744 .type = FE_QPSK,
745 .frequency_min = 950000,
746 .frequency_max = 2150000,
Matthias Schwarzott0389b342009-07-02 16:17:28 -0300747 /* FIXME: adjust freq to real used xtal */
748 .frequency_stepsize = (MT312_PLL_CLK / 1000) / 128,
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300749 .symbol_rate_min = MT312_SYS_CLK / 128, /* FIXME as above */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700750 .symbol_rate_max = MT312_SYS_CLK / 2,
751 .caps =
752 FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 |
753 FE_CAN_FEC_3_4 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 |
754 FE_CAN_FEC_AUTO | FE_CAN_QPSK | FE_CAN_MUTE_TS |
Mauro Carvalho Chehab9101e622005-12-12 00:37:24 -0800755 FE_CAN_RECOVER
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756 },
757
758 .release = mt312_release,
759
760 .init = mt312_initfe,
761 .sleep = mt312_sleep,
Andrew de Quinceya81870e2006-04-18 17:47:09 -0300762 .i2c_gate_ctrl = mt312_i2c_gate_ctrl,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700763
764 .set_frontend = mt312_set_frontend,
765 .get_frontend = mt312_get_frontend,
766 .get_tune_settings = mt312_get_tune_settings,
767
768 .read_status = mt312_read_status,
769 .read_ber = mt312_read_ber,
770 .read_signal_strength = mt312_read_signal_strength,
771 .read_snr = mt312_read_snr,
772 .read_ucblocks = mt312_read_ucblocks,
773
774 .diseqc_send_master_cmd = mt312_send_master_cmd,
775 .diseqc_send_burst = mt312_send_burst,
776 .set_tone = mt312_set_tone,
777 .set_voltage = mt312_set_voltage,
778};
779
Matthias Schwarzotte4671b62008-04-30 12:21:04 -0300780struct dvb_frontend *mt312_attach(const struct mt312_config *config,
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300781 struct i2c_adapter *i2c)
Adrian Bunk805e6602006-02-27 00:07:49 -0300782{
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300783 struct mt312_state *state = NULL;
Adrian Bunk805e6602006-02-27 00:07:49 -0300784
785 /* allocate memory for the internal state */
Matthias Schwarzott084e24a2009-08-10 22:51:01 -0300786 state = kzalloc(sizeof(struct mt312_state), GFP_KERNEL);
Adrian Bunk805e6602006-02-27 00:07:49 -0300787 if (state == NULL)
788 goto error;
789
790 /* setup the state */
791 state->config = config;
792 state->i2c = i2c;
Adrian Bunk805e6602006-02-27 00:07:49 -0300793
794 /* check if the demod is there */
795 if (mt312_readreg(state, ID, &state->id) < 0)
796 goto error;
797
Patrick Boettcherdea74862006-05-14 05:01:31 -0300798 /* create dvb_frontend */
Matthias Schwarzotte4671b62008-04-30 12:21:04 -0300799 memcpy(&state->frontend.ops, &mt312_ops,
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300800 sizeof(struct dvb_frontend_ops));
Patrick Boettcherdea74862006-05-14 05:01:31 -0300801 state->frontend.demodulator_priv = state;
802
Adrian Bunk805e6602006-02-27 00:07:49 -0300803 switch (state->id) {
804 case ID_VP310:
Patrick Boettcherdea74862006-05-14 05:01:31 -0300805 strcpy(state->frontend.ops.info.name, "Zarlink VP310 DVB-S");
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300806 state->xtal = MT312_PLL_CLK;
807 state->freq_mult = 9;
Adrian Bunk805e6602006-02-27 00:07:49 -0300808 break;
809 case ID_MT312:
Patrick Boettcherdea74862006-05-14 05:01:31 -0300810 strcpy(state->frontend.ops.info.name, "Zarlink MT312 DVB-S");
Matthias Schwarzott111221f2008-04-12 15:04:48 -0300811 state->xtal = MT312_PLL_CLK;
812 state->freq_mult = 6;
Adrian Bunk805e6602006-02-27 00:07:49 -0300813 break;
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300814 case ID_ZL10313:
815 strcpy(state->frontend.ops.info.name, "Zarlink ZL10313 DVB-S");
816 state->xtal = MT312_PLL_CLK_10_111;
817 state->freq_mult = 9;
818 break;
Adrian Bunk805e6602006-02-27 00:07:49 -0300819 default:
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300820 printk(KERN_WARNING "Only Zarlink VP310/MT312/ZL10313"
Matthias Schwarzott89f64752007-12-21 08:56:44 -0300821 " are supported chips.\n");
Adrian Bunk805e6602006-02-27 00:07:49 -0300822 goto error;
823 }
824
Adrian Bunk805e6602006-02-27 00:07:49 -0300825 return &state->frontend;
826
827error:
828 kfree(state);
829 return NULL;
830}
Matthias Schwarzotte4671b62008-04-30 12:21:04 -0300831EXPORT_SYMBOL(mt312_attach);
Adrian Bunk805e6602006-02-27 00:07:49 -0300832
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833module_param(debug, int, 0644);
834MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
835
Matthias Schwarzott6a5cbd52008-04-12 15:04:49 -0300836MODULE_DESCRIPTION("Zarlink VP310/MT312/ZL10313 DVB-S Demodulator driver");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700837MODULE_AUTHOR("Andreas Oberritter <obi@linuxtv.org>");
Matthias Schwarzotte4671b62008-04-30 12:21:04 -0300838MODULE_AUTHOR("Matthias Schwarzott <zzam@gentoo.org>");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700839MODULE_LICENSE("GPL");
840