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