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