This source file includes following definitions.
- __dvb_frontend_free
- dvb_frontend_free
- dvb_frontend_put
- dvb_frontend_get
- has_get_frontend
- dvbv3_type
- dvb_frontend_add_event
- dvb_frontend_test_event
- dvb_frontend_get_event
- dvb_frontend_clear_events
- dvb_frontend_init
- dvb_frontend_reinitialise
- dvb_frontend_swzigzag_update_delay
- dvb_frontend_swzigzag_autotune
- dvb_frontend_swzigzag
- dvb_frontend_is_exiting
- dvb_frontend_should_wakeup
- dvb_frontend_wakeup
- dvb_frontend_thread
- dvb_frontend_stop
- dvb_frontend_sleep_until
- dvb_frontend_start
- dvb_frontend_get_frequency_limits
- dvb_frontend_get_stepsize
- dvb_frontend_check_parameters
- dvb_frontend_clear_cache
- dtv_property_cache_sync
- dtv_property_legacy_params_sync
- dtv_get_frontend
- dtv_property_process_get
- is_dvbv3_delsys
- emulate_delivery_system
- dvbv5_set_delivery_system
- dvbv3_set_delivery_system
- dtv_property_process_set
- dvb_frontend_do_ioctl
- dvb_frontend_ioctl
- dvb_frontend_compat_ioctl
- dtv_set_frontend
- dvb_get_property
- dvb_get_frontend
- dvb_frontend_handle_ioctl
- dvb_frontend_poll
- dvb_frontend_open
- dvb_frontend_release
- dvb_frontend_suspend
- dvb_frontend_resume
- dvb_register_frontend
- dvb_unregister_frontend
- dvb_frontend_invoke_release
- dvb_frontend_detach
1
2
3
4
5
6
7
8
9
10
11
12
13
14 #define __DVB_CORE__
15
16 #define pr_fmt(fmt) "dvb_frontend: " fmt
17
18 #include <linux/string.h>
19 #include <linux/kernel.h>
20 #include <linux/sched/signal.h>
21 #include <linux/wait.h>
22 #include <linux/slab.h>
23 #include <linux/poll.h>
24 #include <linux/semaphore.h>
25 #include <linux/module.h>
26 #include <linux/list.h>
27 #include <linux/freezer.h>
28 #include <linux/jiffies.h>
29 #include <linux/kthread.h>
30 #include <linux/ktime.h>
31 #include <linux/compat.h>
32 #include <asm/processor.h>
33
34 #include <media/dvb_frontend.h>
35 #include <media/dvbdev.h>
36 #include <linux/dvb/version.h>
37
38 static int dvb_frontend_debug;
39 static int dvb_shutdown_timeout;
40 static int dvb_force_auto_inversion;
41 static int dvb_override_tune_delay;
42 static int dvb_powerdown_on_sleep = 1;
43 static int dvb_mfe_wait_time = 5;
44
45 module_param_named(frontend_debug, dvb_frontend_debug, int, 0644);
46 MODULE_PARM_DESC(frontend_debug, "Turn on/off frontend core debugging (default:off).");
47 module_param(dvb_shutdown_timeout, int, 0644);
48 MODULE_PARM_DESC(dvb_shutdown_timeout, "wait <shutdown_timeout> seconds after close() before suspending hardware");
49 module_param(dvb_force_auto_inversion, int, 0644);
50 MODULE_PARM_DESC(dvb_force_auto_inversion, "0: normal (default), 1: INVERSION_AUTO forced always");
51 module_param(dvb_override_tune_delay, int, 0644);
52 MODULE_PARM_DESC(dvb_override_tune_delay, "0: normal (default), >0 => delay in milliseconds to wait for lock after a tune attempt");
53 module_param(dvb_powerdown_on_sleep, int, 0644);
54 MODULE_PARM_DESC(dvb_powerdown_on_sleep, "0: do not power down, 1: turn LNB voltage off on sleep (default)");
55 module_param(dvb_mfe_wait_time, int, 0644);
56 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)");
57
58 #define dprintk(fmt, arg...) \
59 printk(KERN_DEBUG pr_fmt("%s: " fmt), __func__, ##arg)
60
61 #define FESTATE_IDLE 1
62 #define FESTATE_RETUNE 2
63 #define FESTATE_TUNING_FAST 4
64 #define FESTATE_TUNING_SLOW 8
65 #define FESTATE_TUNED 16
66 #define FESTATE_ZIGZAG_FAST 32
67 #define FESTATE_ZIGZAG_SLOW 64
68 #define FESTATE_DISEQC 128
69 #define FESTATE_ERROR 256
70 #define FESTATE_WAITFORLOCK (FESTATE_TUNING_FAST | FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW | FESTATE_DISEQC)
71 #define FESTATE_SEARCHING_FAST (FESTATE_TUNING_FAST | FESTATE_ZIGZAG_FAST)
72 #define FESTATE_SEARCHING_SLOW (FESTATE_TUNING_SLOW | FESTATE_ZIGZAG_SLOW)
73 #define FESTATE_LOSTLOCK (FESTATE_ZIGZAG_FAST | FESTATE_ZIGZAG_SLOW)
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90 static DEFINE_MUTEX(frontend_mutex);
91
92 struct dvb_frontend_private {
93
94 struct dvb_device *dvbdev;
95 struct dvb_frontend_parameters parameters_out;
96 struct dvb_fe_events events;
97 struct semaphore sem;
98 struct list_head list_head;
99 wait_queue_head_t wait_queue;
100 struct task_struct *thread;
101 unsigned long release_jiffies;
102 unsigned int wakeup;
103 enum fe_status status;
104 unsigned long tune_mode_flags;
105 unsigned int delay;
106 unsigned int reinitialise;
107 int tone;
108 int voltage;
109
110
111 unsigned int state;
112 unsigned int bending;
113 int lnb_drift;
114 unsigned int inversion;
115 unsigned int auto_step;
116 unsigned int auto_sub_step;
117 unsigned int started_auto_step;
118 unsigned int min_delay;
119 unsigned int max_drift;
120 unsigned int step_size;
121 int quality;
122 unsigned int check_wrapped;
123 enum dvbfe_search algo_status;
124
125 #if defined(CONFIG_MEDIA_CONTROLLER_DVB)
126 struct media_pipeline pipe;
127 #endif
128 };
129
130 static void dvb_frontend_invoke_release(struct dvb_frontend *fe,
131 void (*release)(struct dvb_frontend *fe));
132
133 static void __dvb_frontend_free(struct dvb_frontend *fe)
134 {
135 struct dvb_frontend_private *fepriv = fe->frontend_priv;
136
137 if (fepriv)
138 dvb_free_device(fepriv->dvbdev);
139
140 dvb_frontend_invoke_release(fe, fe->ops.release);
141
142 kfree(fepriv);
143 }
144
145 static void dvb_frontend_free(struct kref *ref)
146 {
147 struct dvb_frontend *fe =
148 container_of(ref, struct dvb_frontend, refcount);
149
150 __dvb_frontend_free(fe);
151 }
152
153 static void dvb_frontend_put(struct dvb_frontend *fe)
154 {
155
156 if (fe->ops.detach)
157 fe->ops.detach(fe);
158
159
160
161
162 if (fe->frontend_priv)
163 kref_put(&fe->refcount, dvb_frontend_free);
164 else
165 __dvb_frontend_free(fe);
166 }
167
168 static void dvb_frontend_get(struct dvb_frontend *fe)
169 {
170 kref_get(&fe->refcount);
171 }
172
173 static void dvb_frontend_wakeup(struct dvb_frontend *fe);
174 static int dtv_get_frontend(struct dvb_frontend *fe,
175 struct dtv_frontend_properties *c,
176 struct dvb_frontend_parameters *p_out);
177 static int
178 dtv_property_legacy_params_sync(struct dvb_frontend *fe,
179 const struct dtv_frontend_properties *c,
180 struct dvb_frontend_parameters *p);
181
182 static bool has_get_frontend(struct dvb_frontend *fe)
183 {
184 return fe->ops.get_frontend;
185 }
186
187
188
189
190
191
192 enum dvbv3_emulation_type {
193 DVBV3_UNKNOWN,
194 DVBV3_QPSK,
195 DVBV3_QAM,
196 DVBV3_OFDM,
197 DVBV3_ATSC,
198 };
199
200 static enum dvbv3_emulation_type dvbv3_type(u32 delivery_system)
201 {
202 switch (delivery_system) {
203 case SYS_DVBC_ANNEX_A:
204 case SYS_DVBC_ANNEX_C:
205 return DVBV3_QAM;
206 case SYS_DVBS:
207 case SYS_DVBS2:
208 case SYS_TURBO:
209 case SYS_ISDBS:
210 case SYS_DSS:
211 return DVBV3_QPSK;
212 case SYS_DVBT:
213 case SYS_DVBT2:
214 case SYS_ISDBT:
215 case SYS_DTMB:
216 return DVBV3_OFDM;
217 case SYS_ATSC:
218 case SYS_ATSCMH:
219 case SYS_DVBC_ANNEX_B:
220 return DVBV3_ATSC;
221 case SYS_UNDEFINED:
222 case SYS_ISDBC:
223 case SYS_DVBH:
224 case SYS_DAB:
225 default:
226
227
228
229
230
231
232 return DVBV3_UNKNOWN;
233 }
234 }
235
236 static void dvb_frontend_add_event(struct dvb_frontend *fe,
237 enum fe_status status)
238 {
239 struct dvb_frontend_private *fepriv = fe->frontend_priv;
240 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
241 struct dvb_fe_events *events = &fepriv->events;
242 struct dvb_frontend_event *e;
243 int wp;
244
245 dev_dbg(fe->dvb->device, "%s:\n", __func__);
246
247 if ((status & FE_HAS_LOCK) && has_get_frontend(fe))
248 dtv_get_frontend(fe, c, &fepriv->parameters_out);
249
250 mutex_lock(&events->mtx);
251
252 wp = (events->eventw + 1) % MAX_EVENT;
253 if (wp == events->eventr) {
254 events->overflow = 1;
255 events->eventr = (events->eventr + 1) % MAX_EVENT;
256 }
257
258 e = &events->events[events->eventw];
259 e->status = status;
260 e->parameters = fepriv->parameters_out;
261
262 events->eventw = wp;
263
264 mutex_unlock(&events->mtx);
265
266 wake_up_interruptible(&events->wait_queue);
267 }
268
269 static int dvb_frontend_test_event(struct dvb_frontend_private *fepriv,
270 struct dvb_fe_events *events)
271 {
272 int ret;
273
274 up(&fepriv->sem);
275 ret = events->eventw != events->eventr;
276 down(&fepriv->sem);
277
278 return ret;
279 }
280
281 static int dvb_frontend_get_event(struct dvb_frontend *fe,
282 struct dvb_frontend_event *event, int flags)
283 {
284 struct dvb_frontend_private *fepriv = fe->frontend_priv;
285 struct dvb_fe_events *events = &fepriv->events;
286
287 dev_dbg(fe->dvb->device, "%s:\n", __func__);
288
289 if (events->overflow) {
290 events->overflow = 0;
291 return -EOVERFLOW;
292 }
293
294 if (events->eventw == events->eventr) {
295 int ret;
296
297 if (flags & O_NONBLOCK)
298 return -EWOULDBLOCK;
299
300 ret = wait_event_interruptible(events->wait_queue,
301 dvb_frontend_test_event(fepriv, events));
302
303 if (ret < 0)
304 return ret;
305 }
306
307 mutex_lock(&events->mtx);
308 *event = events->events[events->eventr];
309 events->eventr = (events->eventr + 1) % MAX_EVENT;
310 mutex_unlock(&events->mtx);
311
312 return 0;
313 }
314
315 static void dvb_frontend_clear_events(struct dvb_frontend *fe)
316 {
317 struct dvb_frontend_private *fepriv = fe->frontend_priv;
318 struct dvb_fe_events *events = &fepriv->events;
319
320 mutex_lock(&events->mtx);
321 events->eventr = events->eventw;
322 mutex_unlock(&events->mtx);
323 }
324
325 static void dvb_frontend_init(struct dvb_frontend *fe)
326 {
327 dev_dbg(fe->dvb->device,
328 "%s: initialising adapter %i frontend %i (%s)...\n",
329 __func__, fe->dvb->num, fe->id, fe->ops.info.name);
330
331 if (fe->ops.init)
332 fe->ops.init(fe);
333 if (fe->ops.tuner_ops.init) {
334 if (fe->ops.i2c_gate_ctrl)
335 fe->ops.i2c_gate_ctrl(fe, 1);
336 fe->ops.tuner_ops.init(fe);
337 if (fe->ops.i2c_gate_ctrl)
338 fe->ops.i2c_gate_ctrl(fe, 0);
339 }
340 }
341
342 void dvb_frontend_reinitialise(struct dvb_frontend *fe)
343 {
344 struct dvb_frontend_private *fepriv = fe->frontend_priv;
345
346 fepriv->reinitialise = 1;
347 dvb_frontend_wakeup(fe);
348 }
349 EXPORT_SYMBOL(dvb_frontend_reinitialise);
350
351 static void dvb_frontend_swzigzag_update_delay(struct dvb_frontend_private *fepriv, int locked)
352 {
353 int q2;
354 struct dvb_frontend *fe = fepriv->dvbdev->priv;
355
356 dev_dbg(fe->dvb->device, "%s:\n", __func__);
357
358 if (locked)
359 (fepriv->quality) = (fepriv->quality * 220 + 36 * 256) / 256;
360 else
361 (fepriv->quality) = (fepriv->quality * 220 + 0) / 256;
362
363 q2 = fepriv->quality - 128;
364 q2 *= q2;
365
366 fepriv->delay = fepriv->min_delay + q2 * HZ / (128 * 128);
367 }
368
369
370
371
372
373
374
375
376
377
378
379 static int dvb_frontend_swzigzag_autotune(struct dvb_frontend *fe, int check_wrapped)
380 {
381 int autoinversion;
382 int ready = 0;
383 int fe_set_err = 0;
384 struct dvb_frontend_private *fepriv = fe->frontend_priv;
385 struct dtv_frontend_properties *c = &fe->dtv_property_cache, tmp;
386 int original_inversion = c->inversion;
387 u32 original_frequency = c->frequency;
388
389
390 autoinversion = ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) &&
391 (c->inversion == INVERSION_AUTO));
392
393
394 while (!ready) {
395
396 fepriv->lnb_drift = fepriv->auto_step * fepriv->step_size;
397
398
399 if (fepriv->lnb_drift > fepriv->max_drift) {
400 fepriv->auto_step = 0;
401 fepriv->auto_sub_step = 0;
402 fepriv->lnb_drift = 0;
403 }
404
405
406 switch (fepriv->auto_sub_step) {
407 case 0:
408
409 ready = 1;
410 break;
411
412 case 1:
413 if (!autoinversion) break;
414
415 fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF;
416 ready = 1;
417 break;
418
419 case 2:
420 if (fepriv->lnb_drift == 0) break;
421
422 fepriv->lnb_drift = -fepriv->lnb_drift;
423 ready = 1;
424 break;
425
426 case 3:
427 if (fepriv->lnb_drift == 0) break;
428 if (!autoinversion) break;
429
430 fepriv->inversion = (fepriv->inversion == INVERSION_OFF) ? INVERSION_ON : INVERSION_OFF;
431 fepriv->lnb_drift = -fepriv->lnb_drift;
432 ready = 1;
433 break;
434
435 default:
436 fepriv->auto_step++;
437 fepriv->auto_sub_step = -1;
438 break;
439 }
440
441 if (!ready) fepriv->auto_sub_step++;
442 }
443
444
445
446 if ((fepriv->auto_step == fepriv->started_auto_step) &&
447 (fepriv->auto_sub_step == 0) && check_wrapped) {
448 return 1;
449 }
450
451 dev_dbg(fe->dvb->device,
452 "%s: drift:%i inversion:%i auto_step:%i auto_sub_step:%i started_auto_step:%i\n",
453 __func__, fepriv->lnb_drift, fepriv->inversion,
454 fepriv->auto_step, fepriv->auto_sub_step,
455 fepriv->started_auto_step);
456
457
458 c->frequency += fepriv->lnb_drift;
459 if (autoinversion)
460 c->inversion = fepriv->inversion;
461 tmp = *c;
462 if (fe->ops.set_frontend)
463 fe_set_err = fe->ops.set_frontend(fe);
464 *c = tmp;
465 if (fe_set_err < 0) {
466 fepriv->state = FESTATE_ERROR;
467 return fe_set_err;
468 }
469
470 c->frequency = original_frequency;
471 c->inversion = original_inversion;
472
473 fepriv->auto_sub_step++;
474 return 0;
475 }
476
477 static void dvb_frontend_swzigzag(struct dvb_frontend *fe)
478 {
479 enum fe_status s = FE_NONE;
480 int retval = 0;
481 struct dvb_frontend_private *fepriv = fe->frontend_priv;
482 struct dtv_frontend_properties *c = &fe->dtv_property_cache, tmp;
483
484
485 if (fepriv->state & FESTATE_IDLE) {
486 fepriv->delay = 3 * HZ;
487 fepriv->quality = 0;
488 return;
489 }
490
491
492 if (fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT) {
493 if (fepriv->state & FESTATE_RETUNE) {
494 tmp = *c;
495 if (fe->ops.set_frontend)
496 retval = fe->ops.set_frontend(fe);
497 *c = tmp;
498 if (retval < 0)
499 fepriv->state = FESTATE_ERROR;
500 else
501 fepriv->state = FESTATE_TUNED;
502 }
503 fepriv->delay = 3 * HZ;
504 fepriv->quality = 0;
505 return;
506 }
507
508
509 if (fepriv->state & FESTATE_RETUNE) {
510 s = 0;
511 } else {
512 if (fe->ops.read_status)
513 fe->ops.read_status(fe, &s);
514 if (s != fepriv->status) {
515 dvb_frontend_add_event(fe, s);
516 fepriv->status = s;
517 }
518 }
519
520
521 if ((fepriv->state & FESTATE_WAITFORLOCK) && (s & FE_HAS_LOCK)) {
522 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
523 fepriv->state = FESTATE_TUNED;
524
525
526 if ((!(fe->ops.info.caps & FE_CAN_INVERSION_AUTO)) &&
527 (c->inversion == INVERSION_AUTO)) {
528 c->inversion = fepriv->inversion;
529 }
530 return;
531 }
532
533
534 if (fepriv->state & FESTATE_TUNED) {
535 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
536
537
538 if (s & FE_HAS_LOCK) {
539 return;
540 } else {
541 fepriv->state = FESTATE_ZIGZAG_FAST;
542 fepriv->started_auto_step = fepriv->auto_step;
543 fepriv->check_wrapped = 0;
544 }
545 }
546
547
548
549 if ((fepriv->state & FESTATE_LOSTLOCK) &&
550 (fe->ops.info.caps & FE_CAN_RECOVER) && (fepriv->max_drift == 0)) {
551 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
552 return;
553 }
554
555
556
557
558 if (fepriv->state & FESTATE_DISEQC) {
559 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
560 return;
561 }
562
563
564
565
566 if (fepriv->state & FESTATE_RETUNE) {
567 fepriv->lnb_drift = 0;
568 fepriv->auto_step = 0;
569 fepriv->auto_sub_step = 0;
570 fepriv->started_auto_step = 0;
571 fepriv->check_wrapped = 0;
572 }
573
574
575 if ((fepriv->state & FESTATE_SEARCHING_FAST) || (fepriv->state & FESTATE_RETUNE)) {
576 fepriv->delay = fepriv->min_delay;
577
578
579 retval = dvb_frontend_swzigzag_autotune(fe,
580 fepriv->check_wrapped);
581 if (retval < 0) {
582 return;
583 } else if (retval) {
584
585
586 fepriv->state = FESTATE_SEARCHING_SLOW;
587 fepriv->started_auto_step = fepriv->auto_step;
588 return;
589 }
590 fepriv->check_wrapped = 1;
591
592
593
594
595
596 if (fepriv->state & FESTATE_RETUNE) {
597 fepriv->state = FESTATE_TUNING_FAST;
598 }
599 }
600
601
602 if (fepriv->state & FESTATE_SEARCHING_SLOW) {
603 dvb_frontend_swzigzag_update_delay(fepriv, s & FE_HAS_LOCK);
604
605
606
607 dvb_frontend_swzigzag_autotune(fe, 0);
608 }
609 }
610
611 static int dvb_frontend_is_exiting(struct dvb_frontend *fe)
612 {
613 struct dvb_frontend_private *fepriv = fe->frontend_priv;
614
615 if (fe->exit != DVB_FE_NO_EXIT)
616 return 1;
617
618 if (fepriv->dvbdev->writers == 1)
619 if (time_after_eq(jiffies, fepriv->release_jiffies +
620 dvb_shutdown_timeout * HZ))
621 return 1;
622
623 return 0;
624 }
625
626 static int dvb_frontend_should_wakeup(struct dvb_frontend *fe)
627 {
628 struct dvb_frontend_private *fepriv = fe->frontend_priv;
629
630 if (fepriv->wakeup) {
631 fepriv->wakeup = 0;
632 return 1;
633 }
634 return dvb_frontend_is_exiting(fe);
635 }
636
637 static void dvb_frontend_wakeup(struct dvb_frontend *fe)
638 {
639 struct dvb_frontend_private *fepriv = fe->frontend_priv;
640
641 fepriv->wakeup = 1;
642 wake_up_interruptible(&fepriv->wait_queue);
643 }
644
645 static int dvb_frontend_thread(void *data)
646 {
647 struct dvb_frontend *fe = data;
648 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
649 struct dvb_frontend_private *fepriv = fe->frontend_priv;
650 enum fe_status s = FE_NONE;
651 enum dvbfe_algo algo;
652 bool re_tune = false;
653 bool semheld = false;
654
655 dev_dbg(fe->dvb->device, "%s:\n", __func__);
656
657 fepriv->check_wrapped = 0;
658 fepriv->quality = 0;
659 fepriv->delay = 3 * HZ;
660 fepriv->status = 0;
661 fepriv->wakeup = 0;
662 fepriv->reinitialise = 0;
663
664 dvb_frontend_init(fe);
665
666 set_freezable();
667 while (1) {
668 up(&fepriv->sem);
669 restart:
670 wait_event_interruptible_timeout(fepriv->wait_queue,
671 dvb_frontend_should_wakeup(fe) ||
672 kthread_should_stop() ||
673 freezing(current),
674 fepriv->delay);
675
676 if (kthread_should_stop() || dvb_frontend_is_exiting(fe)) {
677
678 if (!down_interruptible(&fepriv->sem))
679 semheld = true;
680 fe->exit = DVB_FE_NORMAL_EXIT;
681 break;
682 }
683
684 if (try_to_freeze())
685 goto restart;
686
687 if (down_interruptible(&fepriv->sem))
688 break;
689
690 if (fepriv->reinitialise) {
691 dvb_frontend_init(fe);
692 if (fe->ops.set_tone && fepriv->tone != -1)
693 fe->ops.set_tone(fe, fepriv->tone);
694 if (fe->ops.set_voltage && fepriv->voltage != -1)
695 fe->ops.set_voltage(fe, fepriv->voltage);
696 fepriv->reinitialise = 0;
697 }
698
699
700 if (fe->ops.get_frontend_algo) {
701 algo = fe->ops.get_frontend_algo(fe);
702 switch (algo) {
703 case DVBFE_ALGO_HW:
704 dev_dbg(fe->dvb->device, "%s: Frontend ALGO = DVBFE_ALGO_HW\n", __func__);
705
706 if (fepriv->state & FESTATE_RETUNE) {
707 dev_dbg(fe->dvb->device, "%s: Retune requested, FESTATE_RETUNE\n", __func__);
708 re_tune = true;
709 fepriv->state = FESTATE_TUNED;
710 } else {
711 re_tune = false;
712 }
713
714 if (fe->ops.tune)
715 fe->ops.tune(fe, re_tune, fepriv->tune_mode_flags, &fepriv->delay, &s);
716
717 if (s != fepriv->status && !(fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT)) {
718 dev_dbg(fe->dvb->device, "%s: state changed, adding current state\n", __func__);
719 dvb_frontend_add_event(fe, s);
720 fepriv->status = s;
721 }
722 break;
723 case DVBFE_ALGO_SW:
724 dev_dbg(fe->dvb->device, "%s: Frontend ALGO = DVBFE_ALGO_SW\n", __func__);
725 dvb_frontend_swzigzag(fe);
726 break;
727 case DVBFE_ALGO_CUSTOM:
728 dev_dbg(fe->dvb->device, "%s: Frontend ALGO = DVBFE_ALGO_CUSTOM, state=%d\n", __func__, fepriv->state);
729 if (fepriv->state & FESTATE_RETUNE) {
730 dev_dbg(fe->dvb->device, "%s: Retune requested, FESTAT_RETUNE\n", __func__);
731 fepriv->state = FESTATE_TUNED;
732 }
733
734
735
736
737 if (fepriv->algo_status & DVBFE_ALGO_SEARCH_AGAIN) {
738 if (fe->ops.search) {
739 fepriv->algo_status = fe->ops.search(fe);
740
741
742
743 } else {
744 fepriv->algo_status &= ~DVBFE_ALGO_SEARCH_AGAIN;
745 }
746 }
747
748 if (fepriv->algo_status != DVBFE_ALGO_SEARCH_SUCCESS) {
749 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN;
750 fepriv->delay = HZ / 2;
751 }
752 dtv_property_legacy_params_sync(fe, c, &fepriv->parameters_out);
753 fe->ops.read_status(fe, &s);
754 if (s != fepriv->status) {
755 dvb_frontend_add_event(fe, s);
756 fepriv->status = s;
757 if (!(s & FE_HAS_LOCK)) {
758 fepriv->delay = HZ / 10;
759 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN;
760 } else {
761 fepriv->delay = 60 * HZ;
762 }
763 }
764 break;
765 default:
766 dev_dbg(fe->dvb->device, "%s: UNDEFINED ALGO !\n", __func__);
767 break;
768 }
769 } else {
770 dvb_frontend_swzigzag(fe);
771 }
772 }
773
774 if (dvb_powerdown_on_sleep) {
775 if (fe->ops.set_voltage)
776 fe->ops.set_voltage(fe, SEC_VOLTAGE_OFF);
777 if (fe->ops.tuner_ops.sleep) {
778 if (fe->ops.i2c_gate_ctrl)
779 fe->ops.i2c_gate_ctrl(fe, 1);
780 fe->ops.tuner_ops.sleep(fe);
781 if (fe->ops.i2c_gate_ctrl)
782 fe->ops.i2c_gate_ctrl(fe, 0);
783 }
784 if (fe->ops.sleep)
785 fe->ops.sleep(fe);
786 }
787
788 fepriv->thread = NULL;
789 if (kthread_should_stop())
790 fe->exit = DVB_FE_DEVICE_REMOVED;
791 else
792 fe->exit = DVB_FE_NO_EXIT;
793 mb();
794
795 if (semheld)
796 up(&fepriv->sem);
797 dvb_frontend_wakeup(fe);
798 return 0;
799 }
800
801 static void dvb_frontend_stop(struct dvb_frontend *fe)
802 {
803 struct dvb_frontend_private *fepriv = fe->frontend_priv;
804
805 dev_dbg(fe->dvb->device, "%s:\n", __func__);
806
807 if (fe->exit != DVB_FE_DEVICE_REMOVED)
808 fe->exit = DVB_FE_NORMAL_EXIT;
809 mb();
810
811 if (!fepriv->thread)
812 return;
813
814 kthread_stop(fepriv->thread);
815
816 sema_init(&fepriv->sem, 1);
817 fepriv->state = FESTATE_IDLE;
818
819
820 if (fepriv->thread)
821 dev_warn(fe->dvb->device,
822 "dvb_frontend_stop: warning: thread %p won't exit\n",
823 fepriv->thread);
824 }
825
826
827
828
829
830
831
832
833 void dvb_frontend_sleep_until(ktime_t *waketime, u32 add_usec)
834 {
835 s32 delta;
836
837 *waketime = ktime_add_us(*waketime, add_usec);
838 delta = ktime_us_delta(ktime_get_boottime(), *waketime);
839 if (delta > 2500) {
840 msleep((delta - 1500) / 1000);
841 delta = ktime_us_delta(ktime_get_boottime(), *waketime);
842 }
843 if (delta > 0)
844 udelay(delta);
845 }
846 EXPORT_SYMBOL(dvb_frontend_sleep_until);
847
848 static int dvb_frontend_start(struct dvb_frontend *fe)
849 {
850 int ret;
851 struct dvb_frontend_private *fepriv = fe->frontend_priv;
852 struct task_struct *fe_thread;
853
854 dev_dbg(fe->dvb->device, "%s:\n", __func__);
855
856 if (fepriv->thread) {
857 if (fe->exit == DVB_FE_NO_EXIT)
858 return 0;
859 else
860 dvb_frontend_stop(fe);
861 }
862
863 if (signal_pending(current))
864 return -EINTR;
865 if (down_interruptible(&fepriv->sem))
866 return -EINTR;
867
868 fepriv->state = FESTATE_IDLE;
869 fe->exit = DVB_FE_NO_EXIT;
870 fepriv->thread = NULL;
871 mb();
872
873 fe_thread = kthread_run(dvb_frontend_thread, fe,
874 "kdvb-ad-%i-fe-%i", fe->dvb->num, fe->id);
875 if (IS_ERR(fe_thread)) {
876 ret = PTR_ERR(fe_thread);
877 dev_warn(fe->dvb->device,
878 "dvb_frontend_start: failed to start kthread (%d)\n",
879 ret);
880 up(&fepriv->sem);
881 return ret;
882 }
883 fepriv->thread = fe_thread;
884 return 0;
885 }
886
887 static void dvb_frontend_get_frequency_limits(struct dvb_frontend *fe,
888 u32 *freq_min, u32 *freq_max,
889 u32 *tolerance)
890 {
891 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
892 u32 tuner_min = fe->ops.tuner_ops.info.frequency_min_hz;
893 u32 tuner_max = fe->ops.tuner_ops.info.frequency_max_hz;
894 u32 frontend_min = fe->ops.info.frequency_min_hz;
895 u32 frontend_max = fe->ops.info.frequency_max_hz;
896
897 *freq_min = max(frontend_min, tuner_min);
898
899 if (frontend_max == 0)
900 *freq_max = tuner_max;
901 else if (tuner_max == 0)
902 *freq_max = frontend_max;
903 else
904 *freq_max = min(frontend_max, tuner_max);
905
906 if (*freq_min == 0 || *freq_max == 0)
907 dev_warn(fe->dvb->device,
908 "DVB: adapter %i frontend %u frequency limits undefined - fix the driver\n",
909 fe->dvb->num, fe->id);
910
911 dev_dbg(fe->dvb->device, "frequency interval: tuner: %u...%u, frontend: %u...%u",
912 tuner_min, tuner_max, frontend_min, frontend_max);
913
914
915 switch (c->delivery_system) {
916 case SYS_DVBS:
917 case SYS_DVBS2:
918 case SYS_TURBO:
919 case SYS_ISDBS:
920 *freq_min /= kHz;
921 *freq_max /= kHz;
922 if (tolerance)
923 *tolerance = fe->ops.info.frequency_tolerance_hz / kHz;
924
925 break;
926 default:
927 if (tolerance)
928 *tolerance = fe->ops.info.frequency_tolerance_hz;
929 break;
930 }
931 }
932
933 static u32 dvb_frontend_get_stepsize(struct dvb_frontend *fe)
934 {
935 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
936 u32 fe_step = fe->ops.info.frequency_stepsize_hz;
937 u32 tuner_step = fe->ops.tuner_ops.info.frequency_step_hz;
938 u32 step = max(fe_step, tuner_step);
939
940 switch (c->delivery_system) {
941 case SYS_DVBS:
942 case SYS_DVBS2:
943 case SYS_TURBO:
944 case SYS_ISDBS:
945 step /= kHz;
946 break;
947 default:
948 break;
949 }
950
951 return step;
952 }
953
954 static int dvb_frontend_check_parameters(struct dvb_frontend *fe)
955 {
956 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
957 u32 freq_min;
958 u32 freq_max;
959
960
961 dvb_frontend_get_frequency_limits(fe, &freq_min, &freq_max, NULL);
962 if ((freq_min && c->frequency < freq_min) ||
963 (freq_max && c->frequency > freq_max)) {
964 dev_warn(fe->dvb->device, "DVB: adapter %i frontend %i frequency %u out of range (%u..%u)\n",
965 fe->dvb->num, fe->id, c->frequency,
966 freq_min, freq_max);
967 return -EINVAL;
968 }
969
970
971 switch (c->delivery_system) {
972 case SYS_DVBS:
973 case SYS_DVBS2:
974 case SYS_TURBO:
975 case SYS_DVBC_ANNEX_A:
976 case SYS_DVBC_ANNEX_C:
977 if ((fe->ops.info.symbol_rate_min &&
978 c->symbol_rate < fe->ops.info.symbol_rate_min) ||
979 (fe->ops.info.symbol_rate_max &&
980 c->symbol_rate > fe->ops.info.symbol_rate_max)) {
981 dev_warn(fe->dvb->device, "DVB: adapter %i frontend %i symbol rate %u out of range (%u..%u)\n",
982 fe->dvb->num, fe->id, c->symbol_rate,
983 fe->ops.info.symbol_rate_min,
984 fe->ops.info.symbol_rate_max);
985 return -EINVAL;
986 }
987 default:
988 break;
989 }
990
991 return 0;
992 }
993
994 static int dvb_frontend_clear_cache(struct dvb_frontend *fe)
995 {
996 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
997 int i;
998 u32 delsys;
999
1000 delsys = c->delivery_system;
1001 memset(c, 0, offsetof(struct dtv_frontend_properties, strength));
1002 c->delivery_system = delsys;
1003
1004 dev_dbg(fe->dvb->device, "%s: Clearing cache for delivery system %d\n",
1005 __func__, c->delivery_system);
1006
1007 c->transmission_mode = TRANSMISSION_MODE_AUTO;
1008 c->bandwidth_hz = 0;
1009 c->guard_interval = GUARD_INTERVAL_AUTO;
1010 c->hierarchy = HIERARCHY_AUTO;
1011 c->symbol_rate = 0;
1012 c->code_rate_HP = FEC_AUTO;
1013 c->code_rate_LP = FEC_AUTO;
1014 c->fec_inner = FEC_AUTO;
1015 c->rolloff = ROLLOFF_AUTO;
1016 c->voltage = SEC_VOLTAGE_OFF;
1017 c->sectone = SEC_TONE_OFF;
1018 c->pilot = PILOT_AUTO;
1019
1020 c->isdbt_partial_reception = 0;
1021 c->isdbt_sb_mode = 0;
1022 c->isdbt_sb_subchannel = 0;
1023 c->isdbt_sb_segment_idx = 0;
1024 c->isdbt_sb_segment_count = 0;
1025 c->isdbt_layer_enabled = 7;
1026 for (i = 0; i < 3; i++) {
1027 c->layer[i].fec = FEC_AUTO;
1028 c->layer[i].modulation = QAM_AUTO;
1029 c->layer[i].interleaving = 0;
1030 c->layer[i].segment_count = 0;
1031 }
1032
1033 c->stream_id = NO_STREAM_ID_FILTER;
1034 c->scrambling_sequence_index = 0;
1035
1036 switch (c->delivery_system) {
1037 case SYS_DVBS:
1038 case SYS_DVBS2:
1039 case SYS_TURBO:
1040 c->modulation = QPSK;
1041 c->rolloff = ROLLOFF_35;
1042 break;
1043 case SYS_ATSC:
1044 c->modulation = VSB_8;
1045 break;
1046 case SYS_ISDBS:
1047 c->symbol_rate = 28860000;
1048 c->rolloff = ROLLOFF_35;
1049 c->bandwidth_hz = c->symbol_rate / 100 * 135;
1050 break;
1051 default:
1052 c->modulation = QAM_AUTO;
1053 break;
1054 }
1055
1056 c->lna = LNA_AUTO;
1057
1058 return 0;
1059 }
1060
1061 #define _DTV_CMD(n, s, b) \
1062 [n] = { \
1063 .name = #n, \
1064 .cmd = n, \
1065 .set = s,\
1066 .buffer = b \
1067 }
1068
1069 struct dtv_cmds_h {
1070 char *name;
1071
1072 __u32 cmd;
1073
1074
1075 __u32 set:1;
1076 __u32 buffer:1;
1077 __u32 reserved:30;
1078 };
1079
1080 static struct dtv_cmds_h dtv_cmds[DTV_MAX_COMMAND + 1] = {
1081 _DTV_CMD(DTV_TUNE, 1, 0),
1082 _DTV_CMD(DTV_CLEAR, 1, 0),
1083
1084
1085 _DTV_CMD(DTV_FREQUENCY, 1, 0),
1086 _DTV_CMD(DTV_BANDWIDTH_HZ, 1, 0),
1087 _DTV_CMD(DTV_MODULATION, 1, 0),
1088 _DTV_CMD(DTV_INVERSION, 1, 0),
1089 _DTV_CMD(DTV_DISEQC_MASTER, 1, 1),
1090 _DTV_CMD(DTV_SYMBOL_RATE, 1, 0),
1091 _DTV_CMD(DTV_INNER_FEC, 1, 0),
1092 _DTV_CMD(DTV_VOLTAGE, 1, 0),
1093 _DTV_CMD(DTV_TONE, 1, 0),
1094 _DTV_CMD(DTV_PILOT, 1, 0),
1095 _DTV_CMD(DTV_ROLLOFF, 1, 0),
1096 _DTV_CMD(DTV_DELIVERY_SYSTEM, 1, 0),
1097 _DTV_CMD(DTV_HIERARCHY, 1, 0),
1098 _DTV_CMD(DTV_CODE_RATE_HP, 1, 0),
1099 _DTV_CMD(DTV_CODE_RATE_LP, 1, 0),
1100 _DTV_CMD(DTV_GUARD_INTERVAL, 1, 0),
1101 _DTV_CMD(DTV_TRANSMISSION_MODE, 1, 0),
1102 _DTV_CMD(DTV_INTERLEAVING, 1, 0),
1103
1104 _DTV_CMD(DTV_ISDBT_PARTIAL_RECEPTION, 1, 0),
1105 _DTV_CMD(DTV_ISDBT_SOUND_BROADCASTING, 1, 0),
1106 _DTV_CMD(DTV_ISDBT_SB_SUBCHANNEL_ID, 1, 0),
1107 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_IDX, 1, 0),
1108 _DTV_CMD(DTV_ISDBT_SB_SEGMENT_COUNT, 1, 0),
1109 _DTV_CMD(DTV_ISDBT_LAYER_ENABLED, 1, 0),
1110 _DTV_CMD(DTV_ISDBT_LAYERA_FEC, 1, 0),
1111 _DTV_CMD(DTV_ISDBT_LAYERA_MODULATION, 1, 0),
1112 _DTV_CMD(DTV_ISDBT_LAYERA_SEGMENT_COUNT, 1, 0),
1113 _DTV_CMD(DTV_ISDBT_LAYERA_TIME_INTERLEAVING, 1, 0),
1114 _DTV_CMD(DTV_ISDBT_LAYERB_FEC, 1, 0),
1115 _DTV_CMD(DTV_ISDBT_LAYERB_MODULATION, 1, 0),
1116 _DTV_CMD(DTV_ISDBT_LAYERB_SEGMENT_COUNT, 1, 0),
1117 _DTV_CMD(DTV_ISDBT_LAYERB_TIME_INTERLEAVING, 1, 0),
1118 _DTV_CMD(DTV_ISDBT_LAYERC_FEC, 1, 0),
1119 _DTV_CMD(DTV_ISDBT_LAYERC_MODULATION, 1, 0),
1120 _DTV_CMD(DTV_ISDBT_LAYERC_SEGMENT_COUNT, 1, 0),
1121 _DTV_CMD(DTV_ISDBT_LAYERC_TIME_INTERLEAVING, 1, 0),
1122
1123 _DTV_CMD(DTV_STREAM_ID, 1, 0),
1124 _DTV_CMD(DTV_DVBT2_PLP_ID_LEGACY, 1, 0),
1125 _DTV_CMD(DTV_SCRAMBLING_SEQUENCE_INDEX, 1, 0),
1126 _DTV_CMD(DTV_LNA, 1, 0),
1127
1128
1129 _DTV_CMD(DTV_DISEQC_SLAVE_REPLY, 0, 1),
1130 _DTV_CMD(DTV_API_VERSION, 0, 0),
1131
1132 _DTV_CMD(DTV_ENUM_DELSYS, 0, 0),
1133
1134 _DTV_CMD(DTV_ATSCMH_PARADE_ID, 1, 0),
1135 _DTV_CMD(DTV_ATSCMH_RS_FRAME_ENSEMBLE, 1, 0),
1136
1137 _DTV_CMD(DTV_ATSCMH_FIC_VER, 0, 0),
1138 _DTV_CMD(DTV_ATSCMH_NOG, 0, 0),
1139 _DTV_CMD(DTV_ATSCMH_TNOG, 0, 0),
1140 _DTV_CMD(DTV_ATSCMH_SGN, 0, 0),
1141 _DTV_CMD(DTV_ATSCMH_PRC, 0, 0),
1142 _DTV_CMD(DTV_ATSCMH_RS_FRAME_MODE, 0, 0),
1143 _DTV_CMD(DTV_ATSCMH_RS_CODE_MODE_PRI, 0, 0),
1144 _DTV_CMD(DTV_ATSCMH_RS_CODE_MODE_SEC, 0, 0),
1145 _DTV_CMD(DTV_ATSCMH_SCCC_BLOCK_MODE, 0, 0),
1146 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_A, 0, 0),
1147 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_B, 0, 0),
1148 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_C, 0, 0),
1149 _DTV_CMD(DTV_ATSCMH_SCCC_CODE_MODE_D, 0, 0),
1150
1151
1152 _DTV_CMD(DTV_STAT_SIGNAL_STRENGTH, 0, 0),
1153 _DTV_CMD(DTV_STAT_CNR, 0, 0),
1154 _DTV_CMD(DTV_STAT_PRE_ERROR_BIT_COUNT, 0, 0),
1155 _DTV_CMD(DTV_STAT_PRE_TOTAL_BIT_COUNT, 0, 0),
1156 _DTV_CMD(DTV_STAT_POST_ERROR_BIT_COUNT, 0, 0),
1157 _DTV_CMD(DTV_STAT_POST_TOTAL_BIT_COUNT, 0, 0),
1158 _DTV_CMD(DTV_STAT_ERROR_BLOCK_COUNT, 0, 0),
1159 _DTV_CMD(DTV_STAT_TOTAL_BLOCK_COUNT, 0, 0),
1160 };
1161
1162
1163
1164
1165
1166 static int dtv_property_cache_sync(struct dvb_frontend *fe,
1167 struct dtv_frontend_properties *c,
1168 const struct dvb_frontend_parameters *p)
1169 {
1170 c->frequency = p->frequency;
1171 c->inversion = p->inversion;
1172
1173 switch (dvbv3_type(c->delivery_system)) {
1174 case DVBV3_QPSK:
1175 dev_dbg(fe->dvb->device, "%s: Preparing QPSK req\n", __func__);
1176 c->symbol_rate = p->u.qpsk.symbol_rate;
1177 c->fec_inner = p->u.qpsk.fec_inner;
1178 break;
1179 case DVBV3_QAM:
1180 dev_dbg(fe->dvb->device, "%s: Preparing QAM req\n", __func__);
1181 c->symbol_rate = p->u.qam.symbol_rate;
1182 c->fec_inner = p->u.qam.fec_inner;
1183 c->modulation = p->u.qam.modulation;
1184 break;
1185 case DVBV3_OFDM:
1186 dev_dbg(fe->dvb->device, "%s: Preparing OFDM req\n", __func__);
1187
1188 switch (p->u.ofdm.bandwidth) {
1189 case BANDWIDTH_10_MHZ:
1190 c->bandwidth_hz = 10000000;
1191 break;
1192 case BANDWIDTH_8_MHZ:
1193 c->bandwidth_hz = 8000000;
1194 break;
1195 case BANDWIDTH_7_MHZ:
1196 c->bandwidth_hz = 7000000;
1197 break;
1198 case BANDWIDTH_6_MHZ:
1199 c->bandwidth_hz = 6000000;
1200 break;
1201 case BANDWIDTH_5_MHZ:
1202 c->bandwidth_hz = 5000000;
1203 break;
1204 case BANDWIDTH_1_712_MHZ:
1205 c->bandwidth_hz = 1712000;
1206 break;
1207 case BANDWIDTH_AUTO:
1208 c->bandwidth_hz = 0;
1209 }
1210
1211 c->code_rate_HP = p->u.ofdm.code_rate_HP;
1212 c->code_rate_LP = p->u.ofdm.code_rate_LP;
1213 c->modulation = p->u.ofdm.constellation;
1214 c->transmission_mode = p->u.ofdm.transmission_mode;
1215 c->guard_interval = p->u.ofdm.guard_interval;
1216 c->hierarchy = p->u.ofdm.hierarchy_information;
1217 break;
1218 case DVBV3_ATSC:
1219 dev_dbg(fe->dvb->device, "%s: Preparing ATSC req\n", __func__);
1220 c->modulation = p->u.vsb.modulation;
1221 if (c->delivery_system == SYS_ATSCMH)
1222 break;
1223 if ((c->modulation == VSB_8) || (c->modulation == VSB_16))
1224 c->delivery_system = SYS_ATSC;
1225 else
1226 c->delivery_system = SYS_DVBC_ANNEX_B;
1227 break;
1228 case DVBV3_UNKNOWN:
1229 dev_err(fe->dvb->device,
1230 "%s: doesn't know how to handle a DVBv3 call to delivery system %i\n",
1231 __func__, c->delivery_system);
1232 return -EINVAL;
1233 }
1234
1235 return 0;
1236 }
1237
1238
1239
1240
1241 static int
1242 dtv_property_legacy_params_sync(struct dvb_frontend *fe,
1243 const struct dtv_frontend_properties *c,
1244 struct dvb_frontend_parameters *p)
1245 {
1246 p->frequency = c->frequency;
1247 p->inversion = c->inversion;
1248
1249 switch (dvbv3_type(c->delivery_system)) {
1250 case DVBV3_UNKNOWN:
1251 dev_err(fe->dvb->device,
1252 "%s: doesn't know how to handle a DVBv3 call to delivery system %i\n",
1253 __func__, c->delivery_system);
1254 return -EINVAL;
1255 case DVBV3_QPSK:
1256 dev_dbg(fe->dvb->device, "%s: Preparing QPSK req\n", __func__);
1257 p->u.qpsk.symbol_rate = c->symbol_rate;
1258 p->u.qpsk.fec_inner = c->fec_inner;
1259 break;
1260 case DVBV3_QAM:
1261 dev_dbg(fe->dvb->device, "%s: Preparing QAM req\n", __func__);
1262 p->u.qam.symbol_rate = c->symbol_rate;
1263 p->u.qam.fec_inner = c->fec_inner;
1264 p->u.qam.modulation = c->modulation;
1265 break;
1266 case DVBV3_OFDM:
1267 dev_dbg(fe->dvb->device, "%s: Preparing OFDM req\n", __func__);
1268 switch (c->bandwidth_hz) {
1269 case 10000000:
1270 p->u.ofdm.bandwidth = BANDWIDTH_10_MHZ;
1271 break;
1272 case 8000000:
1273 p->u.ofdm.bandwidth = BANDWIDTH_8_MHZ;
1274 break;
1275 case 7000000:
1276 p->u.ofdm.bandwidth = BANDWIDTH_7_MHZ;
1277 break;
1278 case 6000000:
1279 p->u.ofdm.bandwidth = BANDWIDTH_6_MHZ;
1280 break;
1281 case 5000000:
1282 p->u.ofdm.bandwidth = BANDWIDTH_5_MHZ;
1283 break;
1284 case 1712000:
1285 p->u.ofdm.bandwidth = BANDWIDTH_1_712_MHZ;
1286 break;
1287 case 0:
1288 default:
1289 p->u.ofdm.bandwidth = BANDWIDTH_AUTO;
1290 }
1291 p->u.ofdm.code_rate_HP = c->code_rate_HP;
1292 p->u.ofdm.code_rate_LP = c->code_rate_LP;
1293 p->u.ofdm.constellation = c->modulation;
1294 p->u.ofdm.transmission_mode = c->transmission_mode;
1295 p->u.ofdm.guard_interval = c->guard_interval;
1296 p->u.ofdm.hierarchy_information = c->hierarchy;
1297 break;
1298 case DVBV3_ATSC:
1299 dev_dbg(fe->dvb->device, "%s: Preparing VSB req\n", __func__);
1300 p->u.vsb.modulation = c->modulation;
1301 break;
1302 }
1303 return 0;
1304 }
1305
1306
1307
1308
1309
1310
1311
1312
1313
1314
1315
1316 static int dtv_get_frontend(struct dvb_frontend *fe,
1317 struct dtv_frontend_properties *c,
1318 struct dvb_frontend_parameters *p_out)
1319 {
1320 int r;
1321
1322 if (fe->ops.get_frontend) {
1323 r = fe->ops.get_frontend(fe, c);
1324 if (unlikely(r < 0))
1325 return r;
1326 if (p_out)
1327 dtv_property_legacy_params_sync(fe, c, p_out);
1328 return 0;
1329 }
1330
1331
1332 return 0;
1333 }
1334
1335 static int dvb_frontend_handle_ioctl(struct file *file,
1336 unsigned int cmd, void *parg);
1337
1338 static int dtv_property_process_get(struct dvb_frontend *fe,
1339 const struct dtv_frontend_properties *c,
1340 struct dtv_property *tvp,
1341 struct file *file)
1342 {
1343 int ncaps;
1344
1345 switch (tvp->cmd) {
1346 case DTV_ENUM_DELSYS:
1347 ncaps = 0;
1348 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) {
1349 tvp->u.buffer.data[ncaps] = fe->ops.delsys[ncaps];
1350 ncaps++;
1351 }
1352 tvp->u.buffer.len = ncaps;
1353 break;
1354 case DTV_FREQUENCY:
1355 tvp->u.data = c->frequency;
1356 break;
1357 case DTV_MODULATION:
1358 tvp->u.data = c->modulation;
1359 break;
1360 case DTV_BANDWIDTH_HZ:
1361 tvp->u.data = c->bandwidth_hz;
1362 break;
1363 case DTV_INVERSION:
1364 tvp->u.data = c->inversion;
1365 break;
1366 case DTV_SYMBOL_RATE:
1367 tvp->u.data = c->symbol_rate;
1368 break;
1369 case DTV_INNER_FEC:
1370 tvp->u.data = c->fec_inner;
1371 break;
1372 case DTV_PILOT:
1373 tvp->u.data = c->pilot;
1374 break;
1375 case DTV_ROLLOFF:
1376 tvp->u.data = c->rolloff;
1377 break;
1378 case DTV_DELIVERY_SYSTEM:
1379 tvp->u.data = c->delivery_system;
1380 break;
1381 case DTV_VOLTAGE:
1382 tvp->u.data = c->voltage;
1383 break;
1384 case DTV_TONE:
1385 tvp->u.data = c->sectone;
1386 break;
1387 case DTV_API_VERSION:
1388 tvp->u.data = (DVB_API_VERSION << 8) | DVB_API_VERSION_MINOR;
1389 break;
1390 case DTV_CODE_RATE_HP:
1391 tvp->u.data = c->code_rate_HP;
1392 break;
1393 case DTV_CODE_RATE_LP:
1394 tvp->u.data = c->code_rate_LP;
1395 break;
1396 case DTV_GUARD_INTERVAL:
1397 tvp->u.data = c->guard_interval;
1398 break;
1399 case DTV_TRANSMISSION_MODE:
1400 tvp->u.data = c->transmission_mode;
1401 break;
1402 case DTV_HIERARCHY:
1403 tvp->u.data = c->hierarchy;
1404 break;
1405 case DTV_INTERLEAVING:
1406 tvp->u.data = c->interleaving;
1407 break;
1408
1409
1410 case DTV_ISDBT_PARTIAL_RECEPTION:
1411 tvp->u.data = c->isdbt_partial_reception;
1412 break;
1413 case DTV_ISDBT_SOUND_BROADCASTING:
1414 tvp->u.data = c->isdbt_sb_mode;
1415 break;
1416 case DTV_ISDBT_SB_SUBCHANNEL_ID:
1417 tvp->u.data = c->isdbt_sb_subchannel;
1418 break;
1419 case DTV_ISDBT_SB_SEGMENT_IDX:
1420 tvp->u.data = c->isdbt_sb_segment_idx;
1421 break;
1422 case DTV_ISDBT_SB_SEGMENT_COUNT:
1423 tvp->u.data = c->isdbt_sb_segment_count;
1424 break;
1425 case DTV_ISDBT_LAYER_ENABLED:
1426 tvp->u.data = c->isdbt_layer_enabled;
1427 break;
1428 case DTV_ISDBT_LAYERA_FEC:
1429 tvp->u.data = c->layer[0].fec;
1430 break;
1431 case DTV_ISDBT_LAYERA_MODULATION:
1432 tvp->u.data = c->layer[0].modulation;
1433 break;
1434 case DTV_ISDBT_LAYERA_SEGMENT_COUNT:
1435 tvp->u.data = c->layer[0].segment_count;
1436 break;
1437 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING:
1438 tvp->u.data = c->layer[0].interleaving;
1439 break;
1440 case DTV_ISDBT_LAYERB_FEC:
1441 tvp->u.data = c->layer[1].fec;
1442 break;
1443 case DTV_ISDBT_LAYERB_MODULATION:
1444 tvp->u.data = c->layer[1].modulation;
1445 break;
1446 case DTV_ISDBT_LAYERB_SEGMENT_COUNT:
1447 tvp->u.data = c->layer[1].segment_count;
1448 break;
1449 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING:
1450 tvp->u.data = c->layer[1].interleaving;
1451 break;
1452 case DTV_ISDBT_LAYERC_FEC:
1453 tvp->u.data = c->layer[2].fec;
1454 break;
1455 case DTV_ISDBT_LAYERC_MODULATION:
1456 tvp->u.data = c->layer[2].modulation;
1457 break;
1458 case DTV_ISDBT_LAYERC_SEGMENT_COUNT:
1459 tvp->u.data = c->layer[2].segment_count;
1460 break;
1461 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING:
1462 tvp->u.data = c->layer[2].interleaving;
1463 break;
1464
1465
1466 case DTV_STREAM_ID:
1467 case DTV_DVBT2_PLP_ID_LEGACY:
1468 tvp->u.data = c->stream_id;
1469 break;
1470
1471
1472 case DTV_SCRAMBLING_SEQUENCE_INDEX:
1473 tvp->u.data = c->scrambling_sequence_index;
1474 break;
1475
1476
1477 case DTV_ATSCMH_FIC_VER:
1478 tvp->u.data = fe->dtv_property_cache.atscmh_fic_ver;
1479 break;
1480 case DTV_ATSCMH_PARADE_ID:
1481 tvp->u.data = fe->dtv_property_cache.atscmh_parade_id;
1482 break;
1483 case DTV_ATSCMH_NOG:
1484 tvp->u.data = fe->dtv_property_cache.atscmh_nog;
1485 break;
1486 case DTV_ATSCMH_TNOG:
1487 tvp->u.data = fe->dtv_property_cache.atscmh_tnog;
1488 break;
1489 case DTV_ATSCMH_SGN:
1490 tvp->u.data = fe->dtv_property_cache.atscmh_sgn;
1491 break;
1492 case DTV_ATSCMH_PRC:
1493 tvp->u.data = fe->dtv_property_cache.atscmh_prc;
1494 break;
1495 case DTV_ATSCMH_RS_FRAME_MODE:
1496 tvp->u.data = fe->dtv_property_cache.atscmh_rs_frame_mode;
1497 break;
1498 case DTV_ATSCMH_RS_FRAME_ENSEMBLE:
1499 tvp->u.data = fe->dtv_property_cache.atscmh_rs_frame_ensemble;
1500 break;
1501 case DTV_ATSCMH_RS_CODE_MODE_PRI:
1502 tvp->u.data = fe->dtv_property_cache.atscmh_rs_code_mode_pri;
1503 break;
1504 case DTV_ATSCMH_RS_CODE_MODE_SEC:
1505 tvp->u.data = fe->dtv_property_cache.atscmh_rs_code_mode_sec;
1506 break;
1507 case DTV_ATSCMH_SCCC_BLOCK_MODE:
1508 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_block_mode;
1509 break;
1510 case DTV_ATSCMH_SCCC_CODE_MODE_A:
1511 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_a;
1512 break;
1513 case DTV_ATSCMH_SCCC_CODE_MODE_B:
1514 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_b;
1515 break;
1516 case DTV_ATSCMH_SCCC_CODE_MODE_C:
1517 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_c;
1518 break;
1519 case DTV_ATSCMH_SCCC_CODE_MODE_D:
1520 tvp->u.data = fe->dtv_property_cache.atscmh_sccc_code_mode_d;
1521 break;
1522
1523 case DTV_LNA:
1524 tvp->u.data = c->lna;
1525 break;
1526
1527
1528 case DTV_STAT_SIGNAL_STRENGTH:
1529 tvp->u.st = c->strength;
1530 break;
1531 case DTV_STAT_CNR:
1532 tvp->u.st = c->cnr;
1533 break;
1534 case DTV_STAT_PRE_ERROR_BIT_COUNT:
1535 tvp->u.st = c->pre_bit_error;
1536 break;
1537 case DTV_STAT_PRE_TOTAL_BIT_COUNT:
1538 tvp->u.st = c->pre_bit_count;
1539 break;
1540 case DTV_STAT_POST_ERROR_BIT_COUNT:
1541 tvp->u.st = c->post_bit_error;
1542 break;
1543 case DTV_STAT_POST_TOTAL_BIT_COUNT:
1544 tvp->u.st = c->post_bit_count;
1545 break;
1546 case DTV_STAT_ERROR_BLOCK_COUNT:
1547 tvp->u.st = c->block_error;
1548 break;
1549 case DTV_STAT_TOTAL_BLOCK_COUNT:
1550 tvp->u.st = c->block_count;
1551 break;
1552 default:
1553 dev_dbg(fe->dvb->device,
1554 "%s: FE property %d doesn't exist\n",
1555 __func__, tvp->cmd);
1556 return -EINVAL;
1557 }
1558
1559 if (!dtv_cmds[tvp->cmd].buffer)
1560 dev_dbg(fe->dvb->device,
1561 "%s: GET cmd 0x%08x (%s) = 0x%08x\n",
1562 __func__, tvp->cmd, dtv_cmds[tvp->cmd].name,
1563 tvp->u.data);
1564 else
1565 dev_dbg(fe->dvb->device,
1566 "%s: GET cmd 0x%08x (%s) len %d: %*ph\n",
1567 __func__,
1568 tvp->cmd, dtv_cmds[tvp->cmd].name,
1569 tvp->u.buffer.len,
1570 tvp->u.buffer.len, tvp->u.buffer.data);
1571
1572 return 0;
1573 }
1574
1575 static int dtv_set_frontend(struct dvb_frontend *fe);
1576
1577 static bool is_dvbv3_delsys(u32 delsys)
1578 {
1579 return (delsys == SYS_DVBT) || (delsys == SYS_DVBC_ANNEX_A) ||
1580 (delsys == SYS_DVBS) || (delsys == SYS_ATSC);
1581 }
1582
1583
1584
1585
1586
1587
1588
1589
1590
1591
1592
1593 static int emulate_delivery_system(struct dvb_frontend *fe, u32 delsys)
1594 {
1595 int i;
1596 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1597
1598 c->delivery_system = delsys;
1599
1600
1601
1602
1603 if (c->delivery_system == SYS_ISDBT) {
1604 dev_dbg(fe->dvb->device,
1605 "%s: Using defaults for SYS_ISDBT\n",
1606 __func__);
1607
1608 if (!c->bandwidth_hz)
1609 c->bandwidth_hz = 6000000;
1610
1611 c->isdbt_partial_reception = 0;
1612 c->isdbt_sb_mode = 0;
1613 c->isdbt_sb_subchannel = 0;
1614 c->isdbt_sb_segment_idx = 0;
1615 c->isdbt_sb_segment_count = 0;
1616 c->isdbt_layer_enabled = 7;
1617 for (i = 0; i < 3; i++) {
1618 c->layer[i].fec = FEC_AUTO;
1619 c->layer[i].modulation = QAM_AUTO;
1620 c->layer[i].interleaving = 0;
1621 c->layer[i].segment_count = 0;
1622 }
1623 }
1624 dev_dbg(fe->dvb->device, "%s: change delivery system on cache to %d\n",
1625 __func__, c->delivery_system);
1626
1627 return 0;
1628 }
1629
1630
1631
1632
1633
1634
1635
1636
1637
1638
1639
1640
1641
1642
1643
1644
1645
1646
1647 static int dvbv5_set_delivery_system(struct dvb_frontend *fe,
1648 u32 desired_system)
1649 {
1650 int ncaps;
1651 u32 delsys = SYS_UNDEFINED;
1652 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1653 enum dvbv3_emulation_type type;
1654
1655
1656
1657
1658
1659
1660
1661 if (desired_system == SYS_UNDEFINED)
1662 desired_system = fe->ops.delsys[0];
1663
1664
1665
1666
1667
1668
1669 ncaps = 0;
1670 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) {
1671 if (fe->ops.delsys[ncaps] == desired_system) {
1672 c->delivery_system = desired_system;
1673 dev_dbg(fe->dvb->device,
1674 "%s: Changing delivery system to %d\n",
1675 __func__, desired_system);
1676 return 0;
1677 }
1678 ncaps++;
1679 }
1680
1681
1682
1683
1684
1685
1686
1687
1688 if (!is_dvbv3_delsys(desired_system)) {
1689 dev_dbg(fe->dvb->device,
1690 "%s: Delivery system %d not supported.\n",
1691 __func__, desired_system);
1692 return -EINVAL;
1693 }
1694
1695 type = dvbv3_type(desired_system);
1696
1697
1698
1699
1700
1701 ncaps = 0;
1702 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) {
1703 if (dvbv3_type(fe->ops.delsys[ncaps]) == type)
1704 delsys = fe->ops.delsys[ncaps];
1705 ncaps++;
1706 }
1707
1708
1709 if (delsys == SYS_UNDEFINED) {
1710 dev_dbg(fe->dvb->device,
1711 "%s: Delivery system %d not supported on emulation mode.\n",
1712 __func__, desired_system);
1713 return -EINVAL;
1714 }
1715
1716 dev_dbg(fe->dvb->device,
1717 "%s: Using delivery system %d emulated as if it were %d\n",
1718 __func__, delsys, desired_system);
1719
1720 return emulate_delivery_system(fe, desired_system);
1721 }
1722
1723
1724
1725
1726
1727
1728
1729
1730
1731
1732
1733
1734
1735
1736
1737
1738
1739
1740
1741
1742
1743
1744
1745
1746
1747
1748
1749
1750
1751 static int dvbv3_set_delivery_system(struct dvb_frontend *fe)
1752 {
1753 int ncaps;
1754 u32 delsys = SYS_UNDEFINED;
1755 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1756
1757
1758 if (c->delivery_system == SYS_UNDEFINED)
1759 c->delivery_system = fe->ops.delsys[0];
1760
1761
1762
1763
1764
1765 if (is_dvbv3_delsys(c->delivery_system)) {
1766 dev_dbg(fe->dvb->device,
1767 "%s: Using delivery system to %d\n",
1768 __func__, c->delivery_system);
1769 return 0;
1770 }
1771
1772
1773
1774
1775
1776 ncaps = 0;
1777 while (ncaps < MAX_DELSYS && fe->ops.delsys[ncaps]) {
1778 if (dvbv3_type(fe->ops.delsys[ncaps]) != DVBV3_UNKNOWN) {
1779 delsys = fe->ops.delsys[ncaps];
1780 break;
1781 }
1782 ncaps++;
1783 }
1784 if (delsys == SYS_UNDEFINED) {
1785 dev_dbg(fe->dvb->device,
1786 "%s: Couldn't find a delivery system that works with FE_SET_FRONTEND\n",
1787 __func__);
1788 return -EINVAL;
1789 }
1790 return emulate_delivery_system(fe, delsys);
1791 }
1792
1793
1794
1795
1796
1797
1798
1799
1800
1801
1802
1803
1804
1805
1806
1807 static int dtv_property_process_set(struct dvb_frontend *fe,
1808 struct file *file,
1809 u32 cmd, u32 data)
1810 {
1811 int r = 0;
1812 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
1813
1814
1815 if (!cmd || cmd > DTV_MAX_COMMAND)
1816 dev_warn(fe->dvb->device, "%s: SET cmd 0x%08x undefined\n",
1817 __func__, cmd);
1818 else
1819 dev_dbg(fe->dvb->device,
1820 "%s: SET cmd 0x%08x (%s) to 0x%08x\n",
1821 __func__, cmd, dtv_cmds[cmd].name, data);
1822 switch (cmd) {
1823 case DTV_CLEAR:
1824
1825
1826
1827
1828 dvb_frontend_clear_cache(fe);
1829 break;
1830 case DTV_TUNE:
1831
1832
1833
1834
1835 dev_dbg(fe->dvb->device,
1836 "%s: Setting the frontend from property cache\n",
1837 __func__);
1838
1839 r = dtv_set_frontend(fe);
1840 break;
1841 case DTV_FREQUENCY:
1842 c->frequency = data;
1843 break;
1844 case DTV_MODULATION:
1845 c->modulation = data;
1846 break;
1847 case DTV_BANDWIDTH_HZ:
1848 c->bandwidth_hz = data;
1849 break;
1850 case DTV_INVERSION:
1851 c->inversion = data;
1852 break;
1853 case DTV_SYMBOL_RATE:
1854 c->symbol_rate = data;
1855 break;
1856 case DTV_INNER_FEC:
1857 c->fec_inner = data;
1858 break;
1859 case DTV_PILOT:
1860 c->pilot = data;
1861 break;
1862 case DTV_ROLLOFF:
1863 c->rolloff = data;
1864 break;
1865 case DTV_DELIVERY_SYSTEM:
1866 r = dvbv5_set_delivery_system(fe, data);
1867 break;
1868 case DTV_VOLTAGE:
1869 c->voltage = data;
1870 r = dvb_frontend_handle_ioctl(file, FE_SET_VOLTAGE,
1871 (void *)c->voltage);
1872 break;
1873 case DTV_TONE:
1874 c->sectone = data;
1875 r = dvb_frontend_handle_ioctl(file, FE_SET_TONE,
1876 (void *)c->sectone);
1877 break;
1878 case DTV_CODE_RATE_HP:
1879 c->code_rate_HP = data;
1880 break;
1881 case DTV_CODE_RATE_LP:
1882 c->code_rate_LP = data;
1883 break;
1884 case DTV_GUARD_INTERVAL:
1885 c->guard_interval = data;
1886 break;
1887 case DTV_TRANSMISSION_MODE:
1888 c->transmission_mode = data;
1889 break;
1890 case DTV_HIERARCHY:
1891 c->hierarchy = data;
1892 break;
1893 case DTV_INTERLEAVING:
1894 c->interleaving = data;
1895 break;
1896
1897
1898 case DTV_ISDBT_PARTIAL_RECEPTION:
1899 c->isdbt_partial_reception = data;
1900 break;
1901 case DTV_ISDBT_SOUND_BROADCASTING:
1902 c->isdbt_sb_mode = data;
1903 break;
1904 case DTV_ISDBT_SB_SUBCHANNEL_ID:
1905 c->isdbt_sb_subchannel = data;
1906 break;
1907 case DTV_ISDBT_SB_SEGMENT_IDX:
1908 c->isdbt_sb_segment_idx = data;
1909 break;
1910 case DTV_ISDBT_SB_SEGMENT_COUNT:
1911 c->isdbt_sb_segment_count = data;
1912 break;
1913 case DTV_ISDBT_LAYER_ENABLED:
1914 c->isdbt_layer_enabled = data;
1915 break;
1916 case DTV_ISDBT_LAYERA_FEC:
1917 c->layer[0].fec = data;
1918 break;
1919 case DTV_ISDBT_LAYERA_MODULATION:
1920 c->layer[0].modulation = data;
1921 break;
1922 case DTV_ISDBT_LAYERA_SEGMENT_COUNT:
1923 c->layer[0].segment_count = data;
1924 break;
1925 case DTV_ISDBT_LAYERA_TIME_INTERLEAVING:
1926 c->layer[0].interleaving = data;
1927 break;
1928 case DTV_ISDBT_LAYERB_FEC:
1929 c->layer[1].fec = data;
1930 break;
1931 case DTV_ISDBT_LAYERB_MODULATION:
1932 c->layer[1].modulation = data;
1933 break;
1934 case DTV_ISDBT_LAYERB_SEGMENT_COUNT:
1935 c->layer[1].segment_count = data;
1936 break;
1937 case DTV_ISDBT_LAYERB_TIME_INTERLEAVING:
1938 c->layer[1].interleaving = data;
1939 break;
1940 case DTV_ISDBT_LAYERC_FEC:
1941 c->layer[2].fec = data;
1942 break;
1943 case DTV_ISDBT_LAYERC_MODULATION:
1944 c->layer[2].modulation = data;
1945 break;
1946 case DTV_ISDBT_LAYERC_SEGMENT_COUNT:
1947 c->layer[2].segment_count = data;
1948 break;
1949 case DTV_ISDBT_LAYERC_TIME_INTERLEAVING:
1950 c->layer[2].interleaving = data;
1951 break;
1952
1953
1954 case DTV_STREAM_ID:
1955 case DTV_DVBT2_PLP_ID_LEGACY:
1956 c->stream_id = data;
1957 break;
1958
1959
1960 case DTV_SCRAMBLING_SEQUENCE_INDEX:
1961 c->scrambling_sequence_index = data;
1962 break;
1963
1964
1965 case DTV_ATSCMH_PARADE_ID:
1966 fe->dtv_property_cache.atscmh_parade_id = data;
1967 break;
1968 case DTV_ATSCMH_RS_FRAME_ENSEMBLE:
1969 fe->dtv_property_cache.atscmh_rs_frame_ensemble = data;
1970 break;
1971
1972 case DTV_LNA:
1973 c->lna = data;
1974 if (fe->ops.set_lna)
1975 r = fe->ops.set_lna(fe);
1976 if (r < 0)
1977 c->lna = LNA_AUTO;
1978 break;
1979
1980 default:
1981 return -EINVAL;
1982 }
1983
1984 return r;
1985 }
1986
1987 static int dvb_frontend_do_ioctl(struct file *file, unsigned int cmd,
1988 void *parg)
1989 {
1990 struct dvb_device *dvbdev = file->private_data;
1991 struct dvb_frontend *fe = dvbdev->priv;
1992 struct dvb_frontend_private *fepriv = fe->frontend_priv;
1993 int err;
1994
1995 dev_dbg(fe->dvb->device, "%s: (%d)\n", __func__, _IOC_NR(cmd));
1996 if (down_interruptible(&fepriv->sem))
1997 return -ERESTARTSYS;
1998
1999 if (fe->exit != DVB_FE_NO_EXIT) {
2000 up(&fepriv->sem);
2001 return -ENODEV;
2002 }
2003
2004
2005
2006
2007
2008
2009
2010
2011
2012
2013
2014
2015
2016
2017 if ((file->f_flags & O_ACCMODE) == O_RDONLY
2018 && (_IOC_DIR(cmd) != _IOC_READ
2019 || cmd == FE_GET_EVENT
2020 || cmd == FE_DISEQC_RECV_SLAVE_REPLY)) {
2021 up(&fepriv->sem);
2022 return -EPERM;
2023 }
2024
2025 err = dvb_frontend_handle_ioctl(file, cmd, parg);
2026
2027 up(&fepriv->sem);
2028 return err;
2029 }
2030
2031 static long dvb_frontend_ioctl(struct file *file, unsigned int cmd,
2032 unsigned long arg)
2033 {
2034 struct dvb_device *dvbdev = file->private_data;
2035
2036 if (!dvbdev)
2037 return -ENODEV;
2038
2039 return dvb_usercopy(file, cmd, arg, dvb_frontend_do_ioctl);
2040 }
2041
2042 #ifdef CONFIG_COMPAT
2043 struct compat_dtv_property {
2044 __u32 cmd;
2045 __u32 reserved[3];
2046 union {
2047 __u32 data;
2048 struct dtv_fe_stats st;
2049 struct {
2050 __u8 data[32];
2051 __u32 len;
2052 __u32 reserved1[3];
2053 compat_uptr_t reserved2;
2054 } buffer;
2055 } u;
2056 int result;
2057 } __attribute__ ((packed));
2058
2059 struct compat_dtv_properties {
2060 __u32 num;
2061 compat_uptr_t props;
2062 };
2063
2064 #define COMPAT_FE_SET_PROPERTY _IOW('o', 82, struct compat_dtv_properties)
2065 #define COMPAT_FE_GET_PROPERTY _IOR('o', 83, struct compat_dtv_properties)
2066
2067 static int dvb_frontend_handle_compat_ioctl(struct file *file, unsigned int cmd,
2068 unsigned long arg)
2069 {
2070 struct dvb_device *dvbdev = file->private_data;
2071 struct dvb_frontend *fe = dvbdev->priv;
2072 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2073 int i, err = 0;
2074
2075 if (cmd == COMPAT_FE_SET_PROPERTY) {
2076 struct compat_dtv_properties prop, *tvps = NULL;
2077 struct compat_dtv_property *tvp = NULL;
2078
2079 if (copy_from_user(&prop, compat_ptr(arg), sizeof(prop)))
2080 return -EFAULT;
2081
2082 tvps = ∝
2083
2084
2085
2086
2087
2088 if (!tvps->num || (tvps->num > DTV_IOCTL_MAX_MSGS))
2089 return -EINVAL;
2090
2091 tvp = memdup_user(compat_ptr(tvps->props), tvps->num * sizeof(*tvp));
2092 if (IS_ERR(tvp))
2093 return PTR_ERR(tvp);
2094
2095 for (i = 0; i < tvps->num; i++) {
2096 err = dtv_property_process_set(fe, file,
2097 (tvp + i)->cmd,
2098 (tvp + i)->u.data);
2099 if (err < 0) {
2100 kfree(tvp);
2101 return err;
2102 }
2103 }
2104 kfree(tvp);
2105 } else if (cmd == COMPAT_FE_GET_PROPERTY) {
2106 struct compat_dtv_properties prop, *tvps = NULL;
2107 struct compat_dtv_property *tvp = NULL;
2108 struct dtv_frontend_properties getp = fe->dtv_property_cache;
2109
2110 if (copy_from_user(&prop, compat_ptr(arg), sizeof(prop)))
2111 return -EFAULT;
2112
2113 tvps = ∝
2114
2115
2116
2117
2118
2119 if (!tvps->num || (tvps->num > DTV_IOCTL_MAX_MSGS))
2120 return -EINVAL;
2121
2122 tvp = memdup_user(compat_ptr(tvps->props), tvps->num * sizeof(*tvp));
2123 if (IS_ERR(tvp))
2124 return PTR_ERR(tvp);
2125
2126
2127
2128
2129
2130
2131
2132 if (fepriv->state != FESTATE_IDLE) {
2133 err = dtv_get_frontend(fe, &getp, NULL);
2134 if (err < 0) {
2135 kfree(tvp);
2136 return err;
2137 }
2138 }
2139 for (i = 0; i < tvps->num; i++) {
2140 err = dtv_property_process_get(
2141 fe, &getp, (struct dtv_property *)(tvp + i), file);
2142 if (err < 0) {
2143 kfree(tvp);
2144 return err;
2145 }
2146 }
2147
2148 if (copy_to_user((void __user *)compat_ptr(tvps->props), tvp,
2149 tvps->num * sizeof(struct compat_dtv_property))) {
2150 kfree(tvp);
2151 return -EFAULT;
2152 }
2153 kfree(tvp);
2154 }
2155
2156 return err;
2157 }
2158
2159 static long dvb_frontend_compat_ioctl(struct file *file, unsigned int cmd,
2160 unsigned long arg)
2161 {
2162 struct dvb_device *dvbdev = file->private_data;
2163 struct dvb_frontend *fe = dvbdev->priv;
2164 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2165 int err;
2166
2167 if (cmd == COMPAT_FE_SET_PROPERTY || cmd == COMPAT_FE_GET_PROPERTY) {
2168 if (down_interruptible(&fepriv->sem))
2169 return -ERESTARTSYS;
2170
2171 err = dvb_frontend_handle_compat_ioctl(file, cmd, arg);
2172
2173 up(&fepriv->sem);
2174 return err;
2175 }
2176
2177 return dvb_frontend_ioctl(file, cmd, (unsigned long)compat_ptr(arg));
2178 }
2179 #endif
2180
2181 static int dtv_set_frontend(struct dvb_frontend *fe)
2182 {
2183 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2184 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
2185 struct dvb_frontend_tune_settings fetunesettings;
2186 u32 rolloff = 0;
2187
2188 if (dvb_frontend_check_parameters(fe) < 0)
2189 return -EINVAL;
2190
2191
2192
2193
2194
2195
2196 dtv_property_legacy_params_sync(fe, c, &fepriv->parameters_out);
2197
2198
2199
2200
2201
2202
2203
2204
2205
2206
2207
2208
2209
2210
2211
2212
2213
2214
2215
2216
2217 switch (c->delivery_system) {
2218 case SYS_ATSC:
2219 case SYS_DVBC_ANNEX_B:
2220 c->bandwidth_hz = 6000000;
2221 break;
2222 case SYS_DVBC_ANNEX_A:
2223 rolloff = 115;
2224 break;
2225 case SYS_DVBC_ANNEX_C:
2226 rolloff = 113;
2227 break;
2228 case SYS_DVBS:
2229 case SYS_TURBO:
2230 case SYS_ISDBS:
2231 rolloff = 135;
2232 break;
2233 case SYS_DVBS2:
2234 switch (c->rolloff) {
2235 case ROLLOFF_20:
2236 rolloff = 120;
2237 break;
2238 case ROLLOFF_25:
2239 rolloff = 125;
2240 break;
2241 default:
2242 case ROLLOFF_35:
2243 rolloff = 135;
2244 }
2245 break;
2246 default:
2247 break;
2248 }
2249 if (rolloff)
2250 c->bandwidth_hz = mult_frac(c->symbol_rate, rolloff, 100);
2251
2252
2253 if (dvb_force_auto_inversion)
2254 c->inversion = INVERSION_AUTO;
2255
2256
2257
2258
2259
2260 if (c->hierarchy == HIERARCHY_NONE && c->code_rate_LP == FEC_NONE)
2261 c->code_rate_LP = FEC_AUTO;
2262
2263
2264 memset(&fetunesettings, 0, sizeof(struct dvb_frontend_tune_settings));
2265 if (fe->ops.get_tune_settings && (fe->ops.get_tune_settings(fe, &fetunesettings) == 0)) {
2266 fepriv->min_delay = (fetunesettings.min_delay_ms * HZ) / 1000;
2267 fepriv->max_drift = fetunesettings.max_drift;
2268 fepriv->step_size = fetunesettings.step_size;
2269 } else {
2270
2271 switch (c->delivery_system) {
2272 case SYS_DVBS:
2273 case SYS_DVBS2:
2274 case SYS_ISDBS:
2275 case SYS_TURBO:
2276 case SYS_DVBC_ANNEX_A:
2277 case SYS_DVBC_ANNEX_C:
2278 fepriv->min_delay = HZ / 20;
2279 fepriv->step_size = c->symbol_rate / 16000;
2280 fepriv->max_drift = c->symbol_rate / 2000;
2281 break;
2282 case SYS_DVBT:
2283 case SYS_DVBT2:
2284 case SYS_ISDBT:
2285 case SYS_DTMB:
2286 fepriv->min_delay = HZ / 20;
2287 fepriv->step_size = dvb_frontend_get_stepsize(fe) * 2;
2288 fepriv->max_drift = (dvb_frontend_get_stepsize(fe) * 2) + 1;
2289 break;
2290 default:
2291
2292
2293
2294
2295 fepriv->min_delay = HZ / 20;
2296 fepriv->step_size = 0;
2297 fepriv->max_drift = 0;
2298 break;
2299 }
2300 }
2301 if (dvb_override_tune_delay > 0)
2302 fepriv->min_delay = (dvb_override_tune_delay * HZ) / 1000;
2303
2304 fepriv->state = FESTATE_RETUNE;
2305
2306
2307 fepriv->algo_status |= DVBFE_ALGO_SEARCH_AGAIN;
2308
2309 dvb_frontend_clear_events(fe);
2310 dvb_frontend_add_event(fe, 0);
2311 dvb_frontend_wakeup(fe);
2312 fepriv->status = 0;
2313
2314 return 0;
2315 }
2316
2317 static int dvb_get_property(struct dvb_frontend *fe, struct file *file,
2318 struct dtv_properties *tvps)
2319 {
2320 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2321 struct dtv_property *tvp = NULL;
2322 struct dtv_frontend_properties getp;
2323 int i, err;
2324
2325 memcpy(&getp, &fe->dtv_property_cache, sizeof(getp));
2326
2327 dev_dbg(fe->dvb->device, "%s: properties.num = %d\n",
2328 __func__, tvps->num);
2329 dev_dbg(fe->dvb->device, "%s: properties.props = %p\n",
2330 __func__, tvps->props);
2331
2332
2333
2334
2335
2336 if (!tvps->num || tvps->num > DTV_IOCTL_MAX_MSGS)
2337 return -EINVAL;
2338
2339 tvp = memdup_user((void __user *)tvps->props, tvps->num * sizeof(*tvp));
2340 if (IS_ERR(tvp))
2341 return PTR_ERR(tvp);
2342
2343
2344
2345
2346
2347
2348
2349 if (fepriv->state != FESTATE_IDLE) {
2350 err = dtv_get_frontend(fe, &getp, NULL);
2351 if (err < 0)
2352 goto out;
2353 }
2354 for (i = 0; i < tvps->num; i++) {
2355 err = dtv_property_process_get(fe, &getp,
2356 tvp + i, file);
2357 if (err < 0)
2358 goto out;
2359 }
2360
2361 if (copy_to_user((void __user *)tvps->props, tvp,
2362 tvps->num * sizeof(struct dtv_property))) {
2363 err = -EFAULT;
2364 goto out;
2365 }
2366
2367 err = 0;
2368 out:
2369 kfree(tvp);
2370 return err;
2371 }
2372
2373 static int dvb_get_frontend(struct dvb_frontend *fe,
2374 struct dvb_frontend_parameters *p_out)
2375 {
2376 struct dtv_frontend_properties getp;
2377
2378
2379
2380
2381
2382
2383
2384 memcpy(&getp, &fe->dtv_property_cache, sizeof(getp));
2385
2386 return dtv_get_frontend(fe, &getp, p_out);
2387 }
2388
2389 static int dvb_frontend_handle_ioctl(struct file *file,
2390 unsigned int cmd, void *parg)
2391 {
2392 struct dvb_device *dvbdev = file->private_data;
2393 struct dvb_frontend *fe = dvbdev->priv;
2394 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2395 struct dtv_frontend_properties *c = &fe->dtv_property_cache;
2396 int i, err = -ENOTSUPP;
2397
2398 dev_dbg(fe->dvb->device, "%s:\n", __func__);
2399
2400 switch (cmd) {
2401 case FE_SET_PROPERTY: {
2402 struct dtv_properties *tvps = parg;
2403 struct dtv_property *tvp = NULL;
2404
2405 dev_dbg(fe->dvb->device, "%s: properties.num = %d\n",
2406 __func__, tvps->num);
2407 dev_dbg(fe->dvb->device, "%s: properties.props = %p\n",
2408 __func__, tvps->props);
2409
2410
2411
2412
2413
2414 if (!tvps->num || (tvps->num > DTV_IOCTL_MAX_MSGS))
2415 return -EINVAL;
2416
2417 tvp = memdup_user((void __user *)tvps->props, tvps->num * sizeof(*tvp));
2418 if (IS_ERR(tvp))
2419 return PTR_ERR(tvp);
2420
2421 for (i = 0; i < tvps->num; i++) {
2422 err = dtv_property_process_set(fe, file,
2423 (tvp + i)->cmd,
2424 (tvp + i)->u.data);
2425 if (err < 0) {
2426 kfree(tvp);
2427 return err;
2428 }
2429 }
2430 kfree(tvp);
2431 err = 0;
2432 break;
2433 }
2434 case FE_GET_PROPERTY:
2435 err = dvb_get_property(fe, file, parg);
2436 break;
2437
2438 case FE_GET_INFO: {
2439 struct dvb_frontend_info *info = parg;
2440 memset(info, 0, sizeof(*info));
2441
2442 strscpy(info->name, fe->ops.info.name, sizeof(info->name));
2443 info->symbol_rate_min = fe->ops.info.symbol_rate_min;
2444 info->symbol_rate_max = fe->ops.info.symbol_rate_max;
2445 info->symbol_rate_tolerance = fe->ops.info.symbol_rate_tolerance;
2446 info->caps = fe->ops.info.caps;
2447 info->frequency_stepsize = dvb_frontend_get_stepsize(fe);
2448 dvb_frontend_get_frequency_limits(fe, &info->frequency_min,
2449 &info->frequency_max,
2450 &info->frequency_tolerance);
2451
2452
2453
2454
2455
2456
2457
2458
2459
2460
2461
2462
2463 switch (dvbv3_type(c->delivery_system)) {
2464 case DVBV3_QPSK:
2465 info->type = FE_QPSK;
2466 break;
2467 case DVBV3_ATSC:
2468 info->type = FE_ATSC;
2469 break;
2470 case DVBV3_QAM:
2471 info->type = FE_QAM;
2472 break;
2473 case DVBV3_OFDM:
2474 info->type = FE_OFDM;
2475 break;
2476 default:
2477 dev_err(fe->dvb->device,
2478 "%s: doesn't know how to handle a DVBv3 call to delivery system %i\n",
2479 __func__, c->delivery_system);
2480 info->type = FE_OFDM;
2481 }
2482 dev_dbg(fe->dvb->device, "%s: current delivery system on cache: %d, V3 type: %d\n",
2483 __func__, c->delivery_system, info->type);
2484
2485
2486 if (!(fepriv->tune_mode_flags & FE_TUNE_MODE_ONESHOT))
2487 info->caps |= FE_CAN_INVERSION_AUTO;
2488 err = 0;
2489 break;
2490 }
2491
2492 case FE_READ_STATUS: {
2493 enum fe_status *status = parg;
2494
2495
2496
2497 if (fepriv->state == FESTATE_RETUNE ||
2498 fepriv->state == FESTATE_ERROR) {
2499 err = 0;
2500 *status = 0;
2501 break;
2502 }
2503
2504 if (fe->ops.read_status)
2505 err = fe->ops.read_status(fe, status);
2506 break;
2507 }
2508
2509 case FE_DISEQC_RESET_OVERLOAD:
2510 if (fe->ops.diseqc_reset_overload) {
2511 err = fe->ops.diseqc_reset_overload(fe);
2512 fepriv->state = FESTATE_DISEQC;
2513 fepriv->status = 0;
2514 }
2515 break;
2516
2517 case FE_DISEQC_SEND_MASTER_CMD:
2518 if (fe->ops.diseqc_send_master_cmd) {
2519 struct dvb_diseqc_master_cmd *cmd = parg;
2520
2521 if (cmd->msg_len > sizeof(cmd->msg)) {
2522 err = -EINVAL;
2523 break;
2524 }
2525 err = fe->ops.diseqc_send_master_cmd(fe, cmd);
2526 fepriv->state = FESTATE_DISEQC;
2527 fepriv->status = 0;
2528 }
2529 break;
2530
2531 case FE_DISEQC_SEND_BURST:
2532 if (fe->ops.diseqc_send_burst) {
2533 err = fe->ops.diseqc_send_burst(fe,
2534 (enum fe_sec_mini_cmd)parg);
2535 fepriv->state = FESTATE_DISEQC;
2536 fepriv->status = 0;
2537 }
2538 break;
2539
2540 case FE_SET_TONE:
2541 if (fe->ops.set_tone) {
2542 err = fe->ops.set_tone(fe,
2543 (enum fe_sec_tone_mode)parg);
2544 fepriv->tone = (enum fe_sec_tone_mode)parg;
2545 fepriv->state = FESTATE_DISEQC;
2546 fepriv->status = 0;
2547 }
2548 break;
2549
2550 case FE_SET_VOLTAGE:
2551 if (fe->ops.set_voltage) {
2552 err = fe->ops.set_voltage(fe,
2553 (enum fe_sec_voltage)parg);
2554 fepriv->voltage = (enum fe_sec_voltage)parg;
2555 fepriv->state = FESTATE_DISEQC;
2556 fepriv->status = 0;
2557 }
2558 break;
2559
2560 case FE_DISEQC_RECV_SLAVE_REPLY:
2561 if (fe->ops.diseqc_recv_slave_reply)
2562 err = fe->ops.diseqc_recv_slave_reply(fe, parg);
2563 break;
2564
2565 case FE_ENABLE_HIGH_LNB_VOLTAGE:
2566 if (fe->ops.enable_high_lnb_voltage)
2567 err = fe->ops.enable_high_lnb_voltage(fe, (long)parg);
2568 break;
2569
2570 case FE_SET_FRONTEND_TUNE_MODE:
2571 fepriv->tune_mode_flags = (unsigned long)parg;
2572 err = 0;
2573 break;
2574
2575
2576 case FE_DISHNETWORK_SEND_LEGACY_CMD:
2577 if (fe->ops.dishnetwork_send_legacy_command) {
2578 err = fe->ops.dishnetwork_send_legacy_command(fe,
2579 (unsigned long)parg);
2580 fepriv->state = FESTATE_DISEQC;
2581 fepriv->status = 0;
2582 } else if (fe->ops.set_voltage) {
2583
2584
2585
2586
2587
2588
2589
2590
2591
2592
2593
2594
2595
2596
2597
2598
2599 unsigned long swcmd = ((unsigned long)parg) << 1;
2600 ktime_t nexttime;
2601 ktime_t tv[10];
2602 int i;
2603 u8 last = 1;
2604
2605 if (dvb_frontend_debug)
2606 dprintk("switch command: 0x%04lx\n",
2607 swcmd);
2608 nexttime = ktime_get_boottime();
2609 if (dvb_frontend_debug)
2610 tv[0] = nexttime;
2611
2612
2613
2614 fe->ops.set_voltage(fe, SEC_VOLTAGE_18);
2615 dvb_frontend_sleep_until(&nexttime, 32000);
2616
2617 for (i = 0; i < 9; i++) {
2618 if (dvb_frontend_debug)
2619 tv[i + 1] = ktime_get_boottime();
2620 if ((swcmd & 0x01) != last) {
2621
2622 fe->ops.set_voltage(fe, (last) ? SEC_VOLTAGE_13 : SEC_VOLTAGE_18);
2623 last = (last) ? 0 : 1;
2624 }
2625 swcmd = swcmd >> 1;
2626 if (i != 8)
2627 dvb_frontend_sleep_until(&nexttime, 8000);
2628 }
2629 if (dvb_frontend_debug) {
2630 dprintk("(adapter %d): switch delay (should be 32k followed by all 8k)\n",
2631 fe->dvb->num);
2632 for (i = 1; i < 10; i++)
2633 pr_info("%d: %d\n", i,
2634 (int)ktime_us_delta(tv[i], tv[i - 1]));
2635 }
2636 err = 0;
2637 fepriv->state = FESTATE_DISEQC;
2638 fepriv->status = 0;
2639 }
2640 break;
2641
2642
2643
2644 case FE_READ_BER:
2645 if (fe->ops.read_ber) {
2646 if (fepriv->thread)
2647 err = fe->ops.read_ber(fe, parg);
2648 else
2649 err = -EAGAIN;
2650 }
2651 break;
2652
2653 case FE_READ_SIGNAL_STRENGTH:
2654 if (fe->ops.read_signal_strength) {
2655 if (fepriv->thread)
2656 err = fe->ops.read_signal_strength(fe, parg);
2657 else
2658 err = -EAGAIN;
2659 }
2660 break;
2661
2662 case FE_READ_SNR:
2663 if (fe->ops.read_snr) {
2664 if (fepriv->thread)
2665 err = fe->ops.read_snr(fe, parg);
2666 else
2667 err = -EAGAIN;
2668 }
2669 break;
2670
2671 case FE_READ_UNCORRECTED_BLOCKS:
2672 if (fe->ops.read_ucblocks) {
2673 if (fepriv->thread)
2674 err = fe->ops.read_ucblocks(fe, parg);
2675 else
2676 err = -EAGAIN;
2677 }
2678 break;
2679
2680
2681
2682 case FE_SET_FRONTEND:
2683 err = dvbv3_set_delivery_system(fe);
2684 if (err)
2685 break;
2686
2687 err = dtv_property_cache_sync(fe, c, parg);
2688 if (err)
2689 break;
2690 err = dtv_set_frontend(fe);
2691 break;
2692
2693 case FE_GET_EVENT:
2694 err = dvb_frontend_get_event(fe, parg, file->f_flags);
2695 break;
2696
2697 case FE_GET_FRONTEND:
2698 err = dvb_get_frontend(fe, parg);
2699 break;
2700
2701 default:
2702 return -ENOTSUPP;
2703 }
2704
2705 return err;
2706 }
2707
2708 static __poll_t dvb_frontend_poll(struct file *file, struct poll_table_struct *wait)
2709 {
2710 struct dvb_device *dvbdev = file->private_data;
2711 struct dvb_frontend *fe = dvbdev->priv;
2712 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2713
2714 dev_dbg_ratelimited(fe->dvb->device, "%s:\n", __func__);
2715
2716 poll_wait(file, &fepriv->events.wait_queue, wait);
2717
2718 if (fepriv->events.eventw != fepriv->events.eventr)
2719 return (EPOLLIN | EPOLLRDNORM | EPOLLPRI);
2720
2721 return 0;
2722 }
2723
2724 static int dvb_frontend_open(struct inode *inode, struct file *file)
2725 {
2726 struct dvb_device *dvbdev = file->private_data;
2727 struct dvb_frontend *fe = dvbdev->priv;
2728 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2729 struct dvb_adapter *adapter = fe->dvb;
2730 int ret;
2731
2732 dev_dbg(fe->dvb->device, "%s:\n", __func__);
2733 if (fe->exit == DVB_FE_DEVICE_REMOVED)
2734 return -ENODEV;
2735
2736 if (adapter->mfe_shared) {
2737 mutex_lock(&adapter->mfe_lock);
2738
2739 if (!adapter->mfe_dvbdev)
2740 adapter->mfe_dvbdev = dvbdev;
2741
2742 else if (adapter->mfe_dvbdev != dvbdev) {
2743 struct dvb_device
2744 *mfedev = adapter->mfe_dvbdev;
2745 struct dvb_frontend
2746 *mfe = mfedev->priv;
2747 struct dvb_frontend_private
2748 *mfepriv = mfe->frontend_priv;
2749 int mferetry = (dvb_mfe_wait_time << 1);
2750
2751 mutex_unlock(&adapter->mfe_lock);
2752 while (mferetry-- && (mfedev->users != -1 ||
2753 mfepriv->thread)) {
2754 if (msleep_interruptible(500)) {
2755 if (signal_pending(current))
2756 return -EINTR;
2757 }
2758 }
2759
2760 mutex_lock(&adapter->mfe_lock);
2761 if (adapter->mfe_dvbdev != dvbdev) {
2762 mfedev = adapter->mfe_dvbdev;
2763 mfe = mfedev->priv;
2764 mfepriv = mfe->frontend_priv;
2765 if (mfedev->users != -1 ||
2766 mfepriv->thread) {
2767 mutex_unlock(&adapter->mfe_lock);
2768 return -EBUSY;
2769 }
2770 adapter->mfe_dvbdev = dvbdev;
2771 }
2772 }
2773 }
2774
2775 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl) {
2776 if ((ret = fe->ops.ts_bus_ctrl(fe, 1)) < 0)
2777 goto err0;
2778
2779
2780
2781
2782
2783
2784
2785 fepriv->reinitialise = 1;
2786 }
2787
2788 if ((ret = dvb_generic_open(inode, file)) < 0)
2789 goto err1;
2790
2791 if ((file->f_flags & O_ACCMODE) != O_RDONLY) {
2792
2793 fepriv->tune_mode_flags &= ~FE_TUNE_MODE_ONESHOT;
2794 fepriv->tone = -1;
2795 fepriv->voltage = -1;
2796
2797 #ifdef CONFIG_MEDIA_CONTROLLER_DVB
2798 mutex_lock(&fe->dvb->mdev_lock);
2799 if (fe->dvb->mdev) {
2800 mutex_lock(&fe->dvb->mdev->graph_mutex);
2801 if (fe->dvb->mdev->enable_source)
2802 ret = fe->dvb->mdev->enable_source(
2803 dvbdev->entity,
2804 &fepriv->pipe);
2805 mutex_unlock(&fe->dvb->mdev->graph_mutex);
2806 if (ret) {
2807 mutex_unlock(&fe->dvb->mdev_lock);
2808 dev_err(fe->dvb->device,
2809 "Tuner is busy. Error %d\n", ret);
2810 goto err2;
2811 }
2812 }
2813 mutex_unlock(&fe->dvb->mdev_lock);
2814 #endif
2815 ret = dvb_frontend_start(fe);
2816 if (ret)
2817 goto err3;
2818
2819
2820 fepriv->events.eventr = fepriv->events.eventw = 0;
2821 }
2822
2823 dvb_frontend_get(fe);
2824
2825 if (adapter->mfe_shared)
2826 mutex_unlock(&adapter->mfe_lock);
2827 return ret;
2828
2829 err3:
2830 #ifdef CONFIG_MEDIA_CONTROLLER_DVB
2831 mutex_lock(&fe->dvb->mdev_lock);
2832 if (fe->dvb->mdev) {
2833 mutex_lock(&fe->dvb->mdev->graph_mutex);
2834 if (fe->dvb->mdev->disable_source)
2835 fe->dvb->mdev->disable_source(dvbdev->entity);
2836 mutex_unlock(&fe->dvb->mdev->graph_mutex);
2837 }
2838 mutex_unlock(&fe->dvb->mdev_lock);
2839 err2:
2840 #endif
2841 dvb_generic_release(inode, file);
2842 err1:
2843 if (dvbdev->users == -1 && fe->ops.ts_bus_ctrl)
2844 fe->ops.ts_bus_ctrl(fe, 0);
2845 err0:
2846 if (adapter->mfe_shared)
2847 mutex_unlock(&adapter->mfe_lock);
2848 return ret;
2849 }
2850
2851 static int dvb_frontend_release(struct inode *inode, struct file *file)
2852 {
2853 struct dvb_device *dvbdev = file->private_data;
2854 struct dvb_frontend *fe = dvbdev->priv;
2855 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2856 int ret;
2857
2858 dev_dbg(fe->dvb->device, "%s:\n", __func__);
2859
2860 if ((file->f_flags & O_ACCMODE) != O_RDONLY) {
2861 fepriv->release_jiffies = jiffies;
2862 mb();
2863 }
2864
2865 ret = dvb_generic_release(inode, file);
2866
2867 if (dvbdev->users == -1) {
2868 wake_up(&fepriv->wait_queue);
2869 #ifdef CONFIG_MEDIA_CONTROLLER_DVB
2870 mutex_lock(&fe->dvb->mdev_lock);
2871 if (fe->dvb->mdev) {
2872 mutex_lock(&fe->dvb->mdev->graph_mutex);
2873 if (fe->dvb->mdev->disable_source)
2874 fe->dvb->mdev->disable_source(dvbdev->entity);
2875 mutex_unlock(&fe->dvb->mdev->graph_mutex);
2876 }
2877 mutex_unlock(&fe->dvb->mdev_lock);
2878 #endif
2879 if (fe->exit != DVB_FE_NO_EXIT)
2880 wake_up(&dvbdev->wait_queue);
2881 if (fe->ops.ts_bus_ctrl)
2882 fe->ops.ts_bus_ctrl(fe, 0);
2883 }
2884
2885 dvb_frontend_put(fe);
2886
2887 return ret;
2888 }
2889
2890 static const struct file_operations dvb_frontend_fops = {
2891 .owner = THIS_MODULE,
2892 .unlocked_ioctl = dvb_frontend_ioctl,
2893 #ifdef CONFIG_COMPAT
2894 .compat_ioctl = dvb_frontend_compat_ioctl,
2895 #endif
2896 .poll = dvb_frontend_poll,
2897 .open = dvb_frontend_open,
2898 .release = dvb_frontend_release,
2899 .llseek = noop_llseek,
2900 };
2901
2902 int dvb_frontend_suspend(struct dvb_frontend *fe)
2903 {
2904 int ret = 0;
2905
2906 dev_dbg(fe->dvb->device, "%s: adap=%d fe=%d\n", __func__, fe->dvb->num,
2907 fe->id);
2908
2909 if (fe->ops.tuner_ops.suspend)
2910 ret = fe->ops.tuner_ops.suspend(fe);
2911 else if (fe->ops.tuner_ops.sleep)
2912 ret = fe->ops.tuner_ops.sleep(fe);
2913
2914 if (fe->ops.sleep)
2915 ret = fe->ops.sleep(fe);
2916
2917 return ret;
2918 }
2919 EXPORT_SYMBOL(dvb_frontend_suspend);
2920
2921 int dvb_frontend_resume(struct dvb_frontend *fe)
2922 {
2923 struct dvb_frontend_private *fepriv = fe->frontend_priv;
2924 int ret = 0;
2925
2926 dev_dbg(fe->dvb->device, "%s: adap=%d fe=%d\n", __func__, fe->dvb->num,
2927 fe->id);
2928
2929 fe->exit = DVB_FE_DEVICE_RESUME;
2930 if (fe->ops.init)
2931 ret = fe->ops.init(fe);
2932
2933 if (fe->ops.tuner_ops.resume)
2934 ret = fe->ops.tuner_ops.resume(fe);
2935 else if (fe->ops.tuner_ops.init)
2936 ret = fe->ops.tuner_ops.init(fe);
2937
2938 if (fe->ops.set_tone && fepriv->tone != -1)
2939 fe->ops.set_tone(fe, fepriv->tone);
2940 if (fe->ops.set_voltage && fepriv->voltage != -1)
2941 fe->ops.set_voltage(fe, fepriv->voltage);
2942
2943 fe->exit = DVB_FE_NO_EXIT;
2944 fepriv->state = FESTATE_RETUNE;
2945 dvb_frontend_wakeup(fe);
2946
2947 return ret;
2948 }
2949 EXPORT_SYMBOL(dvb_frontend_resume);
2950
2951 int dvb_register_frontend(struct dvb_adapter *dvb,
2952 struct dvb_frontend *fe)
2953 {
2954 struct dvb_frontend_private *fepriv;
2955 const struct dvb_device dvbdev_template = {
2956 .users = ~0,
2957 .writers = 1,
2958 .readers = (~0) - 1,
2959 .fops = &dvb_frontend_fops,
2960 #if defined(CONFIG_MEDIA_CONTROLLER_DVB)
2961 .name = fe->ops.info.name,
2962 #endif
2963 };
2964
2965 dev_dbg(dvb->device, "%s:\n", __func__);
2966
2967 if (mutex_lock_interruptible(&frontend_mutex))
2968 return -ERESTARTSYS;
2969
2970 fe->frontend_priv = kzalloc(sizeof(struct dvb_frontend_private), GFP_KERNEL);
2971 if (!fe->frontend_priv) {
2972 mutex_unlock(&frontend_mutex);
2973 return -ENOMEM;
2974 }
2975 fepriv = fe->frontend_priv;
2976
2977 kref_init(&fe->refcount);
2978
2979
2980
2981
2982
2983
2984 dvb_frontend_get(fe);
2985
2986 sema_init(&fepriv->sem, 1);
2987 init_waitqueue_head(&fepriv->wait_queue);
2988 init_waitqueue_head(&fepriv->events.wait_queue);
2989 mutex_init(&fepriv->events.mtx);
2990 fe->dvb = dvb;
2991 fepriv->inversion = INVERSION_OFF;
2992
2993 dev_info(fe->dvb->device,
2994 "DVB: registering adapter %i frontend %i (%s)...\n",
2995 fe->dvb->num, fe->id, fe->ops.info.name);
2996
2997 dvb_register_device(fe->dvb, &fepriv->dvbdev, &dvbdev_template,
2998 fe, DVB_DEVICE_FRONTEND, 0);
2999
3000
3001
3002
3003
3004
3005 fe->dtv_property_cache.delivery_system = fe->ops.delsys[0];
3006 dvb_frontend_clear_cache(fe);
3007
3008 mutex_unlock(&frontend_mutex);
3009 return 0;
3010 }
3011 EXPORT_SYMBOL(dvb_register_frontend);
3012
3013 int dvb_unregister_frontend(struct dvb_frontend *fe)
3014 {
3015 struct dvb_frontend_private *fepriv = fe->frontend_priv;
3016
3017 dev_dbg(fe->dvb->device, "%s:\n", __func__);
3018
3019 mutex_lock(&frontend_mutex);
3020 dvb_frontend_stop(fe);
3021 dvb_remove_device(fepriv->dvbdev);
3022
3023
3024 mutex_unlock(&frontend_mutex);
3025 dvb_frontend_put(fe);
3026 return 0;
3027 }
3028 EXPORT_SYMBOL(dvb_unregister_frontend);
3029
3030 static void dvb_frontend_invoke_release(struct dvb_frontend *fe,
3031 void (*release)(struct dvb_frontend *fe))
3032 {
3033 if (release) {
3034 release(fe);
3035 #ifdef CONFIG_MEDIA_ATTACH
3036 dvb_detach(release);
3037 #endif
3038 }
3039 }
3040
3041 void dvb_frontend_detach(struct dvb_frontend *fe)
3042 {
3043 dvb_frontend_invoke_release(fe, fe->ops.release_sec);
3044 dvb_frontend_invoke_release(fe, fe->ops.tuner_ops.release);
3045 dvb_frontend_invoke_release(fe, fe->ops.analog_ops.release);
3046 dvb_frontend_put(fe);
3047 }
3048 EXPORT_SYMBOL(dvb_frontend_detach);