1 /*
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>
22 #include <linux/slab.h>
23
24 #include <linux/freezer.h>
25
26 #include <media/videobuf-core.h>
27 #include <media/videobuf-dvb.h>
28
29 /* ------------------------------------------------------------------ */
30
31 MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
32 MODULE_LICENSE("GPL");
33
34 static unsigned int debug;
35 module_param(debug, int, 0644);
36 MODULE_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
videobuf_dvb_thread(void * data)43 static 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;
49 void *outp;
50
51 dprintk("dvb thread started\n");
52 set_freezable();
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);
60 err = videobuf_waiton(&dvb->dvbq, buf, 0, 1);
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;
67 try_to_freeze();
68
69 /* feed buffer data to demux */
70 outp = videobuf_queue_to_vaddr(&dvb->dvbq, buf);
71
72 if (buf->state == VIDEOBUF_DONE)
73 dvb_dmx_swfilter(&dvb->demux, outp,
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
videobuf_dvb_start_feed(struct dvb_demux_feed * feed)94 static 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
103 mutex_lock(&dvb->lock);
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
116 out:
117 mutex_unlock(&dvb->lock);
118 return rc;
119 }
120
videobuf_dvb_stop_feed(struct dvb_demux_feed * feed)121 static 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
127 mutex_lock(&dvb->lock);
128 dvb->nfeeds--;
129 if (0 == dvb->nfeeds && NULL != dvb->thread) {
130 err = kthread_stop(dvb->thread);
131 dvb->thread = NULL;
132 }
133 mutex_unlock(&dvb->lock);
134 return err;
135 }
136
videobuf_dvb_register_adapter(struct videobuf_dvb_frontends * fe,struct module * module,void * adapter_priv,struct device * device,char * adapter_name,short * adapter_nr,int mfe_shared,int (* fe_ioctl_override)(struct dvb_frontend *,unsigned int,void *,unsigned int))137 static int videobuf_dvb_register_adapter(struct videobuf_dvb_frontends *fe,
138 struct module *module,
139 void *adapter_priv,
140 struct device *device,
141 char *adapter_name,
142 short *adapter_nr,
143 int mfe_shared,
144 int (*fe_ioctl_override)(struct dvb_frontend *,
145 unsigned int, void *, unsigned int))
146 {
147 int result;
148
149 mutex_init(&fe->lock);
150
151 /* register adapter */
152 result = dvb_register_adapter(&fe->adapter, adapter_name, module,
153 device, adapter_nr);
154 if (result < 0) {
155 printk(KERN_WARNING "%s: dvb_register_adapter failed (errno = %d)\n",
156 adapter_name, result);
157 }
158 fe->adapter.priv = adapter_priv;
159 fe->adapter.mfe_shared = mfe_shared;
160 fe->adapter.fe_ioctl_override = fe_ioctl_override;
161
162 return result;
163 }
164
videobuf_dvb_register_frontend(struct dvb_adapter * adapter,struct videobuf_dvb * dvb)165 static int videobuf_dvb_register_frontend(struct dvb_adapter *adapter,
166 struct videobuf_dvb *dvb)
167 {
168 int result;
169
170 /* register frontend */
171 result = dvb_register_frontend(adapter, dvb->frontend);
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;
197 result = dvb_dmxdev_init(&dvb->dmxdev, adapter);
198
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 */
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);
233 goto fail_fe_conn;
234 }
235 return 0;
236
237 fail_fe_conn:
238 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
239 fail_fe_mem:
240 dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
241 fail_fe_hw:
242 dvb_dmxdev_release(&dvb->dmxdev);
243 fail_dmxdev:
244 dvb_dmx_release(&dvb->demux);
245 fail_dmx:
246 dvb_unregister_frontend(dvb->frontend);
247 fail_frontend:
248 dvb_frontend_detach(dvb->frontend);
249 dvb->frontend = NULL;
250
251 return result;
252 }
253
254 /* ------------------------------------------------------------------ */
255 /* Register a single adapter and one or more frontends */
videobuf_dvb_register_bus(struct videobuf_dvb_frontends * f,struct module * module,void * adapter_priv,struct device * device,short * adapter_nr,int mfe_shared,int (* fe_ioctl_override)(struct dvb_frontend *,unsigned int,void *,unsigned int))256 int 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,
261 int mfe_shared,
262 int (*fe_ioctl_override)(struct dvb_frontend *,
263 unsigned int, void *, unsigned int))
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,
277 fe->dvb.name, adapter_nr, mfe_shared, fe_ioctl_override);
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
297 err:
298 mutex_unlock(&f->lock);
299 videobuf_dvb_unregister_bus(f);
300 return res;
301 }
302 EXPORT_SYMBOL(videobuf_dvb_register_bus);
303
videobuf_dvb_unregister_bus(struct videobuf_dvb_frontends * f)304 void videobuf_dvb_unregister_bus(struct videobuf_dvb_frontends *f)
305 {
306 videobuf_dvb_dealloc_frontends(f);
307
308 dvb_unregister_adapter(&f->adapter);
309 }
310 EXPORT_SYMBOL(videobuf_dvb_unregister_bus);
311
videobuf_dvb_get_frontend(struct videobuf_dvb_frontends * f,int id)312 struct videobuf_dvb_frontend *videobuf_dvb_get_frontend(
313 struct videobuf_dvb_frontends *f, int id)
314 {
315 struct list_head *list, *q;
316 struct videobuf_dvb_frontend *fe, *ret = NULL;
317
318 mutex_lock(&f->lock);
319
320 list_for_each_safe(list, q, &f->felist) {
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 }
332 EXPORT_SYMBOL(videobuf_dvb_get_frontend);
333
videobuf_dvb_find_frontend(struct videobuf_dvb_frontends * f,struct dvb_frontend * p)334 int videobuf_dvb_find_frontend(struct videobuf_dvb_frontends *f,
335 struct dvb_frontend *p)
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
343 list_for_each_safe(list, q, &f->felist) {
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 }
355 EXPORT_SYMBOL(videobuf_dvb_find_frontend);
356
videobuf_dvb_alloc_frontend(struct videobuf_dvb_frontends * f,int id)357 struct videobuf_dvb_frontend *videobuf_dvb_alloc_frontend(
358 struct videobuf_dvb_frontends *f, int id)
359 {
360 struct videobuf_dvb_frontend *fe;
361
362 fe = kzalloc(sizeof(struct videobuf_dvb_frontend), GFP_KERNEL);
363 if (fe == NULL)
364 goto fail_alloc;
365
366 fe->id = id;
367 mutex_init(&fe->dvb.lock);
368
369 mutex_lock(&f->lock);
370 list_add_tail(&fe->felist, &f->felist);
371 mutex_unlock(&f->lock);
372
373 fail_alloc:
374 return fe;
375 }
376 EXPORT_SYMBOL(videobuf_dvb_alloc_frontend);
377
videobuf_dvb_dealloc_frontends(struct videobuf_dvb_frontends * f)378 void 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 }
404 EXPORT_SYMBOL(videobuf_dvb_dealloc_frontends);
405