1 /* DVB frontend part of the Linux driver for the TwinhanDTV StarBox USB2.0
4 * Copyright (C) 2005 Ralph Metzler <rjkm@metzlerbros.de>
5 * Metzler Brothers Systementwicklung GbR
7 * Copyright (C) 2005 Patrick Boettcher <patrick.boettcher@desy.de>
9 * Thanks to Twinhan who kindly provided hardware and information.
11 * This file can be removed soon, after the DST-driver is rewritten to provice
12 * the frontend-controlling separately.
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.
18 * see Documentation/dvb/README.dvb-usb for more information
23 struct vp702x_fe_state
{
24 struct dvb_frontend fe
;
25 struct dvb_usb_device
*d
;
27 fe_sec_voltage_t voltage
;
28 fe_sec_tone_mode_t tone_mode
;
36 unsigned long next_status_check
;
37 unsigned long status_check_interval
;
40 static int vp702x_fe_refresh_state(struct vp702x_fe_state
*st
)
43 if (time_after(jiffies
,st
->next_status_check
)) {
44 vp702x_usb_in_op(st
->d
,READ_STATUS
,0,0,buf
,10);
47 vp702x_usb_in_op(st
->d
,READ_TUNER_REG_REQ
,0x11,0,&st
->snr
,1);
48 vp702x_usb_in_op(st
->d
,READ_TUNER_REG_REQ
,0x15,0,&st
->sig
,1);
50 st
->next_status_check
= jiffies
+ (st
->status_check_interval
*HZ
)/1000;
55 static u8
vp702x_chksum(u8
*buf
,int f
, int count
)
59 for (i
= f
; i
< f
+count
; i
++)
64 static int vp702x_fe_read_status(struct dvb_frontend
* fe
, fe_status_t
*status
)
66 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
67 vp702x_fe_refresh_state(st
);
68 deb_fe("%s\n",__FUNCTION__
);
71 *status
= FE_HAS_LOCK
| FE_HAS_SYNC
| FE_HAS_VITERBI
| FE_HAS_SIGNAL
| FE_HAS_CARRIER
;
75 deb_fe("real state: %x\n",*status
);
78 if (*status
& FE_HAS_LOCK
)
79 st
->status_check_interval
= 1000;
81 st
->status_check_interval
= 250;
85 /* not supported by this Frontend */
86 static int vp702x_fe_read_ber(struct dvb_frontend
* fe
, u32
*ber
)
88 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
89 vp702x_fe_refresh_state(st
);
94 /* not supported by this Frontend */
95 static int vp702x_fe_read_unc_blocks(struct dvb_frontend
* fe
, u32
*unc
)
97 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
98 vp702x_fe_refresh_state(st
);
103 static int vp702x_fe_read_signal_strength(struct dvb_frontend
* fe
, u16
*strength
)
105 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
106 vp702x_fe_refresh_state(st
);
108 *strength
= (st
->sig
<< 8) | st
->sig
;
112 static int vp702x_fe_read_snr(struct dvb_frontend
* fe
, u16
*snr
)
115 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
116 vp702x_fe_refresh_state(st
);
118 _snr
= (st
->snr
& 0x1f) * 0xff / 0x1f;
119 *snr
= (_snr
<< 8) | _snr
;
123 static int vp702x_fe_get_tune_settings(struct dvb_frontend
* fe
, struct dvb_frontend_tune_settings
*tune
)
125 deb_fe("%s\n",__FUNCTION__
);
126 tune
->min_delay_ms
= 2000;
130 static int vp702x_fe_set_frontend(struct dvb_frontend
* fe
,
131 struct dvb_frontend_parameters
*fep
)
133 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
134 u32 freq
= fep
->frequency
/1000;
136 /* u16 frequencyRef[16] = { 2, 4, 8, 16, 32, 64, 128, 256, 24, 5, 10, 20, 40, 80, 160, 320 }; */
138 u8 cmd
[8] = { 0 },ibuf
[10];
140 cmd
[0] = (freq
>> 8) & 0x7f;
141 cmd
[1] = freq
& 0xff;
142 cmd
[2] = 1; /* divrate == 4 -> frequencyRef[1] -> 1 here */
144 sr
= (u64
) (fep
->u
.qpsk
.symbol_rate
/1000) << 20;
146 cmd
[3] = (sr
>> 12) & 0xff;
147 cmd
[4] = (sr
>> 4) & 0xff;
148 cmd
[5] = (sr
<< 4) & 0xf0;
150 deb_fe("setting frontend to: %u -> %u (%x) LNB-based GHz, symbolrate: %d -> %lu (%lx)\n",
151 fep
->frequency
,freq
,freq
, fep
->u
.qpsk
.symbol_rate
,
152 (unsigned long) sr
, (unsigned long) sr
);
154 /* if (fep->inversion == INVERSION_ON)
157 if (st
->voltage
== SEC_VOLTAGE_18
)
160 /* if (fep->u.qpsk.symbol_rate > 8000000)
163 if (fep->frequency < 1531000)
166 if (st->tone_mode == SEC_TONE_ON)
169 cmd
[7] = vp702x_chksum(cmd
,0,7);
171 st
->status_check_interval
= 250;
172 st
->next_status_check
= jiffies
;
174 vp702x_usb_in_op(st
->d
, RESET_TUNER
, 0, 0, NULL
, 0);
176 vp702x_usb_inout_op(st
->d
,cmd
,8,ibuf
,10,100);
178 if (ibuf
[2] == 0 && ibuf
[3] == 0)
179 deb_fe("tuning failed.\n");
181 deb_fe("tuning succeeded.\n");
186 static int vp702x_fe_get_frontend(struct dvb_frontend
* fe
,
187 struct dvb_frontend_parameters
*fep
)
189 deb_fe("%s\n",__FUNCTION__
);
193 static int vp702x_fe_send_diseqc_msg (struct dvb_frontend
* fe
,
194 struct dvb_diseqc_master_cmd
*m
)
196 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
200 deb_fe("%s\n",__FUNCTION__
);
205 cmd
[1] = SET_DISEQC_CMD
;
207 memcpy(&cmd
[3], m
->msg
, m
->msg_len
);
208 cmd
[7] = vp702x_chksum(cmd
,0,7);
210 vp702x_usb_inout_op(st
->d
,cmd
,8,ibuf
,10,100);
212 if (ibuf
[2] == 0 && ibuf
[3] == 0)
213 deb_fe("diseqc cmd failed.\n");
215 deb_fe("diseqc cmd succeeded.\n");
220 static int vp702x_fe_send_diseqc_burst (struct dvb_frontend
* fe
, fe_sec_mini_cmd_t burst
)
222 deb_fe("%s\n",__FUNCTION__
);
226 static int vp702x_fe_set_tone(struct dvb_frontend
* fe
, fe_sec_tone_mode_t tone
)
228 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
230 deb_fe("%s\n",__FUNCTION__
);
232 st
->tone_mode
= tone
;
234 if (tone
== SEC_TONE_ON
)
235 st
->lnb_buf
[2] = 0x02;
237 st
->lnb_buf
[2] = 0x00;
239 st
->lnb_buf
[7] = vp702x_chksum(st
->lnb_buf
,0,7);
241 vp702x_usb_inout_op(st
->d
,st
->lnb_buf
,8,ibuf
,10,100);
242 if (ibuf
[2] == 0 && ibuf
[3] == 0)
243 deb_fe("set_tone cmd failed.\n");
245 deb_fe("set_tone cmd succeeded.\n");
250 static int vp702x_fe_set_voltage (struct dvb_frontend
* fe
, fe_sec_voltage_t
253 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
255 deb_fe("%s\n",__FUNCTION__
);
257 st
->voltage
= voltage
;
259 if (voltage
!= SEC_VOLTAGE_OFF
)
260 st
->lnb_buf
[4] = 0x01;
262 st
->lnb_buf
[4] = 0x00;
264 st
->lnb_buf
[7] = vp702x_chksum(st
->lnb_buf
,0,7);
266 vp702x_usb_inout_op(st
->d
,st
->lnb_buf
,8,ibuf
,10,100);
267 if (ibuf
[2] == 0 && ibuf
[3] == 0)
268 deb_fe("set_voltage cmd failed.\n");
270 deb_fe("set_voltage cmd succeeded.\n");
275 static void vp702x_fe_release(struct dvb_frontend
* fe
)
277 struct vp702x_fe_state
*st
= fe
->demodulator_priv
;
281 static struct dvb_frontend_ops vp702x_fe_ops
;
283 struct dvb_frontend
* vp702x_fe_attach(struct dvb_usb_device
*d
)
285 struct vp702x_fe_state
*s
= kzalloc(sizeof(struct vp702x_fe_state
), GFP_KERNEL
);
291 memcpy(&s
->fe
.ops
,&vp702x_fe_ops
,sizeof(struct dvb_frontend_ops
));
292 s
->fe
.demodulator_priv
= s
;
294 s
->lnb_buf
[1] = SET_LNB_POWER
;
295 s
->lnb_buf
[3] = 0xff; /* 0=tone burst, 2=data burst, ff=off */
303 static struct dvb_frontend_ops vp702x_fe_ops
= {
305 .name
= "Twinhan DST-like frontend (VP7021/VP7020) DVB-S",
307 .frequency_min
= 950000,
308 .frequency_max
= 2150000,
309 .frequency_stepsize
= 1000, /* kHz for QPSK frontends */
310 .frequency_tolerance
= 0,
311 .symbol_rate_min
= 1000000,
312 .symbol_rate_max
= 45000000,
313 .symbol_rate_tolerance
= 500, /* ppm */
314 .caps
= FE_CAN_FEC_1_2
| FE_CAN_FEC_2_3
| FE_CAN_FEC_3_4
|
315 FE_CAN_FEC_5_6
| FE_CAN_FEC_7_8
|
319 .release
= vp702x_fe_release
,
324 .set_frontend
= vp702x_fe_set_frontend
,
325 .get_frontend
= vp702x_fe_get_frontend
,
326 .get_tune_settings
= vp702x_fe_get_tune_settings
,
328 .read_status
= vp702x_fe_read_status
,
329 .read_ber
= vp702x_fe_read_ber
,
330 .read_signal_strength
= vp702x_fe_read_signal_strength
,
331 .read_snr
= vp702x_fe_read_snr
,
332 .read_ucblocks
= vp702x_fe_read_unc_blocks
,
334 .diseqc_send_master_cmd
= vp702x_fe_send_diseqc_msg
,
335 .diseqc_send_burst
= vp702x_fe_send_diseqc_burst
,
336 .set_tone
= vp702x_fe_set_tone
,
337 .set_voltage
= vp702x_fe_set_voltage
,