dvb_frontend.c 59.7 KB
Newer Older
L
Linus Torvalds 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33
/*
 * dvb_frontend.c: DVB frontend tuning interface/thread
 *
 *
 * Copyright (C) 1999-2001 Ralph  Metzler
 *			   Marcus Metzler
 *			   Holger Waechtler
 *				      for convergence integrated media GmbH
 *
 * Copyright (C) 2004 Andrew de Quincey (tuning thread cleanup)
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
 */

#include <linux/string.h>
#include <linux/kernel.h>
#include <linux/sched.h>
#include <linux/wait.h>
#include <linux/slab.h>
#include <linux/poll.h>
34
#include <linux/semaphore.h>
L
Linus Torvalds 已提交
35 36
#include <linux/module.h>
#include <linux/list.h>
37
#include <linux/freezer.h>
38
#include <linux/jiffies.h>
39
#include <linux/kthread.h>
L
Linus Torvalds 已提交
40 41 42 43
#include <asm/processor.h>

#include "dvb_frontend.h"
#include "dvbdev.h"
44
#include <linux/dvb/version.h>
L
Linus Torvalds 已提交
45 46

static int dvb_frontend_debug;
47
static int dvb_shutdown_timeout;
L
Linus Torvalds 已提交
48 49 50
static int dvb_force_auto_inversion;
static int dvb_override_tune_delay;
static int dvb_powerdown_on_sleep = 1;
51
static int dvb_mfe_wait_time = 5;
L
Linus Torvalds 已提交
52 53

module_param_named(frontend_debug, dvb_frontend_debug, int, 0644);
54
MODULE_PARM_DESC(frontend_debug, "Turn on/off frontend core debugging (default:off).");
55
module_param(dvb_shutdown_timeout, int, 0644);
L
Linus Torvalds 已提交
56
MODULE_PARM_DESC(dvb_shutdown_timeout, "wait <shutdown_timeout> seconds after close() before suspending hardware");
57
module_param(dvb_force_auto_inversion, int, 0644);
L
Linus Torvalds 已提交
58
MODULE_PARM_DESC(dvb_force_auto_inversion, "0: normal (default), 1: INVERSION_AUTO forced always");
59
module_param(dvb_override_tune_delay, int, 0644);
L
Linus Torvalds 已提交
60
MODULE_PARM_DESC(dvb_override_tune_delay, "0: normal (default), >0 => delay in milliseconds to wait for lock after a tune attempt");
61
module_param(dvb_powerdown_on_sleep, int, 0644);
62
MODULE_PARM_DESC(dvb_powerdown_on_sleep, "0: do not power down, 1: turn LNB voltage off on sleep (default)");
63 64
module_param(dvb_mfe_wait_time, int, 0644);
MODULE_PARM_DESC(dvb_mfe_wait_time, "Wait up to <mfe_wait_time> seconds on open() for multi-frontend to become available (default:5 seconds)");
L
Linus Torvalds 已提交
65 66 67 68 69 70 71 72 73 74 75

#define dprintk if (dvb_frontend_debug) printk

#define FESTATE_IDLE 1
#define FESTATE_RETUNE 2
#define FESTATE_TUNING_FAST 4
#define FESTATE_TUNING_SLOW 8
#define FESTATE_TUNED 16
#define FESTATE_ZIGZAG_FAST 32
#define FESTATE_ZIGZAG_SLOW 64
#define FESTATE_DISEQC 128
76
#define FESTATE_ERROR 256
L
Linus Torvalds 已提交
77 78 79 80
#define FESTATE_WAITFORLOCK (FESTATE_TUNING_FAST | FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW | FESTATE_DISEQC)
#define FESTATE_SEARCHING_FAST (FESTATE_TUNING_FAST | FESTATE_ZIGZAG_FAST)
#define FESTATE_SEARCHING_SLOW (FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_SLOW)
#define FESTATE_LOSTLOCK (FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW)
81 82

#define FE_ALGO_HW		1
L
Linus Torvalds 已提交
83 84 85 86 87 88 89 90 91 92 93 94 95 96 97
/*
 * FESTATE_IDLE. No tuning parameters have been supplied and the loop is idling.
 * FESTATE_RETUNE. Parameters have been supplied, but we have not yet performed the first tune.
 * FESTATE_TUNING_FAST. Tuning parameters have been supplied and fast zigzag scan is in progress.
 * FESTATE_TUNING_SLOW. Tuning parameters have been supplied. Fast zigzag failed, so we're trying again, but slower.
 * FESTATE_TUNED. The frontend has successfully locked on.
 * FESTATE_ZIGZAG_FAST. The lock has been lost, and a fast zigzag has been initiated to try and regain it.
 * FESTATE_ZIGZAG_SLOW. The lock has been lost. Fast zigzag has been failed, so we're trying again, but slower.
 * FESTATE_DISEQC. A DISEQC command has just been issued.
 * FESTATE_WAITFORLOCK. When we're waiting for a lock.
 * FESTATE_SEARCHING_FAST. When we're searching for a signal using a fast zigzag scan.
 * FESTATE_SEARCHING_SLOW. When we're searching for a signal using a slow zigzag scan.
 * FESTATE_LOSTLOCK. When the lock has been lost, and we're searching it again.
 */

98 99 100 101
#define DVB_FE_NO_EXIT	0
#define DVB_FE_NORMAL_EXIT	1
#define DVB_FE_DEVICE_REMOVED	2

102
static DEFINE_MUTEX(frontend_mutex);
L
Linus Torvalds 已提交
103 104 105

struct dvb_frontend_private {

106
	/* thread/frontend values */
L
Linus Torvalds 已提交
107
	struct dvb_device *dvbdev;
108
	struct dvb_frontend_parameters parameters_in;
109
	struct dvb_frontend_parameters parameters_out;
L
Linus Torvalds 已提交
110 111 112 113
	struct dvb_fe_events events;
	struct semaphore sem;
	struct list_head list_head;
	wait_queue_head_t wait_queue;
114
	struct task_struct *thread;
L
Linus Torvalds 已提交
115
	unsigned long release_jiffies;
116 117
	unsigned int exit;
	unsigned int wakeup;
L
Linus Torvalds 已提交
118
	fe_status_t status;
119
	unsigned long tune_mode_flags;
120
	unsigned int delay;
121
	unsigned int reinitialise;
122 123
	int tone;
	int voltage;
124 125 126 127 128 129 130 131 132 133 134 135 136 137

	/* swzigzag values */
	unsigned int state;
	unsigned int bending;
	int lnb_drift;
	unsigned int inversion;
	unsigned int auto_step;
	unsigned int auto_sub_step;
	unsigned int started_auto_step;
	unsigned int min_delay;
	unsigned int max_drift;
	unsigned int step_size;
	int quality;
	unsigned int check_wrapped;
M
Manu Abraham 已提交
138
	enum dvbfe_search algo_status;
L
Linus Torvalds 已提交
139 140
};

141
static void dvb_frontend_wakeup(struct dvb_frontend *fe);
L
Linus Torvalds 已提交
142 143 144

static void dvb_frontend_add_event(struct dvb_frontend *fe, fe_status_t status)
{
145
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
146 147 148 149
	struct dvb_fe_events *events = &fepriv->events;
	struct dvb_frontend_event *e;
	int wp;

150
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
151

152
	if (mutex_lock_interruptible (&events->mtx))
L
Linus Torvalds 已提交
153 154 155 156 157 158 159 160 161 162 163 164
		return;

	wp = (events->eventw + 1) % MAX_EVENT;

	if (wp == events->eventr) {
		events->overflow = 1;
		events->eventr = (events->eventr + 1) % MAX_EVENT;
	}

	e = &events->events[events->eventw];

	if (status & FE_HAS_LOCK)
165
		if (fe->ops.get_frontend)
166 167 168
			fe->ops.get_frontend(fe, &fepriv->parameters_out);

	e->parameters = fepriv->parameters_out;
L
Linus Torvalds 已提交
169 170 171

	events->eventw = wp;

172
	mutex_unlock(&events->mtx);
L
Linus Torvalds 已提交
173 174 175 176 177 178 179 180 181

	e->status = status;

	wake_up_interruptible (&events->wait_queue);
}

static int dvb_frontend_get_event(struct dvb_frontend *fe,
			    struct dvb_frontend_event *event, int flags)
{
182
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
183 184
	struct dvb_fe_events *events = &fepriv->events;

185
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209

	if (events->overflow) {
		events->overflow = 0;
		return -EOVERFLOW;
	}

	if (events->eventw == events->eventr) {
		int ret;

		if (flags & O_NONBLOCK)
			return -EWOULDBLOCK;

		up(&fepriv->sem);

		ret = wait_event_interruptible (events->wait_queue,
						events->eventw != events->eventr);

		if (down_interruptible (&fepriv->sem))
			return -ERESTARTSYS;

		if (ret < 0)
			return ret;
	}

210
	if (mutex_lock_interruptible (&events->mtx))
L
Linus Torvalds 已提交
211 212 213 214 215 216 217
		return -ERESTARTSYS;

	memcpy (event, &events->events[events->eventr],
		sizeof(struct dvb_frontend_event));

	events->eventr = (events->eventr + 1) % MAX_EVENT;

218
	mutex_unlock(&events->mtx);
L
Linus Torvalds 已提交
219 220 221 222 223 224

	return 0;
}

static void dvb_frontend_init(struct dvb_frontend *fe)
{
225
	dprintk ("DVB: initialising adapter %i frontend %i (%s)...\n",
L
Linus Torvalds 已提交
226
		 fe->dvb->num,
227
		 fe->id,
228 229 230 231 232
		 fe->ops.info.name);

	if (fe->ops.init)
		fe->ops.init(fe);
	if (fe->ops.tuner_ops.init) {
233 234
		if (fe->ops.i2c_gate_ctrl)
			fe->ops.i2c_gate_ctrl(fe, 1);
235 236 237
		fe->ops.tuner_ops.init(fe);
		if (fe->ops.i2c_gate_ctrl)
			fe->ops.i2c_gate_ctrl(fe, 0);
238
	}
L
Linus Torvalds 已提交
239 240
}

241 242 243 244 245 246 247 248 249
void dvb_frontend_reinitialise(struct dvb_frontend *fe)
{
	struct dvb_frontend_private *fepriv = fe->frontend_priv;

	fepriv->reinitialise = 1;
	dvb_frontend_wakeup(fe);
}
EXPORT_SYMBOL(dvb_frontend_reinitialise);

250
static void dvb_frontend_swzigzag_update_delay(struct dvb_frontend_private *fepriv, int locked)
L
Linus Torvalds 已提交
251
{
252
	int q2;
L
Linus Torvalds 已提交
253

254
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
255

256 257 258 259
	if (locked)
		(fepriv->quality) = (fepriv->quality * 220 + 36*256) / 256;
	else
		(fepriv->quality) = (fepriv->quality * 220 + 0) / 256;
L
Linus Torvalds 已提交
260

261 262
	q2 = fepriv->quality - 128;
	q2 *= q2;
L
Linus Torvalds 已提交
263

264
	fepriv->delay = fepriv->min_delay + q2 * HZ / (128*128);
L
Linus Torvalds 已提交
265 266 267 268 269 270 271 272 273
}

/**
 * Performs automatic twiddling of frontend parameters.
 *
 * @param fe The frontend concerned.
 * @param check_wrapped Checks if an iteration has completed. DO NOT SET ON THE FIRST ATTEMPT
 * @returns Number of complete iterations that have been performed.
 */
274
static int dvb_frontend_swzigzag_autotune(struct dvb_frontend *fe, int check_wrapped)
L
Linus Torvalds 已提交
275 276 277
{
	int autoinversion;
	int ready = 0;
278
	int fe_set_err = 0;
279
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
280 281
	int original_inversion = fepriv->parameters_in.inversion;
	u32 original_frequency = fepriv->parameters_in.frequency;
L
Linus Torvalds 已提交
282 283

	/* are we using autoinversion? */
284
	autoinversion = ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) &&
285
			 (fepriv->parameters_in.inversion == INVERSION_AUTO));
L
Linus Torvalds 已提交
286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346

	/* setup parameters correctly */
	while(!ready) {
		/* calculate the lnb_drift */
		fepriv->lnb_drift = fepriv->auto_step * fepriv->step_size;

		/* wrap the auto_step if we've exceeded the maximum drift */
		if (fepriv->lnb_drift > fepriv->max_drift) {
			fepriv->auto_step = 0;
			fepriv->auto_sub_step = 0;
			fepriv->lnb_drift = 0;
		}

		/* perform inversion and +/- zigzag */
		switch(fepriv->auto_sub_step) {
		case 0:
			/* try with the current inversion and current drift setting */
			ready = 1;
			break;

		case 1:
			if (!autoinversion) break;

			fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF;
			ready = 1;
			break;

		case 2:
			if (fepriv->lnb_drift == 0) break;

			fepriv->lnb_drift = -fepriv->lnb_drift;
			ready = 1;
			break;

		case 3:
			if (fepriv->lnb_drift == 0) break;
			if (!autoinversion) break;

			fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF;
			fepriv->lnb_drift = -fepriv->lnb_drift;
			ready = 1;
			break;

		default:
			fepriv->auto_step++;
			fepriv->auto_sub_step = -1; /* it'll be incremented to 0 in a moment */
			break;
		}

		if (!ready) fepriv->auto_sub_step++;
	}

	/* if this attempt would hit where we started, indicate a complete
	 * iteration has occurred */
	if ((fepriv->auto_step == fepriv->started_auto_step) &&
	    (fepriv->auto_sub_step == 0) && check_wrapped) {
		return 1;
	}

	dprintk("%s: drift:%i inversion:%i auto_step:%i "
		"auto_sub_step:%i started_auto_step:%i\n",
347
		__func__, fepriv->lnb_drift, fepriv->inversion,
L
Linus Torvalds 已提交
348 349 350
		fepriv->auto_step, fepriv->auto_sub_step, fepriv->started_auto_step);

	/* set the frontend itself */
351
	fepriv->parameters_in.frequency += fepriv->lnb_drift;
L
Linus Torvalds 已提交
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 358 359 360
	if (fe_set_err < 0) {
		fepriv->state = FESTATE_ERROR;
		return fe_set_err;
	}
L
Linus Torvalds 已提交
361

362 363
	fepriv->parameters_in.frequency = original_frequency;
	fepriv->parameters_in.inversion = original_inversion;
L
Linus Torvalds 已提交
364 365 366 367 368

	fepriv->auto_sub_step++;
	return 0;
}

369 370
static void dvb_frontend_swzigzag(struct dvb_frontend *fe)
{
371
	fe_status_t s = 0;
372
	int retval = 0;
373 374 375 376 377 378 379 380 381 382 383 384
	struct dvb_frontend_private *fepriv = fe->frontend_priv;

	/* if we've got no parameters, just keep idling */
	if (fepriv->state & FESTATE_IDLE) {
		fepriv->delay = 3*HZ;
		fepriv->quality = 0;
		return;
	}

	/* in SCAN mode, we just set the frontend when asked and leave it alone */
	if (fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT) {
		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 390 391 392
			if (retval < 0)
				fepriv->state = FESTATE_ERROR;
			else
				fepriv->state = FESTATE_TUNED;
393 394 395 396 397 398 399 400 401 402
		}
		fepriv->delay = 3*HZ;
		fepriv->quality = 0;
		return;
	}

	/* get the frontend status */
	if (fepriv->state & FESTATE_RETUNE) {
		s = 0;
	} else {
403 404
		if (fe->ops.read_status)
			fe->ops.read_status(fe, &s);
405 406 407 408 409 410 411 412 413 414 415 416
		if (s != fepriv->status) {
			dvb_frontend_add_event(fe, s);
			fepriv->status = s;
		}
	}

	/* if we're not tuned, and we have a lock, move to the TUNED state */
	if ((fepriv->state & FESTATE_WAITFORLOCK) && (s & FE_HAS_LOCK)) {
		dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
		fepriv->state = FESTATE_TUNED;

		/* if we're tuned, then we have determined the correct inversion */
417
		if ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) &&
418 419
		    (fepriv->parameters_in.inversion == INVERSION_AUTO)) {
			fepriv->parameters_in.inversion = fepriv->inversion;
420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440
		}
		return;
	}

	/* if we are tuned already, check we're still locked */
	if (fepriv->state & FESTATE_TUNED) {
		dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);

		/* we're tuned, and the lock is still good... */
		if (s & FE_HAS_LOCK) {
			return;
		} else { /* if we _WERE_ tuned, but now don't have a lock */
			fepriv->state = FESTATE_ZIGZAG_FAST;
			fepriv->started_auto_step = fepriv->auto_step;
			fepriv->check_wrapped = 0;
		}
	}

	/* don't actually do anything if we're in the LOSTLOCK state,
	 * the frontend is set to FE_CAN_RECOVER, and the max_drift is 0 */
	if ((fepriv->state & FESTATE_LOSTLOCK) &&
441
	    (fe->ops.info.caps & FE_CAN_RECOVER) && (fepriv->max_drift == 0)) {
442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468
		dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
		return;
	}

	/* don't do anything if we're in the DISEQC state, since this
	 * might be someone with a motorized dish controlled by DISEQC.
	 * If its actually a re-tune, there will be a SET_FRONTEND soon enough.	*/
	if (fepriv->state & FESTATE_DISEQC) {
		dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
		return;
	}

	/* if we're in the RETUNE state, set everything up for a brand
	 * new scan, keeping the current inversion setting, as the next
	 * tune is _very_ likely to require the same */
	if (fepriv->state & FESTATE_RETUNE) {
		fepriv->lnb_drift = 0;
		fepriv->auto_step = 0;
		fepriv->auto_sub_step = 0;
		fepriv->started_auto_step = 0;
		fepriv->check_wrapped = 0;
	}

	/* fast zigzag. */
	if ((fepriv->state & FESTATE_SEARCHING_FAST) || (fepriv->state & FESTATE_RETUNE)) {
		fepriv->delay = fepriv->min_delay;

469
		/* perform a tune */
470 471 472 473 474
		retval = dvb_frontend_swzigzag_autotune(fe,
							fepriv->check_wrapped);
		if (retval < 0) {
			return;
		} else if (retval) {
475 476 477 478 479 480 481 482 483 484 485 486 487 488 489 490 491 492 493 494 495 496 497 498 499 500 501
			/* OK, if we've run out of trials at the fast speed.
			 * Drop back to slow for the _next_ attempt */
			fepriv->state = FESTATE_SEARCHING_SLOW;
			fepriv->started_auto_step = fepriv->auto_step;
			return;
		}
		fepriv->check_wrapped = 1;

		/* if we've just retuned, enter the ZIGZAG_FAST state.
		 * This ensures we cannot return from an
		 * FE_SET_FRONTEND ioctl before the first frontend tune
		 * occurs */
		if (fepriv->state & FESTATE_RETUNE) {
			fepriv->state = FESTATE_TUNING_FAST;
		}
	}

	/* slow zigzag */
	if (fepriv->state & FESTATE_SEARCHING_SLOW) {
		dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);

		/* Note: don't bother checking for wrapping; we stay in this
		 * state until we get a lock */
		dvb_frontend_swzigzag_autotune(fe, 0);
	}
}

L
Linus Torvalds 已提交
502 503
static int dvb_frontend_is_exiting(struct dvb_frontend *fe)
{
504
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
505

506
	if (fepriv->exit != DVB_FE_NO_EXIT)
L
Linus Torvalds 已提交
507 508 509
		return 1;

	if (fepriv->dvbdev->writers == 1)
510
		if (time_after(jiffies, fepriv->release_jiffies +
511
				  dvb_shutdown_timeout * HZ))
L
Linus Torvalds 已提交
512 513 514 515 516 517 518
			return 1;

	return 0;
}

static int dvb_frontend_should_wakeup(struct dvb_frontend *fe)
{
519
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
520 521 522 523 524 525 526 527 528 529

	if (fepriv->wakeup) {
		fepriv->wakeup = 0;
		return 1;
	}
	return dvb_frontend_is_exiting(fe);
}

static void dvb_frontend_wakeup(struct dvb_frontend *fe)
{
530
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
531 532 533 534 535 536 537

	fepriv->wakeup = 1;
	wake_up_interruptible(&fepriv->wait_queue);
}

static int dvb_frontend_thread(void *data)
{
538 539
	struct dvb_frontend *fe = data;
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
540 541
	unsigned long timeout;
	fe_status_t s;
M
Manu Abraham 已提交
542 543
	enum dvbfe_algo algo;

544
	struct dvb_frontend_parameters *params;
L
Linus Torvalds 已提交
545

546
	dprintk("%s\n", __func__);
L
Linus Torvalds 已提交
547

548 549 550
	fepriv->check_wrapped = 0;
	fepriv->quality = 0;
	fepriv->delay = 3*HZ;
L
Linus Torvalds 已提交
551 552
	fepriv->status = 0;
	fepriv->wakeup = 0;
553 554 555
	fepriv->reinitialise = 0;

	dvb_frontend_init(fe);
L
Linus Torvalds 已提交
556

557
	set_freezable();
L
Linus Torvalds 已提交
558 559
	while (1) {
		up(&fepriv->sem);	    /* is locked when we enter the thread... */
560
restart:
L
Linus Torvalds 已提交
561
		timeout = wait_event_interruptible_timeout(fepriv->wait_queue,
562 563
			dvb_frontend_should_wakeup(fe) || kthread_should_stop()
				|| freezing(current),
564 565 566
			fepriv->delay);

		if (kthread_should_stop() || dvb_frontend_is_exiting(fe)) {
L
Linus Torvalds 已提交
567
			/* got signal or quitting */
568
			fepriv->exit = DVB_FE_NORMAL_EXIT;
L
Linus Torvalds 已提交
569 570 571
			break;
		}

572
		if (try_to_freeze())
573
			goto restart;
L
Linus Torvalds 已提交
574 575 576 577

		if (down_interruptible(&fepriv->sem))
			break;

578 579
		if (fepriv->reinitialise) {
			dvb_frontend_init(fe);
580
			if (fepriv->tone != -1) {
581
				fe->ops.set_tone(fe, fepriv->tone);
582 583
			}
			if (fepriv->voltage != -1) {
584
				fe->ops.set_voltage(fe, fepriv->voltage);
585
			}
586 587 588
			fepriv->reinitialise = 0;
		}

589
		/* do an iteration of the tuning loop */
590
		if (fe->ops.get_frontend_algo) {
M
Manu Abraham 已提交
591 592 593 594 595 596
			algo = fe->ops.get_frontend_algo(fe);
			switch (algo) {
			case DVBFE_ALGO_HW:
				dprintk("%s: Frontend ALGO = DVBFE_ALGO_HW\n", __func__);
				params = NULL; /* have we been asked to RETUNE ? */

597
				if (fepriv->state & FESTATE_RETUNE) {
M
Manu Abraham 已提交
598
					dprintk("%s: Retune requested, FESTATE_RETUNE\n", __func__);
599
					params = &fepriv->parameters_in;
600 601 602
					fepriv->state = FESTATE_TUNED;
				}

M
Manu Abraham 已提交
603 604
				if (fe->ops.tune)
					fe->ops.tune(fe, params, fepriv->tune_mode_flags, &fepriv->delay, &s);
605 606
				if (params)
					fepriv->parameters_out = *params;
M
Manu Abraham 已提交
607

608
				if (s != fepriv->status && !(fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT)) {
M
Manu Abraham 已提交
609
					dprintk("%s: state changed, adding current state\n", __func__);
610 611 612
					dvb_frontend_add_event(fe, s);
					fepriv->status = s;
				}
M
Manu Abraham 已提交
613 614 615
				break;
			case DVBFE_ALGO_SW:
				dprintk("%s: Frontend ALGO = DVBFE_ALGO_SW\n", __func__);
616
				dvb_frontend_swzigzag(fe);
M
Manu Abraham 已提交
617 618 619 620 621 622 623 624 625 626 627 628
				break;
			case DVBFE_ALGO_CUSTOM:
				dprintk("%s: Frontend ALGO = DVBFE_ALGO_CUSTOM, state=%d\n", __func__, fepriv->state);
				if (fepriv->state & FESTATE_RETUNE) {
					dprintk("%s: Retune requested, FESTAT_RETUNE\n", __func__);
					fepriv->state = FESTATE_TUNED;
				}
				/* Case where we are going to search for a carrier
				 * User asked us to retune again for some reason, possibly
				 * requesting a search with a new set of parameters
				 */
				if (fepriv->algo_status & DVBFE_ALGO_SEARCH_AGAIN) {
629
					if (fe->ops.search) {
630
						fepriv->algo_status = fe->ops.search(fe, &fepriv->parameters_in);
M
Manu Abraham 已提交
631 632 633
						/* We did do a search as was requested, the flags are
						 * now unset as well and has the flags wrt to search.
						 */
634 635 636
					} else {
						fepriv->algo_status &= ~DVBFE_ALGO_SEARCH_AGAIN;
					}
M
Manu Abraham 已提交
637 638 639 640
				}
				/* Track the carrier if the search was successful */
				if (fepriv->algo_status == DVBFE_ALGO_SEARCH_SUCCESS) {
					if (fe->ops.track)
641
						fe->ops.track(fe, &fepriv->parameters_in);
642 643 644 645
				} else {
					fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN;
					fepriv->delay = HZ / 2;
				}
646
				fepriv->parameters_out = fepriv->parameters_in;
647 648 649 650 651 652 653 654 655 656
				fe->ops.read_status(fe, &s);
				if (s != fepriv->status) {
					dvb_frontend_add_event(fe, s); /* update event list */
					fepriv->status = s;
					if (!(s & FE_HAS_LOCK)) {
						fepriv->delay = HZ / 10;
						fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN;
					} else {
						fepriv->delay = 60 * HZ;
					}
M
Manu Abraham 已提交
657 658 659 660 661 662 663
				}
				break;
			default:
				dprintk("%s: UNDEFINED ALGO !\n", __func__);
				break;
			}
		} else {
664
			dvb_frontend_swzigzag(fe);
M
Manu Abraham 已提交
665
		}
L
Linus Torvalds 已提交
666 667
	}

668 669 670
	if (dvb_powerdown_on_sleep) {
		if (fe->ops.set_voltage)
			fe->ops.set_voltage(fe, SEC_VOLTAGE_OFF);
671
		if (fe->ops.tuner_ops.sleep) {
672 673
			if (fe->ops.i2c_gate_ctrl)
				fe->ops.i2c_gate_ctrl(fe, 1);
674 675 676
			fe->ops.tuner_ops.sleep(fe);
			if (fe->ops.i2c_gate_ctrl)
				fe->ops.i2c_gate_ctrl(fe, 0);
677
		}
678 679
		if (fe->ops.sleep)
			fe->ops.sleep(fe);
L
Linus Torvalds 已提交
680 681
	}

682
	fepriv->thread = NULL;
683 684 685 686
	if (kthread_should_stop())
		fepriv->exit = DVB_FE_DEVICE_REMOVED;
	else
		fepriv->exit = DVB_FE_NO_EXIT;
L
Linus Torvalds 已提交
687 688 689 690 691 692 693 694
	mb();

	dvb_frontend_wakeup(fe);
	return 0;
}

static void dvb_frontend_stop(struct dvb_frontend *fe)
{
695
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
696

697
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
698

699
	fepriv->exit = DVB_FE_NORMAL_EXIT;
L
Linus Torvalds 已提交
700 701
	mb();

702
	if (!fepriv->thread)
L
Linus Torvalds 已提交
703 704
		return;

705
	kthread_stop(fepriv->thread);
706

707
	sema_init(&fepriv->sem, 1);
L
Linus Torvalds 已提交
708 709 710
	fepriv->state = FESTATE_IDLE;

	/* paranoia check in case a signal arrived */
711 712 713
	if (fepriv->thread)
		printk("dvb_frontend_stop: warning: thread %p won't exit\n",
				fepriv->thread);
L
Linus Torvalds 已提交
714 715
}

716 717 718 719 720 721 722 723 724 725 726 727 728 729 730 731 732 733 734 735 736 737 738 739 740 741 742 743 744 745 746 747 748 749 750 751 752 753 754 755 756 757 758
s32 timeval_usec_diff(struct timeval lasttime, struct timeval curtime)
{
	return ((curtime.tv_usec < lasttime.tv_usec) ?
		1000000 - lasttime.tv_usec + curtime.tv_usec :
		curtime.tv_usec - lasttime.tv_usec);
}
EXPORT_SYMBOL(timeval_usec_diff);

static inline void timeval_usec_add(struct timeval *curtime, u32 add_usec)
{
	curtime->tv_usec += add_usec;
	if (curtime->tv_usec >= 1000000) {
		curtime->tv_usec -= 1000000;
		curtime->tv_sec++;
	}
}

/*
 * Sleep until gettimeofday() > waketime + add_usec
 * This needs to be as precise as possible, but as the delay is
 * usually between 2ms and 32ms, it is done using a scheduled msleep
 * followed by usleep (normally a busy-wait loop) for the remainder
 */
void dvb_frontend_sleep_until(struct timeval *waketime, u32 add_usec)
{
	struct timeval lasttime;
	s32 delta, newdelta;

	timeval_usec_add(waketime, add_usec);

	do_gettimeofday(&lasttime);
	delta = timeval_usec_diff(lasttime, *waketime);
	if (delta > 2500) {
		msleep((delta - 1500) / 1000);
		do_gettimeofday(&lasttime);
		newdelta = timeval_usec_diff(lasttime, *waketime);
		delta = (newdelta > delta) ? 0 : newdelta;
	}
	if (delta > 0)
		udelay(delta);
}
EXPORT_SYMBOL(dvb_frontend_sleep_until);

L
Linus Torvalds 已提交
759 760 761
static int dvb_frontend_start(struct dvb_frontend *fe)
{
	int ret;
762
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
763
	struct task_struct *fe_thread;
L
Linus Torvalds 已提交
764

765
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
766

767
	if (fepriv->thread) {
768
		if (fepriv->exit == DVB_FE_NO_EXIT)
L
Linus Torvalds 已提交
769 770 771 772 773 774 775 776 777 778 779
			return 0;
		else
			dvb_frontend_stop (fe);
	}

	if (signal_pending(current))
		return -EINTR;
	if (down_interruptible (&fepriv->sem))
		return -EINTR;

	fepriv->state = FESTATE_IDLE;
780
	fepriv->exit = DVB_FE_NO_EXIT;
781
	fepriv->thread = NULL;
L
Linus Torvalds 已提交
782 783
	mb();

784
	fe_thread = kthread_run(dvb_frontend_thread, fe,
785
		"kdvb-ad-%i-fe-%i", fe->dvb->num,fe->id);
786 787 788
	if (IS_ERR(fe_thread)) {
		ret = PTR_ERR(fe_thread);
		printk("dvb_frontend_start: failed to start kthread (%d)\n", ret);
L
Linus Torvalds 已提交
789 790 791
		up(&fepriv->sem);
		return ret;
	}
792
	fepriv->thread = fe_thread;
L
Linus Torvalds 已提交
793 794 795
	return 0;
}

796
static void dvb_frontend_get_frequency_limits(struct dvb_frontend *fe,
797 798 799 800 801 802 803 804 805 806 807 808
					u32 *freq_min, u32 *freq_max)
{
	*freq_min = max(fe->ops.info.frequency_min, fe->ops.tuner_ops.info.frequency_min);

	if (fe->ops.info.frequency_max == 0)
		*freq_max = fe->ops.tuner_ops.info.frequency_max;
	else if (fe->ops.tuner_ops.info.frequency_max == 0)
		*freq_max = fe->ops.info.frequency_max;
	else
		*freq_max = min(fe->ops.info.frequency_max, fe->ops.tuner_ops.info.frequency_max);

	if (*freq_min == 0 || *freq_max == 0)
809 810
		printk(KERN_WARNING "DVB: adapter %i frontend %u frequency limits undefined - fix the driver\n",
		       fe->dvb->num,fe->id);
811 812
}

813 814 815
static int dvb_frontend_check_parameters(struct dvb_frontend *fe,
				struct dvb_frontend_parameters *parms)
{
816 817 818
	u32 freq_min;
	u32 freq_max;

819
	/* range check: frequency */
820
	dvb_frontend_get_frequency_limits(fe, &freq_min, &freq_max);
821 822
	if ((freq_min && parms->frequency < freq_min) ||
	    (freq_max && parms->frequency > freq_max)) {
823 824
		printk(KERN_WARNING "DVB: adapter %i frontend %i frequency %u out of range (%u..%u)\n",
		       fe->dvb->num, fe->id, parms->frequency, freq_min, freq_max);
825 826 827 828 829 830 831 832 833
		return -EINVAL;
	}

	/* range check: symbol rate */
	if (fe->ops.info.type == FE_QPSK) {
		if ((fe->ops.info.symbol_rate_min &&
		     parms->u.qpsk.symbol_rate < fe->ops.info.symbol_rate_min) ||
		    (fe->ops.info.symbol_rate_max &&
		     parms->u.qpsk.symbol_rate > fe->ops.info.symbol_rate_max)) {
834 835
			printk(KERN_WARNING "DVB: adapter %i frontend %i symbol rate %u out of range (%u..%u)\n",
			       fe->dvb->num, fe->id, parms->u.qpsk.symbol_rate,
836 837 838 839 840 841 842 843 844
			       fe->ops.info.symbol_rate_min, fe->ops.info.symbol_rate_max);
			return -EINVAL;
		}

	} else if (fe->ops.info.type == FE_QAM) {
		if ((fe->ops.info.symbol_rate_min &&
		     parms->u.qam.symbol_rate < fe->ops.info.symbol_rate_min) ||
		    (fe->ops.info.symbol_rate_max &&
		     parms->u.qam.symbol_rate > fe->ops.info.symbol_rate_max)) {
845 846
			printk(KERN_WARNING "DVB: adapter %i frontend %i symbol rate %u out of range (%u..%u)\n",
			       fe->dvb->num, fe->id, parms->u.qam.symbol_rate,
847 848 849 850 851
			       fe->ops.info.symbol_rate_min, fe->ops.info.symbol_rate_max);
			return -EINVAL;
		}
	}

852 853 854 855 856 857 858 859 860
	/* check for supported modulation */
	if (fe->ops.info.type == FE_QAM &&
	    (parms->u.qam.modulation > QAM_AUTO ||
	     !((1 << (parms->u.qam.modulation + 10)) & fe->ops.info.caps))) {
		printk(KERN_WARNING "DVB: adapter %i frontend %i modulation %u not supported\n",
		       fe->dvb->num, fe->id, parms->u.qam.modulation);
			return -EINVAL;
	}

861 862 863
	return 0;
}

864 865
static int dvb_frontend_clear_cache(struct dvb_frontend *fe)
{
866
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
867 868
	int i;

869 870 871 872 873 874 875 876 877 878 879 880 881 882 883 884 885 886 887 888
	memset(c, 0, sizeof(struct dtv_frontend_properties));

	c->state = DTV_CLEAR;
	c->delivery_system = SYS_UNDEFINED;
	c->inversion = INVERSION_AUTO;
	c->fec_inner = FEC_AUTO;
	c->transmission_mode = TRANSMISSION_MODE_AUTO;
	c->bandwidth_hz = BANDWIDTH_AUTO;
	c->guard_interval = GUARD_INTERVAL_AUTO;
	c->hierarchy = HIERARCHY_AUTO;
	c->symbol_rate = QAM_AUTO;
	c->code_rate_HP = FEC_AUTO;
	c->code_rate_LP = FEC_AUTO;

	c->isdbt_partial_reception = -1;
	c->isdbt_sb_mode = -1;
	c->isdbt_sb_subchannel = -1;
	c->isdbt_sb_segment_idx = -1;
	c->isdbt_sb_segment_count = -1;
	c->isdbt_layer_enabled = 0x7;
889
	for (i = 0; i < 3; i++) {
890 891 892 893
		c->layer[i].fec = FEC_AUTO;
		c->layer[i].modulation = QAM_AUTO;
		c->layer[i].interleaving = -1;
		c->layer[i].segment_count = -1;
894 895 896 897 898 899 900 901 902 903 904 905 906
	}

	return 0;
}

#define _DTV_CMD(n, s, b) \
[n] = { \
	.name = #n, \
	.cmd  = n, \
	.set  = s,\
	.buffer = b \
}

907
static struct dtv_cmds_h dtv_cmds[DTV_MAX_COMMAND + 1] = {
908 909
	_DTV_CMD(DTV_TUNE, 1, 0),
	_DTV_CMD(DTV_CLEAR, 1, 0),
910 911

	/* Set */
912 913 914 915 916 917 918 919 920 921 922 923 924 925 926 927 928
	_DTV_CMD(DTV_FREQUENCY, 1, 0),
	_DTV_CMD(DTV_BANDWIDTH_HZ, 1, 0),
	_DTV_CMD(DTV_MODULATION, 1, 0),
	_DTV_CMD(DTV_INVERSION, 1, 0),
	_DTV_CMD(DTV_DISEQC_MASTER, 1, 1),
	_DTV_CMD(DTV_SYMBOL_RATE, 1, 0),
	_DTV_CMD(DTV_INNER_FEC, 1, 0),
	_DTV_CMD(DTV_VOLTAGE, 1, 0),
	_DTV_CMD(DTV_TONE, 1, 0),
	_DTV_CMD(DTV_PILOT, 1, 0),
	_DTV_CMD(DTV_ROLLOFF, 1, 0),
	_DTV_CMD(DTV_DELIVERY_SYSTEM, 1, 0),
	_DTV_CMD(DTV_HIERARCHY, 1, 0),
	_DTV_CMD(DTV_CODE_RATE_HP, 1, 0),
	_DTV_CMD(DTV_CODE_RATE_LP, 1, 0),
	_DTV_CMD(DTV_GUARD_INTERVAL, 1, 0),
	_DTV_CMD(DTV_TRANSMISSION_MODE, 1, 0),
929 930 931 932 933 934

	_DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 1, 0),
	_DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 1, 0),
	_DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 1, 0),
	_DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 1, 0),
	_DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 1, 0),
935
	_DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 1, 0),
936 937 938 939 940 941 942 943 944 945 946 947 948 949 950 951 952 953
	_DTV_CMD(DTV_ISDBT_LAYERA_FEC, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_FEC, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_FEC, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 1, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 1, 0),

	_DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 0, 0),
	_DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 0, 0),
	_DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 0, 0),
	_DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 0, 0),
	_DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 0, 0),
954
	_DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 0, 0),
955 956 957 958 959 960 961 962 963 964 965 966 967
	_DTV_CMD(DTV_ISDBT_LAYERA_FEC, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_FEC, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_FEC, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 0, 0),
	_DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 0, 0),

968
	_DTV_CMD(DTV_ISDBS_TS_ID, 1, 0),
969
	_DTV_CMD(DTV_DVBT2_PLP_ID, 1, 0),
970

971
	/* Get */
972 973 974 975 976 977 978
	_DTV_CMD(DTV_DISEQC_SLAVE_REPLY, 0, 1),
	_DTV_CMD(DTV_API_VERSION, 0, 0),
	_DTV_CMD(DTV_CODE_RATE_HP, 0, 0),
	_DTV_CMD(DTV_CODE_RATE_LP, 0, 0),
	_DTV_CMD(DTV_GUARD_INTERVAL, 0, 0),
	_DTV_CMD(DTV_TRANSMISSION_MODE, 0, 0),
	_DTV_CMD(DTV_HIERARCHY, 0, 0),
979 980
};

981
static void dtv_property_dump(struct dtv_property *tvp)
982 983 984
{
	int i;

985
	if (tvp->cmd <= 0 || tvp->cmd > DTV_MAX_COMMAND) {
986
		printk(KERN_WARNING "%s: tvp.cmd = 0x%08x undefined\n",
987 988 989 990
			__func__, tvp->cmd);
		return;
	}

991 992
	dprintk("%s() tvp.cmd    = 0x%08x (%s)\n"
		,__func__
993
		,tvp->cmd
994
		,dtv_cmds[ tvp->cmd ].name);
995

996
	if(dtv_cmds[ tvp->cmd ].buffer) {
997

998 999
		dprintk("%s() tvp.u.buffer.len = 0x%02x\n"
			,__func__
1000 1001 1002
			,tvp->u.buffer.len);

		for(i = 0; i < tvp->u.buffer.len; i++)
1003 1004
			dprintk("%s() tvp.u.buffer.data[0x%02x] = 0x%02x\n"
				,__func__
1005 1006 1007 1008
				,i
				,tvp->u.buffer.data[i]);

	} else
1009
		dprintk("%s() tvp.u.data = 0x%08x\n", __func__, tvp->u.data);
1010 1011
}

1012
static int is_legacy_delivery_system(fe_delivery_system_t s)
1013 1014
{
	if((s == SYS_UNDEFINED) || (s == SYS_DVBC_ANNEX_AC) ||
1015 1016
	   (s == SYS_DVBC_ANNEX_B) || (s == SYS_DVBT) || (s == SYS_DVBS) ||
	   (s == SYS_ATSC))
1017 1018 1019 1020 1021
		return 1;

	return 0;
}

1022 1023 1024 1025
/* Synchronise the legacy tuning parameters into the cache, so that demodulator
 * drivers can use a single set_frontend tuning function, regardless of whether
 * it's being used for the legacy or new API, reducing code and complexity.
 */
1026
static void dtv_property_cache_sync(struct dvb_frontend *fe,
1027 1028
				    struct dtv_frontend_properties *c,
				    const struct dvb_frontend_parameters *p)
1029 1030 1031 1032 1033 1034
{
	c->frequency = p->frequency;
	c->inversion = p->inversion;

	switch (fe->ops.info.type) {
	case FE_QPSK:
1035 1036
		c->modulation = QPSK;   /* implied for DVB-S in legacy API */
		c->rolloff = ROLLOFF_35;/* implied for DVB-S */
1037 1038
		c->symbol_rate = p->u.qpsk.symbol_rate;
		c->fec_inner = p->u.qpsk.fec_inner;
1039
		c->delivery_system = SYS_DVBS;
1040 1041 1042 1043 1044
		break;
	case FE_QAM:
		c->symbol_rate = p->u.qam.symbol_rate;
		c->fec_inner = p->u.qam.fec_inner;
		c->modulation = p->u.qam.modulation;
1045
		c->delivery_system = SYS_DVBC_ANNEX_AC;
1046 1047
		break;
	case FE_OFDM:
1048 1049 1050 1051 1052 1053 1054 1055 1056
		if (p->u.ofdm.bandwidth == BANDWIDTH_6_MHZ)
			c->bandwidth_hz = 6000000;
		else if (p->u.ofdm.bandwidth == BANDWIDTH_7_MHZ)
			c->bandwidth_hz = 7000000;
		else if (p->u.ofdm.bandwidth == BANDWIDTH_8_MHZ)
			c->bandwidth_hz = 8000000;
		else
			/* Including BANDWIDTH_AUTO */
			c->bandwidth_hz = 0;
1057 1058 1059 1060 1061 1062
		c->code_rate_HP = p->u.ofdm.code_rate_HP;
		c->code_rate_LP = p->u.ofdm.code_rate_LP;
		c->modulation = p->u.ofdm.constellation;
		c->transmission_mode = p->u.ofdm.transmission_mode;
		c->guard_interval = p->u.ofdm.guard_interval;
		c->hierarchy = p->u.ofdm.hierarchy_information;
1063
		c->delivery_system = SYS_DVBT;
1064 1065 1066
		break;
	case FE_ATSC:
		c->modulation = p->u.vsb.modulation;
1067 1068 1069 1070
		if ((c->modulation == VSB_8) || (c->modulation == VSB_16))
			c->delivery_system = SYS_ATSC;
		else
			c->delivery_system = SYS_DVBC_ANNEX_B;
1071 1072 1073 1074
		break;
	}
}

1075 1076 1077
/* Ensure the cached values are set correctly in the frontend
 * legacy tuning structures, for the advanced tuning API.
 */
1078
static void dtv_property_legacy_params_sync(struct dvb_frontend *fe)
1079
{
1080
	const struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1081
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
1082
	struct dvb_frontend_parameters *p = &fepriv->parameters_in;
1083

1084 1085
	p->frequency = c->frequency;
	p->inversion = c->inversion;
1086

1087 1088
	switch (fe->ops.info.type) {
	case FE_QPSK:
1089
		dprintk("%s() Preparing QPSK req\n", __func__);
1090 1091 1092 1093
		p->u.qpsk.symbol_rate = c->symbol_rate;
		p->u.qpsk.fec_inner = c->fec_inner;
		break;
	case FE_QAM:
1094
		dprintk("%s() Preparing QAM req\n", __func__);
1095 1096 1097 1098 1099
		p->u.qam.symbol_rate = c->symbol_rate;
		p->u.qam.fec_inner = c->fec_inner;
		p->u.qam.modulation = c->modulation;
		break;
	case FE_OFDM:
1100
		dprintk("%s() Preparing OFDM req\n", __func__);
1101 1102 1103 1104 1105 1106 1107 1108
		if (c->bandwidth_hz == 6000000)
			p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
		else if (c->bandwidth_hz == 7000000)
			p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ;
		else if (c->bandwidth_hz == 8000000)
			p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ;
		else
			p->u.ofdm.bandwidth = BANDWIDTH_AUTO;
1109 1110 1111 1112 1113 1114 1115 1116
		p->u.ofdm.code_rate_HP = c->code_rate_HP;
		p->u.ofdm.code_rate_LP = c->code_rate_LP;
		p->u.ofdm.constellation = c->modulation;
		p->u.ofdm.transmission_mode = c->transmission_mode;
		p->u.ofdm.guard_interval = c->guard_interval;
		p->u.ofdm.hierarchy_information = c->hierarchy;
		break;
	case FE_ATSC:
1117
		dprintk("%s() Preparing VSB req\n", __func__);
1118 1119 1120 1121 1122 1123 1124 1125
		p->u.vsb.modulation = c->modulation;
		break;
	}
}

/* Ensure the cached values are set correctly in the frontend
 * legacy tuning structures, for the legacy tuning API.
 */
1126
static void dtv_property_adv_params_sync(struct dvb_frontend *fe)
1127
{
1128
	const struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1129
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
1130
	struct dvb_frontend_parameters *p = &fepriv->parameters_in;
1131

1132 1133 1134 1135
	p->frequency = c->frequency;
	p->inversion = c->inversion;

	switch(c->modulation) {
1136 1137
	case PSK_8:
	case APSK_16:
1138
	case APSK_32:
1139
	case QPSK:
1140 1141 1142 1143 1144 1145 1146
		p->u.qpsk.symbol_rate = c->symbol_rate;
		p->u.qpsk.fec_inner = c->fec_inner;
		break;
	default:
		break;
	}

1147 1148 1149
	/* Fake out a generic DVB-T request so we pass validation in the ioctl */
	if ((c->delivery_system == SYS_ISDBT) ||
	    (c->delivery_system == SYS_DVBT2)) {
1150 1151 1152 1153 1154 1155
		p->u.ofdm.constellation = QAM_AUTO;
		p->u.ofdm.code_rate_HP = FEC_AUTO;
		p->u.ofdm.code_rate_LP = FEC_AUTO;
		p->u.ofdm.transmission_mode = TRANSMISSION_MODE_AUTO;
		p->u.ofdm.guard_interval = GUARD_INTERVAL_AUTO;
		p->u.ofdm.hierarchy_information = HIERARCHY_AUTO;
1156 1157 1158 1159 1160 1161 1162 1163
		if (c->bandwidth_hz == 8000000)
			p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ;
		else if (c->bandwidth_hz == 7000000)
			p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ;
		else if (c->bandwidth_hz == 6000000)
			p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
		else
			p->u.ofdm.bandwidth = BANDWIDTH_AUTO;
1164 1165 1166
	}
}

1167
static void dtv_property_cache_submit(struct dvb_frontend *fe)
1168
{
1169
	const struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1170 1171 1172 1173 1174

	/* For legacy delivery systems we don't need the delivery_system to
	 * be specified, but we populate the older structures from the cache
	 * so we can call set_frontend on older drivers.
	 */
1175 1176
	if(is_legacy_delivery_system(c->delivery_system)) {

1177
		dprintk("%s() legacy, modulation = %d\n", __func__, c->modulation);
1178
		dtv_property_legacy_params_sync(fe);
1179 1180

	} else {
1181
		dprintk("%s() adv, modulation = %d\n", __func__, c->modulation);
1182

1183 1184 1185 1186 1187 1188
		/* For advanced delivery systems / modulation types ...
		 * we seed the lecacy dvb_frontend_parameters structure
		 * so that the sanity checking code later in the IOCTL processing
		 * can validate our basic frequency ranges, symbolrates, modulation
		 * etc.
		 */
1189
		dtv_property_adv_params_sync(fe);
1190 1191 1192
	}
}

1193
static int dvb_frontend_ioctl_legacy(struct file *file,
1194
			unsigned int cmd, void *parg);
1195
static int dvb_frontend_ioctl_properties(struct file *file,
1196 1197
			unsigned int cmd, void *parg);

1198 1199
static int dtv_property_process_get(struct dvb_frontend *fe,
				    struct dtv_property *tvp,
1200
				    struct file *file)
1201
{
1202
	const struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1203 1204
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
	struct dtv_frontend_properties cdetected;
1205
	int r;
1206

1207 1208 1209 1210 1211 1212 1213 1214 1215 1216
	/*
	 * If the driver implements a get_frontend function, then convert
	 * detected parameters to S2API properties.
	 */
	if (fe->ops.get_frontend) {
		cdetected = *c;
		dtv_property_cache_sync(fe, &cdetected, &fepriv->parameters_out);
		c = &cdetected;
	}

1217 1218
	switch(tvp->cmd) {
	case DTV_FREQUENCY:
1219
		tvp->u.data = c->frequency;
1220 1221
		break;
	case DTV_MODULATION:
1222
		tvp->u.data = c->modulation;
1223
		break;
1224
	case DTV_BANDWIDTH_HZ:
1225
		tvp->u.data = c->bandwidth_hz;
1226 1227
		break;
	case DTV_INVERSION:
1228
		tvp->u.data = c->inversion;
1229 1230
		break;
	case DTV_SYMBOL_RATE:
1231
		tvp->u.data = c->symbol_rate;
1232 1233
		break;
	case DTV_INNER_FEC:
1234
		tvp->u.data = c->fec_inner;
1235 1236
		break;
	case DTV_PILOT:
1237
		tvp->u.data = c->pilot;
1238 1239
		break;
	case DTV_ROLLOFF:
1240
		tvp->u.data = c->rolloff;
1241 1242
		break;
	case DTV_DELIVERY_SYSTEM:
1243
		tvp->u.data = c->delivery_system;
1244 1245
		break;
	case DTV_VOLTAGE:
1246
		tvp->u.data = c->voltage;
1247 1248
		break;
	case DTV_TONE:
1249
		tvp->u.data = c->sectone;
1250
		break;
1251 1252 1253
	case DTV_API_VERSION:
		tvp->u.data = (DVB_API_VERSION << 8) | DVB_API_VERSION_MINOR;
		break;
1254
	case DTV_CODE_RATE_HP:
1255
		tvp->u.data = c->code_rate_HP;
1256 1257
		break;
	case DTV_CODE_RATE_LP:
1258
		tvp->u.data = c->code_rate_LP;
1259
		break;
1260
	case DTV_GUARD_INTERVAL:
1261
		tvp->u.data = c->guard_interval;
1262 1263
		break;
	case DTV_TRANSMISSION_MODE:
1264
		tvp->u.data = c->transmission_mode;
1265
		break;
1266
	case DTV_HIERARCHY:
1267
		tvp->u.data = c->hierarchy;
1268
		break;
1269 1270 1271

	/* ISDB-T Support here */
	case DTV_ISDBT_PARTIAL_RECEPTION:
1272
		tvp->u.data = c->isdbt_partial_reception;
1273 1274
		break;
	case DTV_ISDBT_SOUND_BROADCASTING:
1275
		tvp->u.data = c->isdbt_sb_mode;
1276 1277
		break;
	case DTV_ISDBT_SB_SUBCHANNEL_ID:
1278
		tvp->u.data = c->isdbt_sb_subchannel;
1279 1280
		break;
	case DTV_ISDBT_SB_SEGMENT_IDX:
1281
		tvp->u.data = c->isdbt_sb_segment_idx;
1282 1283
		break;
	case DTV_ISDBT_SB_SEGMENT_COUNT:
1284
		tvp->u.data = c->isdbt_sb_segment_count;
1285
		break;
1286
	case DTV_ISDBT_LAYER_ENABLED:
1287
		tvp->u.data = c->isdbt_layer_enabled;
1288
		break;
1289
	case DTV_ISDBT_LAYERA_FEC:
1290
		tvp->u.data = c->layer[0].fec;
1291 1292
		break;
	case DTV_ISDBT_LAYERA_MODULATION:
1293
		tvp->u.data = c->layer[0].modulation;
1294 1295
		break;
	case DTV_ISDBT_LAYERA_SEGMENT_COUNT:
1296
		tvp->u.data = c->layer[0].segment_count;
1297 1298
		break;
	case DTV_ISDBT_LAYERA_TIME_INTERLEAVING:
1299
		tvp->u.data = c->layer[0].interleaving;
1300 1301
		break;
	case DTV_ISDBT_LAYERB_FEC:
1302
		tvp->u.data = c->layer[1].fec;
1303 1304
		break;
	case DTV_ISDBT_LAYERB_MODULATION:
1305
		tvp->u.data = c->layer[1].modulation;
1306 1307
		break;
	case DTV_ISDBT_LAYERB_SEGMENT_COUNT:
1308
		tvp->u.data = c->layer[1].segment_count;
1309 1310
		break;
	case DTV_ISDBT_LAYERB_TIME_INTERLEAVING:
1311
		tvp->u.data = c->layer[1].interleaving;
1312 1313
		break;
	case DTV_ISDBT_LAYERC_FEC:
1314
		tvp->u.data = c->layer[2].fec;
1315 1316
		break;
	case DTV_ISDBT_LAYERC_MODULATION:
1317
		tvp->u.data = c->layer[2].modulation;
1318 1319
		break;
	case DTV_ISDBT_LAYERC_SEGMENT_COUNT:
1320
		tvp->u.data = c->layer[2].segment_count;
1321 1322
		break;
	case DTV_ISDBT_LAYERC_TIME_INTERLEAVING:
1323
		tvp->u.data = c->layer[2].interleaving;
1324
		break;
1325
	case DTV_ISDBS_TS_ID:
1326
		tvp->u.data = c->isdbs_ts_id;
1327
		break;
1328
	case DTV_DVBT2_PLP_ID:
1329
		tvp->u.data = c->dvbt2_plp_id;
1330
		break;
1331
	default:
1332
		return -EINVAL;
1333 1334
	}

1335 1336 1337 1338 1339 1340 1341
	/* Allow the frontend to override outgoing properties */
	if (fe->ops.get_property) {
		r = fe->ops.get_property(fe, tvp);
		if (r < 0)
			return r;
	}

1342 1343
	dtv_property_dump(tvp);

1344
	return 0;
1345 1346
}

1347 1348 1349
static int dtv_property_process_set(struct dvb_frontend *fe,
				    struct dtv_property *tvp,
				    struct file *file)
1350 1351
{
	int r = 0;
1352
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1353
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
1354
	dtv_property_dump(tvp);
1355

1356
	/* Allow the frontend to validate incoming properties */
1357
	if (fe->ops.set_property) {
1358
		r = fe->ops.set_property(fe, tvp);
1359 1360 1361
		if (r < 0)
			return r;
	}
1362

1363
	switch(tvp->cmd) {
1364
	case DTV_CLEAR:
1365 1366 1367
		/* Reset a cache of data specific to the frontend here. This does
		 * not effect hardware.
		 */
1368
		dvb_frontend_clear_cache(fe);
1369
		dprintk("%s() Flushing property cache\n", __func__);
1370
		break;
1371
	case DTV_TUNE:
1372
		/* interpret the cache of data, build either a traditional frontend
1373 1374
		 * tunerequest so we can pass validation in the FE_SET_FRONTEND
		 * ioctl.
1375
		 */
1376
		c->state = tvp->cmd;
1377
		dprintk("%s() Finalised property cache\n", __func__);
1378 1379
		dtv_property_cache_submit(fe);

1380
		r = dvb_frontend_ioctl_legacy(file, FE_SET_FRONTEND,
1381
			&fepriv->parameters_in);
1382
		break;
1383
	case DTV_FREQUENCY:
1384
		c->frequency = tvp->u.data;
1385
		break;
1386
	case DTV_MODULATION:
1387
		c->modulation = tvp->u.data;
1388
		break;
1389
	case DTV_BANDWIDTH_HZ:
1390
		c->bandwidth_hz = tvp->u.data;
1391
		break;
1392
	case DTV_INVERSION:
1393
		c->inversion = tvp->u.data;
1394
		break;
1395
	case DTV_SYMBOL_RATE:
1396
		c->symbol_rate = tvp->u.data;
1397
		break;
1398
	case DTV_INNER_FEC:
1399
		c->fec_inner = tvp->u.data;
1400
		break;
1401
	case DTV_PILOT:
1402
		c->pilot = tvp->u.data;
1403
		break;
1404
	case DTV_ROLLOFF:
1405
		c->rolloff = tvp->u.data;
1406
		break;
1407
	case DTV_DELIVERY_SYSTEM:
1408
		c->delivery_system = tvp->u.data;
1409
		break;
1410
	case DTV_VOLTAGE:
1411
		c->voltage = tvp->u.data;
1412
		r = dvb_frontend_ioctl_legacy(file, FE_SET_VOLTAGE,
1413
			(void *)c->voltage);
1414
		break;
1415
	case DTV_TONE:
1416
		c->sectone = tvp->u.data;
1417
		r = dvb_frontend_ioctl_legacy(file, FE_SET_TONE,
1418
			(void *)c->sectone);
1419
		break;
1420
	case DTV_CODE_RATE_HP:
1421
		c->code_rate_HP = tvp->u.data;
1422 1423
		break;
	case DTV_CODE_RATE_LP:
1424
		c->code_rate_LP = tvp->u.data;
1425
		break;
1426
	case DTV_GUARD_INTERVAL:
1427
		c->guard_interval = tvp->u.data;
1428 1429
		break;
	case DTV_TRANSMISSION_MODE:
1430
		c->transmission_mode = tvp->u.data;
1431
		break;
1432
	case DTV_HIERARCHY:
1433
		c->hierarchy = tvp->u.data;
1434
		break;
1435 1436 1437

	/* ISDB-T Support here */
	case DTV_ISDBT_PARTIAL_RECEPTION:
1438
		c->isdbt_partial_reception = tvp->u.data;
1439 1440
		break;
	case DTV_ISDBT_SOUND_BROADCASTING:
1441
		c->isdbt_sb_mode = tvp->u.data;
1442 1443
		break;
	case DTV_ISDBT_SB_SUBCHANNEL_ID:
1444
		c->isdbt_sb_subchannel = tvp->u.data;
1445 1446
		break;
	case DTV_ISDBT_SB_SEGMENT_IDX:
1447
		c->isdbt_sb_segment_idx = tvp->u.data;
1448 1449
		break;
	case DTV_ISDBT_SB_SEGMENT_COUNT:
1450
		c->isdbt_sb_segment_count = tvp->u.data;
1451
		break;
1452
	case DTV_ISDBT_LAYER_ENABLED:
1453
		c->isdbt_layer_enabled = tvp->u.data;
1454
		break;
1455
	case DTV_ISDBT_LAYERA_FEC:
1456
		c->layer[0].fec = tvp->u.data;
1457 1458
		break;
	case DTV_ISDBT_LAYERA_MODULATION:
1459
		c->layer[0].modulation = tvp->u.data;
1460 1461
		break;
	case DTV_ISDBT_LAYERA_SEGMENT_COUNT:
1462
		c->layer[0].segment_count = tvp->u.data;
1463 1464
		break;
	case DTV_ISDBT_LAYERA_TIME_INTERLEAVING:
1465
		c->layer[0].interleaving = tvp->u.data;
1466 1467
		break;
	case DTV_ISDBT_LAYERB_FEC:
1468
		c->layer[1].fec = tvp->u.data;
1469 1470
		break;
	case DTV_ISDBT_LAYERB_MODULATION:
1471
		c->layer[1].modulation = tvp->u.data;
1472 1473
		break;
	case DTV_ISDBT_LAYERB_SEGMENT_COUNT:
1474
		c->layer[1].segment_count = tvp->u.data;
1475 1476
		break;
	case DTV_ISDBT_LAYERB_TIME_INTERLEAVING:
1477
		c->layer[1].interleaving = tvp->u.data;
1478 1479
		break;
	case DTV_ISDBT_LAYERC_FEC:
1480
		c->layer[2].fec = tvp->u.data;
1481 1482
		break;
	case DTV_ISDBT_LAYERC_MODULATION:
1483
		c->layer[2].modulation = tvp->u.data;
1484 1485
		break;
	case DTV_ISDBT_LAYERC_SEGMENT_COUNT:
1486
		c->layer[2].segment_count = tvp->u.data;
1487 1488
		break;
	case DTV_ISDBT_LAYERC_TIME_INTERLEAVING:
1489
		c->layer[2].interleaving = tvp->u.data;
1490
		break;
1491
	case DTV_ISDBS_TS_ID:
1492
		c->isdbs_ts_id = tvp->u.data;
1493 1494
		break;
	case DTV_DVBT2_PLP_ID:
1495
		c->dvbt2_plp_id = tvp->u.data;
1496
		break;
1497
	default:
1498
		return -EINVAL;
1499 1500
	}

1501
	return r;
1502 1503
}

1504
static int dvb_frontend_ioctl(struct file *file,
L
Linus Torvalds 已提交
1505 1506 1507 1508
			unsigned int cmd, void *parg)
{
	struct dvb_device *dvbdev = file->private_data;
	struct dvb_frontend *fe = dvbdev->priv;
1509
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1510
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
1511 1512
	int err = -EOPNOTSUPP;

1513
	dprintk("%s (%d)\n", __func__, _IOC_NR(cmd));
L
Linus Torvalds 已提交
1514

1515
	if (fepriv->exit != DVB_FE_NO_EXIT)
L
Linus Torvalds 已提交
1516 1517 1518 1519 1520 1521 1522 1523 1524 1525
		return -ENODEV;

	if ((file->f_flags & O_ACCMODE) == O_RDONLY &&
	    (_IOC_DIR(cmd) != _IOC_READ || cmd == FE_GET_EVENT ||
	     cmd == FE_DISEQC_RECV_SLAVE_REPLY))
		return -EPERM;

	if (down_interruptible (&fepriv->sem))
		return -ERESTARTSYS;

1526
	if ((cmd == FE_SET_PROPERTY) || (cmd == FE_GET_PROPERTY))
1527
		err = dvb_frontend_ioctl_properties(file, cmd, parg);
1528
	else {
1529
		c->state = DTV_UNDEFINED;
1530
		err = dvb_frontend_ioctl_legacy(file, cmd, parg);
1531
	}
1532 1533 1534 1535 1536

	up(&fepriv->sem);
	return err;
}

1537
static int dvb_frontend_ioctl_properties(struct file *file,
1538 1539 1540 1541
			unsigned int cmd, void *parg)
{
	struct dvb_device *dvbdev = file->private_data;
	struct dvb_frontend *fe = dvbdev->priv;
1542
	struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1543
	int err = 0;
1544 1545 1546 1547

	struct dtv_properties *tvps = NULL;
	struct dtv_property *tvp = NULL;
	int i;
1548 1549 1550

	dprintk("%s\n", __func__);

1551
	if(cmd == FE_SET_PROPERTY) {
1552
		tvps = (struct dtv_properties __user *)parg;
1553

1554 1555
		dprintk("%s() properties.num = %d\n", __func__, tvps->num);
		dprintk("%s() properties.props = %p\n", __func__, tvps->props);
1556 1557 1558

		/* Put an arbitrary limit on the number of messages that can
		 * be sent at once */
1559
		if ((tvps->num == 0) || (tvps->num > DTV_IOCTL_MAX_MSGS))
1560 1561
			return -EINVAL;

1562
		tvp = kmalloc(tvps->num * sizeof(struct dtv_property), GFP_KERNEL);
1563 1564 1565
		if (!tvp) {
			err = -ENOMEM;
			goto out;
1566 1567
		}

1568 1569 1570 1571 1572
		if (copy_from_user(tvp, tvps->props, tvps->num * sizeof(struct dtv_property))) {
			err = -EFAULT;
			goto out;
		}

1573
		for (i = 0; i < tvps->num; i++) {
1574 1575 1576 1577
			err = dtv_property_process_set(fe, tvp + i, file);
			if (err < 0)
				goto out;
			(tvp + i)->result = err;
1578
		}
1579

1580
		if (c->state == DTV_TUNE)
1581
			dprintk("%s() Property cache is full, tuning\n", __func__);
1582

1583 1584 1585 1586 1587
	} else
	if(cmd == FE_GET_PROPERTY) {

		tvps = (struct dtv_properties __user *)parg;

1588 1589
		dprintk("%s() properties.num = %d\n", __func__, tvps->num);
		dprintk("%s() properties.props = %p\n", __func__, tvps->props);
1590 1591 1592

		/* Put an arbitrary limit on the number of messages that can
		 * be sent at once */
1593
		if ((tvps->num == 0) || (tvps->num > DTV_IOCTL_MAX_MSGS))
1594 1595
			return -EINVAL;

1596
		tvp = kmalloc(tvps->num * sizeof(struct dtv_property), GFP_KERNEL);
1597 1598 1599 1600 1601 1602 1603 1604 1605 1606
		if (!tvp) {
			err = -ENOMEM;
			goto out;
		}

		if (copy_from_user(tvp, tvps->props, tvps->num * sizeof(struct dtv_property))) {
			err = -EFAULT;
			goto out;
		}

1607
		for (i = 0; i < tvps->num; i++) {
1608 1609 1610 1611
			err = dtv_property_process_get(fe, tvp + i, file);
			if (err < 0)
				goto out;
			(tvp + i)->result = err;
1612
		}
1613 1614 1615 1616 1617 1618 1619 1620 1621

		if (copy_to_user(tvps->props, tvp, tvps->num * sizeof(struct dtv_property))) {
			err = -EFAULT;
			goto out;
		}

	} else
		err = -EOPNOTSUPP;

1622 1623
out:
	kfree(tvp);
1624 1625 1626
	return err;
}

1627
static int dvb_frontend_ioctl_legacy(struct file *file,
1628 1629 1630 1631 1632
			unsigned int cmd, void *parg)
{
	struct dvb_device *dvbdev = file->private_data;
	struct dvb_frontend *fe = dvbdev->priv;
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
1633 1634 1635 1636 1637 1638 1639 1640 1641 1642 1643 1644
	int cb_err, err = -EOPNOTSUPP;

	if (fe->dvb->fe_ioctl_override) {
		cb_err = fe->dvb->fe_ioctl_override(fe, cmd, parg,
						    DVB_FE_IOCTL_PRE);
		if (cb_err < 0)
			return cb_err;
		if (cb_err > 0)
			return 0;
		/* fe_ioctl_override returning 0 allows
		 * dvb-core to continue handling the ioctl */
	}
1645

L
Linus Torvalds 已提交
1646 1647
	switch (cmd) {
	case FE_GET_INFO: {
1648
		struct dvb_frontend_info* info = parg;
1649
		memcpy(info, &fe->ops.info, sizeof(struct dvb_frontend_info));
1650
		dvb_frontend_get_frequency_limits(fe, &info->frequency_min, &info->frequency_max);
L
Linus Torvalds 已提交
1651 1652 1653 1654 1655 1656 1657 1658

		/* Force the CAN_INVERSION_AUTO bit on. If the frontend doesn't
		 * do it, it is done for it. */
		info->caps |= FE_CAN_INVERSION_AUTO;
		err = 0;
		break;
	}

1659 1660 1661
	case FE_READ_STATUS: {
		fe_status_t* status = parg;

L
Lucas De Marchi 已提交
1662
		/* if retune was requested but hasn't occurred yet, prevent
1663
		 * that user get signal state from previous tuning */
1664 1665
		if (fepriv->state == FESTATE_RETUNE ||
		    fepriv->state == FESTATE_ERROR) {
1666 1667 1668 1669 1670
			err=0;
			*status = 0;
			break;
		}

1671 1672
		if (fe->ops.read_status)
			err = fe->ops.read_status(fe, status);
L
Linus Torvalds 已提交
1673
		break;
1674
	}
L
Linus Torvalds 已提交
1675
	case FE_READ_BER:
1676 1677
		if (fe->ops.read_ber)
			err = fe->ops.read_ber(fe, (__u32*) parg);
L
Linus Torvalds 已提交
1678 1679 1680
		break;

	case FE_READ_SIGNAL_STRENGTH:
1681 1682
		if (fe->ops.read_signal_strength)
			err = fe->ops.read_signal_strength(fe, (__u16*) parg);
L
Linus Torvalds 已提交
1683 1684 1685
		break;

	case FE_READ_SNR:
1686 1687
		if (fe->ops.read_snr)
			err = fe->ops.read_snr(fe, (__u16*) parg);
L
Linus Torvalds 已提交
1688 1689 1690
		break;

	case FE_READ_UNCORRECTED_BLOCKS:
1691 1692
		if (fe->ops.read_ucblocks)
			err = fe->ops.read_ucblocks(fe, (__u32*) parg);
L
Linus Torvalds 已提交
1693 1694 1695 1696
		break;


	case FE_DISEQC_RESET_OVERLOAD:
1697 1698
		if (fe->ops.diseqc_reset_overload) {
			err = fe->ops.diseqc_reset_overload(fe);
L
Linus Torvalds 已提交
1699 1700 1701 1702 1703 1704
			fepriv->state = FESTATE_DISEQC;
			fepriv->status = 0;
		}
		break;

	case FE_DISEQC_SEND_MASTER_CMD:
1705 1706
		if (fe->ops.diseqc_send_master_cmd) {
			err = fe->ops.diseqc_send_master_cmd(fe, (struct dvb_diseqc_master_cmd*) parg);
L
Linus Torvalds 已提交
1707 1708 1709 1710 1711 1712
			fepriv->state = FESTATE_DISEQC;
			fepriv->status = 0;
		}
		break;

	case FE_DISEQC_SEND_BURST:
1713 1714
		if (fe->ops.diseqc_send_burst) {
			err = fe->ops.diseqc_send_burst(fe, (fe_sec_mini_cmd_t) parg);
L
Linus Torvalds 已提交
1715 1716 1717 1718 1719 1720
			fepriv->state = FESTATE_DISEQC;
			fepriv->status = 0;
		}
		break;

	case FE_SET_TONE:
1721 1722
		if (fe->ops.set_tone) {
			err = fe->ops.set_tone(fe, (fe_sec_tone_mode_t) parg);
1723
			fepriv->tone = (fe_sec_tone_mode_t) parg;
L
Linus Torvalds 已提交
1724 1725 1726 1727 1728 1729
			fepriv->state = FESTATE_DISEQC;
			fepriv->status = 0;
		}
		break;

	case FE_SET_VOLTAGE:
1730 1731
		if (fe->ops.set_voltage) {
			err = fe->ops.set_voltage(fe, (fe_sec_voltage_t) parg);
1732
			fepriv->voltage = (fe_sec_voltage_t) parg;
L
Linus Torvalds 已提交
1733 1734 1735 1736 1737 1738
			fepriv->state = FESTATE_DISEQC;
			fepriv->status = 0;
		}
		break;

	case FE_DISHNETWORK_SEND_LEGACY_CMD:
1739 1740
		if (fe->ops.dishnetwork_send_legacy_command) {
			err = fe->ops.dishnetwork_send_legacy_command(fe, (unsigned long) parg);
L
Linus Torvalds 已提交
1741 1742
			fepriv->state = FESTATE_DISEQC;
			fepriv->status = 0;
1743
		} else if (fe->ops.set_voltage) {
1744 1745 1746 1747 1748
			/*
			 * NOTE: This is a fallback condition.  Some frontends
			 * (stv0299 for instance) take longer than 8msec to
			 * respond to a set_voltage command.  Those switches
			 * need custom routines to switch properly.  For all
1749
			 * other frontends, the following should work ok.
1750 1751 1752
			 * Dish network legacy switches (as used by Dish500)
			 * are controlled by sending 9-bit command words
			 * spaced 8msec apart.
L
Lucas De Marchi 已提交
1753
			 * the actual command word is switch/port dependent
1754 1755 1756 1757 1758 1759
			 * so it is up to the userspace application to send
			 * the right command.
			 * The command must always start with a '0' after
			 * initialization, so parg is 8 bits and does not
			 * include the initialization or start bit
			 */
1760
			unsigned long swcmd = ((unsigned long) parg) << 1;
1761 1762 1763 1764 1765
			struct timeval nexttime;
			struct timeval tv[10];
			int i;
			u8 last = 1;
			if (dvb_frontend_debug)
1766
				printk("%s switch command: 0x%04lx\n", __func__, swcmd);
1767 1768 1769 1770 1771 1772
			do_gettimeofday(&nexttime);
			if (dvb_frontend_debug)
				memcpy(&tv[0], &nexttime, sizeof(struct timeval));
			/* before sending a command, initialize by sending
			 * a 32ms 18V to the switch
			 */
1773
			fe->ops.set_voltage(fe, SEC_VOLTAGE_18);
1774 1775 1776 1777 1778
			dvb_frontend_sleep_until(&nexttime, 32000);

			for (i = 0; i < 9; i++) {
				if (dvb_frontend_debug)
					do_gettimeofday(&tv[i + 1]);
1779
				if ((swcmd & 0x01) != last) {
1780
					/* set voltage to (last ? 13V : 18V) */
1781
					fe->ops.set_voltage(fe, (last) ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18);
1782 1783
					last = (last) ? 0 : 1;
				}
1784
				swcmd = swcmd >> 1;
1785 1786 1787 1788 1789
				if (i != 8)
					dvb_frontend_sleep_until(&nexttime, 8000);
			}
			if (dvb_frontend_debug) {
				printk("%s(%d): switch delay (should be 32k followed by all 8k\n",
1790
					__func__, fe->dvb->num);
1791 1792 1793 1794 1795 1796
				for (i = 1; i < 10; i++)
					printk("%d: %d\n", i, timeval_usec_diff(tv[i-1] , tv[i]));
			}
			err = 0;
			fepriv->state = FESTATE_DISEQC;
			fepriv->status = 0;
L
Linus Torvalds 已提交
1797 1798 1799 1800
		}
		break;

	case FE_DISEQC_RECV_SLAVE_REPLY:
1801 1802
		if (fe->ops.diseqc_recv_slave_reply)
			err = fe->ops.diseqc_recv_slave_reply(fe, (struct dvb_diseqc_slave_reply*) parg);
L
Linus Torvalds 已提交
1803 1804 1805
		break;

	case FE_ENABLE_HIGH_LNB_VOLTAGE:
1806 1807
		if (fe->ops.enable_high_lnb_voltage)
			err = fe->ops.enable_high_lnb_voltage(fe, (long) parg);
L
Linus Torvalds 已提交
1808 1809 1810
		break;

	case FE_SET_FRONTEND: {
1811
		struct dtv_frontend_properties *c = &fe->dtv_property_cache;
L
Linus Torvalds 已提交
1812 1813
		struct dvb_frontend_tune_settings fetunesettings;

1814
		if (c->state == DTV_TUNE) {
1815
			if (dvb_frontend_check_parameters(fe, &fepriv->parameters_in) < 0) {
1816 1817 1818 1819 1820 1821 1822 1823
				err = -EINVAL;
				break;
			}
		} else {
			if (dvb_frontend_check_parameters(fe, parg) < 0) {
				err = -EINVAL;
				break;
			}
1824

1825
			memcpy (&fepriv->parameters_in, parg,
1826
				sizeof (struct dvb_frontend_parameters));
1827
			dtv_property_cache_sync(fe, c, &fepriv->parameters_in);
1828
		}
L
Linus Torvalds 已提交
1829

1830 1831 1832 1833 1834 1835 1836
		/*
		 * Initialize output parameters to match the values given by
		 * the user. FE_SET_FRONTEND triggers an initial frontend event
		 * with status = 0, which copies output parameters to userspace.
		 */
		fepriv->parameters_out = fepriv->parameters_in;

L
Linus Torvalds 已提交
1837 1838 1839 1840 1841 1842
		memset(&fetunesettings, 0, sizeof(struct dvb_frontend_tune_settings));
		memcpy(&fetunesettings.parameters, parg,
		       sizeof (struct dvb_frontend_parameters));

		/* force auto frequency inversion if requested */
		if (dvb_force_auto_inversion) {
1843
			fepriv->parameters_in.inversion = INVERSION_AUTO;
L
Linus Torvalds 已提交
1844 1845
			fetunesettings.parameters.inversion = INVERSION_AUTO;
		}
1846
		if (fe->ops.info.type == FE_OFDM) {
1847
			/* without hierarchical coding code_rate_LP is irrelevant,
L
Linus Torvalds 已提交
1848
			 * so we tolerate the otherwise invalid FEC_NONE setting */
1849 1850 1851
			if (fepriv->parameters_in.u.ofdm.hierarchy_information == HIERARCHY_NONE &&
			    fepriv->parameters_in.u.ofdm.code_rate_LP == FEC_NONE)
				fepriv->parameters_in.u.ofdm.code_rate_LP = FEC_AUTO;
L
Linus Torvalds 已提交
1852 1853 1854
		}

		/* get frontend-specific tuning settings */
1855
		if (fe->ops.get_tune_settings && (fe->ops.get_tune_settings(fe, &fetunesettings) == 0)) {
L
Linus Torvalds 已提交
1856 1857 1858 1859 1860
			fepriv->min_delay = (fetunesettings.min_delay_ms * HZ) / 1000;
			fepriv->max_drift = fetunesettings.max_drift;
			fepriv->step_size = fetunesettings.step_size;
		} else {
			/* default values */
1861
			switch(fe->ops.info.type) {
L
Linus Torvalds 已提交
1862 1863
			case FE_QPSK:
				fepriv->min_delay = HZ/20;
1864 1865
				fepriv->step_size = fepriv->parameters_in.u.qpsk.symbol_rate / 16000;
				fepriv->max_drift = fepriv->parameters_in.u.qpsk.symbol_rate / 2000;
L
Linus Torvalds 已提交
1866 1867 1868 1869 1870 1871 1872 1873 1874 1875
				break;

			case FE_QAM:
				fepriv->min_delay = HZ/20;
				fepriv->step_size = 0; /* no zigzag */
				fepriv->max_drift = 0;
				break;

			case FE_OFDM:
				fepriv->min_delay = HZ/20;
1876 1877
				fepriv->step_size = fe->ops.info.frequency_stepsize * 2;
				fepriv->max_drift = (fe->ops.info.frequency_stepsize * 2) + 1;
L
Linus Torvalds 已提交
1878 1879
				break;
			case FE_ATSC:
1880 1881 1882
				fepriv->min_delay = HZ/20;
				fepriv->step_size = 0;
				fepriv->max_drift = 0;
L
Linus Torvalds 已提交
1883 1884 1885 1886 1887 1888 1889
				break;
			}
		}
		if (dvb_override_tune_delay > 0)
			fepriv->min_delay = (dvb_override_tune_delay * HZ) / 1000;

		fepriv->state = FESTATE_RETUNE;
1890 1891 1892 1893

		/* Request the search algorithm to search */
		fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN;

L
Linus Torvalds 已提交
1894 1895 1896 1897 1898 1899 1900 1901 1902 1903 1904 1905
		dvb_frontend_wakeup(fe);
		dvb_frontend_add_event(fe, 0);
		fepriv->status = 0;
		err = 0;
		break;
	}

	case FE_GET_EVENT:
		err = dvb_frontend_get_event (fe, parg, file->f_flags);
		break;

	case FE_GET_FRONTEND:
1906
		if (fe->ops.get_frontend) {
1907 1908
			err = fe->ops.get_frontend(fe, &fepriv->parameters_out);
			memcpy(parg, &fepriv->parameters_out, sizeof(struct dvb_frontend_parameters));
L
Linus Torvalds 已提交
1909 1910
		}
		break;
1911 1912

	case FE_SET_FRONTEND_TUNE_MODE:
1913
		fepriv->tune_mode_flags = (unsigned long) parg;
1914
		err = 0;
1915
		break;
L
Linus Torvalds 已提交
1916 1917
	};

1918 1919 1920 1921 1922 1923 1924
	if (fe->dvb->fe_ioctl_override) {
		cb_err = fe->dvb->fe_ioctl_override(fe, cmd, parg,
						    DVB_FE_IOCTL_POST);
		if (cb_err < 0)
			return cb_err;
	}

L
Linus Torvalds 已提交
1925 1926 1927
	return err;
}

1928

L
Linus Torvalds 已提交
1929 1930 1931 1932
static unsigned int dvb_frontend_poll(struct file *file, struct poll_table_struct *wait)
{
	struct dvb_device *dvbdev = file->private_data;
	struct dvb_frontend *fe = dvbdev->priv;
1933
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
1934

1935
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
1936 1937 1938 1939 1940 1941 1942 1943 1944 1945 1946 1947 1948

	poll_wait (file, &fepriv->events.wait_queue, wait);

	if (fepriv->events.eventw != fepriv->events.eventr)
		return (POLLIN | POLLRDNORM | POLLPRI);

	return 0;
}

static int dvb_frontend_open(struct inode *inode, struct file *file)
{
	struct dvb_device *dvbdev = file->private_data;
	struct dvb_frontend *fe = dvbdev->priv;
1949
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
1950
	struct dvb_adapter *adapter = fe->dvb;
L
Linus Torvalds 已提交
1951 1952
	int ret;

1953
	dprintk ("%s\n", __func__);
1954 1955
	if (fepriv->exit == DVB_FE_DEVICE_REMOVED)
		return -ENODEV;
L
Linus Torvalds 已提交
1956

1957 1958
	if (adapter->mfe_shared) {
		mutex_lock (&adapter->mfe_lock);
1959 1960 1961 1962 1963 1964 1965 1966 1967 1968 1969 1970 1971 1972 1973 1974 1975 1976 1977

		if (adapter->mfe_dvbdev == NULL)
			adapter->mfe_dvbdev = dvbdev;

		else if (adapter->mfe_dvbdev != dvbdev) {
			struct dvb_device
				*mfedev = adapter->mfe_dvbdev;
			struct dvb_frontend
				*mfe = mfedev->priv;
			struct dvb_frontend_private
				*mfepriv = mfe->frontend_priv;
			int mferetry = (dvb_mfe_wait_time << 1);

			mutex_unlock (&adapter->mfe_lock);
			while (mferetry-- && (mfedev->users != -1 ||
					mfepriv->thread != NULL)) {
				if(msleep_interruptible(500)) {
					if(signal_pending(current))
						return -EINTR;
1978
				}
1979 1980 1981 1982
			}

			mutex_lock (&adapter->mfe_lock);
			if(adapter->mfe_dvbdev != dvbdev) {
1983 1984 1985
				mfedev = adapter->mfe_dvbdev;
				mfe = mfedev->priv;
				mfepriv = mfe->frontend_priv;
1986 1987 1988 1989
				if (mfedev->users != -1 ||
						mfepriv->thread != NULL) {
					mutex_unlock (&adapter->mfe_lock);
					return -EBUSY;
1990
				}
1991
				adapter->mfe_dvbdev = dvbdev;
1992 1993 1994 1995
			}
		}
	}

1996 1997
	if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) {
		if ((ret = fe->ops.ts_bus_ctrl(fe, 1)) < 0)
1998
			goto err0;
1999 2000 2001 2002 2003 2004 2005 2006

		/* If we took control of the bus, we need to force
		   reinitialization.  This is because many ts_bus_ctrl()
		   functions strobe the RESET pin on the demod, and if the
		   frontend thread already exists then the dvb_init() routine
		   won't get called (which is what usually does initial
		   register configuration). */
		fepriv->reinitialise = 1;
2007 2008
	}

2009 2010
	if ((ret = dvb_generic_open (inode, file)) < 0)
		goto err1;
2011

2012
	if ((file->f_flags & O_ACCMODE) != O_RDONLY) {
2013 2014 2015 2016 2017
		/* normal tune mode when opened R/W */
		fepriv->tune_mode_flags &= ~FE_TUNE_MODE_ONESHOT;
		fepriv->tone = -1;
		fepriv->voltage = -1;

L
Linus Torvalds 已提交
2018 2019
		ret = dvb_frontend_start (fe);
		if (ret)
2020
			goto err2;
L
Linus Torvalds 已提交
2021 2022 2023 2024 2025

		/*  empty event queue */
		fepriv->events.eventr = fepriv->events.eventw = 0;
	}

2026 2027
	if (adapter->mfe_shared)
		mutex_unlock (&adapter->mfe_lock);
L
Linus Torvalds 已提交
2028
	return ret;
2029 2030 2031 2032 2033 2034

err2:
	dvb_generic_release(inode, file);
err1:
	if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl)
		fe->ops.ts_bus_ctrl(fe, 0);
2035 2036 2037
err0:
	if (adapter->mfe_shared)
		mutex_unlock (&adapter->mfe_lock);
2038
	return ret;
L
Linus Torvalds 已提交
2039 2040 2041 2042 2043 2044
}

static int dvb_frontend_release(struct inode *inode, struct file *file)
{
	struct dvb_device *dvbdev = file->private_data;
	struct dvb_frontend *fe = dvbdev->priv;
2045
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
2046
	int ret;
L
Linus Torvalds 已提交
2047

2048
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
2049 2050 2051 2052

	if ((file->f_flags & O_ACCMODE) != O_RDONLY)
		fepriv->release_jiffies = jiffies;

2053 2054
	ret = dvb_generic_release (inode, file);

2055
	if (dvbdev->users == -1) {
2056
		if (fepriv->exit != DVB_FE_NO_EXIT) {
2057 2058 2059 2060 2061 2062
			fops_put(file->f_op);
			file->f_op = NULL;
			wake_up(&dvbdev->wait_queue);
		}
		if (fe->ops.ts_bus_ctrl)
			fe->ops.ts_bus_ctrl(fe, 0);
2063
	}
2064

2065
	return ret;
L
Linus Torvalds 已提交
2066 2067
}

2068
static const struct file_operations dvb_frontend_fops = {
L
Linus Torvalds 已提交
2069
	.owner		= THIS_MODULE,
2070
	.unlocked_ioctl	= dvb_generic_ioctl,
L
Linus Torvalds 已提交
2071 2072
	.poll		= dvb_frontend_poll,
	.open		= dvb_frontend_open,
2073 2074
	.release	= dvb_frontend_release,
	.llseek		= noop_llseek,
L
Linus Torvalds 已提交
2075 2076 2077 2078 2079 2080 2081 2082 2083 2084 2085 2086 2087 2088
};

int dvb_register_frontend(struct dvb_adapter* dvb,
			  struct dvb_frontend* fe)
{
	struct dvb_frontend_private *fepriv;
	static const struct dvb_device dvbdev_template = {
		.users = ~0,
		.writers = 1,
		.readers = (~0)-1,
		.fops = &dvb_frontend_fops,
		.kernel_ioctl = dvb_frontend_ioctl
	};

2089
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
2090

2091
	if (mutex_lock_interruptible(&frontend_mutex))
L
Linus Torvalds 已提交
2092 2093
		return -ERESTARTSYS;

P
 
Panagiotis Issaris 已提交
2094
	fe->frontend_priv = kzalloc(sizeof(struct dvb_frontend_private), GFP_KERNEL);
L
Linus Torvalds 已提交
2095
	if (fe->frontend_priv == NULL) {
2096
		mutex_unlock(&frontend_mutex);
L
Linus Torvalds 已提交
2097 2098
		return -ENOMEM;
	}
2099
	fepriv = fe->frontend_priv;
L
Linus Torvalds 已提交
2100

2101
	sema_init(&fepriv->sem, 1);
L
Linus Torvalds 已提交
2102 2103
	init_waitqueue_head (&fepriv->wait_queue);
	init_waitqueue_head (&fepriv->events.wait_queue);
2104
	mutex_init(&fepriv->events.mtx);
L
Linus Torvalds 已提交
2105 2106 2107
	fe->dvb = dvb;
	fepriv->inversion = INVERSION_OFF;

2108
	printk ("DVB: registering adapter %i frontend %i (%s)...\n",
L
Linus Torvalds 已提交
2109
		fe->dvb->num,
2110
		fe->id,
2111
		fe->ops.info.name);
L
Linus Torvalds 已提交
2112 2113 2114 2115

	dvb_register_device (fe->dvb, &fepriv->dvbdev, &dvbdev_template,
			     fe, DVB_DEVICE_FRONTEND);

2116
	mutex_unlock(&frontend_mutex);
L
Linus Torvalds 已提交
2117 2118 2119 2120 2121 2122
	return 0;
}
EXPORT_SYMBOL(dvb_register_frontend);

int dvb_unregister_frontend(struct dvb_frontend* fe)
{
2123
	struct dvb_frontend_private *fepriv = fe->frontend_priv;
2124
	dprintk ("%s\n", __func__);
L
Linus Torvalds 已提交
2125

2126
	mutex_lock(&frontend_mutex);
2127
	dvb_frontend_stop (fe);
2128 2129 2130 2131 2132 2133
	mutex_unlock(&frontend_mutex);

	if (fepriv->dvbdev->users < -1)
		wait_event(fepriv->dvbdev->wait_queue,
				fepriv->dvbdev->users==-1);

2134
	mutex_lock(&frontend_mutex);
L
Linus Torvalds 已提交
2135
	dvb_unregister_device (fepriv->dvbdev);
2136

L
Linus Torvalds 已提交
2137 2138
	/* fe is invalid now */
	kfree(fepriv);
2139
	mutex_unlock(&frontend_mutex);
L
Linus Torvalds 已提交
2140 2141 2142
	return 0;
}
EXPORT_SYMBOL(dvb_unregister_frontend);
2143

2144
#ifdef CONFIG_MEDIA_ATTACH
2145 2146 2147 2148 2149 2150 2151 2152 2153 2154 2155 2156
void dvb_frontend_detach(struct dvb_frontend* fe)
{
	void *ptr;

	if (fe->ops.release_sec) {
		fe->ops.release_sec(fe);
		symbol_put_addr(fe->ops.release_sec);
	}
	if (fe->ops.tuner_ops.release) {
		fe->ops.tuner_ops.release(fe);
		symbol_put_addr(fe->ops.tuner_ops.release);
	}
2157 2158 2159 2160
	if (fe->ops.analog_ops.release) {
		fe->ops.analog_ops.release(fe);
		symbol_put_addr(fe->ops.analog_ops.release);
	}
2161 2162 2163 2164 2165 2166 2167 2168 2169 2170 2171 2172 2173
	ptr = (void*)fe->ops.release;
	if (ptr) {
		fe->ops.release(fe);
		symbol_put_addr(ptr);
	}
}
#else
void dvb_frontend_detach(struct dvb_frontend* fe)
{
	if (fe->ops.release_sec)
		fe->ops.release_sec(fe);
	if (fe->ops.tuner_ops.release)
		fe->ops.tuner_ops.release(fe);
2174 2175
	if (fe->ops.analog_ops.release)
		fe->ops.analog_ops.release(fe);
2176 2177 2178 2179 2180
	if (fe->ops.release)
		fe->ops.release(fe);
}
#endif
EXPORT_SYMBOL(dvb_frontend_detach);