diff options
Diffstat (limited to 'drivers/media/dvb/dvb-usb/cinergyT2-fe.c')
-rw-r--r-- | drivers/media/dvb/dvb-usb/cinergyT2-fe.c | 351 |
1 files changed, 351 insertions, 0 deletions
diff --git a/drivers/media/dvb/dvb-usb/cinergyT2-fe.c b/drivers/media/dvb/dvb-usb/cinergyT2-fe.c new file mode 100644 index 000000000000..649f25cca49e --- /dev/null +++ b/drivers/media/dvb/dvb-usb/cinergyT2-fe.c | |||
@@ -0,0 +1,351 @@ | |||
1 | /* | ||
2 | * TerraTec Cinergy T2/qanu USB2 DVB-T adapter. | ||
3 | * | ||
4 | * Copyright (C) 2007 Tomi Orava (tomimo@ncircle.nullnet.fi) | ||
5 | * | ||
6 | * Based on the dvb-usb-framework code and the | ||
7 | * original Terratec Cinergy T2 driver by: | ||
8 | * | ||
9 | * Copyright (C) 2004 Daniel Mack <daniel@qanu.de> and | ||
10 | * Holger Waechtler <holger@qanu.de> | ||
11 | * | ||
12 | * Protocol Spec published on http://qanu.de/specs/terratec_cinergyT2.pdf | ||
13 | * | ||
14 | * This program is free software; you can redistribute it and/or modify | ||
15 | * it under the terms of the GNU General Public License as published by | ||
16 | * the Free Software Foundation; either version 2 of the License, or | ||
17 | * (at your option) any later version. | ||
18 | * | ||
19 | * This program is distributed in the hope that it will be useful, | ||
20 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | ||
21 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | ||
22 | * GNU General Public License for more details. | ||
23 | * | ||
24 | * You should have received a copy of the GNU General Public License | ||
25 | * along with this program; if not, write to the Free Software | ||
26 | * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. | ||
27 | * | ||
28 | */ | ||
29 | |||
30 | #include "cinergyT2.h" | ||
31 | |||
32 | |||
33 | /** | ||
34 | * convert linux-dvb frontend parameter set into TPS. | ||
35 | * See ETSI ETS-300744, section 4.6.2, table 9 for details. | ||
36 | * | ||
37 | * This function is probably reusable and may better get placed in a support | ||
38 | * library. | ||
39 | * | ||
40 | * We replace errornous fields by default TPS fields (the ones with value 0). | ||
41 | */ | ||
42 | |||
43 | static uint16_t compute_tps(struct dvb_frontend_parameters *p) | ||
44 | { | ||
45 | struct dvb_ofdm_parameters *op = &p->u.ofdm; | ||
46 | uint16_t tps = 0; | ||
47 | |||
48 | switch (op->code_rate_HP) { | ||
49 | case FEC_2_3: | ||
50 | tps |= (1 << 7); | ||
51 | break; | ||
52 | case FEC_3_4: | ||
53 | tps |= (2 << 7); | ||
54 | break; | ||
55 | case FEC_5_6: | ||
56 | tps |= (3 << 7); | ||
57 | break; | ||
58 | case FEC_7_8: | ||
59 | tps |= (4 << 7); | ||
60 | break; | ||
61 | case FEC_1_2: | ||
62 | case FEC_AUTO: | ||
63 | default: | ||
64 | /* tps |= (0 << 7) */; | ||
65 | } | ||
66 | |||
67 | switch (op->code_rate_LP) { | ||
68 | case FEC_2_3: | ||
69 | tps |= (1 << 4); | ||
70 | break; | ||
71 | case FEC_3_4: | ||
72 | tps |= (2 << 4); | ||
73 | break; | ||
74 | case FEC_5_6: | ||
75 | tps |= (3 << 4); | ||
76 | break; | ||
77 | case FEC_7_8: | ||
78 | tps |= (4 << 4); | ||
79 | break; | ||
80 | case FEC_1_2: | ||
81 | case FEC_AUTO: | ||
82 | default: | ||
83 | /* tps |= (0 << 4) */; | ||
84 | } | ||
85 | |||
86 | switch (op->constellation) { | ||
87 | case QAM_16: | ||
88 | tps |= (1 << 13); | ||
89 | break; | ||
90 | case QAM_64: | ||
91 | tps |= (2 << 13); | ||
92 | break; | ||
93 | case QPSK: | ||
94 | default: | ||
95 | /* tps |= (0 << 13) */; | ||
96 | } | ||
97 | |||
98 | switch (op->transmission_mode) { | ||
99 | case TRANSMISSION_MODE_8K: | ||
100 | tps |= (1 << 0); | ||
101 | break; | ||
102 | case TRANSMISSION_MODE_2K: | ||
103 | default: | ||
104 | /* tps |= (0 << 0) */; | ||
105 | } | ||
106 | |||
107 | switch (op->guard_interval) { | ||
108 | case GUARD_INTERVAL_1_16: | ||
109 | tps |= (1 << 2); | ||
110 | break; | ||
111 | case GUARD_INTERVAL_1_8: | ||
112 | tps |= (2 << 2); | ||
113 | break; | ||
114 | case GUARD_INTERVAL_1_4: | ||
115 | tps |= (3 << 2); | ||
116 | break; | ||
117 | case GUARD_INTERVAL_1_32: | ||
118 | default: | ||
119 | /* tps |= (0 << 2) */; | ||
120 | } | ||
121 | |||
122 | switch (op->hierarchy_information) { | ||
123 | case HIERARCHY_1: | ||
124 | tps |= (1 << 10); | ||
125 | break; | ||
126 | case HIERARCHY_2: | ||
127 | tps |= (2 << 10); | ||
128 | break; | ||
129 | case HIERARCHY_4: | ||
130 | tps |= (3 << 10); | ||
131 | break; | ||
132 | case HIERARCHY_NONE: | ||
133 | default: | ||
134 | /* tps |= (0 << 10) */; | ||
135 | } | ||
136 | |||
137 | return tps; | ||
138 | } | ||
139 | |||
140 | struct cinergyt2_fe_state { | ||
141 | struct dvb_frontend fe; | ||
142 | struct dvb_usb_device *d; | ||
143 | }; | ||
144 | |||
145 | static int cinergyt2_fe_read_status(struct dvb_frontend *fe, | ||
146 | fe_status_t *status) | ||
147 | { | ||
148 | struct cinergyt2_fe_state *state = fe->demodulator_priv; | ||
149 | struct dvbt_get_status_msg result; | ||
150 | u8 cmd[] = { CINERGYT2_EP1_GET_TUNER_STATUS }; | ||
151 | int ret; | ||
152 | |||
153 | ret = dvb_usb_generic_rw(state->d, cmd, sizeof(cmd), (u8 *)&result, | ||
154 | sizeof(result), 0); | ||
155 | if (ret < 0) | ||
156 | return ret; | ||
157 | |||
158 | *status = 0; | ||
159 | |||
160 | if (0xffff - le16_to_cpu(result.gain) > 30) | ||
161 | *status |= FE_HAS_SIGNAL; | ||
162 | if (result.lock_bits & (1 << 6)) | ||
163 | *status |= FE_HAS_LOCK; | ||
164 | if (result.lock_bits & (1 << 5)) | ||
165 | *status |= FE_HAS_SYNC; | ||
166 | if (result.lock_bits & (1 << 4)) | ||
167 | *status |= FE_HAS_CARRIER; | ||
168 | if (result.lock_bits & (1 << 1)) | ||
169 | *status |= FE_HAS_VITERBI; | ||
170 | |||
171 | if ((*status & (FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC)) != | ||
172 | (FE_HAS_CARRIER | FE_HAS_VITERBI | FE_HAS_SYNC)) | ||
173 | *status &= ~FE_HAS_LOCK; | ||
174 | |||
175 | return 0; | ||
176 | } | ||
177 | |||
178 | static int cinergyt2_fe_read_ber(struct dvb_frontend *fe, u32 *ber) | ||
179 | { | ||
180 | struct cinergyt2_fe_state *state = fe->demodulator_priv; | ||
181 | struct dvbt_get_status_msg status; | ||
182 | char cmd[] = { CINERGYT2_EP1_GET_TUNER_STATUS }; | ||
183 | int ret; | ||
184 | |||
185 | ret = dvb_usb_generic_rw(state->d, cmd, sizeof(cmd), (char *)&status, | ||
186 | sizeof(status), 0); | ||
187 | if (ret < 0) | ||
188 | return ret; | ||
189 | |||
190 | *ber = le32_to_cpu(status.viterbi_error_rate); | ||
191 | return 0; | ||
192 | } | ||
193 | |||
194 | static int cinergyt2_fe_read_unc_blocks(struct dvb_frontend *fe, u32 *unc) | ||
195 | { | ||
196 | struct cinergyt2_fe_state *state = fe->demodulator_priv; | ||
197 | struct dvbt_get_status_msg status; | ||
198 | u8 cmd[] = { CINERGYT2_EP1_GET_TUNER_STATUS }; | ||
199 | int ret; | ||
200 | |||
201 | ret = dvb_usb_generic_rw(state->d, cmd, sizeof(cmd), (u8 *)&status, | ||
202 | sizeof(status), 0); | ||
203 | if (ret < 0) { | ||
204 | err("cinergyt2_fe_read_unc_blocks() Failed! (Error=%d)\n", | ||
205 | ret); | ||
206 | return ret; | ||
207 | } | ||
208 | *unc = le32_to_cpu(status.uncorrected_block_count); | ||
209 | return 0; | ||
210 | } | ||
211 | |||
212 | static int cinergyt2_fe_read_signal_strength(struct dvb_frontend *fe, | ||
213 | u16 *strength) | ||
214 | { | ||
215 | struct cinergyt2_fe_state *state = fe->demodulator_priv; | ||
216 | struct dvbt_get_status_msg status; | ||
217 | char cmd[] = { CINERGYT2_EP1_GET_TUNER_STATUS }; | ||
218 | int ret; | ||
219 | |||
220 | ret = dvb_usb_generic_rw(state->d, cmd, sizeof(cmd), (char *)&status, | ||
221 | sizeof(status), 0); | ||
222 | if (ret < 0) { | ||
223 | err("cinergyt2_fe_read_signal_strength() Failed!" | ||
224 | " (Error=%d)\n", ret); | ||
225 | return ret; | ||
226 | } | ||
227 | *strength = (0xffff - le16_to_cpu(status.gain)); | ||
228 | return 0; | ||
229 | } | ||
230 | |||
231 | static int cinergyt2_fe_read_snr(struct dvb_frontend *fe, u16 *snr) | ||
232 | { | ||
233 | struct cinergyt2_fe_state *state = fe->demodulator_priv; | ||
234 | struct dvbt_get_status_msg status; | ||
235 | char cmd[] = { CINERGYT2_EP1_GET_TUNER_STATUS }; | ||
236 | int ret; | ||
237 | |||
238 | ret = dvb_usb_generic_rw(state->d, cmd, sizeof(cmd), (char *)&status, | ||
239 | sizeof(status), 0); | ||
240 | if (ret < 0) { | ||
241 | err("cinergyt2_fe_read_snr() Failed! (Error=%d)\n", ret); | ||
242 | return ret; | ||
243 | } | ||
244 | *snr = (status.snr << 8) | status.snr; | ||
245 | return 0; | ||
246 | } | ||
247 | |||
248 | static int cinergyt2_fe_init(struct dvb_frontend *fe) | ||
249 | { | ||
250 | return 0; | ||
251 | } | ||
252 | |||
253 | static int cinergyt2_fe_sleep(struct dvb_frontend *fe) | ||
254 | { | ||
255 | deb_info("cinergyt2_fe_sleep() Called\n"); | ||
256 | return 0; | ||
257 | } | ||
258 | |||
259 | static int cinergyt2_fe_get_tune_settings(struct dvb_frontend *fe, | ||
260 | struct dvb_frontend_tune_settings *tune) | ||
261 | { | ||
262 | tune->min_delay_ms = 800; | ||
263 | return 0; | ||
264 | } | ||
265 | |||
266 | static int cinergyt2_fe_set_frontend(struct dvb_frontend *fe, | ||
267 | struct dvb_frontend_parameters *fep) | ||
268 | { | ||
269 | struct cinergyt2_fe_state *state = fe->demodulator_priv; | ||
270 | struct dvbt_set_parameters_msg param; | ||
271 | char result[2]; | ||
272 | int err; | ||
273 | |||
274 | param.cmd = CINERGYT2_EP1_SET_TUNER_PARAMETERS; | ||
275 | param.tps = cpu_to_le16(compute_tps(fep)); | ||
276 | param.freq = cpu_to_le32(fep->frequency / 1000); | ||
277 | param.bandwidth = 8 - fep->u.ofdm.bandwidth - BANDWIDTH_8_MHZ; | ||
278 | |||
279 | err = dvb_usb_generic_rw(state->d, | ||
280 | (char *)¶m, sizeof(param), | ||
281 | result, sizeof(result), 0); | ||
282 | if (err < 0) | ||
283 | err("cinergyt2_fe_set_frontend() Failed! err=%d\n", err); | ||
284 | |||
285 | return (err < 0) ? err : 0; | ||
286 | } | ||
287 | |||
288 | static int cinergyt2_fe_get_frontend(struct dvb_frontend *fe, | ||
289 | struct dvb_frontend_parameters *fep) | ||
290 | { | ||
291 | return 0; | ||
292 | } | ||
293 | |||
294 | static void cinergyt2_fe_release(struct dvb_frontend *fe) | ||
295 | { | ||
296 | struct cinergyt2_fe_state *state = fe->demodulator_priv; | ||
297 | if (state != NULL) | ||
298 | kfree(state); | ||
299 | } | ||
300 | |||
301 | static struct dvb_frontend_ops cinergyt2_fe_ops; | ||
302 | |||
303 | struct dvb_frontend *cinergyt2_fe_attach(struct dvb_usb_device *d) | ||
304 | { | ||
305 | struct cinergyt2_fe_state *s = kzalloc(sizeof( | ||
306 | struct cinergyt2_fe_state), GFP_KERNEL); | ||
307 | if (s == NULL) | ||
308 | return NULL; | ||
309 | |||
310 | s->d = d; | ||
311 | memcpy(&s->fe.ops, &cinergyt2_fe_ops, sizeof(struct dvb_frontend_ops)); | ||
312 | s->fe.demodulator_priv = s; | ||
313 | return &s->fe; | ||
314 | } | ||
315 | |||
316 | |||
317 | static struct dvb_frontend_ops cinergyt2_fe_ops = { | ||
318 | .info = { | ||
319 | .name = DRIVER_NAME, | ||
320 | .type = FE_OFDM, | ||
321 | .frequency_min = 174000000, | ||
322 | .frequency_max = 862000000, | ||
323 | .frequency_stepsize = 166667, | ||
324 | .caps = FE_CAN_INVERSION_AUTO | FE_CAN_FEC_1_2 | ||
325 | | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | ||
326 | | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | ||
327 | | FE_CAN_FEC_AUTO | FE_CAN_QPSK | ||
328 | | FE_CAN_QAM_16 | FE_CAN_QAM_64 | ||
329 | | FE_CAN_QAM_AUTO | ||
330 | | FE_CAN_TRANSMISSION_MODE_AUTO | ||
331 | | FE_CAN_GUARD_INTERVAL_AUTO | ||
332 | | FE_CAN_HIERARCHY_AUTO | ||
333 | | FE_CAN_RECOVER | ||
334 | | FE_CAN_MUTE_TS | ||
335 | }, | ||
336 | |||
337 | .release = cinergyt2_fe_release, | ||
338 | |||
339 | .init = cinergyt2_fe_init, | ||
340 | .sleep = cinergyt2_fe_sleep, | ||
341 | |||
342 | .set_frontend = cinergyt2_fe_set_frontend, | ||
343 | .get_frontend = cinergyt2_fe_get_frontend, | ||
344 | .get_tune_settings = cinergyt2_fe_get_tune_settings, | ||
345 | |||
346 | .read_status = cinergyt2_fe_read_status, | ||
347 | .read_ber = cinergyt2_fe_read_ber, | ||
348 | .read_signal_strength = cinergyt2_fe_read_signal_strength, | ||
349 | .read_snr = cinergyt2_fe_read_snr, | ||
350 | .read_ucblocks = cinergyt2_fe_read_unc_blocks, | ||
351 | }; | ||