projects / deliverable / linux.git / blob
? search:


7ce8ffef8aca58bd868d33124351e02bf4f1e504
[deliverable/linux.git] / drivers / media / usb / dvb-usb-v2 / dvb_usb_core.c
1 /*
2 * DVB USB framework
3 *
4 * Copyright (C) 2004-6 Patrick Boettcher <patrick.boettcher@desy.de>
5 * Copyright (C) 2012 Antti Palosaari <crope@iki.fi>
6 *
7 * This program is free software; you can redistribute it and/or modify
8 * it under the terms of the GNU General Public License as published by
9 * the Free Software Foundation; either version 2 of the License, or
10 * (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
17 * You should have received a copy of the GNU General Public License along
18 * with this program; if not, write to the Free Software Foundation, Inc.,
19 * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
20 */
21
22 #include "dvb_usb_common.h"
23
24 int dvb_usbv2_disable_rc_polling;
25 module_param_named(disable_rc_polling, dvb_usbv2_disable_rc_polling, int, 0644);
26 MODULE_PARM_DESC(disable_rc_polling,
27 "disable remote control polling (default: 0)");
28 static int dvb_usb_force_pid_filter_usage;
29 module_param_named(force_pid_filter_usage, dvb_usb_force_pid_filter_usage,
30 int, 0444);
31 MODULE_PARM_DESC(force_pid_filter_usage, "force all DVB USB devices to use a " \
32 "PID filter, if any (default: 0)");
33
34 static int dvb_usbv2_download_firmware(struct dvb_usb_device *d, const char *name)
35 {
36 int ret;
37 const struct firmware *fw;
38 dev_dbg(&d->udev->dev, "%s:\n", __func__);
39
40 if (!d->props->download_firmware) {
41 ret = -EINVAL;
42 goto err;
43 }
44
45 ret = request_firmware(&fw, name, &d->udev->dev);
46 if (ret < 0) {
47 dev_err(&d->udev->dev, "%s: Did not find the firmware file "\
48 "'%s'. Please see linux/Documentation/dvb/ " \
49 "for more details on firmware-problems. " \
50 "Status %d\n", KBUILD_MODNAME, name, ret);
51 goto err;
52 }
53
54 dev_info(&d->udev->dev, "%s: downloading firmware from file '%s'\n",
55 KBUILD_MODNAME, name);
56
57 ret = d->props->download_firmware(d, fw);
58 release_firmware(fw);
59 if (ret < 0)
60 goto err;
61
62 return ret;
63 err:
64 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
65 return ret;
66 }
67
68 static int dvb_usbv2_i2c_init(struct dvb_usb_device *d)
69 {
70 int ret;
71 dev_dbg(&d->udev->dev, "%s:\n", __func__);
72
73 if (!d->props->i2c_algo)
74 return 0;
75
76 strlcpy(d->i2c_adap.name, d->name, sizeof(d->i2c_adap.name));
77 d->i2c_adap.algo = d->props->i2c_algo;
78 d->i2c_adap.dev.parent = &d->udev->dev;
79 i2c_set_adapdata(&d->i2c_adap, d);
80
81 ret = i2c_add_adapter(&d->i2c_adap);
82 if (ret < 0) {
83 d->i2c_adap.algo = NULL;
84 dev_err(&d->udev->dev, "%s: i2c_add_adapter() failed=%d\n",
85 KBUILD_MODNAME, ret);
86 goto err;
87 }
88
89 return 0;
90 err:
91 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
92 return ret;
93 }
94
95 static int dvb_usbv2_i2c_exit(struct dvb_usb_device *d)
96 {
97 dev_dbg(&d->udev->dev, "%s:\n", __func__);
98
99 if (d->i2c_adap.algo)
100 i2c_del_adapter(&d->i2c_adap);
101
102 return 0;
103 }
104
105 static 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 * When the parameter has been set to 1 via sysfs while the
113 * driver was running, or when bulk mode is enabled after IR init.
114 */
115 if (dvb_usbv2_disable_rc_polling || d->rc.bulk_mode)
116 return;
117
118 ret = d->rc.query(d);
119 if (ret < 0) {
120 dev_err(&d->udev->dev, "%s: rc.query() failed=%d\n",
121 KBUILD_MODNAME, ret);
122 return; /* stop polling */
123 }
124
125 schedule_delayed_work(&d->rc_query_work,
126 msecs_to_jiffies(d->rc.interval));
127 }
128
129 static int dvb_usbv2_remote_init(struct dvb_usb_device *d)
130 {
131 int ret;
132 struct rc_dev *dev;
133 dev_dbg(&d->udev->dev, "%s:\n", __func__);
134
135 if (dvb_usbv2_disable_rc_polling || !d->props->get_rc_config)
136 return 0;
137
138 d->rc.map_name = d->rc_map;
139 ret = d->props->get_rc_config(d, &d->rc);
140 if (ret < 0)
141 goto err;
142
143 /* disable rc when there is no keymap defined */
144 if (!d->rc.map_name)
145 return 0;
146
147 dev = rc_allocate_device();
148 if (!dev) {
149 ret = -ENOMEM;
150 goto err;
151 }
152
153 dev->dev.parent = &d->udev->dev;
154 dev->input_name = d->name;
155 usb_make_path(d->udev, d->rc_phys, sizeof(d->rc_phys));
156 strlcat(d->rc_phys, "/ir0", sizeof(d->rc_phys));
157 dev->input_phys = d->rc_phys;
158 usb_to_input_id(d->udev, &dev->input_id);
159 /* TODO: likely RC-core should took const char * */
160 dev->driver_name = (char *) d->props->driver_name;
161 dev->map_name = d->rc.map_name;
162 dev->driver_type = d->rc.driver_type;
163 dev->allowed_protos = d->rc.allowed_protos;
164 dev->change_protocol = d->rc.change_protocol;
165 dev->priv = d;
166
167 ret = rc_register_device(dev);
168 if (ret < 0) {
169 rc_free_device(dev);
170 goto err;
171 }
172
173 d->rc_dev = dev;
174
175 /* start polling if needed */
176 if (d->rc.query && !d->rc.bulk_mode) {
177 /* initialize a work queue for handling polling */
178 INIT_DELAYED_WORK(&d->rc_query_work,
179 dvb_usb_read_remote_control);
180 dev_info(&d->udev->dev, "%s: schedule remote query interval " \
181 "to %d msecs\n", KBUILD_MODNAME,
182 d->rc.interval);
183 schedule_delayed_work(&d->rc_query_work,
184 msecs_to_jiffies(d->rc.interval));
185 }
186
187 return 0;
188 err:
189 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
190 return ret;
191 }
192
193 static int dvb_usbv2_remote_exit(struct dvb_usb_device *d)
194 {
195 dev_dbg(&d->udev->dev, "%s:\n", __func__);
196
197 if (d->rc_dev) {
198 cancel_delayed_work_sync(&d->rc_query_work);
199 rc_unregister_device(d->rc_dev);
200 d->rc_dev = NULL;
201 }
202
203 return 0;
204 }
205
206 static void dvb_usb_data_complete(struct usb_data_stream *stream, u8 *buf,
207 size_t len)
208 {
209 struct dvb_usb_adapter *adap = stream->user_priv;
210 dvb_dmx_swfilter(&adap->demux, buf, len);
211 }
212
213 static void dvb_usb_data_complete_204(struct usb_data_stream *stream, u8 *buf,
214 size_t len)
215 {
216 struct dvb_usb_adapter *adap = stream->user_priv;
217 dvb_dmx_swfilter_204(&adap->demux, buf, len);
218 }
219
220 static void dvb_usb_data_complete_raw(struct usb_data_stream *stream, u8 *buf,
221 size_t len)
222 {
223 struct dvb_usb_adapter *adap = stream->user_priv;
224 dvb_dmx_swfilter_raw(&adap->demux, buf, len);
225 }
226
227 int dvb_usbv2_adapter_stream_init(struct dvb_usb_adapter *adap)
228 {
229 dev_dbg(&adap_to_d(adap)->udev->dev, "%s: adap=%d\n", __func__,
230 adap->id);
231
232 adap->stream.udev = adap_to_d(adap)->udev;
233 adap->stream.user_priv = adap;
234 adap->stream.complete = dvb_usb_data_complete;
235
236 return usb_urb_initv2(&adap->stream, &adap->props->stream);
237 }
238
239 int dvb_usbv2_adapter_stream_exit(struct dvb_usb_adapter *adap)
240 {
241 dev_dbg(&adap_to_d(adap)->udev->dev, "%s: adap=%d\n", __func__,
242 adap->id);
243
244 return usb_urb_exitv2(&adap->stream);
245 }
246
247 static inline int dvb_usb_ctrl_feed(struct dvb_demux_feed *dvbdmxfeed,
248 int count)
249 {
250 struct dvb_usb_adapter *adap = dvbdmxfeed->demux->priv;
251 struct dvb_usb_device *d = adap_to_d(adap);
252 int ret;
253 dev_dbg(&d->udev->dev, "%s: adap=%d active_fe=%d feed_type=%d " \
254 "setting pid [%s]: %04x (%04d) at index %d '%s'\n",
255 __func__, adap->id, adap->active_fe, dvbdmxfeed->type,
256 adap->pid_filtering ? "yes" : "no", dvbdmxfeed->pid,
257 dvbdmxfeed->pid, dvbdmxfeed->index,
258 (count == 1) ? "on" : "off");
259
260 if (adap->active_fe == -1)
261 return -EINVAL;
262
263 adap->feed_count += count;
264
265 /* stop feeding if it is last pid */
266 if (adap->feed_count == 0) {
267 dev_dbg(&d->udev->dev, "%s: stop feeding\n", __func__);
268 usb_urb_killv2(&adap->stream);
269
270 if (d->props->streaming_ctrl) {
271 ret = d->props->streaming_ctrl(
272 adap->fe[adap->active_fe], 0);
273 if (ret < 0) {
274 dev_err(&d->udev->dev, "%s: streaming_ctrl() " \
275 "failed=%d\n", KBUILD_MODNAME,
276 ret);
277 goto err_mutex_unlock;
278 }
279 }
280 mutex_unlock(&adap->sync_mutex);
281 }
282
283 /* activate the pid on the device pid filter */
284 if (adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER &&
285 adap->pid_filtering &&
286 adap->props->pid_filter)
287 ret = adap->props->pid_filter(adap, dvbdmxfeed->index,
288 dvbdmxfeed->pid, (count == 1) ? 1 : 0);
289 if (ret < 0)
290 dev_err(&d->udev->dev, "%s: pid_filter() " \
291 "failed=%d\n", KBUILD_MODNAME,
292 ret);
293
294 /* start feeding if it is first pid */
295 if (adap->feed_count == 1 && count == 1) {
296 struct usb_data_stream_properties stream_props;
297 mutex_lock(&adap->sync_mutex);
298 dev_dbg(&d->udev->dev, "%s: start feeding\n", __func__);
299
300 /* resolve input and output streaming paramters */
301 if (d->props->get_stream_config) {
302 memcpy(&stream_props, &adap->props->stream,
303 sizeof(struct usb_data_stream_properties));
304 ret = d->props->get_stream_config(
305 adap->fe[adap->active_fe],
306 &adap->ts_type, &stream_props);
307 if (ret < 0)
308 goto err_mutex_unlock;
309 } else {
310 stream_props = adap->props->stream;
311 }
312
313 switch (adap->ts_type) {
314 case DVB_USB_FE_TS_TYPE_204:
315 adap->stream.complete = dvb_usb_data_complete_204;
316 break;
317 case DVB_USB_FE_TS_TYPE_RAW:
318 adap->stream.complete = dvb_usb_data_complete_raw;
319 break;
320 case DVB_USB_FE_TS_TYPE_188:
321 default:
322 adap->stream.complete = dvb_usb_data_complete;
323 break;
324 }
325
326 usb_urb_submitv2(&adap->stream, &stream_props);
327
328 if (adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER &&
329 adap->props->caps &
330 DVB_USB_ADAP_PID_FILTER_CAN_BE_TURNED_OFF &&
331 adap->props->pid_filter_ctrl) {
332 ret = adap->props->pid_filter_ctrl(adap,
333 adap->pid_filtering);
334 if (ret < 0) {
335 dev_err(&d->udev->dev, "%s: " \
336 "pid_filter_ctrl() failed=%d\n",
337 KBUILD_MODNAME, ret);
338 goto err_mutex_unlock;
339 }
340 }
341
342 if (d->props->streaming_ctrl) {
343 ret = d->props->streaming_ctrl(
344 adap->fe[adap->active_fe], 1);
345 if (ret < 0) {
346 dev_err(&d->udev->dev, "%s: streaming_ctrl() " \
347 "failed=%d\n", KBUILD_MODNAME,
348 ret);
349 goto err_mutex_unlock;
350 }
351 }
352 }
353
354 return 0;
355 err_mutex_unlock:
356 mutex_unlock(&adap->sync_mutex);
357 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
358 return ret;
359 }
360
361 static int dvb_usb_start_feed(struct dvb_demux_feed *dvbdmxfeed)
362 {
363 return dvb_usb_ctrl_feed(dvbdmxfeed, 1);
364 }
365
366 static int dvb_usb_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
367 {
368 return dvb_usb_ctrl_feed(dvbdmxfeed, -1);
369 }
370
371 int dvb_usbv2_adapter_dvb_init(struct dvb_usb_adapter *adap)
372 {
373 int ret;
374 struct dvb_usb_device *d = adap_to_d(adap);
375 dev_dbg(&d->udev->dev, "%s: adap=%d\n", __func__, adap->id);
376
377 ret = dvb_register_adapter(&adap->dvb_adap, d->name, d->props->owner,
378 &d->udev->dev, d->props->adapter_nr);
379 if (ret < 0) {
380 dev_dbg(&d->udev->dev, "%s: dvb_register_adapter() failed=%d\n",
381 __func__, ret);
382 goto err_dvb_register_adapter;
383 }
384
385 adap->dvb_adap.priv = adap;
386
387 if (d->props->read_mac_address) {
388 ret = d->props->read_mac_address(adap,
389 adap->dvb_adap.proposed_mac);
390 if (ret < 0)
391 goto err_dvb_dmx_init;
392
393 dev_info(&d->udev->dev, "%s: MAC address: %pM\n",
394 KBUILD_MODNAME, adap->dvb_adap.proposed_mac);
395 }
396
397 adap->demux.dmx.capabilities = DMX_TS_FILTERING | DMX_SECTION_FILTERING;
398 adap->demux.priv = adap;
399 adap->demux.filternum = 0;
400 adap->demux.filternum = adap->max_feed_count;
401 adap->demux.feednum = adap->demux.filternum;
402 adap->demux.start_feed = dvb_usb_start_feed;
403 adap->demux.stop_feed = dvb_usb_stop_feed;
404 adap->demux.write_to_decoder = NULL;
405 ret = dvb_dmx_init(&adap->demux);
406 if (ret < 0) {
407 dev_err(&d->udev->dev, "%s: dvb_dmx_init() failed=%d\n",
408 KBUILD_MODNAME, ret);
409 goto err_dvb_dmx_init;
410 }
411
412 adap->dmxdev.filternum = adap->demux.filternum;
413 adap->dmxdev.demux = &adap->demux.dmx;
414 adap->dmxdev.capabilities = 0;
415 ret = dvb_dmxdev_init(&adap->dmxdev, &adap->dvb_adap);
416 if (ret < 0) {
417 dev_err(&d->udev->dev, "%s: dvb_dmxdev_init() failed=%d\n",
418 KBUILD_MODNAME, ret);
419 goto err_dvb_dmxdev_init;
420 }
421
422 ret = dvb_net_init(&adap->dvb_adap, &adap->dvb_net, &adap->demux.dmx);
423 if (ret < 0) {
424 dev_err(&d->udev->dev, "%s: dvb_net_init() failed=%d\n",
425 KBUILD_MODNAME, ret);
426 goto err_dvb_net_init;
427 }
428
429 mutex_init(&adap->sync_mutex);
430
431 return 0;
432 err_dvb_net_init:
433 dvb_dmxdev_release(&adap->dmxdev);
434 err_dvb_dmxdev_init:
435 dvb_dmx_release(&adap->demux);
436 err_dvb_dmx_init:
437 dvb_unregister_adapter(&adap->dvb_adap);
438 err_dvb_register_adapter:
439 adap->dvb_adap.priv = NULL;
440 return ret;
441 }
442
443 int dvb_usbv2_adapter_dvb_exit(struct dvb_usb_adapter *adap)
444 {
445 dev_dbg(&adap_to_d(adap)->udev->dev, "%s: adap=%d\n", __func__,
446 adap->id);
447
448 if (adap->dvb_adap.priv) {
449 dvb_net_release(&adap->dvb_net);
450 adap->demux.dmx.close(&adap->demux.dmx);
451 dvb_dmxdev_release(&adap->dmxdev);
452 dvb_dmx_release(&adap->demux);
453 dvb_unregister_adapter(&adap->dvb_adap);
454 }
455
456 return 0;
457 }
458
459 int dvb_usbv2_device_power_ctrl(struct dvb_usb_device *d, int onoff)
460 {
461 int ret;
462
463 if (onoff)
464 d->powered++;
465 else
466 d->powered--;
467
468 if (d->powered == 0 || (onoff && d->powered == 1)) {
469 /* when switching from 1 to 0 or from 0 to 1 */
470 dev_dbg(&d->udev->dev, "%s: power=%d\n", __func__, onoff);
471 if (d->props->power_ctrl) {
472 ret = d->props->power_ctrl(d, onoff);
473 if (ret < 0)
474 goto err;
475 }
476 }
477
478 return 0;
479 err:
480 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
481 return ret;
482 }
483
484 static int dvb_usb_fe_init(struct dvb_frontend *fe)
485 {
486 int ret;
487 struct dvb_usb_adapter *adap = fe->dvb->priv;
488 struct dvb_usb_device *d = adap_to_d(adap);
489 dev_dbg(&d->udev->dev, "%s: adap=%d fe=%d\n", __func__, adap->id,
490 fe->id);
491
492 ret = dvb_usbv2_device_power_ctrl(d, 1);
493 if (ret < 0)
494 goto err;
495
496 if (d->props->frontend_ctrl) {
497 ret = d->props->frontend_ctrl(fe, 1);
498 if (ret < 0)
499 goto err;
500 }
501
502 if (adap->fe_init[fe->id]) {
503 ret = adap->fe_init[fe->id](fe);
504 if (ret < 0)
505 goto err;
506 }
507
508 return 0;
509 err:
510 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
511 return ret;
512 }
513
514 static int dvb_usb_fe_init_lock(struct dvb_frontend *fe)
515 {
516 int ret;
517 struct dvb_usb_adapter *adap = fe->dvb->priv;
518 mutex_lock(&adap->sync_mutex);
519
520 ret = dvb_usb_fe_init(fe);
521 adap->active_fe = fe->id;
522
523 mutex_unlock(&adap->sync_mutex);
524 return ret;
525 }
526
527 static int dvb_usb_fe_sleep(struct dvb_frontend *fe)
528 {
529 int ret;
530 struct dvb_usb_adapter *adap = fe->dvb->priv;
531 struct dvb_usb_device *d = adap_to_d(adap);
532 dev_dbg(&d->udev->dev, "%s: adap=%d fe=%d\n", __func__, adap->id,
533 fe->id);
534
535 if (adap->fe_sleep[fe->id]) {
536 ret = adap->fe_sleep[fe->id](fe);
537 if (ret < 0)
538 goto err;
539 }
540
541 if (d->props->frontend_ctrl) {
542 ret = d->props->frontend_ctrl(fe, 0);
543 if (ret < 0)
544 goto err;
545 }
546
547 ret = dvb_usbv2_device_power_ctrl(d, 0);
548 if (ret < 0)
549 goto err;
550
551 return 0;
552 err:
553 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
554 return ret;
555 }
556
557 static int dvb_usb_fe_sleep_lock(struct dvb_frontend *fe)
558 {
559 int ret;
560 struct dvb_usb_adapter *adap = fe->dvb->priv;
561 mutex_lock(&adap->sync_mutex);
562
563 ret = dvb_usb_fe_sleep(fe);
564 adap->active_fe = -1;
565
566 mutex_unlock(&adap->sync_mutex);
567 return ret;
568 }
569
570 int dvb_usbv2_adapter_frontend_init(struct dvb_usb_adapter *adap)
571 {
572 int ret, i, count_registered = 0;
573 struct dvb_usb_device *d = adap_to_d(adap);
574 dev_dbg(&d->udev->dev, "%s: adap=%d\n", __func__, adap->id);
575
576 memset(adap->fe, 0, sizeof(adap->fe));
577 adap->active_fe = -1;
578
579 if (d->props->frontend_attach) {
580 ret = d->props->frontend_attach(adap);
581 if (ret < 0) {
582 dev_dbg(&d->udev->dev, "%s: frontend_attach() " \
583 "failed=%d\n", __func__, ret);
584 goto err_dvb_frontend_detach;
585 }
586 } else {
587 dev_dbg(&d->udev->dev, "%s: frontend_attach() do not exists\n",
588 __func__);
589 ret = 0;
590 goto err;
591 }
592
593 for (i = 0; i < MAX_NO_OF_FE_PER_ADAP && adap->fe[i]; i++) {
594 adap->fe[i]->id = i;
595 /* re-assign sleep and wakeup functions */
596 adap->fe_init[i] = adap->fe[i]->ops.init;
597 adap->fe[i]->ops.init = dvb_usb_fe_init_lock;
598 adap->fe_sleep[i] = adap->fe[i]->ops.sleep;
599 adap->fe[i]->ops.sleep = dvb_usb_fe_sleep_lock;
600
601 ret = dvb_register_frontend(&adap->dvb_adap, adap->fe[i]);
602 if (ret < 0) {
603 dev_err(&d->udev->dev, "%s: frontend%d registration " \
604 "failed\n", KBUILD_MODNAME, i);
605 goto err_dvb_unregister_frontend;
606 }
607
608 count_registered++;
609 }
610
611 if (d->props->tuner_attach) {
612 ret = d->props->tuner_attach(adap);
613 if (ret < 0) {
614 dev_dbg(&d->udev->dev, "%s: tuner_attach() failed=%d\n",
615 __func__, ret);
616 goto err_dvb_unregister_frontend;
617 }
618 }
619
620 return 0;
621
622 err_dvb_unregister_frontend:
623 for (i = count_registered - 1; i >= 0; i--)
624 dvb_unregister_frontend(adap->fe[i]);
625
626 err_dvb_frontend_detach:
627 for (i = MAX_NO_OF_FE_PER_ADAP - 1; i >= 0; i--) {
628 if (adap->fe[i])
629 dvb_frontend_detach(adap->fe[i]);
630 }
631
632 err:
633 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
634 return ret;
635 }
636
637 int dvb_usbv2_adapter_frontend_exit(struct dvb_usb_adapter *adap)
638 {
639 int i;
640 dev_dbg(&adap_to_d(adap)->udev->dev, "%s: adap=%d\n", __func__,
641 adap->id);
642
643 for (i = MAX_NO_OF_FE_PER_ADAP - 1; i >= 0; i--) {
644 if (adap->fe[i]) {
645 dvb_unregister_frontend(adap->fe[i]);
646 dvb_frontend_detach(adap->fe[i]);
647 }
648 }
649
650 return 0;
651 }
652
653 static int dvb_usbv2_adapter_init(struct dvb_usb_device *d)
654 {
655 struct dvb_usb_adapter *adap;
656 int ret, i, adapter_count;
657
658 /* resolve adapter count */
659 adapter_count = d->props->num_adapters;
660 if (d->props->get_adapter_count) {
661 ret = d->props->get_adapter_count(d);
662 if (ret < 0)
663 goto err;
664
665 adapter_count = ret;
666 }
667
668 for (i = 0; i < adapter_count; i++) {
669 adap = &d->adapter[i];
670 adap->id = i;
671 adap->props = &d->props->adapter[i];
672
673 /* speed - when running at FULL speed we need a HW PID filter */
674 if (d->udev->speed == USB_SPEED_FULL &&
675 !(adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER)) {
676 dev_err(&d->udev->dev, "%s: this USB2.0 device " \
677 "cannot be run on a USB1.1 port (it " \
678 "lacks a hardware PID filter)\n",
679 KBUILD_MODNAME);
680 ret = -ENODEV;
681 goto err;
682 } else if ((d->udev->speed == USB_SPEED_FULL &&
683 adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER) ||
684 (adap->props->caps & DVB_USB_ADAP_NEED_PID_FILTERING)) {
685 dev_info(&d->udev->dev, "%s: will use the device's " \
686 "hardware PID filter " \
687 "(table count: %d)\n", KBUILD_MODNAME,
688 adap->props->pid_filter_count);
689 adap->pid_filtering = 1;
690 adap->max_feed_count = adap->props->pid_filter_count;
691 } else {
692 dev_info(&d->udev->dev, "%s: will pass the complete " \
693 "MPEG2 transport stream to the " \
694 "software demuxer\n", KBUILD_MODNAME);
695 adap->pid_filtering = 0;
696 adap->max_feed_count = 255;
697 }
698
699 if (!adap->pid_filtering && dvb_usb_force_pid_filter_usage &&
700 adap->props->caps & DVB_USB_ADAP_HAS_PID_FILTER) {
701 dev_info(&d->udev->dev, "%s: PID filter enabled by " \
702 "module option\n", KBUILD_MODNAME);
703 adap->pid_filtering = 1;
704 adap->max_feed_count = adap->props->pid_filter_count;
705 }
706
707 ret = dvb_usbv2_adapter_stream_init(adap);
708 if (ret)
709 goto err;
710
711 ret = dvb_usbv2_adapter_dvb_init(adap);
712 if (ret)
713 goto err;
714
715 ret = dvb_usbv2_adapter_frontend_init(adap);
716 if (ret)
717 goto err;
718
719 /* use exclusive FE lock if there is multiple shared FEs */
720 if (adap->fe[1])
721 adap->dvb_adap.mfe_shared = 1;
722 }
723
724 return 0;
725 err:
726 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
727 return ret;
728 }
729
730 static int dvb_usbv2_adapter_exit(struct dvb_usb_device *d)
731 {
732 int i;
733 dev_dbg(&d->udev->dev, "%s:\n", __func__);
734
735 for (i = MAX_NO_OF_ADAPTER_PER_DEVICE - 1; i >= 0; i--) {
736 if (d->adapter[i].props) {
737 dvb_usbv2_adapter_frontend_exit(&d->adapter[i]);
738 dvb_usbv2_adapter_dvb_exit(&d->adapter[i]);
739 dvb_usbv2_adapter_stream_exit(&d->adapter[i]);
740 }
741 }
742
743 return 0;
744 }
745
746 /* general initialization functions */
747 static int dvb_usbv2_exit(struct dvb_usb_device *d)
748 {
749 dev_dbg(&d->udev->dev, "%s:\n", __func__);
750
751 dvb_usbv2_remote_exit(d);
752 dvb_usbv2_adapter_exit(d);
753 dvb_usbv2_i2c_exit(d);
754 kfree(d->priv);
755 kfree(d);
756
757 return 0;
758 }
759
760 static int dvb_usbv2_init(struct dvb_usb_device *d)
761 {
762 int ret;
763 dev_dbg(&d->udev->dev, "%s:\n", __func__);
764
765 dvb_usbv2_device_power_ctrl(d, 1);
766
767 if (d->props->read_config) {
768 ret = d->props->read_config(d);
769 if (ret < 0)
770 goto err;
771 }
772
773 ret = dvb_usbv2_i2c_init(d);
774 if (ret < 0)
775 goto err;
776
777 ret = dvb_usbv2_adapter_init(d);
778 if (ret < 0)
779 goto err;
780
781 if (d->props->init) {
782 ret = d->props->init(d);
783 if (ret < 0)
784 goto err;
785 }
786
787 ret = dvb_usbv2_remote_init(d);
788 if (ret < 0)
789 goto err;
790
791 dvb_usbv2_device_power_ctrl(d, 0);
792
793 return 0;
794 err:
795 dvb_usbv2_device_power_ctrl(d, 0);
796 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
797 return ret;
798 }
799
800 /*
801 * udev, which is used for the firmware downloading, requires we cannot
802 * block during module_init(). module_init() calls USB probe() which
803 * is this routine. Due to that we delay actual operation using workqueue
804 * and return always success here.
805 */
806 static void dvb_usbv2_init_work(struct work_struct *work)
807 {
808 int ret;
809 struct dvb_usb_device *d =
810 container_of(work, struct dvb_usb_device, probe_work);
811
812 d->work_pid = current->pid;
813 dev_dbg(&d->udev->dev, "%s: work_pid=%d\n", __func__, d->work_pid);
814
815 if (d->props->size_of_priv) {
816 d->priv = kzalloc(d->props->size_of_priv, GFP_KERNEL);
817 if (!d->priv) {
818 dev_err(&d->udev->dev, "%s: kzalloc() failed\n",
819 KBUILD_MODNAME);
820 ret = -ENOMEM;
821 goto err_usb_driver_release_interface;
822 }
823 }
824
825 if (d->props->identify_state) {
826 const char *name = NULL;
827 ret = d->props->identify_state(d, &name);
828 if (ret == 0) {
829 ;
830 } else if (ret == COLD) {
831 dev_info(&d->udev->dev, "%s: found a '%s' in cold " \
832 "state\n", KBUILD_MODNAME, d->name);
833
834 if (!name)
835 name = d->props->firmware;
836
837 ret = dvb_usbv2_download_firmware(d, name);
838 if (ret == 0) {
839 /* device is warm, continue initialization */
840 ;
841 } else if (ret == RECONNECTS_USB) {
842 /*
843 * USB core will call disconnect() and then
844 * probe() as device reconnects itself from the
845 * USB bus. disconnect() will release all driver
846 * resources and probe() is called for 'new'
847 * device. As 'new' device is warm we should
848 * never go here again.
849 */
850 return;
851 } else {
852 /*
853 * Unexpected error. We must unregister driver
854 * manually from the device, because device is
855 * already register by returning from probe()
856 * with success. usb_driver_release_interface()
857 * finally calls disconnect() in order to free
858 * resources.
859 */
860 goto err_usb_driver_release_interface;
861 }
862 } else {
863 goto err_usb_driver_release_interface;
864 }
865 }
866
867 dev_info(&d->udev->dev, "%s: found a '%s' in warm state\n",
868 KBUILD_MODNAME, d->name);
869
870 ret = dvb_usbv2_init(d);
871 if (ret < 0)
872 goto err_usb_driver_release_interface;
873
874 dev_info(&d->udev->dev, "%s: '%s' successfully initialized and " \
875 "connected\n", KBUILD_MODNAME, d->name);
876
877 return;
878 err_usb_driver_release_interface:
879 dev_info(&d->udev->dev, "%s: '%s' error while loading driver (%d)\n",
880 KBUILD_MODNAME, d->name, ret);
881 usb_driver_release_interface(to_usb_driver(d->intf->dev.driver),
882 d->intf);
883 dev_dbg(&d->udev->dev, "%s: failed=%d\n", __func__, ret);
884 return;
885 }
886
887 int dvb_usbv2_probe(struct usb_interface *intf,
888 const struct usb_device_id *id)
889 {
890 int ret;
891 struct dvb_usb_device *d;
892 struct usb_device *udev = interface_to_usbdev(intf);
893 struct dvb_usb_driver_info *driver_info =
894 (struct dvb_usb_driver_info *) id->driver_info;
895
896 dev_dbg(&udev->dev, "%s: bInterfaceNumber=%d\n", __func__,
897 intf->cur_altsetting->desc.bInterfaceNumber);
898
899 if (!id->driver_info) {
900 dev_err(&udev->dev, "%s: driver_info failed\n", KBUILD_MODNAME);
901 ret = -ENODEV;
902 goto err;
903 }
904
905 d = kzalloc(sizeof(struct dvb_usb_device), GFP_KERNEL);
906 if (!d) {
907 dev_err(&udev->dev, "%s: kzalloc() failed\n", KBUILD_MODNAME);
908 ret = -ENOMEM;
909 goto err;
910 }
911
912 d->name = driver_info->name;
913 d->rc_map = driver_info->rc_map;
914 d->udev = udev;
915 d->intf = intf;
916 d->props = driver_info->props;
917
918 if (d->intf->cur_altsetting->desc.bInterfaceNumber !=
919 d->props->bInterfaceNumber) {
920 ret = -ENODEV;
921 goto err_kfree;
922 }
923
924 mutex_init(&d->usb_mutex);
925 mutex_init(&d->i2c_mutex);
926 INIT_WORK(&d->probe_work, dvb_usbv2_init_work);
927 usb_set_intfdata(intf, d);
928 ret = schedule_work(&d->probe_work);
929 if (ret < 0) {
930 dev_err(&d->udev->dev, "%s: schedule_work() failed\n",
931 KBUILD_MODNAME);
932 goto err_kfree;
933 }
934
935 return 0;
936 err_kfree:
937 kfree(d);
938 err:
939 dev_dbg(&udev->dev, "%s: failed=%d\n", __func__, ret);
940 return ret;
941 }
942 EXPORT_SYMBOL(dvb_usbv2_probe);
943
944 void dvb_usbv2_disconnect(struct usb_interface *intf)
945 {
946 struct dvb_usb_device *d = usb_get_intfdata(intf);
947 const char *name = d->name;
948 struct device dev = d->udev->dev;
949 dev_dbg(&d->udev->dev, "%s: pid=%d work_pid=%d\n", __func__,
950 current->pid, d->work_pid);
951
952 /* ensure initialization work is finished until release resources */
953 if (d->work_pid != current->pid)
954 cancel_work_sync(&d->probe_work);
955
956 if (d->props->exit)
957 d->props->exit(d);
958
959 dvb_usbv2_exit(d);
960
961 dev_info(&dev, "%s: '%s' successfully deinitialized and disconnected\n",
962 KBUILD_MODNAME, name);
963 }
964 EXPORT_SYMBOL(dvb_usbv2_disconnect);
965
966 int dvb_usbv2_suspend(struct usb_interface *intf, pm_message_t msg)
967 {
968 struct dvb_usb_device *d = usb_get_intfdata(intf);
969 int i, active_fe;
970 struct dvb_frontend *fe;
971 dev_dbg(&d->udev->dev, "%s:\n", __func__);
972
973 /* stop remote controller poll */
974 if (d->rc.query && !d->rc.bulk_mode)
975 cancel_delayed_work_sync(&d->rc_query_work);
976
977 for (i = MAX_NO_OF_ADAPTER_PER_DEVICE - 1; i >= 0; i--) {
978 active_fe = d->adapter[i].active_fe;
979 if (d->adapter[i].dvb_adap.priv && active_fe != -1) {
980 fe = d->adapter[i].fe[active_fe];
981
982 if (d->props->streaming_ctrl)
983 d->props->streaming_ctrl(fe, 0);
984
985 /* stop usb streaming */
986 usb_urb_killv2(&d->adapter[i].stream);
987
988 if (fe->ops.tuner_ops.sleep)
989 fe->ops.tuner_ops.sleep(fe);
990
991 dvb_usb_fe_sleep(fe);
992 }
993 }
994
995 return 0;
996 }
997 EXPORT_SYMBOL(dvb_usbv2_suspend);
998
999 int dvb_usbv2_resume(struct usb_interface *intf)
1000 {
1001 struct dvb_usb_device *d = usb_get_intfdata(intf);
1002 int i, active_fe;
1003 struct dvb_frontend *fe;
1004 dev_dbg(&d->udev->dev, "%s:\n", __func__);
1005
1006 for (i = 0; i < MAX_NO_OF_ADAPTER_PER_DEVICE; i++) {
1007 active_fe = d->adapter[i].active_fe;
1008 if (d->adapter[i].dvb_adap.priv && active_fe != -1) {
1009 fe = d->adapter[i].fe[active_fe];
1010
1011 dvb_usb_fe_init(fe);
1012
1013 if (fe->ops.tuner_ops.init)
1014 fe->ops.tuner_ops.init(fe);
1015
1016 /* acquire dvb-core perform retune */
1017 dvb_frontend_retune(fe);
1018
1019 /* resume usb streaming */
1020 usb_urb_submitv2(&d->adapter[i].stream, NULL);
1021
1022 if (d->props->streaming_ctrl)
1023 d->props->streaming_ctrl(fe, 1);
1024 }
1025 }
1026
1027 /* start remote controller poll */
1028 if (d->rc.query && !d->rc.bulk_mode)
1029 schedule_delayed_work(&d->rc_query_work,
1030 msecs_to_jiffies(d->rc.interval));
1031
1032 return 0;
1033 }
1034 EXPORT_SYMBOL(dvb_usbv2_resume);
1035
1036 MODULE_VERSION("2.0");
1037 MODULE_AUTHOR("Patrick Boettcher <patrick.boettcher@desy.de>");
1038 MODULE_AUTHOR("Antti Palosaari <crope@iki.fi>");
1039 MODULE_DESCRIPTION("DVB USB common");
1040 MODULE_LICENSE("GPL");
Linux kernel - Deliverables
This page took 0.050387 seconds and 4 git commands to generate.