162306a36Sopenharmony_ci// SPDX-License-Identifier: LGPL-2.1-or-later 262306a36Sopenharmony_ci/* 362306a36Sopenharmony_ci * dmxdev.c - DVB demultiplexer device 462306a36Sopenharmony_ci * 562306a36Sopenharmony_ci * Copyright (C) 2000 Ralph Metzler & Marcus Metzler 662306a36Sopenharmony_ci * for convergence integrated media GmbH 762306a36Sopenharmony_ci */ 862306a36Sopenharmony_ci 962306a36Sopenharmony_ci#define pr_fmt(fmt) "dmxdev: " fmt 1062306a36Sopenharmony_ci 1162306a36Sopenharmony_ci#include <linux/sched.h> 1262306a36Sopenharmony_ci#include <linux/spinlock.h> 1362306a36Sopenharmony_ci#include <linux/slab.h> 1462306a36Sopenharmony_ci#include <linux/vmalloc.h> 1562306a36Sopenharmony_ci#include <linux/module.h> 1662306a36Sopenharmony_ci#include <linux/poll.h> 1762306a36Sopenharmony_ci#include <linux/ioctl.h> 1862306a36Sopenharmony_ci#include <linux/wait.h> 1962306a36Sopenharmony_ci#include <linux/uaccess.h> 2062306a36Sopenharmony_ci#include <media/dmxdev.h> 2162306a36Sopenharmony_ci#include <media/dvb_vb2.h> 2262306a36Sopenharmony_ci 2362306a36Sopenharmony_cistatic int debug; 2462306a36Sopenharmony_ci 2562306a36Sopenharmony_cimodule_param(debug, int, 0644); 2662306a36Sopenharmony_ciMODULE_PARM_DESC(debug, "Turn on/off debugging (default:off)."); 2762306a36Sopenharmony_ci 2862306a36Sopenharmony_ci#define dprintk(fmt, arg...) do { \ 2962306a36Sopenharmony_ci if (debug) \ 3062306a36Sopenharmony_ci printk(KERN_DEBUG pr_fmt("%s: " fmt), \ 3162306a36Sopenharmony_ci __func__, ##arg); \ 3262306a36Sopenharmony_ci} while (0) 3362306a36Sopenharmony_ci 3462306a36Sopenharmony_cistatic int dvb_dmxdev_buffer_write(struct dvb_ringbuffer *buf, 3562306a36Sopenharmony_ci const u8 *src, size_t len) 3662306a36Sopenharmony_ci{ 3762306a36Sopenharmony_ci ssize_t free; 3862306a36Sopenharmony_ci 3962306a36Sopenharmony_ci if (!len) 4062306a36Sopenharmony_ci return 0; 4162306a36Sopenharmony_ci if (!buf->data) 4262306a36Sopenharmony_ci return 0; 4362306a36Sopenharmony_ci 4462306a36Sopenharmony_ci free = dvb_ringbuffer_free(buf); 4562306a36Sopenharmony_ci if (len > free) { 4662306a36Sopenharmony_ci dprintk("buffer overflow\n"); 4762306a36Sopenharmony_ci return -EOVERFLOW; 4862306a36Sopenharmony_ci } 4962306a36Sopenharmony_ci 5062306a36Sopenharmony_ci return dvb_ringbuffer_write(buf, src, len); 5162306a36Sopenharmony_ci} 5262306a36Sopenharmony_ci 5362306a36Sopenharmony_cistatic ssize_t dvb_dmxdev_buffer_read(struct dvb_ringbuffer *src, 5462306a36Sopenharmony_ci int non_blocking, char __user *buf, 5562306a36Sopenharmony_ci size_t count, loff_t *ppos) 5662306a36Sopenharmony_ci{ 5762306a36Sopenharmony_ci size_t todo; 5862306a36Sopenharmony_ci ssize_t avail; 5962306a36Sopenharmony_ci ssize_t ret = 0; 6062306a36Sopenharmony_ci 6162306a36Sopenharmony_ci if (!src->data) 6262306a36Sopenharmony_ci return 0; 6362306a36Sopenharmony_ci 6462306a36Sopenharmony_ci if (src->error) { 6562306a36Sopenharmony_ci ret = src->error; 6662306a36Sopenharmony_ci dvb_ringbuffer_flush(src); 6762306a36Sopenharmony_ci return ret; 6862306a36Sopenharmony_ci } 6962306a36Sopenharmony_ci 7062306a36Sopenharmony_ci for (todo = count; todo > 0; todo -= ret) { 7162306a36Sopenharmony_ci if (non_blocking && dvb_ringbuffer_empty(src)) { 7262306a36Sopenharmony_ci ret = -EWOULDBLOCK; 7362306a36Sopenharmony_ci break; 7462306a36Sopenharmony_ci } 7562306a36Sopenharmony_ci 7662306a36Sopenharmony_ci ret = wait_event_interruptible(src->queue, 7762306a36Sopenharmony_ci !dvb_ringbuffer_empty(src) || 7862306a36Sopenharmony_ci (src->error != 0)); 7962306a36Sopenharmony_ci if (ret < 0) 8062306a36Sopenharmony_ci break; 8162306a36Sopenharmony_ci 8262306a36Sopenharmony_ci if (src->error) { 8362306a36Sopenharmony_ci ret = src->error; 8462306a36Sopenharmony_ci dvb_ringbuffer_flush(src); 8562306a36Sopenharmony_ci break; 8662306a36Sopenharmony_ci } 8762306a36Sopenharmony_ci 8862306a36Sopenharmony_ci avail = dvb_ringbuffer_avail(src); 8962306a36Sopenharmony_ci if (avail > todo) 9062306a36Sopenharmony_ci avail = todo; 9162306a36Sopenharmony_ci 9262306a36Sopenharmony_ci ret = dvb_ringbuffer_read_user(src, buf, avail); 9362306a36Sopenharmony_ci if (ret < 0) 9462306a36Sopenharmony_ci break; 9562306a36Sopenharmony_ci 9662306a36Sopenharmony_ci buf += ret; 9762306a36Sopenharmony_ci } 9862306a36Sopenharmony_ci 9962306a36Sopenharmony_ci return (count - todo) ? (count - todo) : ret; 10062306a36Sopenharmony_ci} 10162306a36Sopenharmony_ci 10262306a36Sopenharmony_cistatic struct dmx_frontend *get_fe(struct dmx_demux *demux, int type) 10362306a36Sopenharmony_ci{ 10462306a36Sopenharmony_ci struct list_head *head, *pos; 10562306a36Sopenharmony_ci 10662306a36Sopenharmony_ci head = demux->get_frontends(demux); 10762306a36Sopenharmony_ci if (!head) 10862306a36Sopenharmony_ci return NULL; 10962306a36Sopenharmony_ci list_for_each(pos, head) 11062306a36Sopenharmony_ci if (DMX_FE_ENTRY(pos)->source == type) 11162306a36Sopenharmony_ci return DMX_FE_ENTRY(pos); 11262306a36Sopenharmony_ci 11362306a36Sopenharmony_ci return NULL; 11462306a36Sopenharmony_ci} 11562306a36Sopenharmony_ci 11662306a36Sopenharmony_cistatic int dvb_dvr_open(struct inode *inode, struct file *file) 11762306a36Sopenharmony_ci{ 11862306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 11962306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 12062306a36Sopenharmony_ci struct dmx_frontend *front; 12162306a36Sopenharmony_ci bool need_ringbuffer = false; 12262306a36Sopenharmony_ci 12362306a36Sopenharmony_ci dprintk("%s\n", __func__); 12462306a36Sopenharmony_ci 12562306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdev->mutex)) 12662306a36Sopenharmony_ci return -ERESTARTSYS; 12762306a36Sopenharmony_ci 12862306a36Sopenharmony_ci if (dmxdev->exit) { 12962306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 13062306a36Sopenharmony_ci return -ENODEV; 13162306a36Sopenharmony_ci } 13262306a36Sopenharmony_ci 13362306a36Sopenharmony_ci dmxdev->may_do_mmap = 0; 13462306a36Sopenharmony_ci 13562306a36Sopenharmony_ci /* 13662306a36Sopenharmony_ci * The logic here is a little tricky due to the ifdef. 13762306a36Sopenharmony_ci * 13862306a36Sopenharmony_ci * The ringbuffer is used for both read and mmap. 13962306a36Sopenharmony_ci * 14062306a36Sopenharmony_ci * It is not needed, however, on two situations: 14162306a36Sopenharmony_ci * - Write devices (access with O_WRONLY); 14262306a36Sopenharmony_ci * - For duplex device nodes, opened with O_RDWR. 14362306a36Sopenharmony_ci */ 14462306a36Sopenharmony_ci 14562306a36Sopenharmony_ci if ((file->f_flags & O_ACCMODE) == O_RDONLY) 14662306a36Sopenharmony_ci need_ringbuffer = true; 14762306a36Sopenharmony_ci else if ((file->f_flags & O_ACCMODE) == O_RDWR) { 14862306a36Sopenharmony_ci if (!(dmxdev->capabilities & DMXDEV_CAP_DUPLEX)) { 14962306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 15062306a36Sopenharmony_ci dmxdev->may_do_mmap = 1; 15162306a36Sopenharmony_ci need_ringbuffer = true; 15262306a36Sopenharmony_ci#else 15362306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 15462306a36Sopenharmony_ci return -EOPNOTSUPP; 15562306a36Sopenharmony_ci#endif 15662306a36Sopenharmony_ci } 15762306a36Sopenharmony_ci } 15862306a36Sopenharmony_ci 15962306a36Sopenharmony_ci if (need_ringbuffer) { 16062306a36Sopenharmony_ci void *mem; 16162306a36Sopenharmony_ci 16262306a36Sopenharmony_ci if (!dvbdev->readers) { 16362306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 16462306a36Sopenharmony_ci return -EBUSY; 16562306a36Sopenharmony_ci } 16662306a36Sopenharmony_ci mem = vmalloc(DVR_BUFFER_SIZE); 16762306a36Sopenharmony_ci if (!mem) { 16862306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 16962306a36Sopenharmony_ci return -ENOMEM; 17062306a36Sopenharmony_ci } 17162306a36Sopenharmony_ci dvb_ringbuffer_init(&dmxdev->dvr_buffer, mem, DVR_BUFFER_SIZE); 17262306a36Sopenharmony_ci if (dmxdev->may_do_mmap) 17362306a36Sopenharmony_ci dvb_vb2_init(&dmxdev->dvr_vb2_ctx, "dvr", 17462306a36Sopenharmony_ci file->f_flags & O_NONBLOCK); 17562306a36Sopenharmony_ci dvbdev->readers--; 17662306a36Sopenharmony_ci } 17762306a36Sopenharmony_ci 17862306a36Sopenharmony_ci if ((file->f_flags & O_ACCMODE) == O_WRONLY) { 17962306a36Sopenharmony_ci dmxdev->dvr_orig_fe = dmxdev->demux->frontend; 18062306a36Sopenharmony_ci 18162306a36Sopenharmony_ci if (!dmxdev->demux->write) { 18262306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 18362306a36Sopenharmony_ci return -EOPNOTSUPP; 18462306a36Sopenharmony_ci } 18562306a36Sopenharmony_ci 18662306a36Sopenharmony_ci front = get_fe(dmxdev->demux, DMX_MEMORY_FE); 18762306a36Sopenharmony_ci 18862306a36Sopenharmony_ci if (!front) { 18962306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 19062306a36Sopenharmony_ci return -EINVAL; 19162306a36Sopenharmony_ci } 19262306a36Sopenharmony_ci dmxdev->demux->disconnect_frontend(dmxdev->demux); 19362306a36Sopenharmony_ci dmxdev->demux->connect_frontend(dmxdev->demux, front); 19462306a36Sopenharmony_ci } 19562306a36Sopenharmony_ci dvbdev->users++; 19662306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 19762306a36Sopenharmony_ci return 0; 19862306a36Sopenharmony_ci} 19962306a36Sopenharmony_ci 20062306a36Sopenharmony_cistatic int dvb_dvr_release(struct inode *inode, struct file *file) 20162306a36Sopenharmony_ci{ 20262306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 20362306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 20462306a36Sopenharmony_ci 20562306a36Sopenharmony_ci mutex_lock(&dmxdev->mutex); 20662306a36Sopenharmony_ci 20762306a36Sopenharmony_ci if ((file->f_flags & O_ACCMODE) == O_WRONLY) { 20862306a36Sopenharmony_ci dmxdev->demux->disconnect_frontend(dmxdev->demux); 20962306a36Sopenharmony_ci dmxdev->demux->connect_frontend(dmxdev->demux, 21062306a36Sopenharmony_ci dmxdev->dvr_orig_fe); 21162306a36Sopenharmony_ci } 21262306a36Sopenharmony_ci 21362306a36Sopenharmony_ci if (((file->f_flags & O_ACCMODE) == O_RDONLY) || 21462306a36Sopenharmony_ci dmxdev->may_do_mmap) { 21562306a36Sopenharmony_ci if (dmxdev->may_do_mmap) { 21662306a36Sopenharmony_ci if (dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx)) 21762306a36Sopenharmony_ci dvb_vb2_stream_off(&dmxdev->dvr_vb2_ctx); 21862306a36Sopenharmony_ci dvb_vb2_release(&dmxdev->dvr_vb2_ctx); 21962306a36Sopenharmony_ci } 22062306a36Sopenharmony_ci dvbdev->readers++; 22162306a36Sopenharmony_ci if (dmxdev->dvr_buffer.data) { 22262306a36Sopenharmony_ci void *mem = dmxdev->dvr_buffer.data; 22362306a36Sopenharmony_ci /*memory barrier*/ 22462306a36Sopenharmony_ci mb(); 22562306a36Sopenharmony_ci spin_lock_irq(&dmxdev->lock); 22662306a36Sopenharmony_ci dmxdev->dvr_buffer.data = NULL; 22762306a36Sopenharmony_ci spin_unlock_irq(&dmxdev->lock); 22862306a36Sopenharmony_ci vfree(mem); 22962306a36Sopenharmony_ci } 23062306a36Sopenharmony_ci } 23162306a36Sopenharmony_ci /* TODO */ 23262306a36Sopenharmony_ci dvbdev->users--; 23362306a36Sopenharmony_ci if (dvbdev->users == 1 && dmxdev->exit == 1) { 23462306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 23562306a36Sopenharmony_ci wake_up(&dvbdev->wait_queue); 23662306a36Sopenharmony_ci } else 23762306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 23862306a36Sopenharmony_ci 23962306a36Sopenharmony_ci return 0; 24062306a36Sopenharmony_ci} 24162306a36Sopenharmony_ci 24262306a36Sopenharmony_cistatic ssize_t dvb_dvr_write(struct file *file, const char __user *buf, 24362306a36Sopenharmony_ci size_t count, loff_t *ppos) 24462306a36Sopenharmony_ci{ 24562306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 24662306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 24762306a36Sopenharmony_ci int ret; 24862306a36Sopenharmony_ci 24962306a36Sopenharmony_ci if (!dmxdev->demux->write) 25062306a36Sopenharmony_ci return -EOPNOTSUPP; 25162306a36Sopenharmony_ci if ((file->f_flags & O_ACCMODE) != O_WRONLY) 25262306a36Sopenharmony_ci return -EINVAL; 25362306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdev->mutex)) 25462306a36Sopenharmony_ci return -ERESTARTSYS; 25562306a36Sopenharmony_ci 25662306a36Sopenharmony_ci if (dmxdev->exit) { 25762306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 25862306a36Sopenharmony_ci return -ENODEV; 25962306a36Sopenharmony_ci } 26062306a36Sopenharmony_ci ret = dmxdev->demux->write(dmxdev->demux, buf, count); 26162306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 26262306a36Sopenharmony_ci return ret; 26362306a36Sopenharmony_ci} 26462306a36Sopenharmony_ci 26562306a36Sopenharmony_cistatic ssize_t dvb_dvr_read(struct file *file, char __user *buf, size_t count, 26662306a36Sopenharmony_ci loff_t *ppos) 26762306a36Sopenharmony_ci{ 26862306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 26962306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 27062306a36Sopenharmony_ci 27162306a36Sopenharmony_ci if (dmxdev->exit) 27262306a36Sopenharmony_ci return -ENODEV; 27362306a36Sopenharmony_ci 27462306a36Sopenharmony_ci return dvb_dmxdev_buffer_read(&dmxdev->dvr_buffer, 27562306a36Sopenharmony_ci file->f_flags & O_NONBLOCK, 27662306a36Sopenharmony_ci buf, count, ppos); 27762306a36Sopenharmony_ci} 27862306a36Sopenharmony_ci 27962306a36Sopenharmony_cistatic int dvb_dvr_set_buffer_size(struct dmxdev *dmxdev, 28062306a36Sopenharmony_ci unsigned long size) 28162306a36Sopenharmony_ci{ 28262306a36Sopenharmony_ci struct dvb_ringbuffer *buf = &dmxdev->dvr_buffer; 28362306a36Sopenharmony_ci void *newmem; 28462306a36Sopenharmony_ci void *oldmem; 28562306a36Sopenharmony_ci 28662306a36Sopenharmony_ci dprintk("%s\n", __func__); 28762306a36Sopenharmony_ci 28862306a36Sopenharmony_ci if (buf->size == size) 28962306a36Sopenharmony_ci return 0; 29062306a36Sopenharmony_ci if (!size) 29162306a36Sopenharmony_ci return -EINVAL; 29262306a36Sopenharmony_ci 29362306a36Sopenharmony_ci newmem = vmalloc(size); 29462306a36Sopenharmony_ci if (!newmem) 29562306a36Sopenharmony_ci return -ENOMEM; 29662306a36Sopenharmony_ci 29762306a36Sopenharmony_ci oldmem = buf->data; 29862306a36Sopenharmony_ci 29962306a36Sopenharmony_ci spin_lock_irq(&dmxdev->lock); 30062306a36Sopenharmony_ci buf->data = newmem; 30162306a36Sopenharmony_ci buf->size = size; 30262306a36Sopenharmony_ci 30362306a36Sopenharmony_ci /* reset and not flush in case the buffer shrinks */ 30462306a36Sopenharmony_ci dvb_ringbuffer_reset(buf); 30562306a36Sopenharmony_ci spin_unlock_irq(&dmxdev->lock); 30662306a36Sopenharmony_ci 30762306a36Sopenharmony_ci vfree(oldmem); 30862306a36Sopenharmony_ci 30962306a36Sopenharmony_ci return 0; 31062306a36Sopenharmony_ci} 31162306a36Sopenharmony_ci 31262306a36Sopenharmony_cistatic inline void dvb_dmxdev_filter_state_set(struct dmxdev_filter 31362306a36Sopenharmony_ci *dmxdevfilter, int state) 31462306a36Sopenharmony_ci{ 31562306a36Sopenharmony_ci spin_lock_irq(&dmxdevfilter->dev->lock); 31662306a36Sopenharmony_ci dmxdevfilter->state = state; 31762306a36Sopenharmony_ci spin_unlock_irq(&dmxdevfilter->dev->lock); 31862306a36Sopenharmony_ci} 31962306a36Sopenharmony_ci 32062306a36Sopenharmony_cistatic int dvb_dmxdev_set_buffer_size(struct dmxdev_filter *dmxdevfilter, 32162306a36Sopenharmony_ci unsigned long size) 32262306a36Sopenharmony_ci{ 32362306a36Sopenharmony_ci struct dvb_ringbuffer *buf = &dmxdevfilter->buffer; 32462306a36Sopenharmony_ci void *newmem; 32562306a36Sopenharmony_ci void *oldmem; 32662306a36Sopenharmony_ci 32762306a36Sopenharmony_ci if (buf->size == size) 32862306a36Sopenharmony_ci return 0; 32962306a36Sopenharmony_ci if (!size) 33062306a36Sopenharmony_ci return -EINVAL; 33162306a36Sopenharmony_ci if (dmxdevfilter->state >= DMXDEV_STATE_GO) 33262306a36Sopenharmony_ci return -EBUSY; 33362306a36Sopenharmony_ci 33462306a36Sopenharmony_ci newmem = vmalloc(size); 33562306a36Sopenharmony_ci if (!newmem) 33662306a36Sopenharmony_ci return -ENOMEM; 33762306a36Sopenharmony_ci 33862306a36Sopenharmony_ci oldmem = buf->data; 33962306a36Sopenharmony_ci 34062306a36Sopenharmony_ci spin_lock_irq(&dmxdevfilter->dev->lock); 34162306a36Sopenharmony_ci buf->data = newmem; 34262306a36Sopenharmony_ci buf->size = size; 34362306a36Sopenharmony_ci 34462306a36Sopenharmony_ci /* reset and not flush in case the buffer shrinks */ 34562306a36Sopenharmony_ci dvb_ringbuffer_reset(buf); 34662306a36Sopenharmony_ci spin_unlock_irq(&dmxdevfilter->dev->lock); 34762306a36Sopenharmony_ci 34862306a36Sopenharmony_ci vfree(oldmem); 34962306a36Sopenharmony_ci 35062306a36Sopenharmony_ci return 0; 35162306a36Sopenharmony_ci} 35262306a36Sopenharmony_ci 35362306a36Sopenharmony_cistatic void dvb_dmxdev_filter_timeout(struct timer_list *t) 35462306a36Sopenharmony_ci{ 35562306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = from_timer(dmxdevfilter, t, timer); 35662306a36Sopenharmony_ci 35762306a36Sopenharmony_ci dmxdevfilter->buffer.error = -ETIMEDOUT; 35862306a36Sopenharmony_ci spin_lock_irq(&dmxdevfilter->dev->lock); 35962306a36Sopenharmony_ci dmxdevfilter->state = DMXDEV_STATE_TIMEDOUT; 36062306a36Sopenharmony_ci spin_unlock_irq(&dmxdevfilter->dev->lock); 36162306a36Sopenharmony_ci wake_up(&dmxdevfilter->buffer.queue); 36262306a36Sopenharmony_ci} 36362306a36Sopenharmony_ci 36462306a36Sopenharmony_cistatic void dvb_dmxdev_filter_timer(struct dmxdev_filter *dmxdevfilter) 36562306a36Sopenharmony_ci{ 36662306a36Sopenharmony_ci struct dmx_sct_filter_params *para = &dmxdevfilter->params.sec; 36762306a36Sopenharmony_ci 36862306a36Sopenharmony_ci del_timer(&dmxdevfilter->timer); 36962306a36Sopenharmony_ci if (para->timeout) { 37062306a36Sopenharmony_ci dmxdevfilter->timer.expires = 37162306a36Sopenharmony_ci jiffies + 1 + (HZ / 2 + HZ * para->timeout) / 1000; 37262306a36Sopenharmony_ci add_timer(&dmxdevfilter->timer); 37362306a36Sopenharmony_ci } 37462306a36Sopenharmony_ci} 37562306a36Sopenharmony_ci 37662306a36Sopenharmony_cistatic int dvb_dmxdev_section_callback(const u8 *buffer1, size_t buffer1_len, 37762306a36Sopenharmony_ci const u8 *buffer2, size_t buffer2_len, 37862306a36Sopenharmony_ci struct dmx_section_filter *filter, 37962306a36Sopenharmony_ci u32 *buffer_flags) 38062306a36Sopenharmony_ci{ 38162306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = filter->priv; 38262306a36Sopenharmony_ci int ret; 38362306a36Sopenharmony_ci 38462306a36Sopenharmony_ci if (!dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx) && 38562306a36Sopenharmony_ci dmxdevfilter->buffer.error) { 38662306a36Sopenharmony_ci wake_up(&dmxdevfilter->buffer.queue); 38762306a36Sopenharmony_ci return 0; 38862306a36Sopenharmony_ci } 38962306a36Sopenharmony_ci spin_lock(&dmxdevfilter->dev->lock); 39062306a36Sopenharmony_ci if (dmxdevfilter->state != DMXDEV_STATE_GO) { 39162306a36Sopenharmony_ci spin_unlock(&dmxdevfilter->dev->lock); 39262306a36Sopenharmony_ci return 0; 39362306a36Sopenharmony_ci } 39462306a36Sopenharmony_ci del_timer(&dmxdevfilter->timer); 39562306a36Sopenharmony_ci dprintk("section callback %*ph\n", 6, buffer1); 39662306a36Sopenharmony_ci if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx)) { 39762306a36Sopenharmony_ci ret = dvb_vb2_fill_buffer(&dmxdevfilter->vb2_ctx, 39862306a36Sopenharmony_ci buffer1, buffer1_len, 39962306a36Sopenharmony_ci buffer_flags); 40062306a36Sopenharmony_ci if (ret == buffer1_len) 40162306a36Sopenharmony_ci ret = dvb_vb2_fill_buffer(&dmxdevfilter->vb2_ctx, 40262306a36Sopenharmony_ci buffer2, buffer2_len, 40362306a36Sopenharmony_ci buffer_flags); 40462306a36Sopenharmony_ci } else { 40562306a36Sopenharmony_ci ret = dvb_dmxdev_buffer_write(&dmxdevfilter->buffer, 40662306a36Sopenharmony_ci buffer1, buffer1_len); 40762306a36Sopenharmony_ci if (ret == buffer1_len) { 40862306a36Sopenharmony_ci ret = dvb_dmxdev_buffer_write(&dmxdevfilter->buffer, 40962306a36Sopenharmony_ci buffer2, buffer2_len); 41062306a36Sopenharmony_ci } 41162306a36Sopenharmony_ci } 41262306a36Sopenharmony_ci if (ret < 0) 41362306a36Sopenharmony_ci dmxdevfilter->buffer.error = ret; 41462306a36Sopenharmony_ci if (dmxdevfilter->params.sec.flags & DMX_ONESHOT) 41562306a36Sopenharmony_ci dmxdevfilter->state = DMXDEV_STATE_DONE; 41662306a36Sopenharmony_ci spin_unlock(&dmxdevfilter->dev->lock); 41762306a36Sopenharmony_ci wake_up(&dmxdevfilter->buffer.queue); 41862306a36Sopenharmony_ci return 0; 41962306a36Sopenharmony_ci} 42062306a36Sopenharmony_ci 42162306a36Sopenharmony_cistatic int dvb_dmxdev_ts_callback(const u8 *buffer1, size_t buffer1_len, 42262306a36Sopenharmony_ci const u8 *buffer2, size_t buffer2_len, 42362306a36Sopenharmony_ci struct dmx_ts_feed *feed, 42462306a36Sopenharmony_ci u32 *buffer_flags) 42562306a36Sopenharmony_ci{ 42662306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = feed->priv; 42762306a36Sopenharmony_ci struct dvb_ringbuffer *buffer; 42862306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 42962306a36Sopenharmony_ci struct dvb_vb2_ctx *ctx; 43062306a36Sopenharmony_ci#endif 43162306a36Sopenharmony_ci int ret; 43262306a36Sopenharmony_ci 43362306a36Sopenharmony_ci spin_lock(&dmxdevfilter->dev->lock); 43462306a36Sopenharmony_ci if (dmxdevfilter->params.pes.output == DMX_OUT_DECODER) { 43562306a36Sopenharmony_ci spin_unlock(&dmxdevfilter->dev->lock); 43662306a36Sopenharmony_ci return 0; 43762306a36Sopenharmony_ci } 43862306a36Sopenharmony_ci 43962306a36Sopenharmony_ci if (dmxdevfilter->params.pes.output == DMX_OUT_TAP || 44062306a36Sopenharmony_ci dmxdevfilter->params.pes.output == DMX_OUT_TSDEMUX_TAP) { 44162306a36Sopenharmony_ci buffer = &dmxdevfilter->buffer; 44262306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 44362306a36Sopenharmony_ci ctx = &dmxdevfilter->vb2_ctx; 44462306a36Sopenharmony_ci#endif 44562306a36Sopenharmony_ci } else { 44662306a36Sopenharmony_ci buffer = &dmxdevfilter->dev->dvr_buffer; 44762306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 44862306a36Sopenharmony_ci ctx = &dmxdevfilter->dev->dvr_vb2_ctx; 44962306a36Sopenharmony_ci#endif 45062306a36Sopenharmony_ci } 45162306a36Sopenharmony_ci 45262306a36Sopenharmony_ci if (dvb_vb2_is_streaming(ctx)) { 45362306a36Sopenharmony_ci ret = dvb_vb2_fill_buffer(ctx, buffer1, buffer1_len, 45462306a36Sopenharmony_ci buffer_flags); 45562306a36Sopenharmony_ci if (ret == buffer1_len) 45662306a36Sopenharmony_ci ret = dvb_vb2_fill_buffer(ctx, buffer2, buffer2_len, 45762306a36Sopenharmony_ci buffer_flags); 45862306a36Sopenharmony_ci } else { 45962306a36Sopenharmony_ci if (buffer->error) { 46062306a36Sopenharmony_ci spin_unlock(&dmxdevfilter->dev->lock); 46162306a36Sopenharmony_ci wake_up(&buffer->queue); 46262306a36Sopenharmony_ci return 0; 46362306a36Sopenharmony_ci } 46462306a36Sopenharmony_ci ret = dvb_dmxdev_buffer_write(buffer, buffer1, buffer1_len); 46562306a36Sopenharmony_ci if (ret == buffer1_len) 46662306a36Sopenharmony_ci ret = dvb_dmxdev_buffer_write(buffer, 46762306a36Sopenharmony_ci buffer2, buffer2_len); 46862306a36Sopenharmony_ci } 46962306a36Sopenharmony_ci if (ret < 0) 47062306a36Sopenharmony_ci buffer->error = ret; 47162306a36Sopenharmony_ci spin_unlock(&dmxdevfilter->dev->lock); 47262306a36Sopenharmony_ci wake_up(&buffer->queue); 47362306a36Sopenharmony_ci return 0; 47462306a36Sopenharmony_ci} 47562306a36Sopenharmony_ci 47662306a36Sopenharmony_ci/* stop feed but only mark the specified filter as stopped (state set) */ 47762306a36Sopenharmony_cistatic int dvb_dmxdev_feed_stop(struct dmxdev_filter *dmxdevfilter) 47862306a36Sopenharmony_ci{ 47962306a36Sopenharmony_ci struct dmxdev_feed *feed; 48062306a36Sopenharmony_ci 48162306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET); 48262306a36Sopenharmony_ci 48362306a36Sopenharmony_ci switch (dmxdevfilter->type) { 48462306a36Sopenharmony_ci case DMXDEV_TYPE_SEC: 48562306a36Sopenharmony_ci del_timer(&dmxdevfilter->timer); 48662306a36Sopenharmony_ci dmxdevfilter->feed.sec->stop_filtering(dmxdevfilter->feed.sec); 48762306a36Sopenharmony_ci break; 48862306a36Sopenharmony_ci case DMXDEV_TYPE_PES: 48962306a36Sopenharmony_ci list_for_each_entry(feed, &dmxdevfilter->feed.ts, next) 49062306a36Sopenharmony_ci feed->ts->stop_filtering(feed->ts); 49162306a36Sopenharmony_ci break; 49262306a36Sopenharmony_ci default: 49362306a36Sopenharmony_ci return -EINVAL; 49462306a36Sopenharmony_ci } 49562306a36Sopenharmony_ci return 0; 49662306a36Sopenharmony_ci} 49762306a36Sopenharmony_ci 49862306a36Sopenharmony_ci/* start feed associated with the specified filter */ 49962306a36Sopenharmony_cistatic int dvb_dmxdev_feed_start(struct dmxdev_filter *filter) 50062306a36Sopenharmony_ci{ 50162306a36Sopenharmony_ci struct dmxdev_feed *feed; 50262306a36Sopenharmony_ci int ret; 50362306a36Sopenharmony_ci 50462306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(filter, DMXDEV_STATE_GO); 50562306a36Sopenharmony_ci 50662306a36Sopenharmony_ci switch (filter->type) { 50762306a36Sopenharmony_ci case DMXDEV_TYPE_SEC: 50862306a36Sopenharmony_ci return filter->feed.sec->start_filtering(filter->feed.sec); 50962306a36Sopenharmony_ci case DMXDEV_TYPE_PES: 51062306a36Sopenharmony_ci list_for_each_entry(feed, &filter->feed.ts, next) { 51162306a36Sopenharmony_ci ret = feed->ts->start_filtering(feed->ts); 51262306a36Sopenharmony_ci if (ret < 0) { 51362306a36Sopenharmony_ci dvb_dmxdev_feed_stop(filter); 51462306a36Sopenharmony_ci return ret; 51562306a36Sopenharmony_ci } 51662306a36Sopenharmony_ci } 51762306a36Sopenharmony_ci break; 51862306a36Sopenharmony_ci default: 51962306a36Sopenharmony_ci return -EINVAL; 52062306a36Sopenharmony_ci } 52162306a36Sopenharmony_ci 52262306a36Sopenharmony_ci return 0; 52362306a36Sopenharmony_ci} 52462306a36Sopenharmony_ci 52562306a36Sopenharmony_ci/* restart section feed if it has filters left associated with it, 52662306a36Sopenharmony_ci otherwise release the feed */ 52762306a36Sopenharmony_cistatic int dvb_dmxdev_feed_restart(struct dmxdev_filter *filter) 52862306a36Sopenharmony_ci{ 52962306a36Sopenharmony_ci int i; 53062306a36Sopenharmony_ci struct dmxdev *dmxdev = filter->dev; 53162306a36Sopenharmony_ci u16 pid = filter->params.sec.pid; 53262306a36Sopenharmony_ci 53362306a36Sopenharmony_ci for (i = 0; i < dmxdev->filternum; i++) 53462306a36Sopenharmony_ci if (dmxdev->filter[i].state >= DMXDEV_STATE_GO && 53562306a36Sopenharmony_ci dmxdev->filter[i].type == DMXDEV_TYPE_SEC && 53662306a36Sopenharmony_ci dmxdev->filter[i].params.sec.pid == pid) { 53762306a36Sopenharmony_ci dvb_dmxdev_feed_start(&dmxdev->filter[i]); 53862306a36Sopenharmony_ci return 0; 53962306a36Sopenharmony_ci } 54062306a36Sopenharmony_ci 54162306a36Sopenharmony_ci filter->dev->demux->release_section_feed(dmxdev->demux, 54262306a36Sopenharmony_ci filter->feed.sec); 54362306a36Sopenharmony_ci 54462306a36Sopenharmony_ci return 0; 54562306a36Sopenharmony_ci} 54662306a36Sopenharmony_ci 54762306a36Sopenharmony_cistatic int dvb_dmxdev_filter_stop(struct dmxdev_filter *dmxdevfilter) 54862306a36Sopenharmony_ci{ 54962306a36Sopenharmony_ci struct dmxdev_feed *feed; 55062306a36Sopenharmony_ci struct dmx_demux *demux; 55162306a36Sopenharmony_ci 55262306a36Sopenharmony_ci if (dmxdevfilter->state < DMXDEV_STATE_GO) 55362306a36Sopenharmony_ci return 0; 55462306a36Sopenharmony_ci 55562306a36Sopenharmony_ci switch (dmxdevfilter->type) { 55662306a36Sopenharmony_ci case DMXDEV_TYPE_SEC: 55762306a36Sopenharmony_ci if (!dmxdevfilter->feed.sec) 55862306a36Sopenharmony_ci break; 55962306a36Sopenharmony_ci dvb_dmxdev_feed_stop(dmxdevfilter); 56062306a36Sopenharmony_ci if (dmxdevfilter->filter.sec) 56162306a36Sopenharmony_ci dmxdevfilter->feed.sec-> 56262306a36Sopenharmony_ci release_filter(dmxdevfilter->feed.sec, 56362306a36Sopenharmony_ci dmxdevfilter->filter.sec); 56462306a36Sopenharmony_ci dvb_dmxdev_feed_restart(dmxdevfilter); 56562306a36Sopenharmony_ci dmxdevfilter->feed.sec = NULL; 56662306a36Sopenharmony_ci break; 56762306a36Sopenharmony_ci case DMXDEV_TYPE_PES: 56862306a36Sopenharmony_ci dvb_dmxdev_feed_stop(dmxdevfilter); 56962306a36Sopenharmony_ci demux = dmxdevfilter->dev->demux; 57062306a36Sopenharmony_ci list_for_each_entry(feed, &dmxdevfilter->feed.ts, next) { 57162306a36Sopenharmony_ci demux->release_ts_feed(demux, feed->ts); 57262306a36Sopenharmony_ci feed->ts = NULL; 57362306a36Sopenharmony_ci } 57462306a36Sopenharmony_ci break; 57562306a36Sopenharmony_ci default: 57662306a36Sopenharmony_ci if (dmxdevfilter->state == DMXDEV_STATE_ALLOCATED) 57762306a36Sopenharmony_ci return 0; 57862306a36Sopenharmony_ci return -EINVAL; 57962306a36Sopenharmony_ci } 58062306a36Sopenharmony_ci 58162306a36Sopenharmony_ci dvb_ringbuffer_flush(&dmxdevfilter->buffer); 58262306a36Sopenharmony_ci return 0; 58362306a36Sopenharmony_ci} 58462306a36Sopenharmony_ci 58562306a36Sopenharmony_cistatic void dvb_dmxdev_delete_pids(struct dmxdev_filter *dmxdevfilter) 58662306a36Sopenharmony_ci{ 58762306a36Sopenharmony_ci struct dmxdev_feed *feed, *tmp; 58862306a36Sopenharmony_ci 58962306a36Sopenharmony_ci /* delete all PIDs */ 59062306a36Sopenharmony_ci list_for_each_entry_safe(feed, tmp, &dmxdevfilter->feed.ts, next) { 59162306a36Sopenharmony_ci list_del(&feed->next); 59262306a36Sopenharmony_ci kfree(feed); 59362306a36Sopenharmony_ci } 59462306a36Sopenharmony_ci 59562306a36Sopenharmony_ci BUG_ON(!list_empty(&dmxdevfilter->feed.ts)); 59662306a36Sopenharmony_ci} 59762306a36Sopenharmony_ci 59862306a36Sopenharmony_cistatic inline int dvb_dmxdev_filter_reset(struct dmxdev_filter *dmxdevfilter) 59962306a36Sopenharmony_ci{ 60062306a36Sopenharmony_ci if (dmxdevfilter->state < DMXDEV_STATE_SET) 60162306a36Sopenharmony_ci return 0; 60262306a36Sopenharmony_ci 60362306a36Sopenharmony_ci if (dmxdevfilter->type == DMXDEV_TYPE_PES) 60462306a36Sopenharmony_ci dvb_dmxdev_delete_pids(dmxdevfilter); 60562306a36Sopenharmony_ci 60662306a36Sopenharmony_ci dmxdevfilter->type = DMXDEV_TYPE_NONE; 60762306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_ALLOCATED); 60862306a36Sopenharmony_ci return 0; 60962306a36Sopenharmony_ci} 61062306a36Sopenharmony_ci 61162306a36Sopenharmony_cistatic int dvb_dmxdev_start_feed(struct dmxdev *dmxdev, 61262306a36Sopenharmony_ci struct dmxdev_filter *filter, 61362306a36Sopenharmony_ci struct dmxdev_feed *feed) 61462306a36Sopenharmony_ci{ 61562306a36Sopenharmony_ci ktime_t timeout = ktime_set(0, 0); 61662306a36Sopenharmony_ci struct dmx_pes_filter_params *para = &filter->params.pes; 61762306a36Sopenharmony_ci enum dmx_output otype; 61862306a36Sopenharmony_ci int ret; 61962306a36Sopenharmony_ci int ts_type; 62062306a36Sopenharmony_ci enum dmx_ts_pes ts_pes; 62162306a36Sopenharmony_ci struct dmx_ts_feed *tsfeed; 62262306a36Sopenharmony_ci 62362306a36Sopenharmony_ci feed->ts = NULL; 62462306a36Sopenharmony_ci otype = para->output; 62562306a36Sopenharmony_ci 62662306a36Sopenharmony_ci ts_pes = para->pes_type; 62762306a36Sopenharmony_ci 62862306a36Sopenharmony_ci if (ts_pes < DMX_PES_OTHER) 62962306a36Sopenharmony_ci ts_type = TS_DECODER; 63062306a36Sopenharmony_ci else 63162306a36Sopenharmony_ci ts_type = 0; 63262306a36Sopenharmony_ci 63362306a36Sopenharmony_ci if (otype == DMX_OUT_TS_TAP) 63462306a36Sopenharmony_ci ts_type |= TS_PACKET; 63562306a36Sopenharmony_ci else if (otype == DMX_OUT_TSDEMUX_TAP) 63662306a36Sopenharmony_ci ts_type |= TS_PACKET | TS_DEMUX; 63762306a36Sopenharmony_ci else if (otype == DMX_OUT_TAP) 63862306a36Sopenharmony_ci ts_type |= TS_PACKET | TS_DEMUX | TS_PAYLOAD_ONLY; 63962306a36Sopenharmony_ci 64062306a36Sopenharmony_ci ret = dmxdev->demux->allocate_ts_feed(dmxdev->demux, &feed->ts, 64162306a36Sopenharmony_ci dvb_dmxdev_ts_callback); 64262306a36Sopenharmony_ci if (ret < 0) 64362306a36Sopenharmony_ci return ret; 64462306a36Sopenharmony_ci 64562306a36Sopenharmony_ci tsfeed = feed->ts; 64662306a36Sopenharmony_ci tsfeed->priv = filter; 64762306a36Sopenharmony_ci 64862306a36Sopenharmony_ci ret = tsfeed->set(tsfeed, feed->pid, ts_type, ts_pes, timeout); 64962306a36Sopenharmony_ci if (ret < 0) { 65062306a36Sopenharmony_ci dmxdev->demux->release_ts_feed(dmxdev->demux, tsfeed); 65162306a36Sopenharmony_ci return ret; 65262306a36Sopenharmony_ci } 65362306a36Sopenharmony_ci 65462306a36Sopenharmony_ci ret = tsfeed->start_filtering(tsfeed); 65562306a36Sopenharmony_ci if (ret < 0) { 65662306a36Sopenharmony_ci dmxdev->demux->release_ts_feed(dmxdev->demux, tsfeed); 65762306a36Sopenharmony_ci return ret; 65862306a36Sopenharmony_ci } 65962306a36Sopenharmony_ci 66062306a36Sopenharmony_ci return 0; 66162306a36Sopenharmony_ci} 66262306a36Sopenharmony_ci 66362306a36Sopenharmony_cistatic int dvb_dmxdev_filter_start(struct dmxdev_filter *filter) 66462306a36Sopenharmony_ci{ 66562306a36Sopenharmony_ci struct dmxdev *dmxdev = filter->dev; 66662306a36Sopenharmony_ci struct dmxdev_feed *feed; 66762306a36Sopenharmony_ci void *mem; 66862306a36Sopenharmony_ci int ret, i; 66962306a36Sopenharmony_ci 67062306a36Sopenharmony_ci if (filter->state < DMXDEV_STATE_SET) 67162306a36Sopenharmony_ci return -EINVAL; 67262306a36Sopenharmony_ci 67362306a36Sopenharmony_ci if (filter->state >= DMXDEV_STATE_GO) 67462306a36Sopenharmony_ci dvb_dmxdev_filter_stop(filter); 67562306a36Sopenharmony_ci 67662306a36Sopenharmony_ci if (!filter->buffer.data) { 67762306a36Sopenharmony_ci mem = vmalloc(filter->buffer.size); 67862306a36Sopenharmony_ci if (!mem) 67962306a36Sopenharmony_ci return -ENOMEM; 68062306a36Sopenharmony_ci spin_lock_irq(&filter->dev->lock); 68162306a36Sopenharmony_ci filter->buffer.data = mem; 68262306a36Sopenharmony_ci spin_unlock_irq(&filter->dev->lock); 68362306a36Sopenharmony_ci } 68462306a36Sopenharmony_ci 68562306a36Sopenharmony_ci dvb_ringbuffer_flush(&filter->buffer); 68662306a36Sopenharmony_ci 68762306a36Sopenharmony_ci switch (filter->type) { 68862306a36Sopenharmony_ci case DMXDEV_TYPE_SEC: 68962306a36Sopenharmony_ci { 69062306a36Sopenharmony_ci struct dmx_sct_filter_params *para = &filter->params.sec; 69162306a36Sopenharmony_ci struct dmx_section_filter **secfilter = &filter->filter.sec; 69262306a36Sopenharmony_ci struct dmx_section_feed **secfeed = &filter->feed.sec; 69362306a36Sopenharmony_ci 69462306a36Sopenharmony_ci *secfilter = NULL; 69562306a36Sopenharmony_ci *secfeed = NULL; 69662306a36Sopenharmony_ci 69762306a36Sopenharmony_ci 69862306a36Sopenharmony_ci /* find active filter/feed with same PID */ 69962306a36Sopenharmony_ci for (i = 0; i < dmxdev->filternum; i++) { 70062306a36Sopenharmony_ci if (dmxdev->filter[i].state >= DMXDEV_STATE_GO && 70162306a36Sopenharmony_ci dmxdev->filter[i].type == DMXDEV_TYPE_SEC && 70262306a36Sopenharmony_ci dmxdev->filter[i].params.sec.pid == para->pid) { 70362306a36Sopenharmony_ci *secfeed = dmxdev->filter[i].feed.sec; 70462306a36Sopenharmony_ci break; 70562306a36Sopenharmony_ci } 70662306a36Sopenharmony_ci } 70762306a36Sopenharmony_ci 70862306a36Sopenharmony_ci /* if no feed found, try to allocate new one */ 70962306a36Sopenharmony_ci if (!*secfeed) { 71062306a36Sopenharmony_ci ret = dmxdev->demux->allocate_section_feed(dmxdev->demux, 71162306a36Sopenharmony_ci secfeed, 71262306a36Sopenharmony_ci dvb_dmxdev_section_callback); 71362306a36Sopenharmony_ci if (!*secfeed) { 71462306a36Sopenharmony_ci pr_err("DVB (%s): could not alloc feed\n", 71562306a36Sopenharmony_ci __func__); 71662306a36Sopenharmony_ci return ret; 71762306a36Sopenharmony_ci } 71862306a36Sopenharmony_ci 71962306a36Sopenharmony_ci ret = (*secfeed)->set(*secfeed, para->pid, 72062306a36Sopenharmony_ci (para->flags & DMX_CHECK_CRC) ? 1 : 0); 72162306a36Sopenharmony_ci if (ret < 0) { 72262306a36Sopenharmony_ci pr_err("DVB (%s): could not set feed\n", 72362306a36Sopenharmony_ci __func__); 72462306a36Sopenharmony_ci dvb_dmxdev_feed_restart(filter); 72562306a36Sopenharmony_ci return ret; 72662306a36Sopenharmony_ci } 72762306a36Sopenharmony_ci } else { 72862306a36Sopenharmony_ci dvb_dmxdev_feed_stop(filter); 72962306a36Sopenharmony_ci } 73062306a36Sopenharmony_ci 73162306a36Sopenharmony_ci ret = (*secfeed)->allocate_filter(*secfeed, secfilter); 73262306a36Sopenharmony_ci if (ret < 0) { 73362306a36Sopenharmony_ci dvb_dmxdev_feed_restart(filter); 73462306a36Sopenharmony_ci filter->feed.sec->start_filtering(*secfeed); 73562306a36Sopenharmony_ci dprintk("could not get filter\n"); 73662306a36Sopenharmony_ci return ret; 73762306a36Sopenharmony_ci } 73862306a36Sopenharmony_ci 73962306a36Sopenharmony_ci (*secfilter)->priv = filter; 74062306a36Sopenharmony_ci 74162306a36Sopenharmony_ci memcpy(&((*secfilter)->filter_value[3]), 74262306a36Sopenharmony_ci &(para->filter.filter[1]), DMX_FILTER_SIZE - 1); 74362306a36Sopenharmony_ci memcpy(&(*secfilter)->filter_mask[3], 74462306a36Sopenharmony_ci ¶->filter.mask[1], DMX_FILTER_SIZE - 1); 74562306a36Sopenharmony_ci memcpy(&(*secfilter)->filter_mode[3], 74662306a36Sopenharmony_ci ¶->filter.mode[1], DMX_FILTER_SIZE - 1); 74762306a36Sopenharmony_ci 74862306a36Sopenharmony_ci (*secfilter)->filter_value[0] = para->filter.filter[0]; 74962306a36Sopenharmony_ci (*secfilter)->filter_mask[0] = para->filter.mask[0]; 75062306a36Sopenharmony_ci (*secfilter)->filter_mode[0] = para->filter.mode[0]; 75162306a36Sopenharmony_ci (*secfilter)->filter_mask[1] = 0; 75262306a36Sopenharmony_ci (*secfilter)->filter_mask[2] = 0; 75362306a36Sopenharmony_ci 75462306a36Sopenharmony_ci filter->todo = 0; 75562306a36Sopenharmony_ci 75662306a36Sopenharmony_ci ret = filter->feed.sec->start_filtering(filter->feed.sec); 75762306a36Sopenharmony_ci if (ret < 0) 75862306a36Sopenharmony_ci return ret; 75962306a36Sopenharmony_ci 76062306a36Sopenharmony_ci dvb_dmxdev_filter_timer(filter); 76162306a36Sopenharmony_ci break; 76262306a36Sopenharmony_ci } 76362306a36Sopenharmony_ci case DMXDEV_TYPE_PES: 76462306a36Sopenharmony_ci list_for_each_entry(feed, &filter->feed.ts, next) { 76562306a36Sopenharmony_ci ret = dvb_dmxdev_start_feed(dmxdev, filter, feed); 76662306a36Sopenharmony_ci if (ret < 0) { 76762306a36Sopenharmony_ci dvb_dmxdev_filter_stop(filter); 76862306a36Sopenharmony_ci return ret; 76962306a36Sopenharmony_ci } 77062306a36Sopenharmony_ci } 77162306a36Sopenharmony_ci break; 77262306a36Sopenharmony_ci default: 77362306a36Sopenharmony_ci return -EINVAL; 77462306a36Sopenharmony_ci } 77562306a36Sopenharmony_ci 77662306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(filter, DMXDEV_STATE_GO); 77762306a36Sopenharmony_ci return 0; 77862306a36Sopenharmony_ci} 77962306a36Sopenharmony_ci 78062306a36Sopenharmony_cistatic int dvb_demux_open(struct inode *inode, struct file *file) 78162306a36Sopenharmony_ci{ 78262306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 78362306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 78462306a36Sopenharmony_ci int i; 78562306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter; 78662306a36Sopenharmony_ci 78762306a36Sopenharmony_ci if (!dmxdev->filter) 78862306a36Sopenharmony_ci return -EINVAL; 78962306a36Sopenharmony_ci 79062306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdev->mutex)) 79162306a36Sopenharmony_ci return -ERESTARTSYS; 79262306a36Sopenharmony_ci 79362306a36Sopenharmony_ci if (dmxdev->exit) { 79462306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 79562306a36Sopenharmony_ci return -ENODEV; 79662306a36Sopenharmony_ci } 79762306a36Sopenharmony_ci 79862306a36Sopenharmony_ci for (i = 0; i < dmxdev->filternum; i++) 79962306a36Sopenharmony_ci if (dmxdev->filter[i].state == DMXDEV_STATE_FREE) 80062306a36Sopenharmony_ci break; 80162306a36Sopenharmony_ci 80262306a36Sopenharmony_ci if (i == dmxdev->filternum) { 80362306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 80462306a36Sopenharmony_ci return -EMFILE; 80562306a36Sopenharmony_ci } 80662306a36Sopenharmony_ci 80762306a36Sopenharmony_ci dmxdevfilter = &dmxdev->filter[i]; 80862306a36Sopenharmony_ci mutex_init(&dmxdevfilter->mutex); 80962306a36Sopenharmony_ci file->private_data = dmxdevfilter; 81062306a36Sopenharmony_ci 81162306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 81262306a36Sopenharmony_ci dmxdev->may_do_mmap = 1; 81362306a36Sopenharmony_ci#else 81462306a36Sopenharmony_ci dmxdev->may_do_mmap = 0; 81562306a36Sopenharmony_ci#endif 81662306a36Sopenharmony_ci 81762306a36Sopenharmony_ci dvb_ringbuffer_init(&dmxdevfilter->buffer, NULL, 8192); 81862306a36Sopenharmony_ci dvb_vb2_init(&dmxdevfilter->vb2_ctx, "demux_filter", 81962306a36Sopenharmony_ci file->f_flags & O_NONBLOCK); 82062306a36Sopenharmony_ci dmxdevfilter->type = DMXDEV_TYPE_NONE; 82162306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_ALLOCATED); 82262306a36Sopenharmony_ci timer_setup(&dmxdevfilter->timer, dvb_dmxdev_filter_timeout, 0); 82362306a36Sopenharmony_ci 82462306a36Sopenharmony_ci dvbdev->users++; 82562306a36Sopenharmony_ci 82662306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 82762306a36Sopenharmony_ci return 0; 82862306a36Sopenharmony_ci} 82962306a36Sopenharmony_ci 83062306a36Sopenharmony_cistatic int dvb_dmxdev_filter_free(struct dmxdev *dmxdev, 83162306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter) 83262306a36Sopenharmony_ci{ 83362306a36Sopenharmony_ci mutex_lock(&dmxdev->mutex); 83462306a36Sopenharmony_ci mutex_lock(&dmxdevfilter->mutex); 83562306a36Sopenharmony_ci if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx)) 83662306a36Sopenharmony_ci dvb_vb2_stream_off(&dmxdevfilter->vb2_ctx); 83762306a36Sopenharmony_ci dvb_vb2_release(&dmxdevfilter->vb2_ctx); 83862306a36Sopenharmony_ci 83962306a36Sopenharmony_ci 84062306a36Sopenharmony_ci dvb_dmxdev_filter_stop(dmxdevfilter); 84162306a36Sopenharmony_ci dvb_dmxdev_filter_reset(dmxdevfilter); 84262306a36Sopenharmony_ci 84362306a36Sopenharmony_ci if (dmxdevfilter->buffer.data) { 84462306a36Sopenharmony_ci void *mem = dmxdevfilter->buffer.data; 84562306a36Sopenharmony_ci 84662306a36Sopenharmony_ci spin_lock_irq(&dmxdev->lock); 84762306a36Sopenharmony_ci dmxdevfilter->buffer.data = NULL; 84862306a36Sopenharmony_ci spin_unlock_irq(&dmxdev->lock); 84962306a36Sopenharmony_ci vfree(mem); 85062306a36Sopenharmony_ci } 85162306a36Sopenharmony_ci 85262306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_FREE); 85362306a36Sopenharmony_ci wake_up(&dmxdevfilter->buffer.queue); 85462306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 85562306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 85662306a36Sopenharmony_ci return 0; 85762306a36Sopenharmony_ci} 85862306a36Sopenharmony_ci 85962306a36Sopenharmony_cistatic inline void invert_mode(struct dmx_filter *filter) 86062306a36Sopenharmony_ci{ 86162306a36Sopenharmony_ci int i; 86262306a36Sopenharmony_ci 86362306a36Sopenharmony_ci for (i = 0; i < DMX_FILTER_SIZE; i++) 86462306a36Sopenharmony_ci filter->mode[i] ^= 0xff; 86562306a36Sopenharmony_ci} 86662306a36Sopenharmony_ci 86762306a36Sopenharmony_cistatic int dvb_dmxdev_add_pid(struct dmxdev *dmxdev, 86862306a36Sopenharmony_ci struct dmxdev_filter *filter, u16 pid) 86962306a36Sopenharmony_ci{ 87062306a36Sopenharmony_ci struct dmxdev_feed *feed; 87162306a36Sopenharmony_ci 87262306a36Sopenharmony_ci if ((filter->type != DMXDEV_TYPE_PES) || 87362306a36Sopenharmony_ci (filter->state < DMXDEV_STATE_SET)) 87462306a36Sopenharmony_ci return -EINVAL; 87562306a36Sopenharmony_ci 87662306a36Sopenharmony_ci /* only TS packet filters may have multiple PIDs */ 87762306a36Sopenharmony_ci if ((filter->params.pes.output != DMX_OUT_TSDEMUX_TAP) && 87862306a36Sopenharmony_ci (!list_empty(&filter->feed.ts))) 87962306a36Sopenharmony_ci return -EINVAL; 88062306a36Sopenharmony_ci 88162306a36Sopenharmony_ci feed = kzalloc(sizeof(struct dmxdev_feed), GFP_KERNEL); 88262306a36Sopenharmony_ci if (feed == NULL) 88362306a36Sopenharmony_ci return -ENOMEM; 88462306a36Sopenharmony_ci 88562306a36Sopenharmony_ci feed->pid = pid; 88662306a36Sopenharmony_ci list_add(&feed->next, &filter->feed.ts); 88762306a36Sopenharmony_ci 88862306a36Sopenharmony_ci if (filter->state >= DMXDEV_STATE_GO) 88962306a36Sopenharmony_ci return dvb_dmxdev_start_feed(dmxdev, filter, feed); 89062306a36Sopenharmony_ci 89162306a36Sopenharmony_ci return 0; 89262306a36Sopenharmony_ci} 89362306a36Sopenharmony_ci 89462306a36Sopenharmony_cistatic int dvb_dmxdev_remove_pid(struct dmxdev *dmxdev, 89562306a36Sopenharmony_ci struct dmxdev_filter *filter, u16 pid) 89662306a36Sopenharmony_ci{ 89762306a36Sopenharmony_ci struct dmxdev_feed *feed, *tmp; 89862306a36Sopenharmony_ci 89962306a36Sopenharmony_ci if ((filter->type != DMXDEV_TYPE_PES) || 90062306a36Sopenharmony_ci (filter->state < DMXDEV_STATE_SET)) 90162306a36Sopenharmony_ci return -EINVAL; 90262306a36Sopenharmony_ci 90362306a36Sopenharmony_ci list_for_each_entry_safe(feed, tmp, &filter->feed.ts, next) { 90462306a36Sopenharmony_ci if ((feed->pid == pid) && (feed->ts != NULL)) { 90562306a36Sopenharmony_ci feed->ts->stop_filtering(feed->ts); 90662306a36Sopenharmony_ci filter->dev->demux->release_ts_feed(filter->dev->demux, 90762306a36Sopenharmony_ci feed->ts); 90862306a36Sopenharmony_ci list_del(&feed->next); 90962306a36Sopenharmony_ci kfree(feed); 91062306a36Sopenharmony_ci } 91162306a36Sopenharmony_ci } 91262306a36Sopenharmony_ci 91362306a36Sopenharmony_ci return 0; 91462306a36Sopenharmony_ci} 91562306a36Sopenharmony_ci 91662306a36Sopenharmony_cistatic int dvb_dmxdev_filter_set(struct dmxdev *dmxdev, 91762306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter, 91862306a36Sopenharmony_ci struct dmx_sct_filter_params *params) 91962306a36Sopenharmony_ci{ 92062306a36Sopenharmony_ci dprintk("%s: PID=0x%04x, flags=%02x, timeout=%d\n", 92162306a36Sopenharmony_ci __func__, params->pid, params->flags, params->timeout); 92262306a36Sopenharmony_ci 92362306a36Sopenharmony_ci dvb_dmxdev_filter_stop(dmxdevfilter); 92462306a36Sopenharmony_ci 92562306a36Sopenharmony_ci dmxdevfilter->type = DMXDEV_TYPE_SEC; 92662306a36Sopenharmony_ci memcpy(&dmxdevfilter->params.sec, 92762306a36Sopenharmony_ci params, sizeof(struct dmx_sct_filter_params)); 92862306a36Sopenharmony_ci invert_mode(&dmxdevfilter->params.sec.filter); 92962306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET); 93062306a36Sopenharmony_ci 93162306a36Sopenharmony_ci if (params->flags & DMX_IMMEDIATE_START) 93262306a36Sopenharmony_ci return dvb_dmxdev_filter_start(dmxdevfilter); 93362306a36Sopenharmony_ci 93462306a36Sopenharmony_ci return 0; 93562306a36Sopenharmony_ci} 93662306a36Sopenharmony_ci 93762306a36Sopenharmony_cistatic int dvb_dmxdev_pes_filter_set(struct dmxdev *dmxdev, 93862306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter, 93962306a36Sopenharmony_ci struct dmx_pes_filter_params *params) 94062306a36Sopenharmony_ci{ 94162306a36Sopenharmony_ci int ret; 94262306a36Sopenharmony_ci 94362306a36Sopenharmony_ci dvb_dmxdev_filter_stop(dmxdevfilter); 94462306a36Sopenharmony_ci dvb_dmxdev_filter_reset(dmxdevfilter); 94562306a36Sopenharmony_ci 94662306a36Sopenharmony_ci if ((unsigned int)params->pes_type > DMX_PES_OTHER) 94762306a36Sopenharmony_ci return -EINVAL; 94862306a36Sopenharmony_ci 94962306a36Sopenharmony_ci dmxdevfilter->type = DMXDEV_TYPE_PES; 95062306a36Sopenharmony_ci memcpy(&dmxdevfilter->params, params, 95162306a36Sopenharmony_ci sizeof(struct dmx_pes_filter_params)); 95262306a36Sopenharmony_ci INIT_LIST_HEAD(&dmxdevfilter->feed.ts); 95362306a36Sopenharmony_ci 95462306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(dmxdevfilter, DMXDEV_STATE_SET); 95562306a36Sopenharmony_ci 95662306a36Sopenharmony_ci ret = dvb_dmxdev_add_pid(dmxdev, dmxdevfilter, 95762306a36Sopenharmony_ci dmxdevfilter->params.pes.pid); 95862306a36Sopenharmony_ci if (ret < 0) 95962306a36Sopenharmony_ci return ret; 96062306a36Sopenharmony_ci 96162306a36Sopenharmony_ci if (params->flags & DMX_IMMEDIATE_START) 96262306a36Sopenharmony_ci return dvb_dmxdev_filter_start(dmxdevfilter); 96362306a36Sopenharmony_ci 96462306a36Sopenharmony_ci return 0; 96562306a36Sopenharmony_ci} 96662306a36Sopenharmony_ci 96762306a36Sopenharmony_cistatic ssize_t dvb_dmxdev_read_sec(struct dmxdev_filter *dfil, 96862306a36Sopenharmony_ci struct file *file, char __user *buf, 96962306a36Sopenharmony_ci size_t count, loff_t *ppos) 97062306a36Sopenharmony_ci{ 97162306a36Sopenharmony_ci int result, hcount; 97262306a36Sopenharmony_ci int done = 0; 97362306a36Sopenharmony_ci 97462306a36Sopenharmony_ci if (dfil->todo <= 0) { 97562306a36Sopenharmony_ci hcount = 3 + dfil->todo; 97662306a36Sopenharmony_ci if (hcount > count) 97762306a36Sopenharmony_ci hcount = count; 97862306a36Sopenharmony_ci result = dvb_dmxdev_buffer_read(&dfil->buffer, 97962306a36Sopenharmony_ci file->f_flags & O_NONBLOCK, 98062306a36Sopenharmony_ci buf, hcount, ppos); 98162306a36Sopenharmony_ci if (result < 0) { 98262306a36Sopenharmony_ci dfil->todo = 0; 98362306a36Sopenharmony_ci return result; 98462306a36Sopenharmony_ci } 98562306a36Sopenharmony_ci if (copy_from_user(dfil->secheader - dfil->todo, buf, result)) 98662306a36Sopenharmony_ci return -EFAULT; 98762306a36Sopenharmony_ci buf += result; 98862306a36Sopenharmony_ci done = result; 98962306a36Sopenharmony_ci count -= result; 99062306a36Sopenharmony_ci dfil->todo -= result; 99162306a36Sopenharmony_ci if (dfil->todo > -3) 99262306a36Sopenharmony_ci return done; 99362306a36Sopenharmony_ci dfil->todo = ((dfil->secheader[1] << 8) | dfil->secheader[2]) & 0xfff; 99462306a36Sopenharmony_ci if (!count) 99562306a36Sopenharmony_ci return done; 99662306a36Sopenharmony_ci } 99762306a36Sopenharmony_ci if (count > dfil->todo) 99862306a36Sopenharmony_ci count = dfil->todo; 99962306a36Sopenharmony_ci result = dvb_dmxdev_buffer_read(&dfil->buffer, 100062306a36Sopenharmony_ci file->f_flags & O_NONBLOCK, 100162306a36Sopenharmony_ci buf, count, ppos); 100262306a36Sopenharmony_ci if (result < 0) 100362306a36Sopenharmony_ci return result; 100462306a36Sopenharmony_ci dfil->todo -= result; 100562306a36Sopenharmony_ci return (result + done); 100662306a36Sopenharmony_ci} 100762306a36Sopenharmony_ci 100862306a36Sopenharmony_cistatic ssize_t 100962306a36Sopenharmony_cidvb_demux_read(struct file *file, char __user *buf, size_t count, 101062306a36Sopenharmony_ci loff_t *ppos) 101162306a36Sopenharmony_ci{ 101262306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = file->private_data; 101362306a36Sopenharmony_ci int ret; 101462306a36Sopenharmony_ci 101562306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) 101662306a36Sopenharmony_ci return -ERESTARTSYS; 101762306a36Sopenharmony_ci 101862306a36Sopenharmony_ci if (dmxdevfilter->type == DMXDEV_TYPE_SEC) 101962306a36Sopenharmony_ci ret = dvb_dmxdev_read_sec(dmxdevfilter, file, buf, count, ppos); 102062306a36Sopenharmony_ci else 102162306a36Sopenharmony_ci ret = dvb_dmxdev_buffer_read(&dmxdevfilter->buffer, 102262306a36Sopenharmony_ci file->f_flags & O_NONBLOCK, 102362306a36Sopenharmony_ci buf, count, ppos); 102462306a36Sopenharmony_ci 102562306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 102662306a36Sopenharmony_ci return ret; 102762306a36Sopenharmony_ci} 102862306a36Sopenharmony_ci 102962306a36Sopenharmony_cistatic int dvb_demux_do_ioctl(struct file *file, 103062306a36Sopenharmony_ci unsigned int cmd, void *parg) 103162306a36Sopenharmony_ci{ 103262306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = file->private_data; 103362306a36Sopenharmony_ci struct dmxdev *dmxdev = dmxdevfilter->dev; 103462306a36Sopenharmony_ci unsigned long arg = (unsigned long)parg; 103562306a36Sopenharmony_ci int ret = 0; 103662306a36Sopenharmony_ci 103762306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdev->mutex)) 103862306a36Sopenharmony_ci return -ERESTARTSYS; 103962306a36Sopenharmony_ci 104062306a36Sopenharmony_ci switch (cmd) { 104162306a36Sopenharmony_ci case DMX_START: 104262306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 104362306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 104462306a36Sopenharmony_ci return -ERESTARTSYS; 104562306a36Sopenharmony_ci } 104662306a36Sopenharmony_ci if (dmxdevfilter->state < DMXDEV_STATE_SET) 104762306a36Sopenharmony_ci ret = -EINVAL; 104862306a36Sopenharmony_ci else 104962306a36Sopenharmony_ci ret = dvb_dmxdev_filter_start(dmxdevfilter); 105062306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 105162306a36Sopenharmony_ci break; 105262306a36Sopenharmony_ci 105362306a36Sopenharmony_ci case DMX_STOP: 105462306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 105562306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 105662306a36Sopenharmony_ci return -ERESTARTSYS; 105762306a36Sopenharmony_ci } 105862306a36Sopenharmony_ci ret = dvb_dmxdev_filter_stop(dmxdevfilter); 105962306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 106062306a36Sopenharmony_ci break; 106162306a36Sopenharmony_ci 106262306a36Sopenharmony_ci case DMX_SET_FILTER: 106362306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 106462306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 106562306a36Sopenharmony_ci return -ERESTARTSYS; 106662306a36Sopenharmony_ci } 106762306a36Sopenharmony_ci ret = dvb_dmxdev_filter_set(dmxdev, dmxdevfilter, parg); 106862306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 106962306a36Sopenharmony_ci break; 107062306a36Sopenharmony_ci 107162306a36Sopenharmony_ci case DMX_SET_PES_FILTER: 107262306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 107362306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 107462306a36Sopenharmony_ci return -ERESTARTSYS; 107562306a36Sopenharmony_ci } 107662306a36Sopenharmony_ci ret = dvb_dmxdev_pes_filter_set(dmxdev, dmxdevfilter, parg); 107762306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 107862306a36Sopenharmony_ci break; 107962306a36Sopenharmony_ci 108062306a36Sopenharmony_ci case DMX_SET_BUFFER_SIZE: 108162306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 108262306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 108362306a36Sopenharmony_ci return -ERESTARTSYS; 108462306a36Sopenharmony_ci } 108562306a36Sopenharmony_ci ret = dvb_dmxdev_set_buffer_size(dmxdevfilter, arg); 108662306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 108762306a36Sopenharmony_ci break; 108862306a36Sopenharmony_ci 108962306a36Sopenharmony_ci case DMX_GET_PES_PIDS: 109062306a36Sopenharmony_ci if (!dmxdev->demux->get_pes_pids) { 109162306a36Sopenharmony_ci ret = -EINVAL; 109262306a36Sopenharmony_ci break; 109362306a36Sopenharmony_ci } 109462306a36Sopenharmony_ci dmxdev->demux->get_pes_pids(dmxdev->demux, parg); 109562306a36Sopenharmony_ci break; 109662306a36Sopenharmony_ci 109762306a36Sopenharmony_ci case DMX_GET_STC: 109862306a36Sopenharmony_ci if (!dmxdev->demux->get_stc) { 109962306a36Sopenharmony_ci ret = -EINVAL; 110062306a36Sopenharmony_ci break; 110162306a36Sopenharmony_ci } 110262306a36Sopenharmony_ci ret = dmxdev->demux->get_stc(dmxdev->demux, 110362306a36Sopenharmony_ci ((struct dmx_stc *)parg)->num, 110462306a36Sopenharmony_ci &((struct dmx_stc *)parg)->stc, 110562306a36Sopenharmony_ci &((struct dmx_stc *)parg)->base); 110662306a36Sopenharmony_ci break; 110762306a36Sopenharmony_ci 110862306a36Sopenharmony_ci case DMX_ADD_PID: 110962306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 111062306a36Sopenharmony_ci ret = -ERESTARTSYS; 111162306a36Sopenharmony_ci break; 111262306a36Sopenharmony_ci } 111362306a36Sopenharmony_ci ret = dvb_dmxdev_add_pid(dmxdev, dmxdevfilter, *(u16 *)parg); 111462306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 111562306a36Sopenharmony_ci break; 111662306a36Sopenharmony_ci 111762306a36Sopenharmony_ci case DMX_REMOVE_PID: 111862306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 111962306a36Sopenharmony_ci ret = -ERESTARTSYS; 112062306a36Sopenharmony_ci break; 112162306a36Sopenharmony_ci } 112262306a36Sopenharmony_ci ret = dvb_dmxdev_remove_pid(dmxdev, dmxdevfilter, *(u16 *)parg); 112362306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 112462306a36Sopenharmony_ci break; 112562306a36Sopenharmony_ci 112662306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 112762306a36Sopenharmony_ci case DMX_REQBUFS: 112862306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 112962306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 113062306a36Sopenharmony_ci return -ERESTARTSYS; 113162306a36Sopenharmony_ci } 113262306a36Sopenharmony_ci ret = dvb_vb2_reqbufs(&dmxdevfilter->vb2_ctx, parg); 113362306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 113462306a36Sopenharmony_ci break; 113562306a36Sopenharmony_ci 113662306a36Sopenharmony_ci case DMX_QUERYBUF: 113762306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 113862306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 113962306a36Sopenharmony_ci return -ERESTARTSYS; 114062306a36Sopenharmony_ci } 114162306a36Sopenharmony_ci ret = dvb_vb2_querybuf(&dmxdevfilter->vb2_ctx, parg); 114262306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 114362306a36Sopenharmony_ci break; 114462306a36Sopenharmony_ci 114562306a36Sopenharmony_ci case DMX_EXPBUF: 114662306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 114762306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 114862306a36Sopenharmony_ci return -ERESTARTSYS; 114962306a36Sopenharmony_ci } 115062306a36Sopenharmony_ci ret = dvb_vb2_expbuf(&dmxdevfilter->vb2_ctx, parg); 115162306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 115262306a36Sopenharmony_ci break; 115362306a36Sopenharmony_ci 115462306a36Sopenharmony_ci case DMX_QBUF: 115562306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 115662306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 115762306a36Sopenharmony_ci return -ERESTARTSYS; 115862306a36Sopenharmony_ci } 115962306a36Sopenharmony_ci ret = dvb_vb2_qbuf(&dmxdevfilter->vb2_ctx, parg); 116062306a36Sopenharmony_ci if (ret == 0 && !dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx)) 116162306a36Sopenharmony_ci ret = dvb_vb2_stream_on(&dmxdevfilter->vb2_ctx); 116262306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 116362306a36Sopenharmony_ci break; 116462306a36Sopenharmony_ci 116562306a36Sopenharmony_ci case DMX_DQBUF: 116662306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 116762306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 116862306a36Sopenharmony_ci return -ERESTARTSYS; 116962306a36Sopenharmony_ci } 117062306a36Sopenharmony_ci ret = dvb_vb2_dqbuf(&dmxdevfilter->vb2_ctx, parg); 117162306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 117262306a36Sopenharmony_ci break; 117362306a36Sopenharmony_ci#endif 117462306a36Sopenharmony_ci default: 117562306a36Sopenharmony_ci ret = -ENOTTY; 117662306a36Sopenharmony_ci break; 117762306a36Sopenharmony_ci } 117862306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 117962306a36Sopenharmony_ci return ret; 118062306a36Sopenharmony_ci} 118162306a36Sopenharmony_ci 118262306a36Sopenharmony_cistatic long dvb_demux_ioctl(struct file *file, unsigned int cmd, 118362306a36Sopenharmony_ci unsigned long arg) 118462306a36Sopenharmony_ci{ 118562306a36Sopenharmony_ci return dvb_usercopy(file, cmd, arg, dvb_demux_do_ioctl); 118662306a36Sopenharmony_ci} 118762306a36Sopenharmony_ci 118862306a36Sopenharmony_cistatic __poll_t dvb_demux_poll(struct file *file, poll_table *wait) 118962306a36Sopenharmony_ci{ 119062306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = file->private_data; 119162306a36Sopenharmony_ci __poll_t mask = 0; 119262306a36Sopenharmony_ci 119362306a36Sopenharmony_ci poll_wait(file, &dmxdevfilter->buffer.queue, wait); 119462306a36Sopenharmony_ci 119562306a36Sopenharmony_ci if ((!dmxdevfilter) || dmxdevfilter->dev->exit) 119662306a36Sopenharmony_ci return EPOLLERR; 119762306a36Sopenharmony_ci if (dvb_vb2_is_streaming(&dmxdevfilter->vb2_ctx)) 119862306a36Sopenharmony_ci return dvb_vb2_poll(&dmxdevfilter->vb2_ctx, file, wait); 119962306a36Sopenharmony_ci 120062306a36Sopenharmony_ci if (dmxdevfilter->state != DMXDEV_STATE_GO && 120162306a36Sopenharmony_ci dmxdevfilter->state != DMXDEV_STATE_DONE && 120262306a36Sopenharmony_ci dmxdevfilter->state != DMXDEV_STATE_TIMEDOUT) 120362306a36Sopenharmony_ci return 0; 120462306a36Sopenharmony_ci 120562306a36Sopenharmony_ci if (dmxdevfilter->buffer.error) 120662306a36Sopenharmony_ci mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI | EPOLLERR); 120762306a36Sopenharmony_ci 120862306a36Sopenharmony_ci if (!dvb_ringbuffer_empty(&dmxdevfilter->buffer)) 120962306a36Sopenharmony_ci mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI); 121062306a36Sopenharmony_ci 121162306a36Sopenharmony_ci return mask; 121262306a36Sopenharmony_ci} 121362306a36Sopenharmony_ci 121462306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 121562306a36Sopenharmony_cistatic int dvb_demux_mmap(struct file *file, struct vm_area_struct *vma) 121662306a36Sopenharmony_ci{ 121762306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = file->private_data; 121862306a36Sopenharmony_ci struct dmxdev *dmxdev = dmxdevfilter->dev; 121962306a36Sopenharmony_ci int ret; 122062306a36Sopenharmony_ci 122162306a36Sopenharmony_ci if (!dmxdev->may_do_mmap) 122262306a36Sopenharmony_ci return -ENOTTY; 122362306a36Sopenharmony_ci 122462306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdev->mutex)) 122562306a36Sopenharmony_ci return -ERESTARTSYS; 122662306a36Sopenharmony_ci 122762306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdevfilter->mutex)) { 122862306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 122962306a36Sopenharmony_ci return -ERESTARTSYS; 123062306a36Sopenharmony_ci } 123162306a36Sopenharmony_ci ret = dvb_vb2_mmap(&dmxdevfilter->vb2_ctx, vma); 123262306a36Sopenharmony_ci 123362306a36Sopenharmony_ci mutex_unlock(&dmxdevfilter->mutex); 123462306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 123562306a36Sopenharmony_ci 123662306a36Sopenharmony_ci return ret; 123762306a36Sopenharmony_ci} 123862306a36Sopenharmony_ci#endif 123962306a36Sopenharmony_ci 124062306a36Sopenharmony_cistatic int dvb_demux_release(struct inode *inode, struct file *file) 124162306a36Sopenharmony_ci{ 124262306a36Sopenharmony_ci struct dmxdev_filter *dmxdevfilter = file->private_data; 124362306a36Sopenharmony_ci struct dmxdev *dmxdev = dmxdevfilter->dev; 124462306a36Sopenharmony_ci int ret; 124562306a36Sopenharmony_ci 124662306a36Sopenharmony_ci ret = dvb_dmxdev_filter_free(dmxdev, dmxdevfilter); 124762306a36Sopenharmony_ci 124862306a36Sopenharmony_ci mutex_lock(&dmxdev->mutex); 124962306a36Sopenharmony_ci dmxdev->dvbdev->users--; 125062306a36Sopenharmony_ci if (dmxdev->dvbdev->users == 1 && dmxdev->exit == 1) { 125162306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 125262306a36Sopenharmony_ci wake_up(&dmxdev->dvbdev->wait_queue); 125362306a36Sopenharmony_ci } else 125462306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 125562306a36Sopenharmony_ci 125662306a36Sopenharmony_ci return ret; 125762306a36Sopenharmony_ci} 125862306a36Sopenharmony_ci 125962306a36Sopenharmony_cistatic const struct file_operations dvb_demux_fops = { 126062306a36Sopenharmony_ci .owner = THIS_MODULE, 126162306a36Sopenharmony_ci .read = dvb_demux_read, 126262306a36Sopenharmony_ci .unlocked_ioctl = dvb_demux_ioctl, 126362306a36Sopenharmony_ci .compat_ioctl = dvb_demux_ioctl, 126462306a36Sopenharmony_ci .open = dvb_demux_open, 126562306a36Sopenharmony_ci .release = dvb_demux_release, 126662306a36Sopenharmony_ci .poll = dvb_demux_poll, 126762306a36Sopenharmony_ci .llseek = default_llseek, 126862306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 126962306a36Sopenharmony_ci .mmap = dvb_demux_mmap, 127062306a36Sopenharmony_ci#endif 127162306a36Sopenharmony_ci}; 127262306a36Sopenharmony_ci 127362306a36Sopenharmony_cistatic const struct dvb_device dvbdev_demux = { 127462306a36Sopenharmony_ci .priv = NULL, 127562306a36Sopenharmony_ci .users = 1, 127662306a36Sopenharmony_ci .writers = 1, 127762306a36Sopenharmony_ci#if defined(CONFIG_MEDIA_CONTROLLER_DVB) 127862306a36Sopenharmony_ci .name = "dvb-demux", 127962306a36Sopenharmony_ci#endif 128062306a36Sopenharmony_ci .fops = &dvb_demux_fops 128162306a36Sopenharmony_ci}; 128262306a36Sopenharmony_ci 128362306a36Sopenharmony_cistatic int dvb_dvr_do_ioctl(struct file *file, 128462306a36Sopenharmony_ci unsigned int cmd, void *parg) 128562306a36Sopenharmony_ci{ 128662306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 128762306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 128862306a36Sopenharmony_ci unsigned long arg = (unsigned long)parg; 128962306a36Sopenharmony_ci int ret; 129062306a36Sopenharmony_ci 129162306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdev->mutex)) 129262306a36Sopenharmony_ci return -ERESTARTSYS; 129362306a36Sopenharmony_ci 129462306a36Sopenharmony_ci switch (cmd) { 129562306a36Sopenharmony_ci case DMX_SET_BUFFER_SIZE: 129662306a36Sopenharmony_ci ret = dvb_dvr_set_buffer_size(dmxdev, arg); 129762306a36Sopenharmony_ci break; 129862306a36Sopenharmony_ci 129962306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 130062306a36Sopenharmony_ci case DMX_REQBUFS: 130162306a36Sopenharmony_ci ret = dvb_vb2_reqbufs(&dmxdev->dvr_vb2_ctx, parg); 130262306a36Sopenharmony_ci break; 130362306a36Sopenharmony_ci 130462306a36Sopenharmony_ci case DMX_QUERYBUF: 130562306a36Sopenharmony_ci ret = dvb_vb2_querybuf(&dmxdev->dvr_vb2_ctx, parg); 130662306a36Sopenharmony_ci break; 130762306a36Sopenharmony_ci 130862306a36Sopenharmony_ci case DMX_EXPBUF: 130962306a36Sopenharmony_ci ret = dvb_vb2_expbuf(&dmxdev->dvr_vb2_ctx, parg); 131062306a36Sopenharmony_ci break; 131162306a36Sopenharmony_ci 131262306a36Sopenharmony_ci case DMX_QBUF: 131362306a36Sopenharmony_ci ret = dvb_vb2_qbuf(&dmxdev->dvr_vb2_ctx, parg); 131462306a36Sopenharmony_ci if (ret == 0 && !dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx)) 131562306a36Sopenharmony_ci ret = dvb_vb2_stream_on(&dmxdev->dvr_vb2_ctx); 131662306a36Sopenharmony_ci break; 131762306a36Sopenharmony_ci 131862306a36Sopenharmony_ci case DMX_DQBUF: 131962306a36Sopenharmony_ci ret = dvb_vb2_dqbuf(&dmxdev->dvr_vb2_ctx, parg); 132062306a36Sopenharmony_ci break; 132162306a36Sopenharmony_ci#endif 132262306a36Sopenharmony_ci default: 132362306a36Sopenharmony_ci ret = -ENOTTY; 132462306a36Sopenharmony_ci break; 132562306a36Sopenharmony_ci } 132662306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 132762306a36Sopenharmony_ci return ret; 132862306a36Sopenharmony_ci} 132962306a36Sopenharmony_ci 133062306a36Sopenharmony_cistatic long dvb_dvr_ioctl(struct file *file, 133162306a36Sopenharmony_ci unsigned int cmd, unsigned long arg) 133262306a36Sopenharmony_ci{ 133362306a36Sopenharmony_ci return dvb_usercopy(file, cmd, arg, dvb_dvr_do_ioctl); 133462306a36Sopenharmony_ci} 133562306a36Sopenharmony_ci 133662306a36Sopenharmony_cistatic __poll_t dvb_dvr_poll(struct file *file, poll_table *wait) 133762306a36Sopenharmony_ci{ 133862306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 133962306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 134062306a36Sopenharmony_ci __poll_t mask = 0; 134162306a36Sopenharmony_ci 134262306a36Sopenharmony_ci dprintk("%s\n", __func__); 134362306a36Sopenharmony_ci 134462306a36Sopenharmony_ci poll_wait(file, &dmxdev->dvr_buffer.queue, wait); 134562306a36Sopenharmony_ci 134662306a36Sopenharmony_ci if (dmxdev->exit) 134762306a36Sopenharmony_ci return EPOLLERR; 134862306a36Sopenharmony_ci if (dvb_vb2_is_streaming(&dmxdev->dvr_vb2_ctx)) 134962306a36Sopenharmony_ci return dvb_vb2_poll(&dmxdev->dvr_vb2_ctx, file, wait); 135062306a36Sopenharmony_ci 135162306a36Sopenharmony_ci if (((file->f_flags & O_ACCMODE) == O_RDONLY) || 135262306a36Sopenharmony_ci dmxdev->may_do_mmap) { 135362306a36Sopenharmony_ci if (dmxdev->dvr_buffer.error) 135462306a36Sopenharmony_ci mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI | EPOLLERR); 135562306a36Sopenharmony_ci 135662306a36Sopenharmony_ci if (!dvb_ringbuffer_empty(&dmxdev->dvr_buffer)) 135762306a36Sopenharmony_ci mask |= (EPOLLIN | EPOLLRDNORM | EPOLLPRI); 135862306a36Sopenharmony_ci } else 135962306a36Sopenharmony_ci mask |= (EPOLLOUT | EPOLLWRNORM | EPOLLPRI); 136062306a36Sopenharmony_ci 136162306a36Sopenharmony_ci return mask; 136262306a36Sopenharmony_ci} 136362306a36Sopenharmony_ci 136462306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 136562306a36Sopenharmony_cistatic int dvb_dvr_mmap(struct file *file, struct vm_area_struct *vma) 136662306a36Sopenharmony_ci{ 136762306a36Sopenharmony_ci struct dvb_device *dvbdev = file->private_data; 136862306a36Sopenharmony_ci struct dmxdev *dmxdev = dvbdev->priv; 136962306a36Sopenharmony_ci int ret; 137062306a36Sopenharmony_ci 137162306a36Sopenharmony_ci if (!dmxdev->may_do_mmap) 137262306a36Sopenharmony_ci return -ENOTTY; 137362306a36Sopenharmony_ci 137462306a36Sopenharmony_ci if (dmxdev->exit) 137562306a36Sopenharmony_ci return -ENODEV; 137662306a36Sopenharmony_ci 137762306a36Sopenharmony_ci if (mutex_lock_interruptible(&dmxdev->mutex)) 137862306a36Sopenharmony_ci return -ERESTARTSYS; 137962306a36Sopenharmony_ci 138062306a36Sopenharmony_ci ret = dvb_vb2_mmap(&dmxdev->dvr_vb2_ctx, vma); 138162306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 138262306a36Sopenharmony_ci return ret; 138362306a36Sopenharmony_ci} 138462306a36Sopenharmony_ci#endif 138562306a36Sopenharmony_ci 138662306a36Sopenharmony_cistatic const struct file_operations dvb_dvr_fops = { 138762306a36Sopenharmony_ci .owner = THIS_MODULE, 138862306a36Sopenharmony_ci .read = dvb_dvr_read, 138962306a36Sopenharmony_ci .write = dvb_dvr_write, 139062306a36Sopenharmony_ci .unlocked_ioctl = dvb_dvr_ioctl, 139162306a36Sopenharmony_ci .open = dvb_dvr_open, 139262306a36Sopenharmony_ci .release = dvb_dvr_release, 139362306a36Sopenharmony_ci .poll = dvb_dvr_poll, 139462306a36Sopenharmony_ci .llseek = default_llseek, 139562306a36Sopenharmony_ci#ifdef CONFIG_DVB_MMAP 139662306a36Sopenharmony_ci .mmap = dvb_dvr_mmap, 139762306a36Sopenharmony_ci#endif 139862306a36Sopenharmony_ci}; 139962306a36Sopenharmony_ci 140062306a36Sopenharmony_cistatic const struct dvb_device dvbdev_dvr = { 140162306a36Sopenharmony_ci .priv = NULL, 140262306a36Sopenharmony_ci .readers = 1, 140362306a36Sopenharmony_ci .users = 1, 140462306a36Sopenharmony_ci#if defined(CONFIG_MEDIA_CONTROLLER_DVB) 140562306a36Sopenharmony_ci .name = "dvb-dvr", 140662306a36Sopenharmony_ci#endif 140762306a36Sopenharmony_ci .fops = &dvb_dvr_fops 140862306a36Sopenharmony_ci}; 140962306a36Sopenharmony_ciint dvb_dmxdev_init(struct dmxdev *dmxdev, struct dvb_adapter *dvb_adapter) 141062306a36Sopenharmony_ci{ 141162306a36Sopenharmony_ci int i, ret; 141262306a36Sopenharmony_ci 141362306a36Sopenharmony_ci if (dmxdev->demux->open(dmxdev->demux) < 0) 141462306a36Sopenharmony_ci return -EUSERS; 141562306a36Sopenharmony_ci 141662306a36Sopenharmony_ci dmxdev->filter = vmalloc(array_size(sizeof(struct dmxdev_filter), 141762306a36Sopenharmony_ci dmxdev->filternum)); 141862306a36Sopenharmony_ci if (!dmxdev->filter) 141962306a36Sopenharmony_ci return -ENOMEM; 142062306a36Sopenharmony_ci 142162306a36Sopenharmony_ci mutex_init(&dmxdev->mutex); 142262306a36Sopenharmony_ci spin_lock_init(&dmxdev->lock); 142362306a36Sopenharmony_ci for (i = 0; i < dmxdev->filternum; i++) { 142462306a36Sopenharmony_ci dmxdev->filter[i].dev = dmxdev; 142562306a36Sopenharmony_ci dmxdev->filter[i].buffer.data = NULL; 142662306a36Sopenharmony_ci dvb_dmxdev_filter_state_set(&dmxdev->filter[i], 142762306a36Sopenharmony_ci DMXDEV_STATE_FREE); 142862306a36Sopenharmony_ci } 142962306a36Sopenharmony_ci 143062306a36Sopenharmony_ci ret = dvb_register_device(dvb_adapter, &dmxdev->dvbdev, &dvbdev_demux, dmxdev, 143162306a36Sopenharmony_ci DVB_DEVICE_DEMUX, dmxdev->filternum); 143262306a36Sopenharmony_ci if (ret < 0) 143362306a36Sopenharmony_ci goto err_register_dvbdev; 143462306a36Sopenharmony_ci 143562306a36Sopenharmony_ci ret = dvb_register_device(dvb_adapter, &dmxdev->dvr_dvbdev, &dvbdev_dvr, 143662306a36Sopenharmony_ci dmxdev, DVB_DEVICE_DVR, dmxdev->filternum); 143762306a36Sopenharmony_ci if (ret < 0) 143862306a36Sopenharmony_ci goto err_register_dvr_dvbdev; 143962306a36Sopenharmony_ci 144062306a36Sopenharmony_ci dvb_ringbuffer_init(&dmxdev->dvr_buffer, NULL, 8192); 144162306a36Sopenharmony_ci 144262306a36Sopenharmony_ci return 0; 144362306a36Sopenharmony_ci 144462306a36Sopenharmony_cierr_register_dvr_dvbdev: 144562306a36Sopenharmony_ci dvb_unregister_device(dmxdev->dvbdev); 144662306a36Sopenharmony_cierr_register_dvbdev: 144762306a36Sopenharmony_ci vfree(dmxdev->filter); 144862306a36Sopenharmony_ci dmxdev->filter = NULL; 144962306a36Sopenharmony_ci return ret; 145062306a36Sopenharmony_ci} 145162306a36Sopenharmony_ci 145262306a36Sopenharmony_ciEXPORT_SYMBOL(dvb_dmxdev_init); 145362306a36Sopenharmony_ci 145462306a36Sopenharmony_civoid dvb_dmxdev_release(struct dmxdev *dmxdev) 145562306a36Sopenharmony_ci{ 145662306a36Sopenharmony_ci mutex_lock(&dmxdev->mutex); 145762306a36Sopenharmony_ci dmxdev->exit = 1; 145862306a36Sopenharmony_ci mutex_unlock(&dmxdev->mutex); 145962306a36Sopenharmony_ci 146062306a36Sopenharmony_ci if (dmxdev->dvbdev->users > 1) { 146162306a36Sopenharmony_ci wait_event(dmxdev->dvbdev->wait_queue, 146262306a36Sopenharmony_ci dmxdev->dvbdev->users == 1); 146362306a36Sopenharmony_ci } 146462306a36Sopenharmony_ci if (dmxdev->dvr_dvbdev->users > 1) { 146562306a36Sopenharmony_ci wait_event(dmxdev->dvr_dvbdev->wait_queue, 146662306a36Sopenharmony_ci dmxdev->dvr_dvbdev->users == 1); 146762306a36Sopenharmony_ci } 146862306a36Sopenharmony_ci 146962306a36Sopenharmony_ci dvb_unregister_device(dmxdev->dvbdev); 147062306a36Sopenharmony_ci dvb_unregister_device(dmxdev->dvr_dvbdev); 147162306a36Sopenharmony_ci 147262306a36Sopenharmony_ci vfree(dmxdev->filter); 147362306a36Sopenharmony_ci dmxdev->filter = NULL; 147462306a36Sopenharmony_ci dmxdev->demux->close(dmxdev->demux); 147562306a36Sopenharmony_ci} 147662306a36Sopenharmony_ci 147762306a36Sopenharmony_ciEXPORT_SYMBOL(dvb_dmxdev_release); 1478