1 /* 2 * dvb_frontend.c: DVB frontend tuning interface/thread 3 * 4 * 5 * Copyright (C) 1999-2001 Ralph Metzler 6 * Marcus Metzler 7 * Holger Waechtler 8 * for convergence integrated media GmbH 9 * 10 * Copyright (C) 2004 Andrew de Quincey (tuning thread cleanup) 11 * 12 * This program is free software; you can redistribute it and/or 13 * modify it under the terms of the GNU General Public License 14 * as published by the Free Software Foundation; either version 2 15 * of the License, or (at your option) any later version. 16 * 17 * This program is distributed in the hope that it will be useful, 18 * but WITHOUT ANY WARRANTY; without even the implied warranty of 19 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 20 * GNU General Public License for more details. 21 * To obtain the license, point your browser to 22 * http://www.gnu.org/copyleft/gpl.html 23 */ 24 25 /* Enables DVBv3 compatibility bits at the headers */ 26 #define __DVB_CORE__ 27 28 #define pr_fmt(fmt) "dvb_frontend: " fmt 29 30 #include <linux/string.h> 31 #include <linux/kernel.h> 32 #include <linux/sched/signal.h> 33 #include <linux/wait.h> 34 #include <linux/slab.h> 35 #include <linux/poll.h> 36 #include <linux/semaphore.h> 37 #include <linux/module.h> 38 #include <linux/list.h> 39 #include <linux/freezer.h> 40 #include <linux/jiffies.h> 41 #include <linux/kthread.h> 42 #include <linux/ktime.h> 43 #include <linux/compat.h> 44 #include <asm/processor.h> 45 46 #include <media/dvb_frontend.h> 47 #include <media/dvbdev.h> 48 #include <linux/dvb/version.h> 49 50 static int dvb_frontend_debug; 51 static int dvb_shutdown_timeout; 52 static int dvb_force_auto_inversion; 53 static int dvb_override_tune_delay; 54 static int dvb_powerdown_on_sleep = 1; 55 static int dvb_mfe_wait_time = 5; 56 57 module_param_named(frontend_debug, dvb_frontend_debug, int, 0644); 58 MODULE_PARM_DESC(frontend_debug, "Turn on/off frontend core debugging (default:off)."); 59 module_param(dvb_shutdown_timeout, int, 0644); 60 MODULE_PARM_DESC(dvb_shutdown_timeout, "wait <shutdown_timeout> seconds after close() before suspending hardware"); 61 module_param(dvb_force_auto_inversion, int, 0644); 62 MODULE_PARM_DESC(dvb_force_auto_inversion, "0: normal (default), 1: INVERSION_AUTO forced always"); 63 module_param(dvb_override_tune_delay, int, 0644); 64 MODULE_PARM_DESC(dvb_override_tune_delay, "0: normal (default), >0 => delay in milliseconds to wait for lock after a tune attempt"); 65 module_param(dvb_powerdown_on_sleep, int, 0644); 66 MODULE_PARM_DESC(dvb_powerdown_on_sleep, "0: do not power down, 1: turn LNB voltage off on sleep (default)"); 67 module_param(dvb_mfe_wait_time, int, 0644); 68 MODULE_PARM_DESC(dvb_mfe_wait_time, "Wait up to <mfe_wait_time> seconds on open() for multi-frontend to become available (default:5 seconds)"); 69 70 #define dprintk(fmt, arg...) \ 71 printk(KERN_DEBUG pr_fmt("%s: " fmt), __func__, ##arg) 72 73 #define FESTATE_IDLE 1 74 #define FESTATE_RETUNE 2 75 #define FESTATE_TUNING_FAST 4 76 #define FESTATE_TUNING_SLOW 8 77 #define FESTATE_TUNED 16 78 #define FESTATE_ZIGZAG_FAST 32 79 #define FESTATE_ZIGZAG_SLOW 64 80 #define FESTATE_DISEQC 128 81 #define FESTATE_ERROR 256 82 #define FESTATE_WAITFORLOCK (FESTATE_TUNING_FAST | FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW | FESTATE_DISEQC) 83 #define FESTATE_SEARCHING_FAST (FESTATE_TUNING_FAST | FESTATE_ZIGZAG_FAST) 84 #define FESTATE_SEARCHING_SLOW (FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_SLOW) 85 #define FESTATE_LOSTLOCK (FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW) 86 87 /* 88 * FESTATE_IDLE. No tuning parameters have been supplied and the loop is idling. 89 * FESTATE_RETUNE. Parameters have been supplied, but we have not yet performed the first tune. 90 * FESTATE_TUNING_FAST. Tuning parameters have been supplied and fast zigzag scan is in progress. 91 * FESTATE_TUNING_SLOW. Tuning parameters have been supplied. Fast zigzag failed, so we're trying again, but slower. 92 * FESTATE_TUNED. The frontend has successfully locked on. 93 * FESTATE_ZIGZAG_FAST. The lock has been lost, and a fast zigzag has been initiated to try and regain it. 94 * FESTATE_ZIGZAG_SLOW. The lock has been lost. Fast zigzag has been failed, so we're trying again, but slower. 95 * FESTATE_DISEQC. A DISEQC command has just been issued. 96 * FESTATE_WAITFORLOCK. When we're waiting for a lock. 97 * FESTATE_SEARCHING_FAST. When we're searching for a signal using a fast zigzag scan. 98 * FESTATE_SEARCHING_SLOW. When we're searching for a signal using a slow zigzag scan. 99 * FESTATE_LOSTLOCK. When the lock has been lost, and we're searching it again. 100 */ 101 102 static DEFINE_MUTEX(frontend_mutex); 103 104 struct dvb_frontend_private { 105 /* thread/frontend values */ 106 struct dvb_device *dvbdev; 107 struct dvb_frontend_parameters parameters_out; 108 struct dvb_fe_events events; 109 struct semaphore sem; 110 struct list_head list_head; 111 wait_queue_head_t wait_queue; 112 struct task_struct *thread; 113 unsigned long release_jiffies; 114 unsigned int wakeup; 115 enum fe_status status; 116 unsigned long tune_mode_flags; 117 unsigned int delay; 118 unsigned int reinitialise; 119 int tone; 120 int voltage; 121 122 /* swzigzag values */ 123 unsigned int state; 124 unsigned int bending; 125 int lnb_drift; 126 unsigned int inversion; 127 unsigned int auto_step; 128 unsigned int auto_sub_step; 129 unsigned int started_auto_step; 130 unsigned int min_delay; 131 unsigned int max_drift; 132 unsigned int step_size; 133 int quality; 134 unsigned int check_wrapped; 135 enum dvbfe_search algo_status; 136 137 #if defined(CONFIG_MEDIA_CONTROLLER_DVB) 138 struct media_pipeline pipe; 139 #endif 140 }; 141 142 static void dvb_frontend_invoke_release(struct dvb_frontend *fe, 143 void (*release)(struct dvb_frontend *fe)); 144 145 static void __dvb_frontend_free(struct dvb_frontend *fe) 146 { 147 struct dvb_frontend_private *fepriv = fe->frontend_priv; 148 149 if (fepriv) 150 dvb_free_device(fepriv->dvbdev); 151 152 dvb_frontend_invoke_release(fe, fe->ops.release); 153 154 kfree(fepriv); 155 } 156 157 static void dvb_frontend_free(struct kref *ref) 158 { 159 struct dvb_frontend *fe = 160 container_of(ref, struct dvb_frontend, refcount); 161 162 __dvb_frontend_free(fe); 163 } 164 165 static void dvb_frontend_put(struct dvb_frontend *fe) 166 { 167 /* 168 * Check if the frontend was registered, as otherwise 169 * kref was not initialized yet. 170 */ 171 if (fe->frontend_priv) 172 kref_put(&fe->refcount, dvb_frontend_free); 173 else 174 __dvb_frontend_free(fe); 175 } 176 177 static void dvb_frontend_get(struct dvb_frontend *fe) 178 { 179 kref_get(&fe->refcount); 180 } 181 182 static void dvb_frontend_wakeup(struct dvb_frontend *fe); 183 static int dtv_get_frontend(struct dvb_frontend *fe, 184 struct dtv_frontend_properties *c, 185 struct dvb_frontend_parameters *p_out); 186 static int 187 dtv_property_legacy_params_sync(struct dvb_frontend *fe, 188 const struct dtv_frontend_properties *c, 189 struct dvb_frontend_parameters *p); 190 191 static bool has_get_frontend(struct dvb_frontend *fe) 192 { 193 return fe->ops.get_frontend; 194 } 195 196 /* 197 * Due to DVBv3 API calls, a delivery system should be mapped into one of 198 * the 4 DVBv3 delivery systems (FE_QPSK, FE_QAM, FE_OFDM or FE_ATSC), 199 * otherwise, a DVBv3 call will fail. 200 */ 201 enum dvbv3_emulation_type { 202 DVBV3_UNKNOWN, 203 DVBV3_QPSK, 204 DVBV3_QAM, 205 DVBV3_OFDM, 206 DVBV3_ATSC, 207 }; 208 209 static enum dvbv3_emulation_type dvbv3_type(u32 delivery_system) 210 { 211 switch (delivery_system) { 212 case SYS_DVBC_ANNEX_A: 213 case SYS_DVBC_ANNEX_C: 214 return DVBV3_QAM; 215 case SYS_DVBS: 216 case SYS_DVBS2: 217 case SYS_TURBO: 218 case SYS_ISDBS: 219 case SYS_DSS: 220 return DVBV3_QPSK; 221 case SYS_DVBT: 222 case SYS_DVBT2: 223 case SYS_ISDBT: 224 case SYS_DTMB: 225 return DVBV3_OFDM; 226 case SYS_ATSC: 227 case SYS_ATSCMH: 228 case SYS_DVBC_ANNEX_B: 229 return DVBV3_ATSC; 230 case SYS_UNDEFINED: 231 case SYS_ISDBC: 232 case SYS_DVBH: 233 case SYS_DAB: 234 default: 235 /* 236 * Doesn't know how to emulate those types and/or 237 * there's no frontend driver from this type yet 238 * with some emulation code, so, we're not sure yet how 239 * to handle them, or they're not compatible with a DVBv3 call. 240 */ 241 return DVBV3_UNKNOWN; 242 } 243 } 244 245 static void dvb_frontend_add_event(struct dvb_frontend *fe, 246 enum fe_status status) 247 { 248 struct dvb_frontend_private *fepriv = fe->frontend_priv; 249 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 250 struct dvb_fe_events *events = &fepriv->events; 251 struct dvb_frontend_event *e; 252 int wp; 253 254 dev_dbg(fe->dvb->device, "%s:\n", __func__); 255 256 if ((status & FE_HAS_LOCK) && has_get_frontend(fe)) 257 dtv_get_frontend(fe, c, &fepriv->parameters_out); 258 259 mutex_lock(&events->mtx); 260 261 wp = (events->eventw + 1) % MAX_EVENT; 262 if (wp == events->eventr) { 263 events->overflow = 1; 264 events->eventr = (events->eventr + 1) % MAX_EVENT; 265 } 266 267 e = &events->events[events->eventw]; 268 e->status = status; 269 e->parameters = fepriv->parameters_out; 270 271 events->eventw = wp; 272 273 mutex_unlock(&events->mtx); 274 275 wake_up_interruptible(&events->wait_queue); 276 } 277 278 static int dvb_frontend_test_event(struct dvb_frontend_private *fepriv, 279 struct dvb_fe_events *events) 280 { 281 int ret; 282 283 up(&fepriv->sem); 284 ret = events->eventw != events->eventr; 285 down(&fepriv->sem); 286 287 return ret; 288 } 289 290 static int dvb_frontend_get_event(struct dvb_frontend *fe, 291 struct dvb_frontend_event *event, int flags) 292 { 293 struct dvb_frontend_private *fepriv = fe->frontend_priv; 294 struct dvb_fe_events *events = &fepriv->events; 295 296 dev_dbg(fe->dvb->device, "%s:\n", __func__); 297 298 if (events->overflow) { 299 events->overflow = 0; 300 return -EOVERFLOW; 301 } 302 303 if (events->eventw == events->eventr) { 304 int ret; 305 306 if (flags & O_NONBLOCK) 307 return -EWOULDBLOCK; 308 309 ret = wait_event_interruptible(events->wait_queue, 310 dvb_frontend_test_event(fepriv, events)); 311 312 if (ret < 0) 313 return ret; 314 } 315 316 mutex_lock(&events->mtx); 317 *event = events->events[events->eventr]; 318 events->eventr = (events->eventr + 1) % MAX_EVENT; 319 mutex_unlock(&events->mtx); 320 321 return 0; 322 } 323 324 static void dvb_frontend_clear_events(struct dvb_frontend *fe) 325 { 326 struct dvb_frontend_private *fepriv = fe->frontend_priv; 327 struct dvb_fe_events *events = &fepriv->events; 328 329 mutex_lock(&events->mtx); 330 events->eventr = events->eventw; 331 mutex_unlock(&events->mtx); 332 } 333 334 static void dvb_frontend_init(struct dvb_frontend *fe) 335 { 336 dev_dbg(fe->dvb->device, 337 "%s: initialising adapter %i frontend %i (%s)...\n", 338 __func__, fe->dvb->num, fe->id, fe->ops.info.name); 339 340 if (fe->ops.init) 341 fe->ops.init(fe); 342 if (fe->ops.tuner_ops.init) { 343 if (fe->ops.i2c_gate_ctrl) 344 fe->ops.i2c_gate_ctrl(fe, 1); 345 fe->ops.tuner_ops.init(fe); 346 if (fe->ops.i2c_gate_ctrl) 347 fe->ops.i2c_gate_ctrl(fe, 0); 348 } 349 } 350 351 void dvb_frontend_reinitialise(struct dvb_frontend *fe) 352 { 353 struct dvb_frontend_private *fepriv = fe->frontend_priv; 354 355 fepriv->reinitialise = 1; 356 dvb_frontend_wakeup(fe); 357 } 358 EXPORT_SYMBOL(dvb_frontend_reinitialise); 359 360 static void dvb_frontend_swzigzag_update_delay(struct dvb_frontend_private *fepriv, int locked) 361 { 362 int q2; 363 struct dvb_frontend *fe = fepriv->dvbdev->priv; 364 365 dev_dbg(fe->dvb->device, "%s:\n", __func__); 366 367 if (locked) 368 (fepriv->quality) = (fepriv->quality * 220 + 36 * 256) / 256; 369 else 370 (fepriv->quality) = (fepriv->quality * 220 + 0) / 256; 371 372 q2 = fepriv->quality - 128; 373 q2 *= q2; 374 375 fepriv->delay = fepriv->min_delay + q2 * HZ / (128 * 128); 376 } 377 378 /** 379 * dvb_frontend_swzigzag_autotune - Performs automatic twiddling of frontend 380 * parameters. 381 * 382 * @fe: The frontend concerned. 383 * @check_wrapped: Checks if an iteration has completed. 384 * DO NOT SET ON THE FIRST ATTEMPT. 385 * 386 * return: Number of complete iterations that have been performed. 387 */ 388 static int dvb_frontend_swzigzag_autotune(struct dvb_frontend *fe, int check_wrapped) 389 { 390 int autoinversion; 391 int ready = 0; 392 int fe_set_err = 0; 393 struct dvb_frontend_private *fepriv = fe->frontend_priv; 394 struct dtv_frontend_properties *c = &fe->dtv_property_cache, tmp; 395 int original_inversion = c->inversion; 396 u32 original_frequency = c->frequency; 397 398 /* are we using autoinversion? */ 399 autoinversion = ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) && 400 (c->inversion == INVERSION_AUTO)); 401 402 /* setup parameters correctly */ 403 while (!ready) { 404 /* calculate the lnb_drift */ 405 fepriv->lnb_drift = fepriv->auto_step * fepriv->step_size; 406 407 /* wrap the auto_step if we've exceeded the maximum drift */ 408 if (fepriv->lnb_drift > fepriv->max_drift) { 409 fepriv->auto_step = 0; 410 fepriv->auto_sub_step = 0; 411 fepriv->lnb_drift = 0; 412 } 413 414 /* perform inversion and +/- zigzag */ 415 switch (fepriv->auto_sub_step) { 416 case 0: 417 /* try with the current inversion and current drift setting */ 418 ready = 1; 419 break; 420 421 case 1: 422 if (!autoinversion) break; 423 424 fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF; 425 ready = 1; 426 break; 427 428 case 2: 429 if (fepriv->lnb_drift == 0) break; 430 431 fepriv->lnb_drift = -fepriv->lnb_drift; 432 ready = 1; 433 break; 434 435 case 3: 436 if (fepriv->lnb_drift == 0) break; 437 if (!autoinversion) break; 438 439 fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF; 440 fepriv->lnb_drift = -fepriv->lnb_drift; 441 ready = 1; 442 break; 443 444 default: 445 fepriv->auto_step++; 446 fepriv->auto_sub_step = -1; /* it'll be incremented to 0 in a moment */ 447 break; 448 } 449 450 if (!ready) fepriv->auto_sub_step++; 451 } 452 453 /* if this attempt would hit where we started, indicate a complete 454 * iteration has occurred */ 455 if ((fepriv->auto_step == fepriv->started_auto_step) && 456 (fepriv->auto_sub_step == 0) && check_wrapped) { 457 return 1; 458 } 459 460 dev_dbg(fe->dvb->device, 461 "%s: drift:%i inversion:%i auto_step:%i auto_sub_step:%i started_auto_step:%i\n", 462 __func__, fepriv->lnb_drift, fepriv->inversion, 463 fepriv->auto_step, fepriv->auto_sub_step, 464 fepriv->started_auto_step); 465 466 /* set the frontend itself */ 467 c->frequency += fepriv->lnb_drift; 468 if (autoinversion) 469 c->inversion = fepriv->inversion; 470 tmp = *c; 471 if (fe->ops.set_frontend) 472 fe_set_err = fe->ops.set_frontend(fe); 473 *c = tmp; 474 if (fe_set_err < 0) { 475 fepriv->state = FESTATE_ERROR; 476 return fe_set_err; 477 } 478 479 c->frequency = original_frequency; 480 c->inversion = original_inversion; 481 482 fepriv->auto_sub_step++; 483 return 0; 484 } 485 486 static void dvb_frontend_swzigzag(struct dvb_frontend *fe) 487 { 488 enum fe_status s = FE_NONE; 489 int retval = 0; 490 struct dvb_frontend_private *fepriv = fe->frontend_priv; 491 struct dtv_frontend_properties *c = &fe->dtv_property_cache, tmp; 492 493 /* if we've got no parameters, just keep idling */ 494 if (fepriv->state & FESTATE_IDLE) { 495 fepriv->delay = 3 * HZ; 496 fepriv->quality = 0; 497 return; 498 } 499 500 /* in SCAN mode, we just set the frontend when asked and leave it alone */ 501 if (fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT) { 502 if (fepriv->state & FESTATE_RETUNE) { 503 tmp = *c; 504 if (fe->ops.set_frontend) 505 retval = fe->ops.set_frontend(fe); 506 *c = tmp; 507 if (retval < 0) 508 fepriv->state = FESTATE_ERROR; 509 else 510 fepriv->state = FESTATE_TUNED; 511 } 512 fepriv->delay = 3 * HZ; 513 fepriv->quality = 0; 514 return; 515 } 516 517 /* get the frontend status */ 518 if (fepriv->state & FESTATE_RETUNE) { 519 s = 0; 520 } else { 521 if (fe->ops.read_status) 522 fe->ops.read_status(fe, &s); 523 if (s != fepriv->status) { 524 dvb_frontend_add_event(fe, s); 525 fepriv->status = s; 526 } 527 } 528 529 /* if we're not tuned, and we have a lock, move to the TUNED state */ 530 if ((fepriv->state & FESTATE_WAITFORLOCK) && (s & FE_HAS_LOCK)) { 531 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 532 fepriv->state = FESTATE_TUNED; 533 534 /* if we're tuned, then we have determined the correct inversion */ 535 if ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) && 536 (c->inversion == INVERSION_AUTO)) { 537 c->inversion = fepriv->inversion; 538 } 539 return; 540 } 541 542 /* if we are tuned already, check we're still locked */ 543 if (fepriv->state & FESTATE_TUNED) { 544 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 545 546 /* we're tuned, and the lock is still good... */ 547 if (s & FE_HAS_LOCK) { 548 return; 549 } else { /* if we _WERE_ tuned, but now don't have a lock */ 550 fepriv->state = FESTATE_ZIGZAG_FAST; 551 fepriv->started_auto_step = fepriv->auto_step; 552 fepriv->check_wrapped = 0; 553 } 554 } 555 556 /* don't actually do anything if we're in the LOSTLOCK state, 557 * the frontend is set to FE_CAN_RECOVER, and the max_drift is 0 */ 558 if ((fepriv->state & FESTATE_LOSTLOCK) && 559 (fe->ops.info.caps & FE_CAN_RECOVER) && (fepriv->max_drift == 0)) { 560 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 561 return; 562 } 563 564 /* don't do anything if we're in the DISEQC state, since this 565 * might be someone with a motorized dish controlled by DISEQC. 566 * If its actually a re-tune, there will be a SET_FRONTEND soon enough. */ 567 if (fepriv->state & FESTATE_DISEQC) { 568 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 569 return; 570 } 571 572 /* if we're in the RETUNE state, set everything up for a brand 573 * new scan, keeping the current inversion setting, as the next 574 * tune is _very_ likely to require the same */ 575 if (fepriv->state & FESTATE_RETUNE) { 576 fepriv->lnb_drift = 0; 577 fepriv->auto_step = 0; 578 fepriv->auto_sub_step = 0; 579 fepriv->started_auto_step = 0; 580 fepriv->check_wrapped = 0; 581 } 582 583 /* fast zigzag. */ 584 if ((fepriv->state & FESTATE_SEARCHING_FAST) || (fepriv->state & FESTATE_RETUNE)) { 585 fepriv->delay = fepriv->min_delay; 586 587 /* perform a tune */ 588 retval = dvb_frontend_swzigzag_autotune(fe, 589 fepriv->check_wrapped); 590 if (retval < 0) { 591 return; 592 } else if (retval) { 593 /* OK, if we've run out of trials at the fast speed. 594 * Drop back to slow for the _next_ attempt */ 595 fepriv->state = FESTATE_SEARCHING_SLOW; 596 fepriv->started_auto_step = fepriv->auto_step; 597 return; 598 } 599 fepriv->check_wrapped = 1; 600 601 /* if we've just re-tuned, enter the ZIGZAG_FAST state. 602 * This ensures we cannot return from an 603 * FE_SET_FRONTEND ioctl before the first frontend tune 604 * occurs */ 605 if (fepriv->state & FESTATE_RETUNE) { 606 fepriv->state = FESTATE_TUNING_FAST; 607 } 608 } 609 610 /* slow zigzag */ 611 if (fepriv->state & FESTATE_SEARCHING_SLOW) { 612 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 613 614 /* Note: don't bother checking for wrapping; we stay in this 615 * state until we get a lock */ 616 dvb_frontend_swzigzag_autotune(fe, 0); 617 } 618 } 619 620 static int dvb_frontend_is_exiting(struct dvb_frontend *fe) 621 { 622 struct dvb_frontend_private *fepriv = fe->frontend_priv; 623 624 if (fe->exit != DVB_FE_NO_EXIT) 625 return 1; 626 627 if (fepriv->dvbdev->writers == 1) 628 if (time_after_eq(jiffies, fepriv->release_jiffies + 629 dvb_shutdown_timeout * HZ)) 630 return 1; 631 632 return 0; 633 } 634 635 static int dvb_frontend_should_wakeup(struct dvb_frontend *fe) 636 { 637 struct dvb_frontend_private *fepriv = fe->frontend_priv; 638 639 if (fepriv->wakeup) { 640 fepriv->wakeup = 0; 641 return 1; 642 } 643 return dvb_frontend_is_exiting(fe); 644 } 645 646 static void dvb_frontend_wakeup(struct dvb_frontend *fe) 647 { 648 struct dvb_frontend_private *fepriv = fe->frontend_priv; 649 650 fepriv->wakeup = 1; 651 wake_up_interruptible(&fepriv->wait_queue); 652 } 653 654 static int dvb_frontend_thread(void *data) 655 { 656 struct dvb_frontend *fe = data; 657 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 658 struct dvb_frontend_private *fepriv = fe->frontend_priv; 659 enum fe_status s = FE_NONE; 660 enum dvbfe_algo algo; 661 bool re_tune = false; 662 bool semheld = false; 663 664 dev_dbg(fe->dvb->device, "%s:\n", __func__); 665 666 fepriv->check_wrapped = 0; 667 fepriv->quality = 0; 668 fepriv->delay = 3 * HZ; 669 fepriv->status = 0; 670 fepriv->wakeup = 0; 671 fepriv->reinitialise = 0; 672 673 dvb_frontend_init(fe); 674 675 set_freezable(); 676 while (1) { 677 up(&fepriv->sem); /* is locked when we enter the thread... */ 678 restart: 679 wait_event_interruptible_timeout(fepriv->wait_queue, 680 dvb_frontend_should_wakeup(fe) || 681 kthread_should_stop() || 682 freezing(current), 683 fepriv->delay); 684 685 if (kthread_should_stop() || dvb_frontend_is_exiting(fe)) { 686 /* got signal or quitting */ 687 if (!down_interruptible(&fepriv->sem)) 688 semheld = true; 689 fe->exit = DVB_FE_NORMAL_EXIT; 690 break; 691 } 692 693 if (try_to_freeze()) 694 goto restart; 695 696 if (down_interruptible(&fepriv->sem)) 697 break; 698 699 if (fepriv->reinitialise) { 700 dvb_frontend_init(fe); 701 if (fe->ops.set_tone && fepriv->tone != -1) 702 fe->ops.set_tone(fe, fepriv->tone); 703 if (fe->ops.set_voltage && fepriv->voltage != -1) 704 fe->ops.set_voltage(fe, fepriv->voltage); 705 fepriv->reinitialise = 0; 706 } 707 708 /* do an iteration of the tuning loop */ 709 if (fe->ops.get_frontend_algo) { 710 algo = fe->ops.get_frontend_algo(fe); 711 switch (algo) { 712 case DVBFE_ALGO_HW: 713 dev_dbg(fe->dvb->device, "%s: Frontend ALGO = DVBFE_ALGO_HW\n", __func__); 714 715 if (fepriv->state & FESTATE_RETUNE) { 716 dev_dbg(fe->dvb->device, "%s: Retune requested, FESTATE_RETUNE\n", __func__); 717 re_tune = true; 718 fepriv->state = FESTATE_TUNED; 719 } else { 720 re_tune = false; 721 } 722 723 if (fe->ops.tune) 724 fe->ops.tune(fe, re_tune, fepriv->tune_mode_flags, &fepriv->delay, &s); 725 726 if (s != fepriv->status && !(fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT)) { 727 dev_dbg(fe->dvb->device, "%s: state changed, adding current state\n", __func__); 728 dvb_frontend_add_event(fe, s); 729 fepriv->status = s; 730 } 731 break; 732 case DVBFE_ALGO_SW: 733 dev_dbg(fe->dvb->device, "%s: Frontend ALGO = DVBFE_ALGO_SW\n", __func__); 734 dvb_frontend_swzigzag(fe); 735 break; 736 case DVBFE_ALGO_CUSTOM: 737 dev_dbg(fe->dvb->device, "%s: Frontend ALGO = DVBFE_ALGO_CUSTOM, state=%d\n", __func__, fepriv->state); 738 if (fepriv->state & FESTATE_RETUNE) { 739 dev_dbg(fe->dvb->device, "%s: Retune requested, FESTAT_RETUNE\n", __func__); 740 fepriv->state = FESTATE_TUNED; 741 } 742 /* Case where we are going to search for a carrier 743 * User asked us to retune again for some reason, possibly 744 * requesting a search with a new set of parameters 745 */ 746 if (fepriv->algo_status & DVBFE_ALGO_SEARCH_AGAIN) { 747 if (fe->ops.search) { 748 fepriv->algo_status = fe->ops.search(fe); 749 /* We did do a search as was requested, the flags are 750 * now unset as well and has the flags wrt to search. 751 */ 752 } else { 753 fepriv->algo_status &= ~DVBFE_ALGO_SEARCH_AGAIN; 754 } 755 } 756 /* Track the carrier if the search was successful */ 757 if (fepriv->algo_status != DVBFE_ALGO_SEARCH_SUCCESS) { 758 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 759 fepriv->delay = HZ / 2; 760 } 761 dtv_property_legacy_params_sync(fe, c, &fepriv->parameters_out); 762 fe->ops.read_status(fe, &s); 763 if (s != fepriv->status) { 764 dvb_frontend_add_event(fe, s); /* update event list */ 765 fepriv->status = s; 766 if (!(s & FE_HAS_LOCK)) { 767 fepriv->delay = HZ / 10; 768 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 769 } else { 770 fepriv->delay = 60 * HZ; 771 } 772 } 773 break; 774 default: 775 dev_dbg(fe->dvb->device, "%s: UNDEFINED ALGO !\n", __func__); 776 break; 777 } 778 } else { 779 dvb_frontend_swzigzag(fe); 780 } 781 } 782 783 if (dvb_powerdown_on_sleep) { 784 if (fe->ops.set_voltage) 785 fe->ops.set_voltage(fe, SEC_VOLTAGE_OFF); 786 if (fe->ops.tuner_ops.sleep) { 787 if (fe->ops.i2c_gate_ctrl) 788 fe->ops.i2c_gate_ctrl(fe, 1); 789 fe->ops.tuner_ops.sleep(fe); 790 if (fe->ops.i2c_gate_ctrl) 791 fe->ops.i2c_gate_ctrl(fe, 0); 792 } 793 if (fe->ops.sleep) 794 fe->ops.sleep(fe); 795 } 796 797 fepriv->thread = NULL; 798 if (kthread_should_stop()) 799 fe->exit = DVB_FE_DEVICE_REMOVED; 800 else 801 fe->exit = DVB_FE_NO_EXIT; 802 mb(); 803 804 if (semheld) 805 up(&fepriv->sem); 806 dvb_frontend_wakeup(fe); 807 return 0; 808 } 809 810 static void dvb_frontend_stop(struct dvb_frontend *fe) 811 { 812 struct dvb_frontend_private *fepriv = fe->frontend_priv; 813 814 dev_dbg(fe->dvb->device, "%s:\n", __func__); 815 816 if (fe->exit != DVB_FE_DEVICE_REMOVED) 817 fe->exit = DVB_FE_NORMAL_EXIT; 818 mb(); 819 820 if (!fepriv->thread) 821 return; 822 823 kthread_stop(fepriv->thread); 824 825 sema_init(&fepriv->sem, 1); 826 fepriv->state = FESTATE_IDLE; 827 828 /* paranoia check in case a signal arrived */ 829 if (fepriv->thread) 830 dev_warn(fe->dvb->device, 831 "dvb_frontend_stop: warning: thread %p won't exit\n", 832 fepriv->thread); 833 } 834 835 /* 836 * Sleep for the amount of time given by add_usec parameter 837 * 838 * This needs to be as precise as possible, as it affects the detection of 839 * the dish tone command at the satellite subsystem. The precision is improved 840 * by using a scheduled msleep followed by udelay for the remainder. 841 */ 842 void dvb_frontend_sleep_until(ktime_t *waketime, u32 add_usec) 843 { 844 s32 delta; 845 846 *waketime = ktime_add_us(*waketime, add_usec); 847 delta = ktime_us_delta(ktime_get_boottime(), *waketime); 848 if (delta > 2500) { 849 msleep((delta - 1500) / 1000); 850 delta = ktime_us_delta(ktime_get_boottime(), *waketime); 851 } 852 if (delta > 0) 853 udelay(delta); 854 } 855 EXPORT_SYMBOL(dvb_frontend_sleep_until); 856 857 static int dvb_frontend_start(struct dvb_frontend *fe) 858 { 859 int ret; 860 struct dvb_frontend_private *fepriv = fe->frontend_priv; 861 struct task_struct *fe_thread; 862 863 dev_dbg(fe->dvb->device, "%s:\n", __func__); 864 865 if (fepriv->thread) { 866 if (fe->exit == DVB_FE_NO_EXIT) 867 return 0; 868 else 869 dvb_frontend_stop(fe); 870 } 871 872 if (signal_pending(current)) 873 return -EINTR; 874 if (down_interruptible(&fepriv->sem)) 875 return -EINTR; 876 877 fepriv->state = FESTATE_IDLE; 878 fe->exit = DVB_FE_NO_EXIT; 879 fepriv->thread = NULL; 880 mb(); 881 882 fe_thread = kthread_run(dvb_frontend_thread, fe, 883 "kdvb-ad-%i-fe-%i", fe->dvb->num, fe->id); 884 if (IS_ERR(fe_thread)) { 885 ret = PTR_ERR(fe_thread); 886 dev_warn(fe->dvb->device, 887 "dvb_frontend_start: failed to start kthread (%d)\n", 888 ret); 889 up(&fepriv->sem); 890 return ret; 891 } 892 fepriv->thread = fe_thread; 893 return 0; 894 } 895 896 static void dvb_frontend_get_frequency_limits(struct dvb_frontend *fe, 897 u32 *freq_min, u32 *freq_max, 898 u32 *tolerance) 899 { 900 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 901 u32 tuner_min = fe->ops.tuner_ops.info.frequency_min_hz; 902 u32 tuner_max = fe->ops.tuner_ops.info.frequency_max_hz; 903 u32 frontend_min = fe->ops.info.frequency_min_hz; 904 u32 frontend_max = fe->ops.info.frequency_max_hz; 905 906 *freq_min = max(frontend_min, tuner_min); 907 908 if (frontend_max == 0) 909 *freq_max = tuner_max; 910 else if (tuner_max == 0) 911 *freq_max = frontend_max; 912 else 913 *freq_max = min(frontend_max, tuner_max); 914 915 if (*freq_min == 0 || *freq_max == 0) 916 dev_warn(fe->dvb->device, 917 "DVB: adapter %i frontend %u frequency limits undefined - fix the driver\n", 918 fe->dvb->num, fe->id); 919 920 /* If the standard is for satellite, convert frequencies to kHz */ 921 switch (c->delivery_system) { 922 case SYS_DVBS: 923 case SYS_DVBS2: 924 case SYS_TURBO: 925 case SYS_ISDBS: 926 *freq_min /= kHz; 927 *freq_max /= kHz; 928 if (tolerance) 929 *tolerance = fe->ops.info.frequency_tolerance_hz / kHz; 930 931 break; 932 default: 933 if (tolerance) 934 *tolerance = fe->ops.info.frequency_tolerance_hz; 935 break; 936 } 937 } 938 939 static u32 dvb_frontend_get_stepsize(struct dvb_frontend *fe) 940 { 941 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 942 u32 step = fe->ops.info.frequency_stepsize_hz; 943 switch (c->delivery_system) { 944 case SYS_DVBS: 945 case SYS_DVBS2: 946 case SYS_TURBO: 947 case SYS_ISDBS: 948 step /= kHz; 949 break; 950 default: 951 break; 952 } 953 954 return step; 955 } 956 957 static int dvb_frontend_check_parameters(struct dvb_frontend *fe) 958 { 959 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 960 u32 freq_min; 961 u32 freq_max; 962 963 /* range check: frequency */ 964 dvb_frontend_get_frequency_limits(fe, &freq_min, &freq_max, NULL); 965 if ((freq_min && c->frequency < freq_min) || 966 (freq_max && c->frequency > freq_max)) { 967 dev_warn(fe->dvb->device, "DVB: adapter %i frontend %i frequency %u out of range (%u..%u)\n", 968 fe->dvb->num, fe->id, c->frequency, 969 freq_min, freq_max); 970 return -EINVAL; 971 } 972 973 /* range check: symbol rate */ 974 switch (c->delivery_system) { 975 case SYS_DVBS: 976 case SYS_DVBS2: 977 case SYS_TURBO: 978 case SYS_DVBC_ANNEX_A: 979 case SYS_DVBC_ANNEX_C: 980 if ((fe->ops.info.symbol_rate_min && 981 c->symbol_rate < fe->ops.info.symbol_rate_min) || 982 (fe->ops.info.symbol_rate_max && 983 c->symbol_rate > fe->ops.info.symbol_rate_max)) { 984 dev_warn(fe->dvb->device, "DVB: adapter %i frontend %i symbol rate %u out of range (%u..%u)\n", 985 fe->dvb->num, fe->id, c->symbol_rate, 986 fe->ops.info.symbol_rate_min, 987 fe->ops.info.symbol_rate_max); 988 return -EINVAL; 989 } 990 default: 991 break; 992 } 993 994 return 0; 995 } 996 997 static int dvb_frontend_clear_cache(struct dvb_frontend *fe) 998 { 999 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1000 int i; 1001 u32 delsys; 1002 1003 delsys = c->delivery_system; 1004 memset(c, 0, offsetof(struct dtv_frontend_properties, strength)); 1005 c->delivery_system = delsys; 1006 1007 dev_dbg(fe->dvb->device, "%s: Clearing cache for delivery system %d\n", 1008 __func__, c->delivery_system); 1009 1010 c->transmission_mode = TRANSMISSION_MODE_AUTO; 1011 c->bandwidth_hz = 0; /* AUTO */ 1012 c->guard_interval = GUARD_INTERVAL_AUTO; 1013 c->hierarchy = HIERARCHY_AUTO; 1014 c->symbol_rate = 0; 1015 c->code_rate_HP = FEC_AUTO; 1016 c->code_rate_LP = FEC_AUTO; 1017 c->fec_inner = FEC_AUTO; 1018 c->rolloff = ROLLOFF_AUTO; 1019 c->voltage = SEC_VOLTAGE_OFF; 1020 c->sectone = SEC_TONE_OFF; 1021 c->pilot = PILOT_AUTO; 1022 1023 c->isdbt_partial_reception = 0; 1024 c->isdbt_sb_mode = 0; 1025 c->isdbt_sb_subchannel = 0; 1026 c->isdbt_sb_segment_idx = 0; 1027 c->isdbt_sb_segment_count = 0; 1028 c->isdbt_layer_enabled = 7; /* All layers (A,B,C) */ 1029 for (i = 0; i < 3; i++) { 1030 c->layer[i].fec = FEC_AUTO; 1031 c->layer[i].modulation = QAM_AUTO; 1032 c->layer[i].interleaving = 0; 1033 c->layer[i].segment_count = 0; 1034 } 1035 1036 c->stream_id = NO_STREAM_ID_FILTER; 1037 c->scrambling_sequence_index = 0;/* default sequence */ 1038 1039 switch (c->delivery_system) { 1040 case SYS_DVBS: 1041 case SYS_DVBS2: 1042 case SYS_TURBO: 1043 c->modulation = QPSK; /* implied for DVB-S in legacy API */ 1044 c->rolloff = ROLLOFF_35;/* implied for DVB-S */ 1045 break; 1046 case SYS_ATSC: 1047 c->modulation = VSB_8; 1048 break; 1049 case SYS_ISDBS: 1050 c->symbol_rate = 28860000; 1051 c->rolloff = ROLLOFF_35; 1052 c->bandwidth_hz = c->symbol_rate / 100 * 135; 1053 break; 1054 default: 1055 c->modulation = QAM_AUTO; 1056 break; 1057 } 1058 1059 c->lna = LNA_AUTO; 1060 1061 return 0; 1062 } 1063 1064 #define _DTV_CMD(n, s, b) \ 1065 [n] = { \ 1066 .name = #n, \ 1067 .cmd = n, \ 1068 .set = s,\ 1069 .buffer = b \ 1070 } 1071 1072 struct dtv_cmds_h { 1073 char *name; /* A display name for debugging purposes */ 1074 1075 __u32 cmd; /* A unique ID */ 1076 1077 /* Flags */ 1078 __u32 set:1; /* Either a set or get property */ 1079 __u32 buffer:1; /* Does this property use the buffer? */ 1080 __u32 reserved:30; /* Align */ 1081 }; 1082 1083 static struct dtv_cmds_h dtv_cmds[DTV_MAX_COMMAND + 1] = { 1084 _DTV_CMD(DTV_TUNE, 1, 0), 1085 _DTV_CMD(DTV_CLEAR, 1, 0), 1086 1087 /* Set */ 1088 _DTV_CMD(DTV_FREQUENCY, 1, 0), 1089 _DTV_CMD(DTV_BANDWIDTH_HZ, 1, 0), 1090 _DTV_CMD(DTV_MODULATION, 1, 0), 1091 _DTV_CMD(DTV_INVERSION, 1, 0), 1092 _DTV_CMD(DTV_DISEQC_MASTER, 1, 1), 1093 _DTV_CMD(DTV_SYMBOL_RATE, 1, 0), 1094 _DTV_CMD(DTV_INNER_FEC, 1, 0), 1095 _DTV_CMD(DTV_VOLTAGE, 1, 0), 1096 _DTV_CMD(DTV_TONE, 1, 0), 1097 _DTV_CMD(DTV_PILOT, 1, 0), 1098 _DTV_CMD(DTV_ROLLOFF, 1, 0), 1099 _DTV_CMD(DTV_DELIVERY_SYSTEM, 1, 0), 1100 _DTV_CMD(DTV_HIERARCHY, 1, 0), 1101 _DTV_CMD(DTV_CODE_RATE_HP, 1, 0), 1102 _DTV_CMD(DTV_CODE_RATE_LP, 1, 0), 1103 _DTV_CMD(DTV_GUARD_INTERVAL, 1, 0), 1104 _DTV_CMD(DTV_TRANSMISSION_MODE, 1, 0), 1105 _DTV_CMD(DTV_INTERLEAVING, 1, 0), 1106 1107 _DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 1, 0), 1108 _DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 1, 0), 1109 _DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 1, 0), 1110 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 1, 0), 1111 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 1, 0), 1112 _DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 1, 0), 1113 _DTV_CMD(DTV_ISDBT_LAYERA_FEC, 1, 0), 1114 _DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 1, 0), 1115 _DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 1, 0), 1116 _DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 1, 0), 1117 _DTV_CMD(DTV_ISDBT_LAYERB_FEC, 1, 0), 1118 _DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 1, 0), 1119 _DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 1, 0), 1120 _DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 1, 0), 1121 _DTV_CMD(DTV_ISDBT_LAYERC_FEC, 1, 0), 1122 _DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 1, 0), 1123 _DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 1, 0), 1124 _DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 1, 0), 1125 1126 _DTV_CMD(DTV_STREAM_ID, 1, 0), 1127 _DTV_CMD(DTV_DVBT2_PLP_ID_LEGACY, 1, 0), 1128 _DTV_CMD(DTV_SCRAMBLING_SEQUENCE_INDEX, 1, 0), 1129 _DTV_CMD(DTV_LNA, 1, 0), 1130 1131 /* Get */ 1132 _DTV_CMD(DTV_DISEQC_SLAVE_REPLY, 0, 1), 1133 _DTV_CMD(DTV_API_VERSION, 0, 0), 1134 1135 _DTV_CMD(DTV_ENUM_DELSYS, 0, 0), 1136 1137 _DTV_CMD(DTV_ATSCMH_PARADE_ID, 1, 0), 1138 _DTV_CMD(DTV_ATSCMH_RS_FRAME_ENSEMBLE, 1, 0), 1139 1140 _DTV_CMD(DTV_ATSCMH_FIC_VER, 0, 0), 1141 _DTV_CMD(DTV_ATSCMH_NOG, 0, 0), 1142 _DTV_CMD(DTV_ATSCMH_TNOG, 0, 0), 1143 _DTV_CMD(DTV_ATSCMH_SGN, 0, 0), 1144 _DTV_CMD(DTV_ATSCMH_PRC, 0, 0), 1145 _DTV_CMD(DTV_ATSCMH_RS_FRAME_MODE, 0, 0), 1146 _DTV_CMD(DTV_ATSCMH_RS_CODE_MODE_PRI, 0, 0), 1147 _DTV_CMD(DTV_ATSCMH_RS_CODE_MODE_SEC, 0, 0), 1148 _DTV_CMD(DTV_ATSCMH_SCCC_BLOCK_MODE, 0, 0), 1149 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_A, 0, 0), 1150 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_B, 0, 0), 1151 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_C, 0, 0), 1152 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_D, 0, 0), 1153 1154 /* Statistics API */ 1155 _DTV_CMD(DTV_STAT_SIGNAL_STRENGTH, 0, 0), 1156 _DTV_CMD(DTV_STAT_CNR, 0, 0), 1157 _DTV_CMD(DTV_STAT_PRE_ERROR_BIT_COUNT, 0, 0), 1158 _DTV_CMD(DTV_STAT_PRE_TOTAL_BIT_COUNT, 0, 0), 1159 _DTV_CMD(DTV_STAT_POST_ERROR_BIT_COUNT, 0, 0), 1160 _DTV_CMD(DTV_STAT_POST_TOTAL_BIT_COUNT, 0, 0), 1161 _DTV_CMD(DTV_STAT_ERROR_BLOCK_COUNT, 0, 0), 1162 _DTV_CMD(DTV_STAT_TOTAL_BLOCK_COUNT, 0, 0), 1163 }; 1164 1165 /* Synchronise the legacy tuning parameters into the cache, so that demodulator 1166 * drivers can use a single set_frontend tuning function, regardless of whether 1167 * it's being used for the legacy or new API, reducing code and complexity. 1168 */ 1169 static int dtv_property_cache_sync(struct dvb_frontend *fe, 1170 struct dtv_frontend_properties *c, 1171 const struct dvb_frontend_parameters *p) 1172 { 1173 c->frequency = p->frequency; 1174 c->inversion = p->inversion; 1175 1176 switch (dvbv3_type(c->delivery_system)) { 1177 case DVBV3_QPSK: 1178 dev_dbg(fe->dvb->device, "%s: Preparing QPSK req\n", __func__); 1179 c->symbol_rate = p->u.qpsk.symbol_rate; 1180 c->fec_inner = p->u.qpsk.fec_inner; 1181 break; 1182 case DVBV3_QAM: 1183 dev_dbg(fe->dvb->device, "%s: Preparing QAM req\n", __func__); 1184 c->symbol_rate = p->u.qam.symbol_rate; 1185 c->fec_inner = p->u.qam.fec_inner; 1186 c->modulation = p->u.qam.modulation; 1187 break; 1188 case DVBV3_OFDM: 1189 dev_dbg(fe->dvb->device, "%s: Preparing OFDM req\n", __func__); 1190 1191 switch (p->u.ofdm.bandwidth) { 1192 case BANDWIDTH_10_MHZ: 1193 c->bandwidth_hz = 10000000; 1194 break; 1195 case BANDWIDTH_8_MHZ: 1196 c->bandwidth_hz = 8000000; 1197 break; 1198 case BANDWIDTH_7_MHZ: 1199 c->bandwidth_hz = 7000000; 1200 break; 1201 case BANDWIDTH_6_MHZ: 1202 c->bandwidth_hz = 6000000; 1203 break; 1204 case BANDWIDTH_5_MHZ: 1205 c->bandwidth_hz = 5000000; 1206 break; 1207 case BANDWIDTH_1_712_MHZ: 1208 c->bandwidth_hz = 1712000; 1209 break; 1210 case BANDWIDTH_AUTO: 1211 c->bandwidth_hz = 0; 1212 } 1213 1214 c->code_rate_HP = p->u.ofdm.code_rate_HP; 1215 c->code_rate_LP = p->u.ofdm.code_rate_LP; 1216 c->modulation = p->u.ofdm.constellation; 1217 c->transmission_mode = p->u.ofdm.transmission_mode; 1218 c->guard_interval = p->u.ofdm.guard_interval; 1219 c->hierarchy = p->u.ofdm.hierarchy_information; 1220 break; 1221 case DVBV3_ATSC: 1222 dev_dbg(fe->dvb->device, "%s: Preparing ATSC req\n", __func__); 1223 c->modulation = p->u.vsb.modulation; 1224 if (c->delivery_system == SYS_ATSCMH) 1225 break; 1226 if ((c->modulation == VSB_8) || (c->modulation == VSB_16)) 1227 c->delivery_system = SYS_ATSC; 1228 else 1229 c->delivery_system = SYS_DVBC_ANNEX_B; 1230 break; 1231 case DVBV3_UNKNOWN: 1232 dev_err(fe->dvb->device, 1233 "%s: doesn't know how to handle a DVBv3 call to delivery system %i\n", 1234 __func__, c->delivery_system); 1235 return -EINVAL; 1236 } 1237 1238 return 0; 1239 } 1240 1241 /* Ensure the cached values are set correctly in the frontend 1242 * legacy tuning structures, for the advanced tuning API. 1243 */ 1244 static int 1245 dtv_property_legacy_params_sync(struct dvb_frontend *fe, 1246 const struct dtv_frontend_properties *c, 1247 struct dvb_frontend_parameters *p) 1248 { 1249 p->frequency = c->frequency; 1250 p->inversion = c->inversion; 1251 1252 switch (dvbv3_type(c->delivery_system)) { 1253 case DVBV3_UNKNOWN: 1254 dev_err(fe->dvb->device, 1255 "%s: doesn't know how to handle a DVBv3 call to delivery system %i\n", 1256 __func__, c->delivery_system); 1257 return -EINVAL; 1258 case DVBV3_QPSK: 1259 dev_dbg(fe->dvb->device, "%s: Preparing QPSK req\n", __func__); 1260 p->u.qpsk.symbol_rate = c->symbol_rate; 1261 p->u.qpsk.fec_inner = c->fec_inner; 1262 break; 1263 case DVBV3_QAM: 1264 dev_dbg(fe->dvb->device, "%s: Preparing QAM req\n", __func__); 1265 p->u.qam.symbol_rate = c->symbol_rate; 1266 p->u.qam.fec_inner = c->fec_inner; 1267 p->u.qam.modulation = c->modulation; 1268 break; 1269 case DVBV3_OFDM: 1270 dev_dbg(fe->dvb->device, "%s: Preparing OFDM req\n", __func__); 1271 switch (c->bandwidth_hz) { 1272 case 10000000: 1273 p->u.ofdm.bandwidth = BANDWIDTH_10_MHZ; 1274 break; 1275 case 8000000: 1276 p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ; 1277 break; 1278 case 7000000: 1279 p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ; 1280 break; 1281 case 6000000: 1282 p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ; 1283 break; 1284 case 5000000: 1285 p->u.ofdm.bandwidth = BANDWIDTH_5_MHZ; 1286 break; 1287 case 1712000: 1288 p->u.ofdm.bandwidth = BANDWIDTH_1_712_MHZ; 1289 break; 1290 case 0: 1291 default: 1292 p->u.ofdm.bandwidth = BANDWIDTH_AUTO; 1293 } 1294 p->u.ofdm.code_rate_HP = c->code_rate_HP; 1295 p->u.ofdm.code_rate_LP = c->code_rate_LP; 1296 p->u.ofdm.constellation = c->modulation; 1297 p->u.ofdm.transmission_mode = c->transmission_mode; 1298 p->u.ofdm.guard_interval = c->guard_interval; 1299 p->u.ofdm.hierarchy_information = c->hierarchy; 1300 break; 1301 case DVBV3_ATSC: 1302 dev_dbg(fe->dvb->device, "%s: Preparing VSB req\n", __func__); 1303 p->u.vsb.modulation = c->modulation; 1304 break; 1305 } 1306 return 0; 1307 } 1308 1309 /** 1310 * dtv_get_frontend - calls a callback for retrieving DTV parameters 1311 * @fe: struct dvb_frontend pointer 1312 * @c: struct dtv_frontend_properties pointer (DVBv5 cache) 1313 * @p_out: struct dvb_frontend_parameters pointer (DVBv3 FE struct) 1314 * 1315 * This routine calls either the DVBv3 or DVBv5 get_frontend call. 1316 * If c is not null, it will update the DVBv5 cache struct pointed by it. 1317 * If p_out is not null, it will update the DVBv3 params pointed by it. 1318 */ 1319 static int dtv_get_frontend(struct dvb_frontend *fe, 1320 struct dtv_frontend_properties *c, 1321 struct dvb_frontend_parameters *p_out) 1322 { 1323 int r; 1324 1325 if (fe->ops.get_frontend) { 1326 r = fe->ops.get_frontend(fe, c); 1327 if (unlikely(r < 0)) 1328 return r; 1329 if (p_out) 1330 dtv_property_legacy_params_sync(fe, c, p_out); 1331 return 0; 1332 } 1333 1334 /* As everything is in cache, get_frontend fops are always supported */ 1335 return 0; 1336 } 1337 1338 static int dvb_frontend_handle_ioctl(struct file *file, 1339 unsigned int cmd, void *parg); 1340 1341 static int dtv_property_process_get(struct dvb_frontend *fe, 1342 const struct dtv_frontend_properties *c, 1343 struct dtv_property *tvp, 1344 struct file *file) 1345 { 1346 int ncaps; 1347 1348 switch (tvp->cmd) { 1349 case DTV_ENUM_DELSYS: 1350 ncaps = 0; 1351 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) { 1352 tvp->u.buffer.data[ncaps] = fe->ops.delsys[ncaps]; 1353 ncaps++; 1354 } 1355 tvp->u.buffer.len = ncaps; 1356 break; 1357 case DTV_FREQUENCY: 1358 tvp->u.data = c->frequency; 1359 break; 1360 case DTV_MODULATION: 1361 tvp->u.data = c->modulation; 1362 break; 1363 case DTV_BANDWIDTH_HZ: 1364 tvp->u.data = c->bandwidth_hz; 1365 break; 1366 case DTV_INVERSION: 1367 tvp->u.data = c->inversion; 1368 break; 1369 case DTV_SYMBOL_RATE: 1370 tvp->u.data = c->symbol_rate; 1371 break; 1372 case DTV_INNER_FEC: 1373 tvp->u.data = c->fec_inner; 1374 break; 1375 case DTV_PILOT: 1376 tvp->u.data = c->pilot; 1377 break; 1378 case DTV_ROLLOFF: 1379 tvp->u.data = c->rolloff; 1380 break; 1381 case DTV_DELIVERY_SYSTEM: 1382 tvp->u.data = c->delivery_system; 1383 break; 1384 case DTV_VOLTAGE: 1385 tvp->u.data = c->voltage; 1386 break; 1387 case DTV_TONE: 1388 tvp->u.data = c->sectone; 1389 break; 1390 case DTV_API_VERSION: 1391 tvp->u.data = (DVB_API_VERSION << 8) | DVB_API_VERSION_MINOR; 1392 break; 1393 case DTV_CODE_RATE_HP: 1394 tvp->u.data = c->code_rate_HP; 1395 break; 1396 case DTV_CODE_RATE_LP: 1397 tvp->u.data = c->code_rate_LP; 1398 break; 1399 case DTV_GUARD_INTERVAL: 1400 tvp->u.data = c->guard_interval; 1401 break; 1402 case DTV_TRANSMISSION_MODE: 1403 tvp->u.data = c->transmission_mode; 1404 break; 1405 case DTV_HIERARCHY: 1406 tvp->u.data = c->hierarchy; 1407 break; 1408 case DTV_INTERLEAVING: 1409 tvp->u.data = c->interleaving; 1410 break; 1411 1412 /* ISDB-T Support here */ 1413 case DTV_ISDBT_PARTIAL_RECEPTION: 1414 tvp->u.data = c->isdbt_partial_reception; 1415 break; 1416 case DTV_ISDBT_SOUND_BROADCASTING: 1417 tvp->u.data = c->isdbt_sb_mode; 1418 break; 1419 case DTV_ISDBT_SB_SUBCHANNEL_ID: 1420 tvp->u.data = c->isdbt_sb_subchannel; 1421 break; 1422 case DTV_ISDBT_SB_SEGMENT_IDX: 1423 tvp->u.data = c->isdbt_sb_segment_idx; 1424 break; 1425 case DTV_ISDBT_SB_SEGMENT_COUNT: 1426 tvp->u.data = c->isdbt_sb_segment_count; 1427 break; 1428 case DTV_ISDBT_LAYER_ENABLED: 1429 tvp->u.data = c->isdbt_layer_enabled; 1430 break; 1431 case DTV_ISDBT_LAYERA_FEC: 1432 tvp->u.data = c->layer[0].fec; 1433 break; 1434 case DTV_ISDBT_LAYERA_MODULATION: 1435 tvp->u.data = c->layer[0].modulation; 1436 break; 1437 case DTV_ISDBT_LAYERA_SEGMENT_COUNT: 1438 tvp->u.data = c->layer[0].segment_count; 1439 break; 1440 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING: 1441 tvp->u.data = c->layer[0].interleaving; 1442 break; 1443 case DTV_ISDBT_LAYERB_FEC: 1444 tvp->u.data = c->layer[1].fec; 1445 break; 1446 case DTV_ISDBT_LAYERB_MODULATION: 1447 tvp->u.data = c->layer[1].modulation; 1448 break; 1449 case DTV_ISDBT_LAYERB_SEGMENT_COUNT: 1450 tvp->u.data = c->layer[1].segment_count; 1451 break; 1452 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING: 1453 tvp->u.data = c->layer[1].interleaving; 1454 break; 1455 case DTV_ISDBT_LAYERC_FEC: 1456 tvp->u.data = c->layer[2].fec; 1457 break; 1458 case DTV_ISDBT_LAYERC_MODULATION: 1459 tvp->u.data = c->layer[2].modulation; 1460 break; 1461 case DTV_ISDBT_LAYERC_SEGMENT_COUNT: 1462 tvp->u.data = c->layer[2].segment_count; 1463 break; 1464 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING: 1465 tvp->u.data = c->layer[2].interleaving; 1466 break; 1467 1468 /* Multistream support */ 1469 case DTV_STREAM_ID: 1470 case DTV_DVBT2_PLP_ID_LEGACY: 1471 tvp->u.data = c->stream_id; 1472 break; 1473 1474 /* Physical layer scrambling support */ 1475 case DTV_SCRAMBLING_SEQUENCE_INDEX: 1476 tvp->u.data = c->scrambling_sequence_index; 1477 break; 1478 1479 /* ATSC-MH */ 1480 case DTV_ATSCMH_FIC_VER: 1481 tvp->u.data = fe->dtv_property_cache.atscmh_fic_ver; 1482 break; 1483 case DTV_ATSCMH_PARADE_ID: 1484 tvp->u.data = fe->dtv_property_cache.atscmh_parade_id; 1485 break; 1486 case DTV_ATSCMH_NOG: 1487 tvp->u.data = fe->dtv_property_cache.atscmh_nog; 1488 break; 1489 case DTV_ATSCMH_TNOG: 1490 tvp->u.data = fe->dtv_property_cache.atscmh_tnog; 1491 break; 1492 case DTV_ATSCMH_SGN: 1493 tvp->u.data = fe->dtv_property_cache.atscmh_sgn; 1494 break; 1495 case DTV_ATSCMH_PRC: 1496 tvp->u.data = fe->dtv_property_cache.atscmh_prc; 1497 break; 1498 case DTV_ATSCMH_RS_FRAME_MODE: 1499 tvp->u.data = fe->dtv_property_cache.atscmh_rs_frame_mode; 1500 break; 1501 case DTV_ATSCMH_RS_FRAME_ENSEMBLE: 1502 tvp->u.data = fe->dtv_property_cache.atscmh_rs_frame_ensemble; 1503 break; 1504 case DTV_ATSCMH_RS_CODE_MODE_PRI: 1505 tvp->u.data = fe->dtv_property_cache.atscmh_rs_code_mode_pri; 1506 break; 1507 case DTV_ATSCMH_RS_CODE_MODE_SEC: 1508 tvp->u.data = fe->dtv_property_cache.atscmh_rs_code_mode_sec; 1509 break; 1510 case DTV_ATSCMH_SCCC_BLOCK_MODE: 1511 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_block_mode; 1512 break; 1513 case DTV_ATSCMH_SCCC_CODE_MODE_A: 1514 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_a; 1515 break; 1516 case DTV_ATSCMH_SCCC_CODE_MODE_B: 1517 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_b; 1518 break; 1519 case DTV_ATSCMH_SCCC_CODE_MODE_C: 1520 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_c; 1521 break; 1522 case DTV_ATSCMH_SCCC_CODE_MODE_D: 1523 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_d; 1524 break; 1525 1526 case DTV_LNA: 1527 tvp->u.data = c->lna; 1528 break; 1529 1530 /* Fill quality measures */ 1531 case DTV_STAT_SIGNAL_STRENGTH: 1532 tvp->u.st = c->strength; 1533 break; 1534 case DTV_STAT_CNR: 1535 tvp->u.st = c->cnr; 1536 break; 1537 case DTV_STAT_PRE_ERROR_BIT_COUNT: 1538 tvp->u.st = c->pre_bit_error; 1539 break; 1540 case DTV_STAT_PRE_TOTAL_BIT_COUNT: 1541 tvp->u.st = c->pre_bit_count; 1542 break; 1543 case DTV_STAT_POST_ERROR_BIT_COUNT: 1544 tvp->u.st = c->post_bit_error; 1545 break; 1546 case DTV_STAT_POST_TOTAL_BIT_COUNT: 1547 tvp->u.st = c->post_bit_count; 1548 break; 1549 case DTV_STAT_ERROR_BLOCK_COUNT: 1550 tvp->u.st = c->block_error; 1551 break; 1552 case DTV_STAT_TOTAL_BLOCK_COUNT: 1553 tvp->u.st = c->block_count; 1554 break; 1555 default: 1556 dev_dbg(fe->dvb->device, 1557 "%s: FE property %d doesn't exist\n", 1558 __func__, tvp->cmd); 1559 return -EINVAL; 1560 } 1561 1562 if (!dtv_cmds[tvp->cmd].buffer) 1563 dev_dbg(fe->dvb->device, 1564 "%s: GET cmd 0x%08x (%s) = 0x%08x\n", 1565 __func__, tvp->cmd, dtv_cmds[tvp->cmd].name, 1566 tvp->u.data); 1567 else 1568 dev_dbg(fe->dvb->device, 1569 "%s: GET cmd 0x%08x (%s) len %d: %*ph\n", 1570 __func__, 1571 tvp->cmd, dtv_cmds[tvp->cmd].name, 1572 tvp->u.buffer.len, 1573 tvp->u.buffer.len, tvp->u.buffer.data); 1574 1575 return 0; 1576 } 1577 1578 static int dtv_set_frontend(struct dvb_frontend *fe); 1579 1580 static bool is_dvbv3_delsys(u32 delsys) 1581 { 1582 return (delsys == SYS_DVBT) || (delsys == SYS_DVBC_ANNEX_A) || 1583 (delsys == SYS_DVBS) || (delsys == SYS_ATSC); 1584 } 1585 1586 /** 1587 * emulate_delivery_system - emulate a DVBv5 delivery system with a DVBv3 type 1588 * @fe: struct frontend; 1589 * @delsys: DVBv5 type that will be used for emulation 1590 * 1591 * Provides emulation for delivery systems that are compatible with the old 1592 * DVBv3 call. Among its usages, it provices support for ISDB-T, and allows 1593 * using a DVB-S2 only frontend just like it were a DVB-S, if the frontent 1594 * parameters are compatible with DVB-S spec. 1595 */ 1596 static int emulate_delivery_system(struct dvb_frontend *fe, u32 delsys) 1597 { 1598 int i; 1599 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1600 1601 c->delivery_system = delsys; 1602 1603 /* 1604 * If the call is for ISDB-T, put it into full-seg, auto mode, TV 1605 */ 1606 if (c->delivery_system == SYS_ISDBT) { 1607 dev_dbg(fe->dvb->device, 1608 "%s: Using defaults for SYS_ISDBT\n", 1609 __func__); 1610 1611 if (!c->bandwidth_hz) 1612 c->bandwidth_hz = 6000000; 1613 1614 c->isdbt_partial_reception = 0; 1615 c->isdbt_sb_mode = 0; 1616 c->isdbt_sb_subchannel = 0; 1617 c->isdbt_sb_segment_idx = 0; 1618 c->isdbt_sb_segment_count = 0; 1619 c->isdbt_layer_enabled = 7; 1620 for (i = 0; i < 3; i++) { 1621 c->layer[i].fec = FEC_AUTO; 1622 c->layer[i].modulation = QAM_AUTO; 1623 c->layer[i].interleaving = 0; 1624 c->layer[i].segment_count = 0; 1625 } 1626 } 1627 dev_dbg(fe->dvb->device, "%s: change delivery system on cache to %d\n", 1628 __func__, c->delivery_system); 1629 1630 return 0; 1631 } 1632 1633 /** 1634 * dvbv5_set_delivery_system - Sets the delivery system for a DVBv5 API call 1635 * @fe: frontend struct 1636 * @desired_system: delivery system requested by the user 1637 * 1638 * A DVBv5 call know what's the desired system it wants. So, set it. 1639 * 1640 * There are, however, a few known issues with early DVBv5 applications that 1641 * are also handled by this logic: 1642 * 1643 * 1) Some early apps use SYS_UNDEFINED as the desired delivery system. 1644 * This is an API violation, but, as we don't want to break userspace, 1645 * convert it to the first supported delivery system. 1646 * 2) Some apps might be using a DVBv5 call in a wrong way, passing, for 1647 * example, SYS_DVBT instead of SYS_ISDBT. This is because early usage of 1648 * ISDB-T provided backward compat with DVB-T. 1649 */ 1650 static int dvbv5_set_delivery_system(struct dvb_frontend *fe, 1651 u32 desired_system) 1652 { 1653 int ncaps; 1654 u32 delsys = SYS_UNDEFINED; 1655 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1656 enum dvbv3_emulation_type type; 1657 1658 /* 1659 * It was reported that some old DVBv5 applications were 1660 * filling delivery_system with SYS_UNDEFINED. If this happens, 1661 * assume that the application wants to use the first supported 1662 * delivery system. 1663 */ 1664 if (desired_system == SYS_UNDEFINED) 1665 desired_system = fe->ops.delsys[0]; 1666 1667 /* 1668 * This is a DVBv5 call. So, it likely knows the supported 1669 * delivery systems. So, check if the desired delivery system is 1670 * supported 1671 */ 1672 ncaps = 0; 1673 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) { 1674 if (fe->ops.delsys[ncaps] == desired_system) { 1675 c->delivery_system = desired_system; 1676 dev_dbg(fe->dvb->device, 1677 "%s: Changing delivery system to %d\n", 1678 __func__, desired_system); 1679 return 0; 1680 } 1681 ncaps++; 1682 } 1683 1684 /* 1685 * The requested delivery system isn't supported. Maybe userspace 1686 * is requesting a DVBv3 compatible delivery system. 1687 * 1688 * The emulation only works if the desired system is one of the 1689 * delivery systems supported by DVBv3 API 1690 */ 1691 if (!is_dvbv3_delsys(desired_system)) { 1692 dev_dbg(fe->dvb->device, 1693 "%s: Delivery system %d not supported.\n", 1694 __func__, desired_system); 1695 return -EINVAL; 1696 } 1697 1698 type = dvbv3_type(desired_system); 1699 1700 /* 1701 * Get the last non-DVBv3 delivery system that has the same type 1702 * of the desired system 1703 */ 1704 ncaps = 0; 1705 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) { 1706 if (dvbv3_type(fe->ops.delsys[ncaps]) == type) 1707 delsys = fe->ops.delsys[ncaps]; 1708 ncaps++; 1709 } 1710 1711 /* There's nothing compatible with the desired delivery system */ 1712 if (delsys == SYS_UNDEFINED) { 1713 dev_dbg(fe->dvb->device, 1714 "%s: Delivery system %d not supported on emulation mode.\n", 1715 __func__, desired_system); 1716 return -EINVAL; 1717 } 1718 1719 dev_dbg(fe->dvb->device, 1720 "%s: Using delivery system %d emulated as if it were %d\n", 1721 __func__, delsys, desired_system); 1722 1723 return emulate_delivery_system(fe, desired_system); 1724 } 1725 1726 /** 1727 * dvbv3_set_delivery_system - Sets the delivery system for a DVBv3 API call 1728 * @fe: frontend struct 1729 * 1730 * A DVBv3 call doesn't know what's the desired system it wants. It also 1731 * doesn't allow to switch between different types. Due to that, userspace 1732 * should use DVBv5 instead. 1733 * However, in order to avoid breaking userspace API, limited backward 1734 * compatibility support is provided. 1735 * 1736 * There are some delivery systems that are incompatible with DVBv3 calls. 1737 * 1738 * This routine should work fine for frontends that support just one delivery 1739 * system. 1740 * 1741 * For frontends that support multiple frontends: 1742 * 1) It defaults to use the first supported delivery system. There's an 1743 * userspace application that allows changing it at runtime; 1744 * 1745 * 2) If the current delivery system is not compatible with DVBv3, it gets 1746 * the first one that it is compatible. 1747 * 1748 * NOTE: in order for this to work with applications like Kaffeine that 1749 * uses a DVBv5 call for DVB-S2 and a DVBv3 call to go back to 1750 * DVB-S, drivers that support both DVB-S and DVB-S2 should have the 1751 * SYS_DVBS entry before the SYS_DVBS2, otherwise it won't switch back 1752 * to DVB-S. 1753 */ 1754 static int dvbv3_set_delivery_system(struct dvb_frontend *fe) 1755 { 1756 int ncaps; 1757 u32 delsys = SYS_UNDEFINED; 1758 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1759 1760 /* If not set yet, defaults to the first supported delivery system */ 1761 if (c->delivery_system == SYS_UNDEFINED) 1762 c->delivery_system = fe->ops.delsys[0]; 1763 1764 /* 1765 * Trivial case: just use the current one, if it already a DVBv3 1766 * delivery system 1767 */ 1768 if (is_dvbv3_delsys(c->delivery_system)) { 1769 dev_dbg(fe->dvb->device, 1770 "%s: Using delivery system to %d\n", 1771 __func__, c->delivery_system); 1772 return 0; 1773 } 1774 1775 /* 1776 * Seek for the first delivery system that it is compatible with a 1777 * DVBv3 standard 1778 */ 1779 ncaps = 0; 1780 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) { 1781 if (dvbv3_type(fe->ops.delsys[ncaps]) != DVBV3_UNKNOWN) { 1782 delsys = fe->ops.delsys[ncaps]; 1783 break; 1784 } 1785 ncaps++; 1786 } 1787 if (delsys == SYS_UNDEFINED) { 1788 dev_dbg(fe->dvb->device, 1789 "%s: Couldn't find a delivery system that works with FE_SET_FRONTEND\n", 1790 __func__); 1791 return -EINVAL; 1792 } 1793 return emulate_delivery_system(fe, delsys); 1794 } 1795 1796 /** 1797 * dtv_property_process_set - Sets a single DTV property 1798 * @fe: Pointer to &struct dvb_frontend 1799 * @file: Pointer to &struct file 1800 * @cmd: Digital TV command 1801 * @data: An unsigned 32-bits number 1802 * 1803 * This routine assigns the property 1804 * value to the corresponding member of 1805 * &struct dtv_frontend_properties 1806 * 1807 * Returns: 1808 * Zero on success, negative errno on failure. 1809 */ 1810 static int dtv_property_process_set(struct dvb_frontend *fe, 1811 struct file *file, 1812 u32 cmd, u32 data) 1813 { 1814 int r = 0; 1815 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1816 1817 /** Dump DTV command name and value*/ 1818 if (!cmd || cmd > DTV_MAX_COMMAND) 1819 dev_warn(fe->dvb->device, "%s: SET cmd 0x%08x undefined\n", 1820 __func__, cmd); 1821 else 1822 dev_dbg(fe->dvb->device, 1823 "%s: SET cmd 0x%08x (%s) to 0x%08x\n", 1824 __func__, cmd, dtv_cmds[cmd].name, data); 1825 switch (cmd) { 1826 case DTV_CLEAR: 1827 /* 1828 * Reset a cache of data specific to the frontend here. This does 1829 * not effect hardware. 1830 */ 1831 dvb_frontend_clear_cache(fe); 1832 break; 1833 case DTV_TUNE: 1834 /* 1835 * Use the cached Digital TV properties to tune the 1836 * frontend 1837 */ 1838 dev_dbg(fe->dvb->device, 1839 "%s: Setting the frontend from property cache\n", 1840 __func__); 1841 1842 r = dtv_set_frontend(fe); 1843 break; 1844 case DTV_FREQUENCY: 1845 c->frequency = data; 1846 break; 1847 case DTV_MODULATION: 1848 c->modulation = data; 1849 break; 1850 case DTV_BANDWIDTH_HZ: 1851 c->bandwidth_hz = data; 1852 break; 1853 case DTV_INVERSION: 1854 c->inversion = data; 1855 break; 1856 case DTV_SYMBOL_RATE: 1857 c->symbol_rate = data; 1858 break; 1859 case DTV_INNER_FEC: 1860 c->fec_inner = data; 1861 break; 1862 case DTV_PILOT: 1863 c->pilot = data; 1864 break; 1865 case DTV_ROLLOFF: 1866 c->rolloff = data; 1867 break; 1868 case DTV_DELIVERY_SYSTEM: 1869 r = dvbv5_set_delivery_system(fe, data); 1870 break; 1871 case DTV_VOLTAGE: 1872 c->voltage = data; 1873 r = dvb_frontend_handle_ioctl(file, FE_SET_VOLTAGE, 1874 (void *)c->voltage); 1875 break; 1876 case DTV_TONE: 1877 c->sectone = data; 1878 r = dvb_frontend_handle_ioctl(file, FE_SET_TONE, 1879 (void *)c->sectone); 1880 break; 1881 case DTV_CODE_RATE_HP: 1882 c->code_rate_HP = data; 1883 break; 1884 case DTV_CODE_RATE_LP: 1885 c->code_rate_LP = data; 1886 break; 1887 case DTV_GUARD_INTERVAL: 1888 c->guard_interval = data; 1889 break; 1890 case DTV_TRANSMISSION_MODE: 1891 c->transmission_mode = data; 1892 break; 1893 case DTV_HIERARCHY: 1894 c->hierarchy = data; 1895 break; 1896 case DTV_INTERLEAVING: 1897 c->interleaving = data; 1898 break; 1899 1900 /* ISDB-T Support here */ 1901 case DTV_ISDBT_PARTIAL_RECEPTION: 1902 c->isdbt_partial_reception = data; 1903 break; 1904 case DTV_ISDBT_SOUND_BROADCASTING: 1905 c->isdbt_sb_mode = data; 1906 break; 1907 case DTV_ISDBT_SB_SUBCHANNEL_ID: 1908 c->isdbt_sb_subchannel = data; 1909 break; 1910 case DTV_ISDBT_SB_SEGMENT_IDX: 1911 c->isdbt_sb_segment_idx = data; 1912 break; 1913 case DTV_ISDBT_SB_SEGMENT_COUNT: 1914 c->isdbt_sb_segment_count = data; 1915 break; 1916 case DTV_ISDBT_LAYER_ENABLED: 1917 c->isdbt_layer_enabled = data; 1918 break; 1919 case DTV_ISDBT_LAYERA_FEC: 1920 c->layer[0].fec = data; 1921 break; 1922 case DTV_ISDBT_LAYERA_MODULATION: 1923 c->layer[0].modulation = data; 1924 break; 1925 case DTV_ISDBT_LAYERA_SEGMENT_COUNT: 1926 c->layer[0].segment_count = data; 1927 break; 1928 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING: 1929 c->layer[0].interleaving = data; 1930 break; 1931 case DTV_ISDBT_LAYERB_FEC: 1932 c->layer[1].fec = data; 1933 break; 1934 case DTV_ISDBT_LAYERB_MODULATION: 1935 c->layer[1].modulation = data; 1936 break; 1937 case DTV_ISDBT_LAYERB_SEGMENT_COUNT: 1938 c->layer[1].segment_count = data; 1939 break; 1940 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING: 1941 c->layer[1].interleaving = data; 1942 break; 1943 case DTV_ISDBT_LAYERC_FEC: 1944 c->layer[2].fec = data; 1945 break; 1946 case DTV_ISDBT_LAYERC_MODULATION: 1947 c->layer[2].modulation = data; 1948 break; 1949 case DTV_ISDBT_LAYERC_SEGMENT_COUNT: 1950 c->layer[2].segment_count = data; 1951 break; 1952 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING: 1953 c->layer[2].interleaving = data; 1954 break; 1955 1956 /* Multistream support */ 1957 case DTV_STREAM_ID: 1958 case DTV_DVBT2_PLP_ID_LEGACY: 1959 c->stream_id = data; 1960 break; 1961 1962 /* Physical layer scrambling support */ 1963 case DTV_SCRAMBLING_SEQUENCE_INDEX: 1964 c->scrambling_sequence_index = data; 1965 break; 1966 1967 /* ATSC-MH */ 1968 case DTV_ATSCMH_PARADE_ID: 1969 fe->dtv_property_cache.atscmh_parade_id = data; 1970 break; 1971 case DTV_ATSCMH_RS_FRAME_ENSEMBLE: 1972 fe->dtv_property_cache.atscmh_rs_frame_ensemble = data; 1973 break; 1974 1975 case DTV_LNA: 1976 c->lna = data; 1977 if (fe->ops.set_lna) 1978 r = fe->ops.set_lna(fe); 1979 if (r < 0) 1980 c->lna = LNA_AUTO; 1981 break; 1982 1983 default: 1984 return -EINVAL; 1985 } 1986 1987 return r; 1988 } 1989 1990 static int dvb_frontend_do_ioctl(struct file *file, unsigned int cmd, 1991 void *parg) 1992 { 1993 struct dvb_device *dvbdev = file->private_data; 1994 struct dvb_frontend *fe = dvbdev->priv; 1995 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1996 int err; 1997 1998 dev_dbg(fe->dvb->device, "%s: (%d)\n", __func__, _IOC_NR(cmd)); 1999 if (down_interruptible(&fepriv->sem)) 2000 return -ERESTARTSYS; 2001 2002 if (fe->exit != DVB_FE_NO_EXIT) { 2003 up(&fepriv->sem); 2004 return -ENODEV; 2005 } 2006 2007 /* 2008 * If the frontend is opened in read-only mode, only the ioctls 2009 * that don't interfere with the tune logic should be accepted. 2010 * That allows an external application to monitor the DVB QoS and 2011 * statistics parameters. 2012 * 2013 * That matches all _IOR() ioctls, except for two special cases: 2014 * - FE_GET_EVENT is part of the tuning logic on a DVB application; 2015 * - FE_DISEQC_RECV_SLAVE_REPLY is part of DiSEqC 2.0 2016 * setup 2017 * So, those two ioctls should also return -EPERM, as otherwise 2018 * reading from them would interfere with a DVB tune application 2019 */ 2020 if ((file->f_flags & O_ACCMODE) == O_RDONLY 2021 && (_IOC_DIR(cmd) != _IOC_READ 2022 || cmd == FE_GET_EVENT 2023 || cmd == FE_DISEQC_RECV_SLAVE_REPLY)) { 2024 up(&fepriv->sem); 2025 return -EPERM; 2026 } 2027 2028 err = dvb_frontend_handle_ioctl(file, cmd, parg); 2029 2030 up(&fepriv->sem); 2031 return err; 2032 } 2033 2034 static long dvb_frontend_ioctl(struct file *file, unsigned int cmd, 2035 unsigned long arg) 2036 { 2037 struct dvb_device *dvbdev = file->private_data; 2038 2039 if (!dvbdev) 2040 return -ENODEV; 2041 2042 return dvb_usercopy(file, cmd, arg, dvb_frontend_do_ioctl); 2043 } 2044 2045 #ifdef CONFIG_COMPAT 2046 struct compat_dtv_property { 2047 __u32 cmd; 2048 __u32 reserved[3]; 2049 union { 2050 __u32 data; 2051 struct dtv_fe_stats st; 2052 struct { 2053 __u8 data[32]; 2054 __u32 len; 2055 __u32 reserved1[3]; 2056 compat_uptr_t reserved2; 2057 } buffer; 2058 } u; 2059 int result; 2060 } __attribute__ ((packed)); 2061 2062 struct compat_dtv_properties { 2063 __u32 num; 2064 compat_uptr_t props; 2065 }; 2066 2067 #define COMPAT_FE_SET_PROPERTY _IOW('o', 82, struct compat_dtv_properties) 2068 #define COMPAT_FE_GET_PROPERTY _IOR('o', 83, struct compat_dtv_properties) 2069 2070 static int dvb_frontend_handle_compat_ioctl(struct file *file, unsigned int cmd, 2071 unsigned long arg) 2072 { 2073 struct dvb_device *dvbdev = file->private_data; 2074 struct dvb_frontend *fe = dvbdev->priv; 2075 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2076 int i, err = 0; 2077 2078 if (cmd == COMPAT_FE_SET_PROPERTY) { 2079 struct compat_dtv_properties prop, *tvps = NULL; 2080 struct compat_dtv_property *tvp = NULL; 2081 2082 if (copy_from_user(&prop, compat_ptr(arg), sizeof(prop))) 2083 return -EFAULT; 2084 2085 tvps = ∝ 2086 2087 /* 2088 * Put an arbitrary limit on the number of messages that can 2089 * be sent at once 2090 */ 2091 if (!tvps->num || (tvps->num > DTV_IOCTL_MAX_MSGS)) 2092 return -EINVAL; 2093 2094 tvp = memdup_user(compat_ptr(tvps->props), tvps->num * sizeof(*tvp)); 2095 if (IS_ERR(tvp)) 2096 return PTR_ERR(tvp); 2097 2098 for (i = 0; i < tvps->num; i++) { 2099 err = dtv_property_process_set(fe, file, 2100 (tvp + i)->cmd, 2101 (tvp + i)->u.data); 2102 if (err < 0) { 2103 kfree(tvp); 2104 return err; 2105 } 2106 } 2107 kfree(tvp); 2108 } else if (cmd == COMPAT_FE_GET_PROPERTY) { 2109 struct compat_dtv_properties prop, *tvps = NULL; 2110 struct compat_dtv_property *tvp = NULL; 2111 struct dtv_frontend_properties getp = fe->dtv_property_cache; 2112 2113 if (copy_from_user(&prop, compat_ptr(arg), sizeof(prop))) 2114 return -EFAULT; 2115 2116 tvps = ∝ 2117 2118 /* 2119 * Put an arbitrary limit on the number of messages that can 2120 * be sent at once 2121 */ 2122 if (!tvps->num || (tvps->num > DTV_IOCTL_MAX_MSGS)) 2123 return -EINVAL; 2124 2125 tvp = memdup_user(compat_ptr(tvps->props), tvps->num * sizeof(*tvp)); 2126 if (IS_ERR(tvp)) 2127 return PTR_ERR(tvp); 2128 2129 /* 2130 * Let's use our own copy of property cache, in order to 2131 * avoid mangling with DTV zigzag logic, as drivers might 2132 * return crap, if they don't check if the data is available 2133 * before updating the properties cache. 2134 */ 2135 if (fepriv->state != FESTATE_IDLE) { 2136 err = dtv_get_frontend(fe, &getp, NULL); 2137 if (err < 0) { 2138 kfree(tvp); 2139 return err; 2140 } 2141 } 2142 for (i = 0; i < tvps->num; i++) { 2143 err = dtv_property_process_get( 2144 fe, &getp, (struct dtv_property *)(tvp + i), file); 2145 if (err < 0) { 2146 kfree(tvp); 2147 return err; 2148 } 2149 } 2150 2151 if (copy_to_user((void __user *)compat_ptr(tvps->props), tvp, 2152 tvps->num * sizeof(struct compat_dtv_property))) { 2153 kfree(tvp); 2154 return -EFAULT; 2155 } 2156 kfree(tvp); 2157 } 2158 2159 return err; 2160 } 2161 2162 static long dvb_frontend_compat_ioctl(struct file *file, unsigned int cmd, 2163 unsigned long arg) 2164 { 2165 struct dvb_device *dvbdev = file->private_data; 2166 struct dvb_frontend *fe = dvbdev->priv; 2167 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2168 int err; 2169 2170 if (cmd == COMPAT_FE_SET_PROPERTY || cmd == COMPAT_FE_GET_PROPERTY) { 2171 if (down_interruptible(&fepriv->sem)) 2172 return -ERESTARTSYS; 2173 2174 err = dvb_frontend_handle_compat_ioctl(file, cmd, arg); 2175 2176 up(&fepriv->sem); 2177 return err; 2178 } 2179 2180 return dvb_frontend_ioctl(file, cmd, (unsigned long)compat_ptr(arg)); 2181 } 2182 #endif 2183 2184 static int dtv_set_frontend(struct dvb_frontend *fe) 2185 { 2186 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2187 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 2188 struct dvb_frontend_tune_settings fetunesettings; 2189 u32 rolloff = 0; 2190 2191 if (dvb_frontend_check_parameters(fe) < 0) 2192 return -EINVAL; 2193 2194 /* 2195 * Initialize output parameters to match the values given by 2196 * the user. FE_SET_FRONTEND triggers an initial frontend event 2197 * with status = 0, which copies output parameters to userspace. 2198 */ 2199 dtv_property_legacy_params_sync(fe, c, &fepriv->parameters_out); 2200 2201 /* 2202 * Be sure that the bandwidth will be filled for all 2203 * non-satellite systems, as tuners need to know what 2204 * low pass/Nyquist half filter should be applied, in 2205 * order to avoid inter-channel noise. 2206 * 2207 * ISDB-T and DVB-T/T2 already sets bandwidth. 2208 * ATSC and DVB-C don't set, so, the core should fill it. 2209 * 2210 * On DVB-C Annex A and C, the bandwidth is a function of 2211 * the roll-off and symbol rate. Annex B defines different 2212 * roll-off factors depending on the modulation. Fortunately, 2213 * Annex B is only used with 6MHz, so there's no need to 2214 * calculate it. 2215 * 2216 * While not officially supported, a side effect of handling it at 2217 * the cache level is that a program could retrieve the bandwidth 2218 * via DTV_BANDWIDTH_HZ, which may be useful for test programs. 2219 */ 2220 switch (c->delivery_system) { 2221 case SYS_ATSC: 2222 case SYS_DVBC_ANNEX_B: 2223 c->bandwidth_hz = 6000000; 2224 break; 2225 case SYS_DVBC_ANNEX_A: 2226 rolloff = 115; 2227 break; 2228 case SYS_DVBC_ANNEX_C: 2229 rolloff = 113; 2230 break; 2231 case SYS_DVBS: 2232 case SYS_TURBO: 2233 case SYS_ISDBS: 2234 rolloff = 135; 2235 break; 2236 case SYS_DVBS2: 2237 switch (c->rolloff) { 2238 case ROLLOFF_20: 2239 rolloff = 120; 2240 break; 2241 case ROLLOFF_25: 2242 rolloff = 125; 2243 break; 2244 default: 2245 case ROLLOFF_35: 2246 rolloff = 135; 2247 } 2248 break; 2249 default: 2250 break; 2251 } 2252 if (rolloff) 2253 c->bandwidth_hz = mult_frac(c->symbol_rate, rolloff, 100); 2254 2255 /* force auto frequency inversion if requested */ 2256 if (dvb_force_auto_inversion) 2257 c->inversion = INVERSION_AUTO; 2258 2259 /* 2260 * without hierarchical coding code_rate_LP is irrelevant, 2261 * so we tolerate the otherwise invalid FEC_NONE setting 2262 */ 2263 if (c->hierarchy == HIERARCHY_NONE && c->code_rate_LP == FEC_NONE) 2264 c->code_rate_LP = FEC_AUTO; 2265 2266 /* get frontend-specific tuning settings */ 2267 memset(&fetunesettings, 0, sizeof(struct dvb_frontend_tune_settings)); 2268 if (fe->ops.get_tune_settings && (fe->ops.get_tune_settings(fe, &fetunesettings) == 0)) { 2269 fepriv->min_delay = (fetunesettings.min_delay_ms * HZ) / 1000; 2270 fepriv->max_drift = fetunesettings.max_drift; 2271 fepriv->step_size = fetunesettings.step_size; 2272 } else { 2273 /* default values */ 2274 switch (c->delivery_system) { 2275 case SYS_DVBS: 2276 case SYS_DVBS2: 2277 case SYS_ISDBS: 2278 case SYS_TURBO: 2279 case SYS_DVBC_ANNEX_A: 2280 case SYS_DVBC_ANNEX_C: 2281 fepriv->min_delay = HZ / 20; 2282 fepriv->step_size = c->symbol_rate / 16000; 2283 fepriv->max_drift = c->symbol_rate / 2000; 2284 break; 2285 case SYS_DVBT: 2286 case SYS_DVBT2: 2287 case SYS_ISDBT: 2288 case SYS_DTMB: 2289 fepriv->min_delay = HZ / 20; 2290 fepriv->step_size = dvb_frontend_get_stepsize(fe) * 2; 2291 fepriv->max_drift = (dvb_frontend_get_stepsize(fe) * 2) + 1; 2292 break; 2293 default: 2294 /* 2295 * FIXME: This sounds wrong! if freqency_stepsize is 2296 * defined by the frontend, why not use it??? 2297 */ 2298 fepriv->min_delay = HZ / 20; 2299 fepriv->step_size = 0; /* no zigzag */ 2300 fepriv->max_drift = 0; 2301 break; 2302 } 2303 } 2304 if (dvb_override_tune_delay > 0) 2305 fepriv->min_delay = (dvb_override_tune_delay * HZ) / 1000; 2306 2307 fepriv->state = FESTATE_RETUNE; 2308 2309 /* Request the search algorithm to search */ 2310 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 2311 2312 dvb_frontend_clear_events(fe); 2313 dvb_frontend_add_event(fe, 0); 2314 dvb_frontend_wakeup(fe); 2315 fepriv->status = 0; 2316 2317 return 0; 2318 } 2319 2320 static int dvb_frontend_handle_ioctl(struct file *file, 2321 unsigned int cmd, void *parg) 2322 { 2323 struct dvb_device *dvbdev = file->private_data; 2324 struct dvb_frontend *fe = dvbdev->priv; 2325 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2326 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 2327 int i, err = -ENOTSUPP; 2328 2329 dev_dbg(fe->dvb->device, "%s:\n", __func__); 2330 2331 switch (cmd) { 2332 case FE_SET_PROPERTY: { 2333 struct dtv_properties *tvps = parg; 2334 struct dtv_property *tvp = NULL; 2335 2336 dev_dbg(fe->dvb->device, "%s: properties.num = %d\n", 2337 __func__, tvps->num); 2338 dev_dbg(fe->dvb->device, "%s: properties.props = %p\n", 2339 __func__, tvps->props); 2340 2341 /* 2342 * Put an arbitrary limit on the number of messages that can 2343 * be sent at once 2344 */ 2345 if (!tvps->num || (tvps->num > DTV_IOCTL_MAX_MSGS)) 2346 return -EINVAL; 2347 2348 tvp = memdup_user((void __user *)tvps->props, tvps->num * sizeof(*tvp)); 2349 if (IS_ERR(tvp)) 2350 return PTR_ERR(tvp); 2351 2352 for (i = 0; i < tvps->num; i++) { 2353 err = dtv_property_process_set(fe, file, 2354 (tvp + i)->cmd, 2355 (tvp + i)->u.data); 2356 if (err < 0) { 2357 kfree(tvp); 2358 return err; 2359 } 2360 } 2361 kfree(tvp); 2362 err = 0; 2363 break; 2364 } 2365 case FE_GET_PROPERTY: { 2366 struct dtv_properties *tvps = parg; 2367 struct dtv_property *tvp = NULL; 2368 struct dtv_frontend_properties getp = fe->dtv_property_cache; 2369 2370 dev_dbg(fe->dvb->device, "%s: properties.num = %d\n", 2371 __func__, tvps->num); 2372 dev_dbg(fe->dvb->device, "%s: properties.props = %p\n", 2373 __func__, tvps->props); 2374 2375 /* 2376 * Put an arbitrary limit on the number of messages that can 2377 * be sent at once 2378 */ 2379 if (!tvps->num || (tvps->num > DTV_IOCTL_MAX_MSGS)) 2380 return -EINVAL; 2381 2382 tvp = memdup_user((void __user *)tvps->props, tvps->num * sizeof(*tvp)); 2383 if (IS_ERR(tvp)) 2384 return PTR_ERR(tvp); 2385 2386 /* 2387 * Let's use our own copy of property cache, in order to 2388 * avoid mangling with DTV zigzag logic, as drivers might 2389 * return crap, if they don't check if the data is available 2390 * before updating the properties cache. 2391 */ 2392 if (fepriv->state != FESTATE_IDLE) { 2393 err = dtv_get_frontend(fe, &getp, NULL); 2394 if (err < 0) { 2395 kfree(tvp); 2396 return err; 2397 } 2398 } 2399 for (i = 0; i < tvps->num; i++) { 2400 err = dtv_property_process_get(fe, &getp, 2401 tvp + i, file); 2402 if (err < 0) { 2403 kfree(tvp); 2404 return err; 2405 } 2406 } 2407 2408 if (copy_to_user((void __user *)tvps->props, tvp, 2409 tvps->num * sizeof(struct dtv_property))) { 2410 kfree(tvp); 2411 return -EFAULT; 2412 } 2413 kfree(tvp); 2414 err = 0; 2415 break; 2416 } 2417 2418 case FE_GET_INFO: { 2419 struct dvb_frontend_info *info = parg; 2420 memset(info, 0, sizeof(*info)); 2421 2422 strcpy(info->name, fe->ops.info.name); 2423 info->symbol_rate_min = fe->ops.info.symbol_rate_min; 2424 info->symbol_rate_max = fe->ops.info.symbol_rate_max; 2425 info->symbol_rate_tolerance = fe->ops.info.symbol_rate_tolerance; 2426 info->caps = fe->ops.info.caps; 2427 info->frequency_stepsize = dvb_frontend_get_stepsize(fe); 2428 dvb_frontend_get_frequency_limits(fe, &info->frequency_min, 2429 &info->frequency_max, 2430 &info->frequency_tolerance); 2431 2432 /* 2433 * Associate the 4 delivery systems supported by DVBv3 2434 * API with their DVBv5 counterpart. For the other standards, 2435 * use the closest type, assuming that it would hopefully 2436 * work with a DVBv3 application. 2437 * It should be noticed that, on multi-frontend devices with 2438 * different types (terrestrial and cable, for example), 2439 * a pure DVBv3 application won't be able to use all delivery 2440 * systems. Yet, changing the DVBv5 cache to the other delivery 2441 * system should be enough for making it work. 2442 */ 2443 switch (dvbv3_type(c->delivery_system)) { 2444 case DVBV3_QPSK: 2445 info->type = FE_QPSK; 2446 break; 2447 case DVBV3_ATSC: 2448 info->type = FE_ATSC; 2449 break; 2450 case DVBV3_QAM: 2451 info->type = FE_QAM; 2452 break; 2453 case DVBV3_OFDM: 2454 info->type = FE_OFDM; 2455 break; 2456 default: 2457 dev_err(fe->dvb->device, 2458 "%s: doesn't know how to handle a DVBv3 call to delivery system %i\n", 2459 __func__, c->delivery_system); 2460 info->type = FE_OFDM; 2461 } 2462 dev_dbg(fe->dvb->device, "%s: current delivery system on cache: %d, V3 type: %d\n", 2463 __func__, c->delivery_system, info->type); 2464 2465 /* Set CAN_INVERSION_AUTO bit on in other than oneshot mode */ 2466 if (!(fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT)) 2467 info->caps |= FE_CAN_INVERSION_AUTO; 2468 err = 0; 2469 break; 2470 } 2471 2472 case FE_READ_STATUS: { 2473 enum fe_status *status = parg; 2474 2475 /* if retune was requested but hasn't occurred yet, prevent 2476 * that user get signal state from previous tuning */ 2477 if (fepriv->state == FESTATE_RETUNE || 2478 fepriv->state == FESTATE_ERROR) { 2479 err = 0; 2480 *status = 0; 2481 break; 2482 } 2483 2484 if (fe->ops.read_status) 2485 err = fe->ops.read_status(fe, status); 2486 break; 2487 } 2488 2489 case FE_DISEQC_RESET_OVERLOAD: 2490 if (fe->ops.diseqc_reset_overload) { 2491 err = fe->ops.diseqc_reset_overload(fe); 2492 fepriv->state = FESTATE_DISEQC; 2493 fepriv->status = 0; 2494 } 2495 break; 2496 2497 case FE_DISEQC_SEND_MASTER_CMD: 2498 if (fe->ops.diseqc_send_master_cmd) { 2499 struct dvb_diseqc_master_cmd *cmd = parg; 2500 2501 if (cmd->msg_len > sizeof(cmd->msg)) { 2502 err = -EINVAL; 2503 break; 2504 } 2505 err = fe->ops.diseqc_send_master_cmd(fe, cmd); 2506 fepriv->state = FESTATE_DISEQC; 2507 fepriv->status = 0; 2508 } 2509 break; 2510 2511 case FE_DISEQC_SEND_BURST: 2512 if (fe->ops.diseqc_send_burst) { 2513 err = fe->ops.diseqc_send_burst(fe, 2514 (enum fe_sec_mini_cmd)parg); 2515 fepriv->state = FESTATE_DISEQC; 2516 fepriv->status = 0; 2517 } 2518 break; 2519 2520 case FE_SET_TONE: 2521 if (fe->ops.set_tone) { 2522 err = fe->ops.set_tone(fe, 2523 (enum fe_sec_tone_mode)parg); 2524 fepriv->tone = (enum fe_sec_tone_mode)parg; 2525 fepriv->state = FESTATE_DISEQC; 2526 fepriv->status = 0; 2527 } 2528 break; 2529 2530 case FE_SET_VOLTAGE: 2531 if (fe->ops.set_voltage) { 2532 err = fe->ops.set_voltage(fe, 2533 (enum fe_sec_voltage)parg); 2534 fepriv->voltage = (enum fe_sec_voltage)parg; 2535 fepriv->state = FESTATE_DISEQC; 2536 fepriv->status = 0; 2537 } 2538 break; 2539 2540 case FE_DISEQC_RECV_SLAVE_REPLY: 2541 if (fe->ops.diseqc_recv_slave_reply) 2542 err = fe->ops.diseqc_recv_slave_reply(fe, parg); 2543 break; 2544 2545 case FE_ENABLE_HIGH_LNB_VOLTAGE: 2546 if (fe->ops.enable_high_lnb_voltage) 2547 err = fe->ops.enable_high_lnb_voltage(fe, (long)parg); 2548 break; 2549 2550 case FE_SET_FRONTEND_TUNE_MODE: 2551 fepriv->tune_mode_flags = (unsigned long)parg; 2552 err = 0; 2553 break; 2554 2555 /* DEPRECATED dish control ioctls */ 2556 2557 case FE_DISHNETWORK_SEND_LEGACY_CMD: 2558 if (fe->ops.dishnetwork_send_legacy_command) { 2559 err = fe->ops.dishnetwork_send_legacy_command(fe, 2560 (unsigned long)parg); 2561 fepriv->state = FESTATE_DISEQC; 2562 fepriv->status = 0; 2563 } else if (fe->ops.set_voltage) { 2564 /* 2565 * NOTE: This is a fallback condition. Some frontends 2566 * (stv0299 for instance) take longer than 8msec to 2567 * respond to a set_voltage command. Those switches 2568 * need custom routines to switch properly. For all 2569 * other frontends, the following should work ok. 2570 * Dish network legacy switches (as used by Dish500) 2571 * are controlled by sending 9-bit command words 2572 * spaced 8msec apart. 2573 * the actual command word is switch/port dependent 2574 * so it is up to the userspace application to send 2575 * the right command. 2576 * The command must always start with a '0' after 2577 * initialization, so parg is 8 bits and does not 2578 * include the initialization or start bit 2579 */ 2580 unsigned long swcmd = ((unsigned long)parg) << 1; 2581 ktime_t nexttime; 2582 ktime_t tv[10]; 2583 int i; 2584 u8 last = 1; 2585 2586 if (dvb_frontend_debug) 2587 dprintk("%s switch command: 0x%04lx\n", 2588 __func__, swcmd); 2589 nexttime = ktime_get_boottime(); 2590 if (dvb_frontend_debug) 2591 tv[0] = nexttime; 2592 /* before sending a command, initialize by sending 2593 * a 32ms 18V to the switch 2594 */ 2595 fe->ops.set_voltage(fe, SEC_VOLTAGE_18); 2596 dvb_frontend_sleep_until(&nexttime, 32000); 2597 2598 for (i = 0; i < 9; i++) { 2599 if (dvb_frontend_debug) 2600 tv[i + 1] = ktime_get_boottime(); 2601 if ((swcmd & 0x01) != last) { 2602 /* set voltage to (last ? 13V : 18V) */ 2603 fe->ops.set_voltage(fe, (last) ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18); 2604 last = (last) ? 0 : 1; 2605 } 2606 swcmd = swcmd >> 1; 2607 if (i != 8) 2608 dvb_frontend_sleep_until(&nexttime, 8000); 2609 } 2610 if (dvb_frontend_debug) { 2611 dprintk("%s(%d): switch delay (should be 32k followed by all 8k)\n", 2612 __func__, fe->dvb->num); 2613 for (i = 1; i < 10; i++) 2614 pr_info("%d: %d\n", i, 2615 (int)ktime_us_delta(tv[i], tv[i - 1])); 2616 } 2617 err = 0; 2618 fepriv->state = FESTATE_DISEQC; 2619 fepriv->status = 0; 2620 } 2621 break; 2622 2623 /* DEPRECATED statistics ioctls */ 2624 2625 case FE_READ_BER: 2626 if (fe->ops.read_ber) { 2627 if (fepriv->thread) 2628 err = fe->ops.read_ber(fe, parg); 2629 else 2630 err = -EAGAIN; 2631 } 2632 break; 2633 2634 case FE_READ_SIGNAL_STRENGTH: 2635 if (fe->ops.read_signal_strength) { 2636 if (fepriv->thread) 2637 err = fe->ops.read_signal_strength(fe, parg); 2638 else 2639 err = -EAGAIN; 2640 } 2641 break; 2642 2643 case FE_READ_SNR: 2644 if (fe->ops.read_snr) { 2645 if (fepriv->thread) 2646 err = fe->ops.read_snr(fe, parg); 2647 else 2648 err = -EAGAIN; 2649 } 2650 break; 2651 2652 case FE_READ_UNCORRECTED_BLOCKS: 2653 if (fe->ops.read_ucblocks) { 2654 if (fepriv->thread) 2655 err = fe->ops.read_ucblocks(fe, parg); 2656 else 2657 err = -EAGAIN; 2658 } 2659 break; 2660 2661 /* DEPRECATED DVBv3 ioctls */ 2662 2663 case FE_SET_FRONTEND: 2664 err = dvbv3_set_delivery_system(fe); 2665 if (err) 2666 break; 2667 2668 err = dtv_property_cache_sync(fe, c, parg); 2669 if (err) 2670 break; 2671 err = dtv_set_frontend(fe); 2672 break; 2673 case FE_GET_EVENT: 2674 err = dvb_frontend_get_event(fe, parg, file->f_flags); 2675 break; 2676 2677 case FE_GET_FRONTEND: { 2678 struct dtv_frontend_properties getp = fe->dtv_property_cache; 2679 2680 /* 2681 * Let's use our own copy of property cache, in order to 2682 * avoid mangling with DTV zigzag logic, as drivers might 2683 * return crap, if they don't check if the data is available 2684 * before updating the properties cache. 2685 */ 2686 err = dtv_get_frontend(fe, &getp, parg); 2687 break; 2688 } 2689 2690 default: 2691 return -ENOTSUPP; 2692 } /* switch */ 2693 2694 return err; 2695 } 2696 2697 static __poll_t dvb_frontend_poll(struct file *file, struct poll_table_struct *wait) 2698 { 2699 struct dvb_device *dvbdev = file->private_data; 2700 struct dvb_frontend *fe = dvbdev->priv; 2701 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2702 2703 dev_dbg_ratelimited(fe->dvb->device, "%s:\n", __func__); 2704 2705 poll_wait(file, &fepriv->events.wait_queue, wait); 2706 2707 if (fepriv->events.eventw != fepriv->events.eventr) 2708 return (EPOLLIN | EPOLLRDNORM | EPOLLPRI); 2709 2710 return 0; 2711 } 2712 2713 static int dvb_frontend_open(struct inode *inode, struct file *file) 2714 { 2715 struct dvb_device *dvbdev = file->private_data; 2716 struct dvb_frontend *fe = dvbdev->priv; 2717 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2718 struct dvb_adapter *adapter = fe->dvb; 2719 int ret; 2720 2721 dev_dbg(fe->dvb->device, "%s:\n", __func__); 2722 if (fe->exit == DVB_FE_DEVICE_REMOVED) 2723 return -ENODEV; 2724 2725 if (adapter->mfe_shared) { 2726 mutex_lock(&adapter->mfe_lock); 2727 2728 if (!adapter->mfe_dvbdev) 2729 adapter->mfe_dvbdev = dvbdev; 2730 2731 else if (adapter->mfe_dvbdev != dvbdev) { 2732 struct dvb_device 2733 *mfedev = adapter->mfe_dvbdev; 2734 struct dvb_frontend 2735 *mfe = mfedev->priv; 2736 struct dvb_frontend_private 2737 *mfepriv = mfe->frontend_priv; 2738 int mferetry = (dvb_mfe_wait_time << 1); 2739 2740 mutex_unlock(&adapter->mfe_lock); 2741 while (mferetry-- && (mfedev->users != -1 || 2742 mfepriv->thread)) { 2743 if (msleep_interruptible(500)) { 2744 if (signal_pending(current)) 2745 return -EINTR; 2746 } 2747 } 2748 2749 mutex_lock(&adapter->mfe_lock); 2750 if (adapter->mfe_dvbdev != dvbdev) { 2751 mfedev = adapter->mfe_dvbdev; 2752 mfe = mfedev->priv; 2753 mfepriv = mfe->frontend_priv; 2754 if (mfedev->users != -1 || 2755 mfepriv->thread) { 2756 mutex_unlock(&adapter->mfe_lock); 2757 return -EBUSY; 2758 } 2759 adapter->mfe_dvbdev = dvbdev; 2760 } 2761 } 2762 } 2763 2764 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) { 2765 if ((ret = fe->ops.ts_bus_ctrl(fe, 1)) < 0) 2766 goto err0; 2767 2768 /* If we took control of the bus, we need to force 2769 reinitialization. This is because many ts_bus_ctrl() 2770 functions strobe the RESET pin on the demod, and if the 2771 frontend thread already exists then the dvb_init() routine 2772 won't get called (which is what usually does initial 2773 register configuration). */ 2774 fepriv->reinitialise = 1; 2775 } 2776 2777 if ((ret = dvb_generic_open(inode, file)) < 0) 2778 goto err1; 2779 2780 if ((file->f_flags & O_ACCMODE) != O_RDONLY) { 2781 /* normal tune mode when opened R/W */ 2782 fepriv->tune_mode_flags &= ~FE_TUNE_MODE_ONESHOT; 2783 fepriv->tone = -1; 2784 fepriv->voltage = -1; 2785 2786 #ifdef CONFIG_MEDIA_CONTROLLER_DVB 2787 mutex_lock(&fe->dvb->mdev_lock); 2788 if (fe->dvb->mdev) { 2789 mutex_lock(&fe->dvb->mdev->graph_mutex); 2790 if (fe->dvb->mdev->enable_source) 2791 ret = fe->dvb->mdev->enable_source( 2792 dvbdev->entity, 2793 &fepriv->pipe); 2794 mutex_unlock(&fe->dvb->mdev->graph_mutex); 2795 if (ret) { 2796 mutex_unlock(&fe->dvb->mdev_lock); 2797 dev_err(fe->dvb->device, 2798 "Tuner is busy. Error %d\n", ret); 2799 goto err2; 2800 } 2801 } 2802 mutex_unlock(&fe->dvb->mdev_lock); 2803 #endif 2804 ret = dvb_frontend_start(fe); 2805 if (ret) 2806 goto err3; 2807 2808 /* empty event queue */ 2809 fepriv->events.eventr = fepriv->events.eventw = 0; 2810 } 2811 2812 dvb_frontend_get(fe); 2813 2814 if (adapter->mfe_shared) 2815 mutex_unlock(&adapter->mfe_lock); 2816 return ret; 2817 2818 err3: 2819 #ifdef CONFIG_MEDIA_CONTROLLER_DVB 2820 mutex_lock(&fe->dvb->mdev_lock); 2821 if (fe->dvb->mdev) { 2822 mutex_lock(&fe->dvb->mdev->graph_mutex); 2823 if (fe->dvb->mdev->disable_source) 2824 fe->dvb->mdev->disable_source(dvbdev->entity); 2825 mutex_unlock(&fe->dvb->mdev->graph_mutex); 2826 } 2827 mutex_unlock(&fe->dvb->mdev_lock); 2828 err2: 2829 #endif 2830 dvb_generic_release(inode, file); 2831 err1: 2832 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) 2833 fe->ops.ts_bus_ctrl(fe, 0); 2834 err0: 2835 if (adapter->mfe_shared) 2836 mutex_unlock(&adapter->mfe_lock); 2837 return ret; 2838 } 2839 2840 static int dvb_frontend_release(struct inode *inode, struct file *file) 2841 { 2842 struct dvb_device *dvbdev = file->private_data; 2843 struct dvb_frontend *fe = dvbdev->priv; 2844 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2845 int ret; 2846 2847 dev_dbg(fe->dvb->device, "%s:\n", __func__); 2848 2849 if ((file->f_flags & O_ACCMODE) != O_RDONLY) { 2850 fepriv->release_jiffies = jiffies; 2851 mb(); 2852 } 2853 2854 ret = dvb_generic_release(inode, file); 2855 2856 if (dvbdev->users == -1) { 2857 wake_up(&fepriv->wait_queue); 2858 #ifdef CONFIG_MEDIA_CONTROLLER_DVB 2859 mutex_lock(&fe->dvb->mdev_lock); 2860 if (fe->dvb->mdev) { 2861 mutex_lock(&fe->dvb->mdev->graph_mutex); 2862 if (fe->dvb->mdev->disable_source) 2863 fe->dvb->mdev->disable_source(dvbdev->entity); 2864 mutex_unlock(&fe->dvb->mdev->graph_mutex); 2865 } 2866 mutex_unlock(&fe->dvb->mdev_lock); 2867 #endif 2868 if (fe->exit != DVB_FE_NO_EXIT) 2869 wake_up(&dvbdev->wait_queue); 2870 if (fe->ops.ts_bus_ctrl) 2871 fe->ops.ts_bus_ctrl(fe, 0); 2872 } 2873 2874 dvb_frontend_put(fe); 2875 2876 return ret; 2877 } 2878 2879 static const struct file_operations dvb_frontend_fops = { 2880 .owner = THIS_MODULE, 2881 .unlocked_ioctl = dvb_frontend_ioctl, 2882 #ifdef CONFIG_COMPAT 2883 .compat_ioctl = dvb_frontend_compat_ioctl, 2884 #endif 2885 .poll = dvb_frontend_poll, 2886 .open = dvb_frontend_open, 2887 .release = dvb_frontend_release, 2888 .llseek = noop_llseek, 2889 }; 2890 2891 int dvb_frontend_suspend(struct dvb_frontend *fe) 2892 { 2893 int ret = 0; 2894 2895 dev_dbg(fe->dvb->device, "%s: adap=%d fe=%d\n", __func__, fe->dvb->num, 2896 fe->id); 2897 2898 if (fe->ops.tuner_ops.suspend) 2899 ret = fe->ops.tuner_ops.suspend(fe); 2900 else if (fe->ops.tuner_ops.sleep) 2901 ret = fe->ops.tuner_ops.sleep(fe); 2902 2903 if (fe->ops.sleep) 2904 ret = fe->ops.sleep(fe); 2905 2906 return ret; 2907 } 2908 EXPORT_SYMBOL(dvb_frontend_suspend); 2909 2910 int dvb_frontend_resume(struct dvb_frontend *fe) 2911 { 2912 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2913 int ret = 0; 2914 2915 dev_dbg(fe->dvb->device, "%s: adap=%d fe=%d\n", __func__, fe->dvb->num, 2916 fe->id); 2917 2918 fe->exit = DVB_FE_DEVICE_RESUME; 2919 if (fe->ops.init) 2920 ret = fe->ops.init(fe); 2921 2922 if (fe->ops.tuner_ops.resume) 2923 ret = fe->ops.tuner_ops.resume(fe); 2924 else if (fe->ops.tuner_ops.init) 2925 ret = fe->ops.tuner_ops.init(fe); 2926 2927 if (fe->ops.set_tone && fepriv->tone != -1) 2928 fe->ops.set_tone(fe, fepriv->tone); 2929 if (fe->ops.set_voltage && fepriv->voltage != -1) 2930 fe->ops.set_voltage(fe, fepriv->voltage); 2931 2932 fe->exit = DVB_FE_NO_EXIT; 2933 fepriv->state = FESTATE_RETUNE; 2934 dvb_frontend_wakeup(fe); 2935 2936 return ret; 2937 } 2938 EXPORT_SYMBOL(dvb_frontend_resume); 2939 2940 int dvb_register_frontend(struct dvb_adapter *dvb, 2941 struct dvb_frontend *fe) 2942 { 2943 struct dvb_frontend_private *fepriv; 2944 const struct dvb_device dvbdev_template = { 2945 .users = ~0, 2946 .writers = 1, 2947 .readers = (~0) - 1, 2948 .fops = &dvb_frontend_fops, 2949 #if defined(CONFIG_MEDIA_CONTROLLER_DVB) 2950 .name = fe->ops.info.name, 2951 #endif 2952 }; 2953 2954 dev_dbg(dvb->device, "%s:\n", __func__); 2955 2956 if (mutex_lock_interruptible(&frontend_mutex)) 2957 return -ERESTARTSYS; 2958 2959 fe->frontend_priv = kzalloc(sizeof(struct dvb_frontend_private), GFP_KERNEL); 2960 if (!fe->frontend_priv) { 2961 mutex_unlock(&frontend_mutex); 2962 return -ENOMEM; 2963 } 2964 fepriv = fe->frontend_priv; 2965 2966 kref_init(&fe->refcount); 2967 2968 /* 2969 * After initialization, there need to be two references: one 2970 * for dvb_unregister_frontend(), and another one for 2971 * dvb_frontend_detach(). 2972 */ 2973 dvb_frontend_get(fe); 2974 2975 sema_init(&fepriv->sem, 1); 2976 init_waitqueue_head(&fepriv->wait_queue); 2977 init_waitqueue_head(&fepriv->events.wait_queue); 2978 mutex_init(&fepriv->events.mtx); 2979 fe->dvb = dvb; 2980 fepriv->inversion = INVERSION_OFF; 2981 2982 dev_info(fe->dvb->device, 2983 "DVB: registering adapter %i frontend %i (%s)...\n", 2984 fe->dvb->num, fe->id, fe->ops.info.name); 2985 2986 dvb_register_device(fe->dvb, &fepriv->dvbdev, &dvbdev_template, 2987 fe, DVB_DEVICE_FRONTEND, 0); 2988 2989 /* 2990 * Initialize the cache to the proper values according with the 2991 * first supported delivery system (ops->delsys[0]) 2992 */ 2993 2994 fe->dtv_property_cache.delivery_system = fe->ops.delsys[0]; 2995 dvb_frontend_clear_cache(fe); 2996 2997 mutex_unlock(&frontend_mutex); 2998 return 0; 2999 } 3000 EXPORT_SYMBOL(dvb_register_frontend); 3001 3002 int dvb_unregister_frontend(struct dvb_frontend *fe) 3003 { 3004 struct dvb_frontend_private *fepriv = fe->frontend_priv; 3005 3006 dev_dbg(fe->dvb->device, "%s:\n", __func__); 3007 3008 mutex_lock(&frontend_mutex); 3009 dvb_frontend_stop(fe); 3010 dvb_remove_device(fepriv->dvbdev); 3011 3012 /* fe is invalid now */ 3013 mutex_unlock(&frontend_mutex); 3014 dvb_frontend_put(fe); 3015 return 0; 3016 } 3017 EXPORT_SYMBOL(dvb_unregister_frontend); 3018 3019 static void dvb_frontend_invoke_release(struct dvb_frontend *fe, 3020 void (*release)(struct dvb_frontend *fe)) 3021 { 3022 if (release) { 3023 release(fe); 3024 #ifdef CONFIG_MEDIA_ATTACH 3025 dvb_detach(release); 3026 #endif 3027 } 3028 } 3029 3030 void dvb_frontend_detach(struct dvb_frontend *fe) 3031 { 3032 dvb_frontend_invoke_release(fe, fe->ops.release_sec); 3033 dvb_frontend_invoke_release(fe, fe->ops.tuner_ops.release); 3034 dvb_frontend_invoke_release(fe, fe->ops.analog_ops.release); 3035 dvb_frontend_invoke_release(fe, fe->ops.detach); 3036 dvb_frontend_put(fe); 3037 } 3038 EXPORT_SYMBOL(dvb_frontend_detach); 3039