1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include "vp7045.h"
16
17
18
19
20
21
22
23
24struct vp7045_fe_state {
25 struct dvb_frontend fe;
26 struct dvb_usb_device *d;
27};
28
29static int vp7045_fe_read_status(struct dvb_frontend *fe,
30 enum fe_status *status)
31{
32 struct vp7045_fe_state *state = fe->demodulator_priv;
33 u8 s0 = vp7045_read_reg(state->d,0x00),
34 s1 = vp7045_read_reg(state->d,0x01),
35 s3 = vp7045_read_reg(state->d,0x03);
36
37 *status = 0;
38 if (s0 & (1 << 4))
39 *status |= FE_HAS_CARRIER;
40 if (s0 & (1 << 1))
41 *status |= FE_HAS_VITERBI;
42 if (s0 & (1 << 5))
43 *status |= FE_HAS_LOCK;
44 if (s1 & (1 << 1))
45 *status |= FE_HAS_SYNC;
46 if (s3 & (1 << 6))
47 *status |= FE_HAS_SIGNAL;
48
49 if ((*status & (FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC)) !=
50 (FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC))
51 *status &= ~FE_HAS_LOCK;
52
53 return 0;
54}
55
56static int vp7045_fe_read_ber(struct dvb_frontend* fe, u32 *ber)
57{
58 struct vp7045_fe_state *state = fe->demodulator_priv;
59 *ber = (vp7045_read_reg(state->d, 0x0D) << 16) |
60 (vp7045_read_reg(state->d, 0x0E) << 8) |
61 vp7045_read_reg(state->d, 0x0F);
62 return 0;
63}
64
65static int vp7045_fe_read_unc_blocks(struct dvb_frontend* fe, u32 *unc)
66{
67 struct vp7045_fe_state *state = fe->demodulator_priv;
68 *unc = (vp7045_read_reg(state->d, 0x10) << 8) |
69 vp7045_read_reg(state->d, 0x11);
70 return 0;
71}
72
73static int vp7045_fe_read_signal_strength(struct dvb_frontend* fe, u16 *strength)
74{
75 struct vp7045_fe_state *state = fe->demodulator_priv;
76 u16 signal = (vp7045_read_reg(state->d, 0x14) << 8) |
77 vp7045_read_reg(state->d, 0x15);
78
79 *strength = ~signal;
80 return 0;
81}
82
83static int vp7045_fe_read_snr(struct dvb_frontend* fe, u16 *snr)
84{
85 struct vp7045_fe_state *state = fe->demodulator_priv;
86 u8 _snr = vp7045_read_reg(state->d, 0x09);
87 *snr = (_snr << 8) | _snr;
88 return 0;
89}
90
91static int vp7045_fe_init(struct dvb_frontend* fe)
92{
93 return 0;
94}
95
96static int vp7045_fe_sleep(struct dvb_frontend* fe)
97{
98 return 0;
99}
100
101static int vp7045_fe_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings *tune)
102{
103 tune->min_delay_ms = 800;
104 return 0;
105}
106
107static int vp7045_fe_set_frontend(struct dvb_frontend *fe)
108{
109 struct dtv_frontend_properties *fep = &fe->dtv_property_cache;
110 struct vp7045_fe_state *state = fe->demodulator_priv;
111 u8 buf[5];
112 u32 freq = fep->frequency / 1000;
113
114 buf[0] = (freq >> 16) & 0xff;
115 buf[1] = (freq >> 8) & 0xff;
116 buf[2] = freq & 0xff;
117 buf[3] = 0;
118
119 switch (fep->bandwidth_hz) {
120 case 8000000:
121 buf[4] = 8;
122 break;
123 case 7000000:
124 buf[4] = 7;
125 break;
126 case 6000000:
127 buf[4] = 6;
128 break;
129 default:
130 return -EINVAL;
131 }
132
133 vp7045_usb_op(state->d,LOCK_TUNER_COMMAND,buf,5,NULL,0,200);
134 return 0;
135}
136
137static void vp7045_fe_release(struct dvb_frontend* fe)
138{
139 struct vp7045_fe_state *state = fe->demodulator_priv;
140 kfree(state);
141}
142
143static const struct dvb_frontend_ops vp7045_fe_ops;
144
145struct dvb_frontend * vp7045_fe_attach(struct dvb_usb_device *d)
146{
147 struct vp7045_fe_state *s = kzalloc(sizeof(struct vp7045_fe_state), GFP_KERNEL);
148 if (s == NULL)
149 goto error;
150
151 s->d = d;
152 memcpy(&s->fe.ops, &vp7045_fe_ops, sizeof(struct dvb_frontend_ops));
153 s->fe.demodulator_priv = s;
154
155 return &s->fe;
156error:
157 return NULL;
158}
159
160
161static const struct dvb_frontend_ops vp7045_fe_ops = {
162 .delsys = { SYS_DVBT },
163 .info = {
164 .name = "Twinhan VP7045/46 USB DVB-T",
165 .frequency_min = 44250000,
166 .frequency_max = 867250000,
167 .frequency_stepsize = 1000,
168 .caps = FE_CAN_INVERSION_AUTO |
169 FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 |
170 FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO |
171 FE_CAN_QPSK | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_AUTO |
172 FE_CAN_TRANSMISSION_MODE_AUTO |
173 FE_CAN_GUARD_INTERVAL_AUTO |
174 FE_CAN_RECOVER |
175 FE_CAN_HIERARCHY_AUTO,
176 },
177
178 .release = vp7045_fe_release,
179
180 .init = vp7045_fe_init,
181 .sleep = vp7045_fe_sleep,
182
183 .set_frontend = vp7045_fe_set_frontend,
184 .get_tune_settings = vp7045_fe_get_tune_settings,
185
186 .read_status = vp7045_fe_read_status,
187 .read_ber = vp7045_fe_read_ber,
188 .read_signal_strength = vp7045_fe_read_signal_strength,
189 .read_snr = vp7045_fe_read_snr,
190 .read_ucblocks = vp7045_fe_read_unc_blocks,
191};
192
