1*4882a593Smuzhiyun /*
2*4882a593Smuzhiyun * dmxdev.c - DVB demultiplexer device
3*4882a593Smuzhiyun *
4*4882a593Smuzhiyun * Copyright (C) 2000 Ralph Metzler & Marcus Metzler
5*4882a593Smuzhiyun * for convergence integrated media GmbH
6*4882a593Smuzhiyun *
7*4882a593Smuzhiyun * This program is free software; you can redistribute it and/or
8*4882a593Smuzhiyun * modify it under the terms of the GNU Lesser General Public License
9*4882a593Smuzhiyun * as published by the Free Software Foundation; either version 2.1
10*4882a593Smuzhiyun * of the License, or (at your option) any later version.
11*4882a593Smuzhiyun *
12*4882a593Smuzhiyun * This program is distributed in the hope that it will be useful,
13*4882a593Smuzhiyun * but WITHOUT ANY WARRANTY; without even the implied warranty of
14*4882a593Smuzhiyun * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15*4882a593Smuzhiyun * GNU General Public License for more details.
16*4882a593Smuzhiyun *
17*4882a593Smuzhiyun */
18*4882a593Smuzhiyun
19*4882a593Smuzhiyun #define pr_fmt(fmt) "dmxdev: " fmt
20*4882a593Smuzhiyun
21*4882a593Smuzhiyun #include <linux/sched.h>
22*4882a593Smuzhiyun #include <linux/spinlock.h>
23*4882a593Smuzhiyun #include <linux/slab.h>
24*4882a593Smuzhiyun #include <linux/vmalloc.h>
25*4882a593Smuzhiyun #include <linux/module.h>
26*4882a593Smuzhiyun #include <linux/poll.h>
27*4882a593Smuzhiyun #include <linux/ioctl.h>
28*4882a593Smuzhiyun #include <linux/wait.h>
29*4882a593Smuzhiyun #include <linux/uaccess.h>
30*4882a593Smuzhiyun #include <media/dmxdev.h>
31*4882a593Smuzhiyun #include <media/dvb_vb2.h>
32*4882a593Smuzhiyun
33*4882a593Smuzhiyun static int debug;
34*4882a593Smuzhiyun
35*4882a593Smuzhiyun module_param(debug, int, 0644);
36*4882a593Smuzhiyun MODULE_PARM_DESC(debug, "Turn on/off debugging (default:off).");
37*4882a593Smuzhiyun
38*4882a593Smuzhiyun #define dprintk(fmt, arg...) do { \
39*4882a593Smuzhiyun if (debug) \
40*4882a593Smuzhiyun printk(KERN_DEBUG pr_fmt("%s: " fmt), \
41*4882a593Smuzhiyun __func__, ##arg); \
42*4882a593Smuzhiyun } while (0)
43*4882a593Smuzhiyun
dvb_dmxdev_buffer_write(struct dvb_ringbuffer * buf,const u8 * src,size_t len)44*4882a593Smuzhiyun static int dvb_dmxdev_buffer_write(struct dvb_ringbuffer *buf,
45*4882a593Smuzhiyun const u8 *src, size_t len)
46*4882a593Smuzhiyun {
47*4882a593Smuzhiyun ssize_t free;
48*4882a593Smuzhiyun
49*4882a593Smuzhiyun if (!len)
50*4882a593Smuzhiyun return 0;
51*4882a593Smuzhiyun if (!buf->data)
52*4882a593Smuzhiyun return 0;
53*4882a593Smuzhiyun
54*4882a593Smuzhiyun free = dvb_ringbuffer_free(buf);
55*4882a593Smuzhiyun if (len > free) {
56*4882a593Smuzhiyun dprintk("buffer overflow\n");
57*4882a593Smuzhiyun return -EOVERFLOW;
58*4882a593Smuzhiyun }
59*4882a593Smuzhiyun
60*4882a593Smuzhiyun return dvb_ringbuffer_write(buf, src, len);
61*4882a593Smuzhiyun }
62*4882a593Smuzhiyun
dvb_dmxdev_buffer_read(struct dvb_ringbuffer * src,int non_blocking,char __user * buf,size_t count,loff_t * ppos)63*4882a593Smuzhiyun static ssize_t dvb_dmxdev_buffer_read(struct dvb_ringbuffer *src,
64*4882a593Smuzhiyun int non_blocking, char __user *buf,
65*4882a593Smuzhiyun size_t count, loff_t *ppos)
66*4882a593Smuzhiyun {
67*4882a593Smuzhiyun size_t todo;
68*4882a593Smuzhiyun ssize_t avail;
69*4882a593Smuzhiyun ssize_t ret = 0;
70*4882a593Smuzhiyun
71*4882a593Smuzhiyun if (!src->data)
72*4882a593Smuzhiyun return 0;
73*4882a593Smuzhiyun
74*4882a593Smuzhiyun if (src->error) {
75*4882a593Smuzhiyun ret = src->error;
76*4882a593Smuzhiyun dvb_ringbuffer_flush(src);
77*4882a593Smuzhiyun return ret;
78*4882a593Smuzhiyun }
79*4882a593Smuzhiyun
80*4882a593Smuzhiyun for (todo = count; todo > 0; todo -= ret) {
81*4882a593Smuzhiyun if (non_blocking && dvb_ringbuffer_empty(src)) {
82*4882a593Smuzhiyun ret = -EWOULDBLOCK;
83*4882a593Smuzhiyun break;
84*4882a593Smuzhiyun }
85*4882a593Smuzhiyun
86*4882a593Smuzhiyun ret = wait_event_interruptible(src->queue,
87*4882a593Smuzhiyun !dvb_ringbuffer_empty(src) ||
88*4882a593Smuzhiyun (src->error != 0));
89*4882a593Smuzhiyun if (ret < 0)
90*4882a593Smuzhiyun break;
91*4882a593Smuzhiyun
92*4882a593Smuzhiyun if (src->error) {
93*4882a593Smuzhiyun ret = src->error;
94*4882a593Smuzhiyun dvb_ringbuffer_flush(src);
95*4882a593Smuzhiyun break;
96*4882a593Smuzhiyun }
97*4882a593Smuzhiyun
98*4882a593Smuzhiyun avail = dvb_ringbuffer_avail(src);
99*4882a593Smuzhiyun if (avail > todo)
100*4882a593Smuzhiyun avail = todo;
101*4882a593Smuzhiyun
102*4882a593Smuzhiyun ret = dvb_ringbuffer_read_user(src, buf, avail);
103*4882a593Smuzhiyun if (ret < 0)
104*4882a593Smuzhiyun break;
105*4882a593Smuzhiyun
106*4882a593Smuzhiyun buf += ret;
107*4882a593Smuzhiyun }
108*4882a593Smuzhiyun
109*4882a593Smuzhiyun return (count - todo) ? (count - todo) : ret;
110*4882a593Smuzhiyun }
111*4882a593Smuzhiyun
get_fe(struct dmx_demux * demux,int type)112*4882a593Smuzhiyun static struct dmx_frontend *get_fe(struct dmx_demux *demux, int type)
113*4882a593Smuzhiyun {
114*4882a593Smuzhiyun struct list_head *head, *pos;
115*4882a593Smuzhiyun
116*4882a593Smuzhiyun head = demux->get_frontends(demux);
117*4882a593Smuzhiyun if (!head)
118*4882a593Smuzhiyun return NULL;
119*4882a593Smuzhiyun list_for_each(pos, head)
120*4882a593Smuzhiyun if (DMX_FE_ENTRY(pos)->source == type)
121*4882a593Smuzhiyun return DMX_FE_ENTRY(pos);
122*4882a593Smuzhiyun
123*4882a593Smuzhiyun return NULL;
124*4882a593Smuzhiyun }
125*4882a593Smuzhiyun
dvb_dvr_open(struct inode * inode,struct file * file)126*4882a593Smuzhiyun static int dvb_dvr_open(struct inode *inode, struct file *file)
127*4882a593Smuzhiyun {
128*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
129*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
130*4882a593Smuzhiyun struct dmx_frontend *front;
131*4882a593Smuzhiyun bool need_ringbuffer = false;
132*4882a593Smuzhiyun
133*4882a593Smuzhiyun dprintk("%s\n", __func__);
134*4882a593Smuzhiyun
135*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdev->mutex))
136*4882a593Smuzhiyun return -ERESTARTSYS;
137*4882a593Smuzhiyun
138*4882a593Smuzhiyun if (dmxdev->exit) {
139*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
140*4882a593Smuzhiyun return -ENODEV;
141*4882a593Smuzhiyun }
142*4882a593Smuzhiyun
143*4882a593Smuzhiyun dmxdev->may_do_mmap = 0;
144*4882a593Smuzhiyun
145*4882a593Smuzhiyun /*
146*4882a593Smuzhiyun * The logic here is a little tricky due to the ifdef.
147*4882a593Smuzhiyun *
148*4882a593Smuzhiyun * The ringbuffer is used for both read and mmap.
149*4882a593Smuzhiyun *
150*4882a593Smuzhiyun * It is not needed, however, on two situations:
151*4882a593Smuzhiyun * - Write devices (access with O_WRONLY);
152*4882a593Smuzhiyun * - For duplex device nodes, opened with O_RDWR.
153*4882a593Smuzhiyun */
154*4882a593Smuzhiyun
155*4882a593Smuzhiyun if ((file->f_flags & O_ACCMODE) == O_RDONLY)
156*4882a593Smuzhiyun need_ringbuffer = true;
157*4882a593Smuzhiyun else if ((file->f_flags & O_ACCMODE) == O_RDWR) {
158*4882a593Smuzhiyun if (!(dmxdev->capabilities & DMXDEV_CAP_DUPLEX)) {
159*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
160*4882a593Smuzhiyun dmxdev->may_do_mmap = 1;
161*4882a593Smuzhiyun need_ringbuffer = true;
162*4882a593Smuzhiyun #else
163*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
164*4882a593Smuzhiyun return -EOPNOTSUPP;
165*4882a593Smuzhiyun #endif
166*4882a593Smuzhiyun }
167*4882a593Smuzhiyun }
168*4882a593Smuzhiyun
169*4882a593Smuzhiyun if (need_ringbuffer) {
170*4882a593Smuzhiyun void *mem;
171*4882a593Smuzhiyun
172*4882a593Smuzhiyun if (!dvbdev->readers) {
173*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
174*4882a593Smuzhiyun return -EBUSY;
175*4882a593Smuzhiyun }
176*4882a593Smuzhiyun mem = vmalloc(DVR_BUFFER_SIZE);
177*4882a593Smuzhiyun if (!mem) {
178*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
179*4882a593Smuzhiyun return -ENOMEM;
180*4882a593Smuzhiyun }
181*4882a593Smuzhiyun dvb_ringbuffer_init(&dmxdev->dvr_buffer, mem, DVR_BUFFER_SIZE);
182*4882a593Smuzhiyun if (dmxdev->may_do_mmap)
183*4882a593Smuzhiyun dvb_vb2_init(&dmxdev->dvr_vb2_ctx, "dvr",
184*4882a593Smuzhiyun file->f_flags & O_NONBLOCK);
185*4882a593Smuzhiyun dvbdev->readers--;
186*4882a593Smuzhiyun }
187*4882a593Smuzhiyun
188*4882a593Smuzhiyun if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
189*4882a593Smuzhiyun dmxdev->dvr_orig_fe = dmxdev->demux->frontend;
190*4882a593Smuzhiyun
191*4882a593Smuzhiyun if (!dmxdev->demux->write) {
192*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
193*4882a593Smuzhiyun return -EOPNOTSUPP;
194*4882a593Smuzhiyun }
195*4882a593Smuzhiyun
196*4882a593Smuzhiyun front = get_fe(dmxdev->demux, DMX_MEMORY_FE);
197*4882a593Smuzhiyun
198*4882a593Smuzhiyun if (!front) {
199*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
200*4882a593Smuzhiyun return -EINVAL;
201*4882a593Smuzhiyun }
202*4882a593Smuzhiyun dmxdev->demux->disconnect_frontend(dmxdev->demux);
203*4882a593Smuzhiyun dmxdev->demux->connect_frontend(dmxdev->demux, front);
204*4882a593Smuzhiyun }
205*4882a593Smuzhiyun dvbdev->users++;
206*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
207*4882a593Smuzhiyun return 0;
208*4882a593Smuzhiyun }
209*4882a593Smuzhiyun
dvb_dvr_release(struct inode * inode,struct file * file)210*4882a593Smuzhiyun static int dvb_dvr_release(struct inode *inode, struct file *file)
211*4882a593Smuzhiyun {
212*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
213*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
214*4882a593Smuzhiyun
215*4882a593Smuzhiyun mutex_lock(&dmxdev->mutex);
216*4882a593Smuzhiyun
217*4882a593Smuzhiyun if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
218*4882a593Smuzhiyun dmxdev->demux->disconnect_frontend(dmxdev->demux);
219*4882a593Smuzhiyun dmxdev->demux->connect_frontend(dmxdev->demux,
220*4882a593Smuzhiyun dmxdev->dvr_orig_fe);
221*4882a593Smuzhiyun }
222*4882a593Smuzhiyun
223*4882a593Smuzhiyun if (((file->f_flags & O_ACCMODE) == O_RDONLY) ||
224*4882a593Smuzhiyun dmxdev->may_do_mmap) {
225*4882a593Smuzhiyun if (dmxdev->may_do_mmap) {
226*4882a593Smuzhiyun if (dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx))
227*4882a593Smuzhiyun dvb_vb2_stream_off(&dmxdev->dvr_vb2_ctx);
228*4882a593Smuzhiyun dvb_vb2_release(&dmxdev->dvr_vb2_ctx);
229*4882a593Smuzhiyun }
230*4882a593Smuzhiyun dvbdev->readers++;
231*4882a593Smuzhiyun if (dmxdev->dvr_buffer.data) {
232*4882a593Smuzhiyun void *mem = dmxdev->dvr_buffer.data;
233*4882a593Smuzhiyun /*memory barrier*/
234*4882a593Smuzhiyun mb();
235*4882a593Smuzhiyun spin_lock_irq(&dmxdev->lock);
236*4882a593Smuzhiyun dmxdev->dvr_buffer.data = NULL;
237*4882a593Smuzhiyun spin_unlock_irq(&dmxdev->lock);
238*4882a593Smuzhiyun vfree(mem);
239*4882a593Smuzhiyun }
240*4882a593Smuzhiyun }
241*4882a593Smuzhiyun /* TODO */
242*4882a593Smuzhiyun dvbdev->users--;
243*4882a593Smuzhiyun if (dvbdev->users == 1 && dmxdev->exit == 1) {
244*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
245*4882a593Smuzhiyun wake_up(&dvbdev->wait_queue);
246*4882a593Smuzhiyun } else
247*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
248*4882a593Smuzhiyun
249*4882a593Smuzhiyun return 0;
250*4882a593Smuzhiyun }
251*4882a593Smuzhiyun
dvb_dvr_write(struct file * file,const char __user * buf,size_t count,loff_t * ppos)252*4882a593Smuzhiyun static ssize_t dvb_dvr_write(struct file *file, const char __user *buf,
253*4882a593Smuzhiyun size_t count, loff_t *ppos)
254*4882a593Smuzhiyun {
255*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
256*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
257*4882a593Smuzhiyun int ret;
258*4882a593Smuzhiyun
259*4882a593Smuzhiyun if (!dmxdev->demux->write)
260*4882a593Smuzhiyun return -EOPNOTSUPP;
261*4882a593Smuzhiyun if ((file->f_flags & O_ACCMODE) != O_WRONLY)
262*4882a593Smuzhiyun return -EINVAL;
263*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdev->mutex))
264*4882a593Smuzhiyun return -ERESTARTSYS;
265*4882a593Smuzhiyun
266*4882a593Smuzhiyun if (dmxdev->exit) {
267*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
268*4882a593Smuzhiyun return -ENODEV;
269*4882a593Smuzhiyun }
270*4882a593Smuzhiyun ret = dmxdev->demux->write(dmxdev->demux, buf, count);
271*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
272*4882a593Smuzhiyun return ret;
273*4882a593Smuzhiyun }
274*4882a593Smuzhiyun
dvb_dvr_read(struct file * file,char __user * buf,size_t count,loff_t * ppos)275*4882a593Smuzhiyun static ssize_t dvb_dvr_read(struct file *file, char __user *buf, size_t count,
276*4882a593Smuzhiyun loff_t *ppos)
277*4882a593Smuzhiyun {
278*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
279*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
280*4882a593Smuzhiyun
281*4882a593Smuzhiyun if (dmxdev->exit)
282*4882a593Smuzhiyun return -ENODEV;
283*4882a593Smuzhiyun
284*4882a593Smuzhiyun return dvb_dmxdev_buffer_read(&dmxdev->dvr_buffer,
285*4882a593Smuzhiyun file->f_flags & O_NONBLOCK,
286*4882a593Smuzhiyun buf, count, ppos);
287*4882a593Smuzhiyun }
288*4882a593Smuzhiyun
dvb_dvr_set_buffer_size(struct dmxdev * dmxdev,unsigned long size)289*4882a593Smuzhiyun static int dvb_dvr_set_buffer_size(struct dmxdev *dmxdev,
290*4882a593Smuzhiyun unsigned long size)
291*4882a593Smuzhiyun {
292*4882a593Smuzhiyun struct dvb_ringbuffer *buf = &dmxdev->dvr_buffer;
293*4882a593Smuzhiyun void *newmem;
294*4882a593Smuzhiyun void *oldmem;
295*4882a593Smuzhiyun
296*4882a593Smuzhiyun dprintk("%s\n", __func__);
297*4882a593Smuzhiyun
298*4882a593Smuzhiyun if (buf->size == size)
299*4882a593Smuzhiyun return 0;
300*4882a593Smuzhiyun if (!size)
301*4882a593Smuzhiyun return -EINVAL;
302*4882a593Smuzhiyun
303*4882a593Smuzhiyun newmem = vmalloc(size);
304*4882a593Smuzhiyun if (!newmem)
305*4882a593Smuzhiyun return -ENOMEM;
306*4882a593Smuzhiyun
307*4882a593Smuzhiyun oldmem = buf->data;
308*4882a593Smuzhiyun
309*4882a593Smuzhiyun spin_lock_irq(&dmxdev->lock);
310*4882a593Smuzhiyun buf->data = newmem;
311*4882a593Smuzhiyun buf->size = size;
312*4882a593Smuzhiyun
313*4882a593Smuzhiyun /* reset and not flush in case the buffer shrinks */
314*4882a593Smuzhiyun dvb_ringbuffer_reset(buf);
315*4882a593Smuzhiyun spin_unlock_irq(&dmxdev->lock);
316*4882a593Smuzhiyun
317*4882a593Smuzhiyun vfree(oldmem);
318*4882a593Smuzhiyun
319*4882a593Smuzhiyun return 0;
320*4882a593Smuzhiyun }
321*4882a593Smuzhiyun
dvb_dmxdev_filter_state_set(struct dmxdev_filter * dmxdevfilter,int state)322*4882a593Smuzhiyun static inline void dvb_dmxdev_filter_state_set(struct dmxdev_filter
323*4882a593Smuzhiyun *dmxdevfilter, int state)
324*4882a593Smuzhiyun {
325*4882a593Smuzhiyun spin_lock_irq(&dmxdevfilter->dev->lock);
326*4882a593Smuzhiyun dmxdevfilter->state = state;
327*4882a593Smuzhiyun spin_unlock_irq(&dmxdevfilter->dev->lock);
328*4882a593Smuzhiyun }
329*4882a593Smuzhiyun
dvb_dmxdev_set_buffer_size(struct dmxdev_filter * dmxdevfilter,unsigned long size)330*4882a593Smuzhiyun static int dvb_dmxdev_set_buffer_size(struct dmxdev_filter *dmxdevfilter,
331*4882a593Smuzhiyun unsigned long size)
332*4882a593Smuzhiyun {
333*4882a593Smuzhiyun struct dvb_ringbuffer *buf = &dmxdevfilter->buffer;
334*4882a593Smuzhiyun void *newmem;
335*4882a593Smuzhiyun void *oldmem;
336*4882a593Smuzhiyun
337*4882a593Smuzhiyun if (buf->size == size)
338*4882a593Smuzhiyun return 0;
339*4882a593Smuzhiyun if (!size)
340*4882a593Smuzhiyun return -EINVAL;
341*4882a593Smuzhiyun if (dmxdevfilter->state >= DMXDEV_STATE_GO)
342*4882a593Smuzhiyun return -EBUSY;
343*4882a593Smuzhiyun
344*4882a593Smuzhiyun newmem = vmalloc(size);
345*4882a593Smuzhiyun if (!newmem)
346*4882a593Smuzhiyun return -ENOMEM;
347*4882a593Smuzhiyun
348*4882a593Smuzhiyun oldmem = buf->data;
349*4882a593Smuzhiyun
350*4882a593Smuzhiyun spin_lock_irq(&dmxdevfilter->dev->lock);
351*4882a593Smuzhiyun buf->data = newmem;
352*4882a593Smuzhiyun buf->size = size;
353*4882a593Smuzhiyun
354*4882a593Smuzhiyun /* reset and not flush in case the buffer shrinks */
355*4882a593Smuzhiyun dvb_ringbuffer_reset(buf);
356*4882a593Smuzhiyun spin_unlock_irq(&dmxdevfilter->dev->lock);
357*4882a593Smuzhiyun
358*4882a593Smuzhiyun vfree(oldmem);
359*4882a593Smuzhiyun
360*4882a593Smuzhiyun return 0;
361*4882a593Smuzhiyun }
362*4882a593Smuzhiyun
dvb_dmxdev_filter_timeout(struct timer_list * t)363*4882a593Smuzhiyun static void dvb_dmxdev_filter_timeout(struct timer_list *t)
364*4882a593Smuzhiyun {
365*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = from_timer(dmxdevfilter, t, timer);
366*4882a593Smuzhiyun
367*4882a593Smuzhiyun dmxdevfilter->buffer.error = -ETIMEDOUT;
368*4882a593Smuzhiyun spin_lock_irq(&dmxdevfilter->dev->lock);
369*4882a593Smuzhiyun dmxdevfilter->state = DMXDEV_STATE_TIMEDOUT;
370*4882a593Smuzhiyun spin_unlock_irq(&dmxdevfilter->dev->lock);
371*4882a593Smuzhiyun wake_up(&dmxdevfilter->buffer.queue);
372*4882a593Smuzhiyun }
373*4882a593Smuzhiyun
dvb_dmxdev_filter_timer(struct dmxdev_filter * dmxdevfilter)374*4882a593Smuzhiyun static void dvb_dmxdev_filter_timer(struct dmxdev_filter *dmxdevfilter)
375*4882a593Smuzhiyun {
376*4882a593Smuzhiyun struct dmx_sct_filter_params *para = &dmxdevfilter->params.sec;
377*4882a593Smuzhiyun
378*4882a593Smuzhiyun del_timer(&dmxdevfilter->timer);
379*4882a593Smuzhiyun if (para->timeout) {
380*4882a593Smuzhiyun dmxdevfilter->timer.expires =
381*4882a593Smuzhiyun jiffies + 1 + (HZ / 2 + HZ * para->timeout) / 1000;
382*4882a593Smuzhiyun add_timer(&dmxdevfilter->timer);
383*4882a593Smuzhiyun }
384*4882a593Smuzhiyun }
385*4882a593Smuzhiyun
dvb_dmxdev_section_callback(const u8 * buffer1,size_t buffer1_len,const u8 * buffer2,size_t buffer2_len,struct dmx_section_filter * filter,u32 * buffer_flags)386*4882a593Smuzhiyun static int dvb_dmxdev_section_callback(const u8 *buffer1, size_t buffer1_len,
387*4882a593Smuzhiyun const u8 *buffer2, size_t buffer2_len,
388*4882a593Smuzhiyun struct dmx_section_filter *filter,
389*4882a593Smuzhiyun u32 *buffer_flags)
390*4882a593Smuzhiyun {
391*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = filter->priv;
392*4882a593Smuzhiyun int ret;
393*4882a593Smuzhiyun
394*4882a593Smuzhiyun if (!dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx) &&
395*4882a593Smuzhiyun dmxdevfilter->buffer.error) {
396*4882a593Smuzhiyun wake_up(&dmxdevfilter->buffer.queue);
397*4882a593Smuzhiyun return 0;
398*4882a593Smuzhiyun }
399*4882a593Smuzhiyun spin_lock(&dmxdevfilter->dev->lock);
400*4882a593Smuzhiyun if (dmxdevfilter->state != DMXDEV_STATE_GO) {
401*4882a593Smuzhiyun spin_unlock(&dmxdevfilter->dev->lock);
402*4882a593Smuzhiyun return 0;
403*4882a593Smuzhiyun }
404*4882a593Smuzhiyun del_timer(&dmxdevfilter->timer);
405*4882a593Smuzhiyun dprintk("section callback %*ph\n", 6, buffer1);
406*4882a593Smuzhiyun if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx)) {
407*4882a593Smuzhiyun ret = dvb_vb2_fill_buffer(&dmxdevfilter->vb2_ctx,
408*4882a593Smuzhiyun buffer1, buffer1_len,
409*4882a593Smuzhiyun buffer_flags);
410*4882a593Smuzhiyun if (ret == buffer1_len)
411*4882a593Smuzhiyun ret = dvb_vb2_fill_buffer(&dmxdevfilter->vb2_ctx,
412*4882a593Smuzhiyun buffer2, buffer2_len,
413*4882a593Smuzhiyun buffer_flags);
414*4882a593Smuzhiyun } else {
415*4882a593Smuzhiyun ret = dvb_dmxdev_buffer_write(&dmxdevfilter->buffer,
416*4882a593Smuzhiyun buffer1, buffer1_len);
417*4882a593Smuzhiyun if (ret == buffer1_len) {
418*4882a593Smuzhiyun ret = dvb_dmxdev_buffer_write(&dmxdevfilter->buffer,
419*4882a593Smuzhiyun buffer2, buffer2_len);
420*4882a593Smuzhiyun }
421*4882a593Smuzhiyun }
422*4882a593Smuzhiyun if (ret < 0)
423*4882a593Smuzhiyun dmxdevfilter->buffer.error = ret;
424*4882a593Smuzhiyun if (dmxdevfilter->params.sec.flags & DMX_ONESHOT)
425*4882a593Smuzhiyun dmxdevfilter->state = DMXDEV_STATE_DONE;
426*4882a593Smuzhiyun spin_unlock(&dmxdevfilter->dev->lock);
427*4882a593Smuzhiyun wake_up(&dmxdevfilter->buffer.queue);
428*4882a593Smuzhiyun return 0;
429*4882a593Smuzhiyun }
430*4882a593Smuzhiyun
dvb_dmxdev_ts_callback(const u8 * buffer1,size_t buffer1_len,const u8 * buffer2,size_t buffer2_len,struct dmx_ts_feed * feed,u32 * buffer_flags)431*4882a593Smuzhiyun static int dvb_dmxdev_ts_callback(const u8 *buffer1, size_t buffer1_len,
432*4882a593Smuzhiyun const u8 *buffer2, size_t buffer2_len,
433*4882a593Smuzhiyun struct dmx_ts_feed *feed,
434*4882a593Smuzhiyun u32 *buffer_flags)
435*4882a593Smuzhiyun {
436*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = feed->priv;
437*4882a593Smuzhiyun struct dvb_ringbuffer *buffer;
438*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
439*4882a593Smuzhiyun struct dvb_vb2_ctx *ctx;
440*4882a593Smuzhiyun #endif
441*4882a593Smuzhiyun int ret;
442*4882a593Smuzhiyun
443*4882a593Smuzhiyun spin_lock(&dmxdevfilter->dev->lock);
444*4882a593Smuzhiyun if (dmxdevfilter->params.pes.output == DMX_OUT_DECODER) {
445*4882a593Smuzhiyun spin_unlock(&dmxdevfilter->dev->lock);
446*4882a593Smuzhiyun return 0;
447*4882a593Smuzhiyun }
448*4882a593Smuzhiyun
449*4882a593Smuzhiyun if (dmxdevfilter->params.pes.output == DMX_OUT_TAP ||
450*4882a593Smuzhiyun dmxdevfilter->params.pes.output == DMX_OUT_TSDEMUX_TAP) {
451*4882a593Smuzhiyun buffer = &dmxdevfilter->buffer;
452*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
453*4882a593Smuzhiyun ctx = &dmxdevfilter->vb2_ctx;
454*4882a593Smuzhiyun #endif
455*4882a593Smuzhiyun } else {
456*4882a593Smuzhiyun buffer = &dmxdevfilter->dev->dvr_buffer;
457*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
458*4882a593Smuzhiyun ctx = &dmxdevfilter->dev->dvr_vb2_ctx;
459*4882a593Smuzhiyun #endif
460*4882a593Smuzhiyun }
461*4882a593Smuzhiyun
462*4882a593Smuzhiyun if (dvb_vb2_is_streaming(ctx)) {
463*4882a593Smuzhiyun ret = dvb_vb2_fill_buffer(ctx, buffer1, buffer1_len,
464*4882a593Smuzhiyun buffer_flags);
465*4882a593Smuzhiyun if (ret == buffer1_len)
466*4882a593Smuzhiyun ret = dvb_vb2_fill_buffer(ctx, buffer2, buffer2_len,
467*4882a593Smuzhiyun buffer_flags);
468*4882a593Smuzhiyun } else {
469*4882a593Smuzhiyun if (buffer->error) {
470*4882a593Smuzhiyun spin_unlock(&dmxdevfilter->dev->lock);
471*4882a593Smuzhiyun wake_up(&buffer->queue);
472*4882a593Smuzhiyun return 0;
473*4882a593Smuzhiyun }
474*4882a593Smuzhiyun ret = dvb_dmxdev_buffer_write(buffer, buffer1, buffer1_len);
475*4882a593Smuzhiyun if (ret == buffer1_len)
476*4882a593Smuzhiyun ret = dvb_dmxdev_buffer_write(buffer,
477*4882a593Smuzhiyun buffer2, buffer2_len);
478*4882a593Smuzhiyun }
479*4882a593Smuzhiyun if (ret < 0)
480*4882a593Smuzhiyun buffer->error = ret;
481*4882a593Smuzhiyun spin_unlock(&dmxdevfilter->dev->lock);
482*4882a593Smuzhiyun wake_up(&buffer->queue);
483*4882a593Smuzhiyun return 0;
484*4882a593Smuzhiyun }
485*4882a593Smuzhiyun
486*4882a593Smuzhiyun /* stop feed but only mark the specified filter as stopped (state set) */
dvb_dmxdev_feed_stop(struct dmxdev_filter * dmxdevfilter)487*4882a593Smuzhiyun static int dvb_dmxdev_feed_stop(struct dmxdev_filter *dmxdevfilter)
488*4882a593Smuzhiyun {
489*4882a593Smuzhiyun struct dmxdev_feed *feed;
490*4882a593Smuzhiyun
491*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET);
492*4882a593Smuzhiyun
493*4882a593Smuzhiyun switch (dmxdevfilter->type) {
494*4882a593Smuzhiyun case DMXDEV_TYPE_SEC:
495*4882a593Smuzhiyun del_timer(&dmxdevfilter->timer);
496*4882a593Smuzhiyun dmxdevfilter->feed.sec->stop_filtering(dmxdevfilter->feed.sec);
497*4882a593Smuzhiyun break;
498*4882a593Smuzhiyun case DMXDEV_TYPE_PES:
499*4882a593Smuzhiyun list_for_each_entry(feed, &dmxdevfilter->feed.ts, next)
500*4882a593Smuzhiyun feed->ts->stop_filtering(feed->ts);
501*4882a593Smuzhiyun break;
502*4882a593Smuzhiyun default:
503*4882a593Smuzhiyun return -EINVAL;
504*4882a593Smuzhiyun }
505*4882a593Smuzhiyun return 0;
506*4882a593Smuzhiyun }
507*4882a593Smuzhiyun
508*4882a593Smuzhiyun /* start feed associated with the specified filter */
dvb_dmxdev_feed_start(struct dmxdev_filter * filter)509*4882a593Smuzhiyun static int dvb_dmxdev_feed_start(struct dmxdev_filter *filter)
510*4882a593Smuzhiyun {
511*4882a593Smuzhiyun struct dmxdev_feed *feed;
512*4882a593Smuzhiyun int ret;
513*4882a593Smuzhiyun
514*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(filter, DMXDEV_STATE_GO);
515*4882a593Smuzhiyun
516*4882a593Smuzhiyun switch (filter->type) {
517*4882a593Smuzhiyun case DMXDEV_TYPE_SEC:
518*4882a593Smuzhiyun return filter->feed.sec->start_filtering(filter->feed.sec);
519*4882a593Smuzhiyun case DMXDEV_TYPE_PES:
520*4882a593Smuzhiyun list_for_each_entry(feed, &filter->feed.ts, next) {
521*4882a593Smuzhiyun ret = feed->ts->start_filtering(feed->ts);
522*4882a593Smuzhiyun if (ret < 0) {
523*4882a593Smuzhiyun dvb_dmxdev_feed_stop(filter);
524*4882a593Smuzhiyun return ret;
525*4882a593Smuzhiyun }
526*4882a593Smuzhiyun }
527*4882a593Smuzhiyun break;
528*4882a593Smuzhiyun default:
529*4882a593Smuzhiyun return -EINVAL;
530*4882a593Smuzhiyun }
531*4882a593Smuzhiyun
532*4882a593Smuzhiyun return 0;
533*4882a593Smuzhiyun }
534*4882a593Smuzhiyun
535*4882a593Smuzhiyun /* restart section feed if it has filters left associated with it,
536*4882a593Smuzhiyun otherwise release the feed */
dvb_dmxdev_feed_restart(struct dmxdev_filter * filter)537*4882a593Smuzhiyun static int dvb_dmxdev_feed_restart(struct dmxdev_filter *filter)
538*4882a593Smuzhiyun {
539*4882a593Smuzhiyun int i;
540*4882a593Smuzhiyun struct dmxdev *dmxdev = filter->dev;
541*4882a593Smuzhiyun u16 pid = filter->params.sec.pid;
542*4882a593Smuzhiyun
543*4882a593Smuzhiyun for (i = 0; i < dmxdev->filternum; i++)
544*4882a593Smuzhiyun if (dmxdev->filter[i].state >= DMXDEV_STATE_GO &&
545*4882a593Smuzhiyun dmxdev->filter[i].type == DMXDEV_TYPE_SEC &&
546*4882a593Smuzhiyun dmxdev->filter[i].params.sec.pid == pid) {
547*4882a593Smuzhiyun dvb_dmxdev_feed_start(&dmxdev->filter[i]);
548*4882a593Smuzhiyun return 0;
549*4882a593Smuzhiyun }
550*4882a593Smuzhiyun
551*4882a593Smuzhiyun filter->dev->demux->release_section_feed(dmxdev->demux,
552*4882a593Smuzhiyun filter->feed.sec);
553*4882a593Smuzhiyun
554*4882a593Smuzhiyun return 0;
555*4882a593Smuzhiyun }
556*4882a593Smuzhiyun
dvb_dmxdev_filter_stop(struct dmxdev_filter * dmxdevfilter)557*4882a593Smuzhiyun static int dvb_dmxdev_filter_stop(struct dmxdev_filter *dmxdevfilter)
558*4882a593Smuzhiyun {
559*4882a593Smuzhiyun struct dmxdev_feed *feed;
560*4882a593Smuzhiyun struct dmx_demux *demux;
561*4882a593Smuzhiyun
562*4882a593Smuzhiyun if (dmxdevfilter->state < DMXDEV_STATE_GO)
563*4882a593Smuzhiyun return 0;
564*4882a593Smuzhiyun
565*4882a593Smuzhiyun switch (dmxdevfilter->type) {
566*4882a593Smuzhiyun case DMXDEV_TYPE_SEC:
567*4882a593Smuzhiyun if (!dmxdevfilter->feed.sec)
568*4882a593Smuzhiyun break;
569*4882a593Smuzhiyun dvb_dmxdev_feed_stop(dmxdevfilter);
570*4882a593Smuzhiyun if (dmxdevfilter->filter.sec)
571*4882a593Smuzhiyun dmxdevfilter->feed.sec->
572*4882a593Smuzhiyun release_filter(dmxdevfilter->feed.sec,
573*4882a593Smuzhiyun dmxdevfilter->filter.sec);
574*4882a593Smuzhiyun dvb_dmxdev_feed_restart(dmxdevfilter);
575*4882a593Smuzhiyun dmxdevfilter->feed.sec = NULL;
576*4882a593Smuzhiyun break;
577*4882a593Smuzhiyun case DMXDEV_TYPE_PES:
578*4882a593Smuzhiyun dvb_dmxdev_feed_stop(dmxdevfilter);
579*4882a593Smuzhiyun demux = dmxdevfilter->dev->demux;
580*4882a593Smuzhiyun list_for_each_entry(feed, &dmxdevfilter->feed.ts, next) {
581*4882a593Smuzhiyun demux->release_ts_feed(demux, feed->ts);
582*4882a593Smuzhiyun feed->ts = NULL;
583*4882a593Smuzhiyun }
584*4882a593Smuzhiyun break;
585*4882a593Smuzhiyun default:
586*4882a593Smuzhiyun if (dmxdevfilter->state == DMXDEV_STATE_ALLOCATED)
587*4882a593Smuzhiyun return 0;
588*4882a593Smuzhiyun return -EINVAL;
589*4882a593Smuzhiyun }
590*4882a593Smuzhiyun
591*4882a593Smuzhiyun dvb_ringbuffer_flush(&dmxdevfilter->buffer);
592*4882a593Smuzhiyun return 0;
593*4882a593Smuzhiyun }
594*4882a593Smuzhiyun
dvb_dmxdev_delete_pids(struct dmxdev_filter * dmxdevfilter)595*4882a593Smuzhiyun static void dvb_dmxdev_delete_pids(struct dmxdev_filter *dmxdevfilter)
596*4882a593Smuzhiyun {
597*4882a593Smuzhiyun struct dmxdev_feed *feed, *tmp;
598*4882a593Smuzhiyun
599*4882a593Smuzhiyun /* delete all PIDs */
600*4882a593Smuzhiyun list_for_each_entry_safe(feed, tmp, &dmxdevfilter->feed.ts, next) {
601*4882a593Smuzhiyun list_del(&feed->next);
602*4882a593Smuzhiyun kfree(feed);
603*4882a593Smuzhiyun }
604*4882a593Smuzhiyun
605*4882a593Smuzhiyun BUG_ON(!list_empty(&dmxdevfilter->feed.ts));
606*4882a593Smuzhiyun }
607*4882a593Smuzhiyun
dvb_dmxdev_filter_reset(struct dmxdev_filter * dmxdevfilter)608*4882a593Smuzhiyun static inline int dvb_dmxdev_filter_reset(struct dmxdev_filter *dmxdevfilter)
609*4882a593Smuzhiyun {
610*4882a593Smuzhiyun if (dmxdevfilter->state < DMXDEV_STATE_SET)
611*4882a593Smuzhiyun return 0;
612*4882a593Smuzhiyun
613*4882a593Smuzhiyun if (dmxdevfilter->type == DMXDEV_TYPE_PES)
614*4882a593Smuzhiyun dvb_dmxdev_delete_pids(dmxdevfilter);
615*4882a593Smuzhiyun
616*4882a593Smuzhiyun dmxdevfilter->type = DMXDEV_TYPE_NONE;
617*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_ALLOCATED);
618*4882a593Smuzhiyun return 0;
619*4882a593Smuzhiyun }
620*4882a593Smuzhiyun
dvb_dmxdev_start_feed(struct dmxdev * dmxdev,struct dmxdev_filter * filter,struct dmxdev_feed * feed)621*4882a593Smuzhiyun static int dvb_dmxdev_start_feed(struct dmxdev *dmxdev,
622*4882a593Smuzhiyun struct dmxdev_filter *filter,
623*4882a593Smuzhiyun struct dmxdev_feed *feed)
624*4882a593Smuzhiyun {
625*4882a593Smuzhiyun ktime_t timeout = ktime_set(0, 0);
626*4882a593Smuzhiyun struct dmx_pes_filter_params *para = &filter->params.pes;
627*4882a593Smuzhiyun enum dmx_output otype;
628*4882a593Smuzhiyun int ret;
629*4882a593Smuzhiyun int ts_type;
630*4882a593Smuzhiyun enum dmx_ts_pes ts_pes;
631*4882a593Smuzhiyun struct dmx_ts_feed *tsfeed;
632*4882a593Smuzhiyun
633*4882a593Smuzhiyun feed->ts = NULL;
634*4882a593Smuzhiyun otype = para->output;
635*4882a593Smuzhiyun
636*4882a593Smuzhiyun ts_pes = para->pes_type;
637*4882a593Smuzhiyun
638*4882a593Smuzhiyun if (ts_pes < DMX_PES_OTHER)
639*4882a593Smuzhiyun ts_type = TS_DECODER;
640*4882a593Smuzhiyun else
641*4882a593Smuzhiyun ts_type = 0;
642*4882a593Smuzhiyun
643*4882a593Smuzhiyun if (otype == DMX_OUT_TS_TAP)
644*4882a593Smuzhiyun ts_type |= TS_PACKET;
645*4882a593Smuzhiyun else if (otype == DMX_OUT_TSDEMUX_TAP)
646*4882a593Smuzhiyun ts_type |= TS_PACKET | TS_DEMUX;
647*4882a593Smuzhiyun else if (otype == DMX_OUT_TAP)
648*4882a593Smuzhiyun ts_type |= TS_PACKET | TS_DEMUX | TS_PAYLOAD_ONLY;
649*4882a593Smuzhiyun
650*4882a593Smuzhiyun ret = dmxdev->demux->allocate_ts_feed(dmxdev->demux, &feed->ts,
651*4882a593Smuzhiyun dvb_dmxdev_ts_callback);
652*4882a593Smuzhiyun if (ret < 0)
653*4882a593Smuzhiyun return ret;
654*4882a593Smuzhiyun
655*4882a593Smuzhiyun tsfeed = feed->ts;
656*4882a593Smuzhiyun tsfeed->priv = filter;
657*4882a593Smuzhiyun
658*4882a593Smuzhiyun ret = tsfeed->set(tsfeed, feed->pid, ts_type, ts_pes, timeout);
659*4882a593Smuzhiyun if (ret < 0) {
660*4882a593Smuzhiyun dmxdev->demux->release_ts_feed(dmxdev->demux, tsfeed);
661*4882a593Smuzhiyun return ret;
662*4882a593Smuzhiyun }
663*4882a593Smuzhiyun
664*4882a593Smuzhiyun ret = tsfeed->start_filtering(tsfeed);
665*4882a593Smuzhiyun if (ret < 0) {
666*4882a593Smuzhiyun dmxdev->demux->release_ts_feed(dmxdev->demux, tsfeed);
667*4882a593Smuzhiyun return ret;
668*4882a593Smuzhiyun }
669*4882a593Smuzhiyun
670*4882a593Smuzhiyun return 0;
671*4882a593Smuzhiyun }
672*4882a593Smuzhiyun
dvb_dmxdev_filter_start(struct dmxdev_filter * filter)673*4882a593Smuzhiyun static int dvb_dmxdev_filter_start(struct dmxdev_filter *filter)
674*4882a593Smuzhiyun {
675*4882a593Smuzhiyun struct dmxdev *dmxdev = filter->dev;
676*4882a593Smuzhiyun struct dmxdev_feed *feed;
677*4882a593Smuzhiyun void *mem;
678*4882a593Smuzhiyun int ret, i;
679*4882a593Smuzhiyun
680*4882a593Smuzhiyun if (filter->state < DMXDEV_STATE_SET)
681*4882a593Smuzhiyun return -EINVAL;
682*4882a593Smuzhiyun
683*4882a593Smuzhiyun if (filter->state >= DMXDEV_STATE_GO)
684*4882a593Smuzhiyun dvb_dmxdev_filter_stop(filter);
685*4882a593Smuzhiyun
686*4882a593Smuzhiyun if (!filter->buffer.data) {
687*4882a593Smuzhiyun mem = vmalloc(filter->buffer.size);
688*4882a593Smuzhiyun if (!mem)
689*4882a593Smuzhiyun return -ENOMEM;
690*4882a593Smuzhiyun spin_lock_irq(&filter->dev->lock);
691*4882a593Smuzhiyun filter->buffer.data = mem;
692*4882a593Smuzhiyun spin_unlock_irq(&filter->dev->lock);
693*4882a593Smuzhiyun }
694*4882a593Smuzhiyun
695*4882a593Smuzhiyun dvb_ringbuffer_flush(&filter->buffer);
696*4882a593Smuzhiyun
697*4882a593Smuzhiyun switch (filter->type) {
698*4882a593Smuzhiyun case DMXDEV_TYPE_SEC:
699*4882a593Smuzhiyun {
700*4882a593Smuzhiyun struct dmx_sct_filter_params *para = &filter->params.sec;
701*4882a593Smuzhiyun struct dmx_section_filter **secfilter = &filter->filter.sec;
702*4882a593Smuzhiyun struct dmx_section_feed **secfeed = &filter->feed.sec;
703*4882a593Smuzhiyun
704*4882a593Smuzhiyun *secfilter = NULL;
705*4882a593Smuzhiyun *secfeed = NULL;
706*4882a593Smuzhiyun
707*4882a593Smuzhiyun
708*4882a593Smuzhiyun /* find active filter/feed with same PID */
709*4882a593Smuzhiyun for (i = 0; i < dmxdev->filternum; i++) {
710*4882a593Smuzhiyun if (dmxdev->filter[i].state >= DMXDEV_STATE_GO &&
711*4882a593Smuzhiyun dmxdev->filter[i].type == DMXDEV_TYPE_SEC &&
712*4882a593Smuzhiyun dmxdev->filter[i].params.sec.pid == para->pid) {
713*4882a593Smuzhiyun *secfeed = dmxdev->filter[i].feed.sec;
714*4882a593Smuzhiyun break;
715*4882a593Smuzhiyun }
716*4882a593Smuzhiyun }
717*4882a593Smuzhiyun
718*4882a593Smuzhiyun /* if no feed found, try to allocate new one */
719*4882a593Smuzhiyun if (!*secfeed) {
720*4882a593Smuzhiyun ret = dmxdev->demux->allocate_section_feed(dmxdev->demux,
721*4882a593Smuzhiyun secfeed,
722*4882a593Smuzhiyun dvb_dmxdev_section_callback);
723*4882a593Smuzhiyun if (ret < 0) {
724*4882a593Smuzhiyun pr_err("DVB (%s): could not alloc feed\n",
725*4882a593Smuzhiyun __func__);
726*4882a593Smuzhiyun return ret;
727*4882a593Smuzhiyun }
728*4882a593Smuzhiyun
729*4882a593Smuzhiyun ret = (*secfeed)->set(*secfeed, para->pid,
730*4882a593Smuzhiyun (para->flags & DMX_CHECK_CRC) ? 1 : 0);
731*4882a593Smuzhiyun if (ret < 0) {
732*4882a593Smuzhiyun pr_err("DVB (%s): could not set feed\n",
733*4882a593Smuzhiyun __func__);
734*4882a593Smuzhiyun dvb_dmxdev_feed_restart(filter);
735*4882a593Smuzhiyun return ret;
736*4882a593Smuzhiyun }
737*4882a593Smuzhiyun } else {
738*4882a593Smuzhiyun dvb_dmxdev_feed_stop(filter);
739*4882a593Smuzhiyun }
740*4882a593Smuzhiyun
741*4882a593Smuzhiyun ret = (*secfeed)->allocate_filter(*secfeed, secfilter);
742*4882a593Smuzhiyun if (ret < 0) {
743*4882a593Smuzhiyun dvb_dmxdev_feed_restart(filter);
744*4882a593Smuzhiyun filter->feed.sec->start_filtering(*secfeed);
745*4882a593Smuzhiyun dprintk("could not get filter\n");
746*4882a593Smuzhiyun return ret;
747*4882a593Smuzhiyun }
748*4882a593Smuzhiyun
749*4882a593Smuzhiyun (*secfilter)->priv = filter;
750*4882a593Smuzhiyun
751*4882a593Smuzhiyun memcpy(&((*secfilter)->filter_value[3]),
752*4882a593Smuzhiyun &(para->filter.filter[1]), DMX_FILTER_SIZE - 1);
753*4882a593Smuzhiyun memcpy(&(*secfilter)->filter_mask[3],
754*4882a593Smuzhiyun ¶->filter.mask[1], DMX_FILTER_SIZE - 1);
755*4882a593Smuzhiyun memcpy(&(*secfilter)->filter_mode[3],
756*4882a593Smuzhiyun ¶->filter.mode[1], DMX_FILTER_SIZE - 1);
757*4882a593Smuzhiyun
758*4882a593Smuzhiyun (*secfilter)->filter_value[0] = para->filter.filter[0];
759*4882a593Smuzhiyun (*secfilter)->filter_mask[0] = para->filter.mask[0];
760*4882a593Smuzhiyun (*secfilter)->filter_mode[0] = para->filter.mode[0];
761*4882a593Smuzhiyun (*secfilter)->filter_mask[1] = 0;
762*4882a593Smuzhiyun (*secfilter)->filter_mask[2] = 0;
763*4882a593Smuzhiyun
764*4882a593Smuzhiyun filter->todo = 0;
765*4882a593Smuzhiyun
766*4882a593Smuzhiyun ret = filter->feed.sec->start_filtering(filter->feed.sec);
767*4882a593Smuzhiyun if (ret < 0)
768*4882a593Smuzhiyun return ret;
769*4882a593Smuzhiyun
770*4882a593Smuzhiyun dvb_dmxdev_filter_timer(filter);
771*4882a593Smuzhiyun break;
772*4882a593Smuzhiyun }
773*4882a593Smuzhiyun case DMXDEV_TYPE_PES:
774*4882a593Smuzhiyun list_for_each_entry(feed, &filter->feed.ts, next) {
775*4882a593Smuzhiyun ret = dvb_dmxdev_start_feed(dmxdev, filter, feed);
776*4882a593Smuzhiyun if (ret < 0) {
777*4882a593Smuzhiyun dvb_dmxdev_filter_stop(filter);
778*4882a593Smuzhiyun return ret;
779*4882a593Smuzhiyun }
780*4882a593Smuzhiyun }
781*4882a593Smuzhiyun break;
782*4882a593Smuzhiyun default:
783*4882a593Smuzhiyun return -EINVAL;
784*4882a593Smuzhiyun }
785*4882a593Smuzhiyun
786*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(filter, DMXDEV_STATE_GO);
787*4882a593Smuzhiyun return 0;
788*4882a593Smuzhiyun }
789*4882a593Smuzhiyun
dvb_demux_open(struct inode * inode,struct file * file)790*4882a593Smuzhiyun static int dvb_demux_open(struct inode *inode, struct file *file)
791*4882a593Smuzhiyun {
792*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
793*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
794*4882a593Smuzhiyun int i;
795*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter;
796*4882a593Smuzhiyun
797*4882a593Smuzhiyun if (!dmxdev->filter)
798*4882a593Smuzhiyun return -EINVAL;
799*4882a593Smuzhiyun
800*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdev->mutex))
801*4882a593Smuzhiyun return -ERESTARTSYS;
802*4882a593Smuzhiyun
803*4882a593Smuzhiyun if (dmxdev->exit) {
804*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
805*4882a593Smuzhiyun return -ENODEV;
806*4882a593Smuzhiyun }
807*4882a593Smuzhiyun
808*4882a593Smuzhiyun for (i = 0; i < dmxdev->filternum; i++)
809*4882a593Smuzhiyun if (dmxdev->filter[i].state == DMXDEV_STATE_FREE)
810*4882a593Smuzhiyun break;
811*4882a593Smuzhiyun
812*4882a593Smuzhiyun if (i == dmxdev->filternum) {
813*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
814*4882a593Smuzhiyun return -EMFILE;
815*4882a593Smuzhiyun }
816*4882a593Smuzhiyun
817*4882a593Smuzhiyun dmxdevfilter = &dmxdev->filter[i];
818*4882a593Smuzhiyun mutex_init(&dmxdevfilter->mutex);
819*4882a593Smuzhiyun file->private_data = dmxdevfilter;
820*4882a593Smuzhiyun
821*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
822*4882a593Smuzhiyun dmxdev->may_do_mmap = 1;
823*4882a593Smuzhiyun #else
824*4882a593Smuzhiyun dmxdev->may_do_mmap = 0;
825*4882a593Smuzhiyun #endif
826*4882a593Smuzhiyun
827*4882a593Smuzhiyun dvb_ringbuffer_init(&dmxdevfilter->buffer, NULL, 8192);
828*4882a593Smuzhiyun dvb_vb2_init(&dmxdevfilter->vb2_ctx, "demux_filter",
829*4882a593Smuzhiyun file->f_flags & O_NONBLOCK);
830*4882a593Smuzhiyun dmxdevfilter->type = DMXDEV_TYPE_NONE;
831*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_ALLOCATED);
832*4882a593Smuzhiyun timer_setup(&dmxdevfilter->timer, dvb_dmxdev_filter_timeout, 0);
833*4882a593Smuzhiyun
834*4882a593Smuzhiyun dvbdev->users++;
835*4882a593Smuzhiyun
836*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
837*4882a593Smuzhiyun return 0;
838*4882a593Smuzhiyun }
839*4882a593Smuzhiyun
dvb_dmxdev_filter_free(struct dmxdev * dmxdev,struct dmxdev_filter * dmxdevfilter)840*4882a593Smuzhiyun static int dvb_dmxdev_filter_free(struct dmxdev *dmxdev,
841*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter)
842*4882a593Smuzhiyun {
843*4882a593Smuzhiyun mutex_lock(&dmxdev->mutex);
844*4882a593Smuzhiyun mutex_lock(&dmxdevfilter->mutex);
845*4882a593Smuzhiyun if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx))
846*4882a593Smuzhiyun dvb_vb2_stream_off(&dmxdevfilter->vb2_ctx);
847*4882a593Smuzhiyun dvb_vb2_release(&dmxdevfilter->vb2_ctx);
848*4882a593Smuzhiyun
849*4882a593Smuzhiyun
850*4882a593Smuzhiyun dvb_dmxdev_filter_stop(dmxdevfilter);
851*4882a593Smuzhiyun dvb_dmxdev_filter_reset(dmxdevfilter);
852*4882a593Smuzhiyun
853*4882a593Smuzhiyun if (dmxdevfilter->buffer.data) {
854*4882a593Smuzhiyun void *mem = dmxdevfilter->buffer.data;
855*4882a593Smuzhiyun
856*4882a593Smuzhiyun spin_lock_irq(&dmxdev->lock);
857*4882a593Smuzhiyun dmxdevfilter->buffer.data = NULL;
858*4882a593Smuzhiyun spin_unlock_irq(&dmxdev->lock);
859*4882a593Smuzhiyun vfree(mem);
860*4882a593Smuzhiyun }
861*4882a593Smuzhiyun
862*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_FREE);
863*4882a593Smuzhiyun wake_up(&dmxdevfilter->buffer.queue);
864*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
865*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
866*4882a593Smuzhiyun return 0;
867*4882a593Smuzhiyun }
868*4882a593Smuzhiyun
invert_mode(struct dmx_filter * filter)869*4882a593Smuzhiyun static inline void invert_mode(struct dmx_filter *filter)
870*4882a593Smuzhiyun {
871*4882a593Smuzhiyun int i;
872*4882a593Smuzhiyun
873*4882a593Smuzhiyun for (i = 0; i < DMX_FILTER_SIZE; i++)
874*4882a593Smuzhiyun filter->mode[i] ^= 0xff;
875*4882a593Smuzhiyun }
876*4882a593Smuzhiyun
dvb_dmxdev_add_pid(struct dmxdev * dmxdev,struct dmxdev_filter * filter,u16 pid)877*4882a593Smuzhiyun static int dvb_dmxdev_add_pid(struct dmxdev *dmxdev,
878*4882a593Smuzhiyun struct dmxdev_filter *filter, u16 pid)
879*4882a593Smuzhiyun {
880*4882a593Smuzhiyun struct dmxdev_feed *feed;
881*4882a593Smuzhiyun
882*4882a593Smuzhiyun if ((filter->type != DMXDEV_TYPE_PES) ||
883*4882a593Smuzhiyun (filter->state < DMXDEV_STATE_SET))
884*4882a593Smuzhiyun return -EINVAL;
885*4882a593Smuzhiyun
886*4882a593Smuzhiyun /* only TS packet filters may have multiple PIDs */
887*4882a593Smuzhiyun if ((filter->params.pes.output != DMX_OUT_TSDEMUX_TAP) &&
888*4882a593Smuzhiyun (!list_empty(&filter->feed.ts)))
889*4882a593Smuzhiyun return -EINVAL;
890*4882a593Smuzhiyun
891*4882a593Smuzhiyun feed = kzalloc(sizeof(struct dmxdev_feed), GFP_KERNEL);
892*4882a593Smuzhiyun if (feed == NULL)
893*4882a593Smuzhiyun return -ENOMEM;
894*4882a593Smuzhiyun
895*4882a593Smuzhiyun feed->pid = pid;
896*4882a593Smuzhiyun list_add(&feed->next, &filter->feed.ts);
897*4882a593Smuzhiyun
898*4882a593Smuzhiyun if (filter->state >= DMXDEV_STATE_GO)
899*4882a593Smuzhiyun return dvb_dmxdev_start_feed(dmxdev, filter, feed);
900*4882a593Smuzhiyun
901*4882a593Smuzhiyun return 0;
902*4882a593Smuzhiyun }
903*4882a593Smuzhiyun
dvb_dmxdev_remove_pid(struct dmxdev * dmxdev,struct dmxdev_filter * filter,u16 pid)904*4882a593Smuzhiyun static int dvb_dmxdev_remove_pid(struct dmxdev *dmxdev,
905*4882a593Smuzhiyun struct dmxdev_filter *filter, u16 pid)
906*4882a593Smuzhiyun {
907*4882a593Smuzhiyun struct dmxdev_feed *feed, *tmp;
908*4882a593Smuzhiyun
909*4882a593Smuzhiyun if ((filter->type != DMXDEV_TYPE_PES) ||
910*4882a593Smuzhiyun (filter->state < DMXDEV_STATE_SET))
911*4882a593Smuzhiyun return -EINVAL;
912*4882a593Smuzhiyun
913*4882a593Smuzhiyun list_for_each_entry_safe(feed, tmp, &filter->feed.ts, next) {
914*4882a593Smuzhiyun if ((feed->pid == pid) && (feed->ts != NULL)) {
915*4882a593Smuzhiyun feed->ts->stop_filtering(feed->ts);
916*4882a593Smuzhiyun filter->dev->demux->release_ts_feed(filter->dev->demux,
917*4882a593Smuzhiyun feed->ts);
918*4882a593Smuzhiyun list_del(&feed->next);
919*4882a593Smuzhiyun kfree(feed);
920*4882a593Smuzhiyun }
921*4882a593Smuzhiyun }
922*4882a593Smuzhiyun
923*4882a593Smuzhiyun return 0;
924*4882a593Smuzhiyun }
925*4882a593Smuzhiyun
dvb_dmxdev_filter_set(struct dmxdev * dmxdev,struct dmxdev_filter * dmxdevfilter,struct dmx_sct_filter_params * params)926*4882a593Smuzhiyun static int dvb_dmxdev_filter_set(struct dmxdev *dmxdev,
927*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter,
928*4882a593Smuzhiyun struct dmx_sct_filter_params *params)
929*4882a593Smuzhiyun {
930*4882a593Smuzhiyun dprintk("%s: PID=0x%04x, flags=%02x, timeout=%d\n",
931*4882a593Smuzhiyun __func__, params->pid, params->flags, params->timeout);
932*4882a593Smuzhiyun
933*4882a593Smuzhiyun dvb_dmxdev_filter_stop(dmxdevfilter);
934*4882a593Smuzhiyun
935*4882a593Smuzhiyun dmxdevfilter->type = DMXDEV_TYPE_SEC;
936*4882a593Smuzhiyun memcpy(&dmxdevfilter->params.sec,
937*4882a593Smuzhiyun params, sizeof(struct dmx_sct_filter_params));
938*4882a593Smuzhiyun invert_mode(&dmxdevfilter->params.sec.filter);
939*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET);
940*4882a593Smuzhiyun
941*4882a593Smuzhiyun if (params->flags & DMX_IMMEDIATE_START)
942*4882a593Smuzhiyun return dvb_dmxdev_filter_start(dmxdevfilter);
943*4882a593Smuzhiyun
944*4882a593Smuzhiyun return 0;
945*4882a593Smuzhiyun }
946*4882a593Smuzhiyun
dvb_dmxdev_pes_filter_set(struct dmxdev * dmxdev,struct dmxdev_filter * dmxdevfilter,struct dmx_pes_filter_params * params)947*4882a593Smuzhiyun static int dvb_dmxdev_pes_filter_set(struct dmxdev *dmxdev,
948*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter,
949*4882a593Smuzhiyun struct dmx_pes_filter_params *params)
950*4882a593Smuzhiyun {
951*4882a593Smuzhiyun int ret;
952*4882a593Smuzhiyun
953*4882a593Smuzhiyun dvb_dmxdev_filter_stop(dmxdevfilter);
954*4882a593Smuzhiyun dvb_dmxdev_filter_reset(dmxdevfilter);
955*4882a593Smuzhiyun
956*4882a593Smuzhiyun if ((unsigned int)params->pes_type > DMX_PES_OTHER)
957*4882a593Smuzhiyun return -EINVAL;
958*4882a593Smuzhiyun
959*4882a593Smuzhiyun dmxdevfilter->type = DMXDEV_TYPE_PES;
960*4882a593Smuzhiyun memcpy(&dmxdevfilter->params, params,
961*4882a593Smuzhiyun sizeof(struct dmx_pes_filter_params));
962*4882a593Smuzhiyun INIT_LIST_HEAD(&dmxdevfilter->feed.ts);
963*4882a593Smuzhiyun
964*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET);
965*4882a593Smuzhiyun
966*4882a593Smuzhiyun ret = dvb_dmxdev_add_pid(dmxdev, dmxdevfilter,
967*4882a593Smuzhiyun dmxdevfilter->params.pes.pid);
968*4882a593Smuzhiyun if (ret < 0)
969*4882a593Smuzhiyun return ret;
970*4882a593Smuzhiyun
971*4882a593Smuzhiyun if (params->flags & DMX_IMMEDIATE_START)
972*4882a593Smuzhiyun return dvb_dmxdev_filter_start(dmxdevfilter);
973*4882a593Smuzhiyun
974*4882a593Smuzhiyun return 0;
975*4882a593Smuzhiyun }
976*4882a593Smuzhiyun
dvb_dmxdev_read_sec(struct dmxdev_filter * dfil,struct file * file,char __user * buf,size_t count,loff_t * ppos)977*4882a593Smuzhiyun static ssize_t dvb_dmxdev_read_sec(struct dmxdev_filter *dfil,
978*4882a593Smuzhiyun struct file *file, char __user *buf,
979*4882a593Smuzhiyun size_t count, loff_t *ppos)
980*4882a593Smuzhiyun {
981*4882a593Smuzhiyun int result, hcount;
982*4882a593Smuzhiyun int done = 0;
983*4882a593Smuzhiyun
984*4882a593Smuzhiyun if (dfil->todo <= 0) {
985*4882a593Smuzhiyun hcount = 3 + dfil->todo;
986*4882a593Smuzhiyun if (hcount > count)
987*4882a593Smuzhiyun hcount = count;
988*4882a593Smuzhiyun result = dvb_dmxdev_buffer_read(&dfil->buffer,
989*4882a593Smuzhiyun file->f_flags & O_NONBLOCK,
990*4882a593Smuzhiyun buf, hcount, ppos);
991*4882a593Smuzhiyun if (result < 0) {
992*4882a593Smuzhiyun dfil->todo = 0;
993*4882a593Smuzhiyun return result;
994*4882a593Smuzhiyun }
995*4882a593Smuzhiyun if (copy_from_user(dfil->secheader - dfil->todo, buf, result))
996*4882a593Smuzhiyun return -EFAULT;
997*4882a593Smuzhiyun buf += result;
998*4882a593Smuzhiyun done = result;
999*4882a593Smuzhiyun count -= result;
1000*4882a593Smuzhiyun dfil->todo -= result;
1001*4882a593Smuzhiyun if (dfil->todo > -3)
1002*4882a593Smuzhiyun return done;
1003*4882a593Smuzhiyun dfil->todo = ((dfil->secheader[1] << 8) | dfil->secheader[2]) & 0xfff;
1004*4882a593Smuzhiyun if (!count)
1005*4882a593Smuzhiyun return done;
1006*4882a593Smuzhiyun }
1007*4882a593Smuzhiyun if (count > dfil->todo)
1008*4882a593Smuzhiyun count = dfil->todo;
1009*4882a593Smuzhiyun result = dvb_dmxdev_buffer_read(&dfil->buffer,
1010*4882a593Smuzhiyun file->f_flags & O_NONBLOCK,
1011*4882a593Smuzhiyun buf, count, ppos);
1012*4882a593Smuzhiyun if (result < 0)
1013*4882a593Smuzhiyun return result;
1014*4882a593Smuzhiyun dfil->todo -= result;
1015*4882a593Smuzhiyun return (result + done);
1016*4882a593Smuzhiyun }
1017*4882a593Smuzhiyun
1018*4882a593Smuzhiyun static ssize_t
dvb_demux_read(struct file * file,char __user * buf,size_t count,loff_t * ppos)1019*4882a593Smuzhiyun dvb_demux_read(struct file *file, char __user *buf, size_t count,
1020*4882a593Smuzhiyun loff_t *ppos)
1021*4882a593Smuzhiyun {
1022*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = file->private_data;
1023*4882a593Smuzhiyun int ret;
1024*4882a593Smuzhiyun
1025*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex))
1026*4882a593Smuzhiyun return -ERESTARTSYS;
1027*4882a593Smuzhiyun
1028*4882a593Smuzhiyun if (dmxdevfilter->type == DMXDEV_TYPE_SEC)
1029*4882a593Smuzhiyun ret = dvb_dmxdev_read_sec(dmxdevfilter, file, buf, count, ppos);
1030*4882a593Smuzhiyun else
1031*4882a593Smuzhiyun ret = dvb_dmxdev_buffer_read(&dmxdevfilter->buffer,
1032*4882a593Smuzhiyun file->f_flags & O_NONBLOCK,
1033*4882a593Smuzhiyun buf, count, ppos);
1034*4882a593Smuzhiyun
1035*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1036*4882a593Smuzhiyun return ret;
1037*4882a593Smuzhiyun }
1038*4882a593Smuzhiyun
dvb_demux_do_ioctl(struct file * file,unsigned int cmd,void * parg)1039*4882a593Smuzhiyun static int dvb_demux_do_ioctl(struct file *file,
1040*4882a593Smuzhiyun unsigned int cmd, void *parg)
1041*4882a593Smuzhiyun {
1042*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = file->private_data;
1043*4882a593Smuzhiyun struct dmxdev *dmxdev = dmxdevfilter->dev;
1044*4882a593Smuzhiyun unsigned long arg = (unsigned long)parg;
1045*4882a593Smuzhiyun int ret = 0;
1046*4882a593Smuzhiyun
1047*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdev->mutex))
1048*4882a593Smuzhiyun return -ERESTARTSYS;
1049*4882a593Smuzhiyun
1050*4882a593Smuzhiyun switch (cmd) {
1051*4882a593Smuzhiyun case DMX_START:
1052*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1053*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1054*4882a593Smuzhiyun return -ERESTARTSYS;
1055*4882a593Smuzhiyun }
1056*4882a593Smuzhiyun if (dmxdevfilter->state < DMXDEV_STATE_SET)
1057*4882a593Smuzhiyun ret = -EINVAL;
1058*4882a593Smuzhiyun else
1059*4882a593Smuzhiyun ret = dvb_dmxdev_filter_start(dmxdevfilter);
1060*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1061*4882a593Smuzhiyun break;
1062*4882a593Smuzhiyun
1063*4882a593Smuzhiyun case DMX_STOP:
1064*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1065*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1066*4882a593Smuzhiyun return -ERESTARTSYS;
1067*4882a593Smuzhiyun }
1068*4882a593Smuzhiyun ret = dvb_dmxdev_filter_stop(dmxdevfilter);
1069*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1070*4882a593Smuzhiyun break;
1071*4882a593Smuzhiyun
1072*4882a593Smuzhiyun case DMX_SET_FILTER:
1073*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1074*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1075*4882a593Smuzhiyun return -ERESTARTSYS;
1076*4882a593Smuzhiyun }
1077*4882a593Smuzhiyun ret = dvb_dmxdev_filter_set(dmxdev, dmxdevfilter, parg);
1078*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1079*4882a593Smuzhiyun break;
1080*4882a593Smuzhiyun
1081*4882a593Smuzhiyun case DMX_SET_PES_FILTER:
1082*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1083*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1084*4882a593Smuzhiyun return -ERESTARTSYS;
1085*4882a593Smuzhiyun }
1086*4882a593Smuzhiyun ret = dvb_dmxdev_pes_filter_set(dmxdev, dmxdevfilter, parg);
1087*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1088*4882a593Smuzhiyun break;
1089*4882a593Smuzhiyun
1090*4882a593Smuzhiyun case DMX_SET_BUFFER_SIZE:
1091*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1092*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1093*4882a593Smuzhiyun return -ERESTARTSYS;
1094*4882a593Smuzhiyun }
1095*4882a593Smuzhiyun ret = dvb_dmxdev_set_buffer_size(dmxdevfilter, arg);
1096*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1097*4882a593Smuzhiyun break;
1098*4882a593Smuzhiyun
1099*4882a593Smuzhiyun case DMX_GET_PES_PIDS:
1100*4882a593Smuzhiyun if (!dmxdev->demux->get_pes_pids) {
1101*4882a593Smuzhiyun ret = -EINVAL;
1102*4882a593Smuzhiyun break;
1103*4882a593Smuzhiyun }
1104*4882a593Smuzhiyun dmxdev->demux->get_pes_pids(dmxdev->demux, parg);
1105*4882a593Smuzhiyun break;
1106*4882a593Smuzhiyun
1107*4882a593Smuzhiyun case DMX_GET_STC:
1108*4882a593Smuzhiyun if (!dmxdev->demux->get_stc) {
1109*4882a593Smuzhiyun ret = -EINVAL;
1110*4882a593Smuzhiyun break;
1111*4882a593Smuzhiyun }
1112*4882a593Smuzhiyun ret = dmxdev->demux->get_stc(dmxdev->demux,
1113*4882a593Smuzhiyun ((struct dmx_stc *)parg)->num,
1114*4882a593Smuzhiyun &((struct dmx_stc *)parg)->stc,
1115*4882a593Smuzhiyun &((struct dmx_stc *)parg)->base);
1116*4882a593Smuzhiyun break;
1117*4882a593Smuzhiyun
1118*4882a593Smuzhiyun case DMX_ADD_PID:
1119*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1120*4882a593Smuzhiyun ret = -ERESTARTSYS;
1121*4882a593Smuzhiyun break;
1122*4882a593Smuzhiyun }
1123*4882a593Smuzhiyun ret = dvb_dmxdev_add_pid(dmxdev, dmxdevfilter, *(u16 *)parg);
1124*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1125*4882a593Smuzhiyun break;
1126*4882a593Smuzhiyun
1127*4882a593Smuzhiyun case DMX_REMOVE_PID:
1128*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1129*4882a593Smuzhiyun ret = -ERESTARTSYS;
1130*4882a593Smuzhiyun break;
1131*4882a593Smuzhiyun }
1132*4882a593Smuzhiyun ret = dvb_dmxdev_remove_pid(dmxdev, dmxdevfilter, *(u16 *)parg);
1133*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1134*4882a593Smuzhiyun break;
1135*4882a593Smuzhiyun
1136*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
1137*4882a593Smuzhiyun case DMX_REQBUFS:
1138*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1139*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1140*4882a593Smuzhiyun return -ERESTARTSYS;
1141*4882a593Smuzhiyun }
1142*4882a593Smuzhiyun ret = dvb_vb2_reqbufs(&dmxdevfilter->vb2_ctx, parg);
1143*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1144*4882a593Smuzhiyun break;
1145*4882a593Smuzhiyun
1146*4882a593Smuzhiyun case DMX_QUERYBUF:
1147*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1148*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1149*4882a593Smuzhiyun return -ERESTARTSYS;
1150*4882a593Smuzhiyun }
1151*4882a593Smuzhiyun ret = dvb_vb2_querybuf(&dmxdevfilter->vb2_ctx, parg);
1152*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1153*4882a593Smuzhiyun break;
1154*4882a593Smuzhiyun
1155*4882a593Smuzhiyun case DMX_EXPBUF:
1156*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1157*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1158*4882a593Smuzhiyun return -ERESTARTSYS;
1159*4882a593Smuzhiyun }
1160*4882a593Smuzhiyun ret = dvb_vb2_expbuf(&dmxdevfilter->vb2_ctx, parg);
1161*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1162*4882a593Smuzhiyun break;
1163*4882a593Smuzhiyun
1164*4882a593Smuzhiyun case DMX_QBUF:
1165*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1166*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1167*4882a593Smuzhiyun return -ERESTARTSYS;
1168*4882a593Smuzhiyun }
1169*4882a593Smuzhiyun ret = dvb_vb2_qbuf(&dmxdevfilter->vb2_ctx, parg);
1170*4882a593Smuzhiyun if (ret == 0 && !dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx))
1171*4882a593Smuzhiyun ret = dvb_vb2_stream_on(&dmxdevfilter->vb2_ctx);
1172*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1173*4882a593Smuzhiyun break;
1174*4882a593Smuzhiyun
1175*4882a593Smuzhiyun case DMX_DQBUF:
1176*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1177*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1178*4882a593Smuzhiyun return -ERESTARTSYS;
1179*4882a593Smuzhiyun }
1180*4882a593Smuzhiyun ret = dvb_vb2_dqbuf(&dmxdevfilter->vb2_ctx, parg);
1181*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1182*4882a593Smuzhiyun break;
1183*4882a593Smuzhiyun #endif
1184*4882a593Smuzhiyun default:
1185*4882a593Smuzhiyun ret = -ENOTTY;
1186*4882a593Smuzhiyun break;
1187*4882a593Smuzhiyun }
1188*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1189*4882a593Smuzhiyun return ret;
1190*4882a593Smuzhiyun }
1191*4882a593Smuzhiyun
dvb_demux_ioctl(struct file * file,unsigned int cmd,unsigned long arg)1192*4882a593Smuzhiyun static long dvb_demux_ioctl(struct file *file, unsigned int cmd,
1193*4882a593Smuzhiyun unsigned long arg)
1194*4882a593Smuzhiyun {
1195*4882a593Smuzhiyun return dvb_usercopy(file, cmd, arg, dvb_demux_do_ioctl);
1196*4882a593Smuzhiyun }
1197*4882a593Smuzhiyun
dvb_demux_poll(struct file * file,poll_table * wait)1198*4882a593Smuzhiyun static __poll_t dvb_demux_poll(struct file *file, poll_table *wait)
1199*4882a593Smuzhiyun {
1200*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = file->private_data;
1201*4882a593Smuzhiyun __poll_t mask = 0;
1202*4882a593Smuzhiyun
1203*4882a593Smuzhiyun poll_wait(file, &dmxdevfilter->buffer.queue, wait);
1204*4882a593Smuzhiyun
1205*4882a593Smuzhiyun if ((!dmxdevfilter) || dmxdevfilter->dev->exit)
1206*4882a593Smuzhiyun return EPOLLERR;
1207*4882a593Smuzhiyun if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx))
1208*4882a593Smuzhiyun return dvb_vb2_poll(&dmxdevfilter->vb2_ctx, file, wait);
1209*4882a593Smuzhiyun
1210*4882a593Smuzhiyun if (dmxdevfilter->state != DMXDEV_STATE_GO &&
1211*4882a593Smuzhiyun dmxdevfilter->state != DMXDEV_STATE_DONE &&
1212*4882a593Smuzhiyun dmxdevfilter->state != DMXDEV_STATE_TIMEDOUT)
1213*4882a593Smuzhiyun return 0;
1214*4882a593Smuzhiyun
1215*4882a593Smuzhiyun if (dmxdevfilter->buffer.error)
1216*4882a593Smuzhiyun mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI | EPOLLERR);
1217*4882a593Smuzhiyun
1218*4882a593Smuzhiyun if (!dvb_ringbuffer_empty(&dmxdevfilter->buffer))
1219*4882a593Smuzhiyun mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI);
1220*4882a593Smuzhiyun
1221*4882a593Smuzhiyun return mask;
1222*4882a593Smuzhiyun }
1223*4882a593Smuzhiyun
1224*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
dvb_demux_mmap(struct file * file,struct vm_area_struct * vma)1225*4882a593Smuzhiyun static int dvb_demux_mmap(struct file *file, struct vm_area_struct *vma)
1226*4882a593Smuzhiyun {
1227*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = file->private_data;
1228*4882a593Smuzhiyun struct dmxdev *dmxdev = dmxdevfilter->dev;
1229*4882a593Smuzhiyun int ret;
1230*4882a593Smuzhiyun
1231*4882a593Smuzhiyun if (!dmxdev->may_do_mmap)
1232*4882a593Smuzhiyun return -ENOTTY;
1233*4882a593Smuzhiyun
1234*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdev->mutex))
1235*4882a593Smuzhiyun return -ERESTARTSYS;
1236*4882a593Smuzhiyun
1237*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1238*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1239*4882a593Smuzhiyun return -ERESTARTSYS;
1240*4882a593Smuzhiyun }
1241*4882a593Smuzhiyun ret = dvb_vb2_mmap(&dmxdevfilter->vb2_ctx, vma);
1242*4882a593Smuzhiyun
1243*4882a593Smuzhiyun mutex_unlock(&dmxdevfilter->mutex);
1244*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1245*4882a593Smuzhiyun
1246*4882a593Smuzhiyun return ret;
1247*4882a593Smuzhiyun }
1248*4882a593Smuzhiyun #endif
1249*4882a593Smuzhiyun
dvb_demux_release(struct inode * inode,struct file * file)1250*4882a593Smuzhiyun static int dvb_demux_release(struct inode *inode, struct file *file)
1251*4882a593Smuzhiyun {
1252*4882a593Smuzhiyun struct dmxdev_filter *dmxdevfilter = file->private_data;
1253*4882a593Smuzhiyun struct dmxdev *dmxdev = dmxdevfilter->dev;
1254*4882a593Smuzhiyun int ret;
1255*4882a593Smuzhiyun
1256*4882a593Smuzhiyun ret = dvb_dmxdev_filter_free(dmxdev, dmxdevfilter);
1257*4882a593Smuzhiyun
1258*4882a593Smuzhiyun mutex_lock(&dmxdev->mutex);
1259*4882a593Smuzhiyun dmxdev->dvbdev->users--;
1260*4882a593Smuzhiyun if (dmxdev->dvbdev->users == 1 && dmxdev->exit == 1) {
1261*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1262*4882a593Smuzhiyun wake_up(&dmxdev->dvbdev->wait_queue);
1263*4882a593Smuzhiyun } else
1264*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1265*4882a593Smuzhiyun
1266*4882a593Smuzhiyun return ret;
1267*4882a593Smuzhiyun }
1268*4882a593Smuzhiyun
1269*4882a593Smuzhiyun static const struct file_operations dvb_demux_fops = {
1270*4882a593Smuzhiyun .owner = THIS_MODULE,
1271*4882a593Smuzhiyun .read = dvb_demux_read,
1272*4882a593Smuzhiyun .unlocked_ioctl = dvb_demux_ioctl,
1273*4882a593Smuzhiyun .compat_ioctl = dvb_demux_ioctl,
1274*4882a593Smuzhiyun .open = dvb_demux_open,
1275*4882a593Smuzhiyun .release = dvb_demux_release,
1276*4882a593Smuzhiyun .poll = dvb_demux_poll,
1277*4882a593Smuzhiyun .llseek = default_llseek,
1278*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
1279*4882a593Smuzhiyun .mmap = dvb_demux_mmap,
1280*4882a593Smuzhiyun #endif
1281*4882a593Smuzhiyun };
1282*4882a593Smuzhiyun
1283*4882a593Smuzhiyun static const struct dvb_device dvbdev_demux = {
1284*4882a593Smuzhiyun .priv = NULL,
1285*4882a593Smuzhiyun .users = 1,
1286*4882a593Smuzhiyun .writers = 1,
1287*4882a593Smuzhiyun #if defined(CONFIG_MEDIA_CONTROLLER_DVB)
1288*4882a593Smuzhiyun .name = "dvb-demux",
1289*4882a593Smuzhiyun #endif
1290*4882a593Smuzhiyun .fops = &dvb_demux_fops
1291*4882a593Smuzhiyun };
1292*4882a593Smuzhiyun
dvb_dvr_do_ioctl(struct file * file,unsigned int cmd,void * parg)1293*4882a593Smuzhiyun static int dvb_dvr_do_ioctl(struct file *file,
1294*4882a593Smuzhiyun unsigned int cmd, void *parg)
1295*4882a593Smuzhiyun {
1296*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
1297*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
1298*4882a593Smuzhiyun unsigned long arg = (unsigned long)parg;
1299*4882a593Smuzhiyun int ret;
1300*4882a593Smuzhiyun
1301*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdev->mutex))
1302*4882a593Smuzhiyun return -ERESTARTSYS;
1303*4882a593Smuzhiyun
1304*4882a593Smuzhiyun switch (cmd) {
1305*4882a593Smuzhiyun case DMX_SET_BUFFER_SIZE:
1306*4882a593Smuzhiyun ret = dvb_dvr_set_buffer_size(dmxdev, arg);
1307*4882a593Smuzhiyun break;
1308*4882a593Smuzhiyun
1309*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
1310*4882a593Smuzhiyun case DMX_REQBUFS:
1311*4882a593Smuzhiyun ret = dvb_vb2_reqbufs(&dmxdev->dvr_vb2_ctx, parg);
1312*4882a593Smuzhiyun break;
1313*4882a593Smuzhiyun
1314*4882a593Smuzhiyun case DMX_QUERYBUF:
1315*4882a593Smuzhiyun ret = dvb_vb2_querybuf(&dmxdev->dvr_vb2_ctx, parg);
1316*4882a593Smuzhiyun break;
1317*4882a593Smuzhiyun
1318*4882a593Smuzhiyun case DMX_EXPBUF:
1319*4882a593Smuzhiyun ret = dvb_vb2_expbuf(&dmxdev->dvr_vb2_ctx, parg);
1320*4882a593Smuzhiyun break;
1321*4882a593Smuzhiyun
1322*4882a593Smuzhiyun case DMX_QBUF:
1323*4882a593Smuzhiyun ret = dvb_vb2_qbuf(&dmxdev->dvr_vb2_ctx, parg);
1324*4882a593Smuzhiyun if (ret == 0 && !dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx))
1325*4882a593Smuzhiyun ret = dvb_vb2_stream_on(&dmxdev->dvr_vb2_ctx);
1326*4882a593Smuzhiyun break;
1327*4882a593Smuzhiyun
1328*4882a593Smuzhiyun case DMX_DQBUF:
1329*4882a593Smuzhiyun ret = dvb_vb2_dqbuf(&dmxdev->dvr_vb2_ctx, parg);
1330*4882a593Smuzhiyun break;
1331*4882a593Smuzhiyun #endif
1332*4882a593Smuzhiyun default:
1333*4882a593Smuzhiyun ret = -ENOTTY;
1334*4882a593Smuzhiyun break;
1335*4882a593Smuzhiyun }
1336*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1337*4882a593Smuzhiyun return ret;
1338*4882a593Smuzhiyun }
1339*4882a593Smuzhiyun
dvb_dvr_ioctl(struct file * file,unsigned int cmd,unsigned long arg)1340*4882a593Smuzhiyun static long dvb_dvr_ioctl(struct file *file,
1341*4882a593Smuzhiyun unsigned int cmd, unsigned long arg)
1342*4882a593Smuzhiyun {
1343*4882a593Smuzhiyun return dvb_usercopy(file, cmd, arg, dvb_dvr_do_ioctl);
1344*4882a593Smuzhiyun }
1345*4882a593Smuzhiyun
dvb_dvr_poll(struct file * file,poll_table * wait)1346*4882a593Smuzhiyun static __poll_t dvb_dvr_poll(struct file *file, poll_table *wait)
1347*4882a593Smuzhiyun {
1348*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
1349*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
1350*4882a593Smuzhiyun __poll_t mask = 0;
1351*4882a593Smuzhiyun
1352*4882a593Smuzhiyun dprintk("%s\n", __func__);
1353*4882a593Smuzhiyun
1354*4882a593Smuzhiyun poll_wait(file, &dmxdev->dvr_buffer.queue, wait);
1355*4882a593Smuzhiyun
1356*4882a593Smuzhiyun if (dmxdev->exit)
1357*4882a593Smuzhiyun return EPOLLERR;
1358*4882a593Smuzhiyun if (dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx))
1359*4882a593Smuzhiyun return dvb_vb2_poll(&dmxdev->dvr_vb2_ctx, file, wait);
1360*4882a593Smuzhiyun
1361*4882a593Smuzhiyun if (((file->f_flags & O_ACCMODE) == O_RDONLY) ||
1362*4882a593Smuzhiyun dmxdev->may_do_mmap) {
1363*4882a593Smuzhiyun if (dmxdev->dvr_buffer.error)
1364*4882a593Smuzhiyun mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI | EPOLLERR);
1365*4882a593Smuzhiyun
1366*4882a593Smuzhiyun if (!dvb_ringbuffer_empty(&dmxdev->dvr_buffer))
1367*4882a593Smuzhiyun mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI);
1368*4882a593Smuzhiyun } else
1369*4882a593Smuzhiyun mask |= (EPOLLOUT | EPOLLWRNORM | EPOLLPRI);
1370*4882a593Smuzhiyun
1371*4882a593Smuzhiyun return mask;
1372*4882a593Smuzhiyun }
1373*4882a593Smuzhiyun
1374*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
dvb_dvr_mmap(struct file * file,struct vm_area_struct * vma)1375*4882a593Smuzhiyun static int dvb_dvr_mmap(struct file *file, struct vm_area_struct *vma)
1376*4882a593Smuzhiyun {
1377*4882a593Smuzhiyun struct dvb_device *dvbdev = file->private_data;
1378*4882a593Smuzhiyun struct dmxdev *dmxdev = dvbdev->priv;
1379*4882a593Smuzhiyun int ret;
1380*4882a593Smuzhiyun
1381*4882a593Smuzhiyun if (!dmxdev->may_do_mmap)
1382*4882a593Smuzhiyun return -ENOTTY;
1383*4882a593Smuzhiyun
1384*4882a593Smuzhiyun if (dmxdev->exit)
1385*4882a593Smuzhiyun return -ENODEV;
1386*4882a593Smuzhiyun
1387*4882a593Smuzhiyun if (mutex_lock_interruptible(&dmxdev->mutex))
1388*4882a593Smuzhiyun return -ERESTARTSYS;
1389*4882a593Smuzhiyun
1390*4882a593Smuzhiyun ret = dvb_vb2_mmap(&dmxdev->dvr_vb2_ctx, vma);
1391*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1392*4882a593Smuzhiyun return ret;
1393*4882a593Smuzhiyun }
1394*4882a593Smuzhiyun #endif
1395*4882a593Smuzhiyun
1396*4882a593Smuzhiyun static const struct file_operations dvb_dvr_fops = {
1397*4882a593Smuzhiyun .owner = THIS_MODULE,
1398*4882a593Smuzhiyun .read = dvb_dvr_read,
1399*4882a593Smuzhiyun .write = dvb_dvr_write,
1400*4882a593Smuzhiyun .unlocked_ioctl = dvb_dvr_ioctl,
1401*4882a593Smuzhiyun .open = dvb_dvr_open,
1402*4882a593Smuzhiyun .release = dvb_dvr_release,
1403*4882a593Smuzhiyun .poll = dvb_dvr_poll,
1404*4882a593Smuzhiyun .llseek = default_llseek,
1405*4882a593Smuzhiyun #ifdef CONFIG_DVB_MMAP
1406*4882a593Smuzhiyun .mmap = dvb_dvr_mmap,
1407*4882a593Smuzhiyun #endif
1408*4882a593Smuzhiyun };
1409*4882a593Smuzhiyun
1410*4882a593Smuzhiyun static const struct dvb_device dvbdev_dvr = {
1411*4882a593Smuzhiyun .priv = NULL,
1412*4882a593Smuzhiyun .readers = 1,
1413*4882a593Smuzhiyun .users = 1,
1414*4882a593Smuzhiyun #if defined(CONFIG_MEDIA_CONTROLLER_DVB)
1415*4882a593Smuzhiyun .name = "dvb-dvr",
1416*4882a593Smuzhiyun #endif
1417*4882a593Smuzhiyun .fops = &dvb_dvr_fops
1418*4882a593Smuzhiyun };
dvb_dmxdev_init(struct dmxdev * dmxdev,struct dvb_adapter * dvb_adapter)1419*4882a593Smuzhiyun int dvb_dmxdev_init(struct dmxdev *dmxdev, struct dvb_adapter *dvb_adapter)
1420*4882a593Smuzhiyun {
1421*4882a593Smuzhiyun int i, ret;
1422*4882a593Smuzhiyun
1423*4882a593Smuzhiyun if (dmxdev->demux->open(dmxdev->demux) < 0)
1424*4882a593Smuzhiyun return -EUSERS;
1425*4882a593Smuzhiyun
1426*4882a593Smuzhiyun dmxdev->filter = vmalloc(array_size(sizeof(struct dmxdev_filter),
1427*4882a593Smuzhiyun dmxdev->filternum));
1428*4882a593Smuzhiyun if (!dmxdev->filter)
1429*4882a593Smuzhiyun return -ENOMEM;
1430*4882a593Smuzhiyun
1431*4882a593Smuzhiyun mutex_init(&dmxdev->mutex);
1432*4882a593Smuzhiyun spin_lock_init(&dmxdev->lock);
1433*4882a593Smuzhiyun for (i = 0; i < dmxdev->filternum; i++) {
1434*4882a593Smuzhiyun dmxdev->filter[i].dev = dmxdev;
1435*4882a593Smuzhiyun dmxdev->filter[i].buffer.data = NULL;
1436*4882a593Smuzhiyun dvb_dmxdev_filter_state_set(&dmxdev->filter[i],
1437*4882a593Smuzhiyun DMXDEV_STATE_FREE);
1438*4882a593Smuzhiyun }
1439*4882a593Smuzhiyun
1440*4882a593Smuzhiyun ret = dvb_register_device(dvb_adapter, &dmxdev->dvbdev, &dvbdev_demux, dmxdev,
1441*4882a593Smuzhiyun DVB_DEVICE_DEMUX, dmxdev->filternum);
1442*4882a593Smuzhiyun if (ret < 0)
1443*4882a593Smuzhiyun goto err_register_dvbdev;
1444*4882a593Smuzhiyun
1445*4882a593Smuzhiyun ret = dvb_register_device(dvb_adapter, &dmxdev->dvr_dvbdev, &dvbdev_dvr,
1446*4882a593Smuzhiyun dmxdev, DVB_DEVICE_DVR, dmxdev->filternum);
1447*4882a593Smuzhiyun if (ret < 0)
1448*4882a593Smuzhiyun goto err_register_dvr_dvbdev;
1449*4882a593Smuzhiyun
1450*4882a593Smuzhiyun dvb_ringbuffer_init(&dmxdev->dvr_buffer, NULL, 8192);
1451*4882a593Smuzhiyun
1452*4882a593Smuzhiyun return 0;
1453*4882a593Smuzhiyun
1454*4882a593Smuzhiyun err_register_dvr_dvbdev:
1455*4882a593Smuzhiyun dvb_unregister_device(dmxdev->dvbdev);
1456*4882a593Smuzhiyun err_register_dvbdev:
1457*4882a593Smuzhiyun vfree(dmxdev->filter);
1458*4882a593Smuzhiyun dmxdev->filter = NULL;
1459*4882a593Smuzhiyun return ret;
1460*4882a593Smuzhiyun }
1461*4882a593Smuzhiyun
1462*4882a593Smuzhiyun EXPORT_SYMBOL(dvb_dmxdev_init);
1463*4882a593Smuzhiyun
dvb_dmxdev_release(struct dmxdev * dmxdev)1464*4882a593Smuzhiyun void dvb_dmxdev_release(struct dmxdev *dmxdev)
1465*4882a593Smuzhiyun {
1466*4882a593Smuzhiyun mutex_lock(&dmxdev->mutex);
1467*4882a593Smuzhiyun dmxdev->exit = 1;
1468*4882a593Smuzhiyun mutex_unlock(&dmxdev->mutex);
1469*4882a593Smuzhiyun
1470*4882a593Smuzhiyun if (dmxdev->dvbdev->users > 1) {
1471*4882a593Smuzhiyun wait_event(dmxdev->dvbdev->wait_queue,
1472*4882a593Smuzhiyun dmxdev->dvbdev->users == 1);
1473*4882a593Smuzhiyun }
1474*4882a593Smuzhiyun if (dmxdev->dvr_dvbdev->users > 1) {
1475*4882a593Smuzhiyun wait_event(dmxdev->dvr_dvbdev->wait_queue,
1476*4882a593Smuzhiyun dmxdev->dvr_dvbdev->users == 1);
1477*4882a593Smuzhiyun }
1478*4882a593Smuzhiyun
1479*4882a593Smuzhiyun dvb_unregister_device(dmxdev->dvbdev);
1480*4882a593Smuzhiyun dvb_unregister_device(dmxdev->dvr_dvbdev);
1481*4882a593Smuzhiyun
1482*4882a593Smuzhiyun vfree(dmxdev->filter);
1483*4882a593Smuzhiyun dmxdev->filter = NULL;
1484*4882a593Smuzhiyun dmxdev->demux->close(dmxdev->demux);
1485*4882a593Smuzhiyun }
1486*4882a593Smuzhiyun
1487*4882a593Smuzhiyun EXPORT_SYMBOL(dvb_dmxdev_release);
1488