Patrick Boettcher | 3706a4d | 2005-09-09 13:02:41 -0700 | [diff] [blame] | 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 | |
| 27 | fe_sec_voltage_t voltage; |
| 28 | fe_sec_tone_mode_t tone_mode; |
| 29 | |
| 30 | u8 lnb_buf[8]; |
| 31 | |
| 32 | u8 lock; |
| 33 | u8 sig; |
| 34 | u8 snr; |
| 35 | |
| 36 | unsigned long next_status_check; |
| 37 | unsigned long status_check_interval; |
| 38 | }; |
| 39 | |
| 40 | static int vp702x_fe_refresh_state(struct vp702x_fe_state *st) |
| 41 | { |
| 42 | u8 buf[10]; |
| 43 | if (time_after(jiffies,st->next_status_check)) { |
| 44 | vp702x_usb_in_op(st->d,READ_STATUS,0,0,buf,10); |
| 45 | |
| 46 | st->lock = buf[4]; |
| 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); |
| 49 | |
| 50 | st->next_status_check = jiffies + (st->status_check_interval*HZ)/1000; |
| 51 | } |
| 52 | return 0; |
| 53 | } |
| 54 | |
| 55 | static u8 vp702x_chksum(u8 *buf,int f, int count) |
| 56 | { |
| 57 | u8 s = 0; |
| 58 | int i; |
| 59 | for (i = f; i < f+count; i++) |
| 60 | s += buf[i]; |
| 61 | return ~s+1; |
| 62 | } |
| 63 | |
| 64 | static int vp702x_fe_read_status(struct dvb_frontend* fe, fe_status_t *status) |
| 65 | { |
| 66 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 67 | vp702x_fe_refresh_state(st); |
| 68 | deb_fe("%s\n",__FUNCTION__); |
| 69 | |
| 70 | if (st->lock == 0) |
| 71 | *status = FE_HAS_LOCK | FE_HAS_SYNC | FE_HAS_VITERBI | FE_HAS_SIGNAL | FE_HAS_CARRIER; |
| 72 | else |
| 73 | *status = 0; |
| 74 | |
| 75 | deb_fe("real state: %x\n",*status); |
| 76 | *status = 0x1f; |
| 77 | |
| 78 | if (*status & FE_HAS_LOCK) |
| 79 | st->status_check_interval = 1000; |
| 80 | else |
| 81 | st->status_check_interval = 250; |
| 82 | return 0; |
| 83 | } |
| 84 | |
| 85 | /* not supported by this Frontend */ |
| 86 | static int vp702x_fe_read_ber(struct dvb_frontend* fe, u32 *ber) |
| 87 | { |
| 88 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 89 | vp702x_fe_refresh_state(st); |
| 90 | *ber = 0; |
| 91 | return 0; |
| 92 | } |
| 93 | |
| 94 | /* not supported by this Frontend */ |
| 95 | static int vp702x_fe_read_unc_blocks(struct dvb_frontend* fe, u32 *unc) |
| 96 | { |
| 97 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 98 | vp702x_fe_refresh_state(st); |
| 99 | *unc = 0; |
| 100 | return 0; |
| 101 | } |
| 102 | |
| 103 | static int vp702x_fe_read_signal_strength(struct dvb_frontend* fe, u16 *strength) |
| 104 | { |
| 105 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 106 | vp702x_fe_refresh_state(st); |
| 107 | |
| 108 | *strength = (st->sig << 8) | st->sig; |
| 109 | return 0; |
| 110 | } |
| 111 | |
| 112 | static int vp702x_fe_read_snr(struct dvb_frontend* fe, u16 *snr) |
| 113 | { |
| 114 | u8 _snr; |
| 115 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 116 | vp702x_fe_refresh_state(st); |
| 117 | |
| 118 | _snr = (st->snr & 0x1f) * 0xff / 0x1f; |
| 119 | *snr = (_snr << 8) | _snr; |
| 120 | return 0; |
| 121 | } |
| 122 | |
| 123 | static int vp702x_fe_get_tune_settings(struct dvb_frontend* fe, struct dvb_frontend_tune_settings *tune) |
| 124 | { |
| 125 | deb_fe("%s\n",__FUNCTION__); |
| 126 | tune->min_delay_ms = 2000; |
| 127 | return 0; |
| 128 | } |
| 129 | |
| 130 | static int vp702x_fe_set_frontend(struct dvb_frontend* fe, |
| 131 | struct dvb_frontend_parameters *fep) |
| 132 | { |
| 133 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 134 | u32 freq = fep->frequency/1000; |
| 135 | /*CalFrequency*/ |
| 136 | /* u16 frequencyRef[16] = { 2, 4, 8, 16, 32, 64, 128, 256, 24, 5, 10, 20, 40, 80, 160, 320 }; */ |
| 137 | u64 sr; |
| 138 | u8 cmd[8] = { 0 },ibuf[10]; |
| 139 | |
| 140 | cmd[0] = (freq >> 8) & 0x7f; |
| 141 | cmd[1] = freq & 0xff; |
| 142 | cmd[2] = 1; /* divrate == 4 -> frequencyRef[1] -> 1 here */ |
| 143 | |
| 144 | sr = (u64) (fep->u.qpsk.symbol_rate/1000) << 20; |
| 145 | do_div(sr,88000); |
| 146 | cmd[3] = (sr >> 12) & 0xff; |
| 147 | cmd[4] = (sr >> 4) & 0xff; |
| 148 | cmd[5] = (sr << 4) & 0xf0; |
| 149 | |
Mauro Carvalho Chehab | 4ae5c2e | 2006-03-25 15:53:38 -0300 | [diff] [blame] | 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); |
Patrick Boettcher | 3706a4d | 2005-09-09 13:02:41 -0700 | [diff] [blame] | 153 | |
| 154 | /* if (fep->inversion == INVERSION_ON) |
| 155 | cmd[6] |= 0x80; */ |
| 156 | |
| 157 | if (st->voltage == SEC_VOLTAGE_18) |
| 158 | cmd[6] |= 0x40; |
| 159 | |
| 160 | /* if (fep->u.qpsk.symbol_rate > 8000000) |
| 161 | cmd[6] |= 0x20; |
| 162 | |
| 163 | if (fep->frequency < 1531000) |
| 164 | cmd[6] |= 0x04; |
| 165 | |
| 166 | if (st->tone_mode == SEC_TONE_ON) |
| 167 | cmd[6] |= 0x01;*/ |
| 168 | |
| 169 | cmd[7] = vp702x_chksum(cmd,0,7); |
| 170 | |
| 171 | st->status_check_interval = 250; |
| 172 | st->next_status_check = jiffies; |
| 173 | |
| 174 | vp702x_usb_in_op(st->d, RESET_TUNER, 0, 0, NULL, 0); |
| 175 | msleep(30); |
| 176 | vp702x_usb_inout_op(st->d,cmd,8,ibuf,10,100); |
| 177 | |
| 178 | if (ibuf[2] == 0 && ibuf[3] == 0) |
| 179 | deb_fe("tuning failed.\n"); |
| 180 | else |
| 181 | deb_fe("tuning succeeded.\n"); |
| 182 | |
| 183 | return 0; |
| 184 | } |
| 185 | |
| 186 | static int vp702x_fe_get_frontend(struct dvb_frontend* fe, |
| 187 | struct dvb_frontend_parameters *fep) |
| 188 | { |
| 189 | deb_fe("%s\n",__FUNCTION__); |
| 190 | return 0; |
| 191 | } |
| 192 | |
| 193 | static int vp702x_fe_send_diseqc_msg (struct dvb_frontend* fe, |
Michael Krufky | 50c25ff | 2006-01-09 15:25:34 -0200 | [diff] [blame] | 194 | struct dvb_diseqc_master_cmd *m) |
Patrick Boettcher | 3706a4d | 2005-09-09 13:02:41 -0700 | [diff] [blame] | 195 | { |
| 196 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 197 | u8 cmd[8],ibuf[10]; |
| 198 | memset(cmd,0,8); |
| 199 | |
| 200 | deb_fe("%s\n",__FUNCTION__); |
| 201 | |
| 202 | if (m->msg_len > 4) |
| 203 | return -EINVAL; |
| 204 | |
| 205 | cmd[1] = SET_DISEQC_CMD; |
| 206 | cmd[2] = m->msg_len; |
| 207 | memcpy(&cmd[3], m->msg, m->msg_len); |
| 208 | cmd[7] = vp702x_chksum(cmd,0,7); |
| 209 | |
| 210 | vp702x_usb_inout_op(st->d,cmd,8,ibuf,10,100); |
| 211 | |
| 212 | if (ibuf[2] == 0 && ibuf[3] == 0) |
| 213 | deb_fe("diseqc cmd failed.\n"); |
| 214 | else |
| 215 | deb_fe("diseqc cmd succeeded.\n"); |
| 216 | |
| 217 | return 0; |
| 218 | } |
| 219 | |
| 220 | static int vp702x_fe_send_diseqc_burst (struct dvb_frontend* fe, fe_sec_mini_cmd_t burst) |
| 221 | { |
| 222 | deb_fe("%s\n",__FUNCTION__); |
| 223 | return 0; |
| 224 | } |
| 225 | |
| 226 | static int vp702x_fe_set_tone(struct dvb_frontend* fe, fe_sec_tone_mode_t tone) |
| 227 | { |
| 228 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 229 | u8 ibuf[10]; |
| 230 | deb_fe("%s\n",__FUNCTION__); |
| 231 | |
| 232 | st->tone_mode = tone; |
| 233 | |
| 234 | if (tone == SEC_TONE_ON) |
| 235 | st->lnb_buf[2] = 0x02; |
| 236 | else |
| 237 | st->lnb_buf[2] = 0x00; |
| 238 | |
| 239 | st->lnb_buf[7] = vp702x_chksum(st->lnb_buf,0,7); |
| 240 | |
| 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"); |
| 244 | else |
| 245 | deb_fe("set_tone cmd succeeded.\n"); |
| 246 | |
| 247 | return 0; |
| 248 | } |
| 249 | |
| 250 | static int vp702x_fe_set_voltage (struct dvb_frontend* fe, fe_sec_voltage_t |
| 251 | voltage) |
| 252 | { |
| 253 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 254 | u8 ibuf[10]; |
| 255 | deb_fe("%s\n",__FUNCTION__); |
| 256 | |
| 257 | st->voltage = voltage; |
| 258 | |
| 259 | if (voltage != SEC_VOLTAGE_OFF) |
| 260 | st->lnb_buf[4] = 0x01; |
| 261 | else |
| 262 | st->lnb_buf[4] = 0x00; |
| 263 | |
| 264 | st->lnb_buf[7] = vp702x_chksum(st->lnb_buf,0,7); |
| 265 | |
| 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"); |
| 269 | else |
| 270 | deb_fe("set_voltage cmd succeeded.\n"); |
| 271 | |
| 272 | return 0; |
| 273 | } |
| 274 | |
| 275 | static void vp702x_fe_release(struct dvb_frontend* fe) |
| 276 | { |
| 277 | struct vp702x_fe_state *st = fe->demodulator_priv; |
| 278 | kfree(st); |
| 279 | } |
| 280 | |
| 281 | static struct dvb_frontend_ops vp702x_fe_ops; |
| 282 | |
| 283 | struct dvb_frontend * vp702x_fe_attach(struct dvb_usb_device *d) |
| 284 | { |
Panagiotis Issaris | 7408187 | 2006-01-11 19:40:56 -0200 | [diff] [blame] | 285 | struct vp702x_fe_state *s = kzalloc(sizeof(struct vp702x_fe_state), GFP_KERNEL); |
Patrick Boettcher | 3706a4d | 2005-09-09 13:02:41 -0700 | [diff] [blame] | 286 | if (s == NULL) |
| 287 | goto error; |
Patrick Boettcher | 3706a4d | 2005-09-09 13:02:41 -0700 | [diff] [blame] | 288 | |
| 289 | s->d = d; |
| 290 | s->fe.ops = &vp702x_fe_ops; |
| 291 | s->fe.demodulator_priv = s; |
| 292 | |
| 293 | s->lnb_buf[1] = SET_LNB_POWER; |
| 294 | s->lnb_buf[3] = 0xff; /* 0=tone burst, 2=data burst, ff=off */ |
| 295 | |
| 296 | goto success; |
| 297 | error: |
| 298 | return NULL; |
| 299 | success: |
| 300 | return &s->fe; |
| 301 | } |
| 302 | |
| 303 | |
| 304 | static struct dvb_frontend_ops vp702x_fe_ops = { |
| 305 | .info = { |
| 306 | .name = "Twinhan DST-like frontend (VP7021/VP7020) DVB-S", |
| 307 | .type = FE_QPSK, |
| 308 | .frequency_min = 950000, |
| 309 | .frequency_max = 2150000, |
| 310 | .frequency_stepsize = 1000, /* kHz for QPSK frontends */ |
| 311 | .frequency_tolerance = 0, |
| 312 | .symbol_rate_min = 1000000, |
| 313 | .symbol_rate_max = 45000000, |
| 314 | .symbol_rate_tolerance = 500, /* ppm */ |
| 315 | .caps = FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 | |
| 316 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | |
| 317 | FE_CAN_QPSK | |
| 318 | FE_CAN_FEC_AUTO |
| 319 | }, |
| 320 | .release = vp702x_fe_release, |
| 321 | |
| 322 | .init = NULL, |
| 323 | .sleep = NULL, |
| 324 | |
| 325 | .set_frontend = vp702x_fe_set_frontend, |
| 326 | .get_frontend = vp702x_fe_get_frontend, |
| 327 | .get_tune_settings = vp702x_fe_get_tune_settings, |
| 328 | |
| 329 | .read_status = vp702x_fe_read_status, |
| 330 | .read_ber = vp702x_fe_read_ber, |
| 331 | .read_signal_strength = vp702x_fe_read_signal_strength, |
| 332 | .read_snr = vp702x_fe_read_snr, |
| 333 | .read_ucblocks = vp702x_fe_read_unc_blocks, |
| 334 | |
| 335 | .diseqc_send_master_cmd = vp702x_fe_send_diseqc_msg, |
| 336 | .diseqc_send_burst = vp702x_fe_send_diseqc_burst, |
| 337 | .set_tone = vp702x_fe_set_tone, |
| 338 | .set_voltage = vp702x_fe_set_voltage, |
| 339 | }; |