blob: 3de7c7e4402de7f461c1eb4a41bde553f9062ada [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Linus Torvalds1da177e2005-04-16 15:20:36 -07002 *
3 * some helper function for simple DVB cards which simply DMA the
4 * complete transport stream and let the computer sort everything else
5 * (i.e. we are using the software demux, ...). Also uses the
6 * video-buf to manage DMA buffers.
7 *
8 * (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SUSE Labs]
9 *
10 * This program is free software; you can redistribute it and/or modify
11 * it under the terms of the GNU General Public License as published by
12 * the Free Software Foundation; either version 2 of the License, or
13 * (at your option) any later version.
14 */
15
16#include <linux/module.h>
17#include <linux/init.h>
18#include <linux/device.h>
19#include <linux/fs.h>
20#include <linux/kthread.h>
21#include <linux/file.h>
Tejun Heo5a0e3ad2010-03-24 17:04:11 +090022#include <linux/slab.h>
Mauro Carvalho Chehab59d34482008-04-13 15:10:00 -030023
Nigel Cunningham7dfb7102006-12-06 20:34:23 -080024#include <linux/freezer.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070025
Mauro Carvalho Chehab59d34482008-04-13 15:10:00 -030026#include <media/videobuf-core.h>
Mauro Carvalho Chehabba366a22007-08-23 18:12:08 -030027#include <media/videobuf-dvb.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070028
29/* ------------------------------------------------------------------ */
30
31MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
32MODULE_LICENSE("GPL");
33
Douglas Schilling Landgrafff699e62008-04-22 14:41:48 -030034static unsigned int debug;
Linus Torvalds1da177e2005-04-16 15:20:36 -070035module_param(debug, int, 0644);
36MODULE_PARM_DESC(debug,"enable debug messages");
37
38#define dprintk(fmt, arg...) if (debug) \
39 printk(KERN_DEBUG "%s/dvb: " fmt, dvb->name , ## arg)
40
41/* ------------------------------------------------------------------ */
42
43static int videobuf_dvb_thread(void *data)
44{
45 struct videobuf_dvb *dvb = data;
46 struct videobuf_buffer *buf;
47 unsigned long flags;
48 int err;
Mauro Carvalho Chehab59d34482008-04-13 15:10:00 -030049 void *outp;
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
51 dprintk("dvb thread started\n");
Rafael J. Wysocki83144182007-07-17 04:03:35 -070052 set_freezable();
Linus Torvalds1da177e2005-04-16 15:20:36 -070053 videobuf_read_start(&dvb->dvbq);
54
55 for (;;) {
56 /* fetch next buffer */
57 buf = list_entry(dvb->dvbq.stream.next,
58 struct videobuf_buffer, stream);
59 list_del(&buf->stream);
Hans Verkuil0e0809a2010-09-26 09:01:26 -030060 err = videobuf_waiton(&dvb->dvbq, buf, 0, 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -070061
62 /* no more feeds left or stop_feed() asked us to quit */
63 if (0 == dvb->nfeeds)
64 break;
65 if (kthread_should_stop())
66 break;
Christoph Lameter3e1d1d22005-06-24 23:13:50 -070067 try_to_freeze();
Linus Torvalds1da177e2005-04-16 15:20:36 -070068
69 /* feed buffer data to demux */
Hans Verkuilf4fce602010-03-28 08:33:23 -030070 outp = videobuf_queue_to_vaddr(&dvb->dvbq, buf);
Mauro Carvalho Chehab59d34482008-04-13 15:10:00 -030071
Brandon Philips0fc06862007-11-06 20:02:36 -030072 if (buf->state == VIDEOBUF_DONE)
Mauro Carvalho Chehab59d34482008-04-13 15:10:00 -030073 dvb_dmx_swfilter(&dvb->demux, outp,
Linus Torvalds1da177e2005-04-16 15:20:36 -070074 buf->size);
75
76 /* requeue buffer */
77 list_add_tail(&buf->stream,&dvb->dvbq.stream);
78 spin_lock_irqsave(dvb->dvbq.irqlock,flags);
79 dvb->dvbq.ops->buf_queue(&dvb->dvbq,buf);
80 spin_unlock_irqrestore(dvb->dvbq.irqlock,flags);
81 }
82
83 videobuf_read_stop(&dvb->dvbq);
84 dprintk("dvb thread stopped\n");
85
86 /* Hmm, linux becomes *very* unhappy without this ... */
87 while (!kthread_should_stop()) {
88 set_current_state(TASK_INTERRUPTIBLE);
89 schedule();
90 }
91 return 0;
92}
93
94static int videobuf_dvb_start_feed(struct dvb_demux_feed *feed)
95{
96 struct dvb_demux *demux = feed->demux;
97 struct videobuf_dvb *dvb = demux->priv;
98 int rc;
99
100 if (!demux->dmx.frontend)
101 return -EINVAL;
102
Ingo Molnar3593cab2006-02-07 06:49:14 -0200103 mutex_lock(&dvb->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700104 dvb->nfeeds++;
105 rc = dvb->nfeeds;
106
107 if (NULL != dvb->thread)
108 goto out;
109 dvb->thread = kthread_run(videobuf_dvb_thread,
110 dvb, "%s dvb", dvb->name);
111 if (IS_ERR(dvb->thread)) {
112 rc = PTR_ERR(dvb->thread);
113 dvb->thread = NULL;
114 }
115
116out:
Ingo Molnar3593cab2006-02-07 06:49:14 -0200117 mutex_unlock(&dvb->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118 return rc;
119}
120
121static int videobuf_dvb_stop_feed(struct dvb_demux_feed *feed)
122{
123 struct dvb_demux *demux = feed->demux;
124 struct videobuf_dvb *dvb = demux->priv;
125 int err = 0;
126
Ingo Molnar3593cab2006-02-07 06:49:14 -0200127 mutex_lock(&dvb->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700128 dvb->nfeeds--;
129 if (0 == dvb->nfeeds && NULL != dvb->thread) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 err = kthread_stop(dvb->thread);
131 dvb->thread = NULL;
132 }
Ingo Molnar3593cab2006-02-07 06:49:14 -0200133 mutex_unlock(&dvb->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700134 return err;
135}
136
Mauro Carvalho Chehabdcadd082008-10-17 13:02:47 -0300137static int videobuf_dvb_register_adapter(struct videobuf_dvb_frontends *fe,
Steven Toth363c35f2008-10-11 11:05:50 -0300138 struct module *module,
139 void *adapter_priv,
140 struct device *device,
141 char *adapter_name,
Darron Broad59b18422008-10-11 11:44:05 -0300142 short *adapter_nr,
Michael Krufky9133aee2009-05-23 18:00:59 -0300143 int mfe_shared,
144 int (*fe_ioctl_override)(struct dvb_frontend *,
145 unsigned int, void *, unsigned int))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700146{
147 int result;
148
Steven Toth363c35f2008-10-11 11:05:50 -0300149 mutex_init(&fe->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700150
151 /* register adapter */
Steven Toth11fbedd2008-10-16 21:42:10 -0300152 result = dvb_register_adapter(&fe->adapter, adapter_name, module,
153 device, adapter_nr);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154 if (result < 0) {
155 printk(KERN_WARNING "%s: dvb_register_adapter failed (errno = %d)\n",
Steven Toth363c35f2008-10-11 11:05:50 -0300156 adapter_name, result);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157 }
Steven Toth363c35f2008-10-11 11:05:50 -0300158 fe->adapter.priv = adapter_priv;
Darron Broad59b18422008-10-11 11:44:05 -0300159 fe->adapter.mfe_shared = mfe_shared;
Michael Krufky9133aee2009-05-23 18:00:59 -0300160 fe->adapter.fe_ioctl_override = fe_ioctl_override;
Steven Toth363c35f2008-10-11 11:05:50 -0300161
162 return result;
163}
164
Mauro Carvalho Chehabdcadd082008-10-17 13:02:47 -0300165static int videobuf_dvb_register_frontend(struct dvb_adapter *adapter,
Steven Toth11fbedd2008-10-16 21:42:10 -0300166 struct videobuf_dvb *dvb)
Steven Toth363c35f2008-10-11 11:05:50 -0300167{
168 int result;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700169
170 /* register frontend */
Steven Toth363c35f2008-10-11 11:05:50 -0300171 result = dvb_register_frontend(adapter, dvb->frontend);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700172 if (result < 0) {
173 printk(KERN_WARNING "%s: dvb_register_frontend failed (errno = %d)\n",
174 dvb->name, result);
175 goto fail_frontend;
176 }
177
178 /* register demux stuff */
179 dvb->demux.dmx.capabilities =
180 DMX_TS_FILTERING | DMX_SECTION_FILTERING |
181 DMX_MEMORY_BASED_FILTERING;
182 dvb->demux.priv = dvb;
183 dvb->demux.filternum = 256;
184 dvb->demux.feednum = 256;
185 dvb->demux.start_feed = videobuf_dvb_start_feed;
186 dvb->demux.stop_feed = videobuf_dvb_stop_feed;
187 result = dvb_dmx_init(&dvb->demux);
188 if (result < 0) {
189 printk(KERN_WARNING "%s: dvb_dmx_init failed (errno = %d)\n",
190 dvb->name, result);
191 goto fail_dmx;
192 }
193
194 dvb->dmxdev.filternum = 256;
195 dvb->dmxdev.demux = &dvb->demux.dmx;
196 dvb->dmxdev.capabilities = 0;
Steven Toth363c35f2008-10-11 11:05:50 -0300197 result = dvb_dmxdev_init(&dvb->dmxdev, adapter);
198
Linus Torvalds1da177e2005-04-16 15:20:36 -0700199 if (result < 0) {
200 printk(KERN_WARNING "%s: dvb_dmxdev_init failed (errno = %d)\n",
201 dvb->name, result);
202 goto fail_dmxdev;
203 }
204
205 dvb->fe_hw.source = DMX_FRONTEND_0;
206 result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_hw);
207 if (result < 0) {
208 printk(KERN_WARNING "%s: add_frontend failed (DMX_FRONTEND_0, errno = %d)\n",
209 dvb->name, result);
210 goto fail_fe_hw;
211 }
212
213 dvb->fe_mem.source = DMX_MEMORY_FE;
214 result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_mem);
215 if (result < 0) {
216 printk(KERN_WARNING "%s: add_frontend failed (DMX_MEMORY_FE, errno = %d)\n",
217 dvb->name, result);
218 goto fail_fe_mem;
219 }
220
221 result = dvb->demux.dmx.connect_frontend(&dvb->demux.dmx, &dvb->fe_hw);
222 if (result < 0) {
223 printk(KERN_WARNING "%s: connect_frontend failed (errno = %d)\n",
224 dvb->name, result);
225 goto fail_fe_conn;
226 }
227
228 /* register network adapter */
Steven Toth363c35f2008-10-11 11:05:50 -0300229 dvb_net_init(adapter, &dvb->net, &dvb->demux.dmx);
Darron Broade43f3fa2008-10-15 13:48:43 -0300230 if (dvb->net.dvbdev == NULL) {
231 result = -ENOMEM;
232 goto fail_fe_conn;
233 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234 return 0;
235
236fail_fe_conn:
237 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
238fail_fe_mem:
239 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
240fail_fe_hw:
241 dvb_dmxdev_release(&dvb->dmxdev);
242fail_dmxdev:
243 dvb_dmx_release(&dvb->demux);
244fail_dmx:
245 dvb_unregister_frontend(dvb->frontend);
246fail_frontend:
Andrew de Quinceyf52a8382006-08-08 09:10:09 -0300247 dvb_frontend_detach(dvb->frontend);
Darron Broade43f3fa2008-10-15 13:48:43 -0300248 dvb->frontend = NULL;
Steven Toth363c35f2008-10-11 11:05:50 -0300249
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 return result;
251}
252
Mauro Carvalho Chehabdcadd082008-10-17 13:02:47 -0300253/* ------------------------------------------------------------------ */
254/* Register a single adapter and one or more frontends */
255int videobuf_dvb_register_bus(struct videobuf_dvb_frontends *f,
256 struct module *module,
257 void *adapter_priv,
258 struct device *device,
259 short *adapter_nr,
Michael Krufky9133aee2009-05-23 18:00:59 -0300260 int mfe_shared,
261 int (*fe_ioctl_override)(struct dvb_frontend *,
262 unsigned int, void *, unsigned int))
Mauro Carvalho Chehabdcadd082008-10-17 13:02:47 -0300263{
264 struct list_head *list, *q;
265 struct videobuf_dvb_frontend *fe;
266 int res;
267
268 fe = videobuf_dvb_get_frontend(f, 1);
269 if (!fe) {
270 printk(KERN_WARNING "Unable to register the adapter which has no frontends\n");
271 return -EINVAL;
272 }
273
274 /* Bring up the adapter */
275 res = videobuf_dvb_register_adapter(f, module, adapter_priv, device,
Michael Krufky9133aee2009-05-23 18:00:59 -0300276 fe->dvb.name, adapter_nr, mfe_shared, fe_ioctl_override);
Mauro Carvalho Chehabdcadd082008-10-17 13:02:47 -0300277 if (res < 0) {
278 printk(KERN_WARNING "videobuf_dvb_register_adapter failed (errno = %d)\n", res);
279 return res;
280 }
281
282 /* Attach all of the frontends to the adapter */
283 mutex_lock(&f->lock);
284 list_for_each_safe(list, q, &f->felist) {
285 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
286 res = videobuf_dvb_register_frontend(&f->adapter, &fe->dvb);
287 if (res < 0) {
288 printk(KERN_WARNING "%s: videobuf_dvb_register_frontend failed (errno = %d)\n",
289 fe->dvb.name, res);
290 goto err;
291 }
292 }
293 mutex_unlock(&f->lock);
294 return 0;
295
296err:
297 mutex_unlock(&f->lock);
298 videobuf_dvb_unregister_bus(f);
299 return res;
300}
301EXPORT_SYMBOL(videobuf_dvb_register_bus);
302
Steven Toth363c35f2008-10-11 11:05:50 -0300303void videobuf_dvb_unregister_bus(struct videobuf_dvb_frontends *f)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700304{
Darron Broad878595f2008-10-21 11:28:46 -0300305 videobuf_dvb_dealloc_frontends(f);
Steven Toth363c35f2008-10-11 11:05:50 -0300306
307 dvb_unregister_adapter(&f->adapter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700308}
Steven Toth11fbedd2008-10-16 21:42:10 -0300309EXPORT_SYMBOL(videobuf_dvb_unregister_bus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310
Steven Toth11fbedd2008-10-16 21:42:10 -0300311struct videobuf_dvb_frontend *videobuf_dvb_get_frontend(
312 struct videobuf_dvb_frontends *f, int id)
Steven Toth363c35f2008-10-11 11:05:50 -0300313{
314 struct list_head *list, *q;
315 struct videobuf_dvb_frontend *fe, *ret = NULL;
316
317 mutex_lock(&f->lock);
318
Darron Broad7bdf84f2008-10-15 13:43:41 -0300319 list_for_each_safe(list, q, &f->felist) {
Steven Toth363c35f2008-10-11 11:05:50 -0300320 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
321 if (fe->id == id) {
322 ret = fe;
323 break;
324 }
325 }
326
327 mutex_unlock(&f->lock);
328
329 return ret;
330}
Steven Toth11fbedd2008-10-16 21:42:10 -0300331EXPORT_SYMBOL(videobuf_dvb_get_frontend);
Steven Toth363c35f2008-10-11 11:05:50 -0300332
Steven Toth11fbedd2008-10-16 21:42:10 -0300333int videobuf_dvb_find_frontend(struct videobuf_dvb_frontends *f,
334 struct dvb_frontend *p)
Steven Toth363c35f2008-10-11 11:05:50 -0300335{
336 struct list_head *list, *q;
337 struct videobuf_dvb_frontend *fe = NULL;
338 int ret = 0;
339
340 mutex_lock(&f->lock);
341
Darron Broad7bdf84f2008-10-15 13:43:41 -0300342 list_for_each_safe(list, q, &f->felist) {
Steven Toth363c35f2008-10-11 11:05:50 -0300343 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
344 if (fe->dvb.frontend == p) {
345 ret = fe->id;
346 break;
347 }
348 }
349
350 mutex_unlock(&f->lock);
351
352 return ret;
353}
Steven Toth11fbedd2008-10-16 21:42:10 -0300354EXPORT_SYMBOL(videobuf_dvb_find_frontend);
Steven Toth363c35f2008-10-11 11:05:50 -0300355
Steven Toth11fbedd2008-10-16 21:42:10 -0300356struct videobuf_dvb_frontend *videobuf_dvb_alloc_frontend(
357 struct videobuf_dvb_frontends *f, int id)
Steven Toth363c35f2008-10-11 11:05:50 -0300358{
359 struct videobuf_dvb_frontend *fe;
360
Steven Toth11fbedd2008-10-16 21:42:10 -0300361 fe = kzalloc(sizeof(struct videobuf_dvb_frontend), GFP_KERNEL);
Steven Toth363c35f2008-10-11 11:05:50 -0300362 if (fe == NULL)
363 goto fail_alloc;
364
Steven Toth363c35f2008-10-11 11:05:50 -0300365 fe->id = id;
366 mutex_init(&fe->dvb.lock);
367
368 mutex_lock(&f->lock);
Steven Toth11fbedd2008-10-16 21:42:10 -0300369 list_add_tail(&fe->felist, &f->felist);
Steven Toth363c35f2008-10-11 11:05:50 -0300370 mutex_unlock(&f->lock);
371
372fail_alloc:
373 return fe;
374}
Steven Toth363c35f2008-10-11 11:05:50 -0300375EXPORT_SYMBOL(videobuf_dvb_alloc_frontend);
Darron Broad878595f2008-10-21 11:28:46 -0300376
377void videobuf_dvb_dealloc_frontends(struct videobuf_dvb_frontends *f)
378{
379 struct list_head *list, *q;
380 struct videobuf_dvb_frontend *fe;
381
382 mutex_lock(&f->lock);
383 list_for_each_safe(list, q, &f->felist) {
384 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
385 if (fe->dvb.net.dvbdev) {
386 dvb_net_release(&fe->dvb.net);
387 fe->dvb.demux.dmx.remove_frontend(&fe->dvb.demux.dmx,
388 &fe->dvb.fe_mem);
389 fe->dvb.demux.dmx.remove_frontend(&fe->dvb.demux.dmx,
390 &fe->dvb.fe_hw);
391 dvb_dmxdev_release(&fe->dvb.dmxdev);
392 dvb_dmx_release(&fe->dvb.demux);
393 dvb_unregister_frontend(fe->dvb.frontend);
394 }
395 if (fe->dvb.frontend)
396 /* always allocated, may have been reset */
397 dvb_frontend_detach(fe->dvb.frontend);
398 list_del(list); /* remove list entry */
399 kfree(fe); /* free frontend allocation */
400 }
401 mutex_unlock(&f->lock);
402}
403EXPORT_SYMBOL(videobuf_dvb_dealloc_frontends);