dvb_frontend.c revision 0607d077809014082965061e9e88f38459c070ac
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#include <linux/string.h> 29#include <linux/kernel.h> 30#include <linux/sched.h> 31#include <linux/wait.h> 32#include <linux/slab.h> 33#include <linux/poll.h> 34#include <linux/semaphore.h> 35#include <linux/module.h> 36#include <linux/list.h> 37#include <linux/freezer.h> 38#include <linux/jiffies.h> 39#include <linux/kthread.h> 40#include <asm/processor.h> 41 42#include "dvb_frontend.h" 43#include "dvbdev.h" 44#include <linux/dvb/version.h> 45 46static int dvb_frontend_debug; 47static int dvb_shutdown_timeout; 48static int dvb_force_auto_inversion; 49static int dvb_override_tune_delay; 50static int dvb_powerdown_on_sleep = 1; 51static int dvb_mfe_wait_time = 5; 52 53module_param_named(frontend_debug, dvb_frontend_debug, int, 0644); 54MODULE_PARM_DESC(frontend_debug, "Turn on/off frontend core debugging (default:off)."); 55module_param(dvb_shutdown_timeout, int, 0644); 56MODULE_PARM_DESC(dvb_shutdown_timeout, "wait <shutdown_timeout> seconds after close() before suspending hardware"); 57module_param(dvb_force_auto_inversion, int, 0644); 58MODULE_PARM_DESC(dvb_force_auto_inversion, "0: normal (default), 1: INVERSION_AUTO forced always"); 59module_param(dvb_override_tune_delay, int, 0644); 60MODULE_PARM_DESC(dvb_override_tune_delay, "0: normal (default), >0 => delay in milliseconds to wait for lock after a tune attempt"); 61module_param(dvb_powerdown_on_sleep, int, 0644); 62MODULE_PARM_DESC(dvb_powerdown_on_sleep, "0: do not power down, 1: turn LNB voltage off on sleep (default)"); 63module_param(dvb_mfe_wait_time, int, 0644); 64MODULE_PARM_DESC(dvb_mfe_wait_time, "Wait up to <mfe_wait_time> seconds on open() for multi-frontend to become available (default:5 seconds)"); 65 66#define dprintk if (dvb_frontend_debug) printk 67 68#define FESTATE_IDLE 1 69#define FESTATE_RETUNE 2 70#define FESTATE_TUNING_FAST 4 71#define FESTATE_TUNING_SLOW 8 72#define FESTATE_TUNED 16 73#define FESTATE_ZIGZAG_FAST 32 74#define FESTATE_ZIGZAG_SLOW 64 75#define FESTATE_DISEQC 128 76#define FESTATE_ERROR 256 77#define FESTATE_WAITFORLOCK (FESTATE_TUNING_FAST | FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW | FESTATE_DISEQC) 78#define FESTATE_SEARCHING_FAST (FESTATE_TUNING_FAST | FESTATE_ZIGZAG_FAST) 79#define FESTATE_SEARCHING_SLOW (FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_SLOW) 80#define FESTATE_LOSTLOCK (FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW) 81 82#define FE_ALGO_HW 1 83/* 84 * FESTATE_IDLE. No tuning parameters have been supplied and the loop is idling. 85 * FESTATE_RETUNE. Parameters have been supplied, but we have not yet performed the first tune. 86 * FESTATE_TUNING_FAST. Tuning parameters have been supplied and fast zigzag scan is in progress. 87 * FESTATE_TUNING_SLOW. Tuning parameters have been supplied. Fast zigzag failed, so we're trying again, but slower. 88 * FESTATE_TUNED. The frontend has successfully locked on. 89 * FESTATE_ZIGZAG_FAST. The lock has been lost, and a fast zigzag has been initiated to try and regain it. 90 * FESTATE_ZIGZAG_SLOW. The lock has been lost. Fast zigzag has been failed, so we're trying again, but slower. 91 * FESTATE_DISEQC. A DISEQC command has just been issued. 92 * FESTATE_WAITFORLOCK. When we're waiting for a lock. 93 * FESTATE_SEARCHING_FAST. When we're searching for a signal using a fast zigzag scan. 94 * FESTATE_SEARCHING_SLOW. When we're searching for a signal using a slow zigzag scan. 95 * FESTATE_LOSTLOCK. When the lock has been lost, and we're searching it again. 96 */ 97 98#define DVB_FE_NO_EXIT 0 99#define DVB_FE_NORMAL_EXIT 1 100#define DVB_FE_DEVICE_REMOVED 2 101 102static DEFINE_MUTEX(frontend_mutex); 103 104struct dvb_frontend_private { 105 106 /* thread/frontend values */ 107 struct dvb_device *dvbdev; 108 struct dvb_frontend_parameters parameters_in; 109 struct dvb_frontend_parameters parameters_out; 110 struct dvb_fe_events events; 111 struct semaphore sem; 112 struct list_head list_head; 113 wait_queue_head_t wait_queue; 114 struct task_struct *thread; 115 unsigned long release_jiffies; 116 unsigned int exit; 117 unsigned int wakeup; 118 fe_status_t status; 119 unsigned long tune_mode_flags; 120 unsigned int delay; 121 unsigned int reinitialise; 122 int tone; 123 int voltage; 124 125 /* swzigzag values */ 126 unsigned int state; 127 unsigned int bending; 128 int lnb_drift; 129 unsigned int inversion; 130 unsigned int auto_step; 131 unsigned int auto_sub_step; 132 unsigned int started_auto_step; 133 unsigned int min_delay; 134 unsigned int max_drift; 135 unsigned int step_size; 136 int quality; 137 unsigned int check_wrapped; 138 enum dvbfe_search algo_status; 139}; 140 141static void dvb_frontend_wakeup(struct dvb_frontend *fe); 142 143static void dvb_frontend_add_event(struct dvb_frontend *fe, fe_status_t status) 144{ 145 struct dvb_frontend_private *fepriv = fe->frontend_priv; 146 struct dvb_fe_events *events = &fepriv->events; 147 struct dvb_frontend_event *e; 148 int wp; 149 150 dprintk ("%s\n", __func__); 151 152 if ((status & FE_HAS_LOCK) && fe->ops.get_frontend) 153 fe->ops.get_frontend(fe, &fepriv->parameters_out); 154 155 mutex_lock(&events->mtx); 156 157 wp = (events->eventw + 1) % MAX_EVENT; 158 if (wp == events->eventr) { 159 events->overflow = 1; 160 events->eventr = (events->eventr + 1) % MAX_EVENT; 161 } 162 163 e = &events->events[events->eventw]; 164 e->status = status; 165 e->parameters = fepriv->parameters_out; 166 167 events->eventw = wp; 168 169 mutex_unlock(&events->mtx); 170 171 wake_up_interruptible (&events->wait_queue); 172} 173 174static int dvb_frontend_get_event(struct dvb_frontend *fe, 175 struct dvb_frontend_event *event, int flags) 176{ 177 struct dvb_frontend_private *fepriv = fe->frontend_priv; 178 struct dvb_fe_events *events = &fepriv->events; 179 180 dprintk ("%s\n", __func__); 181 182 if (events->overflow) { 183 events->overflow = 0; 184 return -EOVERFLOW; 185 } 186 187 if (events->eventw == events->eventr) { 188 int ret; 189 190 if (flags & O_NONBLOCK) 191 return -EWOULDBLOCK; 192 193 up(&fepriv->sem); 194 195 ret = wait_event_interruptible (events->wait_queue, 196 events->eventw != events->eventr); 197 198 if (down_interruptible (&fepriv->sem)) 199 return -ERESTARTSYS; 200 201 if (ret < 0) 202 return ret; 203 } 204 205 mutex_lock(&events->mtx); 206 *event = events->events[events->eventr]; 207 events->eventr = (events->eventr + 1) % MAX_EVENT; 208 mutex_unlock(&events->mtx); 209 210 return 0; 211} 212 213static void dvb_frontend_clear_events(struct dvb_frontend *fe) 214{ 215 struct dvb_frontend_private *fepriv = fe->frontend_priv; 216 struct dvb_fe_events *events = &fepriv->events; 217 218 mutex_lock(&events->mtx); 219 events->eventr = events->eventw; 220 mutex_unlock(&events->mtx); 221} 222 223static void dvb_frontend_init(struct dvb_frontend *fe) 224{ 225 dprintk ("DVB: initialising adapter %i frontend %i (%s)...\n", 226 fe->dvb->num, 227 fe->id, 228 fe->ops.info.name); 229 230 if (fe->ops.init) 231 fe->ops.init(fe); 232 if (fe->ops.tuner_ops.init) { 233 if (fe->ops.i2c_gate_ctrl) 234 fe->ops.i2c_gate_ctrl(fe, 1); 235 fe->ops.tuner_ops.init(fe); 236 if (fe->ops.i2c_gate_ctrl) 237 fe->ops.i2c_gate_ctrl(fe, 0); 238 } 239} 240 241void dvb_frontend_reinitialise(struct dvb_frontend *fe) 242{ 243 struct dvb_frontend_private *fepriv = fe->frontend_priv; 244 245 fepriv->reinitialise = 1; 246 dvb_frontend_wakeup(fe); 247} 248EXPORT_SYMBOL(dvb_frontend_reinitialise); 249 250static void dvb_frontend_swzigzag_update_delay(struct dvb_frontend_private *fepriv, int locked) 251{ 252 int q2; 253 254 dprintk ("%s\n", __func__); 255 256 if (locked) 257 (fepriv->quality) = (fepriv->quality * 220 + 36*256) / 256; 258 else 259 (fepriv->quality) = (fepriv->quality * 220 + 0) / 256; 260 261 q2 = fepriv->quality - 128; 262 q2 *= q2; 263 264 fepriv->delay = fepriv->min_delay + q2 * HZ / (128*128); 265} 266 267/** 268 * Performs automatic twiddling of frontend parameters. 269 * 270 * @param fe The frontend concerned. 271 * @param check_wrapped Checks if an iteration has completed. DO NOT SET ON THE FIRST ATTEMPT 272 * @returns Number of complete iterations that have been performed. 273 */ 274static int dvb_frontend_swzigzag_autotune(struct dvb_frontend *fe, int check_wrapped) 275{ 276 int autoinversion; 277 int ready = 0; 278 int fe_set_err = 0; 279 struct dvb_frontend_private *fepriv = fe->frontend_priv; 280 int original_inversion = fepriv->parameters_in.inversion; 281 u32 original_frequency = fepriv->parameters_in.frequency; 282 283 /* are we using autoinversion? */ 284 autoinversion = ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) && 285 (fepriv->parameters_in.inversion == INVERSION_AUTO)); 286 287 /* setup parameters correctly */ 288 while(!ready) { 289 /* calculate the lnb_drift */ 290 fepriv->lnb_drift = fepriv->auto_step * fepriv->step_size; 291 292 /* wrap the auto_step if we've exceeded the maximum drift */ 293 if (fepriv->lnb_drift > fepriv->max_drift) { 294 fepriv->auto_step = 0; 295 fepriv->auto_sub_step = 0; 296 fepriv->lnb_drift = 0; 297 } 298 299 /* perform inversion and +/- zigzag */ 300 switch(fepriv->auto_sub_step) { 301 case 0: 302 /* try with the current inversion and current drift setting */ 303 ready = 1; 304 break; 305 306 case 1: 307 if (!autoinversion) break; 308 309 fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF; 310 ready = 1; 311 break; 312 313 case 2: 314 if (fepriv->lnb_drift == 0) break; 315 316 fepriv->lnb_drift = -fepriv->lnb_drift; 317 ready = 1; 318 break; 319 320 case 3: 321 if (fepriv->lnb_drift == 0) break; 322 if (!autoinversion) break; 323 324 fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF; 325 fepriv->lnb_drift = -fepriv->lnb_drift; 326 ready = 1; 327 break; 328 329 default: 330 fepriv->auto_step++; 331 fepriv->auto_sub_step = -1; /* it'll be incremented to 0 in a moment */ 332 break; 333 } 334 335 if (!ready) fepriv->auto_sub_step++; 336 } 337 338 /* if this attempt would hit where we started, indicate a complete 339 * iteration has occurred */ 340 if ((fepriv->auto_step == fepriv->started_auto_step) && 341 (fepriv->auto_sub_step == 0) && check_wrapped) { 342 return 1; 343 } 344 345 dprintk("%s: drift:%i inversion:%i auto_step:%i " 346 "auto_sub_step:%i started_auto_step:%i\n", 347 __func__, fepriv->lnb_drift, fepriv->inversion, 348 fepriv->auto_step, fepriv->auto_sub_step, fepriv->started_auto_step); 349 350 /* set the frontend itself */ 351 fepriv->parameters_in.frequency += fepriv->lnb_drift; 352 if (autoinversion) 353 fepriv->parameters_in.inversion = fepriv->inversion; 354 if (fe->ops.set_frontend) 355 fe_set_err = fe->ops.set_frontend(fe, &fepriv->parameters_in); 356 fepriv->parameters_out = fepriv->parameters_in; 357 if (fe_set_err < 0) { 358 fepriv->state = FESTATE_ERROR; 359 return fe_set_err; 360 } 361 362 fepriv->parameters_in.frequency = original_frequency; 363 fepriv->parameters_in.inversion = original_inversion; 364 365 fepriv->auto_sub_step++; 366 return 0; 367} 368 369static void dvb_frontend_swzigzag(struct dvb_frontend *fe) 370{ 371 fe_status_t s = 0; 372 int retval = 0; 373 struct dvb_frontend_private *fepriv = fe->frontend_priv; 374 375 /* if we've got no parameters, just keep idling */ 376 if (fepriv->state & FESTATE_IDLE) { 377 fepriv->delay = 3*HZ; 378 fepriv->quality = 0; 379 return; 380 } 381 382 /* in SCAN mode, we just set the frontend when asked and leave it alone */ 383 if (fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT) { 384 if (fepriv->state & FESTATE_RETUNE) { 385 if (fe->ops.set_frontend) 386 retval = fe->ops.set_frontend(fe, 387 &fepriv->parameters_in); 388 fepriv->parameters_out = fepriv->parameters_in; 389 if (retval < 0) 390 fepriv->state = FESTATE_ERROR; 391 else 392 fepriv->state = FESTATE_TUNED; 393 } 394 fepriv->delay = 3*HZ; 395 fepriv->quality = 0; 396 return; 397 } 398 399 /* get the frontend status */ 400 if (fepriv->state & FESTATE_RETUNE) { 401 s = 0; 402 } else { 403 if (fe->ops.read_status) 404 fe->ops.read_status(fe, &s); 405 if (s != fepriv->status) { 406 dvb_frontend_add_event(fe, s); 407 fepriv->status = s; 408 } 409 } 410 411 /* if we're not tuned, and we have a lock, move to the TUNED state */ 412 if ((fepriv->state & FESTATE_WAITFORLOCK) && (s & FE_HAS_LOCK)) { 413 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 414 fepriv->state = FESTATE_TUNED; 415 416 /* if we're tuned, then we have determined the correct inversion */ 417 if ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) && 418 (fepriv->parameters_in.inversion == INVERSION_AUTO)) { 419 fepriv->parameters_in.inversion = fepriv->inversion; 420 } 421 return; 422 } 423 424 /* if we are tuned already, check we're still locked */ 425 if (fepriv->state & FESTATE_TUNED) { 426 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 427 428 /* we're tuned, and the lock is still good... */ 429 if (s & FE_HAS_LOCK) { 430 return; 431 } else { /* if we _WERE_ tuned, but now don't have a lock */ 432 fepriv->state = FESTATE_ZIGZAG_FAST; 433 fepriv->started_auto_step = fepriv->auto_step; 434 fepriv->check_wrapped = 0; 435 } 436 } 437 438 /* don't actually do anything if we're in the LOSTLOCK state, 439 * the frontend is set to FE_CAN_RECOVER, and the max_drift is 0 */ 440 if ((fepriv->state & FESTATE_LOSTLOCK) && 441 (fe->ops.info.caps & FE_CAN_RECOVER) && (fepriv->max_drift == 0)) { 442 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 443 return; 444 } 445 446 /* don't do anything if we're in the DISEQC state, since this 447 * might be someone with a motorized dish controlled by DISEQC. 448 * If its actually a re-tune, there will be a SET_FRONTEND soon enough. */ 449 if (fepriv->state & FESTATE_DISEQC) { 450 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 451 return; 452 } 453 454 /* if we're in the RETUNE state, set everything up for a brand 455 * new scan, keeping the current inversion setting, as the next 456 * tune is _very_ likely to require the same */ 457 if (fepriv->state & FESTATE_RETUNE) { 458 fepriv->lnb_drift = 0; 459 fepriv->auto_step = 0; 460 fepriv->auto_sub_step = 0; 461 fepriv->started_auto_step = 0; 462 fepriv->check_wrapped = 0; 463 } 464 465 /* fast zigzag. */ 466 if ((fepriv->state & FESTATE_SEARCHING_FAST) || (fepriv->state & FESTATE_RETUNE)) { 467 fepriv->delay = fepriv->min_delay; 468 469 /* perform a tune */ 470 retval = dvb_frontend_swzigzag_autotune(fe, 471 fepriv->check_wrapped); 472 if (retval < 0) { 473 return; 474 } else if (retval) { 475 /* OK, if we've run out of trials at the fast speed. 476 * Drop back to slow for the _next_ attempt */ 477 fepriv->state = FESTATE_SEARCHING_SLOW; 478 fepriv->started_auto_step = fepriv->auto_step; 479 return; 480 } 481 fepriv->check_wrapped = 1; 482 483 /* if we've just retuned, enter the ZIGZAG_FAST state. 484 * This ensures we cannot return from an 485 * FE_SET_FRONTEND ioctl before the first frontend tune 486 * occurs */ 487 if (fepriv->state & FESTATE_RETUNE) { 488 fepriv->state = FESTATE_TUNING_FAST; 489 } 490 } 491 492 /* slow zigzag */ 493 if (fepriv->state & FESTATE_SEARCHING_SLOW) { 494 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 495 496 /* Note: don't bother checking for wrapping; we stay in this 497 * state until we get a lock */ 498 dvb_frontend_swzigzag_autotune(fe, 0); 499 } 500} 501 502static int dvb_frontend_is_exiting(struct dvb_frontend *fe) 503{ 504 struct dvb_frontend_private *fepriv = fe->frontend_priv; 505 506 if (fepriv->exit != DVB_FE_NO_EXIT) 507 return 1; 508 509 if (fepriv->dvbdev->writers == 1) 510 if (time_after_eq(jiffies, fepriv->release_jiffies + 511 dvb_shutdown_timeout * HZ)) 512 return 1; 513 514 return 0; 515} 516 517static int dvb_frontend_should_wakeup(struct dvb_frontend *fe) 518{ 519 struct dvb_frontend_private *fepriv = fe->frontend_priv; 520 521 if (fepriv->wakeup) { 522 fepriv->wakeup = 0; 523 return 1; 524 } 525 return dvb_frontend_is_exiting(fe); 526} 527 528static void dvb_frontend_wakeup(struct dvb_frontend *fe) 529{ 530 struct dvb_frontend_private *fepriv = fe->frontend_priv; 531 532 fepriv->wakeup = 1; 533 wake_up_interruptible(&fepriv->wait_queue); 534} 535 536static int dvb_frontend_thread(void *data) 537{ 538 struct dvb_frontend *fe = data; 539 struct dvb_frontend_private *fepriv = fe->frontend_priv; 540 fe_status_t s; 541 enum dvbfe_algo algo; 542 543 struct dvb_frontend_parameters *params; 544 545 dprintk("%s\n", __func__); 546 547 fepriv->check_wrapped = 0; 548 fepriv->quality = 0; 549 fepriv->delay = 3*HZ; 550 fepriv->status = 0; 551 fepriv->wakeup = 0; 552 fepriv->reinitialise = 0; 553 554 dvb_frontend_init(fe); 555 556 set_freezable(); 557 while (1) { 558 up(&fepriv->sem); /* is locked when we enter the thread... */ 559restart: 560 wait_event_interruptible_timeout(fepriv->wait_queue, 561 dvb_frontend_should_wakeup(fe) || kthread_should_stop() 562 || freezing(current), 563 fepriv->delay); 564 565 if (kthread_should_stop() || dvb_frontend_is_exiting(fe)) { 566 /* got signal or quitting */ 567 fepriv->exit = DVB_FE_NORMAL_EXIT; 568 break; 569 } 570 571 if (try_to_freeze()) 572 goto restart; 573 574 if (down_interruptible(&fepriv->sem)) 575 break; 576 577 if (fepriv->reinitialise) { 578 dvb_frontend_init(fe); 579 if (fe->ops.set_tone && fepriv->tone != -1) 580 fe->ops.set_tone(fe, fepriv->tone); 581 if (fe->ops.set_voltage && fepriv->voltage != -1) 582 fe->ops.set_voltage(fe, fepriv->voltage); 583 fepriv->reinitialise = 0; 584 } 585 586 /* do an iteration of the tuning loop */ 587 if (fe->ops.get_frontend_algo) { 588 algo = fe->ops.get_frontend_algo(fe); 589 switch (algo) { 590 case DVBFE_ALGO_HW: 591 dprintk("%s: Frontend ALGO = DVBFE_ALGO_HW\n", __func__); 592 params = NULL; /* have we been asked to RETUNE ? */ 593 594 if (fepriv->state & FESTATE_RETUNE) { 595 dprintk("%s: Retune requested, FESTATE_RETUNE\n", __func__); 596 params = &fepriv->parameters_in; 597 fepriv->state = FESTATE_TUNED; 598 } 599 600 if (fe->ops.tune) 601 fe->ops.tune(fe, params, fepriv->tune_mode_flags, &fepriv->delay, &s); 602 if (params) 603 fepriv->parameters_out = *params; 604 605 if (s != fepriv->status && !(fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT)) { 606 dprintk("%s: state changed, adding current state\n", __func__); 607 dvb_frontend_add_event(fe, s); 608 fepriv->status = s; 609 } 610 break; 611 case DVBFE_ALGO_SW: 612 dprintk("%s: Frontend ALGO = DVBFE_ALGO_SW\n", __func__); 613 dvb_frontend_swzigzag(fe); 614 break; 615 case DVBFE_ALGO_CUSTOM: 616 dprintk("%s: Frontend ALGO = DVBFE_ALGO_CUSTOM, state=%d\n", __func__, fepriv->state); 617 if (fepriv->state & FESTATE_RETUNE) { 618 dprintk("%s: Retune requested, FESTAT_RETUNE\n", __func__); 619 fepriv->state = FESTATE_TUNED; 620 } 621 /* Case where we are going to search for a carrier 622 * User asked us to retune again for some reason, possibly 623 * requesting a search with a new set of parameters 624 */ 625 if (fepriv->algo_status & DVBFE_ALGO_SEARCH_AGAIN) { 626 if (fe->ops.search) { 627 fepriv->algo_status = fe->ops.search(fe, &fepriv->parameters_in); 628 /* We did do a search as was requested, the flags are 629 * now unset as well and has the flags wrt to search. 630 */ 631 } else { 632 fepriv->algo_status &= ~DVBFE_ALGO_SEARCH_AGAIN; 633 } 634 } 635 /* Track the carrier if the search was successful */ 636 if (fepriv->algo_status == DVBFE_ALGO_SEARCH_SUCCESS) { 637 if (fe->ops.track) 638 fe->ops.track(fe, &fepriv->parameters_in); 639 } else { 640 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 641 fepriv->delay = HZ / 2; 642 } 643 fepriv->parameters_out = fepriv->parameters_in; 644 fe->ops.read_status(fe, &s); 645 if (s != fepriv->status) { 646 dvb_frontend_add_event(fe, s); /* update event list */ 647 fepriv->status = s; 648 if (!(s & FE_HAS_LOCK)) { 649 fepriv->delay = HZ / 10; 650 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 651 } else { 652 fepriv->delay = 60 * HZ; 653 } 654 } 655 break; 656 default: 657 dprintk("%s: UNDEFINED ALGO !\n", __func__); 658 break; 659 } 660 } else { 661 dvb_frontend_swzigzag(fe); 662 } 663 } 664 665 if (dvb_powerdown_on_sleep) { 666 if (fe->ops.set_voltage) 667 fe->ops.set_voltage(fe, SEC_VOLTAGE_OFF); 668 if (fe->ops.tuner_ops.sleep) { 669 if (fe->ops.i2c_gate_ctrl) 670 fe->ops.i2c_gate_ctrl(fe, 1); 671 fe->ops.tuner_ops.sleep(fe); 672 if (fe->ops.i2c_gate_ctrl) 673 fe->ops.i2c_gate_ctrl(fe, 0); 674 } 675 if (fe->ops.sleep) 676 fe->ops.sleep(fe); 677 } 678 679 fepriv->thread = NULL; 680 if (kthread_should_stop()) 681 fepriv->exit = DVB_FE_DEVICE_REMOVED; 682 else 683 fepriv->exit = DVB_FE_NO_EXIT; 684 mb(); 685 686 dvb_frontend_wakeup(fe); 687 return 0; 688} 689 690static void dvb_frontend_stop(struct dvb_frontend *fe) 691{ 692 struct dvb_frontend_private *fepriv = fe->frontend_priv; 693 694 dprintk ("%s\n", __func__); 695 696 fepriv->exit = DVB_FE_NORMAL_EXIT; 697 mb(); 698 699 if (!fepriv->thread) 700 return; 701 702 kthread_stop(fepriv->thread); 703 704 sema_init(&fepriv->sem, 1); 705 fepriv->state = FESTATE_IDLE; 706 707 /* paranoia check in case a signal arrived */ 708 if (fepriv->thread) 709 printk("dvb_frontend_stop: warning: thread %p won't exit\n", 710 fepriv->thread); 711} 712 713s32 timeval_usec_diff(struct timeval lasttime, struct timeval curtime) 714{ 715 return ((curtime.tv_usec < lasttime.tv_usec) ? 716 1000000 - lasttime.tv_usec + curtime.tv_usec : 717 curtime.tv_usec - lasttime.tv_usec); 718} 719EXPORT_SYMBOL(timeval_usec_diff); 720 721static inline void timeval_usec_add(struct timeval *curtime, u32 add_usec) 722{ 723 curtime->tv_usec += add_usec; 724 if (curtime->tv_usec >= 1000000) { 725 curtime->tv_usec -= 1000000; 726 curtime->tv_sec++; 727 } 728} 729 730/* 731 * Sleep until gettimeofday() > waketime + add_usec 732 * This needs to be as precise as possible, but as the delay is 733 * usually between 2ms and 32ms, it is done using a scheduled msleep 734 * followed by usleep (normally a busy-wait loop) for the remainder 735 */ 736void dvb_frontend_sleep_until(struct timeval *waketime, u32 add_usec) 737{ 738 struct timeval lasttime; 739 s32 delta, newdelta; 740 741 timeval_usec_add(waketime, add_usec); 742 743 do_gettimeofday(&lasttime); 744 delta = timeval_usec_diff(lasttime, *waketime); 745 if (delta > 2500) { 746 msleep((delta - 1500) / 1000); 747 do_gettimeofday(&lasttime); 748 newdelta = timeval_usec_diff(lasttime, *waketime); 749 delta = (newdelta > delta) ? 0 : newdelta; 750 } 751 if (delta > 0) 752 udelay(delta); 753} 754EXPORT_SYMBOL(dvb_frontend_sleep_until); 755 756static int dvb_frontend_start(struct dvb_frontend *fe) 757{ 758 int ret; 759 struct dvb_frontend_private *fepriv = fe->frontend_priv; 760 struct task_struct *fe_thread; 761 762 dprintk ("%s\n", __func__); 763 764 if (fepriv->thread) { 765 if (fepriv->exit == DVB_FE_NO_EXIT) 766 return 0; 767 else 768 dvb_frontend_stop (fe); 769 } 770 771 if (signal_pending(current)) 772 return -EINTR; 773 if (down_interruptible (&fepriv->sem)) 774 return -EINTR; 775 776 fepriv->state = FESTATE_IDLE; 777 fepriv->exit = DVB_FE_NO_EXIT; 778 fepriv->thread = NULL; 779 mb(); 780 781 fe_thread = kthread_run(dvb_frontend_thread, fe, 782 "kdvb-ad-%i-fe-%i", fe->dvb->num,fe->id); 783 if (IS_ERR(fe_thread)) { 784 ret = PTR_ERR(fe_thread); 785 printk("dvb_frontend_start: failed to start kthread (%d)\n", ret); 786 up(&fepriv->sem); 787 return ret; 788 } 789 fepriv->thread = fe_thread; 790 return 0; 791} 792 793static void dvb_frontend_get_frequency_limits(struct dvb_frontend *fe, 794 u32 *freq_min, u32 *freq_max) 795{ 796 *freq_min = max(fe->ops.info.frequency_min, fe->ops.tuner_ops.info.frequency_min); 797 798 if (fe->ops.info.frequency_max == 0) 799 *freq_max = fe->ops.tuner_ops.info.frequency_max; 800 else if (fe->ops.tuner_ops.info.frequency_max == 0) 801 *freq_max = fe->ops.info.frequency_max; 802 else 803 *freq_max = min(fe->ops.info.frequency_max, fe->ops.tuner_ops.info.frequency_max); 804 805 if (*freq_min == 0 || *freq_max == 0) 806 printk(KERN_WARNING "DVB: adapter %i frontend %u frequency limits undefined - fix the driver\n", 807 fe->dvb->num,fe->id); 808} 809 810static int dvb_frontend_check_parameters(struct dvb_frontend *fe, 811 struct dvb_frontend_parameters *parms) 812{ 813 u32 freq_min; 814 u32 freq_max; 815 816 /* range check: frequency */ 817 dvb_frontend_get_frequency_limits(fe, &freq_min, &freq_max); 818 if ((freq_min && parms->frequency < freq_min) || 819 (freq_max && parms->frequency > freq_max)) { 820 printk(KERN_WARNING "DVB: adapter %i frontend %i frequency %u out of range (%u..%u)\n", 821 fe->dvb->num, fe->id, parms->frequency, freq_min, freq_max); 822 return -EINVAL; 823 } 824 825 /* range check: symbol rate */ 826 if (fe->ops.info.type == FE_QPSK) { 827 if ((fe->ops.info.symbol_rate_min && 828 parms->u.qpsk.symbol_rate < fe->ops.info.symbol_rate_min) || 829 (fe->ops.info.symbol_rate_max && 830 parms->u.qpsk.symbol_rate > fe->ops.info.symbol_rate_max)) { 831 printk(KERN_WARNING "DVB: adapter %i frontend %i symbol rate %u out of range (%u..%u)\n", 832 fe->dvb->num, fe->id, parms->u.qpsk.symbol_rate, 833 fe->ops.info.symbol_rate_min, fe->ops.info.symbol_rate_max); 834 return -EINVAL; 835 } 836 837 } else if (fe->ops.info.type == FE_QAM) { 838 if ((fe->ops.info.symbol_rate_min && 839 parms->u.qam.symbol_rate < fe->ops.info.symbol_rate_min) || 840 (fe->ops.info.symbol_rate_max && 841 parms->u.qam.symbol_rate > fe->ops.info.symbol_rate_max)) { 842 printk(KERN_WARNING "DVB: adapter %i frontend %i symbol rate %u out of range (%u..%u)\n", 843 fe->dvb->num, fe->id, parms->u.qam.symbol_rate, 844 fe->ops.info.symbol_rate_min, fe->ops.info.symbol_rate_max); 845 return -EINVAL; 846 } 847 } 848 849 /* check for supported modulation */ 850 if (fe->ops.info.type == FE_QAM && 851 (parms->u.qam.modulation > QAM_AUTO || 852 !((1 << (parms->u.qam.modulation + 10)) & fe->ops.info.caps))) { 853 printk(KERN_WARNING "DVB: adapter %i frontend %i modulation %u not supported\n", 854 fe->dvb->num, fe->id, parms->u.qam.modulation); 855 return -EINVAL; 856 } 857 858 return 0; 859} 860 861static int dvb_frontend_clear_cache(struct dvb_frontend *fe) 862{ 863 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 864 int i; 865 866 memset(c, 0, sizeof(struct dtv_frontend_properties)); 867 868 c->state = DTV_CLEAR; 869 c->delivery_system = SYS_UNDEFINED; 870 c->inversion = INVERSION_AUTO; 871 c->fec_inner = FEC_AUTO; 872 c->transmission_mode = TRANSMISSION_MODE_AUTO; 873 c->bandwidth_hz = BANDWIDTH_AUTO; 874 c->guard_interval = GUARD_INTERVAL_AUTO; 875 c->hierarchy = HIERARCHY_AUTO; 876 c->symbol_rate = QAM_AUTO; 877 c->code_rate_HP = FEC_AUTO; 878 c->code_rate_LP = FEC_AUTO; 879 c->rolloff = ROLLOFF_AUTO; 880 881 c->isdbt_partial_reception = -1; 882 c->isdbt_sb_mode = -1; 883 c->isdbt_sb_subchannel = -1; 884 c->isdbt_sb_segment_idx = -1; 885 c->isdbt_sb_segment_count = -1; 886 c->isdbt_layer_enabled = 0x7; 887 for (i = 0; i < 3; i++) { 888 c->layer[i].fec = FEC_AUTO; 889 c->layer[i].modulation = QAM_AUTO; 890 c->layer[i].interleaving = -1; 891 c->layer[i].segment_count = -1; 892 } 893 894 return 0; 895} 896 897#define _DTV_CMD(n, s, b) \ 898[n] = { \ 899 .name = #n, \ 900 .cmd = n, \ 901 .set = s,\ 902 .buffer = b \ 903} 904 905static struct dtv_cmds_h dtv_cmds[DTV_MAX_COMMAND + 1] = { 906 _DTV_CMD(DTV_TUNE, 1, 0), 907 _DTV_CMD(DTV_CLEAR, 1, 0), 908 909 /* Set */ 910 _DTV_CMD(DTV_FREQUENCY, 1, 0), 911 _DTV_CMD(DTV_BANDWIDTH_HZ, 1, 0), 912 _DTV_CMD(DTV_MODULATION, 1, 0), 913 _DTV_CMD(DTV_INVERSION, 1, 0), 914 _DTV_CMD(DTV_DISEQC_MASTER, 1, 1), 915 _DTV_CMD(DTV_SYMBOL_RATE, 1, 0), 916 _DTV_CMD(DTV_INNER_FEC, 1, 0), 917 _DTV_CMD(DTV_VOLTAGE, 1, 0), 918 _DTV_CMD(DTV_TONE, 1, 0), 919 _DTV_CMD(DTV_PILOT, 1, 0), 920 _DTV_CMD(DTV_ROLLOFF, 1, 0), 921 _DTV_CMD(DTV_DELIVERY_SYSTEM, 1, 0), 922 _DTV_CMD(DTV_HIERARCHY, 1, 0), 923 _DTV_CMD(DTV_CODE_RATE_HP, 1, 0), 924 _DTV_CMD(DTV_CODE_RATE_LP, 1, 0), 925 _DTV_CMD(DTV_GUARD_INTERVAL, 1, 0), 926 _DTV_CMD(DTV_TRANSMISSION_MODE, 1, 0), 927 928 _DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 1, 0), 929 _DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 1, 0), 930 _DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 1, 0), 931 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 1, 0), 932 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 1, 0), 933 _DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 1, 0), 934 _DTV_CMD(DTV_ISDBT_LAYERA_FEC, 1, 0), 935 _DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 1, 0), 936 _DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 1, 0), 937 _DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 1, 0), 938 _DTV_CMD(DTV_ISDBT_LAYERB_FEC, 1, 0), 939 _DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 1, 0), 940 _DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 1, 0), 941 _DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 1, 0), 942 _DTV_CMD(DTV_ISDBT_LAYERC_FEC, 1, 0), 943 _DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 1, 0), 944 _DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 1, 0), 945 _DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 1, 0), 946 947 _DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 0, 0), 948 _DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 0, 0), 949 _DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 0, 0), 950 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 0, 0), 951 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 0, 0), 952 _DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 0, 0), 953 _DTV_CMD(DTV_ISDBT_LAYERA_FEC, 0, 0), 954 _DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 0, 0), 955 _DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 0, 0), 956 _DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 0, 0), 957 _DTV_CMD(DTV_ISDBT_LAYERB_FEC, 0, 0), 958 _DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 0, 0), 959 _DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 0, 0), 960 _DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 0, 0), 961 _DTV_CMD(DTV_ISDBT_LAYERC_FEC, 0, 0), 962 _DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 0, 0), 963 _DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 0, 0), 964 _DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 0, 0), 965 966 _DTV_CMD(DTV_ISDBS_TS_ID, 1, 0), 967 _DTV_CMD(DTV_DVBT2_PLP_ID, 1, 0), 968 969 /* Get */ 970 _DTV_CMD(DTV_DISEQC_SLAVE_REPLY, 0, 1), 971 _DTV_CMD(DTV_API_VERSION, 0, 0), 972 _DTV_CMD(DTV_CODE_RATE_HP, 0, 0), 973 _DTV_CMD(DTV_CODE_RATE_LP, 0, 0), 974 _DTV_CMD(DTV_GUARD_INTERVAL, 0, 0), 975 _DTV_CMD(DTV_TRANSMISSION_MODE, 0, 0), 976 _DTV_CMD(DTV_HIERARCHY, 0, 0), 977 978 _DTV_CMD(DTV_ENUM_DELSYS, 0, 0), 979}; 980 981static void dtv_property_dump(struct dtv_property *tvp) 982{ 983 int i; 984 985 if (tvp->cmd <= 0 || tvp->cmd > DTV_MAX_COMMAND) { 986 printk(KERN_WARNING "%s: tvp.cmd = 0x%08x undefined\n", 987 __func__, tvp->cmd); 988 return; 989 } 990 991 dprintk("%s() tvp.cmd = 0x%08x (%s)\n" 992 ,__func__ 993 ,tvp->cmd 994 ,dtv_cmds[ tvp->cmd ].name); 995 996 if(dtv_cmds[ tvp->cmd ].buffer) { 997 998 dprintk("%s() tvp.u.buffer.len = 0x%02x\n" 999 ,__func__ 1000 ,tvp->u.buffer.len); 1001 1002 for(i = 0; i < tvp->u.buffer.len; i++) 1003 dprintk("%s() tvp.u.buffer.data[0x%02x] = 0x%02x\n" 1004 ,__func__ 1005 ,i 1006 ,tvp->u.buffer.data[i]); 1007 1008 } else 1009 dprintk("%s() tvp.u.data = 0x%08x\n", __func__, tvp->u.data); 1010} 1011 1012static int is_legacy_delivery_system(fe_delivery_system_t s) 1013{ 1014 if((s == SYS_UNDEFINED) || (s == SYS_DVBC_ANNEX_A) || 1015 (s == SYS_DVBC_ANNEX_B) || (s == SYS_DVBT) || (s == SYS_DVBS) || 1016 (s == SYS_ATSC)) 1017 return 1; 1018 1019 return 0; 1020} 1021 1022/* Initialize the cache with some default values derived from the 1023 * legacy frontend_info structure. 1024 */ 1025static void dtv_property_cache_init(struct dvb_frontend *fe, 1026 struct dtv_frontend_properties *c) 1027{ 1028 switch (fe->ops.info.type) { 1029 case FE_QPSK: 1030 c->modulation = QPSK; /* implied for DVB-S in legacy API */ 1031 c->rolloff = ROLLOFF_35;/* implied for DVB-S */ 1032 c->delivery_system = SYS_DVBS; 1033 break; 1034 case FE_QAM: 1035 c->delivery_system = SYS_DVBC_ANNEX_A; 1036 break; 1037 case FE_OFDM: 1038 c->delivery_system = SYS_DVBT; 1039 break; 1040 case FE_ATSC: 1041 break; 1042 } 1043} 1044 1045/* Synchronise the legacy tuning parameters into the cache, so that demodulator 1046 * drivers can use a single set_frontend tuning function, regardless of whether 1047 * it's being used for the legacy or new API, reducing code and complexity. 1048 */ 1049static void dtv_property_cache_sync(struct dvb_frontend *fe, 1050 struct dtv_frontend_properties *c, 1051 const struct dvb_frontend_parameters *p) 1052{ 1053 c->frequency = p->frequency; 1054 c->inversion = p->inversion; 1055 1056 switch (fe->ops.info.type) { 1057 case FE_QPSK: 1058 c->symbol_rate = p->u.qpsk.symbol_rate; 1059 c->fec_inner = p->u.qpsk.fec_inner; 1060 break; 1061 case FE_QAM: 1062 c->symbol_rate = p->u.qam.symbol_rate; 1063 c->fec_inner = p->u.qam.fec_inner; 1064 c->modulation = p->u.qam.modulation; 1065 break; 1066 case FE_OFDM: 1067 if (p->u.ofdm.bandwidth == BANDWIDTH_6_MHZ) 1068 c->bandwidth_hz = 6000000; 1069 else if (p->u.ofdm.bandwidth == BANDWIDTH_7_MHZ) 1070 c->bandwidth_hz = 7000000; 1071 else if (p->u.ofdm.bandwidth == BANDWIDTH_8_MHZ) 1072 c->bandwidth_hz = 8000000; 1073 else 1074 /* Including BANDWIDTH_AUTO */ 1075 c->bandwidth_hz = 0; 1076 c->code_rate_HP = p->u.ofdm.code_rate_HP; 1077 c->code_rate_LP = p->u.ofdm.code_rate_LP; 1078 c->modulation = p->u.ofdm.constellation; 1079 c->transmission_mode = p->u.ofdm.transmission_mode; 1080 c->guard_interval = p->u.ofdm.guard_interval; 1081 c->hierarchy = p->u.ofdm.hierarchy_information; 1082 break; 1083 case FE_ATSC: 1084 c->modulation = p->u.vsb.modulation; 1085 if ((c->modulation == VSB_8) || (c->modulation == VSB_16)) 1086 c->delivery_system = SYS_ATSC; 1087 else 1088 c->delivery_system = SYS_DVBC_ANNEX_B; 1089 break; 1090 } 1091} 1092 1093/* Ensure the cached values are set correctly in the frontend 1094 * legacy tuning structures, for the advanced tuning API. 1095 */ 1096static void dtv_property_legacy_params_sync(struct dvb_frontend *fe) 1097{ 1098 const struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1099 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1100 struct dvb_frontend_parameters *p = &fepriv->parameters_in; 1101 1102 p->frequency = c->frequency; 1103 p->inversion = c->inversion; 1104 1105 switch (fe->ops.info.type) { 1106 case FE_QPSK: 1107 dprintk("%s() Preparing QPSK req\n", __func__); 1108 p->u.qpsk.symbol_rate = c->symbol_rate; 1109 p->u.qpsk.fec_inner = c->fec_inner; 1110 break; 1111 case FE_QAM: 1112 dprintk("%s() Preparing QAM req\n", __func__); 1113 p->u.qam.symbol_rate = c->symbol_rate; 1114 p->u.qam.fec_inner = c->fec_inner; 1115 p->u.qam.modulation = c->modulation; 1116 break; 1117 case FE_OFDM: 1118 dprintk("%s() Preparing OFDM req\n", __func__); 1119 if (c->bandwidth_hz == 6000000) 1120 p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ; 1121 else if (c->bandwidth_hz == 7000000) 1122 p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ; 1123 else if (c->bandwidth_hz == 8000000) 1124 p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ; 1125 else 1126 p->u.ofdm.bandwidth = BANDWIDTH_AUTO; 1127 p->u.ofdm.code_rate_HP = c->code_rate_HP; 1128 p->u.ofdm.code_rate_LP = c->code_rate_LP; 1129 p->u.ofdm.constellation = c->modulation; 1130 p->u.ofdm.transmission_mode = c->transmission_mode; 1131 p->u.ofdm.guard_interval = c->guard_interval; 1132 p->u.ofdm.hierarchy_information = c->hierarchy; 1133 break; 1134 case FE_ATSC: 1135 dprintk("%s() Preparing VSB req\n", __func__); 1136 p->u.vsb.modulation = c->modulation; 1137 break; 1138 } 1139} 1140 1141/* Ensure the cached values are set correctly in the frontend 1142 * legacy tuning structures, for the legacy tuning API. 1143 */ 1144static void dtv_property_adv_params_sync(struct dvb_frontend *fe) 1145{ 1146 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1147 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1148 struct dvb_frontend_parameters *p = &fepriv->parameters_in; 1149 u32 rolloff = 0; 1150 1151 p->frequency = c->frequency; 1152 p->inversion = c->inversion; 1153 1154 if (c->delivery_system == SYS_DSS || 1155 c->delivery_system == SYS_DVBS || 1156 c->delivery_system == SYS_DVBS2 || 1157 c->delivery_system == SYS_ISDBS || 1158 c->delivery_system == SYS_TURBO) { 1159 p->u.qpsk.symbol_rate = c->symbol_rate; 1160 p->u.qpsk.fec_inner = c->fec_inner; 1161 } 1162 1163 /* Fake out a generic DVB-T request so we pass validation in the ioctl */ 1164 if ((c->delivery_system == SYS_ISDBT) || 1165 (c->delivery_system == SYS_DVBT2)) { 1166 p->u.ofdm.constellation = QAM_AUTO; 1167 p->u.ofdm.code_rate_HP = FEC_AUTO; 1168 p->u.ofdm.code_rate_LP = FEC_AUTO; 1169 p->u.ofdm.transmission_mode = TRANSMISSION_MODE_AUTO; 1170 p->u.ofdm.guard_interval = GUARD_INTERVAL_AUTO; 1171 p->u.ofdm.hierarchy_information = HIERARCHY_AUTO; 1172 if (c->bandwidth_hz == 8000000) 1173 p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ; 1174 else if (c->bandwidth_hz == 7000000) 1175 p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ; 1176 else if (c->bandwidth_hz == 6000000) 1177 p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ; 1178 else 1179 p->u.ofdm.bandwidth = BANDWIDTH_AUTO; 1180 } 1181 1182 /* 1183 * Be sure that the bandwidth will be filled for all 1184 * non-satellite systems, as tuners need to know what 1185 * low pass/Nyquist half filter should be applied, in 1186 * order to avoid inter-channel noise. 1187 * 1188 * ISDB-T and DVB-T/T2 already sets bandwidth. 1189 * ATSC and DVB-C don't set, so, the core should fill it. 1190 * 1191 * On DVB-C Annex A and C, the bandwidth is a function of 1192 * the roll-off and symbol rate. Annex B defines different 1193 * roll-off factors depending on the modulation. Fortunately, 1194 * Annex B is only used with 6MHz, so there's no need to 1195 * calculate it. 1196 * 1197 * While not officially supported, a side effect of handling it at 1198 * the cache level is that a program could retrieve the bandwidth 1199 * via DTV_BANDWIDTH_HZ, which may be useful for test programs. 1200 */ 1201 switch (c->delivery_system) { 1202 case SYS_ATSC: 1203 case SYS_DVBC_ANNEX_B: 1204 c->bandwidth_hz = 6000000; 1205 break; 1206 case SYS_DVBC_ANNEX_A: 1207 rolloff = 115; 1208 break; 1209 case SYS_DVBC_ANNEX_C: 1210 rolloff = 113; 1211 break; 1212 default: 1213 break; 1214 } 1215 if (rolloff) 1216 c->bandwidth_hz = (c->symbol_rate * rolloff) / 100; 1217} 1218 1219static void dtv_property_cache_submit(struct dvb_frontend *fe) 1220{ 1221 const struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1222 1223 /* For legacy delivery systems we don't need the delivery_system to 1224 * be specified, but we populate the older structures from the cache 1225 * so we can call set_frontend on older drivers. 1226 */ 1227 if(is_legacy_delivery_system(c->delivery_system)) { 1228 1229 dprintk("%s() legacy, modulation = %d\n", __func__, c->modulation); 1230 dtv_property_legacy_params_sync(fe); 1231 1232 } else { 1233 dprintk("%s() adv, modulation = %d\n", __func__, c->modulation); 1234 1235 /* For advanced delivery systems / modulation types ... 1236 * we seed the lecacy dvb_frontend_parameters structure 1237 * so that the sanity checking code later in the IOCTL processing 1238 * can validate our basic frequency ranges, symbolrates, modulation 1239 * etc. 1240 */ 1241 dtv_property_adv_params_sync(fe); 1242 } 1243} 1244 1245static int dvb_frontend_ioctl_legacy(struct file *file, 1246 unsigned int cmd, void *parg); 1247static int dvb_frontend_ioctl_properties(struct file *file, 1248 unsigned int cmd, void *parg); 1249 1250static void dtv_set_default_delivery_caps(const struct dvb_frontend *fe, struct dtv_property *p) 1251{ 1252 const struct dvb_frontend_info *info = &fe->ops.info; 1253 u32 ncaps = 0; 1254 1255 switch (info->type) { 1256 case FE_QPSK: 1257 p->u.buffer.data[ncaps++] = SYS_DVBS; 1258 if (info->caps & FE_CAN_2G_MODULATION) 1259 p->u.buffer.data[ncaps++] = SYS_DVBS2; 1260 if (info->caps & FE_CAN_TURBO_FEC) 1261 p->u.buffer.data[ncaps++] = SYS_TURBO; 1262 break; 1263 case FE_QAM: 1264 p->u.buffer.data[ncaps++] = SYS_DVBC_ANNEX_A; 1265 break; 1266 case FE_OFDM: 1267 p->u.buffer.data[ncaps++] = SYS_DVBT; 1268 if (info->caps & FE_CAN_2G_MODULATION) 1269 p->u.buffer.data[ncaps++] = SYS_DVBT2; 1270 break; 1271 case FE_ATSC: 1272 if (info->caps & (FE_CAN_8VSB | FE_CAN_16VSB)) 1273 p->u.buffer.data[ncaps++] = SYS_ATSC; 1274 if (info->caps & (FE_CAN_QAM_16 | FE_CAN_QAM_64 | FE_CAN_QAM_128 | FE_CAN_QAM_256)) 1275 p->u.buffer.data[ncaps++] = SYS_DVBC_ANNEX_B; 1276 break; 1277 } 1278 p->u.buffer.len = ncaps; 1279} 1280 1281static int dtv_property_process_get(struct dvb_frontend *fe, 1282 struct dtv_property *tvp, 1283 struct file *file) 1284{ 1285 const struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1286 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1287 struct dtv_frontend_properties cdetected; 1288 int r; 1289 1290 /* 1291 * If the driver implements a get_frontend function, then convert 1292 * detected parameters to S2API properties. 1293 */ 1294 if (fe->ops.get_frontend) { 1295 cdetected = *c; 1296 dtv_property_cache_sync(fe, &cdetected, &fepriv->parameters_out); 1297 c = &cdetected; 1298 } 1299 1300 switch(tvp->cmd) { 1301 case DTV_ENUM_DELSYS: 1302 dtv_set_default_delivery_caps(fe, tvp); 1303 break; 1304 case DTV_FREQUENCY: 1305 tvp->u.data = c->frequency; 1306 break; 1307 case DTV_MODULATION: 1308 tvp->u.data = c->modulation; 1309 break; 1310 case DTV_BANDWIDTH_HZ: 1311 tvp->u.data = c->bandwidth_hz; 1312 break; 1313 case DTV_INVERSION: 1314 tvp->u.data = c->inversion; 1315 break; 1316 case DTV_SYMBOL_RATE: 1317 tvp->u.data = c->symbol_rate; 1318 break; 1319 case DTV_INNER_FEC: 1320 tvp->u.data = c->fec_inner; 1321 break; 1322 case DTV_PILOT: 1323 tvp->u.data = c->pilot; 1324 break; 1325 case DTV_ROLLOFF: 1326 tvp->u.data = c->rolloff; 1327 break; 1328 case DTV_DELIVERY_SYSTEM: 1329 tvp->u.data = c->delivery_system; 1330 break; 1331 case DTV_VOLTAGE: 1332 tvp->u.data = c->voltage; 1333 break; 1334 case DTV_TONE: 1335 tvp->u.data = c->sectone; 1336 break; 1337 case DTV_API_VERSION: 1338 tvp->u.data = (DVB_API_VERSION << 8) | DVB_API_VERSION_MINOR; 1339 break; 1340 case DTV_CODE_RATE_HP: 1341 tvp->u.data = c->code_rate_HP; 1342 break; 1343 case DTV_CODE_RATE_LP: 1344 tvp->u.data = c->code_rate_LP; 1345 break; 1346 case DTV_GUARD_INTERVAL: 1347 tvp->u.data = c->guard_interval; 1348 break; 1349 case DTV_TRANSMISSION_MODE: 1350 tvp->u.data = c->transmission_mode; 1351 break; 1352 case DTV_HIERARCHY: 1353 tvp->u.data = c->hierarchy; 1354 break; 1355 1356 /* ISDB-T Support here */ 1357 case DTV_ISDBT_PARTIAL_RECEPTION: 1358 tvp->u.data = c->isdbt_partial_reception; 1359 break; 1360 case DTV_ISDBT_SOUND_BROADCASTING: 1361 tvp->u.data = c->isdbt_sb_mode; 1362 break; 1363 case DTV_ISDBT_SB_SUBCHANNEL_ID: 1364 tvp->u.data = c->isdbt_sb_subchannel; 1365 break; 1366 case DTV_ISDBT_SB_SEGMENT_IDX: 1367 tvp->u.data = c->isdbt_sb_segment_idx; 1368 break; 1369 case DTV_ISDBT_SB_SEGMENT_COUNT: 1370 tvp->u.data = c->isdbt_sb_segment_count; 1371 break; 1372 case DTV_ISDBT_LAYER_ENABLED: 1373 tvp->u.data = c->isdbt_layer_enabled; 1374 break; 1375 case DTV_ISDBT_LAYERA_FEC: 1376 tvp->u.data = c->layer[0].fec; 1377 break; 1378 case DTV_ISDBT_LAYERA_MODULATION: 1379 tvp->u.data = c->layer[0].modulation; 1380 break; 1381 case DTV_ISDBT_LAYERA_SEGMENT_COUNT: 1382 tvp->u.data = c->layer[0].segment_count; 1383 break; 1384 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING: 1385 tvp->u.data = c->layer[0].interleaving; 1386 break; 1387 case DTV_ISDBT_LAYERB_FEC: 1388 tvp->u.data = c->layer[1].fec; 1389 break; 1390 case DTV_ISDBT_LAYERB_MODULATION: 1391 tvp->u.data = c->layer[1].modulation; 1392 break; 1393 case DTV_ISDBT_LAYERB_SEGMENT_COUNT: 1394 tvp->u.data = c->layer[1].segment_count; 1395 break; 1396 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING: 1397 tvp->u.data = c->layer[1].interleaving; 1398 break; 1399 case DTV_ISDBT_LAYERC_FEC: 1400 tvp->u.data = c->layer[2].fec; 1401 break; 1402 case DTV_ISDBT_LAYERC_MODULATION: 1403 tvp->u.data = c->layer[2].modulation; 1404 break; 1405 case DTV_ISDBT_LAYERC_SEGMENT_COUNT: 1406 tvp->u.data = c->layer[2].segment_count; 1407 break; 1408 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING: 1409 tvp->u.data = c->layer[2].interleaving; 1410 break; 1411 case DTV_ISDBS_TS_ID: 1412 tvp->u.data = c->isdbs_ts_id; 1413 break; 1414 case DTV_DVBT2_PLP_ID: 1415 tvp->u.data = c->dvbt2_plp_id; 1416 break; 1417 default: 1418 return -EINVAL; 1419 } 1420 1421 /* Allow the frontend to override outgoing properties */ 1422 if (fe->ops.get_property) { 1423 r = fe->ops.get_property(fe, tvp); 1424 if (r < 0) 1425 return r; 1426 } 1427 1428 dtv_property_dump(tvp); 1429 1430 return 0; 1431} 1432 1433static int dtv_property_process_set(struct dvb_frontend *fe, 1434 struct dtv_property *tvp, 1435 struct file *file) 1436{ 1437 int r = 0; 1438 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1439 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1440 dtv_property_dump(tvp); 1441 1442 /* Allow the frontend to validate incoming properties */ 1443 if (fe->ops.set_property) { 1444 r = fe->ops.set_property(fe, tvp); 1445 if (r < 0) 1446 return r; 1447 } 1448 1449 switch(tvp->cmd) { 1450 case DTV_CLEAR: 1451 /* Reset a cache of data specific to the frontend here. This does 1452 * not effect hardware. 1453 */ 1454 dvb_frontend_clear_cache(fe); 1455 dprintk("%s() Flushing property cache\n", __func__); 1456 break; 1457 case DTV_TUNE: 1458 /* interpret the cache of data, build either a traditional frontend 1459 * tunerequest so we can pass validation in the FE_SET_FRONTEND 1460 * ioctl. 1461 */ 1462 c->state = tvp->cmd; 1463 dprintk("%s() Finalised property cache\n", __func__); 1464 dtv_property_cache_submit(fe); 1465 1466 r = dvb_frontend_ioctl_legacy(file, FE_SET_FRONTEND, 1467 &fepriv->parameters_in); 1468 break; 1469 case DTV_FREQUENCY: 1470 c->frequency = tvp->u.data; 1471 break; 1472 case DTV_MODULATION: 1473 c->modulation = tvp->u.data; 1474 break; 1475 case DTV_BANDWIDTH_HZ: 1476 c->bandwidth_hz = tvp->u.data; 1477 break; 1478 case DTV_INVERSION: 1479 c->inversion = tvp->u.data; 1480 break; 1481 case DTV_SYMBOL_RATE: 1482 c->symbol_rate = tvp->u.data; 1483 break; 1484 case DTV_INNER_FEC: 1485 c->fec_inner = tvp->u.data; 1486 break; 1487 case DTV_PILOT: 1488 c->pilot = tvp->u.data; 1489 break; 1490 case DTV_ROLLOFF: 1491 c->rolloff = tvp->u.data; 1492 break; 1493 case DTV_DELIVERY_SYSTEM: 1494 c->delivery_system = tvp->u.data; 1495 break; 1496 case DTV_VOLTAGE: 1497 c->voltage = tvp->u.data; 1498 r = dvb_frontend_ioctl_legacy(file, FE_SET_VOLTAGE, 1499 (void *)c->voltage); 1500 break; 1501 case DTV_TONE: 1502 c->sectone = tvp->u.data; 1503 r = dvb_frontend_ioctl_legacy(file, FE_SET_TONE, 1504 (void *)c->sectone); 1505 break; 1506 case DTV_CODE_RATE_HP: 1507 c->code_rate_HP = tvp->u.data; 1508 break; 1509 case DTV_CODE_RATE_LP: 1510 c->code_rate_LP = tvp->u.data; 1511 break; 1512 case DTV_GUARD_INTERVAL: 1513 c->guard_interval = tvp->u.data; 1514 break; 1515 case DTV_TRANSMISSION_MODE: 1516 c->transmission_mode = tvp->u.data; 1517 break; 1518 case DTV_HIERARCHY: 1519 c->hierarchy = tvp->u.data; 1520 break; 1521 1522 /* ISDB-T Support here */ 1523 case DTV_ISDBT_PARTIAL_RECEPTION: 1524 c->isdbt_partial_reception = tvp->u.data; 1525 break; 1526 case DTV_ISDBT_SOUND_BROADCASTING: 1527 c->isdbt_sb_mode = tvp->u.data; 1528 break; 1529 case DTV_ISDBT_SB_SUBCHANNEL_ID: 1530 c->isdbt_sb_subchannel = tvp->u.data; 1531 break; 1532 case DTV_ISDBT_SB_SEGMENT_IDX: 1533 c->isdbt_sb_segment_idx = tvp->u.data; 1534 break; 1535 case DTV_ISDBT_SB_SEGMENT_COUNT: 1536 c->isdbt_sb_segment_count = tvp->u.data; 1537 break; 1538 case DTV_ISDBT_LAYER_ENABLED: 1539 c->isdbt_layer_enabled = tvp->u.data; 1540 break; 1541 case DTV_ISDBT_LAYERA_FEC: 1542 c->layer[0].fec = tvp->u.data; 1543 break; 1544 case DTV_ISDBT_LAYERA_MODULATION: 1545 c->layer[0].modulation = tvp->u.data; 1546 break; 1547 case DTV_ISDBT_LAYERA_SEGMENT_COUNT: 1548 c->layer[0].segment_count = tvp->u.data; 1549 break; 1550 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING: 1551 c->layer[0].interleaving = tvp->u.data; 1552 break; 1553 case DTV_ISDBT_LAYERB_FEC: 1554 c->layer[1].fec = tvp->u.data; 1555 break; 1556 case DTV_ISDBT_LAYERB_MODULATION: 1557 c->layer[1].modulation = tvp->u.data; 1558 break; 1559 case DTV_ISDBT_LAYERB_SEGMENT_COUNT: 1560 c->layer[1].segment_count = tvp->u.data; 1561 break; 1562 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING: 1563 c->layer[1].interleaving = tvp->u.data; 1564 break; 1565 case DTV_ISDBT_LAYERC_FEC: 1566 c->layer[2].fec = tvp->u.data; 1567 break; 1568 case DTV_ISDBT_LAYERC_MODULATION: 1569 c->layer[2].modulation = tvp->u.data; 1570 break; 1571 case DTV_ISDBT_LAYERC_SEGMENT_COUNT: 1572 c->layer[2].segment_count = tvp->u.data; 1573 break; 1574 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING: 1575 c->layer[2].interleaving = tvp->u.data; 1576 break; 1577 case DTV_ISDBS_TS_ID: 1578 c->isdbs_ts_id = tvp->u.data; 1579 break; 1580 case DTV_DVBT2_PLP_ID: 1581 c->dvbt2_plp_id = tvp->u.data; 1582 break; 1583 default: 1584 return -EINVAL; 1585 } 1586 1587 return r; 1588} 1589 1590static int dvb_frontend_ioctl(struct file *file, 1591 unsigned int cmd, void *parg) 1592{ 1593 struct dvb_device *dvbdev = file->private_data; 1594 struct dvb_frontend *fe = dvbdev->priv; 1595 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1596 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1597 int err = -EOPNOTSUPP; 1598 1599 dprintk("%s (%d)\n", __func__, _IOC_NR(cmd)); 1600 1601 if (fepriv->exit != DVB_FE_NO_EXIT) 1602 return -ENODEV; 1603 1604 if ((file->f_flags & O_ACCMODE) == O_RDONLY && 1605 (_IOC_DIR(cmd) != _IOC_READ || cmd == FE_GET_EVENT || 1606 cmd == FE_DISEQC_RECV_SLAVE_REPLY)) 1607 return -EPERM; 1608 1609 if (down_interruptible (&fepriv->sem)) 1610 return -ERESTARTSYS; 1611 1612 if ((cmd == FE_SET_PROPERTY) || (cmd == FE_GET_PROPERTY)) 1613 err = dvb_frontend_ioctl_properties(file, cmd, parg); 1614 else { 1615 c->state = DTV_UNDEFINED; 1616 err = dvb_frontend_ioctl_legacy(file, cmd, parg); 1617 } 1618 1619 up(&fepriv->sem); 1620 return err; 1621} 1622 1623static int dvb_frontend_ioctl_properties(struct file *file, 1624 unsigned int cmd, void *parg) 1625{ 1626 struct dvb_device *dvbdev = file->private_data; 1627 struct dvb_frontend *fe = dvbdev->priv; 1628 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1629 int err = 0; 1630 1631 struct dtv_properties *tvps = NULL; 1632 struct dtv_property *tvp = NULL; 1633 int i; 1634 1635 dprintk("%s\n", __func__); 1636 1637 if(cmd == FE_SET_PROPERTY) { 1638 tvps = (struct dtv_properties __user *)parg; 1639 1640 dprintk("%s() properties.num = %d\n", __func__, tvps->num); 1641 dprintk("%s() properties.props = %p\n", __func__, tvps->props); 1642 1643 /* Put an arbitrary limit on the number of messages that can 1644 * be sent at once */ 1645 if ((tvps->num == 0) || (tvps->num > DTV_IOCTL_MAX_MSGS)) 1646 return -EINVAL; 1647 1648 tvp = kmalloc(tvps->num * sizeof(struct dtv_property), GFP_KERNEL); 1649 if (!tvp) { 1650 err = -ENOMEM; 1651 goto out; 1652 } 1653 1654 if (copy_from_user(tvp, tvps->props, tvps->num * sizeof(struct dtv_property))) { 1655 err = -EFAULT; 1656 goto out; 1657 } 1658 1659 for (i = 0; i < tvps->num; i++) { 1660 err = dtv_property_process_set(fe, tvp + i, file); 1661 if (err < 0) 1662 goto out; 1663 (tvp + i)->result = err; 1664 } 1665 1666 if (c->state == DTV_TUNE) 1667 dprintk("%s() Property cache is full, tuning\n", __func__); 1668 1669 } else 1670 if(cmd == FE_GET_PROPERTY) { 1671 1672 tvps = (struct dtv_properties __user *)parg; 1673 1674 dprintk("%s() properties.num = %d\n", __func__, tvps->num); 1675 dprintk("%s() properties.props = %p\n", __func__, tvps->props); 1676 1677 /* Put an arbitrary limit on the number of messages that can 1678 * be sent at once */ 1679 if ((tvps->num == 0) || (tvps->num > DTV_IOCTL_MAX_MSGS)) 1680 return -EINVAL; 1681 1682 tvp = kmalloc(tvps->num * sizeof(struct dtv_property), GFP_KERNEL); 1683 if (!tvp) { 1684 err = -ENOMEM; 1685 goto out; 1686 } 1687 1688 if (copy_from_user(tvp, tvps->props, tvps->num * sizeof(struct dtv_property))) { 1689 err = -EFAULT; 1690 goto out; 1691 } 1692 1693 for (i = 0; i < tvps->num; i++) { 1694 err = dtv_property_process_get(fe, tvp + i, file); 1695 if (err < 0) 1696 goto out; 1697 (tvp + i)->result = err; 1698 } 1699 1700 if (copy_to_user(tvps->props, tvp, tvps->num * sizeof(struct dtv_property))) { 1701 err = -EFAULT; 1702 goto out; 1703 } 1704 1705 } else 1706 err = -EOPNOTSUPP; 1707 1708out: 1709 kfree(tvp); 1710 return err; 1711} 1712 1713static int dvb_frontend_ioctl_legacy(struct file *file, 1714 unsigned int cmd, void *parg) 1715{ 1716 struct dvb_device *dvbdev = file->private_data; 1717 struct dvb_frontend *fe = dvbdev->priv; 1718 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1719 int cb_err, err = -EOPNOTSUPP; 1720 1721 if (fe->dvb->fe_ioctl_override) { 1722 cb_err = fe->dvb->fe_ioctl_override(fe, cmd, parg, 1723 DVB_FE_IOCTL_PRE); 1724 if (cb_err < 0) 1725 return cb_err; 1726 if (cb_err > 0) 1727 return 0; 1728 /* fe_ioctl_override returning 0 allows 1729 * dvb-core to continue handling the ioctl */ 1730 } 1731 1732 switch (cmd) { 1733 case FE_GET_INFO: { 1734 struct dvb_frontend_info* info = parg; 1735 memcpy(info, &fe->ops.info, sizeof(struct dvb_frontend_info)); 1736 dvb_frontend_get_frequency_limits(fe, &info->frequency_min, &info->frequency_max); 1737 1738 /* Force the CAN_INVERSION_AUTO bit on. If the frontend doesn't 1739 * do it, it is done for it. */ 1740 info->caps |= FE_CAN_INVERSION_AUTO; 1741 err = 0; 1742 break; 1743 } 1744 1745 case FE_READ_STATUS: { 1746 fe_status_t* status = parg; 1747 1748 /* if retune was requested but hasn't occurred yet, prevent 1749 * that user get signal state from previous tuning */ 1750 if (fepriv->state == FESTATE_RETUNE || 1751 fepriv->state == FESTATE_ERROR) { 1752 err=0; 1753 *status = 0; 1754 break; 1755 } 1756 1757 if (fe->ops.read_status) 1758 err = fe->ops.read_status(fe, status); 1759 break; 1760 } 1761 case FE_READ_BER: 1762 if (fe->ops.read_ber) 1763 err = fe->ops.read_ber(fe, (__u32*) parg); 1764 break; 1765 1766 case FE_READ_SIGNAL_STRENGTH: 1767 if (fe->ops.read_signal_strength) 1768 err = fe->ops.read_signal_strength(fe, (__u16*) parg); 1769 break; 1770 1771 case FE_READ_SNR: 1772 if (fe->ops.read_snr) 1773 err = fe->ops.read_snr(fe, (__u16*) parg); 1774 break; 1775 1776 case FE_READ_UNCORRECTED_BLOCKS: 1777 if (fe->ops.read_ucblocks) 1778 err = fe->ops.read_ucblocks(fe, (__u32*) parg); 1779 break; 1780 1781 1782 case FE_DISEQC_RESET_OVERLOAD: 1783 if (fe->ops.diseqc_reset_overload) { 1784 err = fe->ops.diseqc_reset_overload(fe); 1785 fepriv->state = FESTATE_DISEQC; 1786 fepriv->status = 0; 1787 } 1788 break; 1789 1790 case FE_DISEQC_SEND_MASTER_CMD: 1791 if (fe->ops.diseqc_send_master_cmd) { 1792 err = fe->ops.diseqc_send_master_cmd(fe, (struct dvb_diseqc_master_cmd*) parg); 1793 fepriv->state = FESTATE_DISEQC; 1794 fepriv->status = 0; 1795 } 1796 break; 1797 1798 case FE_DISEQC_SEND_BURST: 1799 if (fe->ops.diseqc_send_burst) { 1800 err = fe->ops.diseqc_send_burst(fe, (fe_sec_mini_cmd_t) parg); 1801 fepriv->state = FESTATE_DISEQC; 1802 fepriv->status = 0; 1803 } 1804 break; 1805 1806 case FE_SET_TONE: 1807 if (fe->ops.set_tone) { 1808 err = fe->ops.set_tone(fe, (fe_sec_tone_mode_t) parg); 1809 fepriv->tone = (fe_sec_tone_mode_t) parg; 1810 fepriv->state = FESTATE_DISEQC; 1811 fepriv->status = 0; 1812 } 1813 break; 1814 1815 case FE_SET_VOLTAGE: 1816 if (fe->ops.set_voltage) { 1817 err = fe->ops.set_voltage(fe, (fe_sec_voltage_t) parg); 1818 fepriv->voltage = (fe_sec_voltage_t) parg; 1819 fepriv->state = FESTATE_DISEQC; 1820 fepriv->status = 0; 1821 } 1822 break; 1823 1824 case FE_DISHNETWORK_SEND_LEGACY_CMD: 1825 if (fe->ops.dishnetwork_send_legacy_command) { 1826 err = fe->ops.dishnetwork_send_legacy_command(fe, (unsigned long) parg); 1827 fepriv->state = FESTATE_DISEQC; 1828 fepriv->status = 0; 1829 } else if (fe->ops.set_voltage) { 1830 /* 1831 * NOTE: This is a fallback condition. Some frontends 1832 * (stv0299 for instance) take longer than 8msec to 1833 * respond to a set_voltage command. Those switches 1834 * need custom routines to switch properly. For all 1835 * other frontends, the following should work ok. 1836 * Dish network legacy switches (as used by Dish500) 1837 * are controlled by sending 9-bit command words 1838 * spaced 8msec apart. 1839 * the actual command word is switch/port dependent 1840 * so it is up to the userspace application to send 1841 * the right command. 1842 * The command must always start with a '0' after 1843 * initialization, so parg is 8 bits and does not 1844 * include the initialization or start bit 1845 */ 1846 unsigned long swcmd = ((unsigned long) parg) << 1; 1847 struct timeval nexttime; 1848 struct timeval tv[10]; 1849 int i; 1850 u8 last = 1; 1851 if (dvb_frontend_debug) 1852 printk("%s switch command: 0x%04lx\n", __func__, swcmd); 1853 do_gettimeofday(&nexttime); 1854 if (dvb_frontend_debug) 1855 memcpy(&tv[0], &nexttime, sizeof(struct timeval)); 1856 /* before sending a command, initialize by sending 1857 * a 32ms 18V to the switch 1858 */ 1859 fe->ops.set_voltage(fe, SEC_VOLTAGE_18); 1860 dvb_frontend_sleep_until(&nexttime, 32000); 1861 1862 for (i = 0; i < 9; i++) { 1863 if (dvb_frontend_debug) 1864 do_gettimeofday(&tv[i + 1]); 1865 if ((swcmd & 0x01) != last) { 1866 /* set voltage to (last ? 13V : 18V) */ 1867 fe->ops.set_voltage(fe, (last) ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18); 1868 last = (last) ? 0 : 1; 1869 } 1870 swcmd = swcmd >> 1; 1871 if (i != 8) 1872 dvb_frontend_sleep_until(&nexttime, 8000); 1873 } 1874 if (dvb_frontend_debug) { 1875 printk("%s(%d): switch delay (should be 32k followed by all 8k\n", 1876 __func__, fe->dvb->num); 1877 for (i = 1; i < 10; i++) 1878 printk("%d: %d\n", i, timeval_usec_diff(tv[i-1] , tv[i])); 1879 } 1880 err = 0; 1881 fepriv->state = FESTATE_DISEQC; 1882 fepriv->status = 0; 1883 } 1884 break; 1885 1886 case FE_DISEQC_RECV_SLAVE_REPLY: 1887 if (fe->ops.diseqc_recv_slave_reply) 1888 err = fe->ops.diseqc_recv_slave_reply(fe, (struct dvb_diseqc_slave_reply*) parg); 1889 break; 1890 1891 case FE_ENABLE_HIGH_LNB_VOLTAGE: 1892 if (fe->ops.enable_high_lnb_voltage) 1893 err = fe->ops.enable_high_lnb_voltage(fe, (long) parg); 1894 break; 1895 1896 case FE_SET_FRONTEND: { 1897 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1898 struct dvb_frontend_tune_settings fetunesettings; 1899 1900 if (c->state == DTV_TUNE) { 1901 if (dvb_frontend_check_parameters(fe, &fepriv->parameters_in) < 0) { 1902 err = -EINVAL; 1903 break; 1904 } 1905 } else { 1906 if (dvb_frontend_check_parameters(fe, parg) < 0) { 1907 err = -EINVAL; 1908 break; 1909 } 1910 1911 memcpy (&fepriv->parameters_in, parg, 1912 sizeof (struct dvb_frontend_parameters)); 1913 dtv_property_cache_init(fe, c); 1914 dtv_property_cache_sync(fe, c, &fepriv->parameters_in); 1915 } 1916 1917 /* 1918 * Initialize output parameters to match the values given by 1919 * the user. FE_SET_FRONTEND triggers an initial frontend event 1920 * with status = 0, which copies output parameters to userspace. 1921 */ 1922 fepriv->parameters_out = fepriv->parameters_in; 1923 1924 memset(&fetunesettings, 0, sizeof(struct dvb_frontend_tune_settings)); 1925 memcpy(&fetunesettings.parameters, parg, 1926 sizeof (struct dvb_frontend_parameters)); 1927 1928 /* force auto frequency inversion if requested */ 1929 if (dvb_force_auto_inversion) { 1930 fepriv->parameters_in.inversion = INVERSION_AUTO; 1931 fetunesettings.parameters.inversion = INVERSION_AUTO; 1932 } 1933 if (fe->ops.info.type == FE_OFDM) { 1934 /* without hierarchical coding code_rate_LP is irrelevant, 1935 * so we tolerate the otherwise invalid FEC_NONE setting */ 1936 if (fepriv->parameters_in.u.ofdm.hierarchy_information == HIERARCHY_NONE && 1937 fepriv->parameters_in.u.ofdm.code_rate_LP == FEC_NONE) 1938 fepriv->parameters_in.u.ofdm.code_rate_LP = FEC_AUTO; 1939 } 1940 1941 /* get frontend-specific tuning settings */ 1942 if (fe->ops.get_tune_settings && (fe->ops.get_tune_settings(fe, &fetunesettings) == 0)) { 1943 fepriv->min_delay = (fetunesettings.min_delay_ms * HZ) / 1000; 1944 fepriv->max_drift = fetunesettings.max_drift; 1945 fepriv->step_size = fetunesettings.step_size; 1946 } else { 1947 /* default values */ 1948 switch(fe->ops.info.type) { 1949 case FE_QPSK: 1950 fepriv->min_delay = HZ/20; 1951 fepriv->step_size = fepriv->parameters_in.u.qpsk.symbol_rate / 16000; 1952 fepriv->max_drift = fepriv->parameters_in.u.qpsk.symbol_rate / 2000; 1953 break; 1954 1955 case FE_QAM: 1956 fepriv->min_delay = HZ/20; 1957 fepriv->step_size = 0; /* no zigzag */ 1958 fepriv->max_drift = 0; 1959 break; 1960 1961 case FE_OFDM: 1962 fepriv->min_delay = HZ/20; 1963 fepriv->step_size = fe->ops.info.frequency_stepsize * 2; 1964 fepriv->max_drift = (fe->ops.info.frequency_stepsize * 2) + 1; 1965 break; 1966 case FE_ATSC: 1967 fepriv->min_delay = HZ/20; 1968 fepriv->step_size = 0; 1969 fepriv->max_drift = 0; 1970 break; 1971 } 1972 } 1973 if (dvb_override_tune_delay > 0) 1974 fepriv->min_delay = (dvb_override_tune_delay * HZ) / 1000; 1975 1976 fepriv->state = FESTATE_RETUNE; 1977 1978 /* Request the search algorithm to search */ 1979 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 1980 1981 dvb_frontend_clear_events(fe); 1982 dvb_frontend_add_event(fe, 0); 1983 dvb_frontend_wakeup(fe); 1984 fepriv->status = 0; 1985 err = 0; 1986 break; 1987 } 1988 1989 case FE_GET_EVENT: 1990 err = dvb_frontend_get_event (fe, parg, file->f_flags); 1991 break; 1992 1993 case FE_GET_FRONTEND: 1994 if (fe->ops.get_frontend) { 1995 err = fe->ops.get_frontend(fe, &fepriv->parameters_out); 1996 memcpy(parg, &fepriv->parameters_out, sizeof(struct dvb_frontend_parameters)); 1997 } 1998 break; 1999 2000 case FE_SET_FRONTEND_TUNE_MODE: 2001 fepriv->tune_mode_flags = (unsigned long) parg; 2002 err = 0; 2003 break; 2004 }; 2005 2006 if (fe->dvb->fe_ioctl_override) { 2007 cb_err = fe->dvb->fe_ioctl_override(fe, cmd, parg, 2008 DVB_FE_IOCTL_POST); 2009 if (cb_err < 0) 2010 return cb_err; 2011 } 2012 2013 return err; 2014} 2015 2016 2017static unsigned int dvb_frontend_poll(struct file *file, struct poll_table_struct *wait) 2018{ 2019 struct dvb_device *dvbdev = file->private_data; 2020 struct dvb_frontend *fe = dvbdev->priv; 2021 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2022 2023 dprintk ("%s\n", __func__); 2024 2025 poll_wait (file, &fepriv->events.wait_queue, wait); 2026 2027 if (fepriv->events.eventw != fepriv->events.eventr) 2028 return (POLLIN | POLLRDNORM | POLLPRI); 2029 2030 return 0; 2031} 2032 2033static int dvb_frontend_open(struct inode *inode, struct file *file) 2034{ 2035 struct dvb_device *dvbdev = file->private_data; 2036 struct dvb_frontend *fe = dvbdev->priv; 2037 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2038 struct dvb_adapter *adapter = fe->dvb; 2039 int ret; 2040 2041 dprintk ("%s\n", __func__); 2042 if (fepriv->exit == DVB_FE_DEVICE_REMOVED) 2043 return -ENODEV; 2044 2045 if (adapter->mfe_shared) { 2046 mutex_lock (&adapter->mfe_lock); 2047 2048 if (adapter->mfe_dvbdev == NULL) 2049 adapter->mfe_dvbdev = dvbdev; 2050 2051 else if (adapter->mfe_dvbdev != dvbdev) { 2052 struct dvb_device 2053 *mfedev = adapter->mfe_dvbdev; 2054 struct dvb_frontend 2055 *mfe = mfedev->priv; 2056 struct dvb_frontend_private 2057 *mfepriv = mfe->frontend_priv; 2058 int mferetry = (dvb_mfe_wait_time << 1); 2059 2060 mutex_unlock (&adapter->mfe_lock); 2061 while (mferetry-- && (mfedev->users != -1 || 2062 mfepriv->thread != NULL)) { 2063 if(msleep_interruptible(500)) { 2064 if(signal_pending(current)) 2065 return -EINTR; 2066 } 2067 } 2068 2069 mutex_lock (&adapter->mfe_lock); 2070 if(adapter->mfe_dvbdev != dvbdev) { 2071 mfedev = adapter->mfe_dvbdev; 2072 mfe = mfedev->priv; 2073 mfepriv = mfe->frontend_priv; 2074 if (mfedev->users != -1 || 2075 mfepriv->thread != NULL) { 2076 mutex_unlock (&adapter->mfe_lock); 2077 return -EBUSY; 2078 } 2079 adapter->mfe_dvbdev = dvbdev; 2080 } 2081 } 2082 } 2083 2084 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) { 2085 if ((ret = fe->ops.ts_bus_ctrl(fe, 1)) < 0) 2086 goto err0; 2087 2088 /* If we took control of the bus, we need to force 2089 reinitialization. This is because many ts_bus_ctrl() 2090 functions strobe the RESET pin on the demod, and if the 2091 frontend thread already exists then the dvb_init() routine 2092 won't get called (which is what usually does initial 2093 register configuration). */ 2094 fepriv->reinitialise = 1; 2095 } 2096 2097 if ((ret = dvb_generic_open (inode, file)) < 0) 2098 goto err1; 2099 2100 if ((file->f_flags & O_ACCMODE) != O_RDONLY) { 2101 /* normal tune mode when opened R/W */ 2102 fepriv->tune_mode_flags &= ~FE_TUNE_MODE_ONESHOT; 2103 fepriv->tone = -1; 2104 fepriv->voltage = -1; 2105 2106 ret = dvb_frontend_start (fe); 2107 if (ret) 2108 goto err2; 2109 2110 /* empty event queue */ 2111 fepriv->events.eventr = fepriv->events.eventw = 0; 2112 } 2113 2114 if (adapter->mfe_shared) 2115 mutex_unlock (&adapter->mfe_lock); 2116 return ret; 2117 2118err2: 2119 dvb_generic_release(inode, file); 2120err1: 2121 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) 2122 fe->ops.ts_bus_ctrl(fe, 0); 2123err0: 2124 if (adapter->mfe_shared) 2125 mutex_unlock (&adapter->mfe_lock); 2126 return ret; 2127} 2128 2129static int dvb_frontend_release(struct inode *inode, struct file *file) 2130{ 2131 struct dvb_device *dvbdev = file->private_data; 2132 struct dvb_frontend *fe = dvbdev->priv; 2133 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2134 int ret; 2135 2136 dprintk ("%s\n", __func__); 2137 2138 if ((file->f_flags & O_ACCMODE) != O_RDONLY) { 2139 fepriv->release_jiffies = jiffies; 2140 mb(); 2141 } 2142 2143 ret = dvb_generic_release (inode, file); 2144 2145 if (dvbdev->users == -1) { 2146 wake_up(&fepriv->wait_queue); 2147 if (fepriv->exit != DVB_FE_NO_EXIT) { 2148 fops_put(file->f_op); 2149 file->f_op = NULL; 2150 wake_up(&dvbdev->wait_queue); 2151 } 2152 if (fe->ops.ts_bus_ctrl) 2153 fe->ops.ts_bus_ctrl(fe, 0); 2154 } 2155 2156 return ret; 2157} 2158 2159static const struct file_operations dvb_frontend_fops = { 2160 .owner = THIS_MODULE, 2161 .unlocked_ioctl = dvb_generic_ioctl, 2162 .poll = dvb_frontend_poll, 2163 .open = dvb_frontend_open, 2164 .release = dvb_frontend_release, 2165 .llseek = noop_llseek, 2166}; 2167 2168int dvb_register_frontend(struct dvb_adapter* dvb, 2169 struct dvb_frontend* fe) 2170{ 2171 struct dvb_frontend_private *fepriv; 2172 static const struct dvb_device dvbdev_template = { 2173 .users = ~0, 2174 .writers = 1, 2175 .readers = (~0)-1, 2176 .fops = &dvb_frontend_fops, 2177 .kernel_ioctl = dvb_frontend_ioctl 2178 }; 2179 2180 dprintk ("%s\n", __func__); 2181 2182 if (mutex_lock_interruptible(&frontend_mutex)) 2183 return -ERESTARTSYS; 2184 2185 fe->frontend_priv = kzalloc(sizeof(struct dvb_frontend_private), GFP_KERNEL); 2186 if (fe->frontend_priv == NULL) { 2187 mutex_unlock(&frontend_mutex); 2188 return -ENOMEM; 2189 } 2190 fepriv = fe->frontend_priv; 2191 2192 sema_init(&fepriv->sem, 1); 2193 init_waitqueue_head (&fepriv->wait_queue); 2194 init_waitqueue_head (&fepriv->events.wait_queue); 2195 mutex_init(&fepriv->events.mtx); 2196 fe->dvb = dvb; 2197 fepriv->inversion = INVERSION_OFF; 2198 2199 printk ("DVB: registering adapter %i frontend %i (%s)...\n", 2200 fe->dvb->num, 2201 fe->id, 2202 fe->ops.info.name); 2203 2204 dvb_register_device (fe->dvb, &fepriv->dvbdev, &dvbdev_template, 2205 fe, DVB_DEVICE_FRONTEND); 2206 2207 mutex_unlock(&frontend_mutex); 2208 return 0; 2209} 2210EXPORT_SYMBOL(dvb_register_frontend); 2211 2212int dvb_unregister_frontend(struct dvb_frontend* fe) 2213{ 2214 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2215 dprintk ("%s\n", __func__); 2216 2217 mutex_lock(&frontend_mutex); 2218 dvb_frontend_stop (fe); 2219 mutex_unlock(&frontend_mutex); 2220 2221 if (fepriv->dvbdev->users < -1) 2222 wait_event(fepriv->dvbdev->wait_queue, 2223 fepriv->dvbdev->users==-1); 2224 2225 mutex_lock(&frontend_mutex); 2226 dvb_unregister_device (fepriv->dvbdev); 2227 2228 /* fe is invalid now */ 2229 kfree(fepriv); 2230 mutex_unlock(&frontend_mutex); 2231 return 0; 2232} 2233EXPORT_SYMBOL(dvb_unregister_frontend); 2234 2235#ifdef CONFIG_MEDIA_ATTACH 2236void dvb_frontend_detach(struct dvb_frontend* fe) 2237{ 2238 void *ptr; 2239 2240 if (fe->ops.release_sec) { 2241 fe->ops.release_sec(fe); 2242 symbol_put_addr(fe->ops.release_sec); 2243 } 2244 if (fe->ops.tuner_ops.release) { 2245 fe->ops.tuner_ops.release(fe); 2246 symbol_put_addr(fe->ops.tuner_ops.release); 2247 } 2248 if (fe->ops.analog_ops.release) { 2249 fe->ops.analog_ops.release(fe); 2250 symbol_put_addr(fe->ops.analog_ops.release); 2251 } 2252 ptr = (void*)fe->ops.release; 2253 if (ptr) { 2254 fe->ops.release(fe); 2255 symbol_put_addr(ptr); 2256 } 2257} 2258#else 2259void dvb_frontend_detach(struct dvb_frontend* fe) 2260{ 2261 if (fe->ops.release_sec) 2262 fe->ops.release_sec(fe); 2263 if (fe->ops.tuner_ops.release) 2264 fe->ops.tuner_ops.release(fe); 2265 if (fe->ops.analog_ops.release) 2266 fe->ops.analog_ops.release(fe); 2267 if (fe->ops.release) 2268 fe->ops.release(fe); 2269} 2270#endif 2271EXPORT_SYMBOL(dvb_frontend_detach); 2272