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