Commit | Line | Data |
---|---|---|
3706a4da PB |
1 | /* DVB frontend part of the Linux driver for the TwinhanDTV StarBox USB2.0 |
2 | * DVB-S receiver. | |
3 | * | |
4 | * Copyright (C) 2005 Ralph Metzler <rjkm@metzlerbros.de> | |
5 | * Metzler Brothers Systementwicklung GbR | |
6 | * | |
7 | * Copyright (C) 2005 Patrick Boettcher <patrick.boettcher@desy.de> | |
8 | * | |
9 | * Thanks to Twinhan who kindly provided hardware and information. | |
10 | * | |
11 | * This file can be removed soon, after the DST-driver is rewritten to provice | |
12 | * the frontend-controlling separately. | |
13 | * | |
14 | * This program is free software; you can redistribute it and/or modify it | |
15 | * under the terms of the GNU General Public License as published by the Free | |
16 | * Software Foundation, version 2. | |
17 | * | |
18 | * see Documentation/dvb/README.dvb-usb for more information | |
19 | * | |
20 | */ | |
21 | #include "vp702x.h" | |
22 | ||
23 | struct vp702x_fe_state { | |
24 | struct dvb_frontend fe; | |
25 | struct dvb_usb_device *d; | |
26 | ||
0540c496 PB |
27 | struct dvb_frontend_ops ops; |
28 | ||
3706a4da PB |
29 | fe_sec_voltage_t voltage; |
30 | fe_sec_tone_mode_t tone_mode; | |
31 | ||
32 | u8 lnb_buf[8]; | |
33 | ||
34 | u8 lock; | |
35 | u8 sig; | |
36 | u8 snr; | |
37 | ||
38 | unsigned long next_status_check; | |
39 | unsigned long status_check_interval; | |
40 | }; | |
41 | ||
42 | static int vp702x_fe_refresh_state(struct vp702x_fe_state *st) | |
43 | { | |
60f81f12 | 44 | struct vp702x_device_state *dst = st->d->priv; |
57873c72 FM |
45 | u8 *buf; |
46 | ||
47 | if (time_after(jiffies, st->next_status_check)) { | |
60f81f12 FM |
48 | mutex_lock(&dst->buf_mutex); |
49 | buf = dst->buf; | |
50 | ||
57873c72 | 51 | vp702x_usb_in_op(st->d, READ_STATUS, 0, 0, buf, 10); |
3706a4da | 52 | st->lock = buf[4]; |
57873c72 FM |
53 | |
54 | vp702x_usb_in_op(st->d, READ_TUNER_REG_REQ, 0x11, 0, buf, 1); | |
55 | st->snr = buf[0]; | |
56 | ||
57 | vp702x_usb_in_op(st->d, READ_TUNER_REG_REQ, 0x15, 0, buf, 1); | |
58 | st->sig = buf[0]; | |
59 | ||
60f81f12 | 60 | mutex_unlock(&dst->buf_mutex); |
3706a4da PB |
61 | st->next_status_check = jiffies + (st->status_check_interval*HZ)/1000; |
62 | } | |
63 | return 0; | |
64 | } | |
65 | ||
66 | static u8 vp702x_chksum(u8 *buf,int f, int count) | |
67 | { | |
68 | u8 s = 0; | |
69 | int i; | |
70 | for (i = f; i < f+count; i++) | |
71 | s += buf[i]; | |
72 | return ~s+1; | |
73 | } | |
74 | ||
75 | static int vp702x_fe_read_status(struct dvb_frontend* fe, fe_status_t *status) | |
76 | { | |
77 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
78 | vp702x_fe_refresh_state(st); | |
708bebdd | 79 | deb_fe("%s\n",__func__); |
3706a4da PB |
80 | |
81 | if (st->lock == 0) | |
82 | *status = FE_HAS_LOCK | FE_HAS_SYNC | FE_HAS_VITERBI | FE_HAS_SIGNAL | FE_HAS_CARRIER; | |
83 | else | |
84 | *status = 0; | |
85 | ||
3706a4da PB |
86 | if (*status & FE_HAS_LOCK) |
87 | st->status_check_interval = 1000; | |
88 | else | |
89 | st->status_check_interval = 250; | |
90 | return 0; | |
91 | } | |
92 | ||
93 | /* not supported by this Frontend */ | |
94 | static int vp702x_fe_read_ber(struct dvb_frontend* fe, u32 *ber) | |
95 | { | |
96 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
97 | vp702x_fe_refresh_state(st); | |
98 | *ber = 0; | |
99 | return 0; | |
100 | } | |
101 | ||
102 | /* not supported by this Frontend */ | |
103 | static int vp702x_fe_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) | |
104 | { | |
105 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
106 | vp702x_fe_refresh_state(st); | |
107 | *unc = 0; | |
108 | return 0; | |
109 | } | |
110 | ||
111 | static int vp702x_fe_read_signal_strength(struct dvb_frontend* fe, u16 *strength) | |
112 | { | |
113 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
114 | vp702x_fe_refresh_state(st); | |
115 | ||
116 | *strength = (st->sig << 8) | st->sig; | |
117 | return 0; | |
118 | } | |
119 | ||
120 | static int vp702x_fe_read_snr(struct dvb_frontend* fe, u16 *snr) | |
121 | { | |
122 | u8 _snr; | |
123 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
124 | vp702x_fe_refresh_state(st); | |
125 | ||
126 | _snr = (st->snr & 0x1f) * 0xff / 0x1f; | |
127 | *snr = (_snr << 8) | _snr; | |
128 | return 0; | |
129 | } | |
130 | ||
131 | static int vp702x_fe_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings *tune) | |
132 | { | |
708bebdd | 133 | deb_fe("%s\n",__func__); |
3706a4da PB |
134 | tune->min_delay_ms = 2000; |
135 | return 0; | |
136 | } | |
137 | ||
138 | static int vp702x_fe_set_frontend(struct dvb_frontend* fe, | |
139 | struct dvb_frontend_parameters *fep) | |
140 | { | |
141 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
60f81f12 | 142 | struct vp702x_device_state *dst = st->d->priv; |
3706a4da PB |
143 | u32 freq = fep->frequency/1000; |
144 | /*CalFrequency*/ | |
145 | /* u16 frequencyRef[16] = { 2, 4, 8, 16, 32, 64, 128, 256, 24, 5, 10, 20, 40, 80, 160, 320 }; */ | |
146 | u64 sr; | |
57873c72 FM |
147 | u8 *cmd; |
148 | ||
60f81f12 FM |
149 | mutex_lock(&dst->buf_mutex); |
150 | ||
151 | cmd = dst->buf; | |
152 | memset(cmd, 0, 10); | |
3706a4da PB |
153 | |
154 | cmd[0] = (freq >> 8) & 0x7f; | |
155 | cmd[1] = freq & 0xff; | |
156 | cmd[2] = 1; /* divrate == 4 -> frequencyRef[1] -> 1 here */ | |
157 | ||
158 | sr = (u64) (fep->u.qpsk.symbol_rate/1000) << 20; | |
159 | do_div(sr,88000); | |
160 | cmd[3] = (sr >> 12) & 0xff; | |
161 | cmd[4] = (sr >> 4) & 0xff; | |
162 | cmd[5] = (sr << 4) & 0xf0; | |
163 | ||
4ae5c2e5 MCC |
164 | deb_fe("setting frontend to: %u -> %u (%x) LNB-based GHz, symbolrate: %d -> %lu (%lx)\n", |
165 | fep->frequency,freq,freq, fep->u.qpsk.symbol_rate, | |
166 | (unsigned long) sr, (unsigned long) sr); | |
3706a4da PB |
167 | |
168 | /* if (fep->inversion == INVERSION_ON) | |
169 | cmd[6] |= 0x80; */ | |
170 | ||
171 | if (st->voltage == SEC_VOLTAGE_18) | |
172 | cmd[6] |= 0x40; | |
173 | ||
174 | /* if (fep->u.qpsk.symbol_rate > 8000000) | |
175 | cmd[6] |= 0x20; | |
176 | ||
177 | if (fep->frequency < 1531000) | |
178 | cmd[6] |= 0x04; | |
179 | ||
180 | if (st->tone_mode == SEC_TONE_ON) | |
181 | cmd[6] |= 0x01;*/ | |
182 | ||
183 | cmd[7] = vp702x_chksum(cmd,0,7); | |
184 | ||
185 | st->status_check_interval = 250; | |
186 | st->next_status_check = jiffies; | |
187 | ||
57873c72 | 188 | vp702x_usb_inout_op(st->d, cmd, 8, cmd, 10, 100); |
3706a4da | 189 | |
57873c72 | 190 | if (cmd[2] == 0 && cmd[3] == 0) |
3706a4da PB |
191 | deb_fe("tuning failed.\n"); |
192 | else | |
193 | deb_fe("tuning succeeded.\n"); | |
194 | ||
60f81f12 FM |
195 | mutex_unlock(&dst->buf_mutex); |
196 | ||
3706a4da PB |
197 | return 0; |
198 | } | |
199 | ||
0540c496 PB |
200 | static int vp702x_fe_init(struct dvb_frontend *fe) |
201 | { | |
202 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
708bebdd | 203 | deb_fe("%s\n",__func__); |
0540c496 PB |
204 | vp702x_usb_in_op(st->d, RESET_TUNER, 0, 0, NULL, 0); |
205 | return 0; | |
206 | } | |
207 | ||
208 | static int vp702x_fe_sleep(struct dvb_frontend *fe) | |
209 | { | |
708bebdd | 210 | deb_fe("%s\n",__func__); |
0540c496 PB |
211 | return 0; |
212 | } | |
213 | ||
3706a4da PB |
214 | static int vp702x_fe_get_frontend(struct dvb_frontend* fe, |
215 | struct dvb_frontend_parameters *fep) | |
216 | { | |
708bebdd | 217 | deb_fe("%s\n",__func__); |
3706a4da PB |
218 | return 0; |
219 | } | |
220 | ||
221 | static int vp702x_fe_send_diseqc_msg (struct dvb_frontend* fe, | |
50c25fff | 222 | struct dvb_diseqc_master_cmd *m) |
3706a4da | 223 | { |
57873c72 | 224 | u8 *cmd; |
5ad5e484 | 225 | struct vp702x_fe_state *st = fe->demodulator_priv; |
60f81f12 | 226 | struct vp702x_device_state *dst = st->d->priv; |
3706a4da | 227 | |
708bebdd | 228 | deb_fe("%s\n",__func__); |
3706a4da | 229 | |
60f81f12 FM |
230 | if (m->msg_len > 4) |
231 | return -EINVAL; | |
232 | ||
233 | mutex_lock(&dst->buf_mutex); | |
3706a4da | 234 | |
60f81f12 | 235 | cmd = dst->buf; |
3706a4da PB |
236 | cmd[1] = SET_DISEQC_CMD; |
237 | cmd[2] = m->msg_len; | |
238 | memcpy(&cmd[3], m->msg, m->msg_len); | |
57873c72 | 239 | cmd[7] = vp702x_chksum(cmd, 0, 7); |
3706a4da | 240 | |
57873c72 | 241 | vp702x_usb_inout_op(st->d, cmd, 8, cmd, 10, 100); |
3706a4da | 242 | |
57873c72 | 243 | if (cmd[2] == 0 && cmd[3] == 0) |
5ad5e484 PE |
244 | deb_fe("diseqc cmd failed.\n"); |
245 | else | |
246 | deb_fe("diseqc cmd succeeded.\n"); | |
60f81f12 FM |
247 | |
248 | mutex_unlock(&dst->buf_mutex); | |
249 | ||
250 | return 0; | |
3706a4da PB |
251 | } |
252 | ||
253 | static int vp702x_fe_send_diseqc_burst (struct dvb_frontend* fe, fe_sec_mini_cmd_t burst) | |
254 | { | |
708bebdd | 255 | deb_fe("%s\n",__func__); |
3706a4da PB |
256 | return 0; |
257 | } | |
258 | ||
259 | static int vp702x_fe_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) | |
260 | { | |
261 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
60f81f12 | 262 | struct vp702x_device_state *dst = st->d->priv; |
57873c72 FM |
263 | u8 *buf; |
264 | ||
708bebdd | 265 | deb_fe("%s\n",__func__); |
3706a4da PB |
266 | |
267 | st->tone_mode = tone; | |
268 | ||
269 | if (tone == SEC_TONE_ON) | |
270 | st->lnb_buf[2] = 0x02; | |
271 | else | |
272 | st->lnb_buf[2] = 0x00; | |
273 | ||
57873c72 | 274 | st->lnb_buf[7] = vp702x_chksum(st->lnb_buf, 0, 7); |
60f81f12 FM |
275 | |
276 | mutex_lock(&dst->buf_mutex); | |
277 | ||
278 | buf = dst->buf; | |
57873c72 | 279 | memcpy(buf, st->lnb_buf, 8); |
3706a4da | 280 | |
57873c72 FM |
281 | vp702x_usb_inout_op(st->d, buf, 8, buf, 10, 100); |
282 | if (buf[2] == 0 && buf[3] == 0) | |
3706a4da PB |
283 | deb_fe("set_tone cmd failed.\n"); |
284 | else | |
285 | deb_fe("set_tone cmd succeeded.\n"); | |
286 | ||
60f81f12 FM |
287 | mutex_unlock(&dst->buf_mutex); |
288 | ||
3706a4da PB |
289 | return 0; |
290 | } | |
291 | ||
292 | static int vp702x_fe_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t | |
293 | voltage) | |
294 | { | |
295 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
60f81f12 | 296 | struct vp702x_device_state *dst = st->d->priv; |
57873c72 | 297 | u8 *buf; |
708bebdd | 298 | deb_fe("%s\n",__func__); |
3706a4da PB |
299 | |
300 | st->voltage = voltage; | |
301 | ||
302 | if (voltage != SEC_VOLTAGE_OFF) | |
303 | st->lnb_buf[4] = 0x01; | |
304 | else | |
305 | st->lnb_buf[4] = 0x00; | |
306 | ||
57873c72 | 307 | st->lnb_buf[7] = vp702x_chksum(st->lnb_buf, 0, 7); |
60f81f12 FM |
308 | |
309 | mutex_lock(&dst->buf_mutex); | |
310 | ||
311 | buf = dst->buf; | |
57873c72 | 312 | memcpy(buf, st->lnb_buf, 8); |
3706a4da | 313 | |
57873c72 FM |
314 | vp702x_usb_inout_op(st->d, buf, 8, buf, 10, 100); |
315 | if (buf[2] == 0 && buf[3] == 0) | |
3706a4da PB |
316 | deb_fe("set_voltage cmd failed.\n"); |
317 | else | |
318 | deb_fe("set_voltage cmd succeeded.\n"); | |
319 | ||
60f81f12 | 320 | mutex_unlock(&dst->buf_mutex); |
3706a4da PB |
321 | return 0; |
322 | } | |
323 | ||
324 | static void vp702x_fe_release(struct dvb_frontend* fe) | |
325 | { | |
326 | struct vp702x_fe_state *st = fe->demodulator_priv; | |
327 | kfree(st); | |
328 | } | |
329 | ||
330 | static struct dvb_frontend_ops vp702x_fe_ops; | |
331 | ||
332 | struct dvb_frontend * vp702x_fe_attach(struct dvb_usb_device *d) | |
333 | { | |
7408187d | 334 | struct vp702x_fe_state *s = kzalloc(sizeof(struct vp702x_fe_state), GFP_KERNEL); |
3706a4da PB |
335 | if (s == NULL) |
336 | goto error; | |
3706a4da PB |
337 | |
338 | s->d = d; | |
dea74869 PB |
339 | |
340 | memcpy(&s->fe.ops,&vp702x_fe_ops,sizeof(struct dvb_frontend_ops)); | |
3706a4da PB |
341 | s->fe.demodulator_priv = s; |
342 | ||
343 | s->lnb_buf[1] = SET_LNB_POWER; | |
344 | s->lnb_buf[3] = 0xff; /* 0=tone burst, 2=data burst, ff=off */ | |
345 | ||
8397703e | 346 | return &s->fe; |
3706a4da PB |
347 | error: |
348 | return NULL; | |
3706a4da PB |
349 | } |
350 | ||
351 | ||
352 | static struct dvb_frontend_ops vp702x_fe_ops = { | |
353 | .info = { | |
354 | .name = "Twinhan DST-like frontend (VP7021/VP7020) DVB-S", | |
355 | .type = FE_QPSK, | |
356 | .frequency_min = 950000, | |
357 | .frequency_max = 2150000, | |
358 | .frequency_stepsize = 1000, /* kHz for QPSK frontends */ | |
359 | .frequency_tolerance = 0, | |
360 | .symbol_rate_min = 1000000, | |
361 | .symbol_rate_max = 45000000, | |
362 | .symbol_rate_tolerance = 500, /* ppm */ | |
363 | .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | | |
364 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | | |
365 | FE_CAN_QPSK | | |
366 | FE_CAN_FEC_AUTO | |
367 | }, | |
368 | .release = vp702x_fe_release, | |
369 | ||
0540c496 PB |
370 | .init = vp702x_fe_init, |
371 | .sleep = vp702x_fe_sleep, | |
3706a4da PB |
372 | |
373 | .set_frontend = vp702x_fe_set_frontend, | |
374 | .get_frontend = vp702x_fe_get_frontend, | |
375 | .get_tune_settings = vp702x_fe_get_tune_settings, | |
376 | ||
377 | .read_status = vp702x_fe_read_status, | |
378 | .read_ber = vp702x_fe_read_ber, | |
379 | .read_signal_strength = vp702x_fe_read_signal_strength, | |
380 | .read_snr = vp702x_fe_read_snr, | |
381 | .read_ucblocks = vp702x_fe_read_unc_blocks, | |
382 | ||
383 | .diseqc_send_master_cmd = vp702x_fe_send_diseqc_msg, | |
384 | .diseqc_send_burst = vp702x_fe_send_diseqc_burst, | |
385 | .set_tone = vp702x_fe_set_tone, | |
386 | .set_voltage = vp702x_fe_set_voltage, | |
387 | }; |