Linux kernel mirror (for testing) git.kernel.org/pub/scm/linux/kernel/git/torvalds/linux.git
kernel os linux
1
fork

Configure Feed

Select the types of activity you want to include in your feed.

at v2.6.37 2143 lines 62 kB view raw
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; 109 struct dvb_fe_events events; 110 struct semaphore sem; 111 struct list_head list_head; 112 wait_queue_head_t wait_queue; 113 struct task_struct *thread; 114 unsigned long release_jiffies; 115 unsigned int exit; 116 unsigned int wakeup; 117 fe_status_t status; 118 unsigned long tune_mode_flags; 119 unsigned int delay; 120 unsigned int reinitialise; 121 int tone; 122 int voltage; 123 124 /* swzigzag values */ 125 unsigned int state; 126 unsigned int bending; 127 int lnb_drift; 128 unsigned int inversion; 129 unsigned int auto_step; 130 unsigned int auto_sub_step; 131 unsigned int started_auto_step; 132 unsigned int min_delay; 133 unsigned int max_drift; 134 unsigned int step_size; 135 int quality; 136 unsigned int check_wrapped; 137 enum dvbfe_search algo_status; 138}; 139 140static void dvb_frontend_wakeup(struct dvb_frontend *fe); 141 142static void dvb_frontend_add_event(struct dvb_frontend *fe, fe_status_t status) 143{ 144 struct dvb_frontend_private *fepriv = fe->frontend_priv; 145 struct dvb_fe_events *events = &fepriv->events; 146 struct dvb_frontend_event *e; 147 int wp; 148 149 dprintk ("%s\n", __func__); 150 151 if (mutex_lock_interruptible (&events->mtx)) 152 return; 153 154 wp = (events->eventw + 1) % MAX_EVENT; 155 156 if (wp == events->eventr) { 157 events->overflow = 1; 158 events->eventr = (events->eventr + 1) % MAX_EVENT; 159 } 160 161 e = &events->events[events->eventw]; 162 163 memcpy (&e->parameters, &fepriv->parameters, 164 sizeof (struct dvb_frontend_parameters)); 165 166 if (status & FE_HAS_LOCK) 167 if (fe->ops.get_frontend) 168 fe->ops.get_frontend(fe, &e->parameters); 169 170 events->eventw = wp; 171 172 mutex_unlock(&events->mtx); 173 174 e->status = status; 175 176 wake_up_interruptible (&events->wait_queue); 177} 178 179static int dvb_frontend_get_event(struct dvb_frontend *fe, 180 struct dvb_frontend_event *event, int flags) 181{ 182 struct dvb_frontend_private *fepriv = fe->frontend_priv; 183 struct dvb_fe_events *events = &fepriv->events; 184 185 dprintk ("%s\n", __func__); 186 187 if (events->overflow) { 188 events->overflow = 0; 189 return -EOVERFLOW; 190 } 191 192 if (events->eventw == events->eventr) { 193 int ret; 194 195 if (flags & O_NONBLOCK) 196 return -EWOULDBLOCK; 197 198 up(&fepriv->sem); 199 200 ret = wait_event_interruptible (events->wait_queue, 201 events->eventw != events->eventr); 202 203 if (down_interruptible (&fepriv->sem)) 204 return -ERESTARTSYS; 205 206 if (ret < 0) 207 return ret; 208 } 209 210 if (mutex_lock_interruptible (&events->mtx)) 211 return -ERESTARTSYS; 212 213 memcpy (event, &events->events[events->eventr], 214 sizeof(struct dvb_frontend_event)); 215 216 events->eventr = (events->eventr + 1) % MAX_EVENT; 217 218 mutex_unlock(&events->mtx); 219 220 return 0; 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.inversion; 281 u32 original_frequency = fepriv->parameters.frequency; 282 283 /* are we using autoinversion? */ 284 autoinversion = ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) && 285 (fepriv->parameters.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.frequency += fepriv->lnb_drift; 352 if (autoinversion) 353 fepriv->parameters.inversion = fepriv->inversion; 354 if (fe->ops.set_frontend) 355 fe_set_err = fe->ops.set_frontend(fe, &fepriv->parameters); 356 if (fe_set_err < 0) { 357 fepriv->state = FESTATE_ERROR; 358 return fe_set_err; 359 } 360 361 fepriv->parameters.frequency = original_frequency; 362 fepriv->parameters.inversion = original_inversion; 363 364 fepriv->auto_sub_step++; 365 return 0; 366} 367 368static void dvb_frontend_swzigzag(struct dvb_frontend *fe) 369{ 370 fe_status_t s = 0; 371 int retval = 0; 372 struct dvb_frontend_private *fepriv = fe->frontend_priv; 373 374 /* if we've got no parameters, just keep idling */ 375 if (fepriv->state & FESTATE_IDLE) { 376 fepriv->delay = 3*HZ; 377 fepriv->quality = 0; 378 return; 379 } 380 381 /* in SCAN mode, we just set the frontend when asked and leave it alone */ 382 if (fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT) { 383 if (fepriv->state & FESTATE_RETUNE) { 384 if (fe->ops.set_frontend) 385 retval = fe->ops.set_frontend(fe, 386 &fepriv->parameters); 387 if (retval < 0) 388 fepriv->state = FESTATE_ERROR; 389 else 390 fepriv->state = FESTATE_TUNED; 391 } 392 fepriv->delay = 3*HZ; 393 fepriv->quality = 0; 394 return; 395 } 396 397 /* get the frontend status */ 398 if (fepriv->state & FESTATE_RETUNE) { 399 s = 0; 400 } else { 401 if (fe->ops.read_status) 402 fe->ops.read_status(fe, &s); 403 if (s != fepriv->status) { 404 dvb_frontend_add_event(fe, s); 405 fepriv->status = s; 406 } 407 } 408 409 /* if we're not tuned, and we have a lock, move to the TUNED state */ 410 if ((fepriv->state & FESTATE_WAITFORLOCK) && (s & FE_HAS_LOCK)) { 411 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 412 fepriv->state = FESTATE_TUNED; 413 414 /* if we're tuned, then we have determined the correct inversion */ 415 if ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) && 416 (fepriv->parameters.inversion == INVERSION_AUTO)) { 417 fepriv->parameters.inversion = fepriv->inversion; 418 } 419 return; 420 } 421 422 /* if we are tuned already, check we're still locked */ 423 if (fepriv->state & FESTATE_TUNED) { 424 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 425 426 /* we're tuned, and the lock is still good... */ 427 if (s & FE_HAS_LOCK) { 428 return; 429 } else { /* if we _WERE_ tuned, but now don't have a lock */ 430 fepriv->state = FESTATE_ZIGZAG_FAST; 431 fepriv->started_auto_step = fepriv->auto_step; 432 fepriv->check_wrapped = 0; 433 } 434 } 435 436 /* don't actually do anything if we're in the LOSTLOCK state, 437 * the frontend is set to FE_CAN_RECOVER, and the max_drift is 0 */ 438 if ((fepriv->state & FESTATE_LOSTLOCK) && 439 (fe->ops.info.caps & FE_CAN_RECOVER) && (fepriv->max_drift == 0)) { 440 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 441 return; 442 } 443 444 /* don't do anything if we're in the DISEQC state, since this 445 * might be someone with a motorized dish controlled by DISEQC. 446 * If its actually a re-tune, there will be a SET_FRONTEND soon enough. */ 447 if (fepriv->state & FESTATE_DISEQC) { 448 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 449 return; 450 } 451 452 /* if we're in the RETUNE state, set everything up for a brand 453 * new scan, keeping the current inversion setting, as the next 454 * tune is _very_ likely to require the same */ 455 if (fepriv->state & FESTATE_RETUNE) { 456 fepriv->lnb_drift = 0; 457 fepriv->auto_step = 0; 458 fepriv->auto_sub_step = 0; 459 fepriv->started_auto_step = 0; 460 fepriv->check_wrapped = 0; 461 } 462 463 /* fast zigzag. */ 464 if ((fepriv->state & FESTATE_SEARCHING_FAST) || (fepriv->state & FESTATE_RETUNE)) { 465 fepriv->delay = fepriv->min_delay; 466 467 /* perform a tune */ 468 retval = dvb_frontend_swzigzag_autotune(fe, 469 fepriv->check_wrapped); 470 if (retval < 0) { 471 return; 472 } else if (retval) { 473 /* OK, if we've run out of trials at the fast speed. 474 * Drop back to slow for the _next_ attempt */ 475 fepriv->state = FESTATE_SEARCHING_SLOW; 476 fepriv->started_auto_step = fepriv->auto_step; 477 return; 478 } 479 fepriv->check_wrapped = 1; 480 481 /* if we've just retuned, enter the ZIGZAG_FAST state. 482 * This ensures we cannot return from an 483 * FE_SET_FRONTEND ioctl before the first frontend tune 484 * occurs */ 485 if (fepriv->state & FESTATE_RETUNE) { 486 fepriv->state = FESTATE_TUNING_FAST; 487 } 488 } 489 490 /* slow zigzag */ 491 if (fepriv->state & FESTATE_SEARCHING_SLOW) { 492 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK); 493 494 /* Note: don't bother checking for wrapping; we stay in this 495 * state until we get a lock */ 496 dvb_frontend_swzigzag_autotune(fe, 0); 497 } 498} 499 500static int dvb_frontend_is_exiting(struct dvb_frontend *fe) 501{ 502 struct dvb_frontend_private *fepriv = fe->frontend_priv; 503 504 if (fepriv->exit != DVB_FE_NO_EXIT) 505 return 1; 506 507 if (fepriv->dvbdev->writers == 1) 508 if (time_after(jiffies, fepriv->release_jiffies + 509 dvb_shutdown_timeout * HZ)) 510 return 1; 511 512 return 0; 513} 514 515static int dvb_frontend_should_wakeup(struct dvb_frontend *fe) 516{ 517 struct dvb_frontend_private *fepriv = fe->frontend_priv; 518 519 if (fepriv->wakeup) { 520 fepriv->wakeup = 0; 521 return 1; 522 } 523 return dvb_frontend_is_exiting(fe); 524} 525 526static void dvb_frontend_wakeup(struct dvb_frontend *fe) 527{ 528 struct dvb_frontend_private *fepriv = fe->frontend_priv; 529 530 fepriv->wakeup = 1; 531 wake_up_interruptible(&fepriv->wait_queue); 532} 533 534static int dvb_frontend_thread(void *data) 535{ 536 struct dvb_frontend *fe = data; 537 struct dvb_frontend_private *fepriv = fe->frontend_priv; 538 unsigned long timeout; 539 fe_status_t s; 540 enum dvbfe_algo algo; 541 542 struct dvb_frontend_parameters *params; 543 544 dprintk("%s\n", __func__); 545 546 fepriv->check_wrapped = 0; 547 fepriv->quality = 0; 548 fepriv->delay = 3*HZ; 549 fepriv->status = 0; 550 fepriv->wakeup = 0; 551 fepriv->reinitialise = 0; 552 553 dvb_frontend_init(fe); 554 555 set_freezable(); 556 while (1) { 557 up(&fepriv->sem); /* is locked when we enter the thread... */ 558restart: 559 timeout = wait_event_interruptible_timeout(fepriv->wait_queue, 560 dvb_frontend_should_wakeup(fe) || kthread_should_stop() 561 || freezing(current), 562 fepriv->delay); 563 564 if (kthread_should_stop() || dvb_frontend_is_exiting(fe)) { 565 /* got signal or quitting */ 566 fepriv->exit = DVB_FE_NORMAL_EXIT; 567 break; 568 } 569 570 if (try_to_freeze()) 571 goto restart; 572 573 if (down_interruptible(&fepriv->sem)) 574 break; 575 576 if (fepriv->reinitialise) { 577 dvb_frontend_init(fe); 578 if (fepriv->tone != -1) { 579 fe->ops.set_tone(fe, fepriv->tone); 580 } 581 if (fepriv->voltage != -1) { 582 fe->ops.set_voltage(fe, fepriv->voltage); 583 } 584 fepriv->reinitialise = 0; 585 } 586 587 /* do an iteration of the tuning loop */ 588 if (fe->ops.get_frontend_algo) { 589 algo = fe->ops.get_frontend_algo(fe); 590 switch (algo) { 591 case DVBFE_ALGO_HW: 592 dprintk("%s: Frontend ALGO = DVBFE_ALGO_HW\n", __func__); 593 params = NULL; /* have we been asked to RETUNE ? */ 594 595 if (fepriv->state & FESTATE_RETUNE) { 596 dprintk("%s: Retune requested, FESTATE_RETUNE\n", __func__); 597 params = &fepriv->parameters; 598 fepriv->state = FESTATE_TUNED; 599 } 600 601 if (fe->ops.tune) 602 fe->ops.tune(fe, params, fepriv->tune_mode_flags, &fepriv->delay, &s); 603 604 if (s != fepriv->status && !(fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT)) { 605 dprintk("%s: state changed, adding current state\n", __func__); 606 dvb_frontend_add_event(fe, s); 607 fepriv->status = s; 608 } 609 break; 610 case DVBFE_ALGO_SW: 611 dprintk("%s: Frontend ALGO = DVBFE_ALGO_SW\n", __func__); 612 dvb_frontend_swzigzag(fe); 613 break; 614 case DVBFE_ALGO_CUSTOM: 615 params = NULL; /* have we been asked to RETUNE ? */ 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 params = &fepriv->parameters; 620 fepriv->state = FESTATE_TUNED; 621 } 622 /* Case where we are going to search for a carrier 623 * User asked us to retune again for some reason, possibly 624 * requesting a search with a new set of parameters 625 */ 626 if (fepriv->algo_status & DVBFE_ALGO_SEARCH_AGAIN) { 627 if (fe->ops.search) { 628 fepriv->algo_status = fe->ops.search(fe, &fepriv->parameters); 629 /* We did do a search as was requested, the flags are 630 * now unset as well and has the flags wrt to search. 631 */ 632 } else { 633 fepriv->algo_status &= ~DVBFE_ALGO_SEARCH_AGAIN; 634 } 635 } 636 /* Track the carrier if the search was successful */ 637 if (fepriv->algo_status == DVBFE_ALGO_SEARCH_SUCCESS) { 638 if (fe->ops.track) 639 fe->ops.track(fe, &fepriv->parameters); 640 } else { 641 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 642 fepriv->delay = HZ / 2; 643 } 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 int i; 864 865 memset(&(fe->dtv_property_cache), 0, 866 sizeof(struct dtv_frontend_properties)); 867 868 fe->dtv_property_cache.state = DTV_CLEAR; 869 fe->dtv_property_cache.delivery_system = SYS_UNDEFINED; 870 fe->dtv_property_cache.inversion = INVERSION_AUTO; 871 fe->dtv_property_cache.fec_inner = FEC_AUTO; 872 fe->dtv_property_cache.transmission_mode = TRANSMISSION_MODE_AUTO; 873 fe->dtv_property_cache.bandwidth_hz = BANDWIDTH_AUTO; 874 fe->dtv_property_cache.guard_interval = GUARD_INTERVAL_AUTO; 875 fe->dtv_property_cache.hierarchy = HIERARCHY_AUTO; 876 fe->dtv_property_cache.symbol_rate = QAM_AUTO; 877 fe->dtv_property_cache.code_rate_HP = FEC_AUTO; 878 fe->dtv_property_cache.code_rate_LP = FEC_AUTO; 879 880 fe->dtv_property_cache.isdbt_partial_reception = -1; 881 fe->dtv_property_cache.isdbt_sb_mode = -1; 882 fe->dtv_property_cache.isdbt_sb_subchannel = -1; 883 fe->dtv_property_cache.isdbt_sb_segment_idx = -1; 884 fe->dtv_property_cache.isdbt_sb_segment_count = -1; 885 fe->dtv_property_cache.isdbt_layer_enabled = 0x7; 886 for (i = 0; i < 3; i++) { 887 fe->dtv_property_cache.layer[i].fec = FEC_AUTO; 888 fe->dtv_property_cache.layer[i].modulation = QAM_AUTO; 889 fe->dtv_property_cache.layer[i].interleaving = -1; 890 fe->dtv_property_cache.layer[i].segment_count = -1; 891 } 892 893 return 0; 894} 895 896#define _DTV_CMD(n, s, b) \ 897[n] = { \ 898 .name = #n, \ 899 .cmd = n, \ 900 .set = s,\ 901 .buffer = b \ 902} 903 904static struct dtv_cmds_h dtv_cmds[] = { 905 _DTV_CMD(DTV_TUNE, 1, 0), 906 _DTV_CMD(DTV_CLEAR, 1, 0), 907 908 /* Set */ 909 _DTV_CMD(DTV_FREQUENCY, 1, 0), 910 _DTV_CMD(DTV_BANDWIDTH_HZ, 1, 0), 911 _DTV_CMD(DTV_MODULATION, 1, 0), 912 _DTV_CMD(DTV_INVERSION, 1, 0), 913 _DTV_CMD(DTV_DISEQC_MASTER, 1, 1), 914 _DTV_CMD(DTV_SYMBOL_RATE, 1, 0), 915 _DTV_CMD(DTV_INNER_FEC, 1, 0), 916 _DTV_CMD(DTV_VOLTAGE, 1, 0), 917 _DTV_CMD(DTV_TONE, 1, 0), 918 _DTV_CMD(DTV_PILOT, 1, 0), 919 _DTV_CMD(DTV_ROLLOFF, 1, 0), 920 _DTV_CMD(DTV_DELIVERY_SYSTEM, 1, 0), 921 _DTV_CMD(DTV_HIERARCHY, 1, 0), 922 _DTV_CMD(DTV_CODE_RATE_HP, 1, 0), 923 _DTV_CMD(DTV_CODE_RATE_LP, 1, 0), 924 _DTV_CMD(DTV_GUARD_INTERVAL, 1, 0), 925 _DTV_CMD(DTV_TRANSMISSION_MODE, 1, 0), 926 927 _DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 1, 0), 928 _DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 1, 0), 929 _DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 1, 0), 930 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 1, 0), 931 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 1, 0), 932 _DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 1, 0), 933 _DTV_CMD(DTV_ISDBT_LAYERA_FEC, 1, 0), 934 _DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 1, 0), 935 _DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 1, 0), 936 _DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 1, 0), 937 _DTV_CMD(DTV_ISDBT_LAYERB_FEC, 1, 0), 938 _DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 1, 0), 939 _DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 1, 0), 940 _DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 1, 0), 941 _DTV_CMD(DTV_ISDBT_LAYERC_FEC, 1, 0), 942 _DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 1, 0), 943 _DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 1, 0), 944 _DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 1, 0), 945 946 _DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 0, 0), 947 _DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 0, 0), 948 _DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 0, 0), 949 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 0, 0), 950 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 0, 0), 951 _DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 0, 0), 952 _DTV_CMD(DTV_ISDBT_LAYERA_FEC, 0, 0), 953 _DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 0, 0), 954 _DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 0, 0), 955 _DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 0, 0), 956 _DTV_CMD(DTV_ISDBT_LAYERB_FEC, 0, 0), 957 _DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 0, 0), 958 _DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 0, 0), 959 _DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 0, 0), 960 _DTV_CMD(DTV_ISDBT_LAYERC_FEC, 0, 0), 961 _DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 0, 0), 962 _DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 0, 0), 963 _DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 0, 0), 964 965 _DTV_CMD(DTV_ISDBS_TS_ID, 1, 0), 966 967 /* Get */ 968 _DTV_CMD(DTV_DISEQC_SLAVE_REPLY, 0, 1), 969 _DTV_CMD(DTV_API_VERSION, 0, 0), 970 _DTV_CMD(DTV_CODE_RATE_HP, 0, 0), 971 _DTV_CMD(DTV_CODE_RATE_LP, 0, 0), 972 _DTV_CMD(DTV_GUARD_INTERVAL, 0, 0), 973 _DTV_CMD(DTV_TRANSMISSION_MODE, 0, 0), 974 _DTV_CMD(DTV_HIERARCHY, 0, 0), 975}; 976 977static void dtv_property_dump(struct dtv_property *tvp) 978{ 979 int i; 980 981 if (tvp->cmd <= 0 || tvp->cmd > DTV_MAX_COMMAND) { 982 printk(KERN_WARNING "%s: tvp.cmd = 0x%08x undefined\n", 983 __func__, tvp->cmd); 984 return; 985 } 986 987 dprintk("%s() tvp.cmd = 0x%08x (%s)\n" 988 ,__func__ 989 ,tvp->cmd 990 ,dtv_cmds[ tvp->cmd ].name); 991 992 if(dtv_cmds[ tvp->cmd ].buffer) { 993 994 dprintk("%s() tvp.u.buffer.len = 0x%02x\n" 995 ,__func__ 996 ,tvp->u.buffer.len); 997 998 for(i = 0; i < tvp->u.buffer.len; i++) 999 dprintk("%s() tvp.u.buffer.data[0x%02x] = 0x%02x\n" 1000 ,__func__ 1001 ,i 1002 ,tvp->u.buffer.data[i]); 1003 1004 } else 1005 dprintk("%s() tvp.u.data = 0x%08x\n", __func__, tvp->u.data); 1006} 1007 1008static int is_legacy_delivery_system(fe_delivery_system_t s) 1009{ 1010 if((s == SYS_UNDEFINED) || (s == SYS_DVBC_ANNEX_AC) || 1011 (s == SYS_DVBC_ANNEX_B) || (s == SYS_DVBT) || (s == SYS_DVBS) || 1012 (s == SYS_ATSC)) 1013 return 1; 1014 1015 return 0; 1016} 1017 1018/* Synchronise the legacy tuning parameters into the cache, so that demodulator 1019 * drivers can use a single set_frontend tuning function, regardless of whether 1020 * it's being used for the legacy or new API, reducing code and complexity. 1021 */ 1022static void dtv_property_cache_sync(struct dvb_frontend *fe, 1023 struct dvb_frontend_parameters *p) 1024{ 1025 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1026 1027 c->frequency = p->frequency; 1028 c->inversion = p->inversion; 1029 1030 switch (fe->ops.info.type) { 1031 case FE_QPSK: 1032 c->modulation = QPSK; /* implied for DVB-S in legacy API */ 1033 c->rolloff = ROLLOFF_35;/* implied for DVB-S */ 1034 c->symbol_rate = p->u.qpsk.symbol_rate; 1035 c->fec_inner = p->u.qpsk.fec_inner; 1036 c->delivery_system = SYS_DVBS; 1037 break; 1038 case FE_QAM: 1039 c->symbol_rate = p->u.qam.symbol_rate; 1040 c->fec_inner = p->u.qam.fec_inner; 1041 c->modulation = p->u.qam.modulation; 1042 c->delivery_system = SYS_DVBC_ANNEX_AC; 1043 break; 1044 case FE_OFDM: 1045 if (p->u.ofdm.bandwidth == BANDWIDTH_6_MHZ) 1046 c->bandwidth_hz = 6000000; 1047 else if (p->u.ofdm.bandwidth == BANDWIDTH_7_MHZ) 1048 c->bandwidth_hz = 7000000; 1049 else if (p->u.ofdm.bandwidth == BANDWIDTH_8_MHZ) 1050 c->bandwidth_hz = 8000000; 1051 else 1052 /* Including BANDWIDTH_AUTO */ 1053 c->bandwidth_hz = 0; 1054 c->code_rate_HP = p->u.ofdm.code_rate_HP; 1055 c->code_rate_LP = p->u.ofdm.code_rate_LP; 1056 c->modulation = p->u.ofdm.constellation; 1057 c->transmission_mode = p->u.ofdm.transmission_mode; 1058 c->guard_interval = p->u.ofdm.guard_interval; 1059 c->hierarchy = p->u.ofdm.hierarchy_information; 1060 c->delivery_system = SYS_DVBT; 1061 break; 1062 case FE_ATSC: 1063 c->modulation = p->u.vsb.modulation; 1064 if ((c->modulation == VSB_8) || (c->modulation == VSB_16)) 1065 c->delivery_system = SYS_ATSC; 1066 else 1067 c->delivery_system = SYS_DVBC_ANNEX_B; 1068 break; 1069 } 1070} 1071 1072/* Ensure the cached values are set correctly in the frontend 1073 * legacy tuning structures, for the advanced tuning API. 1074 */ 1075static void dtv_property_legacy_params_sync(struct dvb_frontend *fe) 1076{ 1077 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1078 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1079 struct dvb_frontend_parameters *p = &fepriv->parameters; 1080 1081 p->frequency = c->frequency; 1082 p->inversion = c->inversion; 1083 1084 switch (fe->ops.info.type) { 1085 case FE_QPSK: 1086 dprintk("%s() Preparing QPSK req\n", __func__); 1087 p->u.qpsk.symbol_rate = c->symbol_rate; 1088 p->u.qpsk.fec_inner = c->fec_inner; 1089 c->delivery_system = SYS_DVBS; 1090 break; 1091 case FE_QAM: 1092 dprintk("%s() Preparing QAM req\n", __func__); 1093 p->u.qam.symbol_rate = c->symbol_rate; 1094 p->u.qam.fec_inner = c->fec_inner; 1095 p->u.qam.modulation = c->modulation; 1096 c->delivery_system = SYS_DVBC_ANNEX_AC; 1097 break; 1098 case FE_OFDM: 1099 dprintk("%s() Preparing OFDM req\n", __func__); 1100 if (c->bandwidth_hz == 6000000) 1101 p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ; 1102 else if (c->bandwidth_hz == 7000000) 1103 p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ; 1104 else if (c->bandwidth_hz == 8000000) 1105 p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ; 1106 else 1107 p->u.ofdm.bandwidth = BANDWIDTH_AUTO; 1108 p->u.ofdm.code_rate_HP = c->code_rate_HP; 1109 p->u.ofdm.code_rate_LP = c->code_rate_LP; 1110 p->u.ofdm.constellation = c->modulation; 1111 p->u.ofdm.transmission_mode = c->transmission_mode; 1112 p->u.ofdm.guard_interval = c->guard_interval; 1113 p->u.ofdm.hierarchy_information = c->hierarchy; 1114 c->delivery_system = SYS_DVBT; 1115 break; 1116 case FE_ATSC: 1117 dprintk("%s() Preparing VSB req\n", __func__); 1118 p->u.vsb.modulation = c->modulation; 1119 if ((c->modulation == VSB_8) || (c->modulation == VSB_16)) 1120 c->delivery_system = SYS_ATSC; 1121 else 1122 c->delivery_system = SYS_DVBC_ANNEX_B; 1123 break; 1124 } 1125} 1126 1127/* Ensure the cached values are set correctly in the frontend 1128 * legacy tuning structures, for the legacy tuning API. 1129 */ 1130static void dtv_property_adv_params_sync(struct dvb_frontend *fe) 1131{ 1132 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1133 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1134 struct dvb_frontend_parameters *p = &fepriv->parameters; 1135 1136 p->frequency = c->frequency; 1137 p->inversion = c->inversion; 1138 1139 switch(c->modulation) { 1140 case PSK_8: 1141 case APSK_16: 1142 case APSK_32: 1143 case QPSK: 1144 p->u.qpsk.symbol_rate = c->symbol_rate; 1145 p->u.qpsk.fec_inner = c->fec_inner; 1146 break; 1147 default: 1148 break; 1149 } 1150 1151 if(c->delivery_system == SYS_ISDBT) { 1152 /* Fake out a generic DVB-T request so we pass validation in the ioctl */ 1153 p->frequency = c->frequency; 1154 p->inversion = c->inversion; 1155 p->u.ofdm.constellation = QAM_AUTO; 1156 p->u.ofdm.code_rate_HP = FEC_AUTO; 1157 p->u.ofdm.code_rate_LP = FEC_AUTO; 1158 p->u.ofdm.transmission_mode = TRANSMISSION_MODE_AUTO; 1159 p->u.ofdm.guard_interval = GUARD_INTERVAL_AUTO; 1160 p->u.ofdm.hierarchy_information = HIERARCHY_AUTO; 1161 if (c->bandwidth_hz == 8000000) 1162 p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ; 1163 else if (c->bandwidth_hz == 7000000) 1164 p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ; 1165 else if (c->bandwidth_hz == 6000000) 1166 p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ; 1167 else 1168 p->u.ofdm.bandwidth = BANDWIDTH_AUTO; 1169 } 1170} 1171 1172static void dtv_property_cache_submit(struct dvb_frontend *fe) 1173{ 1174 struct dtv_frontend_properties *c = &fe->dtv_property_cache; 1175 1176 /* For legacy delivery systems we don't need the delivery_system to 1177 * be specified, but we populate the older structures from the cache 1178 * so we can call set_frontend on older drivers. 1179 */ 1180 if(is_legacy_delivery_system(c->delivery_system)) { 1181 1182 dprintk("%s() legacy, modulation = %d\n", __func__, c->modulation); 1183 dtv_property_legacy_params_sync(fe); 1184 1185 } else { 1186 dprintk("%s() adv, modulation = %d\n", __func__, c->modulation); 1187 1188 /* For advanced delivery systems / modulation types ... 1189 * we seed the lecacy dvb_frontend_parameters structure 1190 * so that the sanity checking code later in the IOCTL processing 1191 * can validate our basic frequency ranges, symbolrates, modulation 1192 * etc. 1193 */ 1194 dtv_property_adv_params_sync(fe); 1195 } 1196} 1197 1198static int dvb_frontend_ioctl_legacy(struct file *file, 1199 unsigned int cmd, void *parg); 1200static int dvb_frontend_ioctl_properties(struct file *file, 1201 unsigned int cmd, void *parg); 1202 1203static int dtv_property_process_get(struct dvb_frontend *fe, 1204 struct dtv_property *tvp, 1205 struct file *file) 1206{ 1207 int r = 0; 1208 1209 /* Allow the frontend to validate incoming properties */ 1210 if (fe->ops.get_property) 1211 r = fe->ops.get_property(fe, tvp); 1212 1213 if (r < 0) 1214 return r; 1215 1216 switch(tvp->cmd) { 1217 case DTV_FREQUENCY: 1218 tvp->u.data = fe->dtv_property_cache.frequency; 1219 break; 1220 case DTV_MODULATION: 1221 tvp->u.data = fe->dtv_property_cache.modulation; 1222 break; 1223 case DTV_BANDWIDTH_HZ: 1224 tvp->u.data = fe->dtv_property_cache.bandwidth_hz; 1225 break; 1226 case DTV_INVERSION: 1227 tvp->u.data = fe->dtv_property_cache.inversion; 1228 break; 1229 case DTV_SYMBOL_RATE: 1230 tvp->u.data = fe->dtv_property_cache.symbol_rate; 1231 break; 1232 case DTV_INNER_FEC: 1233 tvp->u.data = fe->dtv_property_cache.fec_inner; 1234 break; 1235 case DTV_PILOT: 1236 tvp->u.data = fe->dtv_property_cache.pilot; 1237 break; 1238 case DTV_ROLLOFF: 1239 tvp->u.data = fe->dtv_property_cache.rolloff; 1240 break; 1241 case DTV_DELIVERY_SYSTEM: 1242 tvp->u.data = fe->dtv_property_cache.delivery_system; 1243 break; 1244 case DTV_VOLTAGE: 1245 tvp->u.data = fe->dtv_property_cache.voltage; 1246 break; 1247 case DTV_TONE: 1248 tvp->u.data = fe->dtv_property_cache.sectone; 1249 break; 1250 case DTV_API_VERSION: 1251 tvp->u.data = (DVB_API_VERSION << 8) | DVB_API_VERSION_MINOR; 1252 break; 1253 case DTV_CODE_RATE_HP: 1254 tvp->u.data = fe->dtv_property_cache.code_rate_HP; 1255 break; 1256 case DTV_CODE_RATE_LP: 1257 tvp->u.data = fe->dtv_property_cache.code_rate_LP; 1258 break; 1259 case DTV_GUARD_INTERVAL: 1260 tvp->u.data = fe->dtv_property_cache.guard_interval; 1261 break; 1262 case DTV_TRANSMISSION_MODE: 1263 tvp->u.data = fe->dtv_property_cache.transmission_mode; 1264 break; 1265 case DTV_HIERARCHY: 1266 tvp->u.data = fe->dtv_property_cache.hierarchy; 1267 break; 1268 1269 /* ISDB-T Support here */ 1270 case DTV_ISDBT_PARTIAL_RECEPTION: 1271 tvp->u.data = fe->dtv_property_cache.isdbt_partial_reception; 1272 break; 1273 case DTV_ISDBT_SOUND_BROADCASTING: 1274 tvp->u.data = fe->dtv_property_cache.isdbt_sb_mode; 1275 break; 1276 case DTV_ISDBT_SB_SUBCHANNEL_ID: 1277 tvp->u.data = fe->dtv_property_cache.isdbt_sb_subchannel; 1278 break; 1279 case DTV_ISDBT_SB_SEGMENT_IDX: 1280 tvp->u.data = fe->dtv_property_cache.isdbt_sb_segment_idx; 1281 break; 1282 case DTV_ISDBT_SB_SEGMENT_COUNT: 1283 tvp->u.data = fe->dtv_property_cache.isdbt_sb_segment_count; 1284 break; 1285 case DTV_ISDBT_LAYER_ENABLED: 1286 tvp->u.data = fe->dtv_property_cache.isdbt_layer_enabled; 1287 break; 1288 case DTV_ISDBT_LAYERA_FEC: 1289 tvp->u.data = fe->dtv_property_cache.layer[0].fec; 1290 break; 1291 case DTV_ISDBT_LAYERA_MODULATION: 1292 tvp->u.data = fe->dtv_property_cache.layer[0].modulation; 1293 break; 1294 case DTV_ISDBT_LAYERA_SEGMENT_COUNT: 1295 tvp->u.data = fe->dtv_property_cache.layer[0].segment_count; 1296 break; 1297 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING: 1298 tvp->u.data = fe->dtv_property_cache.layer[0].interleaving; 1299 break; 1300 case DTV_ISDBT_LAYERB_FEC: 1301 tvp->u.data = fe->dtv_property_cache.layer[1].fec; 1302 break; 1303 case DTV_ISDBT_LAYERB_MODULATION: 1304 tvp->u.data = fe->dtv_property_cache.layer[1].modulation; 1305 break; 1306 case DTV_ISDBT_LAYERB_SEGMENT_COUNT: 1307 tvp->u.data = fe->dtv_property_cache.layer[1].segment_count; 1308 break; 1309 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING: 1310 tvp->u.data = fe->dtv_property_cache.layer[1].interleaving; 1311 break; 1312 case DTV_ISDBT_LAYERC_FEC: 1313 tvp->u.data = fe->dtv_property_cache.layer[2].fec; 1314 break; 1315 case DTV_ISDBT_LAYERC_MODULATION: 1316 tvp->u.data = fe->dtv_property_cache.layer[2].modulation; 1317 break; 1318 case DTV_ISDBT_LAYERC_SEGMENT_COUNT: 1319 tvp->u.data = fe->dtv_property_cache.layer[2].segment_count; 1320 break; 1321 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING: 1322 tvp->u.data = fe->dtv_property_cache.layer[2].interleaving; 1323 break; 1324 case DTV_ISDBS_TS_ID: 1325 tvp->u.data = fe->dtv_property_cache.isdbs_ts_id; 1326 break; 1327 default: 1328 r = -1; 1329 } 1330 1331 dtv_property_dump(tvp); 1332 1333 return r; 1334} 1335 1336static int dtv_property_process_set(struct dvb_frontend *fe, 1337 struct dtv_property *tvp, 1338 struct file *file) 1339{ 1340 int r = 0; 1341 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1342 dtv_property_dump(tvp); 1343 1344 /* Allow the frontend to validate incoming properties */ 1345 if (fe->ops.set_property) 1346 r = fe->ops.set_property(fe, tvp); 1347 1348 if (r < 0) 1349 return r; 1350 1351 switch(tvp->cmd) { 1352 case DTV_CLEAR: 1353 /* Reset a cache of data specific to the frontend here. This does 1354 * not effect hardware. 1355 */ 1356 dvb_frontend_clear_cache(fe); 1357 dprintk("%s() Flushing property cache\n", __func__); 1358 break; 1359 case DTV_TUNE: 1360 /* interpret the cache of data, build either a traditional frontend 1361 * tunerequest so we can pass validation in the FE_SET_FRONTEND 1362 * ioctl. 1363 */ 1364 fe->dtv_property_cache.state = tvp->cmd; 1365 dprintk("%s() Finalised property cache\n", __func__); 1366 dtv_property_cache_submit(fe); 1367 1368 r |= dvb_frontend_ioctl_legacy(file, FE_SET_FRONTEND, 1369 &fepriv->parameters); 1370 break; 1371 case DTV_FREQUENCY: 1372 fe->dtv_property_cache.frequency = tvp->u.data; 1373 break; 1374 case DTV_MODULATION: 1375 fe->dtv_property_cache.modulation = tvp->u.data; 1376 break; 1377 case DTV_BANDWIDTH_HZ: 1378 fe->dtv_property_cache.bandwidth_hz = tvp->u.data; 1379 break; 1380 case DTV_INVERSION: 1381 fe->dtv_property_cache.inversion = tvp->u.data; 1382 break; 1383 case DTV_SYMBOL_RATE: 1384 fe->dtv_property_cache.symbol_rate = tvp->u.data; 1385 break; 1386 case DTV_INNER_FEC: 1387 fe->dtv_property_cache.fec_inner = tvp->u.data; 1388 break; 1389 case DTV_PILOT: 1390 fe->dtv_property_cache.pilot = tvp->u.data; 1391 break; 1392 case DTV_ROLLOFF: 1393 fe->dtv_property_cache.rolloff = tvp->u.data; 1394 break; 1395 case DTV_DELIVERY_SYSTEM: 1396 fe->dtv_property_cache.delivery_system = tvp->u.data; 1397 break; 1398 case DTV_VOLTAGE: 1399 fe->dtv_property_cache.voltage = tvp->u.data; 1400 r = dvb_frontend_ioctl_legacy(file, FE_SET_VOLTAGE, 1401 (void *)fe->dtv_property_cache.voltage); 1402 break; 1403 case DTV_TONE: 1404 fe->dtv_property_cache.sectone = tvp->u.data; 1405 r = dvb_frontend_ioctl_legacy(file, FE_SET_TONE, 1406 (void *)fe->dtv_property_cache.sectone); 1407 break; 1408 case DTV_CODE_RATE_HP: 1409 fe->dtv_property_cache.code_rate_HP = tvp->u.data; 1410 break; 1411 case DTV_CODE_RATE_LP: 1412 fe->dtv_property_cache.code_rate_LP = tvp->u.data; 1413 break; 1414 case DTV_GUARD_INTERVAL: 1415 fe->dtv_property_cache.guard_interval = tvp->u.data; 1416 break; 1417 case DTV_TRANSMISSION_MODE: 1418 fe->dtv_property_cache.transmission_mode = tvp->u.data; 1419 break; 1420 case DTV_HIERARCHY: 1421 fe->dtv_property_cache.hierarchy = tvp->u.data; 1422 break; 1423 1424 /* ISDB-T Support here */ 1425 case DTV_ISDBT_PARTIAL_RECEPTION: 1426 fe->dtv_property_cache.isdbt_partial_reception = tvp->u.data; 1427 break; 1428 case DTV_ISDBT_SOUND_BROADCASTING: 1429 fe->dtv_property_cache.isdbt_sb_mode = tvp->u.data; 1430 break; 1431 case DTV_ISDBT_SB_SUBCHANNEL_ID: 1432 fe->dtv_property_cache.isdbt_sb_subchannel = tvp->u.data; 1433 break; 1434 case DTV_ISDBT_SB_SEGMENT_IDX: 1435 fe->dtv_property_cache.isdbt_sb_segment_idx = tvp->u.data; 1436 break; 1437 case DTV_ISDBT_SB_SEGMENT_COUNT: 1438 fe->dtv_property_cache.isdbt_sb_segment_count = tvp->u.data; 1439 break; 1440 case DTV_ISDBT_LAYER_ENABLED: 1441 fe->dtv_property_cache.isdbt_layer_enabled = tvp->u.data; 1442 break; 1443 case DTV_ISDBT_LAYERA_FEC: 1444 fe->dtv_property_cache.layer[0].fec = tvp->u.data; 1445 break; 1446 case DTV_ISDBT_LAYERA_MODULATION: 1447 fe->dtv_property_cache.layer[0].modulation = tvp->u.data; 1448 break; 1449 case DTV_ISDBT_LAYERA_SEGMENT_COUNT: 1450 fe->dtv_property_cache.layer[0].segment_count = tvp->u.data; 1451 break; 1452 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING: 1453 fe->dtv_property_cache.layer[0].interleaving = tvp->u.data; 1454 break; 1455 case DTV_ISDBT_LAYERB_FEC: 1456 fe->dtv_property_cache.layer[1].fec = tvp->u.data; 1457 break; 1458 case DTV_ISDBT_LAYERB_MODULATION: 1459 fe->dtv_property_cache.layer[1].modulation = tvp->u.data; 1460 break; 1461 case DTV_ISDBT_LAYERB_SEGMENT_COUNT: 1462 fe->dtv_property_cache.layer[1].segment_count = tvp->u.data; 1463 break; 1464 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING: 1465 fe->dtv_property_cache.layer[1].interleaving = tvp->u.data; 1466 break; 1467 case DTV_ISDBT_LAYERC_FEC: 1468 fe->dtv_property_cache.layer[2].fec = tvp->u.data; 1469 break; 1470 case DTV_ISDBT_LAYERC_MODULATION: 1471 fe->dtv_property_cache.layer[2].modulation = tvp->u.data; 1472 break; 1473 case DTV_ISDBT_LAYERC_SEGMENT_COUNT: 1474 fe->dtv_property_cache.layer[2].segment_count = tvp->u.data; 1475 break; 1476 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING: 1477 fe->dtv_property_cache.layer[2].interleaving = tvp->u.data; 1478 break; 1479 case DTV_ISDBS_TS_ID: 1480 fe->dtv_property_cache.isdbs_ts_id = tvp->u.data; 1481 break; 1482 default: 1483 r = -1; 1484 } 1485 1486 return r; 1487} 1488 1489static int dvb_frontend_ioctl(struct file *file, 1490 unsigned int cmd, void *parg) 1491{ 1492 struct dvb_device *dvbdev = file->private_data; 1493 struct dvb_frontend *fe = dvbdev->priv; 1494 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1495 int err = -EOPNOTSUPP; 1496 1497 dprintk("%s (%d)\n", __func__, _IOC_NR(cmd)); 1498 1499 if (fepriv->exit != DVB_FE_NO_EXIT) 1500 return -ENODEV; 1501 1502 if ((file->f_flags & O_ACCMODE) == O_RDONLY && 1503 (_IOC_DIR(cmd) != _IOC_READ || cmd == FE_GET_EVENT || 1504 cmd == FE_DISEQC_RECV_SLAVE_REPLY)) 1505 return -EPERM; 1506 1507 if (down_interruptible (&fepriv->sem)) 1508 return -ERESTARTSYS; 1509 1510 if ((cmd == FE_SET_PROPERTY) || (cmd == FE_GET_PROPERTY)) 1511 err = dvb_frontend_ioctl_properties(file, cmd, parg); 1512 else { 1513 fe->dtv_property_cache.state = DTV_UNDEFINED; 1514 err = dvb_frontend_ioctl_legacy(file, cmd, parg); 1515 } 1516 1517 up(&fepriv->sem); 1518 return err; 1519} 1520 1521static int dvb_frontend_ioctl_properties(struct file *file, 1522 unsigned int cmd, void *parg) 1523{ 1524 struct dvb_device *dvbdev = file->private_data; 1525 struct dvb_frontend *fe = dvbdev->priv; 1526 int err = 0; 1527 1528 struct dtv_properties *tvps = NULL; 1529 struct dtv_property *tvp = NULL; 1530 int i; 1531 1532 dprintk("%s\n", __func__); 1533 1534 if(cmd == FE_SET_PROPERTY) { 1535 tvps = (struct dtv_properties __user *)parg; 1536 1537 dprintk("%s() properties.num = %d\n", __func__, tvps->num); 1538 dprintk("%s() properties.props = %p\n", __func__, tvps->props); 1539 1540 /* Put an arbitrary limit on the number of messages that can 1541 * be sent at once */ 1542 if ((tvps->num == 0) || (tvps->num > DTV_IOCTL_MAX_MSGS)) 1543 return -EINVAL; 1544 1545 tvp = kmalloc(tvps->num * sizeof(struct dtv_property), GFP_KERNEL); 1546 if (!tvp) { 1547 err = -ENOMEM; 1548 goto out; 1549 } 1550 1551 if (copy_from_user(tvp, tvps->props, tvps->num * sizeof(struct dtv_property))) { 1552 err = -EFAULT; 1553 goto out; 1554 } 1555 1556 for (i = 0; i < tvps->num; i++) { 1557 (tvp + i)->result = dtv_property_process_set(fe, tvp + i, file); 1558 err |= (tvp + i)->result; 1559 } 1560 1561 if(fe->dtv_property_cache.state == DTV_TUNE) 1562 dprintk("%s() Property cache is full, tuning\n", __func__); 1563 1564 } else 1565 if(cmd == FE_GET_PROPERTY) { 1566 1567 tvps = (struct dtv_properties __user *)parg; 1568 1569 dprintk("%s() properties.num = %d\n", __func__, tvps->num); 1570 dprintk("%s() properties.props = %p\n", __func__, tvps->props); 1571 1572 /* Put an arbitrary limit on the number of messages that can 1573 * be sent at once */ 1574 if ((tvps->num == 0) || (tvps->num > DTV_IOCTL_MAX_MSGS)) 1575 return -EINVAL; 1576 1577 tvp = kmalloc(tvps->num * sizeof(struct dtv_property), GFP_KERNEL); 1578 if (!tvp) { 1579 err = -ENOMEM; 1580 goto out; 1581 } 1582 1583 if (copy_from_user(tvp, tvps->props, tvps->num * sizeof(struct dtv_property))) { 1584 err = -EFAULT; 1585 goto out; 1586 } 1587 1588 for (i = 0; i < tvps->num; i++) { 1589 (tvp + i)->result = dtv_property_process_get(fe, tvp + i, file); 1590 err |= (tvp + i)->result; 1591 } 1592 1593 if (copy_to_user(tvps->props, tvp, tvps->num * sizeof(struct dtv_property))) { 1594 err = -EFAULT; 1595 goto out; 1596 } 1597 1598 } else 1599 err = -EOPNOTSUPP; 1600 1601out: 1602 kfree(tvp); 1603 return err; 1604} 1605 1606static int dvb_frontend_ioctl_legacy(struct file *file, 1607 unsigned int cmd, void *parg) 1608{ 1609 struct dvb_device *dvbdev = file->private_data; 1610 struct dvb_frontend *fe = dvbdev->priv; 1611 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1612 int cb_err, err = -EOPNOTSUPP; 1613 1614 if (fe->dvb->fe_ioctl_override) { 1615 cb_err = fe->dvb->fe_ioctl_override(fe, cmd, parg, 1616 DVB_FE_IOCTL_PRE); 1617 if (cb_err < 0) 1618 return cb_err; 1619 if (cb_err > 0) 1620 return 0; 1621 /* fe_ioctl_override returning 0 allows 1622 * dvb-core to continue handling the ioctl */ 1623 } 1624 1625 switch (cmd) { 1626 case FE_GET_INFO: { 1627 struct dvb_frontend_info* info = parg; 1628 memcpy(info, &fe->ops.info, sizeof(struct dvb_frontend_info)); 1629 dvb_frontend_get_frequency_limits(fe, &info->frequency_min, &info->frequency_max); 1630 1631 /* Force the CAN_INVERSION_AUTO bit on. If the frontend doesn't 1632 * do it, it is done for it. */ 1633 info->caps |= FE_CAN_INVERSION_AUTO; 1634 err = 0; 1635 break; 1636 } 1637 1638 case FE_READ_STATUS: { 1639 fe_status_t* status = parg; 1640 1641 /* if retune was requested but hasn't occured yet, prevent 1642 * that user get signal state from previous tuning */ 1643 if (fepriv->state == FESTATE_RETUNE || 1644 fepriv->state == FESTATE_ERROR) { 1645 err=0; 1646 *status = 0; 1647 break; 1648 } 1649 1650 if (fe->ops.read_status) 1651 err = fe->ops.read_status(fe, status); 1652 break; 1653 } 1654 case FE_READ_BER: 1655 if (fe->ops.read_ber) 1656 err = fe->ops.read_ber(fe, (__u32*) parg); 1657 break; 1658 1659 case FE_READ_SIGNAL_STRENGTH: 1660 if (fe->ops.read_signal_strength) 1661 err = fe->ops.read_signal_strength(fe, (__u16*) parg); 1662 break; 1663 1664 case FE_READ_SNR: 1665 if (fe->ops.read_snr) 1666 err = fe->ops.read_snr(fe, (__u16*) parg); 1667 break; 1668 1669 case FE_READ_UNCORRECTED_BLOCKS: 1670 if (fe->ops.read_ucblocks) 1671 err = fe->ops.read_ucblocks(fe, (__u32*) parg); 1672 break; 1673 1674 1675 case FE_DISEQC_RESET_OVERLOAD: 1676 if (fe->ops.diseqc_reset_overload) { 1677 err = fe->ops.diseqc_reset_overload(fe); 1678 fepriv->state = FESTATE_DISEQC; 1679 fepriv->status = 0; 1680 } 1681 break; 1682 1683 case FE_DISEQC_SEND_MASTER_CMD: 1684 if (fe->ops.diseqc_send_master_cmd) { 1685 err = fe->ops.diseqc_send_master_cmd(fe, (struct dvb_diseqc_master_cmd*) parg); 1686 fepriv->state = FESTATE_DISEQC; 1687 fepriv->status = 0; 1688 } 1689 break; 1690 1691 case FE_DISEQC_SEND_BURST: 1692 if (fe->ops.diseqc_send_burst) { 1693 err = fe->ops.diseqc_send_burst(fe, (fe_sec_mini_cmd_t) parg); 1694 fepriv->state = FESTATE_DISEQC; 1695 fepriv->status = 0; 1696 } 1697 break; 1698 1699 case FE_SET_TONE: 1700 if (fe->ops.set_tone) { 1701 err = fe->ops.set_tone(fe, (fe_sec_tone_mode_t) parg); 1702 fepriv->tone = (fe_sec_tone_mode_t) parg; 1703 fepriv->state = FESTATE_DISEQC; 1704 fepriv->status = 0; 1705 } 1706 break; 1707 1708 case FE_SET_VOLTAGE: 1709 if (fe->ops.set_voltage) { 1710 err = fe->ops.set_voltage(fe, (fe_sec_voltage_t) parg); 1711 fepriv->voltage = (fe_sec_voltage_t) parg; 1712 fepriv->state = FESTATE_DISEQC; 1713 fepriv->status = 0; 1714 } 1715 break; 1716 1717 case FE_DISHNETWORK_SEND_LEGACY_CMD: 1718 if (fe->ops.dishnetwork_send_legacy_command) { 1719 err = fe->ops.dishnetwork_send_legacy_command(fe, (unsigned long) parg); 1720 fepriv->state = FESTATE_DISEQC; 1721 fepriv->status = 0; 1722 } else if (fe->ops.set_voltage) { 1723 /* 1724 * NOTE: This is a fallback condition. Some frontends 1725 * (stv0299 for instance) take longer than 8msec to 1726 * respond to a set_voltage command. Those switches 1727 * need custom routines to switch properly. For all 1728 * other frontends, the following should work ok. 1729 * Dish network legacy switches (as used by Dish500) 1730 * are controlled by sending 9-bit command words 1731 * spaced 8msec apart. 1732 * the actual command word is switch/port dependant 1733 * so it is up to the userspace application to send 1734 * the right command. 1735 * The command must always start with a '0' after 1736 * initialization, so parg is 8 bits and does not 1737 * include the initialization or start bit 1738 */ 1739 unsigned long swcmd = ((unsigned long) parg) << 1; 1740 struct timeval nexttime; 1741 struct timeval tv[10]; 1742 int i; 1743 u8 last = 1; 1744 if (dvb_frontend_debug) 1745 printk("%s switch command: 0x%04lx\n", __func__, swcmd); 1746 do_gettimeofday(&nexttime); 1747 if (dvb_frontend_debug) 1748 memcpy(&tv[0], &nexttime, sizeof(struct timeval)); 1749 /* before sending a command, initialize by sending 1750 * a 32ms 18V to the switch 1751 */ 1752 fe->ops.set_voltage(fe, SEC_VOLTAGE_18); 1753 dvb_frontend_sleep_until(&nexttime, 32000); 1754 1755 for (i = 0; i < 9; i++) { 1756 if (dvb_frontend_debug) 1757 do_gettimeofday(&tv[i + 1]); 1758 if ((swcmd & 0x01) != last) { 1759 /* set voltage to (last ? 13V : 18V) */ 1760 fe->ops.set_voltage(fe, (last) ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18); 1761 last = (last) ? 0 : 1; 1762 } 1763 swcmd = swcmd >> 1; 1764 if (i != 8) 1765 dvb_frontend_sleep_until(&nexttime, 8000); 1766 } 1767 if (dvb_frontend_debug) { 1768 printk("%s(%d): switch delay (should be 32k followed by all 8k\n", 1769 __func__, fe->dvb->num); 1770 for (i = 1; i < 10; i++) 1771 printk("%d: %d\n", i, timeval_usec_diff(tv[i-1] , tv[i])); 1772 } 1773 err = 0; 1774 fepriv->state = FESTATE_DISEQC; 1775 fepriv->status = 0; 1776 } 1777 break; 1778 1779 case FE_DISEQC_RECV_SLAVE_REPLY: 1780 if (fe->ops.diseqc_recv_slave_reply) 1781 err = fe->ops.diseqc_recv_slave_reply(fe, (struct dvb_diseqc_slave_reply*) parg); 1782 break; 1783 1784 case FE_ENABLE_HIGH_LNB_VOLTAGE: 1785 if (fe->ops.enable_high_lnb_voltage) 1786 err = fe->ops.enable_high_lnb_voltage(fe, (long) parg); 1787 break; 1788 1789 case FE_SET_FRONTEND: { 1790 struct dvb_frontend_tune_settings fetunesettings; 1791 1792 if(fe->dtv_property_cache.state == DTV_TUNE) { 1793 if (dvb_frontend_check_parameters(fe, &fepriv->parameters) < 0) { 1794 err = -EINVAL; 1795 break; 1796 } 1797 } else { 1798 if (dvb_frontend_check_parameters(fe, parg) < 0) { 1799 err = -EINVAL; 1800 break; 1801 } 1802 1803 memcpy (&fepriv->parameters, parg, 1804 sizeof (struct dvb_frontend_parameters)); 1805 dtv_property_cache_sync(fe, &fepriv->parameters); 1806 } 1807 1808 memset(&fetunesettings, 0, sizeof(struct dvb_frontend_tune_settings)); 1809 memcpy(&fetunesettings.parameters, parg, 1810 sizeof (struct dvb_frontend_parameters)); 1811 1812 /* force auto frequency inversion if requested */ 1813 if (dvb_force_auto_inversion) { 1814 fepriv->parameters.inversion = INVERSION_AUTO; 1815 fetunesettings.parameters.inversion = INVERSION_AUTO; 1816 } 1817 if (fe->ops.info.type == FE_OFDM) { 1818 /* without hierarchical coding code_rate_LP is irrelevant, 1819 * so we tolerate the otherwise invalid FEC_NONE setting */ 1820 if (fepriv->parameters.u.ofdm.hierarchy_information == HIERARCHY_NONE && 1821 fepriv->parameters.u.ofdm.code_rate_LP == FEC_NONE) 1822 fepriv->parameters.u.ofdm.code_rate_LP = FEC_AUTO; 1823 } 1824 1825 /* get frontend-specific tuning settings */ 1826 if (fe->ops.get_tune_settings && (fe->ops.get_tune_settings(fe, &fetunesettings) == 0)) { 1827 fepriv->min_delay = (fetunesettings.min_delay_ms * HZ) / 1000; 1828 fepriv->max_drift = fetunesettings.max_drift; 1829 fepriv->step_size = fetunesettings.step_size; 1830 } else { 1831 /* default values */ 1832 switch(fe->ops.info.type) { 1833 case FE_QPSK: 1834 fepriv->min_delay = HZ/20; 1835 fepriv->step_size = fepriv->parameters.u.qpsk.symbol_rate / 16000; 1836 fepriv->max_drift = fepriv->parameters.u.qpsk.symbol_rate / 2000; 1837 break; 1838 1839 case FE_QAM: 1840 fepriv->min_delay = HZ/20; 1841 fepriv->step_size = 0; /* no zigzag */ 1842 fepriv->max_drift = 0; 1843 break; 1844 1845 case FE_OFDM: 1846 fepriv->min_delay = HZ/20; 1847 fepriv->step_size = fe->ops.info.frequency_stepsize * 2; 1848 fepriv->max_drift = (fe->ops.info.frequency_stepsize * 2) + 1; 1849 break; 1850 case FE_ATSC: 1851 fepriv->min_delay = HZ/20; 1852 fepriv->step_size = 0; 1853 fepriv->max_drift = 0; 1854 break; 1855 } 1856 } 1857 if (dvb_override_tune_delay > 0) 1858 fepriv->min_delay = (dvb_override_tune_delay * HZ) / 1000; 1859 1860 fepriv->state = FESTATE_RETUNE; 1861 1862 /* Request the search algorithm to search */ 1863 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN; 1864 1865 dvb_frontend_wakeup(fe); 1866 dvb_frontend_add_event(fe, 0); 1867 fepriv->status = 0; 1868 err = 0; 1869 break; 1870 } 1871 1872 case FE_GET_EVENT: 1873 err = dvb_frontend_get_event (fe, parg, file->f_flags); 1874 break; 1875 1876 case FE_GET_FRONTEND: 1877 if (fe->ops.get_frontend) { 1878 memcpy (parg, &fepriv->parameters, sizeof (struct dvb_frontend_parameters)); 1879 err = fe->ops.get_frontend(fe, (struct dvb_frontend_parameters*) parg); 1880 } 1881 break; 1882 1883 case FE_SET_FRONTEND_TUNE_MODE: 1884 fepriv->tune_mode_flags = (unsigned long) parg; 1885 err = 0; 1886 break; 1887 }; 1888 1889 if (fe->dvb->fe_ioctl_override) { 1890 cb_err = fe->dvb->fe_ioctl_override(fe, cmd, parg, 1891 DVB_FE_IOCTL_POST); 1892 if (cb_err < 0) 1893 return cb_err; 1894 } 1895 1896 return err; 1897} 1898 1899 1900static unsigned int dvb_frontend_poll(struct file *file, struct poll_table_struct *wait) 1901{ 1902 struct dvb_device *dvbdev = file->private_data; 1903 struct dvb_frontend *fe = dvbdev->priv; 1904 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1905 1906 dprintk ("%s\n", __func__); 1907 1908 poll_wait (file, &fepriv->events.wait_queue, wait); 1909 1910 if (fepriv->events.eventw != fepriv->events.eventr) 1911 return (POLLIN | POLLRDNORM | POLLPRI); 1912 1913 return 0; 1914} 1915 1916static int dvb_frontend_open(struct inode *inode, struct file *file) 1917{ 1918 struct dvb_device *dvbdev = file->private_data; 1919 struct dvb_frontend *fe = dvbdev->priv; 1920 struct dvb_frontend_private *fepriv = fe->frontend_priv; 1921 struct dvb_adapter *adapter = fe->dvb; 1922 int ret; 1923 1924 dprintk ("%s\n", __func__); 1925 if (fepriv->exit == DVB_FE_DEVICE_REMOVED) 1926 return -ENODEV; 1927 1928 if (adapter->mfe_shared) { 1929 mutex_lock (&adapter->mfe_lock); 1930 1931 if (adapter->mfe_dvbdev == NULL) 1932 adapter->mfe_dvbdev = dvbdev; 1933 1934 else if (adapter->mfe_dvbdev != dvbdev) { 1935 struct dvb_device 1936 *mfedev = adapter->mfe_dvbdev; 1937 struct dvb_frontend 1938 *mfe = mfedev->priv; 1939 struct dvb_frontend_private 1940 *mfepriv = mfe->frontend_priv; 1941 int mferetry = (dvb_mfe_wait_time << 1); 1942 1943 mutex_unlock (&adapter->mfe_lock); 1944 while (mferetry-- && (mfedev->users != -1 || 1945 mfepriv->thread != NULL)) { 1946 if(msleep_interruptible(500)) { 1947 if(signal_pending(current)) 1948 return -EINTR; 1949 } 1950 } 1951 1952 mutex_lock (&adapter->mfe_lock); 1953 if(adapter->mfe_dvbdev != dvbdev) { 1954 mfedev = adapter->mfe_dvbdev; 1955 mfe = mfedev->priv; 1956 mfepriv = mfe->frontend_priv; 1957 if (mfedev->users != -1 || 1958 mfepriv->thread != NULL) { 1959 mutex_unlock (&adapter->mfe_lock); 1960 return -EBUSY; 1961 } 1962 adapter->mfe_dvbdev = dvbdev; 1963 } 1964 } 1965 } 1966 1967 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) { 1968 if ((ret = fe->ops.ts_bus_ctrl(fe, 1)) < 0) 1969 goto err0; 1970 } 1971 1972 if ((ret = dvb_generic_open (inode, file)) < 0) 1973 goto err1; 1974 1975 if ((file->f_flags & O_ACCMODE) != O_RDONLY) { 1976 /* normal tune mode when opened R/W */ 1977 fepriv->tune_mode_flags &= ~FE_TUNE_MODE_ONESHOT; 1978 fepriv->tone = -1; 1979 fepriv->voltage = -1; 1980 1981 ret = dvb_frontend_start (fe); 1982 if (ret) 1983 goto err2; 1984 1985 /* empty event queue */ 1986 fepriv->events.eventr = fepriv->events.eventw = 0; 1987 } 1988 1989 if (adapter->mfe_shared) 1990 mutex_unlock (&adapter->mfe_lock); 1991 return ret; 1992 1993err2: 1994 dvb_generic_release(inode, file); 1995err1: 1996 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) 1997 fe->ops.ts_bus_ctrl(fe, 0); 1998err0: 1999 if (adapter->mfe_shared) 2000 mutex_unlock (&adapter->mfe_lock); 2001 return ret; 2002} 2003 2004static int dvb_frontend_release(struct inode *inode, struct file *file) 2005{ 2006 struct dvb_device *dvbdev = file->private_data; 2007 struct dvb_frontend *fe = dvbdev->priv; 2008 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2009 int ret; 2010 2011 dprintk ("%s\n", __func__); 2012 2013 if ((file->f_flags & O_ACCMODE) != O_RDONLY) 2014 fepriv->release_jiffies = jiffies; 2015 2016 ret = dvb_generic_release (inode, file); 2017 2018 if (dvbdev->users == -1) { 2019 if (fepriv->exit != DVB_FE_NO_EXIT) { 2020 fops_put(file->f_op); 2021 file->f_op = NULL; 2022 wake_up(&dvbdev->wait_queue); 2023 } 2024 if (fe->ops.ts_bus_ctrl) 2025 fe->ops.ts_bus_ctrl(fe, 0); 2026 } 2027 2028 return ret; 2029} 2030 2031static const struct file_operations dvb_frontend_fops = { 2032 .owner = THIS_MODULE, 2033 .unlocked_ioctl = dvb_generic_ioctl, 2034 .poll = dvb_frontend_poll, 2035 .open = dvb_frontend_open, 2036 .release = dvb_frontend_release, 2037 .llseek = noop_llseek, 2038}; 2039 2040int dvb_register_frontend(struct dvb_adapter* dvb, 2041 struct dvb_frontend* fe) 2042{ 2043 struct dvb_frontend_private *fepriv; 2044 static const struct dvb_device dvbdev_template = { 2045 .users = ~0, 2046 .writers = 1, 2047 .readers = (~0)-1, 2048 .fops = &dvb_frontend_fops, 2049 .kernel_ioctl = dvb_frontend_ioctl 2050 }; 2051 2052 dprintk ("%s\n", __func__); 2053 2054 if (mutex_lock_interruptible(&frontend_mutex)) 2055 return -ERESTARTSYS; 2056 2057 fe->frontend_priv = kzalloc(sizeof(struct dvb_frontend_private), GFP_KERNEL); 2058 if (fe->frontend_priv == NULL) { 2059 mutex_unlock(&frontend_mutex); 2060 return -ENOMEM; 2061 } 2062 fepriv = fe->frontend_priv; 2063 2064 sema_init(&fepriv->sem, 1); 2065 init_waitqueue_head (&fepriv->wait_queue); 2066 init_waitqueue_head (&fepriv->events.wait_queue); 2067 mutex_init(&fepriv->events.mtx); 2068 fe->dvb = dvb; 2069 fepriv->inversion = INVERSION_OFF; 2070 2071 printk ("DVB: registering adapter %i frontend %i (%s)...\n", 2072 fe->dvb->num, 2073 fe->id, 2074 fe->ops.info.name); 2075 2076 dvb_register_device (fe->dvb, &fepriv->dvbdev, &dvbdev_template, 2077 fe, DVB_DEVICE_FRONTEND); 2078 2079 mutex_unlock(&frontend_mutex); 2080 return 0; 2081} 2082EXPORT_SYMBOL(dvb_register_frontend); 2083 2084int dvb_unregister_frontend(struct dvb_frontend* fe) 2085{ 2086 struct dvb_frontend_private *fepriv = fe->frontend_priv; 2087 dprintk ("%s\n", __func__); 2088 2089 mutex_lock(&frontend_mutex); 2090 dvb_frontend_stop (fe); 2091 mutex_unlock(&frontend_mutex); 2092 2093 if (fepriv->dvbdev->users < -1) 2094 wait_event(fepriv->dvbdev->wait_queue, 2095 fepriv->dvbdev->users==-1); 2096 2097 mutex_lock(&frontend_mutex); 2098 dvb_unregister_device (fepriv->dvbdev); 2099 2100 /* fe is invalid now */ 2101 kfree(fepriv); 2102 mutex_unlock(&frontend_mutex); 2103 return 0; 2104} 2105EXPORT_SYMBOL(dvb_unregister_frontend); 2106 2107#ifdef CONFIG_MEDIA_ATTACH 2108void dvb_frontend_detach(struct dvb_frontend* fe) 2109{ 2110 void *ptr; 2111 2112 if (fe->ops.release_sec) { 2113 fe->ops.release_sec(fe); 2114 symbol_put_addr(fe->ops.release_sec); 2115 } 2116 if (fe->ops.tuner_ops.release) { 2117 fe->ops.tuner_ops.release(fe); 2118 symbol_put_addr(fe->ops.tuner_ops.release); 2119 } 2120 if (fe->ops.analog_ops.release) { 2121 fe->ops.analog_ops.release(fe); 2122 symbol_put_addr(fe->ops.analog_ops.release); 2123 } 2124 ptr = (void*)fe->ops.release; 2125 if (ptr) { 2126 fe->ops.release(fe); 2127 symbol_put_addr(ptr); 2128 } 2129} 2130#else 2131void dvb_frontend_detach(struct dvb_frontend* fe) 2132{ 2133 if (fe->ops.release_sec) 2134 fe->ops.release_sec(fe); 2135 if (fe->ops.tuner_ops.release) 2136 fe->ops.tuner_ops.release(fe); 2137 if (fe->ops.analog_ops.release) 2138 fe->ops.analog_ops.release(fe); 2139 if (fe->ops.release) 2140 fe->ops.release(fe); 2141} 2142#endif 2143EXPORT_SYMBOL(dvb_frontend_detach);