1 /* 2 * Abilis Systems Single DVB-T Receiver 3 * Copyright (C) 2008 Pierrick Hascoet <pierrick.hascoet@abilis.com> 4 * Copyright (C) 2010 Devin Heitmueller <dheitmueller@kernellabs.com> 5 * 6 * This program is free software; you can redistribute it and/or modify 7 * it under the terms of the GNU General Public License as published by 8 * the Free Software Foundation; either version 2, or (at your option) 9 * any later version. 10 * 11 * This program is distributed in the hope that it will be useful, 12 * but WITHOUT ANY WARRANTY; without even the implied warranty of 13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14 * GNU General Public License for more details. 15 */ 16 17 #include <dvb_frontend.h> 18 19 #include "as102_fe.h" 20 21 struct as102_state { 22 struct dvb_frontend frontend; 23 struct as10x_demod_stats demod_stats; 24 25 const struct as102_fe_ops *ops; 26 void *priv; 27 uint8_t elna_cfg; 28 29 /* signal strength */ 30 uint16_t signal_strength; 31 /* bit error rate */ 32 uint32_t ber; 33 }; 34 35 static uint8_t as102_fe_get_code_rate(fe_code_rate_t arg) 36 { 37 uint8_t c; 38 39 switch (arg) { 40 case FEC_1_2: 41 c = CODE_RATE_1_2; 42 break; 43 case FEC_2_3: 44 c = CODE_RATE_2_3; 45 break; 46 case FEC_3_4: 47 c = CODE_RATE_3_4; 48 break; 49 case FEC_5_6: 50 c = CODE_RATE_5_6; 51 break; 52 case FEC_7_8: 53 c = CODE_RATE_7_8; 54 break; 55 default: 56 c = CODE_RATE_UNKNOWN; 57 break; 58 } 59 60 return c; 61 } 62 63 static int as102_fe_set_frontend(struct dvb_frontend *fe) 64 { 65 struct as102_state *state = fe->demodulator_priv; 66 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 67 struct as10x_tune_args tune_args = { 0 }; 68 69 /* set frequency */ 70 tune_args.freq = c->frequency / 1000; 71 72 /* fix interleaving_mode */ 73 tune_args.interleaving_mode = INTLV_NATIVE; 74 75 switch (c->bandwidth_hz) { 76 case 8000000: 77 tune_args.bandwidth = BW_8_MHZ; 78 break; 79 case 7000000: 80 tune_args.bandwidth = BW_7_MHZ; 81 break; 82 case 6000000: 83 tune_args.bandwidth = BW_6_MHZ; 84 break; 85 default: 86 tune_args.bandwidth = BW_8_MHZ; 87 } 88 89 switch (c->guard_interval) { 90 case GUARD_INTERVAL_1_32: 91 tune_args.guard_interval = GUARD_INT_1_32; 92 break; 93 case GUARD_INTERVAL_1_16: 94 tune_args.guard_interval = GUARD_INT_1_16; 95 break; 96 case GUARD_INTERVAL_1_8: 97 tune_args.guard_interval = GUARD_INT_1_8; 98 break; 99 case GUARD_INTERVAL_1_4: 100 tune_args.guard_interval = GUARD_INT_1_4; 101 break; 102 case GUARD_INTERVAL_AUTO: 103 default: 104 tune_args.guard_interval = GUARD_UNKNOWN; 105 break; 106 } 107 108 switch (c->modulation) { 109 case QPSK: 110 tune_args.modulation = CONST_QPSK; 111 break; 112 case QAM_16: 113 tune_args.modulation = CONST_QAM16; 114 break; 115 case QAM_64: 116 tune_args.modulation = CONST_QAM64; 117 break; 118 default: 119 tune_args.modulation = CONST_UNKNOWN; 120 break; 121 } 122 123 switch (c->transmission_mode) { 124 case TRANSMISSION_MODE_2K: 125 tune_args.transmission_mode = TRANS_MODE_2K; 126 break; 127 case TRANSMISSION_MODE_8K: 128 tune_args.transmission_mode = TRANS_MODE_8K; 129 break; 130 default: 131 tune_args.transmission_mode = TRANS_MODE_UNKNOWN; 132 } 133 134 switch (c->hierarchy) { 135 case HIERARCHY_NONE: 136 tune_args.hierarchy = HIER_NONE; 137 break; 138 case HIERARCHY_1: 139 tune_args.hierarchy = HIER_ALPHA_1; 140 break; 141 case HIERARCHY_2: 142 tune_args.hierarchy = HIER_ALPHA_2; 143 break; 144 case HIERARCHY_4: 145 tune_args.hierarchy = HIER_ALPHA_4; 146 break; 147 case HIERARCHY_AUTO: 148 tune_args.hierarchy = HIER_UNKNOWN; 149 break; 150 } 151 152 pr_debug("as102: tuner parameters: freq: %d bw: 0x%02x gi: 0x%02x\n", 153 c->frequency, 154 tune_args.bandwidth, 155 tune_args.guard_interval); 156 157 /* 158 * Detect a hierarchy selection 159 * if HP/LP are both set to FEC_NONE, HP will be selected. 160 */ 161 if ((tune_args.hierarchy != HIER_NONE) && 162 ((c->code_rate_LP == FEC_NONE) || 163 (c->code_rate_HP == FEC_NONE))) { 164 165 if (c->code_rate_LP == FEC_NONE) { 166 tune_args.hier_select = HIER_HIGH_PRIORITY; 167 tune_args.code_rate = 168 as102_fe_get_code_rate(c->code_rate_HP); 169 } 170 171 if (c->code_rate_HP == FEC_NONE) { 172 tune_args.hier_select = HIER_LOW_PRIORITY; 173 tune_args.code_rate = 174 as102_fe_get_code_rate(c->code_rate_LP); 175 } 176 177 pr_debug("as102: \thierarchy: 0x%02x selected: %s code_rate_%s: 0x%02x\n", 178 tune_args.hierarchy, 179 tune_args.hier_select == HIER_HIGH_PRIORITY ? 180 "HP" : "LP", 181 tune_args.hier_select == HIER_HIGH_PRIORITY ? 182 "HP" : "LP", 183 tune_args.code_rate); 184 } else { 185 tune_args.code_rate = 186 as102_fe_get_code_rate(c->code_rate_HP); 187 } 188 189 /* Set frontend arguments */ 190 return state->ops->set_tune(state->priv, &tune_args); 191 } 192 193 static int as102_fe_get_frontend(struct dvb_frontend *fe) 194 { 195 struct as102_state *state = fe->demodulator_priv; 196 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 197 int ret = 0; 198 struct as10x_tps tps = { 0 }; 199 200 /* send abilis command: GET_TPS */ 201 ret = state->ops->get_tps(state->priv, &tps); 202 if (ret < 0) 203 return ret; 204 205 /* extract constellation */ 206 switch (tps.modulation) { 207 case CONST_QPSK: 208 c->modulation = QPSK; 209 break; 210 case CONST_QAM16: 211 c->modulation = QAM_16; 212 break; 213 case CONST_QAM64: 214 c->modulation = QAM_64; 215 break; 216 } 217 218 /* extract hierarchy */ 219 switch (tps.hierarchy) { 220 case HIER_NONE: 221 c->hierarchy = HIERARCHY_NONE; 222 break; 223 case HIER_ALPHA_1: 224 c->hierarchy = HIERARCHY_1; 225 break; 226 case HIER_ALPHA_2: 227 c->hierarchy = HIERARCHY_2; 228 break; 229 case HIER_ALPHA_4: 230 c->hierarchy = HIERARCHY_4; 231 break; 232 } 233 234 /* extract code rate HP */ 235 switch (tps.code_rate_HP) { 236 case CODE_RATE_1_2: 237 c->code_rate_HP = FEC_1_2; 238 break; 239 case CODE_RATE_2_3: 240 c->code_rate_HP = FEC_2_3; 241 break; 242 case CODE_RATE_3_4: 243 c->code_rate_HP = FEC_3_4; 244 break; 245 case CODE_RATE_5_6: 246 c->code_rate_HP = FEC_5_6; 247 break; 248 case CODE_RATE_7_8: 249 c->code_rate_HP = FEC_7_8; 250 break; 251 } 252 253 /* extract code rate LP */ 254 switch (tps.code_rate_LP) { 255 case CODE_RATE_1_2: 256 c->code_rate_LP = FEC_1_2; 257 break; 258 case CODE_RATE_2_3: 259 c->code_rate_LP = FEC_2_3; 260 break; 261 case CODE_RATE_3_4: 262 c->code_rate_LP = FEC_3_4; 263 break; 264 case CODE_RATE_5_6: 265 c->code_rate_LP = FEC_5_6; 266 break; 267 case CODE_RATE_7_8: 268 c->code_rate_LP = FEC_7_8; 269 break; 270 } 271 272 /* extract guard interval */ 273 switch (tps.guard_interval) { 274 case GUARD_INT_1_32: 275 c->guard_interval = GUARD_INTERVAL_1_32; 276 break; 277 case GUARD_INT_1_16: 278 c->guard_interval = GUARD_INTERVAL_1_16; 279 break; 280 case GUARD_INT_1_8: 281 c->guard_interval = GUARD_INTERVAL_1_8; 282 break; 283 case GUARD_INT_1_4: 284 c->guard_interval = GUARD_INTERVAL_1_4; 285 break; 286 } 287 288 /* extract transmission mode */ 289 switch (tps.transmission_mode) { 290 case TRANS_MODE_2K: 291 c->transmission_mode = TRANSMISSION_MODE_2K; 292 break; 293 case TRANS_MODE_8K: 294 c->transmission_mode = TRANSMISSION_MODE_8K; 295 break; 296 } 297 298 return 0; 299 } 300 301 static int as102_fe_get_tune_settings(struct dvb_frontend *fe, 302 struct dvb_frontend_tune_settings *settings) { 303 304 settings->min_delay_ms = 1000; 305 306 return 0; 307 } 308 309 static int as102_fe_read_status(struct dvb_frontend *fe, fe_status_t *status) 310 { 311 int ret = 0; 312 struct as102_state *state = fe->demodulator_priv; 313 struct as10x_tune_status tstate = { 0 }; 314 315 /* send abilis command: GET_TUNE_STATUS */ 316 ret = state->ops->get_status(state->priv, &tstate); 317 if (ret < 0) 318 return ret; 319 320 state->signal_strength = tstate.signal_strength; 321 state->ber = tstate.BER; 322 323 switch (tstate.tune_state) { 324 case TUNE_STATUS_SIGNAL_DVB_OK: 325 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER; 326 break; 327 case TUNE_STATUS_STREAM_DETECTED: 328 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_SYNC | 329 FE_HAS_VITERBI; 330 break; 331 case TUNE_STATUS_STREAM_TUNED: 332 *status = FE_HAS_SIGNAL | FE_HAS_CARRIER | FE_HAS_SYNC | 333 FE_HAS_LOCK | FE_HAS_VITERBI; 334 break; 335 default: 336 *status = TUNE_STATUS_NOT_TUNED; 337 } 338 339 pr_debug("as102: tuner status: 0x%02x, strength %d, per: %d, ber: %d\n", 340 tstate.tune_state, tstate.signal_strength, 341 tstate.PER, tstate.BER); 342 343 if (!(*status & FE_HAS_LOCK)) { 344 memset(&state->demod_stats, 0, sizeof(state->demod_stats)); 345 return 0; 346 } 347 348 ret = state->ops->get_stats(state->priv, &state->demod_stats); 349 if (ret < 0) 350 memset(&state->demod_stats, 0, sizeof(state->demod_stats)); 351 352 return ret; 353 } 354 355 /* 356 * Note: 357 * - in AS102 SNR=MER 358 * - the SNR will be returned in linear terms, i.e. not in dB 359 * - the accuracy equals ±2dB for a SNR range from 4dB to 30dB 360 * - the accuracy is >2dB for SNR values outside this range 361 */ 362 static int as102_fe_read_snr(struct dvb_frontend *fe, u16 *snr) 363 { 364 struct as102_state *state = fe->demodulator_priv; 365 366 *snr = state->demod_stats.mer; 367 368 return 0; 369 } 370 371 static int as102_fe_read_ber(struct dvb_frontend *fe, u32 *ber) 372 { 373 struct as102_state *state = fe->demodulator_priv; 374 375 *ber = state->ber; 376 377 return 0; 378 } 379 380 static int as102_fe_read_signal_strength(struct dvb_frontend *fe, 381 u16 *strength) 382 { 383 struct as102_state *state = fe->demodulator_priv; 384 385 *strength = (((0xffff * 400) * state->signal_strength + 41000) * 2); 386 387 return 0; 388 } 389 390 static int as102_fe_read_ucblocks(struct dvb_frontend *fe, u32 *ucblocks) 391 { 392 struct as102_state *state = fe->demodulator_priv; 393 394 if (state->demod_stats.has_started) 395 *ucblocks = state->demod_stats.bad_frame_count; 396 else 397 *ucblocks = 0; 398 399 return 0; 400 } 401 402 static int as102_fe_ts_bus_ctrl(struct dvb_frontend *fe, int acquire) 403 { 404 struct as102_state *state = fe->demodulator_priv; 405 406 return state->ops->stream_ctrl(state->priv, acquire, 407 state->elna_cfg); 408 } 409 410 static void as102_fe_release(struct dvb_frontend *fe) 411 { 412 struct as102_state *state = fe->demodulator_priv; 413 414 kfree(state); 415 } 416 417 418 static struct dvb_frontend_ops as102_fe_ops = { 419 .delsys = { SYS_DVBT }, 420 .info = { 421 .name = "Abilis AS102 DVB-T", 422 .frequency_min = 174000000, 423 .frequency_max = 862000000, 424 .frequency_stepsize = 166667, 425 .caps = FE_CAN_INVERSION_AUTO 426 | FE_CAN_FEC_1_2 | FE_CAN_FEC_2_3 | FE_CAN_FEC_3_4 427 | FE_CAN_FEC_5_6 | FE_CAN_FEC_7_8 | FE_CAN_FEC_AUTO 428 | FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QPSK 429 | FE_CAN_QAM_AUTO 430 | FE_CAN_TRANSMISSION_MODE_AUTO 431 | FE_CAN_GUARD_INTERVAL_AUTO 432 | FE_CAN_HIERARCHY_AUTO 433 | FE_CAN_RECOVER 434 | FE_CAN_MUTE_TS 435 }, 436 437 .set_frontend = as102_fe_set_frontend, 438 .get_frontend = as102_fe_get_frontend, 439 .get_tune_settings = as102_fe_get_tune_settings, 440 441 .read_status = as102_fe_read_status, 442 .read_snr = as102_fe_read_snr, 443 .read_ber = as102_fe_read_ber, 444 .read_signal_strength = as102_fe_read_signal_strength, 445 .read_ucblocks = as102_fe_read_ucblocks, 446 .ts_bus_ctrl = as102_fe_ts_bus_ctrl, 447 .release = as102_fe_release, 448 }; 449 450 struct dvb_frontend *as102_attach(const char *name, 451 const struct as102_fe_ops *ops, 452 void *priv, 453 uint8_t elna_cfg) 454 { 455 struct as102_state *state; 456 struct dvb_frontend *fe; 457 458 state = kzalloc(sizeof(struct as102_state), GFP_KERNEL); 459 if (state == NULL) { 460 pr_err("%s: unable to allocate memory for state\n", __func__); 461 return NULL; 462 } 463 fe = &state->frontend; 464 fe->demodulator_priv = state; 465 state->ops = ops; 466 state->priv = priv; 467 state->elna_cfg = elna_cfg; 468 469 /* init frontend callback ops */ 470 memcpy(&fe->ops, &as102_fe_ops, sizeof(struct dvb_frontend_ops)); 471 strncpy(fe->ops.info.name, name, sizeof(fe->ops.info.name)); 472 473 return fe; 474 475 } 476 EXPORT_SYMBOL_GPL(as102_attach); 477 478 MODULE_DESCRIPTION("as102-fe"); 479 MODULE_LICENSE("GPL"); 480 MODULE_AUTHOR("Pierrick Hascoet <pierrick.hascoet@abilis.com>"); 481