1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22#include "dvb_usb_common.h"
23#include <media/media-device.h>
24
25static int dvb_usbv2_disable_rc_polling;
26module_param_named(disable_rc_polling, dvb_usbv2_disable_rc_polling, int, 0644);
27MODULE_PARM_DESC(disable_rc_polling,
28 "disable remote control polling (default: 0)");
29static int dvb_usb_force_pid_filter_usage;
30module_param_named(force_pid_filter_usage, dvb_usb_force_pid_filter_usage,
31 int, 0444);
32MODULE_PARM_DESC(force_pid_filter_usage,
33 "force all DVB USB devices to use a PID filter, if any (default: 0)");
34
35static int dvb_usbv2_download_firmware(struct dvb_usb_device *d,
36 const char *name)
37{
38 int ret;
39 const struct firmware *fw;
40 dev_dbg(&d->udev->dev, "%s:\n", __func__);
41
42 if (!d->props->download_firmware) {
43 ret = -EINVAL;
44 goto err;
45 }
46
47 ret = request_firmware(&fw, name, &d->udev->dev);
48 if (ret < 0) {
49 dev_err(&d->udev->dev,
50 "%s: Did not find the firmware file '%s'. Please see linux/Documentation/dvb/ for more details on firmware-problems. Status %d\n",
51 KBUILD_MODNAME, name, ret);
52 goto err;
53 }
54
55 dev_info(&d->udev->dev, "%s: downloading firmware from file '%s'\n",
56 KBUILD_MODNAME, name);
57
58 ret = d->props->download_firmware(d, fw);
59 release_firmware(fw);
60 if (ret < 0)
61 goto err;
62
63 return ret;
64err:
65 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
66 return ret;
67}
68
69static int dvb_usbv2_i2c_init(struct dvb_usb_device *d)
70{
71 int ret;
72 dev_dbg(&d->udev->dev, "%s:\n", __func__);
73
74 if (!d->props->i2c_algo)
75 return 0;
76
77 strlcpy(d->i2c_adap.name, d->name, sizeof(d->i2c_adap.name));
78 d->i2c_adap.algo = d->props->i2c_algo;
79 d->i2c_adap.dev.parent = &d->udev->dev;
80 i2c_set_adapdata(&d->i2c_adap, d);
81
82 ret = i2c_add_adapter(&d->i2c_adap);
83 if (ret < 0) {
84 d->i2c_adap.algo = NULL;
85 goto err;
86 }
87
88 return 0;
89err:
90 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
91 return ret;
92}
93
94static int dvb_usbv2_i2c_exit(struct dvb_usb_device *d)
95{
96 dev_dbg(&d->udev->dev, "%s:\n", __func__);
97
98 if (d->i2c_adap.algo)
99 i2c_del_adapter(&d->i2c_adap);
100
101 return 0;
102}
103
104#if IS_ENABLED(CONFIG_RC_CORE)
105static void dvb_usb_read_remote_control(struct work_struct *work)
106{
107 struct dvb_usb_device *d = container_of(work,
108 struct dvb_usb_device, rc_query_work.work);
109 int ret;
110
111
112
113
114
115 if (dvb_usbv2_disable_rc_polling || d->rc.bulk_mode) {
116 d->rc_polling_active = false;
117 return;
118 }
119
120 ret = d->rc.query(d);
121 if (ret < 0) {
122 dev_err(&d->udev->dev, "%s: rc.query() failed=%d\n",
123 KBUILD_MODNAME, ret);
124 d->rc_polling_active = false;
125 return;
126 }
127
128 schedule_delayed_work(&d->rc_query_work,
129 msecs_to_jiffies(d->rc.interval));
130}
131
132static int dvb_usbv2_remote_init(struct dvb_usb_device *d)
133{
134 int ret;
135 struct rc_dev *dev;
136 dev_dbg(&d->udev->dev, "%s:\n", __func__);
137
138 if (dvb_usbv2_disable_rc_polling || !d->props->get_rc_config)
139 return 0;
140
141 d->rc.map_name = d->rc_map;
142 ret = d->props->get_rc_config(d, &d->rc);
143 if (ret < 0)
144 goto err;
145
146
147 if (!d->rc.map_name)
148 return 0;
149
150 dev = rc_allocate_device();
151 if (!dev) {
152 ret = -ENOMEM;
153 goto err;
154 }
155
156 dev->dev.parent = &d->udev->dev;
157 dev->input_name = d->name;
158 usb_make_path(d->udev, d->rc_phys, sizeof(d->rc_phys));
159 strlcat(d->rc_phys, "/ir0", sizeof(d->rc_phys));
160 dev->input_phys = d->rc_phys;
161 usb_to_input_id(d->udev, &dev->input_id);
162
163 dev->driver_name = (char *) d->props->driver_name;
164 dev->map_name = d->rc.map_name;
165 dev->driver_type = d->rc.driver_type;
166 dev->allowed_protocols = d->rc.allowed_protos;
167 dev->change_protocol = d->rc.change_protocol;
168 dev->priv = d;
169
170 ret = rc_register_device(dev);
171 if (ret < 0) {
172 rc_free_device(dev);
173 goto err;
174 }
175
176 d->rc_dev = dev;
177
178
179 if (d->rc.query && !d->rc.bulk_mode) {
180
181 INIT_DELAYED_WORK(&d->rc_query_work,
182 dvb_usb_read_remote_control);
183 dev_info(&d->udev->dev,
184 "%s: schedule remote query interval to %d msecs\n",
185 KBUILD_MODNAME, d->rc.interval);
186 schedule_delayed_work(&d->rc_query_work,
187 msecs_to_jiffies(d->rc.interval));
188 d->rc_polling_active = true;
189 }
190
191 return 0;
192err:
193 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
194 return ret;
195}
196
197static int dvb_usbv2_remote_exit(struct dvb_usb_device *d)
198{
199 dev_dbg(&d->udev->dev, "%s:\n", __func__);
200
201 if (d->rc_dev) {
202 cancel_delayed_work_sync(&d->rc_query_work);
203 rc_unregister_device(d->rc_dev);
204 d->rc_dev = NULL;
205 }
206
207 return 0;
208}
209#else
210 #define dvb_usbv2_remote_init(args...) 0
211 #define dvb_usbv2_remote_exit(args...)
212#endif
213
214static void dvb_usb_data_complete(struct usb_data_stream *stream, u8 *buf,
215 size_t len)
216{
217 struct dvb_usb_adapter *adap = stream->user_priv;
218 dvb_dmx_swfilter(&adap->demux, buf, len);
219}
220
221static void dvb_usb_data_complete_204(struct usb_data_stream *stream, u8 *buf,
222 size_t len)
223{
224 struct dvb_usb_adapter *adap = stream->user_priv;
225 dvb_dmx_swfilter_204(&adap->demux, buf, len);
226}
227
228static void dvb_usb_data_complete_raw(struct usb_data_stream *stream, u8 *buf,
229 size_t len)
230{
231 struct dvb_usb_adapter *adap = stream->user_priv;
232 dvb_dmx_swfilter_raw(&adap->demux, buf, len);
233}
234
235static int dvb_usbv2_adapter_stream_init(struct dvb_usb_adapter *adap)
236{
237 dev_dbg(&adap_to_d(adap)->udev->dev, "%s: adap=%d\n", __func__,
238 adap->id);
239
240 adap->stream.udev = adap_to_d(adap)->udev;
241 adap->stream.user_priv = adap;
242 adap->stream.complete = dvb_usb_data_complete;
243
244 return usb_urb_initv2(&adap->stream, &adap->props->stream);
245}
246
247static int dvb_usbv2_adapter_stream_exit(struct dvb_usb_adapter *adap)
248{
249 dev_dbg(&adap_to_d(adap)->udev->dev, "%s: adap=%d\n", __func__,
250 adap->id);
251
252 return usb_urb_exitv2(&adap->stream);
253}
254
255static int dvb_usb_start_feed(struct dvb_demux_feed *dvbdmxfeed)
256{
257 struct dvb_usb_adapter *adap = dvbdmxfeed->demux->priv;
258 struct dvb_usb_device *d = adap_to_d(adap);
259 int ret = 0;
260 struct usb_data_stream_properties stream_props;
261 dev_dbg(&d->udev->dev,
262 "%s: adap=%d active_fe=%d feed_type=%d setting pid [%s]: %04x (%04d) at index %d\n",
263 __func__, adap->id, adap->active_fe, dvbdmxfeed->type,
264 adap->pid_filtering ? "yes" : "no", dvbdmxfeed->pid,
265 dvbdmxfeed->pid, dvbdmxfeed->index);
266
267
268 wait_on_bit(&adap->state_bits, ADAP_INIT, TASK_UNINTERRUPTIBLE);
269
270 if (adap->active_fe == -1)
271 return -EINVAL;
272
273
274 if (adap->feed_count++ > 0)
275 goto skip_feed_start;
276
277
278 set_bit(ADAP_STREAMING, &adap->state_bits);
279
280
281 if (d->props->get_stream_config) {
282 memcpy(&stream_props, &adap->props->stream,
283 sizeof(struct usb_data_stream_properties));
284 ret = d->props->get_stream_config(adap->fe[adap->active_fe],
285 &adap->ts_type, &stream_props);
286 if (ret)
287 dev_err(&d->udev->dev,
288 "%s: get_stream_config() failed=%d\n",
289 KBUILD_MODNAME, ret);
290 } else {
291 stream_props = adap->props->stream;
292 }
293
294 switch (adap->ts_type) {
295 case DVB_USB_FE_TS_TYPE_204:
296 adap->stream.complete = dvb_usb_data_complete_204;
297 break;
298 case DVB_USB_FE_TS_TYPE_RAW:
299 adap->stream.complete = dvb_usb_data_complete_raw;
300 break;
301 case DVB_USB_FE_TS_TYPE_188:
302 default:
303 adap->stream.complete = dvb_usb_data_complete;
304 break;
305 }
306
307
308 usb_urb_submitv2(&adap->stream, &stream_props);
309
310
311 if (adap->pid_filtering && adap->props->pid_filter_ctrl) {
312 ret = adap->props->pid_filter_ctrl(adap, 1);
313 if (ret)
314 dev_err(&d->udev->dev,
315 "%s: pid_filter_ctrl() failed=%d\n",
316 KBUILD_MODNAME, ret);
317 }
318
319
320 if (d->props->streaming_ctrl) {
321 ret = d->props->streaming_ctrl(adap->fe[adap->active_fe], 1);
322 if (ret)
323 dev_err(&d->udev->dev,
324 "%s: streaming_ctrl() failed=%d\n",
325 KBUILD_MODNAME, ret);
326 }
327skip_feed_start:
328
329
330 if (adap->pid_filtering && adap->props->pid_filter) {
331 ret = adap->props->pid_filter(adap, dvbdmxfeed->index,
332 dvbdmxfeed->pid, 1);
333 if (ret)
334 dev_err(&d->udev->dev, "%s: pid_filter() failed=%d\n",
335 KBUILD_MODNAME, ret);
336 }
337
338 if (ret)
339 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
340 return ret;
341}
342
343static int dvb_usb_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
344{
345 struct dvb_usb_adapter *adap = dvbdmxfeed->demux->priv;
346 struct dvb_usb_device *d = adap_to_d(adap);
347 int ret = 0;
348 dev_dbg(&d->udev->dev,
349 "%s: adap=%d active_fe=%d feed_type=%d setting pid [%s]: %04x (%04d) at index %d\n",
350 __func__, adap->id, adap->active_fe, dvbdmxfeed->type,
351 adap->pid_filtering ? "yes" : "no", dvbdmxfeed->pid,
352 dvbdmxfeed->pid, dvbdmxfeed->index);
353
354 if (adap->active_fe == -1)
355 return -EINVAL;
356
357
358 if (adap->pid_filtering && adap->props->pid_filter) {
359 ret = adap->props->pid_filter(adap, dvbdmxfeed->index,
360 dvbdmxfeed->pid, 0);
361 if (ret)
362 dev_err(&d->udev->dev, "%s: pid_filter() failed=%d\n",
363 KBUILD_MODNAME, ret);
364 }
365
366
367 if (--adap->feed_count > 0)
368 goto skip_feed_stop;
369
370
371 if (d->props->streaming_ctrl) {
372 ret = d->props->streaming_ctrl(adap->fe[adap->active_fe], 0);
373 if (ret)
374 dev_err(&d->udev->dev,
375 "%s: streaming_ctrl() failed=%d\n",
376 KBUILD_MODNAME, ret);
377 }
378
379
380 if (adap->pid_filtering && adap->props->pid_filter_ctrl) {
381 ret = adap->props->pid_filter_ctrl(adap, 0);
382 if (ret)
383 dev_err(&d->udev->dev,
384 "%s: pid_filter_ctrl() failed=%d\n",
385 KBUILD_MODNAME, ret);
386 }
387
388
389 usb_urb_killv2(&adap->stream);
390
391
392 clear_bit(ADAP_STREAMING, &adap->state_bits);
393 smp_mb__after_atomic();
394 wake_up_bit(&adap->state_bits, ADAP_STREAMING);
395skip_feed_stop:
396
397 if (ret)
398 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
399 return ret;
400}
401
402static int dvb_usbv2_media_device_init(struct dvb_usb_adapter *adap)
403{
404#ifdef CONFIG_MEDIA_CONTROLLER_DVB
405 struct media_device *mdev;
406 struct dvb_usb_device *d = adap_to_d(adap);
407 struct usb_device *udev = d->udev;
408
409 mdev = kzalloc(sizeof(*mdev), GFP_KERNEL);
410 if (!mdev)
411 return -ENOMEM;
412
413 media_device_usb_init(mdev, udev, d->name);
414
415 dvb_register_media_controller(&adap->dvb_adap, mdev);
416
417 dev_info(&d->udev->dev, "media controller created\n");
418#endif
419 return 0;
420}
421
422static int dvb_usbv2_media_device_register(struct dvb_usb_adapter *adap)
423{
424#ifdef CONFIG_MEDIA_CONTROLLER_DVB
425 return media_device_register(adap->dvb_adap.mdev);
426#else
427 return 0;
428#endif
429}
430
431static void dvb_usbv2_media_device_unregister(struct dvb_usb_adapter *adap)
432{
433#ifdef CONFIG_MEDIA_CONTROLLER_DVB
434
435 if (!adap->dvb_adap.mdev)
436 return;
437
438 media_device_unregister(adap->dvb_adap.mdev);
439 media_device_cleanup(adap->dvb_adap.mdev);
440 kfree(adap->dvb_adap.mdev);
441 adap->dvb_adap.mdev = NULL;
442
443#endif
444}
445
446static int dvb_usbv2_adapter_dvb_init(struct dvb_usb_adapter *adap)
447{
448 int ret;
449 struct dvb_usb_device *d = adap_to_d(adap);
450
451 dev_dbg(&d->udev->dev, "%s: adap=%d\n", __func__, adap->id);
452
453 ret = dvb_register_adapter(&adap->dvb_adap, d->name, d->props->owner,
454 &d->udev->dev, d->props->adapter_nr);
455 if (ret < 0) {
456 dev_dbg(&d->udev->dev, "%s: dvb_register_adapter() failed=%d\n",
457 __func__, ret);
458 goto err_dvb_register_adapter;
459 }
460
461 adap->dvb_adap.priv = adap;
462
463 ret = dvb_usbv2_media_device_init(adap);
464 if (ret < 0) {
465 dev_dbg(&d->udev->dev, "%s: dvb_usbv2_media_device_init() failed=%d\n",
466 __func__, ret);
467 goto err_dvb_register_mc;
468 }
469
470 if (d->props->read_mac_address) {
471 ret = d->props->read_mac_address(adap,
472 adap->dvb_adap.proposed_mac);
473 if (ret < 0)
474 goto err_dvb_dmx_init;
475
476 dev_info(&d->udev->dev, "%s: MAC address: %pM\n",
477 KBUILD_MODNAME, adap->dvb_adap.proposed_mac);
478 }
479
480 adap->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING;
481 adap->demux.priv = adap;
482 adap->demux.filternum = 0;
483 adap->demux.filternum = adap->max_feed_count;
484 adap->demux.feednum = adap->demux.filternum;
485 adap->demux.start_feed = dvb_usb_start_feed;
486 adap->demux.stop_feed = dvb_usb_stop_feed;
487 adap->demux.write_to_decoder = NULL;
488 ret = dvb_dmx_init(&adap->demux);
489 if (ret < 0) {
490 dev_err(&d->udev->dev, "%s: dvb_dmx_init() failed=%d\n",
491 KBUILD_MODNAME, ret);
492 goto err_dvb_dmx_init;
493 }
494
495 adap->dmxdev.filternum = adap->demux.filternum;
496 adap->dmxdev.demux = &adap->demux.dmx;
497 adap->dmxdev.capabilities = 0;
498 ret = dvb_dmxdev_init(&adap->dmxdev, &adap->dvb_adap);
499 if (ret < 0) {
500 dev_err(&d->udev->dev, "%s: dvb_dmxdev_init() failed=%d\n",
501 KBUILD_MODNAME, ret);
502 goto err_dvb_dmxdev_init;
503 }
504
505 ret = dvb_net_init(&adap->dvb_adap, &adap->dvb_net, &adap->demux.dmx);
506 if (ret < 0) {
507 dev_err(&d->udev->dev, "%s: dvb_net_init() failed=%d\n",
508 KBUILD_MODNAME, ret);
509 goto err_dvb_net_init;
510 }
511
512 return 0;
513err_dvb_net_init:
514 dvb_dmxdev_release(&adap->dmxdev);
515err_dvb_dmxdev_init:
516 dvb_dmx_release(&adap->demux);
517err_dvb_dmx_init:
518 dvb_usbv2_media_device_unregister(adap);
519err_dvb_register_mc:
520 dvb_unregister_adapter(&adap->dvb_adap);
521err_dvb_register_adapter:
522 adap->dvb_adap.priv = NULL;
523 return ret;
524}
525
526static int dvb_usbv2_adapter_dvb_exit(struct dvb_usb_adapter *adap)
527{
528 dev_dbg(&adap_to_d(adap)->udev->dev, "%s: adap=%d\n", __func__,
529 adap->id);
530
531 if (adap->dvb_adap.priv) {
532 dvb_net_release(&adap->dvb_net);
533 adap->demux.dmx.close(&adap->demux.dmx);
534 dvb_dmxdev_release(&adap->dmxdev);
535 dvb_dmx_release(&adap->demux);
536 dvb_unregister_adapter(&adap->dvb_adap);
537 }
538
539 return 0;
540}
541
542static int dvb_usbv2_device_power_ctrl(struct dvb_usb_device *d, int onoff)
543{
544 int ret;
545
546 if (onoff)
547 d->powered++;
548 else
549 d->powered--;
550
551 if (d->powered == 0 || (onoff && d->powered == 1)) {
552
553 dev_dbg(&d->udev->dev, "%s: power=%d\n", __func__, onoff);
554 if (d->props->power_ctrl) {
555 ret = d->props->power_ctrl(d, onoff);
556 if (ret < 0)
557 goto err;
558 }
559 }
560
561 return 0;
562err:
563 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
564 return ret;
565}
566
567static int dvb_usb_fe_init(struct dvb_frontend *fe)
568{
569 int ret;
570 struct dvb_usb_adapter *adap = fe->dvb->priv;
571 struct dvb_usb_device *d = adap_to_d(adap);
572 dev_dbg(&d->udev->dev, "%s: adap=%d fe=%d\n", __func__, adap->id,
573 fe->id);
574
575 if (!adap->suspend_resume_active) {
576 adap->active_fe = fe->id;
577 set_bit(ADAP_INIT, &adap->state_bits);
578 }
579
580 ret = dvb_usbv2_device_power_ctrl(d, 1);
581 if (ret < 0)
582 goto err;
583
584 if (d->props->frontend_ctrl) {
585 ret = d->props->frontend_ctrl(fe, 1);
586 if (ret < 0)
587 goto err;
588 }
589
590 if (adap->fe_init[fe->id]) {
591 ret = adap->fe_init[fe->id](fe);
592 if (ret < 0)
593 goto err;
594 }
595err:
596 if (!adap->suspend_resume_active) {
597 clear_bit(ADAP_INIT, &adap->state_bits);
598 smp_mb__after_atomic();
599 wake_up_bit(&adap->state_bits, ADAP_INIT);
600 }
601
602 dev_dbg(&d->udev->dev, "%s: ret=%d\n", __func__, ret);
603 return ret;
604}
605
606static int dvb_usb_fe_sleep(struct dvb_frontend *fe)
607{
608 int ret;
609 struct dvb_usb_adapter *adap = fe->dvb->priv;
610 struct dvb_usb_device *d = adap_to_d(adap);
611 dev_dbg(&d->udev->dev, "%s: adap=%d fe=%d\n", __func__, adap->id,
612 fe->id);
613
614 if (!adap->suspend_resume_active) {
615 set_bit(ADAP_SLEEP, &adap->state_bits);
616 wait_on_bit(&adap->state_bits, ADAP_STREAMING,
617 TASK_UNINTERRUPTIBLE);
618 }
619
620 if (adap->fe_sleep[fe->id]) {
621 ret = adap->fe_sleep[fe->id](fe);
622 if (ret < 0)
623 goto err;
624 }
625
626 if (d->props->frontend_ctrl) {
627 ret = d->props->frontend_ctrl(fe, 0);
628 if (ret < 0)
629 goto err;
630 }
631
632 ret = dvb_usbv2_device_power_ctrl(d, 0);
633 if (ret < 0)
634 goto err;
635err:
636 if (!adap->suspend_resume_active) {
637 adap->active_fe = -1;
638 clear_bit(ADAP_SLEEP, &adap->state_bits);
639 smp_mb__after_atomic();
640 wake_up_bit(&adap->state_bits, ADAP_SLEEP);
641 }
642
643 dev_dbg(&d->udev->dev, "%s: ret=%d\n", __func__, ret);
644 return ret;
645}
646
647static int dvb_usbv2_adapter_frontend_init(struct dvb_usb_adapter *adap)
648{
649 int ret, i, count_registered = 0;
650 struct dvb_usb_device *d = adap_to_d(adap);
651 dev_dbg(&d->udev->dev, "%s: adap=%d\n", __func__, adap->id);
652
653 memset(adap->fe, 0, sizeof(adap->fe));
654 adap->active_fe = -1;
655
656 if (d->props->frontend_attach) {
657 ret = d->props->frontend_attach(adap);
658 if (ret < 0) {
659 dev_dbg(&d->udev->dev,
660 "%s: frontend_attach() failed=%d\n",
661 __func__, ret);
662 goto err_dvb_frontend_detach;
663 }
664 } else {
665 dev_dbg(&d->udev->dev, "%s: frontend_attach() do not exists\n",
666 __func__);
667 ret = 0;
668 goto err;
669 }
670
671 for (i = 0; i < MAX_NO_OF_FE_PER_ADAP && adap->fe[i]; i++) {
672 adap->fe[i]->id = i;
673
674 adap->fe_init[i] = adap->fe[i]->ops.init;
675 adap->fe[i]->ops.init = dvb_usb_fe_init;
676 adap->fe_sleep[i] = adap->fe[i]->ops.sleep;
677 adap->fe[i]->ops.sleep = dvb_usb_fe_sleep;
678
679 ret = dvb_register_frontend(&adap->dvb_adap, adap->fe[i]);
680 if (ret < 0) {
681 dev_err(&d->udev->dev,
682 "%s: frontend%d registration failed\n",
683 KBUILD_MODNAME, i);
684 goto err_dvb_unregister_frontend;
685 }
686
687 count_registered++;
688 }
689
690 if (d->props->tuner_attach) {
691 ret = d->props->tuner_attach(adap);
692 if (ret < 0) {
693 dev_dbg(&d->udev->dev, "%s: tuner_attach() failed=%d\n",
694 __func__, ret);
695 goto err_dvb_unregister_frontend;
696 }
697 }
698
699 ret = dvb_create_media_graph(&adap->dvb_adap, true);
700 if (ret < 0)
701 goto err_dvb_unregister_frontend;
702
703 ret = dvb_usbv2_media_device_register(adap);
704
705 return ret;
706
707err_dvb_unregister_frontend:
708 for (i = count_registered - 1; i >= 0; i--)
709 dvb_unregister_frontend(adap->fe[i]);
710
711err_dvb_frontend_detach:
712 for (i = MAX_NO_OF_FE_PER_ADAP - 1; i >= 0; i--) {
713 if (adap->fe[i]) {
714 dvb_frontend_detach(adap->fe[i]);
715 adap->fe[i] = NULL;
716 }
717 }
718
719err:
720 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
721 return ret;
722}
723
724static int dvb_usbv2_adapter_frontend_exit(struct dvb_usb_adapter *adap)
725{
726 int ret, i;
727 struct dvb_usb_device *d = adap_to_d(adap);
728
729 dev_dbg(&d->udev->dev, "%s: adap=%d\n", __func__, adap->id);
730
731 for (i = MAX_NO_OF_FE_PER_ADAP - 1; i >= 0; i--) {
732 if (adap->fe[i]) {
733 dvb_unregister_frontend(adap->fe[i]);
734 dvb_frontend_detach(adap->fe[i]);
735 }
736 }
737
738 if (d->props->tuner_detach) {
739 ret = d->props->tuner_detach(adap);
740 if (ret < 0) {
741 dev_dbg(&d->udev->dev, "%s: tuner_detach() failed=%d\n",
742 __func__, ret);
743 }
744 }
745
746 if (d->props->frontend_detach) {
747 ret = d->props->frontend_detach(adap);
748 if (ret < 0) {
749 dev_dbg(&d->udev->dev,
750 "%s: frontend_detach() failed=%d\n",
751 __func__, ret);
752 }
753 }
754
755 return 0;
756}
757
758static int dvb_usbv2_adapter_init(struct dvb_usb_device *d)
759{
760 struct dvb_usb_adapter *adap;
761 int ret, i, adapter_count;
762
763
764 adapter_count = d->props->num_adapters;
765 if (d->props->get_adapter_count) {
766 ret = d->props->get_adapter_count(d);
767 if (ret < 0)
768 goto err;
769
770 adapter_count = ret;
771 }
772
773 for (i = 0; i < adapter_count; i++) {
774 adap = &d->adapter[i];
775 adap->id = i;
776 adap->props = &d->props->adapter[i];
777
778
779 if (d->udev->speed == USB_SPEED_FULL &&
780 !(adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER)) {
781 dev_err(&d->udev->dev,
782 "%s: this USB2.0 device cannot be run on a USB1.1 port (it lacks a hardware PID filter)\n",
783 KBUILD_MODNAME);
784 ret = -ENODEV;
785 goto err;
786 } else if ((d->udev->speed == USB_SPEED_FULL &&
787 adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER) ||
788 (adap->props->caps & DVB_USB_ADAP_NEED_PID_FILTERING)) {
789 dev_info(&d->udev->dev,
790 "%s: will use the device's hardware PID filter (table count: %d)\n",
791 KBUILD_MODNAME,
792 adap->props->pid_filter_count);
793 adap->pid_filtering = 1;
794 adap->max_feed_count = adap->props->pid_filter_count;
795 } else {
796 dev_info(&d->udev->dev,
797 "%s: will pass the complete MPEG2 transport stream to the software demuxer\n",
798 KBUILD_MODNAME);
799 adap->pid_filtering = 0;
800 adap->max_feed_count = 255;
801 }
802
803 if (!adap->pid_filtering && dvb_usb_force_pid_filter_usage &&
804 adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER) {
805 dev_info(&d->udev->dev,
806 "%s: PID filter enabled by module option\n",
807 KBUILD_MODNAME);
808 adap->pid_filtering = 1;
809 adap->max_feed_count = adap->props->pid_filter_count;
810 }
811
812 ret = dvb_usbv2_adapter_stream_init(adap);
813 if (ret)
814 goto err;
815
816 ret = dvb_usbv2_adapter_dvb_init(adap);
817 if (ret)
818 goto err;
819
820 ret = dvb_usbv2_adapter_frontend_init(adap);
821 if (ret)
822 goto err;
823
824
825 if (adap->fe[1])
826 adap->dvb_adap.mfe_shared = 1;
827 }
828
829 return 0;
830err:
831 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
832 return ret;
833}
834
835static int dvb_usbv2_adapter_exit(struct dvb_usb_device *d)
836{
837 int i;
838 dev_dbg(&d->udev->dev, "%s:\n", __func__);
839
840 for (i = MAX_NO_OF_ADAPTER_PER_DEVICE - 1; i >= 0; i--) {
841 if (d->adapter[i].props) {
842 dvb_usbv2_adapter_dvb_exit(&d->adapter[i]);
843 dvb_usbv2_adapter_stream_exit(&d->adapter[i]);
844 dvb_usbv2_adapter_frontend_exit(&d->adapter[i]);
845 dvb_usbv2_media_device_unregister(&d->adapter[i]);
846 }
847 }
848
849 return 0;
850}
851
852
853static int dvb_usbv2_exit(struct dvb_usb_device *d)
854{
855 dev_dbg(&d->udev->dev, "%s:\n", __func__);
856
857 dvb_usbv2_remote_exit(d);
858 dvb_usbv2_adapter_exit(d);
859 dvb_usbv2_i2c_exit(d);
860 kfree(d->priv);
861 kfree(d);
862
863 return 0;
864}
865
866static int dvb_usbv2_init(struct dvb_usb_device *d)
867{
868 int ret;
869 dev_dbg(&d->udev->dev, "%s:\n", __func__);
870
871 dvb_usbv2_device_power_ctrl(d, 1);
872
873 if (d->props->read_config) {
874 ret = d->props->read_config(d);
875 if (ret < 0)
876 goto err;
877 }
878
879 ret = dvb_usbv2_i2c_init(d);
880 if (ret < 0)
881 goto err;
882
883 ret = dvb_usbv2_adapter_init(d);
884 if (ret < 0)
885 goto err;
886
887 if (d->props->init) {
888 ret = d->props->init(d);
889 if (ret < 0)
890 goto err;
891 }
892
893 ret = dvb_usbv2_remote_init(d);
894 if (ret < 0)
895 goto err;
896
897 dvb_usbv2_device_power_ctrl(d, 0);
898
899 return 0;
900err:
901 dvb_usbv2_device_power_ctrl(d, 0);
902 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
903 return ret;
904}
905
906int dvb_usbv2_probe(struct usb_interface *intf,
907 const struct usb_device_id *id)
908{
909 int ret;
910 struct dvb_usb_device *d;
911 struct usb_device *udev = interface_to_usbdev(intf);
912 struct dvb_usb_driver_info *driver_info =
913 (struct dvb_usb_driver_info *) id->driver_info;
914
915 dev_dbg(&udev->dev, "%s: bInterfaceNumber=%d\n", __func__,
916 intf->cur_altsetting->desc.bInterfaceNumber);
917
918 if (!id->driver_info) {
919 dev_err(&udev->dev, "%s: driver_info failed\n", KBUILD_MODNAME);
920 ret = -ENODEV;
921 goto err;
922 }
923
924 d = kzalloc(sizeof(struct dvb_usb_device), GFP_KERNEL);
925 if (!d) {
926 dev_err(&udev->dev, "%s: kzalloc() failed\n", KBUILD_MODNAME);
927 ret = -ENOMEM;
928 goto err;
929 }
930
931 d->intf = intf;
932 d->name = driver_info->name;
933 d->rc_map = driver_info->rc_map;
934 d->udev = udev;
935 d->props = driver_info->props;
936
937 if (intf->cur_altsetting->desc.bInterfaceNumber !=
938 d->props->bInterfaceNumber) {
939 ret = -ENODEV;
940 goto err_free_all;
941 }
942
943 mutex_init(&d->usb_mutex);
944 mutex_init(&d->i2c_mutex);
945
946 if (d->props->size_of_priv) {
947 d->priv = kzalloc(d->props->size_of_priv, GFP_KERNEL);
948 if (!d->priv) {
949 dev_err(&d->udev->dev, "%s: kzalloc() failed\n",
950 KBUILD_MODNAME);
951 ret = -ENOMEM;
952 goto err_free_all;
953 }
954 }
955
956 if (d->props->identify_state) {
957 const char *name = NULL;
958 ret = d->props->identify_state(d, &name);
959 if (ret == 0) {
960 ;
961 } else if (ret == COLD) {
962 dev_info(&d->udev->dev,
963 "%s: found a '%s' in cold state\n",
964 KBUILD_MODNAME, d->name);
965
966 if (!name)
967 name = d->props->firmware;
968
969 ret = dvb_usbv2_download_firmware(d, name);
970 if (ret == 0) {
971
972 ;
973 } else if (ret == RECONNECTS_USB) {
974
975
976
977
978
979
980
981
982 goto exit;
983 } else {
984 goto err_free_all;
985 }
986 } else {
987 goto err_free_all;
988 }
989 }
990
991 dev_info(&d->udev->dev, "%s: found a '%s' in warm state\n",
992 KBUILD_MODNAME, d->name);
993
994 ret = dvb_usbv2_init(d);
995 if (ret < 0)
996 goto err_free_all;
997
998 dev_info(&d->udev->dev,
999 "%s: '%s' successfully initialized and connected\n",
1000 KBUILD_MODNAME, d->name);
1001exit:
1002 usb_set_intfdata(intf, d);
1003
1004 return 0;
1005err_free_all:
1006 dvb_usbv2_exit(d);
1007err:
1008 dev_dbg(&udev->dev, "%s: failed=%d\n", __func__, ret);
1009 return ret;
1010}
1011EXPORT_SYMBOL(dvb_usbv2_probe);
1012
1013void dvb_usbv2_disconnect(struct usb_interface *intf)
1014{
1015 struct dvb_usb_device *d = usb_get_intfdata(intf);
1016 const char *name = d->name;
1017 struct device dev = d->udev->dev;
1018
1019 dev_dbg(&d->udev->dev, "%s: bInterfaceNumber=%d\n", __func__,
1020 intf->cur_altsetting->desc.bInterfaceNumber);
1021
1022 if (d->props->exit)
1023 d->props->exit(d);
1024
1025 dvb_usbv2_exit(d);
1026
1027 dev_info(&dev, "%s: '%s' successfully deinitialized and disconnected\n",
1028 KBUILD_MODNAME, name);
1029}
1030EXPORT_SYMBOL(dvb_usbv2_disconnect);
1031
1032int dvb_usbv2_suspend(struct usb_interface *intf, pm_message_t msg)
1033{
1034 struct dvb_usb_device *d = usb_get_intfdata(intf);
1035 int ret = 0, i, active_fe;
1036 struct dvb_frontend *fe;
1037 dev_dbg(&d->udev->dev, "%s:\n", __func__);
1038
1039
1040 if (d->rc_polling_active)
1041 cancel_delayed_work_sync(&d->rc_query_work);
1042
1043 for (i = MAX_NO_OF_ADAPTER_PER_DEVICE - 1; i >= 0; i--) {
1044 active_fe = d->adapter[i].active_fe;
1045 if (d->adapter[i].dvb_adap.priv && active_fe != -1) {
1046 fe = d->adapter[i].fe[active_fe];
1047 d->adapter[i].suspend_resume_active = true;
1048
1049 if (d->props->streaming_ctrl)
1050 d->props->streaming_ctrl(fe, 0);
1051
1052
1053 usb_urb_killv2(&d->adapter[i].stream);
1054
1055 ret = dvb_frontend_suspend(fe);
1056 }
1057 }
1058
1059 return ret;
1060}
1061EXPORT_SYMBOL(dvb_usbv2_suspend);
1062
1063static int dvb_usbv2_resume_common(struct dvb_usb_device *d)
1064{
1065 int ret = 0, i, active_fe;
1066 struct dvb_frontend *fe;
1067 dev_dbg(&d->udev->dev, "%s:\n", __func__);
1068
1069 for (i = 0; i < MAX_NO_OF_ADAPTER_PER_DEVICE; i++) {
1070 active_fe = d->adapter[i].active_fe;
1071 if (d->adapter[i].dvb_adap.priv && active_fe != -1) {
1072 fe = d->adapter[i].fe[active_fe];
1073
1074 ret = dvb_frontend_resume(fe);
1075
1076
1077 usb_urb_submitv2(&d->adapter[i].stream, NULL);
1078
1079 if (d->props->streaming_ctrl)
1080 d->props->streaming_ctrl(fe, 1);
1081
1082 d->adapter[i].suspend_resume_active = false;
1083 }
1084 }
1085
1086
1087 if (d->rc_polling_active)
1088 schedule_delayed_work(&d->rc_query_work,
1089 msecs_to_jiffies(d->rc.interval));
1090
1091 return ret;
1092}
1093
1094int dvb_usbv2_resume(struct usb_interface *intf)
1095{
1096 struct dvb_usb_device *d = usb_get_intfdata(intf);
1097 dev_dbg(&d->udev->dev, "%s:\n", __func__);
1098
1099 return dvb_usbv2_resume_common(d);
1100}
1101EXPORT_SYMBOL(dvb_usbv2_resume);
1102
1103int dvb_usbv2_reset_resume(struct usb_interface *intf)
1104{
1105 struct dvb_usb_device *d = usb_get_intfdata(intf);
1106 int ret;
1107 dev_dbg(&d->udev->dev, "%s:\n", __func__);
1108
1109 dvb_usbv2_device_power_ctrl(d, 1);
1110
1111 if (d->props->init)
1112 d->props->init(d);
1113
1114 ret = dvb_usbv2_resume_common(d);
1115
1116 dvb_usbv2_device_power_ctrl(d, 0);
1117
1118 return ret;
1119}
1120EXPORT_SYMBOL(dvb_usbv2_reset_resume);
1121
1122MODULE_VERSION("2.0");
1123MODULE_AUTHOR("Patrick Boettcher <patrick.boettcher@posteo.de>");
1124MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1125MODULE_DESCRIPTION("DVB USB common");
1126MODULE_LICENSE("GPL");
1127
