drivers/media/dvb/dvb-usb/cinergyT2-fe.c

   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 *)&param, 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 };