Merge branch 'rmobile/urgent' into rmobile-fixes-for-linus
[linux-2.6-block.git] / drivers / media / video / videobuf-dvb.c
CommitLineData
1da177e4 1/*
1da177e4
LT
2 *
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>
5a0e3ad6 22#include <linux/slab.h>
59d34489 23
7dfb7103 24#include <linux/freezer.h>
1da177e4 25
59d34489 26#include <media/videobuf-core.h>
ba366a23 27#include <media/videobuf-dvb.h>
1da177e4
LT
28
29/* ------------------------------------------------------------------ */
30
31MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
32MODULE_LICENSE("GPL");
33
ff699e6b 34static unsigned int debug;
1da177e4
LT
35module_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;
59d34489 49 void *outp;
1da177e4
LT
50
51 dprintk("dvb thread started\n");
83144186 52 set_freezable();
1da177e4
LT
53 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);
0e0809a5 60 err = videobuf_waiton(&dvb->dvbq, buf, 0, 1);
1da177e4
LT
61
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;
3e1d1d28 67 try_to_freeze();
1da177e4
LT
68
69 /* feed buffer data to demux */
f4fce60e 70 outp = videobuf_queue_to_vaddr(&dvb->dvbq, buf);
59d34489 71
0fc0686e 72 if (buf->state == VIDEOBUF_DONE)
59d34489 73 dvb_dmx_swfilter(&dvb->demux, outp,
1da177e4
LT
74 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
3593cab5 103 mutex_lock(&dvb->lock);
1da177e4
LT
104 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:
3593cab5 117 mutex_unlock(&dvb->lock);
1da177e4
LT
118 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
3593cab5 127 mutex_lock(&dvb->lock);
1da177e4
LT
128 dvb->nfeeds--;
129 if (0 == dvb->nfeeds && NULL != dvb->thread) {
1da177e4
LT
130 err = kthread_stop(dvb->thread);
131 dvb->thread = NULL;
132 }
3593cab5 133 mutex_unlock(&dvb->lock);
1da177e4
LT
134 return err;
135}
136
dcadd082 137static int videobuf_dvb_register_adapter(struct videobuf_dvb_frontends *fe,
1da177e4 138 struct module *module,
d09dbf92 139 void *adapter_priv,
78e92006 140 struct device *device,
363c35fc 141 char *adapter_name,
59b1842d 142 short *adapter_nr,
9133aee0
MK
143 int mfe_shared,
144 int (*fe_ioctl_override)(struct dvb_frontend *,
145 unsigned int, void *, unsigned int))
1da177e4
LT
146{
147 int result;
148
363c35fc 149 mutex_init(&fe->lock);
1da177e4
LT
150
151 /* register adapter */
11fbedd3
ST
152 result = dvb_register_adapter(&fe->adapter, adapter_name, module,
153 device, adapter_nr);
1da177e4
LT
154 if (result < 0) {
155 printk(KERN_WARNING "%s: dvb_register_adapter failed (errno = %d)\n",
363c35fc 156 adapter_name, result);
1da177e4 157 }
363c35fc 158 fe->adapter.priv = adapter_priv;
59b1842d 159 fe->adapter.mfe_shared = mfe_shared;
9133aee0 160 fe->adapter.fe_ioctl_override = fe_ioctl_override;
363c35fc
ST
161
162 return result;
163}
164
dcadd082 165static int videobuf_dvb_register_frontend(struct dvb_adapter *adapter,
11fbedd3 166 struct videobuf_dvb *dvb)
363c35fc
ST
167{
168 int result;
1da177e4
LT
169
170 /* register frontend */
363c35fc 171 result = dvb_register_frontend(adapter, dvb->frontend);
1da177e4
LT
172 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;
363c35fc
ST
197 result = dvb_dmxdev_init(&dvb->dmxdev, adapter);
198
1da177e4
LT
199 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 */
5c96ebb7
JN
229 result = dvb_net_init(adapter, &dvb->net, &dvb->demux.dmx);
230 if (result < 0) {
231 printk(KERN_WARNING "%s: dvb_net_init failed (errno = %d)\n",
232 dvb->name, result);
e43f3fab
DB
233 goto fail_fe_conn;
234 }
1da177e4
LT
235 return 0;
236
237fail_fe_conn:
238 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
239fail_fe_mem:
240 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
241fail_fe_hw:
242 dvb_dmxdev_release(&dvb->dmxdev);
243fail_dmxdev:
244 dvb_dmx_release(&dvb->demux);
245fail_dmx:
246 dvb_unregister_frontend(dvb->frontend);
247fail_frontend:
f52a838b 248 dvb_frontend_detach(dvb->frontend);
e43f3fab 249 dvb->frontend = NULL;
363c35fc 250
1da177e4
LT
251 return result;
252}
253
dcadd082
MCC
254/* ------------------------------------------------------------------ */
255/* Register a single adapter and one or more frontends */
256int videobuf_dvb_register_bus(struct videobuf_dvb_frontends *f,
257 struct module *module,
258 void *adapter_priv,
259 struct device *device,
260 short *adapter_nr,
9133aee0
MK
261 int mfe_shared,
262 int (*fe_ioctl_override)(struct dvb_frontend *,
263 unsigned int, void *, unsigned int))
dcadd082
MCC
264{
265 struct list_head *list, *q;
266 struct videobuf_dvb_frontend *fe;
267 int res;
268
269 fe = videobuf_dvb_get_frontend(f, 1);
270 if (!fe) {
271 printk(KERN_WARNING "Unable to register the adapter which has no frontends\n");
272 return -EINVAL;
273 }
274
275 /* Bring up the adapter */
276 res = videobuf_dvb_register_adapter(f, module, adapter_priv, device,
9133aee0 277 fe->dvb.name, adapter_nr, mfe_shared, fe_ioctl_override);
dcadd082
MCC
278 if (res < 0) {
279 printk(KERN_WARNING "videobuf_dvb_register_adapter failed (errno = %d)\n", res);
280 return res;
281 }
282
283 /* Attach all of the frontends to the adapter */
284 mutex_lock(&f->lock);
285 list_for_each_safe(list, q, &f->felist) {
286 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
287 res = videobuf_dvb_register_frontend(&f->adapter, &fe->dvb);
288 if (res < 0) {
289 printk(KERN_WARNING "%s: videobuf_dvb_register_frontend failed (errno = %d)\n",
290 fe->dvb.name, res);
291 goto err;
292 }
293 }
294 mutex_unlock(&f->lock);
295 return 0;
296
297err:
298 mutex_unlock(&f->lock);
299 videobuf_dvb_unregister_bus(f);
300 return res;
301}
302EXPORT_SYMBOL(videobuf_dvb_register_bus);
303
363c35fc 304void videobuf_dvb_unregister_bus(struct videobuf_dvb_frontends *f)
1da177e4 305{
878595f6 306 videobuf_dvb_dealloc_frontends(f);
363c35fc
ST
307
308 dvb_unregister_adapter(&f->adapter);
309}
11fbedd3 310EXPORT_SYMBOL(videobuf_dvb_unregister_bus);
363c35fc 311
11fbedd3
ST
312struct videobuf_dvb_frontend *videobuf_dvb_get_frontend(
313 struct videobuf_dvb_frontends *f, int id)
363c35fc
ST
314{
315 struct list_head *list, *q;
316 struct videobuf_dvb_frontend *fe, *ret = NULL;
317
318 mutex_lock(&f->lock);
319
7bdf84fc 320 list_for_each_safe(list, q, &f->felist) {
363c35fc
ST
321 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
322 if (fe->id == id) {
323 ret = fe;
324 break;
325 }
326 }
327
328 mutex_unlock(&f->lock);
329
330 return ret;
331}
11fbedd3 332EXPORT_SYMBOL(videobuf_dvb_get_frontend);
363c35fc 333
11fbedd3
ST
334int videobuf_dvb_find_frontend(struct videobuf_dvb_frontends *f,
335 struct dvb_frontend *p)
363c35fc
ST
336{
337 struct list_head *list, *q;
338 struct videobuf_dvb_frontend *fe = NULL;
339 int ret = 0;
340
341 mutex_lock(&f->lock);
342
7bdf84fc 343 list_for_each_safe(list, q, &f->felist) {
363c35fc
ST
344 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
345 if (fe->dvb.frontend == p) {
346 ret = fe->id;
347 break;
348 }
349 }
350
351 mutex_unlock(&f->lock);
352
353 return ret;
354}
11fbedd3 355EXPORT_SYMBOL(videobuf_dvb_find_frontend);
363c35fc 356
11fbedd3
ST
357struct videobuf_dvb_frontend *videobuf_dvb_alloc_frontend(
358 struct videobuf_dvb_frontends *f, int id)
363c35fc
ST
359{
360 struct videobuf_dvb_frontend *fe;
361
11fbedd3 362 fe = kzalloc(sizeof(struct videobuf_dvb_frontend), GFP_KERNEL);
363c35fc
ST
363 if (fe == NULL)
364 goto fail_alloc;
365
363c35fc
ST
366 fe->id = id;
367 mutex_init(&fe->dvb.lock);
368
369 mutex_lock(&f->lock);
11fbedd3 370 list_add_tail(&fe->felist, &f->felist);
363c35fc
ST
371 mutex_unlock(&f->lock);
372
373fail_alloc:
374 return fe;
1da177e4 375}
363c35fc 376EXPORT_SYMBOL(videobuf_dvb_alloc_frontend);
878595f6
DB
377
378void videobuf_dvb_dealloc_frontends(struct videobuf_dvb_frontends *f)
379{
380 struct list_head *list, *q;
381 struct videobuf_dvb_frontend *fe;
382
383 mutex_lock(&f->lock);
384 list_for_each_safe(list, q, &f->felist) {
385 fe = list_entry(list, struct videobuf_dvb_frontend, felist);
386 if (fe->dvb.net.dvbdev) {
387 dvb_net_release(&fe->dvb.net);
388 fe->dvb.demux.dmx.remove_frontend(&fe->dvb.demux.dmx,
389 &fe->dvb.fe_mem);
390 fe->dvb.demux.dmx.remove_frontend(&fe->dvb.demux.dmx,
391 &fe->dvb.fe_hw);
392 dvb_dmxdev_release(&fe->dvb.dmxdev);
393 dvb_dmx_release(&fe->dvb.demux);
394 dvb_unregister_frontend(fe->dvb.frontend);
395 }
396 if (fe->dvb.frontend)
397 /* always allocated, may have been reset */
398 dvb_frontend_detach(fe->dvb.frontend);
399 list_del(list); /* remove list entry */
400 kfree(fe); /* free frontend allocation */
401 }
402 mutex_unlock(&f->lock);
403}
404EXPORT_SYMBOL(videobuf_dvb_dealloc_frontends);