blob: d87b69b86a59a8c7655fb287acf9d899a5b8cdbf [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * dmxdev.c - DVB demultiplexer device
3 *
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03004 * Copyright (C) 2000 Ralph Metzler & Marcus Metzler
5 * for convergence integrated media GmbH
Linus Torvalds1da177e2005-04-16 15:20:36 -07006 *
7 * This program is free software; you can redistribute it and/or
8 * modify it under the terms of the GNU Lesser General Public License
9 * as published by the Free Software Foundation; either version 2.1
10 * of the License, or (at your option) any later version.
11 *
12 * This program is distributed in the hope that it will be useful,
13 * but WITHOUT ANY WARRANTY; without even the implied warranty of
14 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
15 * GNU General Public License for more details.
16 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070017 */
18
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -030019#define pr_fmt(fmt) "dmxdev: " fmt
20
Alexey Dobriyana99bbaf2009-10-04 16:11:37 +040021#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070022#include <linux/spinlock.h>
23#include <linux/slab.h>
24#include <linux/vmalloc.h>
25#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070026#include <linux/poll.h>
27#include <linux/ioctl.h>
28#include <linux/wait.h>
Linus Torvalds7c0f6ba2016-12-24 11:46:01 -080029#include <linux/uaccess.h>
Mauro Carvalho Chehabfada1932017-12-28 13:03:51 -050030#include <media/dmxdev.h>
31#include <media/dvb_vb2.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070032
33static int debug;
34
35module_param(debug, int, 0644);
36MODULE_PARM_DESC(debug, "Turn on/off debugging (default:off).");
37
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -030038#define dprintk(fmt, arg...) do { \
39 if (debug) \
40 printk(KERN_DEBUG pr_fmt("%s: " fmt), \
41 __func__, ##arg); \
42} while (0)
Linus Torvalds1da177e2005-04-16 15:20:36 -070043
Andreas Oberritter34731df2006-03-14 17:31:01 -030044static int dvb_dmxdev_buffer_write(struct dvb_ringbuffer *buf,
45 const u8 *src, size_t len)
Linus Torvalds1da177e2005-04-16 15:20:36 -070046{
Andreas Oberritter34731df2006-03-14 17:31:01 -030047 ssize_t free;
Linus Torvalds1da177e2005-04-16 15:20:36 -070048
49 if (!len)
50 return 0;
51 if (!buf->data)
52 return 0;
53
Andreas Oberritter34731df2006-03-14 17:31:01 -030054 free = dvb_ringbuffer_free(buf);
55 if (len > free) {
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -030056 dprintk("buffer overflow\n");
Andreas Oberritter34731df2006-03-14 17:31:01 -030057 return -EOVERFLOW;
Linus Torvalds1da177e2005-04-16 15:20:36 -070058 }
Andreas Oberritter34731df2006-03-14 17:31:01 -030059
60 return dvb_ringbuffer_write(buf, src, len);
Linus Torvalds1da177e2005-04-16 15:20:36 -070061}
62
Andreas Oberritter34731df2006-03-14 17:31:01 -030063static ssize_t dvb_dmxdev_buffer_read(struct dvb_ringbuffer *src,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -030064 int non_blocking, char __user *buf,
65 size_t count, loff_t *ppos)
Linus Torvalds1da177e2005-04-16 15:20:36 -070066{
Andreas Oberritter34731df2006-03-14 17:31:01 -030067 size_t todo;
68 ssize_t avail;
69 ssize_t ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070070
71 if (!src->data)
72 return 0;
73
Andreas Oberritter34731df2006-03-14 17:31:01 -030074 if (src->error) {
75 ret = src->error;
76 dvb_ringbuffer_flush(src);
77 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 }
79
Andreas Oberritter34731df2006-03-14 17:31:01 -030080 for (todo = count; todo > 0; todo -= ret) {
81 if (non_blocking && dvb_ringbuffer_empty(src)) {
82 ret = -EWOULDBLOCK;
83 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -070084 }
85
Andreas Oberritter34731df2006-03-14 17:31:01 -030086 ret = wait_event_interruptible(src->queue,
87 !dvb_ringbuffer_empty(src) ||
88 (src->error != 0));
89 if (ret < 0)
90 break;
91
92 if (src->error) {
93 ret = src->error;
94 dvb_ringbuffer_flush(src);
95 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -070096 }
Andreas Oberritter34731df2006-03-14 17:31:01 -030097
98 avail = dvb_ringbuffer_avail(src);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -030099 if (avail > todo)
100 avail = todo;
Andreas Oberritter34731df2006-03-14 17:31:01 -0300101
Al Virob0ba0e32008-06-22 14:20:29 -0300102 ret = dvb_ringbuffer_read_user(src, buf, avail);
Andreas Oberritter34731df2006-03-14 17:31:01 -0300103 if (ret < 0)
104 break;
105
106 buf += ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700107 }
Andreas Oberritter34731df2006-03-14 17:31:01 -0300108
109 return (count - todo) ? (count - todo) : ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700110}
111
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300112static struct dmx_frontend *get_fe(struct dmx_demux *demux, int type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700113{
114 struct list_head *head, *pos;
115
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300116 head = demux->get_frontends(demux);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700117 if (!head)
118 return NULL;
119 list_for_each(pos, head)
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300120 if (DMX_FE_ENTRY(pos)->source == type)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700121 return DMX_FE_ENTRY(pos);
122
123 return NULL;
124}
125
Linus Torvalds1da177e2005-04-16 15:20:36 -0700126static int dvb_dvr_open(struct inode *inode, struct file *file)
127{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -0700128 struct dvb_device *dvbdev = file->private_data;
129 struct dmxdev *dmxdev = dvbdev->priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700130 struct dmx_frontend *front;
Arnd Bergmannec5b1002018-01-04 05:31:30 -0500131#ifndef CONFIG_DVB_MMAP
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500132 bool need_ringbuffer = false;
133#else
134 const bool need_ringbuffer = true;
135#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700136
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -0300137 dprintk("%s\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700138
Ingo Molnar3593cab2006-02-07 06:49:14 -0200139 if (mutex_lock_interruptible(&dmxdev->mutex))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700140 return -ERESTARTSYS;
141
Markus Rechberger57861b42007-04-14 10:19:18 -0300142 if (dmxdev->exit) {
143 mutex_unlock(&dmxdev->mutex);
144 return -ENODEV;
145 }
146
Arnd Bergmannec5b1002018-01-04 05:31:30 -0500147#ifndef CONFIG_DVB_MMAP
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500148 if ((file->f_flags & O_ACCMODE) == O_RDONLY)
149 need_ringbuffer = true;
150#else
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300151 if ((file->f_flags & O_ACCMODE) == O_RDWR) {
152 if (!(dmxdev->capabilities & DMXDEV_CAP_DUPLEX)) {
Ingo Molnar3593cab2006-02-07 06:49:14 -0200153 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700154 return -EOPNOTSUPP;
155 }
156 }
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500157#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700158
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500159 if (need_ringbuffer) {
Trent Piepho5e85bd02006-03-30 15:53:32 -0300160 void *mem;
devendra sharmae90bbac2016-12-18 11:52:55 -0200161
Trent Piepho5e85bd02006-03-30 15:53:32 -0300162 if (!dvbdev->readers) {
163 mutex_unlock(&dmxdev->mutex);
164 return -EBUSY;
165 }
166 mem = vmalloc(DVR_BUFFER_SIZE);
Andreas Oberritter34731df2006-03-14 17:31:01 -0300167 if (!mem) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300168 mutex_unlock(&dmxdev->mutex);
169 return -ENOMEM;
170 }
Andreas Oberritter34731df2006-03-14 17:31:01 -0300171 dvb_ringbuffer_init(&dmxdev->dvr_buffer, mem, DVR_BUFFER_SIZE);
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500172 dvb_vb2_init(&dmxdev->dvr_vb2_ctx, "dvr",
173 file->f_flags & O_NONBLOCK);
Trent Piepho5e85bd02006-03-30 15:53:32 -0300174 dvbdev->readers--;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700175 }
176
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300177 if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
178 dmxdev->dvr_orig_fe = dmxdev->demux->frontend;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700179
180 if (!dmxdev->demux->write) {
Ingo Molnar3593cab2006-02-07 06:49:14 -0200181 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700182 return -EOPNOTSUPP;
183 }
184
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300185 front = get_fe(dmxdev->demux, DMX_MEMORY_FE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186
187 if (!front) {
Ingo Molnar3593cab2006-02-07 06:49:14 -0200188 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 return -EINVAL;
190 }
191 dmxdev->demux->disconnect_frontend(dmxdev->demux);
192 dmxdev->demux->connect_frontend(dmxdev->demux, front);
193 }
Markus Rechberger57861b42007-04-14 10:19:18 -0300194 dvbdev->users++;
Ingo Molnar3593cab2006-02-07 06:49:14 -0200195 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700196 return 0;
197}
198
199static int dvb_dvr_release(struct inode *inode, struct file *file)
200{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -0700201 struct dvb_device *dvbdev = file->private_data;
202 struct dmxdev *dmxdev = dvbdev->priv;
Arnd Bergmannec5b1002018-01-04 05:31:30 -0500203#ifndef CONFIG_DVB_MMAP
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500204 bool need_ringbuffer = false;
205#else
206 const bool need_ringbuffer = true;
207#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700208
Simon Arlottc2788502007-03-10 06:21:25 -0300209 mutex_lock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300211 if ((file->f_flags & O_ACCMODE) == O_WRONLY) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700212 dmxdev->demux->disconnect_frontend(dmxdev->demux);
213 dmxdev->demux->connect_frontend(dmxdev->demux,
214 dmxdev->dvr_orig_fe);
215 }
Arnd Bergmannec5b1002018-01-04 05:31:30 -0500216#ifndef CONFIG_DVB_MMAP
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500217 if ((file->f_flags & O_ACCMODE) == O_RDONLY)
218 need_ringbuffer = true;
219#endif
220
221 if (need_ringbuffer) {
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500222 if (dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx))
223 dvb_vb2_stream_off(&dmxdev->dvr_vb2_ctx);
224 dvb_vb2_release(&dmxdev->dvr_vb2_ctx);
Trent Piepho5e85bd02006-03-30 15:53:32 -0300225 dvbdev->readers++;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700226 if (dmxdev->dvr_buffer.data) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300227 void *mem = dmxdev->dvr_buffer.data;
devendra sharmae90bbac2016-12-18 11:52:55 -0200228 /*memory barrier*/
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229 mb();
230 spin_lock_irq(&dmxdev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300231 dmxdev->dvr_buffer.data = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700232 spin_unlock_irq(&dmxdev->lock);
233 vfree(mem);
234 }
235 }
Markus Rechberger57861b42007-04-14 10:19:18 -0300236 /* TODO */
237 dvbdev->users--;
Jiri Slaby1c488ea2010-07-18 15:34:18 -0300238 if (dvbdev->users == 1 && dmxdev->exit == 1) {
Markus Rechberger57861b42007-04-14 10:19:18 -0300239 mutex_unlock(&dmxdev->mutex);
240 wake_up(&dvbdev->wait_queue);
241 } else
242 mutex_unlock(&dmxdev->mutex);
243
Linus Torvalds1da177e2005-04-16 15:20:36 -0700244 return 0;
245}
246
247static ssize_t dvb_dvr_write(struct file *file, const char __user *buf,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300248 size_t count, loff_t *ppos)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700249{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -0700250 struct dvb_device *dvbdev = file->private_data;
251 struct dmxdev *dmxdev = dvbdev->priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 int ret;
253
254 if (!dmxdev->demux->write)
255 return -EOPNOTSUPP;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300256 if ((file->f_flags & O_ACCMODE) != O_WRONLY)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257 return -EINVAL;
Ingo Molnar3593cab2006-02-07 06:49:14 -0200258 if (mutex_lock_interruptible(&dmxdev->mutex))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700259 return -ERESTARTSYS;
Markus Rechberger57861b42007-04-14 10:19:18 -0300260
261 if (dmxdev->exit) {
262 mutex_unlock(&dmxdev->mutex);
263 return -ENODEV;
264 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300265 ret = dmxdev->demux->write(dmxdev->demux, buf, count);
Ingo Molnar3593cab2006-02-07 06:49:14 -0200266 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700267 return ret;
268}
269
270static ssize_t dvb_dvr_read(struct file *file, char __user *buf, size_t count,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300271 loff_t *ppos)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -0700273 struct dvb_device *dvbdev = file->private_data;
274 struct dmxdev *dmxdev = dvbdev->priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275
Simon Arlotteda9f752009-05-12 17:39:28 -0300276 if (dmxdev->exit)
Markus Rechberger57861b42007-04-14 10:19:18 -0300277 return -ENODEV;
Markus Rechberger57861b42007-04-14 10:19:18 -0300278
Simon Arlotteda9f752009-05-12 17:39:28 -0300279 return dvb_dmxdev_buffer_read(&dmxdev->dvr_buffer,
280 file->f_flags & O_NONBLOCK,
281 buf, count, ppos);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700282}
283
Andrea Odettia095be42008-04-20 19:14:51 -0300284static int dvb_dvr_set_buffer_size(struct dmxdev *dmxdev,
285 unsigned long size)
286{
287 struct dvb_ringbuffer *buf = &dmxdev->dvr_buffer;
288 void *newmem;
289 void *oldmem;
290
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -0300291 dprintk("%s\n", __func__);
Andrea Odettia095be42008-04-20 19:14:51 -0300292
293 if (buf->size == size)
294 return 0;
295 if (!size)
296 return -EINVAL;
297
298 newmem = vmalloc(size);
299 if (!newmem)
300 return -ENOMEM;
301
302 oldmem = buf->data;
303
304 spin_lock_irq(&dmxdev->lock);
305 buf->data = newmem;
306 buf->size = size;
307
308 /* reset and not flush in case the buffer shrinks */
309 dvb_ringbuffer_reset(buf);
310 spin_unlock_irq(&dmxdev->lock);
311
312 vfree(oldmem);
313
314 return 0;
315}
316
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300317static inline void dvb_dmxdev_filter_state_set(struct dmxdev_filter
318 *dmxdevfilter, int state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700319{
320 spin_lock_irq(&dmxdevfilter->dev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300321 dmxdevfilter->state = state;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 spin_unlock_irq(&dmxdevfilter->dev->lock);
323}
324
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300325static int dvb_dmxdev_set_buffer_size(struct dmxdev_filter *dmxdevfilter,
326 unsigned long size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700327{
Andreas Oberritter34731df2006-03-14 17:31:01 -0300328 struct dvb_ringbuffer *buf = &dmxdevfilter->buffer;
Andrea Odettia095be42008-04-20 19:14:51 -0300329 void *newmem;
330 void *oldmem;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700331
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300332 if (buf->size == size)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700333 return 0;
Andrea Odettia095be42008-04-20 19:14:51 -0300334 if (!size)
335 return -EINVAL;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300336 if (dmxdevfilter->state >= DMXDEV_STATE_GO)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700337 return -EBUSY;
Andrea Odettia095be42008-04-20 19:14:51 -0300338
339 newmem = vmalloc(size);
340 if (!newmem)
341 return -ENOMEM;
342
343 oldmem = buf->data;
344
Linus Torvalds1da177e2005-04-16 15:20:36 -0700345 spin_lock_irq(&dmxdevfilter->dev->lock);
Andrea Odettia095be42008-04-20 19:14:51 -0300346 buf->data = newmem;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300347 buf->size = size;
Andrea Odetti48c01a92008-04-20 18:37:45 -0300348
349 /* reset and not flush in case the buffer shrinks */
350 dvb_ringbuffer_reset(buf);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700351 spin_unlock_irq(&dmxdevfilter->dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352
Andrea Odettia095be42008-04-20 19:14:51 -0300353 vfree(oldmem);
354
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355 return 0;
356}
357
Kees Cooke7e0e2c2017-10-16 19:10:47 -0400358static void dvb_dmxdev_filter_timeout(struct timer_list *t)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700359{
Kees Cooke7e0e2c2017-10-16 19:10:47 -0400360 struct dmxdev_filter *dmxdevfilter = from_timer(dmxdevfilter, t, timer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700361
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300362 dmxdevfilter->buffer.error = -ETIMEDOUT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 spin_lock_irq(&dmxdevfilter->dev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300364 dmxdevfilter->state = DMXDEV_STATE_TIMEDOUT;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700365 spin_unlock_irq(&dmxdevfilter->dev->lock);
366 wake_up(&dmxdevfilter->buffer.queue);
367}
368
369static void dvb_dmxdev_filter_timer(struct dmxdev_filter *dmxdevfilter)
370{
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300371 struct dmx_sct_filter_params *para = &dmxdevfilter->params.sec;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700372
373 del_timer(&dmxdevfilter->timer);
374 if (para->timeout) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300375 dmxdevfilter->timer.expires =
376 jiffies + 1 + (HZ / 2 + HZ * para->timeout) / 1000;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700377 add_timer(&dmxdevfilter->timer);
378 }
379}
380
381static int dvb_dmxdev_section_callback(const u8 *buffer1, size_t buffer1_len,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300382 const u8 *buffer2, size_t buffer2_len,
Mauro Carvalho Chehab2f684b22015-10-06 19:53:02 -0300383 struct dmx_section_filter *filter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -0700385 struct dmxdev_filter *dmxdevfilter = filter->priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700386 int ret;
387
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500388 if (!dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx) &&
389 dmxdevfilter->buffer.error) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700390 wake_up(&dmxdevfilter->buffer.queue);
391 return 0;
392 }
Mauro Carvalho Chehab28100162009-02-16 15:27:44 -0300393 spin_lock(&dmxdevfilter->dev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300394 if (dmxdevfilter->state != DMXDEV_STATE_GO) {
Mauro Carvalho Chehab28100162009-02-16 15:27:44 -0300395 spin_unlock(&dmxdevfilter->dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396 return 0;
397 }
398 del_timer(&dmxdevfilter->timer);
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -0300399 dprintk("section callback %*ph\n", 6, buffer1);
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500400 if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx)) {
401 ret = dvb_vb2_fill_buffer(&dmxdevfilter->vb2_ctx,
402 buffer1, buffer1_len);
403 if (ret == buffer1_len)
404 ret = dvb_vb2_fill_buffer(&dmxdevfilter->vb2_ctx,
405 buffer2, buffer2_len);
406 } else {
407 ret = dvb_dmxdev_buffer_write(&dmxdevfilter->buffer,
408 buffer1, buffer1_len);
409 if (ret == buffer1_len) {
410 ret = dvb_dmxdev_buffer_write(&dmxdevfilter->buffer,
411 buffer2, buffer2_len);
412 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700413 }
Soeren Moch414abbd2013-06-05 21:26:23 -0300414 if (ret < 0)
Andreas Oberritter34731df2006-03-14 17:31:01 -0300415 dmxdevfilter->buffer.error = ret;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300416 if (dmxdevfilter->params.sec.flags & DMX_ONESHOT)
417 dmxdevfilter->state = DMXDEV_STATE_DONE;
Mauro Carvalho Chehab28100162009-02-16 15:27:44 -0300418 spin_unlock(&dmxdevfilter->dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700419 wake_up(&dmxdevfilter->buffer.queue);
420 return 0;
421}
422
423static int dvb_dmxdev_ts_callback(const u8 *buffer1, size_t buffer1_len,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300424 const u8 *buffer2, size_t buffer2_len,
Mauro Carvalho Chehab2f684b22015-10-06 19:53:02 -0300425 struct dmx_ts_feed *feed)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700426{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -0700427 struct dmxdev_filter *dmxdevfilter = feed->priv;
Andreas Oberritter34731df2006-03-14 17:31:01 -0300428 struct dvb_ringbuffer *buffer;
Arnd Bergmannec5b1002018-01-04 05:31:30 -0500429#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500430 struct dvb_vb2_ctx *ctx;
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500431#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700432 int ret;
433
Mauro Carvalho Chehab28100162009-02-16 15:27:44 -0300434 spin_lock(&dmxdevfilter->dev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300435 if (dmxdevfilter->params.pes.output == DMX_OUT_DECODER) {
Mauro Carvalho Chehab28100162009-02-16 15:27:44 -0300436 spin_unlock(&dmxdevfilter->dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700437 return 0;
438 }
439
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500440 if (dmxdevfilter->params.pes.output == DMX_OUT_TAP ||
441 dmxdevfilter->params.pes.output == DMX_OUT_TSDEMUX_TAP) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300442 buffer = &dmxdevfilter->buffer;
Arnd Bergmannec5b1002018-01-04 05:31:30 -0500443#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500444 ctx = &dmxdevfilter->vb2_ctx;
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500445#endif
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500446 } else {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300447 buffer = &dmxdevfilter->dev->dvr_buffer;
Arnd Bergmannec5b1002018-01-04 05:31:30 -0500448#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500449 ctx = &dmxdevfilter->dev->dvr_vb2_ctx;
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -0500450#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 }
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500452
453 if (dvb_vb2_is_streaming(ctx)) {
454 ret = dvb_vb2_fill_buffer(ctx, buffer1, buffer1_len);
455 if (ret == buffer1_len)
456 ret = dvb_vb2_fill_buffer(ctx, buffer2, buffer2_len);
457 } else {
458 if (buffer->error) {
459 spin_unlock(&dmxdevfilter->dev->lock);
460 wake_up(&buffer->queue);
461 return 0;
462 }
463 ret = dvb_dmxdev_buffer_write(buffer, buffer1, buffer1_len);
464 if (ret == buffer1_len)
465 ret = dvb_dmxdev_buffer_write(buffer,
466 buffer2, buffer2_len);
467 }
Soeren Moch414abbd2013-06-05 21:26:23 -0300468 if (ret < 0)
Andreas Oberritter34731df2006-03-14 17:31:01 -0300469 buffer->error = ret;
Mauro Carvalho Chehab28100162009-02-16 15:27:44 -0300470 spin_unlock(&dmxdevfilter->dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700471 wake_up(&buffer->queue);
472 return 0;
473}
474
Linus Torvalds1da177e2005-04-16 15:20:36 -0700475/* stop feed but only mark the specified filter as stopped (state set) */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700476static int dvb_dmxdev_feed_stop(struct dmxdev_filter *dmxdevfilter)
477{
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300478 struct dmxdev_feed *feed;
479
Linus Torvalds1da177e2005-04-16 15:20:36 -0700480 dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET);
481
482 switch (dmxdevfilter->type) {
483 case DMXDEV_TYPE_SEC:
484 del_timer(&dmxdevfilter->timer);
485 dmxdevfilter->feed.sec->stop_filtering(dmxdevfilter->feed.sec);
486 break;
487 case DMXDEV_TYPE_PES:
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300488 list_for_each_entry(feed, &dmxdevfilter->feed.ts, next)
489 feed->ts->stop_filtering(feed->ts);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700490 break;
491 default:
492 return -EINVAL;
493 }
494 return 0;
495}
496
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497/* start feed associated with the specified filter */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700498static int dvb_dmxdev_feed_start(struct dmxdev_filter *filter)
499{
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300500 struct dmxdev_feed *feed;
501 int ret;
502
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300503 dvb_dmxdev_filter_state_set(filter, DMXDEV_STATE_GO);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700504
505 switch (filter->type) {
506 case DMXDEV_TYPE_SEC:
507 return filter->feed.sec->start_filtering(filter->feed.sec);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700508 case DMXDEV_TYPE_PES:
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300509 list_for_each_entry(feed, &filter->feed.ts, next) {
510 ret = feed->ts->start_filtering(feed->ts);
511 if (ret < 0) {
512 dvb_dmxdev_feed_stop(filter);
513 return ret;
514 }
515 }
516 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700517 default:
518 return -EINVAL;
519 }
520
521 return 0;
522}
523
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524/* restart section feed if it has filters left associated with it,
525 otherwise release the feed */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700526static int dvb_dmxdev_feed_restart(struct dmxdev_filter *filter)
527{
528 int i;
529 struct dmxdev *dmxdev = filter->dev;
530 u16 pid = filter->params.sec.pid;
531
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300532 for (i = 0; i < dmxdev->filternum; i++)
533 if (dmxdev->filter[i].state >= DMXDEV_STATE_GO &&
534 dmxdev->filter[i].type == DMXDEV_TYPE_SEC &&
535 dmxdev->filter[i].params.sec.pid == pid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536 dvb_dmxdev_feed_start(&dmxdev->filter[i]);
537 return 0;
538 }
539
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300540 filter->dev->demux->release_section_feed(dmxdev->demux,
541 filter->feed.sec);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542
543 return 0;
544}
545
546static int dvb_dmxdev_filter_stop(struct dmxdev_filter *dmxdevfilter)
547{
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300548 struct dmxdev_feed *feed;
549 struct dmx_demux *demux;
550
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300551 if (dmxdevfilter->state < DMXDEV_STATE_GO)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552 return 0;
553
554 switch (dmxdevfilter->type) {
555 case DMXDEV_TYPE_SEC:
556 if (!dmxdevfilter->feed.sec)
557 break;
558 dvb_dmxdev_feed_stop(dmxdevfilter);
559 if (dmxdevfilter->filter.sec)
560 dmxdevfilter->feed.sec->
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300561 release_filter(dmxdevfilter->feed.sec,
562 dmxdevfilter->filter.sec);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700563 dvb_dmxdev_feed_restart(dmxdevfilter);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300564 dmxdevfilter->feed.sec = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700565 break;
566 case DMXDEV_TYPE_PES:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700567 dvb_dmxdev_feed_stop(dmxdevfilter);
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300568 demux = dmxdevfilter->dev->demux;
569 list_for_each_entry(feed, &dmxdevfilter->feed.ts, next) {
570 demux->release_ts_feed(demux, feed->ts);
571 feed->ts = NULL;
572 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573 break;
574 default:
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300575 if (dmxdevfilter->state == DMXDEV_STATE_ALLOCATED)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700576 return 0;
577 return -EINVAL;
578 }
Andreas Oberritter34731df2006-03-14 17:31:01 -0300579
580 dvb_ringbuffer_flush(&dmxdevfilter->buffer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700581 return 0;
582}
583
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300584static void dvb_dmxdev_delete_pids(struct dmxdev_filter *dmxdevfilter)
585{
586 struct dmxdev_feed *feed, *tmp;
587
588 /* delete all PIDs */
589 list_for_each_entry_safe(feed, tmp, &dmxdevfilter->feed.ts, next) {
590 list_del(&feed->next);
591 kfree(feed);
592 }
593
594 BUG_ON(!list_empty(&dmxdevfilter->feed.ts));
595}
596
Linus Torvalds1da177e2005-04-16 15:20:36 -0700597static inline int dvb_dmxdev_filter_reset(struct dmxdev_filter *dmxdevfilter)
598{
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300599 if (dmxdevfilter->state < DMXDEV_STATE_SET)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700600 return 0;
601
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300602 if (dmxdevfilter->type == DMXDEV_TYPE_PES)
603 dvb_dmxdev_delete_pids(dmxdevfilter);
604
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300605 dmxdevfilter->type = DMXDEV_TYPE_NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700606 dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_ALLOCATED);
607 return 0;
608}
609
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300610static int dvb_dmxdev_start_feed(struct dmxdev *dmxdev,
611 struct dmxdev_filter *filter,
612 struct dmxdev_feed *feed)
613{
Thomas Gleixner8b0e1952016-12-25 12:30:41 +0100614 ktime_t timeout = 0;
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300615 struct dmx_pes_filter_params *para = &filter->params.pes;
Mauro Carvalho Chehab3256b362017-09-01 06:09:14 -0400616 enum dmx_output otype;
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300617 int ret;
618 int ts_type;
Mauro Carvalho Chehabfde04ab2013-04-04 13:25:30 -0300619 enum dmx_ts_pes ts_pes;
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300620 struct dmx_ts_feed *tsfeed;
621
622 feed->ts = NULL;
623 otype = para->output;
624
Mauro Carvalho Chehab9ae2ae32010-12-27 11:41:14 -0300625 ts_pes = para->pes_type;
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300626
627 if (ts_pes < DMX_PES_OTHER)
628 ts_type = TS_DECODER;
629 else
630 ts_type = 0;
631
632 if (otype == DMX_OUT_TS_TAP)
633 ts_type |= TS_PACKET;
634 else if (otype == DMX_OUT_TSDEMUX_TAP)
635 ts_type |= TS_PACKET | TS_DEMUX;
636 else if (otype == DMX_OUT_TAP)
637 ts_type |= TS_PACKET | TS_DEMUX | TS_PAYLOAD_ONLY;
638
639 ret = dmxdev->demux->allocate_ts_feed(dmxdev->demux, &feed->ts,
640 dvb_dmxdev_ts_callback);
641 if (ret < 0)
642 return ret;
643
644 tsfeed = feed->ts;
645 tsfeed->priv = filter;
646
Mauro Carvalho Chehabdd79d272016-10-13 07:14:38 -0300647 ret = tsfeed->set(tsfeed, feed->pid, ts_type, ts_pes, timeout);
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300648 if (ret < 0) {
649 dmxdev->demux->release_ts_feed(dmxdev->demux, tsfeed);
650 return ret;
651 }
652
653 ret = tsfeed->start_filtering(tsfeed);
654 if (ret < 0) {
655 dmxdev->demux->release_ts_feed(dmxdev->demux, tsfeed);
656 return ret;
657 }
658
659 return 0;
660}
661
Linus Torvalds1da177e2005-04-16 15:20:36 -0700662static int dvb_dmxdev_filter_start(struct dmxdev_filter *filter)
663{
664 struct dmxdev *dmxdev = filter->dev;
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300665 struct dmxdev_feed *feed;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700666 void *mem;
667 int ret, i;
668
669 if (filter->state < DMXDEV_STATE_SET)
670 return -EINVAL;
671
672 if (filter->state >= DMXDEV_STATE_GO)
673 dvb_dmxdev_filter_stop(filter);
674
Andreas Oberritter34731df2006-03-14 17:31:01 -0300675 if (!filter->buffer.data) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700676 mem = vmalloc(filter->buffer.size);
Andreas Oberritter34731df2006-03-14 17:31:01 -0300677 if (!mem)
678 return -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700679 spin_lock_irq(&filter->dev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300680 filter->buffer.data = mem;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700681 spin_unlock_irq(&filter->dev->lock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682 }
683
Andreas Oberritter34731df2006-03-14 17:31:01 -0300684 dvb_ringbuffer_flush(&filter->buffer);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700685
686 switch (filter->type) {
687 case DMXDEV_TYPE_SEC:
688 {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300689 struct dmx_sct_filter_params *para = &filter->params.sec;
690 struct dmx_section_filter **secfilter = &filter->filter.sec;
691 struct dmx_section_feed **secfeed = &filter->feed.sec;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700692
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300693 *secfilter = NULL;
694 *secfeed = NULL;
695
Linus Torvalds1da177e2005-04-16 15:20:36 -0700696
697 /* find active filter/feed with same PID */
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300698 for (i = 0; i < dmxdev->filternum; i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700699 if (dmxdev->filter[i].state >= DMXDEV_STATE_GO &&
Andreas Oberritter09794a62006-03-10 15:21:28 -0300700 dmxdev->filter[i].type == DMXDEV_TYPE_SEC &&
701 dmxdev->filter[i].params.sec.pid == para->pid) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702 *secfeed = dmxdev->filter[i].feed.sec;
703 break;
704 }
705 }
706
707 /* if no feed found, try to allocate new one */
708 if (!*secfeed) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300709 ret = dmxdev->demux->allocate_section_feed(dmxdev->demux,
710 secfeed,
711 dvb_dmxdev_section_callback);
712 if (ret < 0) {
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -0300713 pr_err("DVB (%s): could not alloc feed\n",
Harvey Harrison46b4f7c2008-04-08 23:20:00 -0300714 __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700715 return ret;
716 }
717
Mauro Carvalho Chehabdd79d272016-10-13 07:14:38 -0300718 ret = (*secfeed)->set(*secfeed, para->pid,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300719 (para->flags & DMX_CHECK_CRC) ? 1 : 0);
720 if (ret < 0) {
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -0300721 pr_err("DVB (%s): could not set feed\n",
Harvey Harrison46b4f7c2008-04-08 23:20:00 -0300722 __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700723 dvb_dmxdev_feed_restart(filter);
724 return ret;
725 }
726 } else {
727 dvb_dmxdev_feed_stop(filter);
728 }
729
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300730 ret = (*secfeed)->allocate_filter(*secfeed, secfilter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700731 if (ret < 0) {
732 dvb_dmxdev_feed_restart(filter);
733 filter->feed.sec->start_filtering(*secfeed);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300734 dprintk("could not get filter\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700735 return ret;
736 }
737
738 (*secfilter)->priv = filter;
739
740 memcpy(&((*secfilter)->filter_value[3]),
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300741 &(para->filter.filter[1]), DMX_FILTER_SIZE - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700742 memcpy(&(*secfilter)->filter_mask[3],
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300743 &para->filter.mask[1], DMX_FILTER_SIZE - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700744 memcpy(&(*secfilter)->filter_mode[3],
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300745 &para->filter.mode[1], DMX_FILTER_SIZE - 1);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700746
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300747 (*secfilter)->filter_value[0] = para->filter.filter[0];
748 (*secfilter)->filter_mask[0] = para->filter.mask[0];
749 (*secfilter)->filter_mode[0] = para->filter.mode[0];
750 (*secfilter)->filter_mask[1] = 0;
751 (*secfilter)->filter_mask[2] = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700752
753 filter->todo = 0;
754
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300755 ret = filter->feed.sec->start_filtering(filter->feed.sec);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700756 if (ret < 0)
757 return ret;
758
759 dvb_dmxdev_filter_timer(filter);
760 break;
761 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 case DMXDEV_TYPE_PES:
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300763 list_for_each_entry(feed, &filter->feed.ts, next) {
764 ret = dvb_dmxdev_start_feed(dmxdev, filter, feed);
765 if (ret < 0) {
766 dvb_dmxdev_filter_stop(filter);
767 return ret;
768 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700769 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700770 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700771 default:
772 return -EINVAL;
773 }
774
775 dvb_dmxdev_filter_state_set(filter, DMXDEV_STATE_GO);
776 return 0;
777}
778
779static int dvb_demux_open(struct inode *inode, struct file *file)
780{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -0700781 struct dvb_device *dvbdev = file->private_data;
782 struct dmxdev *dmxdev = dvbdev->priv;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700783 int i;
784 struct dmxdev_filter *dmxdevfilter;
785
786 if (!dmxdev->filter)
787 return -EINVAL;
788
Ingo Molnar3593cab2006-02-07 06:49:14 -0200789 if (mutex_lock_interruptible(&dmxdev->mutex))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700790 return -ERESTARTSYS;
791
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300792 for (i = 0; i < dmxdev->filternum; i++)
793 if (dmxdev->filter[i].state == DMXDEV_STATE_FREE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700794 break;
795
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300796 if (i == dmxdev->filternum) {
Ingo Molnar3593cab2006-02-07 06:49:14 -0200797 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700798 return -EMFILE;
799 }
800
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300801 dmxdevfilter = &dmxdev->filter[i];
Ingo Molnar3593cab2006-02-07 06:49:14 -0200802 mutex_init(&dmxdevfilter->mutex);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300803 file->private_data = dmxdevfilter;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700804
Andreas Oberritter34731df2006-03-14 17:31:01 -0300805 dvb_ringbuffer_init(&dmxdevfilter->buffer, NULL, 8192);
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500806 dvb_vb2_init(&dmxdevfilter->vb2_ctx, "demux_filter",
807 file->f_flags & O_NONBLOCK);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300808 dmxdevfilter->type = DMXDEV_TYPE_NONE;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700809 dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_ALLOCATED);
Kees Cooke7e0e2c2017-10-16 19:10:47 -0400810 timer_setup(&dmxdevfilter->timer, dvb_dmxdev_filter_timeout, 0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700811
Markus Rechberger57861b42007-04-14 10:19:18 -0300812 dvbdev->users++;
813
Ingo Molnar3593cab2006-02-07 06:49:14 -0200814 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700815 return 0;
816}
817
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300818static int dvb_dmxdev_filter_free(struct dmxdev *dmxdev,
819 struct dmxdev_filter *dmxdevfilter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700820{
Simon Arlottc2788502007-03-10 06:21:25 -0300821 mutex_lock(&dmxdev->mutex);
822 mutex_lock(&dmxdevfilter->mutex);
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -0500823 if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx))
824 dvb_vb2_stream_off(&dmxdevfilter->vb2_ctx);
825 dvb_vb2_release(&dmxdevfilter->vb2_ctx);
826
Linus Torvalds1da177e2005-04-16 15:20:36 -0700827
828 dvb_dmxdev_filter_stop(dmxdevfilter);
829 dvb_dmxdev_filter_reset(dmxdevfilter);
830
831 if (dmxdevfilter->buffer.data) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300832 void *mem = dmxdevfilter->buffer.data;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700833
834 spin_lock_irq(&dmxdev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300835 dmxdevfilter->buffer.data = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700836 spin_unlock_irq(&dmxdev->lock);
837 vfree(mem);
838 }
839
840 dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_FREE);
841 wake_up(&dmxdevfilter->buffer.queue);
Ingo Molnar3593cab2006-02-07 06:49:14 -0200842 mutex_unlock(&dmxdevfilter->mutex);
843 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700844 return 0;
845}
846
Mauro Carvalho Chehab3256b362017-09-01 06:09:14 -0400847static inline void invert_mode(struct dmx_filter *filter)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700848{
849 int i;
850
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300851 for (i = 0; i < DMX_FILTER_SIZE; i++)
852 filter->mode[i] ^= 0xff;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700853}
854
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300855static int dvb_dmxdev_add_pid(struct dmxdev *dmxdev,
856 struct dmxdev_filter *filter, u16 pid)
857{
858 struct dmxdev_feed *feed;
859
860 if ((filter->type != DMXDEV_TYPE_PES) ||
861 (filter->state < DMXDEV_STATE_SET))
862 return -EINVAL;
863
864 /* only TS packet filters may have multiple PIDs */
865 if ((filter->params.pes.output != DMX_OUT_TSDEMUX_TAP) &&
866 (!list_empty(&filter->feed.ts)))
867 return -EINVAL;
868
869 feed = kzalloc(sizeof(struct dmxdev_feed), GFP_KERNEL);
870 if (feed == NULL)
871 return -ENOMEM;
872
873 feed->pid = pid;
874 list_add(&feed->next, &filter->feed.ts);
875
876 if (filter->state >= DMXDEV_STATE_GO)
877 return dvb_dmxdev_start_feed(dmxdev, filter, feed);
878
879 return 0;
880}
881
882static int dvb_dmxdev_remove_pid(struct dmxdev *dmxdev,
883 struct dmxdev_filter *filter, u16 pid)
884{
885 struct dmxdev_feed *feed, *tmp;
886
887 if ((filter->type != DMXDEV_TYPE_PES) ||
888 (filter->state < DMXDEV_STATE_SET))
889 return -EINVAL;
890
891 list_for_each_entry_safe(feed, tmp, &filter->feed.ts, next) {
892 if ((feed->pid == pid) && (feed->ts != NULL)) {
893 feed->ts->stop_filtering(feed->ts);
894 filter->dev->demux->release_ts_feed(filter->dev->demux,
895 feed->ts);
896 list_del(&feed->next);
897 kfree(feed);
898 }
899 }
900
901 return 0;
902}
903
Linus Torvalds1da177e2005-04-16 15:20:36 -0700904static int dvb_dmxdev_filter_set(struct dmxdev *dmxdev,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300905 struct dmxdev_filter *dmxdevfilter,
906 struct dmx_sct_filter_params *params)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700907{
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -0300908 dprintk("%s: PID=0x%04x, flags=%02x, timeout=%d\n",
Mauro Carvalho Chehab17e67d42013-03-01 15:20:25 -0300909 __func__, params->pid, params->flags, params->timeout);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700910
911 dvb_dmxdev_filter_stop(dmxdevfilter);
912
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300913 dmxdevfilter->type = DMXDEV_TYPE_SEC;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700914 memcpy(&dmxdevfilter->params.sec,
915 params, sizeof(struct dmx_sct_filter_params));
916 invert_mode(&dmxdevfilter->params.sec.filter);
917 dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET);
918
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300919 if (params->flags & DMX_IMMEDIATE_START)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700920 return dvb_dmxdev_filter_start(dmxdevfilter);
921
922 return 0;
923}
924
925static int dvb_dmxdev_pes_filter_set(struct dmxdev *dmxdev,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300926 struct dmxdev_filter *dmxdevfilter,
927 struct dmx_pes_filter_params *params)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700928{
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300929 int ret;
930
Linus Torvalds1da177e2005-04-16 15:20:36 -0700931 dvb_dmxdev_filter_stop(dmxdevfilter);
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300932 dvb_dmxdev_filter_reset(dmxdevfilter);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700933
devendra sharmae90bbac2016-12-18 11:52:55 -0200934 if ((unsigned int)params->pes_type > DMX_PES_OTHER)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700935 return -EINVAL;
936
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300937 dmxdevfilter->type = DMXDEV_TYPE_PES;
938 memcpy(&dmxdevfilter->params, params,
939 sizeof(struct dmx_pes_filter_params));
Francesco Lavra691c9ae2010-02-07 09:49:58 -0300940 INIT_LIST_HEAD(&dmxdevfilter->feed.ts);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700941
942 dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET);
943
Andreas Oberritter1cb662a2009-07-14 20:28:50 -0300944 ret = dvb_dmxdev_add_pid(dmxdev, dmxdevfilter,
945 dmxdevfilter->params.pes.pid);
946 if (ret < 0)
947 return ret;
948
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300949 if (params->flags & DMX_IMMEDIATE_START)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700950 return dvb_dmxdev_filter_start(dmxdevfilter);
951
952 return 0;
953}
954
955static ssize_t dvb_dmxdev_read_sec(struct dmxdev_filter *dfil,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300956 struct file *file, char __user *buf,
957 size_t count, loff_t *ppos)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700958{
959 int result, hcount;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300960 int done = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700961
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300962 if (dfil->todo <= 0) {
963 hcount = 3 + dfil->todo;
964 if (hcount > count)
965 hcount = count;
966 result = dvb_dmxdev_buffer_read(&dfil->buffer,
967 file->f_flags & O_NONBLOCK,
968 buf, hcount, ppos);
969 if (result < 0) {
970 dfil->todo = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700971 return result;
972 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300973 if (copy_from_user(dfil->secheader - dfil->todo, buf, result))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700974 return -EFAULT;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300975 buf += result;
976 done = result;
977 count -= result;
978 dfil->todo -= result;
979 if (dfil->todo > -3)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700980 return done;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300981 dfil->todo = ((dfil->secheader[1] << 8) | dfil->secheader[2]) & 0xfff;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700982 if (!count)
983 return done;
984 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300985 if (count > dfil->todo)
986 count = dfil->todo;
987 result = dvb_dmxdev_buffer_read(&dfil->buffer,
988 file->f_flags & O_NONBLOCK,
989 buf, count, ppos);
990 if (result < 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700991 return result;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300992 dfil->todo -= result;
993 return (result + done);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700994}
995
Linus Torvalds1da177e2005-04-16 15:20:36 -0700996static ssize_t
Andreas Oberritterf705e6e2006-03-10 15:22:31 -0300997dvb_demux_read(struct file *file, char __user *buf, size_t count,
998 loff_t *ppos)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700999{
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001000 struct dmxdev_filter *dmxdevfilter = file->private_data;
1001 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001002
Ingo Molnar3593cab2006-02-07 06:49:14 -02001003 if (mutex_lock_interruptible(&dmxdevfilter->mutex))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001004 return -ERESTARTSYS;
1005
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001006 if (dmxdevfilter->type == DMXDEV_TYPE_SEC)
1007 ret = dvb_dmxdev_read_sec(dmxdevfilter, file, buf, count, ppos);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001008 else
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001009 ret = dvb_dmxdev_buffer_read(&dmxdevfilter->buffer,
1010 file->f_flags & O_NONBLOCK,
1011 buf, count, ppos);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001012
Ingo Molnar3593cab2006-02-07 06:49:14 -02001013 mutex_unlock(&dmxdevfilter->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001014 return ret;
1015}
1016
Arnd Bergmann16ef8de2010-04-27 00:24:00 +02001017static int dvb_demux_do_ioctl(struct file *file,
Linus Torvalds1da177e2005-04-16 15:20:36 -07001018 unsigned int cmd, void *parg)
1019{
Peter Beutner3ec4a302005-07-07 17:57:39 -07001020 struct dmxdev_filter *dmxdevfilter = file->private_data;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001021 struct dmxdev *dmxdev = dmxdevfilter->dev;
1022 unsigned long arg = (unsigned long)parg;
1023 int ret = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001024
Ingo Molnar3593cab2006-02-07 06:49:14 -02001025 if (mutex_lock_interruptible(&dmxdev->mutex))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001026 return -ERESTARTSYS;
1027
1028 switch (cmd) {
1029 case DMX_START:
Ingo Molnar3593cab2006-02-07 06:49:14 -02001030 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1031 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001032 return -ERESTARTSYS;
1033 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001034 if (dmxdevfilter->state < DMXDEV_STATE_SET)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001035 ret = -EINVAL;
1036 else
1037 ret = dvb_dmxdev_filter_start(dmxdevfilter);
Ingo Molnar3593cab2006-02-07 06:49:14 -02001038 mutex_unlock(&dmxdevfilter->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001039 break;
1040
1041 case DMX_STOP:
Ingo Molnar3593cab2006-02-07 06:49:14 -02001042 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1043 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044 return -ERESTARTSYS;
1045 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001046 ret = dvb_dmxdev_filter_stop(dmxdevfilter);
Ingo Molnar3593cab2006-02-07 06:49:14 -02001047 mutex_unlock(&dmxdevfilter->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001048 break;
1049
1050 case DMX_SET_FILTER:
Ingo Molnar3593cab2006-02-07 06:49:14 -02001051 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1052 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001053 return -ERESTARTSYS;
1054 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001055 ret = dvb_dmxdev_filter_set(dmxdev, dmxdevfilter, parg);
Ingo Molnar3593cab2006-02-07 06:49:14 -02001056 mutex_unlock(&dmxdevfilter->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001057 break;
1058
1059 case DMX_SET_PES_FILTER:
Ingo Molnar3593cab2006-02-07 06:49:14 -02001060 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1061 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001062 return -ERESTARTSYS;
1063 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001064 ret = dvb_dmxdev_pes_filter_set(dmxdev, dmxdevfilter, parg);
Ingo Molnar3593cab2006-02-07 06:49:14 -02001065 mutex_unlock(&dmxdevfilter->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001066 break;
1067
1068 case DMX_SET_BUFFER_SIZE:
Ingo Molnar3593cab2006-02-07 06:49:14 -02001069 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1070 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001071 return -ERESTARTSYS;
1072 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001073 ret = dvb_dmxdev_set_buffer_size(dmxdevfilter, arg);
Ingo Molnar3593cab2006-02-07 06:49:14 -02001074 mutex_unlock(&dmxdevfilter->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001075 break;
1076
Linus Torvalds1da177e2005-04-16 15:20:36 -07001077 case DMX_GET_PES_PIDS:
1078 if (!dmxdev->demux->get_pes_pids) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001079 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001080 break;
1081 }
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001082 dmxdev->demux->get_pes_pids(dmxdev->demux, parg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001083 break;
1084
1085 case DMX_GET_STC:
1086 if (!dmxdev->demux->get_stc) {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001087 ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088 break;
1089 }
1090 ret = dmxdev->demux->get_stc(dmxdev->demux,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001091 ((struct dmx_stc *)parg)->num,
1092 &((struct dmx_stc *)parg)->stc,
1093 &((struct dmx_stc *)parg)->base);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001094 break;
1095
Andreas Oberritter1cb662a2009-07-14 20:28:50 -03001096 case DMX_ADD_PID:
1097 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1098 ret = -ERESTARTSYS;
1099 break;
1100 }
1101 ret = dvb_dmxdev_add_pid(dmxdev, dmxdevfilter, *(u16 *)parg);
1102 mutex_unlock(&dmxdevfilter->mutex);
1103 break;
1104
1105 case DMX_REMOVE_PID:
1106 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1107 ret = -ERESTARTSYS;
1108 break;
1109 }
1110 ret = dvb_dmxdev_remove_pid(dmxdev, dmxdevfilter, *(u16 *)parg);
1111 mutex_unlock(&dmxdevfilter->mutex);
1112 break;
1113
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001114#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001115 case DMX_REQBUFS:
1116 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1117 mutex_unlock(&dmxdev->mutex);
1118 return -ERESTARTSYS;
1119 }
1120 ret = dvb_vb2_reqbufs(&dmxdevfilter->vb2_ctx, parg);
1121 mutex_unlock(&dmxdevfilter->mutex);
1122 break;
1123
1124 case DMX_QUERYBUF:
1125 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1126 mutex_unlock(&dmxdev->mutex);
1127 return -ERESTARTSYS;
1128 }
1129 ret = dvb_vb2_querybuf(&dmxdevfilter->vb2_ctx, parg);
1130 mutex_unlock(&dmxdevfilter->mutex);
1131 break;
1132
1133 case DMX_EXPBUF:
1134 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1135 mutex_unlock(&dmxdev->mutex);
1136 return -ERESTARTSYS;
1137 }
1138 ret = dvb_vb2_expbuf(&dmxdevfilter->vb2_ctx, parg);
1139 mutex_unlock(&dmxdevfilter->mutex);
1140 break;
1141
1142 case DMX_QBUF:
1143 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1144 mutex_unlock(&dmxdev->mutex);
1145 return -ERESTARTSYS;
1146 }
1147 ret = dvb_vb2_qbuf(&dmxdevfilter->vb2_ctx, parg);
1148 if (ret == 0 && !dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx))
1149 ret = dvb_vb2_stream_on(&dmxdevfilter->vb2_ctx);
1150 mutex_unlock(&dmxdevfilter->mutex);
1151 break;
1152
1153 case DMX_DQBUF:
1154 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1155 mutex_unlock(&dmxdev->mutex);
1156 return -ERESTARTSYS;
1157 }
1158 ret = dvb_vb2_dqbuf(&dmxdevfilter->vb2_ctx, parg);
1159 mutex_unlock(&dmxdevfilter->mutex);
1160 break;
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001161#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001162 default:
Mauro Carvalho Chehaba145f642018-02-11 05:44:21 -05001163 ret = -ENOTTY;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001164 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001165 }
Ingo Molnar3593cab2006-02-07 06:49:14 -02001166 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001167 return ret;
1168}
1169
Arnd Bergmann16ef8de2010-04-27 00:24:00 +02001170static long dvb_demux_ioctl(struct file *file, unsigned int cmd,
1171 unsigned long arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001172{
Arnd Bergmann72024f12010-09-11 19:56:45 +02001173 return dvb_usercopy(file, cmd, arg, dvb_demux_do_ioctl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001174}
1175
Al Viroc23e0cb2017-07-03 03:02:56 -04001176static __poll_t dvb_demux_poll(struct file *file, poll_table *wait)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001177{
Peter Beutner3ec4a302005-07-07 17:57:39 -07001178 struct dmxdev_filter *dmxdevfilter = file->private_data;
Al Viroc23e0cb2017-07-03 03:02:56 -04001179 __poll_t mask = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001180
Mauro Carvalho Chehab313ddec2014-09-03 14:32:26 -03001181 if ((!dmxdevfilter) || dmxdevfilter->dev->exit)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001182 return EPOLLERR;
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001183 if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx))
1184 return dvb_vb2_poll(&dmxdevfilter->vb2_ctx, file, wait);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001185
1186 poll_wait(file, &dmxdevfilter->buffer.queue, wait);
1187
1188 if (dmxdevfilter->state != DMXDEV_STATE_GO &&
1189 dmxdevfilter->state != DMXDEV_STATE_DONE &&
1190 dmxdevfilter->state != DMXDEV_STATE_TIMEDOUT)
1191 return 0;
1192
1193 if (dmxdevfilter->buffer.error)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001194 mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI | EPOLLERR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001195
Andreas Oberritter34731df2006-03-14 17:31:01 -03001196 if (!dvb_ringbuffer_empty(&dmxdevfilter->buffer))
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001197 mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001198
1199 return mask;
1200}
1201
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001202#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001203static int dvb_demux_mmap(struct file *file, struct vm_area_struct *vma)
1204{
1205 struct dmxdev_filter *dmxdevfilter = file->private_data;
1206 struct dmxdev *dmxdev = dmxdevfilter->dev;
1207 int ret;
1208
1209 if (mutex_lock_interruptible(&dmxdev->mutex))
1210 return -ERESTARTSYS;
1211
1212 if (mutex_lock_interruptible(&dmxdevfilter->mutex)) {
1213 mutex_unlock(&dmxdev->mutex);
1214 return -ERESTARTSYS;
1215 }
1216 ret = dvb_vb2_mmap(&dmxdevfilter->vb2_ctx, vma);
1217
1218 mutex_unlock(&dmxdevfilter->mutex);
1219 mutex_unlock(&dmxdev->mutex);
1220
1221 return ret;
1222}
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001223#endif
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001224
Linus Torvalds1da177e2005-04-16 15:20:36 -07001225static int dvb_demux_release(struct inode *inode, struct file *file)
1226{
Peter Beutner3ec4a302005-07-07 17:57:39 -07001227 struct dmxdev_filter *dmxdevfilter = file->private_data;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001228 struct dmxdev *dmxdev = dmxdevfilter->dev;
Markus Rechberger57861b42007-04-14 10:19:18 -03001229 int ret;
1230
1231 ret = dvb_dmxdev_filter_free(dmxdev, dmxdevfilter);
1232
1233 mutex_lock(&dmxdev->mutex);
1234 dmxdev->dvbdev->users--;
devendra sharmae90bbac2016-12-18 11:52:55 -02001235 if (dmxdev->dvbdev->users == 1 && dmxdev->exit == 1) {
Markus Rechberger57861b42007-04-14 10:19:18 -03001236 mutex_unlock(&dmxdev->mutex);
1237 wake_up(&dmxdev->dvbdev->wait_queue);
1238 } else
1239 mutex_unlock(&dmxdev->mutex);
1240
1241 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001242}
1243
Jan Engelhardt784e29d2009-01-11 06:12:43 -03001244static const struct file_operations dvb_demux_fops = {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001245 .owner = THIS_MODULE,
1246 .read = dvb_demux_read,
Arnd Bergmann16ef8de2010-04-27 00:24:00 +02001247 .unlocked_ioctl = dvb_demux_ioctl,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001248 .open = dvb_demux_open,
1249 .release = dvb_demux_release,
1250 .poll = dvb_demux_poll,
Arnd Bergmann6038f372010-08-15 18:52:59 +02001251 .llseek = default_llseek,
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001252#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001253 .mmap = dvb_demux_mmap,
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001254#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001255};
1256
Mauro Carvalho Chehab8afd52e2015-01-02 22:28:53 -03001257static const struct dvb_device dvbdev_demux = {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001258 .priv = NULL,
1259 .users = 1,
1260 .writers = 1,
Mauro Carvalho Chehab8afd52e2015-01-02 22:28:53 -03001261#if defined(CONFIG_MEDIA_CONTROLLER_DVB)
Mauro Carvalho Chehabe4fd3bc2015-02-18 12:09:27 -03001262 .name = "dvb-demux",
Mauro Carvalho Chehab8afd52e2015-01-02 22:28:53 -03001263#endif
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001264 .fops = &dvb_demux_fops
Linus Torvalds1da177e2005-04-16 15:20:36 -07001265};
1266
Arnd Bergmann16ef8de2010-04-27 00:24:00 +02001267static int dvb_dvr_do_ioctl(struct file *file,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001268 unsigned int cmd, void *parg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001269{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -07001270 struct dvb_device *dvbdev = file->private_data;
1271 struct dmxdev *dmxdev = dvbdev->priv;
Andrea Odettia095be42008-04-20 19:14:51 -03001272 unsigned long arg = (unsigned long)parg;
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001273 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001274
Ingo Molnar3593cab2006-02-07 06:49:14 -02001275 if (mutex_lock_interruptible(&dmxdev->mutex))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001276 return -ERESTARTSYS;
1277
1278 switch (cmd) {
1279 case DMX_SET_BUFFER_SIZE:
Andrea Odettia095be42008-04-20 19:14:51 -03001280 ret = dvb_dvr_set_buffer_size(dmxdev, arg);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001281 break;
1282
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001283#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001284 case DMX_REQBUFS:
1285 ret = dvb_vb2_reqbufs(&dmxdev->dvr_vb2_ctx, parg);
1286 break;
1287
1288 case DMX_QUERYBUF:
1289 ret = dvb_vb2_querybuf(&dmxdev->dvr_vb2_ctx, parg);
1290 break;
1291
1292 case DMX_EXPBUF:
1293 ret = dvb_vb2_expbuf(&dmxdev->dvr_vb2_ctx, parg);
1294 break;
1295
1296 case DMX_QBUF:
1297 ret = dvb_vb2_qbuf(&dmxdev->dvr_vb2_ctx, parg);
1298 if (ret == 0 && !dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx))
1299 ret = dvb_vb2_stream_on(&dmxdev->dvr_vb2_ctx);
1300 break;
1301
1302 case DMX_DQBUF:
1303 ret = dvb_vb2_dqbuf(&dmxdev->dvr_vb2_ctx, parg);
1304 break;
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001305#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001306 default:
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001307 ret = -EINVAL;
1308 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001309 }
Ingo Molnar3593cab2006-02-07 06:49:14 -02001310 mutex_unlock(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001311 return ret;
1312}
1313
Arnd Bergmann16ef8de2010-04-27 00:24:00 +02001314static long dvb_dvr_ioctl(struct file *file,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001315 unsigned int cmd, unsigned long arg)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001316{
Arnd Bergmann72024f12010-09-11 19:56:45 +02001317 return dvb_usercopy(file, cmd, arg, dvb_dvr_do_ioctl);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001318}
1319
Al Viroc23e0cb2017-07-03 03:02:56 -04001320static __poll_t dvb_dvr_poll(struct file *file, poll_table *wait)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001321{
Johannes Stezenbach0c53c702005-05-16 21:54:24 -07001322 struct dvb_device *dvbdev = file->private_data;
1323 struct dmxdev *dmxdev = dvbdev->priv;
Al Viroc23e0cb2017-07-03 03:02:56 -04001324 __poll_t mask = 0;
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001325#ifndef CONFIG_DVB_MMAP
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001326 bool need_ringbuffer = false;
1327#else
1328 const bool need_ringbuffer = true;
1329#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001330
Mauro Carvalho Chehabb3ad24d2016-10-13 06:47:54 -03001331 dprintk("%s\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001332
Changbing Xiongd102cac2014-08-20 23:05:40 -03001333 if (dmxdev->exit)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001334 return EPOLLERR;
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001335 if (dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx))
1336 return dvb_vb2_poll(&dmxdev->dvr_vb2_ctx, file, wait);
Changbing Xiongd102cac2014-08-20 23:05:40 -03001337
Linus Torvalds1da177e2005-04-16 15:20:36 -07001338 poll_wait(file, &dmxdev->dvr_buffer.queue, wait);
1339
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001340#ifndef CONFIG_DVB_MMAP
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001341 if ((file->f_flags & O_ACCMODE) == O_RDONLY)
1342 need_ringbuffer = true;
1343#endif
1344 if (need_ringbuffer) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07001345 if (dmxdev->dvr_buffer.error)
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001346 mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI | EPOLLERR);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001347
Andreas Oberritter34731df2006-03-14 17:31:01 -03001348 if (!dvb_ringbuffer_empty(&dmxdev->dvr_buffer))
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001349 mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001350 } else
Linus Torvaldsa9a08842018-02-11 14:34:03 -08001351 mask |= (EPOLLOUT | EPOLLWRNORM | EPOLLPRI);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001352
1353 return mask;
1354}
1355
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001356#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001357static int dvb_dvr_mmap(struct file *file, struct vm_area_struct *vma)
1358{
1359 struct dvb_device *dvbdev = file->private_data;
1360 struct dmxdev *dmxdev = dvbdev->priv;
1361 int ret;
1362
1363 if (dmxdev->exit)
1364 return -ENODEV;
1365
1366 if (mutex_lock_interruptible(&dmxdev->mutex))
1367 return -ERESTARTSYS;
1368
1369 ret = dvb_vb2_mmap(&dmxdev->dvr_vb2_ctx, vma);
1370 mutex_unlock(&dmxdev->mutex);
1371 return ret;
1372}
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001373#endif
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001374
Alexey Dobriyan828c0952009-10-01 15:43:56 -07001375static const struct file_operations dvb_dvr_fops = {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001376 .owner = THIS_MODULE,
1377 .read = dvb_dvr_read,
1378 .write = dvb_dvr_write,
Arnd Bergmann16ef8de2010-04-27 00:24:00 +02001379 .unlocked_ioctl = dvb_dvr_ioctl,
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001380 .open = dvb_dvr_open,
1381 .release = dvb_dvr_release,
1382 .poll = dvb_dvr_poll,
Arnd Bergmann6038f372010-08-15 18:52:59 +02001383 .llseek = default_llseek,
Arnd Bergmannec5b1002018-01-04 05:31:30 -05001384#ifdef CONFIG_DVB_MMAP
Satendra Singh Thakur57868ac2017-12-18 22:35:53 -05001385 .mmap = dvb_dvr_mmap,
Mauro Carvalho Chehab40210532017-12-28 09:24:20 -05001386#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001387};
1388
Mauro Carvalho Chehab8afd52e2015-01-02 22:28:53 -03001389static const struct dvb_device dvbdev_dvr = {
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001390 .priv = NULL,
Trent Piepho5e85bd02006-03-30 15:53:32 -03001391 .readers = 1,
Markus Rechberger57861b42007-04-14 10:19:18 -03001392 .users = 1,
Mauro Carvalho Chehab8afd52e2015-01-02 22:28:53 -03001393#if defined(CONFIG_MEDIA_CONTROLLER_DVB)
Mauro Carvalho Chehabe4fd3bc2015-02-18 12:09:27 -03001394 .name = "dvb-dvr",
Mauro Carvalho Chehab8afd52e2015-01-02 22:28:53 -03001395#endif
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001396 .fops = &dvb_dvr_fops
Linus Torvalds1da177e2005-04-16 15:20:36 -07001397};
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001398int dvb_dmxdev_init(struct dmxdev *dmxdev, struct dvb_adapter *dvb_adapter)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001399{
1400 int i;
1401
1402 if (dmxdev->demux->open(dmxdev->demux) < 0)
1403 return -EUSERS;
1404
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001405 dmxdev->filter = vmalloc(dmxdev->filternum * sizeof(struct dmxdev_filter));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001406 if (!dmxdev->filter)
1407 return -ENOMEM;
1408
Ingo Molnar3593cab2006-02-07 06:49:14 -02001409 mutex_init(&dmxdev->mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001410 spin_lock_init(&dmxdev->lock);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001411 for (i = 0; i < dmxdev->filternum; i++) {
1412 dmxdev->filter[i].dev = dmxdev;
1413 dmxdev->filter[i].buffer.data = NULL;
1414 dvb_dmxdev_filter_state_set(&dmxdev->filter[i],
1415 DMXDEV_STATE_FREE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001416 }
1417
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001418 dvb_register_device(dvb_adapter, &dmxdev->dvbdev, &dvbdev_demux, dmxdev,
Mauro Carvalho Chehabdf2f94e2015-08-21 16:18:18 -03001419 DVB_DEVICE_DEMUX, dmxdev->filternum);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001420 dvb_register_device(dvb_adapter, &dmxdev->dvr_dvbdev, &dvbdev_dvr,
Mauro Carvalho Chehabdf2f94e2015-08-21 16:18:18 -03001421 dmxdev, DVB_DEVICE_DVR, dmxdev->filternum);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001422
Andreas Oberritter34731df2006-03-14 17:31:01 -03001423 dvb_ringbuffer_init(&dmxdev->dvr_buffer, NULL, 8192);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001424
1425 return 0;
1426}
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001427
Linus Torvalds1da177e2005-04-16 15:20:36 -07001428EXPORT_SYMBOL(dvb_dmxdev_init);
1429
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001430void dvb_dmxdev_release(struct dmxdev *dmxdev)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001431{
devendra sharmae90bbac2016-12-18 11:52:55 -02001432 dmxdev->exit = 1;
Markus Rechberger57861b42007-04-14 10:19:18 -03001433 if (dmxdev->dvbdev->users > 1) {
1434 wait_event(dmxdev->dvbdev->wait_queue,
devendra sharmae90bbac2016-12-18 11:52:55 -02001435 dmxdev->dvbdev->users == 1);
Markus Rechberger57861b42007-04-14 10:19:18 -03001436 }
1437 if (dmxdev->dvr_dvbdev->users > 1) {
1438 wait_event(dmxdev->dvr_dvbdev->wait_queue,
devendra sharmae90bbac2016-12-18 11:52:55 -02001439 dmxdev->dvr_dvbdev->users == 1);
Markus Rechberger57861b42007-04-14 10:19:18 -03001440 }
1441
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 dvb_unregister_device(dmxdev->dvbdev);
1443 dvb_unregister_device(dmxdev->dvr_dvbdev);
1444
1445 vfree(dmxdev->filter);
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001446 dmxdev->filter = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447 dmxdev->demux->close(dmxdev->demux);
1448}
Andreas Oberritterf705e6e2006-03-10 15:22:31 -03001449
Linus Torvalds1da177e2005-04-16 15:20:36 -07001450EXPORT_SYMBOL(dvb_dmxdev_release);