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