xref: /OK3568_Linux_fs/kernel/drivers/media/dvb-frontends/m88rs2000.c (revision 4882a59341e53eb6f0b4789bf948001014eff981)
1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun 	Driver for M88RS2000 demodulator and tuner
4*4882a593Smuzhiyun 
5*4882a593Smuzhiyun 	Copyright (C) 2012 Malcolm Priestley (tvboxspy@gmail.com)
6*4882a593Smuzhiyun 	Beta Driver
7*4882a593Smuzhiyun 
8*4882a593Smuzhiyun 	Include various calculation code from DS3000 driver.
9*4882a593Smuzhiyun 	Copyright (C) 2009 Konstantin Dimitrov.
10*4882a593Smuzhiyun 
11*4882a593Smuzhiyun 
12*4882a593Smuzhiyun */
13*4882a593Smuzhiyun #include <linux/init.h>
14*4882a593Smuzhiyun #include <linux/module.h>
15*4882a593Smuzhiyun #include <linux/device.h>
16*4882a593Smuzhiyun #include <linux/jiffies.h>
17*4882a593Smuzhiyun #include <linux/string.h>
18*4882a593Smuzhiyun #include <linux/slab.h>
19*4882a593Smuzhiyun #include <linux/types.h>
20*4882a593Smuzhiyun 
21*4882a593Smuzhiyun 
22*4882a593Smuzhiyun #include <media/dvb_frontend.h>
23*4882a593Smuzhiyun #include "m88rs2000.h"
24*4882a593Smuzhiyun 
25*4882a593Smuzhiyun struct m88rs2000_state {
26*4882a593Smuzhiyun 	struct i2c_adapter *i2c;
27*4882a593Smuzhiyun 	const struct m88rs2000_config *config;
28*4882a593Smuzhiyun 	struct dvb_frontend frontend;
29*4882a593Smuzhiyun 	u8 no_lock_count;
30*4882a593Smuzhiyun 	u32 tuner_frequency;
31*4882a593Smuzhiyun 	u32 symbol_rate;
32*4882a593Smuzhiyun 	enum fe_code_rate fec_inner;
33*4882a593Smuzhiyun 	u8 tuner_level;
34*4882a593Smuzhiyun 	int errmode;
35*4882a593Smuzhiyun };
36*4882a593Smuzhiyun 
37*4882a593Smuzhiyun static int m88rs2000_debug;
38*4882a593Smuzhiyun 
39*4882a593Smuzhiyun module_param_named(debug, m88rs2000_debug, int, 0644);
40*4882a593Smuzhiyun MODULE_PARM_DESC(debug, "set debugging level (1=info (or-able)).");
41*4882a593Smuzhiyun 
42*4882a593Smuzhiyun #define dprintk(level, args...) do { \
43*4882a593Smuzhiyun 	if (level & m88rs2000_debug) \
44*4882a593Smuzhiyun 		printk(KERN_DEBUG "m88rs2000-fe: " args); \
45*4882a593Smuzhiyun } while (0)
46*4882a593Smuzhiyun 
47*4882a593Smuzhiyun #define deb_info(args...)  dprintk(0x01, args)
48*4882a593Smuzhiyun #define info(format, arg...) \
49*4882a593Smuzhiyun 	printk(KERN_INFO "m88rs2000-fe: " format "\n" , ## arg)
50*4882a593Smuzhiyun 
m88rs2000_writereg(struct m88rs2000_state * state,u8 reg,u8 data)51*4882a593Smuzhiyun static int m88rs2000_writereg(struct m88rs2000_state *state,
52*4882a593Smuzhiyun 	u8 reg, u8 data)
53*4882a593Smuzhiyun {
54*4882a593Smuzhiyun 	int ret;
55*4882a593Smuzhiyun 	u8 buf[] = { reg, data };
56*4882a593Smuzhiyun 	struct i2c_msg msg = {
57*4882a593Smuzhiyun 		.addr = state->config->demod_addr,
58*4882a593Smuzhiyun 		.flags = 0,
59*4882a593Smuzhiyun 		.buf = buf,
60*4882a593Smuzhiyun 		.len = 2
61*4882a593Smuzhiyun 	};
62*4882a593Smuzhiyun 
63*4882a593Smuzhiyun 	ret = i2c_transfer(state->i2c, &msg, 1);
64*4882a593Smuzhiyun 
65*4882a593Smuzhiyun 	if (ret != 1)
66*4882a593Smuzhiyun 		deb_info("%s: writereg error (reg == 0x%02x, val == 0x%02x, ret == %i)\n",
67*4882a593Smuzhiyun 			 __func__, reg, data, ret);
68*4882a593Smuzhiyun 
69*4882a593Smuzhiyun 	return (ret != 1) ? -EREMOTEIO : 0;
70*4882a593Smuzhiyun }
71*4882a593Smuzhiyun 
m88rs2000_readreg(struct m88rs2000_state * state,u8 reg)72*4882a593Smuzhiyun static u8 m88rs2000_readreg(struct m88rs2000_state *state, u8 reg)
73*4882a593Smuzhiyun {
74*4882a593Smuzhiyun 	int ret;
75*4882a593Smuzhiyun 	u8 b0[] = { reg };
76*4882a593Smuzhiyun 	u8 b1[] = { 0 };
77*4882a593Smuzhiyun 
78*4882a593Smuzhiyun 	struct i2c_msg msg[] = {
79*4882a593Smuzhiyun 		{
80*4882a593Smuzhiyun 			.addr = state->config->demod_addr,
81*4882a593Smuzhiyun 			.flags = 0,
82*4882a593Smuzhiyun 			.buf = b0,
83*4882a593Smuzhiyun 			.len = 1
84*4882a593Smuzhiyun 		}, {
85*4882a593Smuzhiyun 			.addr = state->config->demod_addr,
86*4882a593Smuzhiyun 			.flags = I2C_M_RD,
87*4882a593Smuzhiyun 			.buf = b1,
88*4882a593Smuzhiyun 			.len = 1
89*4882a593Smuzhiyun 		}
90*4882a593Smuzhiyun 	};
91*4882a593Smuzhiyun 
92*4882a593Smuzhiyun 	ret = i2c_transfer(state->i2c, msg, 2);
93*4882a593Smuzhiyun 
94*4882a593Smuzhiyun 	if (ret != 2)
95*4882a593Smuzhiyun 		deb_info("%s: readreg error (reg == 0x%02x, ret == %i)\n",
96*4882a593Smuzhiyun 				__func__, reg, ret);
97*4882a593Smuzhiyun 
98*4882a593Smuzhiyun 	return b1[0];
99*4882a593Smuzhiyun }
100*4882a593Smuzhiyun 
m88rs2000_get_mclk(struct dvb_frontend * fe)101*4882a593Smuzhiyun static u32 m88rs2000_get_mclk(struct dvb_frontend *fe)
102*4882a593Smuzhiyun {
103*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
104*4882a593Smuzhiyun 	u32 mclk;
105*4882a593Smuzhiyun 	u8 reg;
106*4882a593Smuzhiyun 	/* Must not be 0x00 or 0xff */
107*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0x86);
108*4882a593Smuzhiyun 	if (!reg || reg == 0xff)
109*4882a593Smuzhiyun 		return 0;
110*4882a593Smuzhiyun 
111*4882a593Smuzhiyun 	reg /= 2;
112*4882a593Smuzhiyun 	reg += 1;
113*4882a593Smuzhiyun 
114*4882a593Smuzhiyun 	mclk = (u32)(reg * RS2000_FE_CRYSTAL_KHZ + 28 / 2) / 28;
115*4882a593Smuzhiyun 
116*4882a593Smuzhiyun 	return mclk;
117*4882a593Smuzhiyun }
118*4882a593Smuzhiyun 
m88rs2000_set_carrieroffset(struct dvb_frontend * fe,s16 offset)119*4882a593Smuzhiyun static int m88rs2000_set_carrieroffset(struct dvb_frontend *fe, s16 offset)
120*4882a593Smuzhiyun {
121*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
122*4882a593Smuzhiyun 	u32 mclk;
123*4882a593Smuzhiyun 	s32 tmp;
124*4882a593Smuzhiyun 	u8 reg;
125*4882a593Smuzhiyun 	int ret;
126*4882a593Smuzhiyun 
127*4882a593Smuzhiyun 	mclk = m88rs2000_get_mclk(fe);
128*4882a593Smuzhiyun 	if (!mclk)
129*4882a593Smuzhiyun 		return -EINVAL;
130*4882a593Smuzhiyun 
131*4882a593Smuzhiyun 	tmp = (offset * 4096 + (s32)mclk / 2) / (s32)mclk;
132*4882a593Smuzhiyun 	if (tmp < 0)
133*4882a593Smuzhiyun 		tmp += 4096;
134*4882a593Smuzhiyun 
135*4882a593Smuzhiyun 	/* Carrier Offset */
136*4882a593Smuzhiyun 	ret = m88rs2000_writereg(state, 0x9c, (u8)(tmp >> 4));
137*4882a593Smuzhiyun 
138*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0x9d);
139*4882a593Smuzhiyun 	reg &= 0xf;
140*4882a593Smuzhiyun 	reg |= (u8)(tmp & 0xf) << 4;
141*4882a593Smuzhiyun 
142*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x9d, reg);
143*4882a593Smuzhiyun 
144*4882a593Smuzhiyun 	return ret;
145*4882a593Smuzhiyun }
146*4882a593Smuzhiyun 
m88rs2000_set_symbolrate(struct dvb_frontend * fe,u32 srate)147*4882a593Smuzhiyun static int m88rs2000_set_symbolrate(struct dvb_frontend *fe, u32 srate)
148*4882a593Smuzhiyun {
149*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
150*4882a593Smuzhiyun 	int ret;
151*4882a593Smuzhiyun 	u64 temp;
152*4882a593Smuzhiyun 	u32 mclk;
153*4882a593Smuzhiyun 	u8 b[3];
154*4882a593Smuzhiyun 
155*4882a593Smuzhiyun 	if ((srate < 1000000) || (srate > 45000000))
156*4882a593Smuzhiyun 		return -EINVAL;
157*4882a593Smuzhiyun 
158*4882a593Smuzhiyun 	mclk = m88rs2000_get_mclk(fe);
159*4882a593Smuzhiyun 	if (!mclk)
160*4882a593Smuzhiyun 		return -EINVAL;
161*4882a593Smuzhiyun 
162*4882a593Smuzhiyun 	temp = srate / 1000;
163*4882a593Smuzhiyun 	temp *= 1 << 24;
164*4882a593Smuzhiyun 
165*4882a593Smuzhiyun 	do_div(temp, mclk);
166*4882a593Smuzhiyun 
167*4882a593Smuzhiyun 	b[0] = (u8) (temp >> 16) & 0xff;
168*4882a593Smuzhiyun 	b[1] = (u8) (temp >> 8) & 0xff;
169*4882a593Smuzhiyun 	b[2] = (u8) temp & 0xff;
170*4882a593Smuzhiyun 
171*4882a593Smuzhiyun 	ret = m88rs2000_writereg(state, 0x93, b[2]);
172*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x94, b[1]);
173*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x95, b[0]);
174*4882a593Smuzhiyun 
175*4882a593Smuzhiyun 	if (srate > 10000000)
176*4882a593Smuzhiyun 		ret |= m88rs2000_writereg(state, 0xa0, 0x20);
177*4882a593Smuzhiyun 	else
178*4882a593Smuzhiyun 		ret |= m88rs2000_writereg(state, 0xa0, 0x60);
179*4882a593Smuzhiyun 
180*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0xa1, 0xe0);
181*4882a593Smuzhiyun 
182*4882a593Smuzhiyun 	if (srate > 12000000)
183*4882a593Smuzhiyun 		ret |= m88rs2000_writereg(state, 0xa3, 0x20);
184*4882a593Smuzhiyun 	else if (srate > 2800000)
185*4882a593Smuzhiyun 		ret |= m88rs2000_writereg(state, 0xa3, 0x98);
186*4882a593Smuzhiyun 	else
187*4882a593Smuzhiyun 		ret |= m88rs2000_writereg(state, 0xa3, 0x90);
188*4882a593Smuzhiyun 
189*4882a593Smuzhiyun 	deb_info("m88rs2000: m88rs2000_set_symbolrate\n");
190*4882a593Smuzhiyun 	return ret;
191*4882a593Smuzhiyun }
192*4882a593Smuzhiyun 
m88rs2000_send_diseqc_msg(struct dvb_frontend * fe,struct dvb_diseqc_master_cmd * m)193*4882a593Smuzhiyun static int m88rs2000_send_diseqc_msg(struct dvb_frontend *fe,
194*4882a593Smuzhiyun 				    struct dvb_diseqc_master_cmd *m)
195*4882a593Smuzhiyun {
196*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
197*4882a593Smuzhiyun 
198*4882a593Smuzhiyun 	int i;
199*4882a593Smuzhiyun 	u8 reg;
200*4882a593Smuzhiyun 	deb_info("%s\n", __func__);
201*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0x30);
202*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0xb2);
203*4882a593Smuzhiyun 	reg &= 0x3f;
204*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb2, reg);
205*4882a593Smuzhiyun 	for (i = 0; i <  m->msg_len; i++)
206*4882a593Smuzhiyun 		m88rs2000_writereg(state, 0xb3 + i, m->msg[i]);
207*4882a593Smuzhiyun 
208*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0xb1);
209*4882a593Smuzhiyun 	reg &= 0x87;
210*4882a593Smuzhiyun 	reg |= ((m->msg_len - 1) << 3) | 0x07;
211*4882a593Smuzhiyun 	reg &= 0x7f;
212*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb1, reg);
213*4882a593Smuzhiyun 
214*4882a593Smuzhiyun 	for (i = 0; i < 15; i++) {
215*4882a593Smuzhiyun 		if ((m88rs2000_readreg(state, 0xb1) & 0x40) == 0x0)
216*4882a593Smuzhiyun 			break;
217*4882a593Smuzhiyun 		msleep(20);
218*4882a593Smuzhiyun 	}
219*4882a593Smuzhiyun 
220*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0xb1);
221*4882a593Smuzhiyun 	if ((reg & 0x40) > 0x0) {
222*4882a593Smuzhiyun 		reg &= 0x7f;
223*4882a593Smuzhiyun 		reg |= 0x40;
224*4882a593Smuzhiyun 		m88rs2000_writereg(state, 0xb1, reg);
225*4882a593Smuzhiyun 	}
226*4882a593Smuzhiyun 
227*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0xb2);
228*4882a593Smuzhiyun 	reg &= 0x3f;
229*4882a593Smuzhiyun 	reg |= 0x80;
230*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb2, reg);
231*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0xb0);
232*4882a593Smuzhiyun 
233*4882a593Smuzhiyun 
234*4882a593Smuzhiyun 	return 0;
235*4882a593Smuzhiyun }
236*4882a593Smuzhiyun 
m88rs2000_send_diseqc_burst(struct dvb_frontend * fe,enum fe_sec_mini_cmd burst)237*4882a593Smuzhiyun static int m88rs2000_send_diseqc_burst(struct dvb_frontend *fe,
238*4882a593Smuzhiyun 				       enum fe_sec_mini_cmd burst)
239*4882a593Smuzhiyun {
240*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
241*4882a593Smuzhiyun 	u8 reg0, reg1;
242*4882a593Smuzhiyun 	deb_info("%s\n", __func__);
243*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0x30);
244*4882a593Smuzhiyun 	msleep(50);
245*4882a593Smuzhiyun 	reg0 = m88rs2000_readreg(state, 0xb1);
246*4882a593Smuzhiyun 	reg1 = m88rs2000_readreg(state, 0xb2);
247*4882a593Smuzhiyun 	/* TODO complete this section */
248*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb2, reg1);
249*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb1, reg0);
250*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0xb0);
251*4882a593Smuzhiyun 
252*4882a593Smuzhiyun 	return 0;
253*4882a593Smuzhiyun }
254*4882a593Smuzhiyun 
m88rs2000_set_tone(struct dvb_frontend * fe,enum fe_sec_tone_mode tone)255*4882a593Smuzhiyun static int m88rs2000_set_tone(struct dvb_frontend *fe,
256*4882a593Smuzhiyun 			      enum fe_sec_tone_mode tone)
257*4882a593Smuzhiyun {
258*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
259*4882a593Smuzhiyun 	u8 reg0, reg1;
260*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0x30);
261*4882a593Smuzhiyun 	reg0 = m88rs2000_readreg(state, 0xb1);
262*4882a593Smuzhiyun 	reg1 = m88rs2000_readreg(state, 0xb2);
263*4882a593Smuzhiyun 
264*4882a593Smuzhiyun 	reg1 &= 0x3f;
265*4882a593Smuzhiyun 
266*4882a593Smuzhiyun 	switch (tone) {
267*4882a593Smuzhiyun 	case SEC_TONE_ON:
268*4882a593Smuzhiyun 		reg0 |= 0x4;
269*4882a593Smuzhiyun 		reg0 &= 0xbc;
270*4882a593Smuzhiyun 		break;
271*4882a593Smuzhiyun 	case SEC_TONE_OFF:
272*4882a593Smuzhiyun 		reg1 |= 0x80;
273*4882a593Smuzhiyun 		break;
274*4882a593Smuzhiyun 	default:
275*4882a593Smuzhiyun 		break;
276*4882a593Smuzhiyun 	}
277*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb2, reg1);
278*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb1, reg0);
279*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0xb0);
280*4882a593Smuzhiyun 	return 0;
281*4882a593Smuzhiyun }
282*4882a593Smuzhiyun 
283*4882a593Smuzhiyun struct inittab {
284*4882a593Smuzhiyun 	u8 cmd;
285*4882a593Smuzhiyun 	u8 reg;
286*4882a593Smuzhiyun 	u8 val;
287*4882a593Smuzhiyun };
288*4882a593Smuzhiyun 
289*4882a593Smuzhiyun static struct inittab m88rs2000_setup[] = {
290*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9a, 0x30},
291*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x00, 0x01},
292*4882a593Smuzhiyun 	{WRITE_DELAY, 0x19, 0x00},
293*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x00, 0x00},
294*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9a, 0xb0},
295*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x81, 0xc1},
296*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x81, 0x81},
297*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x86, 0xc6},
298*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9a, 0x30},
299*4882a593Smuzhiyun 	{DEMOD_WRITE, 0xf0, 0x22},
300*4882a593Smuzhiyun 	{DEMOD_WRITE, 0xf1, 0xbf},
301*4882a593Smuzhiyun 	{DEMOD_WRITE, 0xb0, 0x45},
302*4882a593Smuzhiyun 	{DEMOD_WRITE, 0xb2, 0x01}, /* set voltage pin always set 1*/
303*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9a, 0xb0},
304*4882a593Smuzhiyun 	{0xff, 0xaa, 0xff}
305*4882a593Smuzhiyun };
306*4882a593Smuzhiyun 
307*4882a593Smuzhiyun static struct inittab m88rs2000_shutdown[] = {
308*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9a, 0x30},
309*4882a593Smuzhiyun 	{DEMOD_WRITE, 0xb0, 0x00},
310*4882a593Smuzhiyun 	{DEMOD_WRITE, 0xf1, 0x89},
311*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x00, 0x01},
312*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9a, 0xb0},
313*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x81, 0x81},
314*4882a593Smuzhiyun 	{0xff, 0xaa, 0xff}
315*4882a593Smuzhiyun };
316*4882a593Smuzhiyun 
317*4882a593Smuzhiyun static struct inittab fe_reset[] = {
318*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x00, 0x01},
319*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x20, 0x81},
320*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x21, 0x80},
321*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x10, 0x33},
322*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x11, 0x44},
323*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x12, 0x07},
324*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x18, 0x20},
325*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x28, 0x04},
326*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x29, 0x8e},
327*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x3b, 0xff},
328*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x32, 0x10},
329*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x33, 0x02},
330*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x34, 0x30},
331*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x35, 0xff},
332*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x38, 0x50},
333*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x39, 0x68},
334*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x3c, 0x7f},
335*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x3d, 0x0f},
336*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x45, 0x20},
337*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x46, 0x24},
338*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x47, 0x7c},
339*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x48, 0x16},
340*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x49, 0x04},
341*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x4a, 0x01},
342*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x4b, 0x78},
343*4882a593Smuzhiyun 	{DEMOD_WRITE, 0X4d, 0xd2},
344*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x4e, 0x6d},
345*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x50, 0x30},
346*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x51, 0x30},
347*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x54, 0x7b},
348*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x56, 0x09},
349*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x58, 0x59},
350*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x59, 0x37},
351*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x63, 0xfa},
352*4882a593Smuzhiyun 	{0xff, 0xaa, 0xff}
353*4882a593Smuzhiyun };
354*4882a593Smuzhiyun 
355*4882a593Smuzhiyun static struct inittab fe_trigger[] = {
356*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x97, 0x04},
357*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x99, 0x77},
358*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9b, 0x64},
359*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9e, 0x00},
360*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9f, 0xf8},
361*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x98, 0xff},
362*4882a593Smuzhiyun 	{DEMOD_WRITE, 0xc0, 0x0f},
363*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x89, 0x01},
364*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x00, 0x00},
365*4882a593Smuzhiyun 	{WRITE_DELAY, 0x0a, 0x00},
366*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x00, 0x01},
367*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x00, 0x00},
368*4882a593Smuzhiyun 	{DEMOD_WRITE, 0x9a, 0xb0},
369*4882a593Smuzhiyun 	{0xff, 0xaa, 0xff}
370*4882a593Smuzhiyun };
371*4882a593Smuzhiyun 
m88rs2000_tab_set(struct m88rs2000_state * state,struct inittab * tab)372*4882a593Smuzhiyun static int m88rs2000_tab_set(struct m88rs2000_state *state,
373*4882a593Smuzhiyun 		struct inittab *tab)
374*4882a593Smuzhiyun {
375*4882a593Smuzhiyun 	int ret = 0;
376*4882a593Smuzhiyun 	u8 i;
377*4882a593Smuzhiyun 	if (tab == NULL)
378*4882a593Smuzhiyun 		return -EINVAL;
379*4882a593Smuzhiyun 
380*4882a593Smuzhiyun 	for (i = 0; i < 255; i++) {
381*4882a593Smuzhiyun 		switch (tab[i].cmd) {
382*4882a593Smuzhiyun 		case 0x01:
383*4882a593Smuzhiyun 			ret = m88rs2000_writereg(state, tab[i].reg,
384*4882a593Smuzhiyun 				tab[i].val);
385*4882a593Smuzhiyun 			break;
386*4882a593Smuzhiyun 		case 0x10:
387*4882a593Smuzhiyun 			if (tab[i].reg > 0)
388*4882a593Smuzhiyun 				mdelay(tab[i].reg);
389*4882a593Smuzhiyun 			break;
390*4882a593Smuzhiyun 		case 0xff:
391*4882a593Smuzhiyun 			if (tab[i].reg == 0xaa && tab[i].val == 0xff)
392*4882a593Smuzhiyun 				return 0;
393*4882a593Smuzhiyun 		case 0x00:
394*4882a593Smuzhiyun 			break;
395*4882a593Smuzhiyun 		default:
396*4882a593Smuzhiyun 			return -EINVAL;
397*4882a593Smuzhiyun 		}
398*4882a593Smuzhiyun 		if (ret < 0)
399*4882a593Smuzhiyun 			return -ENODEV;
400*4882a593Smuzhiyun 	}
401*4882a593Smuzhiyun 	return 0;
402*4882a593Smuzhiyun }
403*4882a593Smuzhiyun 
m88rs2000_set_voltage(struct dvb_frontend * fe,enum fe_sec_voltage volt)404*4882a593Smuzhiyun static int m88rs2000_set_voltage(struct dvb_frontend *fe,
405*4882a593Smuzhiyun 				 enum fe_sec_voltage volt)
406*4882a593Smuzhiyun {
407*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
408*4882a593Smuzhiyun 	u8 data;
409*4882a593Smuzhiyun 
410*4882a593Smuzhiyun 	data = m88rs2000_readreg(state, 0xb2);
411*4882a593Smuzhiyun 	data |= 0x03; /* bit0 V/H, bit1 off/on */
412*4882a593Smuzhiyun 
413*4882a593Smuzhiyun 	switch (volt) {
414*4882a593Smuzhiyun 	case SEC_VOLTAGE_18:
415*4882a593Smuzhiyun 		data &= ~0x03;
416*4882a593Smuzhiyun 		break;
417*4882a593Smuzhiyun 	case SEC_VOLTAGE_13:
418*4882a593Smuzhiyun 		data &= ~0x03;
419*4882a593Smuzhiyun 		data |= 0x01;
420*4882a593Smuzhiyun 		break;
421*4882a593Smuzhiyun 	case SEC_VOLTAGE_OFF:
422*4882a593Smuzhiyun 		break;
423*4882a593Smuzhiyun 	}
424*4882a593Smuzhiyun 
425*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xb2, data);
426*4882a593Smuzhiyun 
427*4882a593Smuzhiyun 	return 0;
428*4882a593Smuzhiyun }
429*4882a593Smuzhiyun 
m88rs2000_init(struct dvb_frontend * fe)430*4882a593Smuzhiyun static int m88rs2000_init(struct dvb_frontend *fe)
431*4882a593Smuzhiyun {
432*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
433*4882a593Smuzhiyun 	int ret;
434*4882a593Smuzhiyun 
435*4882a593Smuzhiyun 	deb_info("m88rs2000: init chip\n");
436*4882a593Smuzhiyun 	/* Setup frontend from shutdown/cold */
437*4882a593Smuzhiyun 	if (state->config->inittab)
438*4882a593Smuzhiyun 		ret = m88rs2000_tab_set(state,
439*4882a593Smuzhiyun 				(struct inittab *)state->config->inittab);
440*4882a593Smuzhiyun 	else
441*4882a593Smuzhiyun 		ret = m88rs2000_tab_set(state, m88rs2000_setup);
442*4882a593Smuzhiyun 
443*4882a593Smuzhiyun 	return ret;
444*4882a593Smuzhiyun }
445*4882a593Smuzhiyun 
m88rs2000_sleep(struct dvb_frontend * fe)446*4882a593Smuzhiyun static int m88rs2000_sleep(struct dvb_frontend *fe)
447*4882a593Smuzhiyun {
448*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
449*4882a593Smuzhiyun 	int ret;
450*4882a593Smuzhiyun 	/* Shutdown the frondend */
451*4882a593Smuzhiyun 	ret = m88rs2000_tab_set(state, m88rs2000_shutdown);
452*4882a593Smuzhiyun 	return ret;
453*4882a593Smuzhiyun }
454*4882a593Smuzhiyun 
m88rs2000_read_status(struct dvb_frontend * fe,enum fe_status * status)455*4882a593Smuzhiyun static int m88rs2000_read_status(struct dvb_frontend *fe,
456*4882a593Smuzhiyun 				 enum fe_status *status)
457*4882a593Smuzhiyun {
458*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
459*4882a593Smuzhiyun 	u8 reg = m88rs2000_readreg(state, 0x8c);
460*4882a593Smuzhiyun 
461*4882a593Smuzhiyun 	*status = 0;
462*4882a593Smuzhiyun 
463*4882a593Smuzhiyun 	if ((reg & 0xee) == 0xee) {
464*4882a593Smuzhiyun 		*status = FE_HAS_CARRIER | FE_HAS_SIGNAL | FE_HAS_VITERBI
465*4882a593Smuzhiyun 			| FE_HAS_SYNC | FE_HAS_LOCK;
466*4882a593Smuzhiyun 		if (state->config->set_ts_params)
467*4882a593Smuzhiyun 			state->config->set_ts_params(fe, CALL_IS_READ);
468*4882a593Smuzhiyun 	}
469*4882a593Smuzhiyun 	return 0;
470*4882a593Smuzhiyun }
471*4882a593Smuzhiyun 
m88rs2000_read_ber(struct dvb_frontend * fe,u32 * ber)472*4882a593Smuzhiyun static int m88rs2000_read_ber(struct dvb_frontend *fe, u32 *ber)
473*4882a593Smuzhiyun {
474*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
475*4882a593Smuzhiyun 	u8 tmp0, tmp1;
476*4882a593Smuzhiyun 
477*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0x30);
478*4882a593Smuzhiyun 	tmp0 = m88rs2000_readreg(state, 0xd8);
479*4882a593Smuzhiyun 	if ((tmp0 & 0x10) != 0) {
480*4882a593Smuzhiyun 		m88rs2000_writereg(state, 0x9a, 0xb0);
481*4882a593Smuzhiyun 		*ber = 0xffffffff;
482*4882a593Smuzhiyun 		return 0;
483*4882a593Smuzhiyun 	}
484*4882a593Smuzhiyun 
485*4882a593Smuzhiyun 	*ber = (m88rs2000_readreg(state, 0xd7) << 8) |
486*4882a593Smuzhiyun 		m88rs2000_readreg(state, 0xd6);
487*4882a593Smuzhiyun 
488*4882a593Smuzhiyun 	tmp1 = m88rs2000_readreg(state, 0xd9);
489*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xd9, (tmp1 & ~7) | 4);
490*4882a593Smuzhiyun 	/* needs twice */
491*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xd8, (tmp0 & ~8) | 0x30);
492*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xd8, (tmp0 & ~8) | 0x30);
493*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0xb0);
494*4882a593Smuzhiyun 
495*4882a593Smuzhiyun 	return 0;
496*4882a593Smuzhiyun }
497*4882a593Smuzhiyun 
m88rs2000_read_signal_strength(struct dvb_frontend * fe,u16 * strength)498*4882a593Smuzhiyun static int m88rs2000_read_signal_strength(struct dvb_frontend *fe,
499*4882a593Smuzhiyun 	u16 *strength)
500*4882a593Smuzhiyun {
501*4882a593Smuzhiyun 	if (fe->ops.tuner_ops.get_rf_strength)
502*4882a593Smuzhiyun 		fe->ops.tuner_ops.get_rf_strength(fe, strength);
503*4882a593Smuzhiyun 
504*4882a593Smuzhiyun 	return 0;
505*4882a593Smuzhiyun }
506*4882a593Smuzhiyun 
m88rs2000_read_snr(struct dvb_frontend * fe,u16 * snr)507*4882a593Smuzhiyun static int m88rs2000_read_snr(struct dvb_frontend *fe, u16 *snr)
508*4882a593Smuzhiyun {
509*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
510*4882a593Smuzhiyun 
511*4882a593Smuzhiyun 	*snr = 512 * m88rs2000_readreg(state, 0x65);
512*4882a593Smuzhiyun 
513*4882a593Smuzhiyun 	return 0;
514*4882a593Smuzhiyun }
515*4882a593Smuzhiyun 
m88rs2000_read_ucblocks(struct dvb_frontend * fe,u32 * ucblocks)516*4882a593Smuzhiyun static int m88rs2000_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks)
517*4882a593Smuzhiyun {
518*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
519*4882a593Smuzhiyun 	u8 tmp;
520*4882a593Smuzhiyun 
521*4882a593Smuzhiyun 	*ucblocks = (m88rs2000_readreg(state, 0xd5) << 8) |
522*4882a593Smuzhiyun 			m88rs2000_readreg(state, 0xd4);
523*4882a593Smuzhiyun 	tmp = m88rs2000_readreg(state, 0xd8);
524*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xd8, tmp & ~0x20);
525*4882a593Smuzhiyun 	/* needs two times */
526*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xd8, tmp | 0x20);
527*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0xd8, tmp | 0x20);
528*4882a593Smuzhiyun 
529*4882a593Smuzhiyun 	return 0;
530*4882a593Smuzhiyun }
531*4882a593Smuzhiyun 
m88rs2000_set_fec(struct m88rs2000_state * state,enum fe_code_rate fec)532*4882a593Smuzhiyun static int m88rs2000_set_fec(struct m88rs2000_state *state,
533*4882a593Smuzhiyun 			     enum fe_code_rate fec)
534*4882a593Smuzhiyun {
535*4882a593Smuzhiyun 	u8 fec_set, reg;
536*4882a593Smuzhiyun 	int ret;
537*4882a593Smuzhiyun 
538*4882a593Smuzhiyun 	switch (fec) {
539*4882a593Smuzhiyun 	case FEC_1_2:
540*4882a593Smuzhiyun 		fec_set = 0x8;
541*4882a593Smuzhiyun 		break;
542*4882a593Smuzhiyun 	case FEC_2_3:
543*4882a593Smuzhiyun 		fec_set = 0x10;
544*4882a593Smuzhiyun 		break;
545*4882a593Smuzhiyun 	case FEC_3_4:
546*4882a593Smuzhiyun 		fec_set = 0x20;
547*4882a593Smuzhiyun 		break;
548*4882a593Smuzhiyun 	case FEC_5_6:
549*4882a593Smuzhiyun 		fec_set = 0x40;
550*4882a593Smuzhiyun 		break;
551*4882a593Smuzhiyun 	case FEC_7_8:
552*4882a593Smuzhiyun 		fec_set = 0x80;
553*4882a593Smuzhiyun 		break;
554*4882a593Smuzhiyun 	case FEC_AUTO:
555*4882a593Smuzhiyun 	default:
556*4882a593Smuzhiyun 		fec_set = 0x0;
557*4882a593Smuzhiyun 	}
558*4882a593Smuzhiyun 
559*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0x70);
560*4882a593Smuzhiyun 	reg &= 0x7;
561*4882a593Smuzhiyun 	ret = m88rs2000_writereg(state, 0x70, reg | fec_set);
562*4882a593Smuzhiyun 
563*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x76, 0x8);
564*4882a593Smuzhiyun 
565*4882a593Smuzhiyun 	return ret;
566*4882a593Smuzhiyun }
567*4882a593Smuzhiyun 
m88rs2000_get_fec(struct m88rs2000_state * state)568*4882a593Smuzhiyun static enum fe_code_rate m88rs2000_get_fec(struct m88rs2000_state *state)
569*4882a593Smuzhiyun {
570*4882a593Smuzhiyun 	u8 reg;
571*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0x30);
572*4882a593Smuzhiyun 	reg = m88rs2000_readreg(state, 0x76);
573*4882a593Smuzhiyun 	m88rs2000_writereg(state, 0x9a, 0xb0);
574*4882a593Smuzhiyun 
575*4882a593Smuzhiyun 	reg &= 0xf0;
576*4882a593Smuzhiyun 	reg >>= 5;
577*4882a593Smuzhiyun 
578*4882a593Smuzhiyun 	switch (reg) {
579*4882a593Smuzhiyun 	case 0x4:
580*4882a593Smuzhiyun 		return FEC_1_2;
581*4882a593Smuzhiyun 	case 0x3:
582*4882a593Smuzhiyun 		return FEC_2_3;
583*4882a593Smuzhiyun 	case 0x2:
584*4882a593Smuzhiyun 		return FEC_3_4;
585*4882a593Smuzhiyun 	case 0x1:
586*4882a593Smuzhiyun 		return FEC_5_6;
587*4882a593Smuzhiyun 	case 0x0:
588*4882a593Smuzhiyun 		return FEC_7_8;
589*4882a593Smuzhiyun 	default:
590*4882a593Smuzhiyun 		break;
591*4882a593Smuzhiyun 	}
592*4882a593Smuzhiyun 
593*4882a593Smuzhiyun 	return FEC_AUTO;
594*4882a593Smuzhiyun }
595*4882a593Smuzhiyun 
m88rs2000_set_frontend(struct dvb_frontend * fe)596*4882a593Smuzhiyun static int m88rs2000_set_frontend(struct dvb_frontend *fe)
597*4882a593Smuzhiyun {
598*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
599*4882a593Smuzhiyun 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
600*4882a593Smuzhiyun 	enum fe_status status = 0;
601*4882a593Smuzhiyun 	int i, ret = 0;
602*4882a593Smuzhiyun 	u32 tuner_freq;
603*4882a593Smuzhiyun 	s16 offset = 0;
604*4882a593Smuzhiyun 	u8 reg;
605*4882a593Smuzhiyun 
606*4882a593Smuzhiyun 	state->no_lock_count = 0;
607*4882a593Smuzhiyun 
608*4882a593Smuzhiyun 	if (c->delivery_system != SYS_DVBS) {
609*4882a593Smuzhiyun 		deb_info("%s: unsupported delivery system selected (%d)\n",
610*4882a593Smuzhiyun 			 __func__, c->delivery_system);
611*4882a593Smuzhiyun 		return -EOPNOTSUPP;
612*4882a593Smuzhiyun 	}
613*4882a593Smuzhiyun 
614*4882a593Smuzhiyun 	/* Set Tuner */
615*4882a593Smuzhiyun 	if (fe->ops.tuner_ops.set_params)
616*4882a593Smuzhiyun 		ret = fe->ops.tuner_ops.set_params(fe);
617*4882a593Smuzhiyun 
618*4882a593Smuzhiyun 	if (ret < 0)
619*4882a593Smuzhiyun 		return -ENODEV;
620*4882a593Smuzhiyun 
621*4882a593Smuzhiyun 	if (fe->ops.tuner_ops.get_frequency) {
622*4882a593Smuzhiyun 		ret = fe->ops.tuner_ops.get_frequency(fe, &tuner_freq);
623*4882a593Smuzhiyun 
624*4882a593Smuzhiyun 		if (ret < 0)
625*4882a593Smuzhiyun 			return -ENODEV;
626*4882a593Smuzhiyun 
627*4882a593Smuzhiyun 		offset = (s16)((s32)tuner_freq - c->frequency);
628*4882a593Smuzhiyun 	} else {
629*4882a593Smuzhiyun 		offset = 0;
630*4882a593Smuzhiyun 	}
631*4882a593Smuzhiyun 
632*4882a593Smuzhiyun 	/* default mclk value 96.4285 * 2 * 1000 = 192857 */
633*4882a593Smuzhiyun 	if (((c->frequency % 192857) >= (192857 - 3000)) ||
634*4882a593Smuzhiyun 				(c->frequency % 192857) <= 3000)
635*4882a593Smuzhiyun 		ret = m88rs2000_writereg(state, 0x86, 0xc2);
636*4882a593Smuzhiyun 	else
637*4882a593Smuzhiyun 		ret = m88rs2000_writereg(state, 0x86, 0xc6);
638*4882a593Smuzhiyun 
639*4882a593Smuzhiyun 	ret |= m88rs2000_set_carrieroffset(fe, offset);
640*4882a593Smuzhiyun 	if (ret < 0)
641*4882a593Smuzhiyun 		return -ENODEV;
642*4882a593Smuzhiyun 
643*4882a593Smuzhiyun 	/* Reset demod by symbol rate */
644*4882a593Smuzhiyun 	if (c->symbol_rate > 27500000)
645*4882a593Smuzhiyun 		ret = m88rs2000_writereg(state, 0xf1, 0xa4);
646*4882a593Smuzhiyun 	else
647*4882a593Smuzhiyun 		ret = m88rs2000_writereg(state, 0xf1, 0xbf);
648*4882a593Smuzhiyun 
649*4882a593Smuzhiyun 	ret |= m88rs2000_tab_set(state, fe_reset);
650*4882a593Smuzhiyun 	if (ret < 0)
651*4882a593Smuzhiyun 		return -ENODEV;
652*4882a593Smuzhiyun 
653*4882a593Smuzhiyun 	/* Set FEC */
654*4882a593Smuzhiyun 	ret = m88rs2000_set_fec(state, c->fec_inner);
655*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x85, 0x1);
656*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x8a, 0xbf);
657*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x8d, 0x1e);
658*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x90, 0xf1);
659*4882a593Smuzhiyun 	ret |= m88rs2000_writereg(state, 0x91, 0x08);
660*4882a593Smuzhiyun 
661*4882a593Smuzhiyun 	if (ret < 0)
662*4882a593Smuzhiyun 		return -ENODEV;
663*4882a593Smuzhiyun 
664*4882a593Smuzhiyun 	/* Set Symbol Rate */
665*4882a593Smuzhiyun 	ret = m88rs2000_set_symbolrate(fe, c->symbol_rate);
666*4882a593Smuzhiyun 	if (ret < 0)
667*4882a593Smuzhiyun 		return -ENODEV;
668*4882a593Smuzhiyun 
669*4882a593Smuzhiyun 	/* Set up Demod */
670*4882a593Smuzhiyun 	ret = m88rs2000_tab_set(state, fe_trigger);
671*4882a593Smuzhiyun 	if (ret < 0)
672*4882a593Smuzhiyun 		return -ENODEV;
673*4882a593Smuzhiyun 
674*4882a593Smuzhiyun 	for (i = 0; i < 25; i++) {
675*4882a593Smuzhiyun 		reg = m88rs2000_readreg(state, 0x8c);
676*4882a593Smuzhiyun 		if ((reg & 0xee) == 0xee) {
677*4882a593Smuzhiyun 			status = FE_HAS_LOCK;
678*4882a593Smuzhiyun 			break;
679*4882a593Smuzhiyun 		}
680*4882a593Smuzhiyun 		state->no_lock_count++;
681*4882a593Smuzhiyun 		if (state->no_lock_count == 15) {
682*4882a593Smuzhiyun 			reg = m88rs2000_readreg(state, 0x70);
683*4882a593Smuzhiyun 			reg ^= 0x4;
684*4882a593Smuzhiyun 			m88rs2000_writereg(state, 0x70, reg);
685*4882a593Smuzhiyun 			state->no_lock_count = 0;
686*4882a593Smuzhiyun 		}
687*4882a593Smuzhiyun 		msleep(20);
688*4882a593Smuzhiyun 	}
689*4882a593Smuzhiyun 
690*4882a593Smuzhiyun 	if (status & FE_HAS_LOCK) {
691*4882a593Smuzhiyun 		state->fec_inner = m88rs2000_get_fec(state);
692*4882a593Smuzhiyun 		/* Unknown suspect SNR level */
693*4882a593Smuzhiyun 		reg = m88rs2000_readreg(state, 0x65);
694*4882a593Smuzhiyun 	}
695*4882a593Smuzhiyun 
696*4882a593Smuzhiyun 	state->tuner_frequency = c->frequency;
697*4882a593Smuzhiyun 	state->symbol_rate = c->symbol_rate;
698*4882a593Smuzhiyun 	return 0;
699*4882a593Smuzhiyun }
700*4882a593Smuzhiyun 
m88rs2000_get_frontend(struct dvb_frontend * fe,struct dtv_frontend_properties * c)701*4882a593Smuzhiyun static int m88rs2000_get_frontend(struct dvb_frontend *fe,
702*4882a593Smuzhiyun 				  struct dtv_frontend_properties *c)
703*4882a593Smuzhiyun {
704*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
705*4882a593Smuzhiyun 
706*4882a593Smuzhiyun 	c->fec_inner = state->fec_inner;
707*4882a593Smuzhiyun 	c->frequency = state->tuner_frequency;
708*4882a593Smuzhiyun 	c->symbol_rate = state->symbol_rate;
709*4882a593Smuzhiyun 	return 0;
710*4882a593Smuzhiyun }
711*4882a593Smuzhiyun 
m88rs2000_get_tune_settings(struct dvb_frontend * fe,struct dvb_frontend_tune_settings * tune)712*4882a593Smuzhiyun static int m88rs2000_get_tune_settings(struct dvb_frontend *fe,
713*4882a593Smuzhiyun 	struct dvb_frontend_tune_settings *tune)
714*4882a593Smuzhiyun {
715*4882a593Smuzhiyun 	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
716*4882a593Smuzhiyun 
717*4882a593Smuzhiyun 	if (c->symbol_rate > 3000000)
718*4882a593Smuzhiyun 		tune->min_delay_ms = 2000;
719*4882a593Smuzhiyun 	else
720*4882a593Smuzhiyun 		tune->min_delay_ms = 3000;
721*4882a593Smuzhiyun 
722*4882a593Smuzhiyun 	tune->step_size = c->symbol_rate / 16000;
723*4882a593Smuzhiyun 	tune->max_drift = c->symbol_rate / 2000;
724*4882a593Smuzhiyun 
725*4882a593Smuzhiyun 	return 0;
726*4882a593Smuzhiyun }
727*4882a593Smuzhiyun 
m88rs2000_i2c_gate_ctrl(struct dvb_frontend * fe,int enable)728*4882a593Smuzhiyun static int m88rs2000_i2c_gate_ctrl(struct dvb_frontend *fe, int enable)
729*4882a593Smuzhiyun {
730*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
731*4882a593Smuzhiyun 
732*4882a593Smuzhiyun 	if (enable)
733*4882a593Smuzhiyun 		m88rs2000_writereg(state, 0x81, 0x84);
734*4882a593Smuzhiyun 	else
735*4882a593Smuzhiyun 		m88rs2000_writereg(state, 0x81, 0x81);
736*4882a593Smuzhiyun 	udelay(10);
737*4882a593Smuzhiyun 	return 0;
738*4882a593Smuzhiyun }
739*4882a593Smuzhiyun 
m88rs2000_release(struct dvb_frontend * fe)740*4882a593Smuzhiyun static void m88rs2000_release(struct dvb_frontend *fe)
741*4882a593Smuzhiyun {
742*4882a593Smuzhiyun 	struct m88rs2000_state *state = fe->demodulator_priv;
743*4882a593Smuzhiyun 	kfree(state);
744*4882a593Smuzhiyun }
745*4882a593Smuzhiyun 
746*4882a593Smuzhiyun static const struct dvb_frontend_ops m88rs2000_ops = {
747*4882a593Smuzhiyun 	.delsys = { SYS_DVBS },
748*4882a593Smuzhiyun 	.info = {
749*4882a593Smuzhiyun 		.name			= "M88RS2000 DVB-S",
750*4882a593Smuzhiyun 		.frequency_min_hz	=  950 * MHz,
751*4882a593Smuzhiyun 		.frequency_max_hz	= 2150 * MHz,
752*4882a593Smuzhiyun 		.frequency_stepsize_hz	= 1 * MHz,
753*4882a593Smuzhiyun 		.frequency_tolerance_hz	= 5 * MHz,
754*4882a593Smuzhiyun 		.symbol_rate_min	= 1000000,
755*4882a593Smuzhiyun 		.symbol_rate_max	= 45000000,
756*4882a593Smuzhiyun 		.symbol_rate_tolerance	= 500,	/* ppm */
757*4882a593Smuzhiyun 		.caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
758*4882a593Smuzhiyun 		      FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 |
759*4882a593Smuzhiyun 		      FE_CAN_QPSK | FE_CAN_INVERSION_AUTO |
760*4882a593Smuzhiyun 		      FE_CAN_FEC_AUTO
761*4882a593Smuzhiyun 	},
762*4882a593Smuzhiyun 
763*4882a593Smuzhiyun 	.release = m88rs2000_release,
764*4882a593Smuzhiyun 	.init = m88rs2000_init,
765*4882a593Smuzhiyun 	.sleep = m88rs2000_sleep,
766*4882a593Smuzhiyun 	.i2c_gate_ctrl = m88rs2000_i2c_gate_ctrl,
767*4882a593Smuzhiyun 	.read_status = m88rs2000_read_status,
768*4882a593Smuzhiyun 	.read_ber = m88rs2000_read_ber,
769*4882a593Smuzhiyun 	.read_signal_strength = m88rs2000_read_signal_strength,
770*4882a593Smuzhiyun 	.read_snr = m88rs2000_read_snr,
771*4882a593Smuzhiyun 	.read_ucblocks = m88rs2000_read_ucblocks,
772*4882a593Smuzhiyun 	.diseqc_send_master_cmd = m88rs2000_send_diseqc_msg,
773*4882a593Smuzhiyun 	.diseqc_send_burst = m88rs2000_send_diseqc_burst,
774*4882a593Smuzhiyun 	.set_tone = m88rs2000_set_tone,
775*4882a593Smuzhiyun 	.set_voltage = m88rs2000_set_voltage,
776*4882a593Smuzhiyun 
777*4882a593Smuzhiyun 	.set_frontend = m88rs2000_set_frontend,
778*4882a593Smuzhiyun 	.get_frontend = m88rs2000_get_frontend,
779*4882a593Smuzhiyun 	.get_tune_settings = m88rs2000_get_tune_settings,
780*4882a593Smuzhiyun };
781*4882a593Smuzhiyun 
m88rs2000_attach(const struct m88rs2000_config * config,struct i2c_adapter * i2c)782*4882a593Smuzhiyun struct dvb_frontend *m88rs2000_attach(const struct m88rs2000_config *config,
783*4882a593Smuzhiyun 				    struct i2c_adapter *i2c)
784*4882a593Smuzhiyun {
785*4882a593Smuzhiyun 	struct m88rs2000_state *state = NULL;
786*4882a593Smuzhiyun 
787*4882a593Smuzhiyun 	/* allocate memory for the internal state */
788*4882a593Smuzhiyun 	state = kzalloc(sizeof(struct m88rs2000_state), GFP_KERNEL);
789*4882a593Smuzhiyun 	if (state == NULL)
790*4882a593Smuzhiyun 		goto error;
791*4882a593Smuzhiyun 
792*4882a593Smuzhiyun 	/* setup the state */
793*4882a593Smuzhiyun 	state->config = config;
794*4882a593Smuzhiyun 	state->i2c = i2c;
795*4882a593Smuzhiyun 	state->tuner_frequency = 0;
796*4882a593Smuzhiyun 	state->symbol_rate = 0;
797*4882a593Smuzhiyun 	state->fec_inner = 0;
798*4882a593Smuzhiyun 
799*4882a593Smuzhiyun 	/* create dvb_frontend */
800*4882a593Smuzhiyun 	memcpy(&state->frontend.ops, &m88rs2000_ops,
801*4882a593Smuzhiyun 			sizeof(struct dvb_frontend_ops));
802*4882a593Smuzhiyun 	state->frontend.demodulator_priv = state;
803*4882a593Smuzhiyun 	return &state->frontend;
804*4882a593Smuzhiyun 
805*4882a593Smuzhiyun error:
806*4882a593Smuzhiyun 	kfree(state);
807*4882a593Smuzhiyun 
808*4882a593Smuzhiyun 	return NULL;
809*4882a593Smuzhiyun }
810*4882a593Smuzhiyun EXPORT_SYMBOL(m88rs2000_attach);
811*4882a593Smuzhiyun 
812*4882a593Smuzhiyun MODULE_DESCRIPTION("M88RS2000 DVB-S Demodulator driver");
813*4882a593Smuzhiyun MODULE_AUTHOR("Malcolm Priestley tvboxspy@gmail.com");
814*4882a593Smuzhiyun MODULE_LICENSE("GPL");
815*4882a593Smuzhiyun MODULE_VERSION("1.13");
816*4882a593Smuzhiyun 
817