1*4882a593Smuzhiyun // SPDX-License-Identifier: GPL-2.0-or-later
2*4882a593Smuzhiyun /*
3*4882a593Smuzhiyun Driver for Philips tda1004xh OFDM Demodulator
4*4882a593Smuzhiyun
5*4882a593Smuzhiyun (c) 2003, 2004 Andrew de Quincey & Robert Schlabbach
6*4882a593Smuzhiyun
7*4882a593Smuzhiyun
8*4882a593Smuzhiyun */
9*4882a593Smuzhiyun /*
10*4882a593Smuzhiyun * This driver needs external firmware. Please use the commands
11*4882a593Smuzhiyun * "<kerneldir>/scripts/get_dvb_firmware tda10045",
12*4882a593Smuzhiyun * "<kerneldir>/scripts/get_dvb_firmware tda10046" to
13*4882a593Smuzhiyun * download/extract them, and then copy them to /usr/lib/hotplug/firmware
14*4882a593Smuzhiyun * or /lib/firmware (depending on configuration of firmware hotplug).
15*4882a593Smuzhiyun */
16*4882a593Smuzhiyun #define TDA10045_DEFAULT_FIRMWARE "dvb-fe-tda10045.fw"
17*4882a593Smuzhiyun #define TDA10046_DEFAULT_FIRMWARE "dvb-fe-tda10046.fw"
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #include <linux/init.h>
20*4882a593Smuzhiyun #include <linux/module.h>
21*4882a593Smuzhiyun #include <linux/device.h>
22*4882a593Smuzhiyun #include <linux/jiffies.h>
23*4882a593Smuzhiyun #include <linux/string.h>
24*4882a593Smuzhiyun #include <linux/slab.h>
25*4882a593Smuzhiyun
26*4882a593Smuzhiyun #include <media/dvb_frontend.h>
27*4882a593Smuzhiyun #include "tda1004x.h"
28*4882a593Smuzhiyun
29*4882a593Smuzhiyun static int debug;
30*4882a593Smuzhiyun #define dprintk(args...) \
31*4882a593Smuzhiyun do { \
32*4882a593Smuzhiyun if (debug) printk(KERN_DEBUG "tda1004x: " args); \
33*4882a593Smuzhiyun } while (0)
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun #define TDA1004X_CHIPID 0x00
36*4882a593Smuzhiyun #define TDA1004X_AUTO 0x01
37*4882a593Smuzhiyun #define TDA1004X_IN_CONF1 0x02
38*4882a593Smuzhiyun #define TDA1004X_IN_CONF2 0x03
39*4882a593Smuzhiyun #define TDA1004X_OUT_CONF1 0x04
40*4882a593Smuzhiyun #define TDA1004X_OUT_CONF2 0x05
41*4882a593Smuzhiyun #define TDA1004X_STATUS_CD 0x06
42*4882a593Smuzhiyun #define TDA1004X_CONFC4 0x07
43*4882a593Smuzhiyun #define TDA1004X_DSSPARE2 0x0C
44*4882a593Smuzhiyun #define TDA10045H_CODE_IN 0x0D
45*4882a593Smuzhiyun #define TDA10045H_FWPAGE 0x0E
46*4882a593Smuzhiyun #define TDA1004X_SCAN_CPT 0x10
47*4882a593Smuzhiyun #define TDA1004X_DSP_CMD 0x11
48*4882a593Smuzhiyun #define TDA1004X_DSP_ARG 0x12
49*4882a593Smuzhiyun #define TDA1004X_DSP_DATA1 0x13
50*4882a593Smuzhiyun #define TDA1004X_DSP_DATA2 0x14
51*4882a593Smuzhiyun #define TDA1004X_CONFADC1 0x15
52*4882a593Smuzhiyun #define TDA1004X_CONFC1 0x16
53*4882a593Smuzhiyun #define TDA10045H_S_AGC 0x1a
54*4882a593Smuzhiyun #define TDA10046H_AGC_TUN_LEVEL 0x1a
55*4882a593Smuzhiyun #define TDA1004X_SNR 0x1c
56*4882a593Smuzhiyun #define TDA1004X_CONF_TS1 0x1e
57*4882a593Smuzhiyun #define TDA1004X_CONF_TS2 0x1f
58*4882a593Smuzhiyun #define TDA1004X_CBER_RESET 0x20
59*4882a593Smuzhiyun #define TDA1004X_CBER_MSB 0x21
60*4882a593Smuzhiyun #define TDA1004X_CBER_LSB 0x22
61*4882a593Smuzhiyun #define TDA1004X_CVBER_LUT 0x23
62*4882a593Smuzhiyun #define TDA1004X_VBER_MSB 0x24
63*4882a593Smuzhiyun #define TDA1004X_VBER_MID 0x25
64*4882a593Smuzhiyun #define TDA1004X_VBER_LSB 0x26
65*4882a593Smuzhiyun #define TDA1004X_UNCOR 0x27
66*4882a593Smuzhiyun
67*4882a593Smuzhiyun #define TDA10045H_CONFPLL_P 0x2D
68*4882a593Smuzhiyun #define TDA10045H_CONFPLL_M_MSB 0x2E
69*4882a593Smuzhiyun #define TDA10045H_CONFPLL_M_LSB 0x2F
70*4882a593Smuzhiyun #define TDA10045H_CONFPLL_N 0x30
71*4882a593Smuzhiyun
72*4882a593Smuzhiyun #define TDA10046H_CONFPLL1 0x2D
73*4882a593Smuzhiyun #define TDA10046H_CONFPLL2 0x2F
74*4882a593Smuzhiyun #define TDA10046H_CONFPLL3 0x30
75*4882a593Smuzhiyun #define TDA10046H_TIME_WREF1 0x31
76*4882a593Smuzhiyun #define TDA10046H_TIME_WREF2 0x32
77*4882a593Smuzhiyun #define TDA10046H_TIME_WREF3 0x33
78*4882a593Smuzhiyun #define TDA10046H_TIME_WREF4 0x34
79*4882a593Smuzhiyun #define TDA10046H_TIME_WREF5 0x35
80*4882a593Smuzhiyun
81*4882a593Smuzhiyun #define TDA10045H_UNSURW_MSB 0x31
82*4882a593Smuzhiyun #define TDA10045H_UNSURW_LSB 0x32
83*4882a593Smuzhiyun #define TDA10045H_WREF_MSB 0x33
84*4882a593Smuzhiyun #define TDA10045H_WREF_MID 0x34
85*4882a593Smuzhiyun #define TDA10045H_WREF_LSB 0x35
86*4882a593Smuzhiyun #define TDA10045H_MUXOUT 0x36
87*4882a593Smuzhiyun #define TDA1004X_CONFADC2 0x37
88*4882a593Smuzhiyun
89*4882a593Smuzhiyun #define TDA10045H_IOFFSET 0x38
90*4882a593Smuzhiyun
91*4882a593Smuzhiyun #define TDA10046H_CONF_TRISTATE1 0x3B
92*4882a593Smuzhiyun #define TDA10046H_CONF_TRISTATE2 0x3C
93*4882a593Smuzhiyun #define TDA10046H_CONF_POLARITY 0x3D
94*4882a593Smuzhiyun #define TDA10046H_FREQ_OFFSET 0x3E
95*4882a593Smuzhiyun #define TDA10046H_GPIO_OUT_SEL 0x41
96*4882a593Smuzhiyun #define TDA10046H_GPIO_SELECT 0x42
97*4882a593Smuzhiyun #define TDA10046H_AGC_CONF 0x43
98*4882a593Smuzhiyun #define TDA10046H_AGC_THR 0x44
99*4882a593Smuzhiyun #define TDA10046H_AGC_RENORM 0x45
100*4882a593Smuzhiyun #define TDA10046H_AGC_GAINS 0x46
101*4882a593Smuzhiyun #define TDA10046H_AGC_TUN_MIN 0x47
102*4882a593Smuzhiyun #define TDA10046H_AGC_TUN_MAX 0x48
103*4882a593Smuzhiyun #define TDA10046H_AGC_IF_MIN 0x49
104*4882a593Smuzhiyun #define TDA10046H_AGC_IF_MAX 0x4A
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun #define TDA10046H_FREQ_PHY2_MSB 0x4D
107*4882a593Smuzhiyun #define TDA10046H_FREQ_PHY2_LSB 0x4E
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun #define TDA10046H_CVBER_CTRL 0x4F
110*4882a593Smuzhiyun #define TDA10046H_AGC_IF_LEVEL 0x52
111*4882a593Smuzhiyun #define TDA10046H_CODE_CPT 0x57
112*4882a593Smuzhiyun #define TDA10046H_CODE_IN 0x58
113*4882a593Smuzhiyun
114*4882a593Smuzhiyun
tda1004x_write_byteI(struct tda1004x_state * state,int reg,int data)115*4882a593Smuzhiyun static int tda1004x_write_byteI(struct tda1004x_state *state, int reg, int data)
116*4882a593Smuzhiyun {
117*4882a593Smuzhiyun int ret;
118*4882a593Smuzhiyun u8 buf[] = { reg, data };
119*4882a593Smuzhiyun struct i2c_msg msg = { .flags = 0, .buf = buf, .len = 2 };
120*4882a593Smuzhiyun
121*4882a593Smuzhiyun dprintk("%s: reg=0x%x, data=0x%x\n", __func__, reg, data);
122*4882a593Smuzhiyun
123*4882a593Smuzhiyun msg.addr = state->config->demod_address;
124*4882a593Smuzhiyun ret = i2c_transfer(state->i2c, &msg, 1);
125*4882a593Smuzhiyun
126*4882a593Smuzhiyun if (ret != 1)
127*4882a593Smuzhiyun dprintk("%s: error reg=0x%x, data=0x%x, ret=%i\n",
128*4882a593Smuzhiyun __func__, reg, data, ret);
129*4882a593Smuzhiyun
130*4882a593Smuzhiyun dprintk("%s: success reg=0x%x, data=0x%x, ret=%i\n", __func__,
131*4882a593Smuzhiyun reg, data, ret);
132*4882a593Smuzhiyun return (ret != 1) ? -1 : 0;
133*4882a593Smuzhiyun }
134*4882a593Smuzhiyun
tda1004x_read_byte(struct tda1004x_state * state,int reg)135*4882a593Smuzhiyun static int tda1004x_read_byte(struct tda1004x_state *state, int reg)
136*4882a593Smuzhiyun {
137*4882a593Smuzhiyun int ret;
138*4882a593Smuzhiyun u8 b0[] = { reg };
139*4882a593Smuzhiyun u8 b1[] = { 0 };
140*4882a593Smuzhiyun struct i2c_msg msg[] = {{ .flags = 0, .buf = b0, .len = 1 },
141*4882a593Smuzhiyun { .flags = I2C_M_RD, .buf = b1, .len = 1 }};
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun dprintk("%s: reg=0x%x\n", __func__, reg);
144*4882a593Smuzhiyun
145*4882a593Smuzhiyun msg[0].addr = state->config->demod_address;
146*4882a593Smuzhiyun msg[1].addr = state->config->demod_address;
147*4882a593Smuzhiyun ret = i2c_transfer(state->i2c, msg, 2);
148*4882a593Smuzhiyun
149*4882a593Smuzhiyun if (ret != 2) {
150*4882a593Smuzhiyun dprintk("%s: error reg=0x%x, ret=%i\n", __func__, reg,
151*4882a593Smuzhiyun ret);
152*4882a593Smuzhiyun return -EINVAL;
153*4882a593Smuzhiyun }
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun dprintk("%s: success reg=0x%x, data=0x%x, ret=%i\n", __func__,
156*4882a593Smuzhiyun reg, b1[0], ret);
157*4882a593Smuzhiyun return b1[0];
158*4882a593Smuzhiyun }
159*4882a593Smuzhiyun
tda1004x_write_mask(struct tda1004x_state * state,int reg,int mask,int data)160*4882a593Smuzhiyun static int tda1004x_write_mask(struct tda1004x_state *state, int reg, int mask, int data)
161*4882a593Smuzhiyun {
162*4882a593Smuzhiyun int val;
163*4882a593Smuzhiyun dprintk("%s: reg=0x%x, mask=0x%x, data=0x%x\n", __func__, reg,
164*4882a593Smuzhiyun mask, data);
165*4882a593Smuzhiyun
166*4882a593Smuzhiyun // read a byte and check
167*4882a593Smuzhiyun val = tda1004x_read_byte(state, reg);
168*4882a593Smuzhiyun if (val < 0)
169*4882a593Smuzhiyun return val;
170*4882a593Smuzhiyun
171*4882a593Smuzhiyun // mask if off
172*4882a593Smuzhiyun val = val & ~mask;
173*4882a593Smuzhiyun val |= data & 0xff;
174*4882a593Smuzhiyun
175*4882a593Smuzhiyun // write it out again
176*4882a593Smuzhiyun return tda1004x_write_byteI(state, reg, val);
177*4882a593Smuzhiyun }
178*4882a593Smuzhiyun
tda1004x_write_buf(struct tda1004x_state * state,int reg,unsigned char * buf,int len)179*4882a593Smuzhiyun static int tda1004x_write_buf(struct tda1004x_state *state, int reg, unsigned char *buf, int len)
180*4882a593Smuzhiyun {
181*4882a593Smuzhiyun int i;
182*4882a593Smuzhiyun int result;
183*4882a593Smuzhiyun
184*4882a593Smuzhiyun dprintk("%s: reg=0x%x, len=0x%x\n", __func__, reg, len);
185*4882a593Smuzhiyun
186*4882a593Smuzhiyun result = 0;
187*4882a593Smuzhiyun for (i = 0; i < len; i++) {
188*4882a593Smuzhiyun result = tda1004x_write_byteI(state, reg + i, buf[i]);
189*4882a593Smuzhiyun if (result != 0)
190*4882a593Smuzhiyun break;
191*4882a593Smuzhiyun }
192*4882a593Smuzhiyun
193*4882a593Smuzhiyun return result;
194*4882a593Smuzhiyun }
195*4882a593Smuzhiyun
tda1004x_enable_tuner_i2c(struct tda1004x_state * state)196*4882a593Smuzhiyun static int tda1004x_enable_tuner_i2c(struct tda1004x_state *state)
197*4882a593Smuzhiyun {
198*4882a593Smuzhiyun int result;
199*4882a593Smuzhiyun dprintk("%s\n", __func__);
200*4882a593Smuzhiyun
201*4882a593Smuzhiyun result = tda1004x_write_mask(state, TDA1004X_CONFC4, 2, 2);
202*4882a593Smuzhiyun msleep(20);
203*4882a593Smuzhiyun return result;
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun
tda1004x_disable_tuner_i2c(struct tda1004x_state * state)206*4882a593Smuzhiyun static int tda1004x_disable_tuner_i2c(struct tda1004x_state *state)
207*4882a593Smuzhiyun {
208*4882a593Smuzhiyun dprintk("%s\n", __func__);
209*4882a593Smuzhiyun
210*4882a593Smuzhiyun return tda1004x_write_mask(state, TDA1004X_CONFC4, 2, 0);
211*4882a593Smuzhiyun }
212*4882a593Smuzhiyun
tda10045h_set_bandwidth(struct tda1004x_state * state,u32 bandwidth)213*4882a593Smuzhiyun static int tda10045h_set_bandwidth(struct tda1004x_state *state,
214*4882a593Smuzhiyun u32 bandwidth)
215*4882a593Smuzhiyun {
216*4882a593Smuzhiyun static u8 bandwidth_6mhz[] = { 0x02, 0x00, 0x3d, 0x00, 0x60, 0x1e, 0xa7, 0x45, 0x4f };
217*4882a593Smuzhiyun static u8 bandwidth_7mhz[] = { 0x02, 0x00, 0x37, 0x00, 0x4a, 0x2f, 0x6d, 0x76, 0xdb };
218*4882a593Smuzhiyun static u8 bandwidth_8mhz[] = { 0x02, 0x00, 0x3d, 0x00, 0x48, 0x17, 0x89, 0xc7, 0x14 };
219*4882a593Smuzhiyun
220*4882a593Smuzhiyun switch (bandwidth) {
221*4882a593Smuzhiyun case 6000000:
222*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10045H_CONFPLL_P, bandwidth_6mhz, sizeof(bandwidth_6mhz));
223*4882a593Smuzhiyun break;
224*4882a593Smuzhiyun
225*4882a593Smuzhiyun case 7000000:
226*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10045H_CONFPLL_P, bandwidth_7mhz, sizeof(bandwidth_7mhz));
227*4882a593Smuzhiyun break;
228*4882a593Smuzhiyun
229*4882a593Smuzhiyun case 8000000:
230*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10045H_CONFPLL_P, bandwidth_8mhz, sizeof(bandwidth_8mhz));
231*4882a593Smuzhiyun break;
232*4882a593Smuzhiyun
233*4882a593Smuzhiyun default:
234*4882a593Smuzhiyun return -EINVAL;
235*4882a593Smuzhiyun }
236*4882a593Smuzhiyun
237*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10045H_IOFFSET, 0);
238*4882a593Smuzhiyun
239*4882a593Smuzhiyun return 0;
240*4882a593Smuzhiyun }
241*4882a593Smuzhiyun
tda10046h_set_bandwidth(struct tda1004x_state * state,u32 bandwidth)242*4882a593Smuzhiyun static int tda10046h_set_bandwidth(struct tda1004x_state *state,
243*4882a593Smuzhiyun u32 bandwidth)
244*4882a593Smuzhiyun {
245*4882a593Smuzhiyun static u8 bandwidth_6mhz_53M[] = { 0x7b, 0x2e, 0x11, 0xf0, 0xd2 };
246*4882a593Smuzhiyun static u8 bandwidth_7mhz_53M[] = { 0x6a, 0x02, 0x6a, 0x43, 0x9f };
247*4882a593Smuzhiyun static u8 bandwidth_8mhz_53M[] = { 0x5c, 0x32, 0xc2, 0x96, 0x6d };
248*4882a593Smuzhiyun
249*4882a593Smuzhiyun static u8 bandwidth_6mhz_48M[] = { 0x70, 0x02, 0x49, 0x24, 0x92 };
250*4882a593Smuzhiyun static u8 bandwidth_7mhz_48M[] = { 0x60, 0x02, 0xaa, 0xaa, 0xab };
251*4882a593Smuzhiyun static u8 bandwidth_8mhz_48M[] = { 0x54, 0x03, 0x0c, 0x30, 0xc3 };
252*4882a593Smuzhiyun int tda10046_clk53m;
253*4882a593Smuzhiyun
254*4882a593Smuzhiyun if ((state->config->if_freq == TDA10046_FREQ_045) ||
255*4882a593Smuzhiyun (state->config->if_freq == TDA10046_FREQ_052))
256*4882a593Smuzhiyun tda10046_clk53m = 0;
257*4882a593Smuzhiyun else
258*4882a593Smuzhiyun tda10046_clk53m = 1;
259*4882a593Smuzhiyun switch (bandwidth) {
260*4882a593Smuzhiyun case 6000000:
261*4882a593Smuzhiyun if (tda10046_clk53m)
262*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10046H_TIME_WREF1, bandwidth_6mhz_53M,
263*4882a593Smuzhiyun sizeof(bandwidth_6mhz_53M));
264*4882a593Smuzhiyun else
265*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10046H_TIME_WREF1, bandwidth_6mhz_48M,
266*4882a593Smuzhiyun sizeof(bandwidth_6mhz_48M));
267*4882a593Smuzhiyun if (state->config->if_freq == TDA10046_FREQ_045) {
268*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0x0a);
269*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0xab);
270*4882a593Smuzhiyun }
271*4882a593Smuzhiyun break;
272*4882a593Smuzhiyun
273*4882a593Smuzhiyun case 7000000:
274*4882a593Smuzhiyun if (tda10046_clk53m)
275*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10046H_TIME_WREF1, bandwidth_7mhz_53M,
276*4882a593Smuzhiyun sizeof(bandwidth_7mhz_53M));
277*4882a593Smuzhiyun else
278*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10046H_TIME_WREF1, bandwidth_7mhz_48M,
279*4882a593Smuzhiyun sizeof(bandwidth_7mhz_48M));
280*4882a593Smuzhiyun if (state->config->if_freq == TDA10046_FREQ_045) {
281*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0x0c);
282*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x00);
283*4882a593Smuzhiyun }
284*4882a593Smuzhiyun break;
285*4882a593Smuzhiyun
286*4882a593Smuzhiyun case 8000000:
287*4882a593Smuzhiyun if (tda10046_clk53m)
288*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10046H_TIME_WREF1, bandwidth_8mhz_53M,
289*4882a593Smuzhiyun sizeof(bandwidth_8mhz_53M));
290*4882a593Smuzhiyun else
291*4882a593Smuzhiyun tda1004x_write_buf(state, TDA10046H_TIME_WREF1, bandwidth_8mhz_48M,
292*4882a593Smuzhiyun sizeof(bandwidth_8mhz_48M));
293*4882a593Smuzhiyun if (state->config->if_freq == TDA10046_FREQ_045) {
294*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0x0d);
295*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x55);
296*4882a593Smuzhiyun }
297*4882a593Smuzhiyun break;
298*4882a593Smuzhiyun
299*4882a593Smuzhiyun default:
300*4882a593Smuzhiyun return -EINVAL;
301*4882a593Smuzhiyun }
302*4882a593Smuzhiyun
303*4882a593Smuzhiyun return 0;
304*4882a593Smuzhiyun }
305*4882a593Smuzhiyun
tda1004x_do_upload(struct tda1004x_state * state,const unsigned char * mem,unsigned int len,u8 dspCodeCounterReg,u8 dspCodeInReg)306*4882a593Smuzhiyun static int tda1004x_do_upload(struct tda1004x_state *state,
307*4882a593Smuzhiyun const unsigned char *mem, unsigned int len,
308*4882a593Smuzhiyun u8 dspCodeCounterReg, u8 dspCodeInReg)
309*4882a593Smuzhiyun {
310*4882a593Smuzhiyun u8 buf[65];
311*4882a593Smuzhiyun struct i2c_msg fw_msg = { .flags = 0, .buf = buf, .len = 0 };
312*4882a593Smuzhiyun int tx_size;
313*4882a593Smuzhiyun int pos = 0;
314*4882a593Smuzhiyun
315*4882a593Smuzhiyun /* clear code counter */
316*4882a593Smuzhiyun tda1004x_write_byteI(state, dspCodeCounterReg, 0);
317*4882a593Smuzhiyun fw_msg.addr = state->config->demod_address;
318*4882a593Smuzhiyun
319*4882a593Smuzhiyun i2c_lock_bus(state->i2c, I2C_LOCK_SEGMENT);
320*4882a593Smuzhiyun buf[0] = dspCodeInReg;
321*4882a593Smuzhiyun while (pos != len) {
322*4882a593Smuzhiyun // work out how much to send this time
323*4882a593Smuzhiyun tx_size = len - pos;
324*4882a593Smuzhiyun if (tx_size > 0x10)
325*4882a593Smuzhiyun tx_size = 0x10;
326*4882a593Smuzhiyun
327*4882a593Smuzhiyun // send the chunk
328*4882a593Smuzhiyun memcpy(buf + 1, mem + pos, tx_size);
329*4882a593Smuzhiyun fw_msg.len = tx_size + 1;
330*4882a593Smuzhiyun if (__i2c_transfer(state->i2c, &fw_msg, 1) != 1) {
331*4882a593Smuzhiyun printk(KERN_ERR "tda1004x: Error during firmware upload\n");
332*4882a593Smuzhiyun i2c_unlock_bus(state->i2c, I2C_LOCK_SEGMENT);
333*4882a593Smuzhiyun return -EIO;
334*4882a593Smuzhiyun }
335*4882a593Smuzhiyun pos += tx_size;
336*4882a593Smuzhiyun
337*4882a593Smuzhiyun dprintk("%s: fw_pos=0x%x\n", __func__, pos);
338*4882a593Smuzhiyun }
339*4882a593Smuzhiyun i2c_unlock_bus(state->i2c, I2C_LOCK_SEGMENT);
340*4882a593Smuzhiyun
341*4882a593Smuzhiyun /* give the DSP a chance to settle 03/10/05 Hac */
342*4882a593Smuzhiyun msleep(100);
343*4882a593Smuzhiyun
344*4882a593Smuzhiyun return 0;
345*4882a593Smuzhiyun }
346*4882a593Smuzhiyun
tda1004x_check_upload_ok(struct tda1004x_state * state)347*4882a593Smuzhiyun static int tda1004x_check_upload_ok(struct tda1004x_state *state)
348*4882a593Smuzhiyun {
349*4882a593Smuzhiyun u8 data1, data2;
350*4882a593Smuzhiyun unsigned long timeout;
351*4882a593Smuzhiyun
352*4882a593Smuzhiyun if (state->demod_type == TDA1004X_DEMOD_TDA10046) {
353*4882a593Smuzhiyun timeout = jiffies + 2 * HZ;
354*4882a593Smuzhiyun while(!(tda1004x_read_byte(state, TDA1004X_STATUS_CD) & 0x20)) {
355*4882a593Smuzhiyun if (time_after(jiffies, timeout)) {
356*4882a593Smuzhiyun printk(KERN_ERR "tda1004x: timeout waiting for DSP ready\n");
357*4882a593Smuzhiyun break;
358*4882a593Smuzhiyun }
359*4882a593Smuzhiyun msleep(1);
360*4882a593Smuzhiyun }
361*4882a593Smuzhiyun } else
362*4882a593Smuzhiyun msleep(100);
363*4882a593Smuzhiyun
364*4882a593Smuzhiyun // check upload was OK
365*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 0x10, 0); // we want to read from the DSP
366*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_DSP_CMD, 0x67);
367*4882a593Smuzhiyun
368*4882a593Smuzhiyun data1 = tda1004x_read_byte(state, TDA1004X_DSP_DATA1);
369*4882a593Smuzhiyun data2 = tda1004x_read_byte(state, TDA1004X_DSP_DATA2);
370*4882a593Smuzhiyun if (data1 != 0x67 || data2 < 0x20 || data2 > 0x2e) {
371*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: found firmware revision %x -- invalid\n", data2);
372*4882a593Smuzhiyun return -EIO;
373*4882a593Smuzhiyun }
374*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: found firmware revision %x -- ok\n", data2);
375*4882a593Smuzhiyun return 0;
376*4882a593Smuzhiyun }
377*4882a593Smuzhiyun
tda10045_fwupload(struct dvb_frontend * fe)378*4882a593Smuzhiyun static int tda10045_fwupload(struct dvb_frontend* fe)
379*4882a593Smuzhiyun {
380*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
381*4882a593Smuzhiyun int ret;
382*4882a593Smuzhiyun const struct firmware *fw;
383*4882a593Smuzhiyun
384*4882a593Smuzhiyun /* don't re-upload unless necessary */
385*4882a593Smuzhiyun if (tda1004x_check_upload_ok(state) == 0)
386*4882a593Smuzhiyun return 0;
387*4882a593Smuzhiyun
388*4882a593Smuzhiyun /* request the firmware, this will block until someone uploads it */
389*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: waiting for firmware upload (%s)...\n", TDA10045_DEFAULT_FIRMWARE);
390*4882a593Smuzhiyun ret = state->config->request_firmware(fe, &fw, TDA10045_DEFAULT_FIRMWARE);
391*4882a593Smuzhiyun if (ret) {
392*4882a593Smuzhiyun printk(KERN_ERR "tda1004x: no firmware upload (timeout or file not found?)\n");
393*4882a593Smuzhiyun return ret;
394*4882a593Smuzhiyun }
395*4882a593Smuzhiyun
396*4882a593Smuzhiyun /* reset chip */
397*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 0x10, 0);
398*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 8);
399*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 0);
400*4882a593Smuzhiyun msleep(10);
401*4882a593Smuzhiyun
402*4882a593Smuzhiyun /* set parameters */
403*4882a593Smuzhiyun tda10045h_set_bandwidth(state, 8000000);
404*4882a593Smuzhiyun
405*4882a593Smuzhiyun ret = tda1004x_do_upload(state, fw->data, fw->size, TDA10045H_FWPAGE, TDA10045H_CODE_IN);
406*4882a593Smuzhiyun release_firmware(fw);
407*4882a593Smuzhiyun if (ret)
408*4882a593Smuzhiyun return ret;
409*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: firmware upload complete\n");
410*4882a593Smuzhiyun
411*4882a593Smuzhiyun /* wait for DSP to initialise */
412*4882a593Smuzhiyun /* DSPREADY doesn't seem to work on the TDA10045H */
413*4882a593Smuzhiyun msleep(100);
414*4882a593Smuzhiyun
415*4882a593Smuzhiyun return tda1004x_check_upload_ok(state);
416*4882a593Smuzhiyun }
417*4882a593Smuzhiyun
tda10046_init_plls(struct dvb_frontend * fe)418*4882a593Smuzhiyun static void tda10046_init_plls(struct dvb_frontend* fe)
419*4882a593Smuzhiyun {
420*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
421*4882a593Smuzhiyun int tda10046_clk53m;
422*4882a593Smuzhiyun
423*4882a593Smuzhiyun if ((state->config->if_freq == TDA10046_FREQ_045) ||
424*4882a593Smuzhiyun (state->config->if_freq == TDA10046_FREQ_052))
425*4882a593Smuzhiyun tda10046_clk53m = 0;
426*4882a593Smuzhiyun else
427*4882a593Smuzhiyun tda10046_clk53m = 1;
428*4882a593Smuzhiyun
429*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CONFPLL1, 0xf0);
430*4882a593Smuzhiyun if(tda10046_clk53m) {
431*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: setting up plls for 53MHz sampling clock\n");
432*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CONFPLL2, 0x08); // PLL M = 8
433*4882a593Smuzhiyun } else {
434*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: setting up plls for 48MHz sampling clock\n");
435*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CONFPLL2, 0x03); // PLL M = 3
436*4882a593Smuzhiyun }
437*4882a593Smuzhiyun if (state->config->xtal_freq == TDA10046_XTAL_4M ) {
438*4882a593Smuzhiyun dprintk("%s: setting up PLLs for a 4 MHz Xtal\n", __func__);
439*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CONFPLL3, 0); // PLL P = N = 0
440*4882a593Smuzhiyun } else {
441*4882a593Smuzhiyun dprintk("%s: setting up PLLs for a 16 MHz Xtal\n", __func__);
442*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CONFPLL3, 3); // PLL P = 0, N = 3
443*4882a593Smuzhiyun }
444*4882a593Smuzhiyun if(tda10046_clk53m)
445*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_OFFSET, 0x67);
446*4882a593Smuzhiyun else
447*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_OFFSET, 0x72);
448*4882a593Smuzhiyun /* Note clock frequency is handled implicitly */
449*4882a593Smuzhiyun switch (state->config->if_freq) {
450*4882a593Smuzhiyun case TDA10046_FREQ_045:
451*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0x0c);
452*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x00);
453*4882a593Smuzhiyun break;
454*4882a593Smuzhiyun case TDA10046_FREQ_052:
455*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0x0d);
456*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0xc7);
457*4882a593Smuzhiyun break;
458*4882a593Smuzhiyun case TDA10046_FREQ_3617:
459*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0xd7);
460*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x59);
461*4882a593Smuzhiyun break;
462*4882a593Smuzhiyun case TDA10046_FREQ_3613:
463*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_MSB, 0xd7);
464*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_FREQ_PHY2_LSB, 0x3f);
465*4882a593Smuzhiyun break;
466*4882a593Smuzhiyun }
467*4882a593Smuzhiyun tda10046h_set_bandwidth(state, 8000000); /* default bandwidth 8 MHz */
468*4882a593Smuzhiyun /* let the PLLs settle */
469*4882a593Smuzhiyun msleep(120);
470*4882a593Smuzhiyun }
471*4882a593Smuzhiyun
tda10046_fwupload(struct dvb_frontend * fe)472*4882a593Smuzhiyun static int tda10046_fwupload(struct dvb_frontend* fe)
473*4882a593Smuzhiyun {
474*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
475*4882a593Smuzhiyun int ret, confc4;
476*4882a593Smuzhiyun const struct firmware *fw;
477*4882a593Smuzhiyun
478*4882a593Smuzhiyun /* reset + wake up chip */
479*4882a593Smuzhiyun if (state->config->xtal_freq == TDA10046_XTAL_4M) {
480*4882a593Smuzhiyun confc4 = 0;
481*4882a593Smuzhiyun } else {
482*4882a593Smuzhiyun dprintk("%s: 16MHz Xtal, reducing I2C speed\n", __func__);
483*4882a593Smuzhiyun confc4 = 0x80;
484*4882a593Smuzhiyun }
485*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONFC4, confc4);
486*4882a593Smuzhiyun
487*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_TRISTATE1, 1, 0);
488*4882a593Smuzhiyun /* set GPIO 1 and 3 */
489*4882a593Smuzhiyun if (state->config->gpio_config != TDA10046_GPTRI) {
490*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CONF_TRISTATE2, 0x33);
491*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_POLARITY, 0x0f, state->config->gpio_config &0x0f);
492*4882a593Smuzhiyun }
493*4882a593Smuzhiyun /* let the clocks recover from sleep */
494*4882a593Smuzhiyun msleep(10);
495*4882a593Smuzhiyun
496*4882a593Smuzhiyun /* The PLLs need to be reprogrammed after sleep */
497*4882a593Smuzhiyun tda10046_init_plls(fe);
498*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFADC2, 0xc0, 0);
499*4882a593Smuzhiyun
500*4882a593Smuzhiyun /* don't re-upload unless necessary */
501*4882a593Smuzhiyun if (tda1004x_check_upload_ok(state) == 0)
502*4882a593Smuzhiyun return 0;
503*4882a593Smuzhiyun
504*4882a593Smuzhiyun /*
505*4882a593Smuzhiyun For i2c normal work, we need to slow down the bus speed.
506*4882a593Smuzhiyun However, the slow down breaks the eeprom firmware load.
507*4882a593Smuzhiyun So, use normal speed for eeprom booting and then restore the
508*4882a593Smuzhiyun i2c speed after that. Tested with MSI TV @nyware A/D board,
509*4882a593Smuzhiyun that comes with firmware version 29 inside their eeprom.
510*4882a593Smuzhiyun
511*4882a593Smuzhiyun It should also be noticed that no other I2C transfer should
512*4882a593Smuzhiyun be in course while booting from eeprom, otherwise, tda10046
513*4882a593Smuzhiyun goes into an instable state. So, proper locking are needed
514*4882a593Smuzhiyun at the i2c bus master.
515*4882a593Smuzhiyun */
516*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: trying to boot from eeprom\n");
517*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONFC4, 4);
518*4882a593Smuzhiyun msleep(300);
519*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONFC4, confc4);
520*4882a593Smuzhiyun
521*4882a593Smuzhiyun /* Checks if eeprom firmware went without troubles */
522*4882a593Smuzhiyun if (tda1004x_check_upload_ok(state) == 0)
523*4882a593Smuzhiyun return 0;
524*4882a593Smuzhiyun
525*4882a593Smuzhiyun /* eeprom firmware didn't work. Load one manually. */
526*4882a593Smuzhiyun
527*4882a593Smuzhiyun if (state->config->request_firmware != NULL) {
528*4882a593Smuzhiyun /* request the firmware, this will block until someone uploads it */
529*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: waiting for firmware upload...\n");
530*4882a593Smuzhiyun ret = state->config->request_firmware(fe, &fw, TDA10046_DEFAULT_FIRMWARE);
531*4882a593Smuzhiyun if (ret) {
532*4882a593Smuzhiyun /* remain compatible to old bug: try to load with tda10045 image name */
533*4882a593Smuzhiyun ret = state->config->request_firmware(fe, &fw, TDA10045_DEFAULT_FIRMWARE);
534*4882a593Smuzhiyun if (ret) {
535*4882a593Smuzhiyun printk(KERN_ERR "tda1004x: no firmware upload (timeout or file not found?)\n");
536*4882a593Smuzhiyun return ret;
537*4882a593Smuzhiyun } else {
538*4882a593Smuzhiyun printk(KERN_INFO "tda1004x: please rename the firmware file to %s\n",
539*4882a593Smuzhiyun TDA10046_DEFAULT_FIRMWARE);
540*4882a593Smuzhiyun }
541*4882a593Smuzhiyun }
542*4882a593Smuzhiyun } else {
543*4882a593Smuzhiyun printk(KERN_ERR "tda1004x: no request function defined, can't upload from file\n");
544*4882a593Smuzhiyun return -EIO;
545*4882a593Smuzhiyun }
546*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 8); // going to boot from HOST
547*4882a593Smuzhiyun ret = tda1004x_do_upload(state, fw->data, fw->size, TDA10046H_CODE_CPT, TDA10046H_CODE_IN);
548*4882a593Smuzhiyun release_firmware(fw);
549*4882a593Smuzhiyun return tda1004x_check_upload_ok(state);
550*4882a593Smuzhiyun }
551*4882a593Smuzhiyun
tda1004x_encode_fec(int fec)552*4882a593Smuzhiyun static int tda1004x_encode_fec(int fec)
553*4882a593Smuzhiyun {
554*4882a593Smuzhiyun // convert known FEC values
555*4882a593Smuzhiyun switch (fec) {
556*4882a593Smuzhiyun case FEC_1_2:
557*4882a593Smuzhiyun return 0;
558*4882a593Smuzhiyun case FEC_2_3:
559*4882a593Smuzhiyun return 1;
560*4882a593Smuzhiyun case FEC_3_4:
561*4882a593Smuzhiyun return 2;
562*4882a593Smuzhiyun case FEC_5_6:
563*4882a593Smuzhiyun return 3;
564*4882a593Smuzhiyun case FEC_7_8:
565*4882a593Smuzhiyun return 4;
566*4882a593Smuzhiyun }
567*4882a593Smuzhiyun
568*4882a593Smuzhiyun // unsupported
569*4882a593Smuzhiyun return -EINVAL;
570*4882a593Smuzhiyun }
571*4882a593Smuzhiyun
tda1004x_decode_fec(int tdafec)572*4882a593Smuzhiyun static int tda1004x_decode_fec(int tdafec)
573*4882a593Smuzhiyun {
574*4882a593Smuzhiyun // convert known FEC values
575*4882a593Smuzhiyun switch (tdafec) {
576*4882a593Smuzhiyun case 0:
577*4882a593Smuzhiyun return FEC_1_2;
578*4882a593Smuzhiyun case 1:
579*4882a593Smuzhiyun return FEC_2_3;
580*4882a593Smuzhiyun case 2:
581*4882a593Smuzhiyun return FEC_3_4;
582*4882a593Smuzhiyun case 3:
583*4882a593Smuzhiyun return FEC_5_6;
584*4882a593Smuzhiyun case 4:
585*4882a593Smuzhiyun return FEC_7_8;
586*4882a593Smuzhiyun }
587*4882a593Smuzhiyun
588*4882a593Smuzhiyun // unsupported
589*4882a593Smuzhiyun return -1;
590*4882a593Smuzhiyun }
591*4882a593Smuzhiyun
tda1004x_write(struct dvb_frontend * fe,const u8 buf[],int len)592*4882a593Smuzhiyun static int tda1004x_write(struct dvb_frontend* fe, const u8 buf[], int len)
593*4882a593Smuzhiyun {
594*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
595*4882a593Smuzhiyun
596*4882a593Smuzhiyun if (len != 2)
597*4882a593Smuzhiyun return -EINVAL;
598*4882a593Smuzhiyun
599*4882a593Smuzhiyun return tda1004x_write_byteI(state, buf[0], buf[1]);
600*4882a593Smuzhiyun }
601*4882a593Smuzhiyun
tda10045_init(struct dvb_frontend * fe)602*4882a593Smuzhiyun static int tda10045_init(struct dvb_frontend* fe)
603*4882a593Smuzhiyun {
604*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
605*4882a593Smuzhiyun
606*4882a593Smuzhiyun dprintk("%s\n", __func__);
607*4882a593Smuzhiyun
608*4882a593Smuzhiyun if (tda10045_fwupload(fe)) {
609*4882a593Smuzhiyun printk("tda1004x: firmware upload failed\n");
610*4882a593Smuzhiyun return -EIO;
611*4882a593Smuzhiyun }
612*4882a593Smuzhiyun
613*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFADC1, 0x10, 0); // wake up the ADC
614*4882a593Smuzhiyun
615*4882a593Smuzhiyun // tda setup
616*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 0x20, 0); // disable DSP watchdog timer
617*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 8, 0); // select HP stream
618*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC1, 0x40, 0); // set polarity of VAGC signal
619*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC1, 0x80, 0x80); // enable pulse killer
620*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 0x10, 0x10); // enable auto offset
621*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF2, 0xC0, 0x0); // no frequency offset
622*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONF_TS1, 0); // setup MPEG2 TS interface
623*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONF_TS2, 0); // setup MPEG2 TS interface
624*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_VBER_MSB, 0xe0, 0xa0); // 10^6 VBER measurement bits
625*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC1, 0x10, 0); // VAGC polarity
626*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONFADC1, 0x2e);
627*4882a593Smuzhiyun
628*4882a593Smuzhiyun tda1004x_write_mask(state, 0x1f, 0x01, state->config->invert_oclk);
629*4882a593Smuzhiyun
630*4882a593Smuzhiyun return 0;
631*4882a593Smuzhiyun }
632*4882a593Smuzhiyun
tda10046_init(struct dvb_frontend * fe)633*4882a593Smuzhiyun static int tda10046_init(struct dvb_frontend* fe)
634*4882a593Smuzhiyun {
635*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
636*4882a593Smuzhiyun dprintk("%s\n", __func__);
637*4882a593Smuzhiyun
638*4882a593Smuzhiyun if (tda10046_fwupload(fe)) {
639*4882a593Smuzhiyun printk("tda1004x: firmware upload failed\n");
640*4882a593Smuzhiyun return -EIO;
641*4882a593Smuzhiyun }
642*4882a593Smuzhiyun
643*4882a593Smuzhiyun // tda setup
644*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 0x20, 0); // disable DSP watchdog timer
645*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_AUTO, 0x87); // 100 ppm crystal, select HP stream
646*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONFC1, 0x88); // enable pulse killer
647*4882a593Smuzhiyun
648*4882a593Smuzhiyun switch (state->config->agc_config) {
649*4882a593Smuzhiyun case TDA10046_AGC_DEFAULT:
650*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_CONF, 0x00); // AGC setup
651*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_POLARITY, 0xf0, 0x60); // set AGC polarities
652*4882a593Smuzhiyun break;
653*4882a593Smuzhiyun case TDA10046_AGC_IFO_AUTO_NEG:
654*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_CONF, 0x0a); // AGC setup
655*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_POLARITY, 0xf0, 0x60); // set AGC polarities
656*4882a593Smuzhiyun break;
657*4882a593Smuzhiyun case TDA10046_AGC_IFO_AUTO_POS:
658*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_CONF, 0x0a); // AGC setup
659*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_POLARITY, 0xf0, 0x00); // set AGC polarities
660*4882a593Smuzhiyun break;
661*4882a593Smuzhiyun case TDA10046_AGC_TDA827X:
662*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_CONF, 0x02); // AGC setup
663*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_THR, 0x70); // AGC Threshold
664*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_RENORM, 0x08); // Gain Renormalize
665*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_POLARITY, 0xf0, 0x60); // set AGC polarities
666*4882a593Smuzhiyun break;
667*4882a593Smuzhiyun }
668*4882a593Smuzhiyun if (state->config->ts_mode == 0) {
669*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_TRISTATE1, 0xc0, 0x40);
670*4882a593Smuzhiyun tda1004x_write_mask(state, 0x3a, 0x80, state->config->invert_oclk << 7);
671*4882a593Smuzhiyun } else {
672*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_TRISTATE1, 0xc0, 0x80);
673*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_POLARITY, 0x10,
674*4882a593Smuzhiyun state->config->invert_oclk << 4);
675*4882a593Smuzhiyun }
676*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONFADC2, 0x38);
677*4882a593Smuzhiyun tda1004x_write_mask (state, TDA10046H_CONF_TRISTATE1, 0x3e, 0x38); // Turn IF AGC output on
678*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_TUN_MIN, 0); // }
679*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_TUN_MAX, 0xff); // } AGC min/max values
680*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_IF_MIN, 0); // }
681*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_IF_MAX, 0xff); // }
682*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_AGC_GAINS, 0x12); // IF gain 2, TUN gain 1
683*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CVBER_CTRL, 0x1a); // 10^6 VBER measurement bits
684*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONF_TS1, 7); // MPEG2 interface config
685*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA1004X_CONF_TS2, 0xc0); // MPEG2 interface config
686*4882a593Smuzhiyun // tda1004x_write_mask(state, 0x50, 0x80, 0x80); // handle out of guard echoes
687*4882a593Smuzhiyun
688*4882a593Smuzhiyun return 0;
689*4882a593Smuzhiyun }
690*4882a593Smuzhiyun
tda1004x_set_fe(struct dvb_frontend * fe)691*4882a593Smuzhiyun static int tda1004x_set_fe(struct dvb_frontend *fe)
692*4882a593Smuzhiyun {
693*4882a593Smuzhiyun struct dtv_frontend_properties *fe_params = &fe->dtv_property_cache;
694*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
695*4882a593Smuzhiyun int tmp;
696*4882a593Smuzhiyun int inversion;
697*4882a593Smuzhiyun
698*4882a593Smuzhiyun dprintk("%s\n", __func__);
699*4882a593Smuzhiyun
700*4882a593Smuzhiyun if (state->demod_type == TDA1004X_DEMOD_TDA10046) {
701*4882a593Smuzhiyun // setup auto offset
702*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 0x10, 0x10);
703*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x80, 0);
704*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF2, 0xC0, 0);
705*4882a593Smuzhiyun
706*4882a593Smuzhiyun // disable agc_conf[2]
707*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_AGC_CONF, 4, 0);
708*4882a593Smuzhiyun }
709*4882a593Smuzhiyun
710*4882a593Smuzhiyun // set frequency
711*4882a593Smuzhiyun if (fe->ops.tuner_ops.set_params) {
712*4882a593Smuzhiyun fe->ops.tuner_ops.set_params(fe);
713*4882a593Smuzhiyun if (fe->ops.i2c_gate_ctrl)
714*4882a593Smuzhiyun fe->ops.i2c_gate_ctrl(fe, 0);
715*4882a593Smuzhiyun }
716*4882a593Smuzhiyun
717*4882a593Smuzhiyun // Hardcoded to use auto as much as possible on the TDA10045 as it
718*4882a593Smuzhiyun // is very unreliable if AUTO mode is _not_ used.
719*4882a593Smuzhiyun if (state->demod_type == TDA1004X_DEMOD_TDA10045) {
720*4882a593Smuzhiyun fe_params->code_rate_HP = FEC_AUTO;
721*4882a593Smuzhiyun fe_params->guard_interval = GUARD_INTERVAL_AUTO;
722*4882a593Smuzhiyun fe_params->transmission_mode = TRANSMISSION_MODE_AUTO;
723*4882a593Smuzhiyun }
724*4882a593Smuzhiyun
725*4882a593Smuzhiyun // Set standard params.. or put them to auto
726*4882a593Smuzhiyun if ((fe_params->code_rate_HP == FEC_AUTO) ||
727*4882a593Smuzhiyun (fe_params->code_rate_LP == FEC_AUTO) ||
728*4882a593Smuzhiyun (fe_params->modulation == QAM_AUTO) ||
729*4882a593Smuzhiyun (fe_params->hierarchy == HIERARCHY_AUTO)) {
730*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 1, 1); // enable auto
731*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x03, 0); /* turn off modulation bits */
732*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x60, 0); // turn off hierarchy bits
733*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF2, 0x3f, 0); // turn off FEC bits
734*4882a593Smuzhiyun } else {
735*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 1, 0); // disable auto
736*4882a593Smuzhiyun
737*4882a593Smuzhiyun // set HP FEC
738*4882a593Smuzhiyun tmp = tda1004x_encode_fec(fe_params->code_rate_HP);
739*4882a593Smuzhiyun if (tmp < 0)
740*4882a593Smuzhiyun return tmp;
741*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF2, 7, tmp);
742*4882a593Smuzhiyun
743*4882a593Smuzhiyun // set LP FEC
744*4882a593Smuzhiyun tmp = tda1004x_encode_fec(fe_params->code_rate_LP);
745*4882a593Smuzhiyun if (tmp < 0)
746*4882a593Smuzhiyun return tmp;
747*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF2, 0x38, tmp << 3);
748*4882a593Smuzhiyun
749*4882a593Smuzhiyun /* set modulation */
750*4882a593Smuzhiyun switch (fe_params->modulation) {
751*4882a593Smuzhiyun case QPSK:
752*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 3, 0);
753*4882a593Smuzhiyun break;
754*4882a593Smuzhiyun
755*4882a593Smuzhiyun case QAM_16:
756*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 3, 1);
757*4882a593Smuzhiyun break;
758*4882a593Smuzhiyun
759*4882a593Smuzhiyun case QAM_64:
760*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 3, 2);
761*4882a593Smuzhiyun break;
762*4882a593Smuzhiyun
763*4882a593Smuzhiyun default:
764*4882a593Smuzhiyun return -EINVAL;
765*4882a593Smuzhiyun }
766*4882a593Smuzhiyun
767*4882a593Smuzhiyun // set hierarchy
768*4882a593Smuzhiyun switch (fe_params->hierarchy) {
769*4882a593Smuzhiyun case HIERARCHY_NONE:
770*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x60, 0 << 5);
771*4882a593Smuzhiyun break;
772*4882a593Smuzhiyun
773*4882a593Smuzhiyun case HIERARCHY_1:
774*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x60, 1 << 5);
775*4882a593Smuzhiyun break;
776*4882a593Smuzhiyun
777*4882a593Smuzhiyun case HIERARCHY_2:
778*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x60, 2 << 5);
779*4882a593Smuzhiyun break;
780*4882a593Smuzhiyun
781*4882a593Smuzhiyun case HIERARCHY_4:
782*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x60, 3 << 5);
783*4882a593Smuzhiyun break;
784*4882a593Smuzhiyun
785*4882a593Smuzhiyun default:
786*4882a593Smuzhiyun return -EINVAL;
787*4882a593Smuzhiyun }
788*4882a593Smuzhiyun }
789*4882a593Smuzhiyun
790*4882a593Smuzhiyun // set bandwidth
791*4882a593Smuzhiyun switch (state->demod_type) {
792*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10045:
793*4882a593Smuzhiyun tda10045h_set_bandwidth(state, fe_params->bandwidth_hz);
794*4882a593Smuzhiyun break;
795*4882a593Smuzhiyun
796*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10046:
797*4882a593Smuzhiyun tda10046h_set_bandwidth(state, fe_params->bandwidth_hz);
798*4882a593Smuzhiyun break;
799*4882a593Smuzhiyun }
800*4882a593Smuzhiyun
801*4882a593Smuzhiyun // set inversion
802*4882a593Smuzhiyun inversion = fe_params->inversion;
803*4882a593Smuzhiyun if (state->config->invert)
804*4882a593Smuzhiyun inversion = inversion ? INVERSION_OFF : INVERSION_ON;
805*4882a593Smuzhiyun switch (inversion) {
806*4882a593Smuzhiyun case INVERSION_OFF:
807*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC1, 0x20, 0);
808*4882a593Smuzhiyun break;
809*4882a593Smuzhiyun
810*4882a593Smuzhiyun case INVERSION_ON:
811*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC1, 0x20, 0x20);
812*4882a593Smuzhiyun break;
813*4882a593Smuzhiyun
814*4882a593Smuzhiyun default:
815*4882a593Smuzhiyun return -EINVAL;
816*4882a593Smuzhiyun }
817*4882a593Smuzhiyun
818*4882a593Smuzhiyun // set guard interval
819*4882a593Smuzhiyun switch (fe_params->guard_interval) {
820*4882a593Smuzhiyun case GUARD_INTERVAL_1_32:
821*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 2, 0);
822*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x0c, 0 << 2);
823*4882a593Smuzhiyun break;
824*4882a593Smuzhiyun
825*4882a593Smuzhiyun case GUARD_INTERVAL_1_16:
826*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 2, 0);
827*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x0c, 1 << 2);
828*4882a593Smuzhiyun break;
829*4882a593Smuzhiyun
830*4882a593Smuzhiyun case GUARD_INTERVAL_1_8:
831*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 2, 0);
832*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x0c, 2 << 2);
833*4882a593Smuzhiyun break;
834*4882a593Smuzhiyun
835*4882a593Smuzhiyun case GUARD_INTERVAL_1_4:
836*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 2, 0);
837*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x0c, 3 << 2);
838*4882a593Smuzhiyun break;
839*4882a593Smuzhiyun
840*4882a593Smuzhiyun case GUARD_INTERVAL_AUTO:
841*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 2, 2);
842*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x0c, 0 << 2);
843*4882a593Smuzhiyun break;
844*4882a593Smuzhiyun
845*4882a593Smuzhiyun default:
846*4882a593Smuzhiyun return -EINVAL;
847*4882a593Smuzhiyun }
848*4882a593Smuzhiyun
849*4882a593Smuzhiyun // set transmission mode
850*4882a593Smuzhiyun switch (fe_params->transmission_mode) {
851*4882a593Smuzhiyun case TRANSMISSION_MODE_2K:
852*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 4, 0);
853*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x10, 0 << 4);
854*4882a593Smuzhiyun break;
855*4882a593Smuzhiyun
856*4882a593Smuzhiyun case TRANSMISSION_MODE_8K:
857*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 4, 0);
858*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x10, 1 << 4);
859*4882a593Smuzhiyun break;
860*4882a593Smuzhiyun
861*4882a593Smuzhiyun case TRANSMISSION_MODE_AUTO:
862*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 4, 4);
863*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_IN_CONF1, 0x10, 0);
864*4882a593Smuzhiyun break;
865*4882a593Smuzhiyun
866*4882a593Smuzhiyun default:
867*4882a593Smuzhiyun return -EINVAL;
868*4882a593Smuzhiyun }
869*4882a593Smuzhiyun
870*4882a593Smuzhiyun // start the lock
871*4882a593Smuzhiyun switch (state->demod_type) {
872*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10045:
873*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 8);
874*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 8, 0);
875*4882a593Smuzhiyun break;
876*4882a593Smuzhiyun
877*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10046:
878*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_AUTO, 0x40, 0x40);
879*4882a593Smuzhiyun msleep(1);
880*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_AGC_CONF, 4, 1);
881*4882a593Smuzhiyun break;
882*4882a593Smuzhiyun }
883*4882a593Smuzhiyun
884*4882a593Smuzhiyun msleep(10);
885*4882a593Smuzhiyun
886*4882a593Smuzhiyun return 0;
887*4882a593Smuzhiyun }
888*4882a593Smuzhiyun
tda1004x_get_fe(struct dvb_frontend * fe,struct dtv_frontend_properties * fe_params)889*4882a593Smuzhiyun static int tda1004x_get_fe(struct dvb_frontend *fe,
890*4882a593Smuzhiyun struct dtv_frontend_properties *fe_params)
891*4882a593Smuzhiyun {
892*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
893*4882a593Smuzhiyun int status;
894*4882a593Smuzhiyun
895*4882a593Smuzhiyun dprintk("%s\n", __func__);
896*4882a593Smuzhiyun
897*4882a593Smuzhiyun status = tda1004x_read_byte(state, TDA1004X_STATUS_CD);
898*4882a593Smuzhiyun if (status == -1)
899*4882a593Smuzhiyun return -EIO;
900*4882a593Smuzhiyun
901*4882a593Smuzhiyun /* Only update the properties cache if device is locked */
902*4882a593Smuzhiyun if (!(status & 8))
903*4882a593Smuzhiyun return 0;
904*4882a593Smuzhiyun
905*4882a593Smuzhiyun // inversion status
906*4882a593Smuzhiyun fe_params->inversion = INVERSION_OFF;
907*4882a593Smuzhiyun if (tda1004x_read_byte(state, TDA1004X_CONFC1) & 0x20)
908*4882a593Smuzhiyun fe_params->inversion = INVERSION_ON;
909*4882a593Smuzhiyun if (state->config->invert)
910*4882a593Smuzhiyun fe_params->inversion = fe_params->inversion ? INVERSION_OFF : INVERSION_ON;
911*4882a593Smuzhiyun
912*4882a593Smuzhiyun // bandwidth
913*4882a593Smuzhiyun switch (state->demod_type) {
914*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10045:
915*4882a593Smuzhiyun switch (tda1004x_read_byte(state, TDA10045H_WREF_LSB)) {
916*4882a593Smuzhiyun case 0x14:
917*4882a593Smuzhiyun fe_params->bandwidth_hz = 8000000;
918*4882a593Smuzhiyun break;
919*4882a593Smuzhiyun case 0xdb:
920*4882a593Smuzhiyun fe_params->bandwidth_hz = 7000000;
921*4882a593Smuzhiyun break;
922*4882a593Smuzhiyun case 0x4f:
923*4882a593Smuzhiyun fe_params->bandwidth_hz = 6000000;
924*4882a593Smuzhiyun break;
925*4882a593Smuzhiyun }
926*4882a593Smuzhiyun break;
927*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10046:
928*4882a593Smuzhiyun switch (tda1004x_read_byte(state, TDA10046H_TIME_WREF1)) {
929*4882a593Smuzhiyun case 0x5c:
930*4882a593Smuzhiyun case 0x54:
931*4882a593Smuzhiyun fe_params->bandwidth_hz = 8000000;
932*4882a593Smuzhiyun break;
933*4882a593Smuzhiyun case 0x6a:
934*4882a593Smuzhiyun case 0x60:
935*4882a593Smuzhiyun fe_params->bandwidth_hz = 7000000;
936*4882a593Smuzhiyun break;
937*4882a593Smuzhiyun case 0x7b:
938*4882a593Smuzhiyun case 0x70:
939*4882a593Smuzhiyun fe_params->bandwidth_hz = 6000000;
940*4882a593Smuzhiyun break;
941*4882a593Smuzhiyun }
942*4882a593Smuzhiyun break;
943*4882a593Smuzhiyun }
944*4882a593Smuzhiyun
945*4882a593Smuzhiyun // FEC
946*4882a593Smuzhiyun fe_params->code_rate_HP =
947*4882a593Smuzhiyun tda1004x_decode_fec(tda1004x_read_byte(state, TDA1004X_OUT_CONF2) & 7);
948*4882a593Smuzhiyun fe_params->code_rate_LP =
949*4882a593Smuzhiyun tda1004x_decode_fec((tda1004x_read_byte(state, TDA1004X_OUT_CONF2) >> 3) & 7);
950*4882a593Smuzhiyun
951*4882a593Smuzhiyun /* modulation */
952*4882a593Smuzhiyun switch (tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 3) {
953*4882a593Smuzhiyun case 0:
954*4882a593Smuzhiyun fe_params->modulation = QPSK;
955*4882a593Smuzhiyun break;
956*4882a593Smuzhiyun case 1:
957*4882a593Smuzhiyun fe_params->modulation = QAM_16;
958*4882a593Smuzhiyun break;
959*4882a593Smuzhiyun case 2:
960*4882a593Smuzhiyun fe_params->modulation = QAM_64;
961*4882a593Smuzhiyun break;
962*4882a593Smuzhiyun }
963*4882a593Smuzhiyun
964*4882a593Smuzhiyun // transmission mode
965*4882a593Smuzhiyun fe_params->transmission_mode = TRANSMISSION_MODE_2K;
966*4882a593Smuzhiyun if (tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 0x10)
967*4882a593Smuzhiyun fe_params->transmission_mode = TRANSMISSION_MODE_8K;
968*4882a593Smuzhiyun
969*4882a593Smuzhiyun // guard interval
970*4882a593Smuzhiyun switch ((tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 0x0c) >> 2) {
971*4882a593Smuzhiyun case 0:
972*4882a593Smuzhiyun fe_params->guard_interval = GUARD_INTERVAL_1_32;
973*4882a593Smuzhiyun break;
974*4882a593Smuzhiyun case 1:
975*4882a593Smuzhiyun fe_params->guard_interval = GUARD_INTERVAL_1_16;
976*4882a593Smuzhiyun break;
977*4882a593Smuzhiyun case 2:
978*4882a593Smuzhiyun fe_params->guard_interval = GUARD_INTERVAL_1_8;
979*4882a593Smuzhiyun break;
980*4882a593Smuzhiyun case 3:
981*4882a593Smuzhiyun fe_params->guard_interval = GUARD_INTERVAL_1_4;
982*4882a593Smuzhiyun break;
983*4882a593Smuzhiyun }
984*4882a593Smuzhiyun
985*4882a593Smuzhiyun // hierarchy
986*4882a593Smuzhiyun switch ((tda1004x_read_byte(state, TDA1004X_OUT_CONF1) & 0x60) >> 5) {
987*4882a593Smuzhiyun case 0:
988*4882a593Smuzhiyun fe_params->hierarchy = HIERARCHY_NONE;
989*4882a593Smuzhiyun break;
990*4882a593Smuzhiyun case 1:
991*4882a593Smuzhiyun fe_params->hierarchy = HIERARCHY_1;
992*4882a593Smuzhiyun break;
993*4882a593Smuzhiyun case 2:
994*4882a593Smuzhiyun fe_params->hierarchy = HIERARCHY_2;
995*4882a593Smuzhiyun break;
996*4882a593Smuzhiyun case 3:
997*4882a593Smuzhiyun fe_params->hierarchy = HIERARCHY_4;
998*4882a593Smuzhiyun break;
999*4882a593Smuzhiyun }
1000*4882a593Smuzhiyun
1001*4882a593Smuzhiyun return 0;
1002*4882a593Smuzhiyun }
1003*4882a593Smuzhiyun
tda1004x_read_status(struct dvb_frontend * fe,enum fe_status * fe_status)1004*4882a593Smuzhiyun static int tda1004x_read_status(struct dvb_frontend *fe,
1005*4882a593Smuzhiyun enum fe_status *fe_status)
1006*4882a593Smuzhiyun {
1007*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
1008*4882a593Smuzhiyun int status;
1009*4882a593Smuzhiyun int cber;
1010*4882a593Smuzhiyun int vber;
1011*4882a593Smuzhiyun
1012*4882a593Smuzhiyun dprintk("%s\n", __func__);
1013*4882a593Smuzhiyun
1014*4882a593Smuzhiyun // read status
1015*4882a593Smuzhiyun status = tda1004x_read_byte(state, TDA1004X_STATUS_CD);
1016*4882a593Smuzhiyun if (status == -1)
1017*4882a593Smuzhiyun return -EIO;
1018*4882a593Smuzhiyun
1019*4882a593Smuzhiyun // decode
1020*4882a593Smuzhiyun *fe_status = 0;
1021*4882a593Smuzhiyun if (status & 4)
1022*4882a593Smuzhiyun *fe_status |= FE_HAS_SIGNAL;
1023*4882a593Smuzhiyun if (status & 2)
1024*4882a593Smuzhiyun *fe_status |= FE_HAS_CARRIER;
1025*4882a593Smuzhiyun if (status & 8)
1026*4882a593Smuzhiyun *fe_status |= FE_HAS_VITERBI | FE_HAS_SYNC | FE_HAS_LOCK;
1027*4882a593Smuzhiyun
1028*4882a593Smuzhiyun // if we don't already have VITERBI (i.e. not LOCKED), see if the viterbi
1029*4882a593Smuzhiyun // is getting anything valid
1030*4882a593Smuzhiyun if (!(*fe_status & FE_HAS_VITERBI)) {
1031*4882a593Smuzhiyun // read the CBER
1032*4882a593Smuzhiyun cber = tda1004x_read_byte(state, TDA1004X_CBER_LSB);
1033*4882a593Smuzhiyun if (cber == -1)
1034*4882a593Smuzhiyun return -EIO;
1035*4882a593Smuzhiyun status = tda1004x_read_byte(state, TDA1004X_CBER_MSB);
1036*4882a593Smuzhiyun if (status == -1)
1037*4882a593Smuzhiyun return -EIO;
1038*4882a593Smuzhiyun cber |= (status << 8);
1039*4882a593Smuzhiyun // The address 0x20 should be read to cope with a TDA10046 bug
1040*4882a593Smuzhiyun tda1004x_read_byte(state, TDA1004X_CBER_RESET);
1041*4882a593Smuzhiyun
1042*4882a593Smuzhiyun if (cber != 65535)
1043*4882a593Smuzhiyun *fe_status |= FE_HAS_VITERBI;
1044*4882a593Smuzhiyun }
1045*4882a593Smuzhiyun
1046*4882a593Smuzhiyun // if we DO have some valid VITERBI output, but don't already have SYNC
1047*4882a593Smuzhiyun // bytes (i.e. not LOCKED), see if the RS decoder is getting anything valid.
1048*4882a593Smuzhiyun if ((*fe_status & FE_HAS_VITERBI) && (!(*fe_status & FE_HAS_SYNC))) {
1049*4882a593Smuzhiyun // read the VBER
1050*4882a593Smuzhiyun vber = tda1004x_read_byte(state, TDA1004X_VBER_LSB);
1051*4882a593Smuzhiyun if (vber == -1)
1052*4882a593Smuzhiyun return -EIO;
1053*4882a593Smuzhiyun status = tda1004x_read_byte(state, TDA1004X_VBER_MID);
1054*4882a593Smuzhiyun if (status == -1)
1055*4882a593Smuzhiyun return -EIO;
1056*4882a593Smuzhiyun vber |= (status << 8);
1057*4882a593Smuzhiyun status = tda1004x_read_byte(state, TDA1004X_VBER_MSB);
1058*4882a593Smuzhiyun if (status == -1)
1059*4882a593Smuzhiyun return -EIO;
1060*4882a593Smuzhiyun vber |= (status & 0x0f) << 16;
1061*4882a593Smuzhiyun // The CVBER_LUT should be read to cope with TDA10046 hardware bug
1062*4882a593Smuzhiyun tda1004x_read_byte(state, TDA1004X_CVBER_LUT);
1063*4882a593Smuzhiyun
1064*4882a593Smuzhiyun // if RS has passed some valid TS packets, then we must be
1065*4882a593Smuzhiyun // getting some SYNC bytes
1066*4882a593Smuzhiyun if (vber < 16632)
1067*4882a593Smuzhiyun *fe_status |= FE_HAS_SYNC;
1068*4882a593Smuzhiyun }
1069*4882a593Smuzhiyun
1070*4882a593Smuzhiyun // success
1071*4882a593Smuzhiyun dprintk("%s: fe_status=0x%x\n", __func__, *fe_status);
1072*4882a593Smuzhiyun return 0;
1073*4882a593Smuzhiyun }
1074*4882a593Smuzhiyun
tda1004x_read_signal_strength(struct dvb_frontend * fe,u16 * signal)1075*4882a593Smuzhiyun static int tda1004x_read_signal_strength(struct dvb_frontend* fe, u16 * signal)
1076*4882a593Smuzhiyun {
1077*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
1078*4882a593Smuzhiyun int tmp;
1079*4882a593Smuzhiyun int reg = 0;
1080*4882a593Smuzhiyun
1081*4882a593Smuzhiyun dprintk("%s\n", __func__);
1082*4882a593Smuzhiyun
1083*4882a593Smuzhiyun // determine the register to use
1084*4882a593Smuzhiyun switch (state->demod_type) {
1085*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10045:
1086*4882a593Smuzhiyun reg = TDA10045H_S_AGC;
1087*4882a593Smuzhiyun break;
1088*4882a593Smuzhiyun
1089*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10046:
1090*4882a593Smuzhiyun reg = TDA10046H_AGC_IF_LEVEL;
1091*4882a593Smuzhiyun break;
1092*4882a593Smuzhiyun }
1093*4882a593Smuzhiyun
1094*4882a593Smuzhiyun // read it
1095*4882a593Smuzhiyun tmp = tda1004x_read_byte(state, reg);
1096*4882a593Smuzhiyun if (tmp < 0)
1097*4882a593Smuzhiyun return -EIO;
1098*4882a593Smuzhiyun
1099*4882a593Smuzhiyun *signal = (tmp << 8) | tmp;
1100*4882a593Smuzhiyun dprintk("%s: signal=0x%x\n", __func__, *signal);
1101*4882a593Smuzhiyun return 0;
1102*4882a593Smuzhiyun }
1103*4882a593Smuzhiyun
tda1004x_read_snr(struct dvb_frontend * fe,u16 * snr)1104*4882a593Smuzhiyun static int tda1004x_read_snr(struct dvb_frontend* fe, u16 * snr)
1105*4882a593Smuzhiyun {
1106*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
1107*4882a593Smuzhiyun int tmp;
1108*4882a593Smuzhiyun
1109*4882a593Smuzhiyun dprintk("%s\n", __func__);
1110*4882a593Smuzhiyun
1111*4882a593Smuzhiyun // read it
1112*4882a593Smuzhiyun tmp = tda1004x_read_byte(state, TDA1004X_SNR);
1113*4882a593Smuzhiyun if (tmp < 0)
1114*4882a593Smuzhiyun return -EIO;
1115*4882a593Smuzhiyun tmp = 255 - tmp;
1116*4882a593Smuzhiyun
1117*4882a593Smuzhiyun *snr = ((tmp << 8) | tmp);
1118*4882a593Smuzhiyun dprintk("%s: snr=0x%x\n", __func__, *snr);
1119*4882a593Smuzhiyun return 0;
1120*4882a593Smuzhiyun }
1121*4882a593Smuzhiyun
tda1004x_read_ucblocks(struct dvb_frontend * fe,u32 * ucblocks)1122*4882a593Smuzhiyun static int tda1004x_read_ucblocks(struct dvb_frontend* fe, u32* ucblocks)
1123*4882a593Smuzhiyun {
1124*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
1125*4882a593Smuzhiyun int tmp;
1126*4882a593Smuzhiyun int tmp2;
1127*4882a593Smuzhiyun int counter;
1128*4882a593Smuzhiyun
1129*4882a593Smuzhiyun dprintk("%s\n", __func__);
1130*4882a593Smuzhiyun
1131*4882a593Smuzhiyun // read the UCBLOCKS and reset
1132*4882a593Smuzhiyun counter = 0;
1133*4882a593Smuzhiyun tmp = tda1004x_read_byte(state, TDA1004X_UNCOR);
1134*4882a593Smuzhiyun if (tmp < 0)
1135*4882a593Smuzhiyun return -EIO;
1136*4882a593Smuzhiyun tmp &= 0x7f;
1137*4882a593Smuzhiyun while (counter++ < 5) {
1138*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_UNCOR, 0x80, 0);
1139*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_UNCOR, 0x80, 0);
1140*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_UNCOR, 0x80, 0);
1141*4882a593Smuzhiyun
1142*4882a593Smuzhiyun tmp2 = tda1004x_read_byte(state, TDA1004X_UNCOR);
1143*4882a593Smuzhiyun if (tmp2 < 0)
1144*4882a593Smuzhiyun return -EIO;
1145*4882a593Smuzhiyun tmp2 &= 0x7f;
1146*4882a593Smuzhiyun if ((tmp2 < tmp) || (tmp2 == 0))
1147*4882a593Smuzhiyun break;
1148*4882a593Smuzhiyun }
1149*4882a593Smuzhiyun
1150*4882a593Smuzhiyun if (tmp != 0x7f)
1151*4882a593Smuzhiyun *ucblocks = tmp;
1152*4882a593Smuzhiyun else
1153*4882a593Smuzhiyun *ucblocks = 0xffffffff;
1154*4882a593Smuzhiyun
1155*4882a593Smuzhiyun dprintk("%s: ucblocks=0x%x\n", __func__, *ucblocks);
1156*4882a593Smuzhiyun return 0;
1157*4882a593Smuzhiyun }
1158*4882a593Smuzhiyun
tda1004x_read_ber(struct dvb_frontend * fe,u32 * ber)1159*4882a593Smuzhiyun static int tda1004x_read_ber(struct dvb_frontend* fe, u32* ber)
1160*4882a593Smuzhiyun {
1161*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
1162*4882a593Smuzhiyun int tmp;
1163*4882a593Smuzhiyun
1164*4882a593Smuzhiyun dprintk("%s\n", __func__);
1165*4882a593Smuzhiyun
1166*4882a593Smuzhiyun // read it in
1167*4882a593Smuzhiyun tmp = tda1004x_read_byte(state, TDA1004X_CBER_LSB);
1168*4882a593Smuzhiyun if (tmp < 0)
1169*4882a593Smuzhiyun return -EIO;
1170*4882a593Smuzhiyun *ber = tmp << 1;
1171*4882a593Smuzhiyun tmp = tda1004x_read_byte(state, TDA1004X_CBER_MSB);
1172*4882a593Smuzhiyun if (tmp < 0)
1173*4882a593Smuzhiyun return -EIO;
1174*4882a593Smuzhiyun *ber |= (tmp << 9);
1175*4882a593Smuzhiyun // The address 0x20 should be read to cope with a TDA10046 bug
1176*4882a593Smuzhiyun tda1004x_read_byte(state, TDA1004X_CBER_RESET);
1177*4882a593Smuzhiyun
1178*4882a593Smuzhiyun dprintk("%s: ber=0x%x\n", __func__, *ber);
1179*4882a593Smuzhiyun return 0;
1180*4882a593Smuzhiyun }
1181*4882a593Smuzhiyun
tda1004x_sleep(struct dvb_frontend * fe)1182*4882a593Smuzhiyun static int tda1004x_sleep(struct dvb_frontend* fe)
1183*4882a593Smuzhiyun {
1184*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
1185*4882a593Smuzhiyun int gpio_conf;
1186*4882a593Smuzhiyun
1187*4882a593Smuzhiyun switch (state->demod_type) {
1188*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10045:
1189*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFADC1, 0x10, 0x10);
1190*4882a593Smuzhiyun break;
1191*4882a593Smuzhiyun
1192*4882a593Smuzhiyun case TDA1004X_DEMOD_TDA10046:
1193*4882a593Smuzhiyun /* set outputs to tristate */
1194*4882a593Smuzhiyun tda1004x_write_byteI(state, TDA10046H_CONF_TRISTATE1, 0xff);
1195*4882a593Smuzhiyun /* invert GPIO 1 and 3 if desired*/
1196*4882a593Smuzhiyun gpio_conf = state->config->gpio_config;
1197*4882a593Smuzhiyun if (gpio_conf >= TDA10046_GP00_I)
1198*4882a593Smuzhiyun tda1004x_write_mask(state, TDA10046H_CONF_POLARITY, 0x0f,
1199*4882a593Smuzhiyun (gpio_conf & 0x0f) ^ 0x0a);
1200*4882a593Smuzhiyun
1201*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFADC2, 0xc0, 0xc0);
1202*4882a593Smuzhiyun tda1004x_write_mask(state, TDA1004X_CONFC4, 1, 1);
1203*4882a593Smuzhiyun break;
1204*4882a593Smuzhiyun }
1205*4882a593Smuzhiyun
1206*4882a593Smuzhiyun return 0;
1207*4882a593Smuzhiyun }
1208*4882a593Smuzhiyun
tda1004x_i2c_gate_ctrl(struct dvb_frontend * fe,int enable)1209*4882a593Smuzhiyun static int tda1004x_i2c_gate_ctrl(struct dvb_frontend* fe, int enable)
1210*4882a593Smuzhiyun {
1211*4882a593Smuzhiyun struct tda1004x_state* state = fe->demodulator_priv;
1212*4882a593Smuzhiyun
1213*4882a593Smuzhiyun if (enable) {
1214*4882a593Smuzhiyun return tda1004x_enable_tuner_i2c(state);
1215*4882a593Smuzhiyun } else {
1216*4882a593Smuzhiyun return tda1004x_disable_tuner_i2c(state);
1217*4882a593Smuzhiyun }
1218*4882a593Smuzhiyun }
1219*4882a593Smuzhiyun
tda1004x_get_tune_settings(struct dvb_frontend * fe,struct dvb_frontend_tune_settings * fesettings)1220*4882a593Smuzhiyun static int tda1004x_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings* fesettings)
1221*4882a593Smuzhiyun {
1222*4882a593Smuzhiyun fesettings->min_delay_ms = 800;
1223*4882a593Smuzhiyun /* Drift compensation makes no sense for DVB-T */
1224*4882a593Smuzhiyun fesettings->step_size = 0;
1225*4882a593Smuzhiyun fesettings->max_drift = 0;
1226*4882a593Smuzhiyun return 0;
1227*4882a593Smuzhiyun }
1228*4882a593Smuzhiyun
tda1004x_release(struct dvb_frontend * fe)1229*4882a593Smuzhiyun static void tda1004x_release(struct dvb_frontend* fe)
1230*4882a593Smuzhiyun {
1231*4882a593Smuzhiyun struct tda1004x_state *state = fe->demodulator_priv;
1232*4882a593Smuzhiyun kfree(state);
1233*4882a593Smuzhiyun }
1234*4882a593Smuzhiyun
1235*4882a593Smuzhiyun static const struct dvb_frontend_ops tda10045_ops = {
1236*4882a593Smuzhiyun .delsys = { SYS_DVBT },
1237*4882a593Smuzhiyun .info = {
1238*4882a593Smuzhiyun .name = "Philips TDA10045H DVB-T",
1239*4882a593Smuzhiyun .frequency_min_hz = 51 * MHz,
1240*4882a593Smuzhiyun .frequency_max_hz = 858 * MHz,
1241*4882a593Smuzhiyun .frequency_stepsize_hz = 166667,
1242*4882a593Smuzhiyun .caps =
1243*4882a593Smuzhiyun FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
1244*4882a593Smuzhiyun FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
1245*4882a593Smuzhiyun FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
1246*4882a593Smuzhiyun FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_GUARD_INTERVAL_AUTO
1247*4882a593Smuzhiyun },
1248*4882a593Smuzhiyun
1249*4882a593Smuzhiyun .release = tda1004x_release,
1250*4882a593Smuzhiyun
1251*4882a593Smuzhiyun .init = tda10045_init,
1252*4882a593Smuzhiyun .sleep = tda1004x_sleep,
1253*4882a593Smuzhiyun .write = tda1004x_write,
1254*4882a593Smuzhiyun .i2c_gate_ctrl = tda1004x_i2c_gate_ctrl,
1255*4882a593Smuzhiyun
1256*4882a593Smuzhiyun .set_frontend = tda1004x_set_fe,
1257*4882a593Smuzhiyun .get_frontend = tda1004x_get_fe,
1258*4882a593Smuzhiyun .get_tune_settings = tda1004x_get_tune_settings,
1259*4882a593Smuzhiyun
1260*4882a593Smuzhiyun .read_status = tda1004x_read_status,
1261*4882a593Smuzhiyun .read_ber = tda1004x_read_ber,
1262*4882a593Smuzhiyun .read_signal_strength = tda1004x_read_signal_strength,
1263*4882a593Smuzhiyun .read_snr = tda1004x_read_snr,
1264*4882a593Smuzhiyun .read_ucblocks = tda1004x_read_ucblocks,
1265*4882a593Smuzhiyun };
1266*4882a593Smuzhiyun
tda10045_attach(const struct tda1004x_config * config,struct i2c_adapter * i2c)1267*4882a593Smuzhiyun struct dvb_frontend* tda10045_attach(const struct tda1004x_config* config,
1268*4882a593Smuzhiyun struct i2c_adapter* i2c)
1269*4882a593Smuzhiyun {
1270*4882a593Smuzhiyun struct tda1004x_state *state;
1271*4882a593Smuzhiyun int id;
1272*4882a593Smuzhiyun
1273*4882a593Smuzhiyun /* allocate memory for the internal state */
1274*4882a593Smuzhiyun state = kzalloc(sizeof(struct tda1004x_state), GFP_KERNEL);
1275*4882a593Smuzhiyun if (!state) {
1276*4882a593Smuzhiyun printk(KERN_ERR "Can't allocate memory for tda10045 state\n");
1277*4882a593Smuzhiyun return NULL;
1278*4882a593Smuzhiyun }
1279*4882a593Smuzhiyun
1280*4882a593Smuzhiyun /* setup the state */
1281*4882a593Smuzhiyun state->config = config;
1282*4882a593Smuzhiyun state->i2c = i2c;
1283*4882a593Smuzhiyun state->demod_type = TDA1004X_DEMOD_TDA10045;
1284*4882a593Smuzhiyun
1285*4882a593Smuzhiyun /* check if the demod is there */
1286*4882a593Smuzhiyun id = tda1004x_read_byte(state, TDA1004X_CHIPID);
1287*4882a593Smuzhiyun if (id < 0) {
1288*4882a593Smuzhiyun printk(KERN_ERR "tda10045: chip is not answering. Giving up.\n");
1289*4882a593Smuzhiyun kfree(state);
1290*4882a593Smuzhiyun return NULL;
1291*4882a593Smuzhiyun }
1292*4882a593Smuzhiyun
1293*4882a593Smuzhiyun if (id != 0x25) {
1294*4882a593Smuzhiyun printk(KERN_ERR "Invalid tda1004x ID = 0x%02x. Can't proceed\n", id);
1295*4882a593Smuzhiyun kfree(state);
1296*4882a593Smuzhiyun return NULL;
1297*4882a593Smuzhiyun }
1298*4882a593Smuzhiyun
1299*4882a593Smuzhiyun /* create dvb_frontend */
1300*4882a593Smuzhiyun memcpy(&state->frontend.ops, &tda10045_ops, sizeof(struct dvb_frontend_ops));
1301*4882a593Smuzhiyun state->frontend.demodulator_priv = state;
1302*4882a593Smuzhiyun return &state->frontend;
1303*4882a593Smuzhiyun }
1304*4882a593Smuzhiyun
1305*4882a593Smuzhiyun static const struct dvb_frontend_ops tda10046_ops = {
1306*4882a593Smuzhiyun .delsys = { SYS_DVBT },
1307*4882a593Smuzhiyun .info = {
1308*4882a593Smuzhiyun .name = "Philips TDA10046H DVB-T",
1309*4882a593Smuzhiyun .frequency_min_hz = 51 * MHz,
1310*4882a593Smuzhiyun .frequency_max_hz = 858 * MHz,
1311*4882a593Smuzhiyun .frequency_stepsize_hz = 166667,
1312*4882a593Smuzhiyun .caps =
1313*4882a593Smuzhiyun FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
1314*4882a593Smuzhiyun FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
1315*4882a593Smuzhiyun FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
1316*4882a593Smuzhiyun FE_CAN_TRANSMISSION_MODE_AUTO | FE_CAN_GUARD_INTERVAL_AUTO
1317*4882a593Smuzhiyun },
1318*4882a593Smuzhiyun
1319*4882a593Smuzhiyun .release = tda1004x_release,
1320*4882a593Smuzhiyun
1321*4882a593Smuzhiyun .init = tda10046_init,
1322*4882a593Smuzhiyun .sleep = tda1004x_sleep,
1323*4882a593Smuzhiyun .write = tda1004x_write,
1324*4882a593Smuzhiyun .i2c_gate_ctrl = tda1004x_i2c_gate_ctrl,
1325*4882a593Smuzhiyun
1326*4882a593Smuzhiyun .set_frontend = tda1004x_set_fe,
1327*4882a593Smuzhiyun .get_frontend = tda1004x_get_fe,
1328*4882a593Smuzhiyun .get_tune_settings = tda1004x_get_tune_settings,
1329*4882a593Smuzhiyun
1330*4882a593Smuzhiyun .read_status = tda1004x_read_status,
1331*4882a593Smuzhiyun .read_ber = tda1004x_read_ber,
1332*4882a593Smuzhiyun .read_signal_strength = tda1004x_read_signal_strength,
1333*4882a593Smuzhiyun .read_snr = tda1004x_read_snr,
1334*4882a593Smuzhiyun .read_ucblocks = tda1004x_read_ucblocks,
1335*4882a593Smuzhiyun };
1336*4882a593Smuzhiyun
tda10046_attach(const struct tda1004x_config * config,struct i2c_adapter * i2c)1337*4882a593Smuzhiyun struct dvb_frontend* tda10046_attach(const struct tda1004x_config* config,
1338*4882a593Smuzhiyun struct i2c_adapter* i2c)
1339*4882a593Smuzhiyun {
1340*4882a593Smuzhiyun struct tda1004x_state *state;
1341*4882a593Smuzhiyun int id;
1342*4882a593Smuzhiyun
1343*4882a593Smuzhiyun /* allocate memory for the internal state */
1344*4882a593Smuzhiyun state = kzalloc(sizeof(struct tda1004x_state), GFP_KERNEL);
1345*4882a593Smuzhiyun if (!state) {
1346*4882a593Smuzhiyun printk(KERN_ERR "Can't allocate memory for tda10046 state\n");
1347*4882a593Smuzhiyun return NULL;
1348*4882a593Smuzhiyun }
1349*4882a593Smuzhiyun
1350*4882a593Smuzhiyun /* setup the state */
1351*4882a593Smuzhiyun state->config = config;
1352*4882a593Smuzhiyun state->i2c = i2c;
1353*4882a593Smuzhiyun state->demod_type = TDA1004X_DEMOD_TDA10046;
1354*4882a593Smuzhiyun
1355*4882a593Smuzhiyun /* check if the demod is there */
1356*4882a593Smuzhiyun id = tda1004x_read_byte(state, TDA1004X_CHIPID);
1357*4882a593Smuzhiyun if (id < 0) {
1358*4882a593Smuzhiyun printk(KERN_ERR "tda10046: chip is not answering. Giving up.\n");
1359*4882a593Smuzhiyun kfree(state);
1360*4882a593Smuzhiyun return NULL;
1361*4882a593Smuzhiyun }
1362*4882a593Smuzhiyun if (id != 0x46) {
1363*4882a593Smuzhiyun printk(KERN_ERR "Invalid tda1004x ID = 0x%02x. Can't proceed\n", id);
1364*4882a593Smuzhiyun kfree(state);
1365*4882a593Smuzhiyun return NULL;
1366*4882a593Smuzhiyun }
1367*4882a593Smuzhiyun
1368*4882a593Smuzhiyun /* create dvb_frontend */
1369*4882a593Smuzhiyun memcpy(&state->frontend.ops, &tda10046_ops, sizeof(struct dvb_frontend_ops));
1370*4882a593Smuzhiyun state->frontend.demodulator_priv = state;
1371*4882a593Smuzhiyun return &state->frontend;
1372*4882a593Smuzhiyun }
1373*4882a593Smuzhiyun
1374*4882a593Smuzhiyun module_param(debug, int, 0644);
1375*4882a593Smuzhiyun MODULE_PARM_DESC(debug, "Turn on/off frontend debugging (default:off).");
1376*4882a593Smuzhiyun
1377*4882a593Smuzhiyun MODULE_DESCRIPTION("Philips TDA10045H & TDA10046H DVB-T Demodulator");
1378*4882a593Smuzhiyun MODULE_AUTHOR("Andrew de Quincey & Robert Schlabbach");
1379*4882a593Smuzhiyun MODULE_LICENSE("GPL");
1380*4882a593Smuzhiyun
1381*4882a593Smuzhiyun EXPORT_SYMBOL(tda10045_attach);
1382*4882a593Smuzhiyun EXPORT_SYMBOL(tda10046_attach);
1383