2 * dmxdev.c - DVB demultiplexer device
4 * Copyright (C) 2000 Ralph Metzler & Marcus Metzler
5 * for convergence integrated media GmbH
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.
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.
17 * You should have received a copy of the GNU Lesser General Public License
18 * along with this program; if not, write to the Free Software
19 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
23 #include <linux/sched.h>
24 #include <linux/spinlock.h>
25 #include <linux/slab.h>
26 #include <linux/vmalloc.h>
27 #include <linux/module.h>
28 #include <linux/poll.h>
29 #include <linux/ioctl.h>
30 #include <linux/wait.h>
31 #include <asm/uaccess.h>
36 module_param(debug
, int, 0644);
37 MODULE_PARM_DESC(debug
, "Turn on/off debugging (default:off).");
39 #define dprintk if (debug) printk
41 static int dvb_dmxdev_buffer_write(struct dvb_ringbuffer
*buf
,
42 const u8
*src
, size_t len
)
51 free
= dvb_ringbuffer_free(buf
);
53 dprintk("dmxdev: buffer overflow\n");
57 return dvb_ringbuffer_write(buf
, src
, len
);
60 static ssize_t
dvb_dmxdev_buffer_read(struct dvb_ringbuffer
*src
,
61 int non_blocking
, char __user
*buf
,
62 size_t count
, loff_t
*ppos
)
73 dvb_ringbuffer_flush(src
);
77 for (todo
= count
; todo
> 0; todo
-= ret
) {
78 if (non_blocking
&& dvb_ringbuffer_empty(src
)) {
83 ret
= wait_event_interruptible(src
->queue
,
84 !dvb_ringbuffer_empty(src
) ||
91 dvb_ringbuffer_flush(src
);
95 avail
= dvb_ringbuffer_avail(src
);
99 ret
= dvb_ringbuffer_read_user(src
, buf
, avail
);
106 return (count
- todo
) ? (count
- todo
) : ret
;
109 static struct dmx_frontend
*get_fe(struct dmx_demux
*demux
, int type
)
111 struct list_head
*head
, *pos
;
113 head
= demux
->get_frontends(demux
);
116 list_for_each(pos
, head
)
117 if (DMX_FE_ENTRY(pos
)->source
== type
)
118 return DMX_FE_ENTRY(pos
);
123 static int dvb_dvr_open(struct inode
*inode
, struct file
*file
)
125 struct dvb_device
*dvbdev
= file
->private_data
;
126 struct dmxdev
*dmxdev
= dvbdev
->priv
;
127 struct dmx_frontend
*front
;
129 dprintk("function : %s\n", __func__
);
131 if (mutex_lock_interruptible(&dmxdev
->mutex
))
135 mutex_unlock(&dmxdev
->mutex
);
139 if ((file
->f_flags
& O_ACCMODE
) == O_RDWR
) {
140 if (!(dmxdev
->capabilities
& DMXDEV_CAP_DUPLEX
)) {
141 mutex_unlock(&dmxdev
->mutex
);
146 if ((file
->f_flags
& O_ACCMODE
) == O_RDONLY
) {
148 if (!dvbdev
->readers
) {
149 mutex_unlock(&dmxdev
->mutex
);
152 mem
= vmalloc(DVR_BUFFER_SIZE
);
154 mutex_unlock(&dmxdev
->mutex
);
157 dvb_ringbuffer_init(&dmxdev
->dvr_buffer
, mem
, DVR_BUFFER_SIZE
);
161 if ((file
->f_flags
& O_ACCMODE
) == O_WRONLY
) {
162 dmxdev
->dvr_orig_fe
= dmxdev
->demux
->frontend
;
164 if (!dmxdev
->demux
->write
) {
165 mutex_unlock(&dmxdev
->mutex
);
169 front
= get_fe(dmxdev
->demux
, DMX_MEMORY_FE
);
172 mutex_unlock(&dmxdev
->mutex
);
175 dmxdev
->demux
->disconnect_frontend(dmxdev
->demux
);
176 dmxdev
->demux
->connect_frontend(dmxdev
->demux
, front
);
179 mutex_unlock(&dmxdev
->mutex
);
183 static int dvb_dvr_release(struct inode
*inode
, struct file
*file
)
185 struct dvb_device
*dvbdev
= file
->private_data
;
186 struct dmxdev
*dmxdev
= dvbdev
->priv
;
188 mutex_lock(&dmxdev
->mutex
);
190 if ((file
->f_flags
& O_ACCMODE
) == O_WRONLY
) {
191 dmxdev
->demux
->disconnect_frontend(dmxdev
->demux
);
192 dmxdev
->demux
->connect_frontend(dmxdev
->demux
,
193 dmxdev
->dvr_orig_fe
);
195 if ((file
->f_flags
& O_ACCMODE
) == O_RDONLY
) {
197 if (dmxdev
->dvr_buffer
.data
) {
198 void *mem
= dmxdev
->dvr_buffer
.data
;
200 spin_lock_irq(&dmxdev
->lock
);
201 dmxdev
->dvr_buffer
.data
= NULL
;
202 spin_unlock_irq(&dmxdev
->lock
);
208 if (dvbdev
->users
== 1 && dmxdev
->exit
== 1) {
209 mutex_unlock(&dmxdev
->mutex
);
210 wake_up(&dvbdev
->wait_queue
);
212 mutex_unlock(&dmxdev
->mutex
);
217 static ssize_t
dvb_dvr_write(struct file
*file
, const char __user
*buf
,
218 size_t count
, loff_t
*ppos
)
220 struct dvb_device
*dvbdev
= file
->private_data
;
221 struct dmxdev
*dmxdev
= dvbdev
->priv
;
224 if (!dmxdev
->demux
->write
)
226 if ((file
->f_flags
& O_ACCMODE
) != O_WRONLY
)
228 if (mutex_lock_interruptible(&dmxdev
->mutex
))
232 mutex_unlock(&dmxdev
->mutex
);
235 ret
= dmxdev
->demux
->write(dmxdev
->demux
, buf
, count
);
236 mutex_unlock(&dmxdev
->mutex
);
240 static ssize_t
dvb_dvr_read(struct file
*file
, char __user
*buf
, size_t count
,
243 struct dvb_device
*dvbdev
= file
->private_data
;
244 struct dmxdev
*dmxdev
= dvbdev
->priv
;
249 return dvb_dmxdev_buffer_read(&dmxdev
->dvr_buffer
,
250 file
->f_flags
& O_NONBLOCK
,
254 static int dvb_dvr_set_buffer_size(struct dmxdev
*dmxdev
,
257 struct dvb_ringbuffer
*buf
= &dmxdev
->dvr_buffer
;
261 dprintk("function : %s\n", __func__
);
263 if (buf
->size
== size
)
268 newmem
= vmalloc(size
);
274 spin_lock_irq(&dmxdev
->lock
);
278 /* reset and not flush in case the buffer shrinks */
279 dvb_ringbuffer_reset(buf
);
280 spin_unlock_irq(&dmxdev
->lock
);
287 static inline void dvb_dmxdev_filter_state_set(struct dmxdev_filter
288 *dmxdevfilter
, int state
)
290 spin_lock_irq(&dmxdevfilter
->dev
->lock
);
291 dmxdevfilter
->state
= state
;
292 spin_unlock_irq(&dmxdevfilter
->dev
->lock
);
295 static int dvb_dmxdev_set_buffer_size(struct dmxdev_filter
*dmxdevfilter
,
298 struct dvb_ringbuffer
*buf
= &dmxdevfilter
->buffer
;
302 if (buf
->size
== size
)
306 if (dmxdevfilter
->state
>= DMXDEV_STATE_GO
)
309 newmem
= vmalloc(size
);
315 spin_lock_irq(&dmxdevfilter
->dev
->lock
);
319 /* reset and not flush in case the buffer shrinks */
320 dvb_ringbuffer_reset(buf
);
321 spin_unlock_irq(&dmxdevfilter
->dev
->lock
);
328 static void dvb_dmxdev_filter_timeout(unsigned long data
)
330 struct dmxdev_filter
*dmxdevfilter
= (struct dmxdev_filter
*)data
;
332 dmxdevfilter
->buffer
.error
= -ETIMEDOUT
;
333 spin_lock_irq(&dmxdevfilter
->dev
->lock
);
334 dmxdevfilter
->state
= DMXDEV_STATE_TIMEDOUT
;
335 spin_unlock_irq(&dmxdevfilter
->dev
->lock
);
336 wake_up(&dmxdevfilter
->buffer
.queue
);
339 static void dvb_dmxdev_filter_timer(struct dmxdev_filter
*dmxdevfilter
)
341 struct dmx_sct_filter_params
*para
= &dmxdevfilter
->params
.sec
;
343 del_timer(&dmxdevfilter
->timer
);
345 dmxdevfilter
->timer
.function
= dvb_dmxdev_filter_timeout
;
346 dmxdevfilter
->timer
.data
= (unsigned long)dmxdevfilter
;
347 dmxdevfilter
->timer
.expires
=
348 jiffies
+ 1 + (HZ
/ 2 + HZ
* para
->timeout
) / 1000;
349 add_timer(&dmxdevfilter
->timer
);
353 static int dvb_dmxdev_section_callback(const u8
*buffer1
, size_t buffer1_len
,
354 const u8
*buffer2
, size_t buffer2_len
,
355 struct dmx_section_filter
*filter
)
357 struct dmxdev_filter
*dmxdevfilter
= filter
->priv
;
360 if (dmxdevfilter
->buffer
.error
) {
361 wake_up(&dmxdevfilter
->buffer
.queue
);
364 spin_lock(&dmxdevfilter
->dev
->lock
);
365 if (dmxdevfilter
->state
!= DMXDEV_STATE_GO
) {
366 spin_unlock(&dmxdevfilter
->dev
->lock
);
369 del_timer(&dmxdevfilter
->timer
);
370 dprintk("dmxdev: section callback %*ph\n", 6, buffer1
);
371 ret
= dvb_dmxdev_buffer_write(&dmxdevfilter
->buffer
, buffer1
,
373 if (ret
== buffer1_len
) {
374 ret
= dvb_dmxdev_buffer_write(&dmxdevfilter
->buffer
, buffer2
,
378 dmxdevfilter
->buffer
.error
= ret
;
379 if (dmxdevfilter
->params
.sec
.flags
& DMX_ONESHOT
)
380 dmxdevfilter
->state
= DMXDEV_STATE_DONE
;
381 spin_unlock(&dmxdevfilter
->dev
->lock
);
382 wake_up(&dmxdevfilter
->buffer
.queue
);
386 static int dvb_dmxdev_ts_callback(const u8
*buffer1
, size_t buffer1_len
,
387 const u8
*buffer2
, size_t buffer2_len
,
388 struct dmx_ts_feed
*feed
)
390 struct dmxdev_filter
*dmxdevfilter
= feed
->priv
;
391 struct dvb_ringbuffer
*buffer
;
394 spin_lock(&dmxdevfilter
->dev
->lock
);
395 if (dmxdevfilter
->params
.pes
.output
== DMX_OUT_DECODER
) {
396 spin_unlock(&dmxdevfilter
->dev
->lock
);
400 if (dmxdevfilter
->params
.pes
.output
== DMX_OUT_TAP
401 || dmxdevfilter
->params
.pes
.output
== DMX_OUT_TSDEMUX_TAP
)
402 buffer
= &dmxdevfilter
->buffer
;
404 buffer
= &dmxdevfilter
->dev
->dvr_buffer
;
406 spin_unlock(&dmxdevfilter
->dev
->lock
);
407 wake_up(&buffer
->queue
);
410 ret
= dvb_dmxdev_buffer_write(buffer
, buffer1
, buffer1_len
);
411 if (ret
== buffer1_len
)
412 ret
= dvb_dmxdev_buffer_write(buffer
, buffer2
, buffer2_len
);
415 spin_unlock(&dmxdevfilter
->dev
->lock
);
416 wake_up(&buffer
->queue
);
420 /* stop feed but only mark the specified filter as stopped (state set) */
421 static int dvb_dmxdev_feed_stop(struct dmxdev_filter
*dmxdevfilter
)
423 struct dmxdev_feed
*feed
;
425 dvb_dmxdev_filter_state_set(dmxdevfilter
, DMXDEV_STATE_SET
);
427 switch (dmxdevfilter
->type
) {
428 case DMXDEV_TYPE_SEC
:
429 del_timer(&dmxdevfilter
->timer
);
430 dmxdevfilter
->feed
.sec
->stop_filtering(dmxdevfilter
->feed
.sec
);
432 case DMXDEV_TYPE_PES
:
433 list_for_each_entry(feed
, &dmxdevfilter
->feed
.ts
, next
)
434 feed
->ts
->stop_filtering(feed
->ts
);
442 /* start feed associated with the specified filter */
443 static int dvb_dmxdev_feed_start(struct dmxdev_filter
*filter
)
445 struct dmxdev_feed
*feed
;
448 dvb_dmxdev_filter_state_set(filter
, DMXDEV_STATE_GO
);
450 switch (filter
->type
) {
451 case DMXDEV_TYPE_SEC
:
452 return filter
->feed
.sec
->start_filtering(filter
->feed
.sec
);
453 case DMXDEV_TYPE_PES
:
454 list_for_each_entry(feed
, &filter
->feed
.ts
, next
) {
455 ret
= feed
->ts
->start_filtering(feed
->ts
);
457 dvb_dmxdev_feed_stop(filter
);
469 /* restart section feed if it has filters left associated with it,
470 otherwise release the feed */
471 static int dvb_dmxdev_feed_restart(struct dmxdev_filter
*filter
)
474 struct dmxdev
*dmxdev
= filter
->dev
;
475 u16 pid
= filter
->params
.sec
.pid
;
477 for (i
= 0; i
< dmxdev
->filternum
; i
++)
478 if (dmxdev
->filter
[i
].state
>= DMXDEV_STATE_GO
&&
479 dmxdev
->filter
[i
].type
== DMXDEV_TYPE_SEC
&&
480 dmxdev
->filter
[i
].params
.sec
.pid
== pid
) {
481 dvb_dmxdev_feed_start(&dmxdev
->filter
[i
]);
485 filter
->dev
->demux
->release_section_feed(dmxdev
->demux
,
491 static int dvb_dmxdev_filter_stop(struct dmxdev_filter
*dmxdevfilter
)
493 struct dmxdev_feed
*feed
;
494 struct dmx_demux
*demux
;
496 if (dmxdevfilter
->state
< DMXDEV_STATE_GO
)
499 switch (dmxdevfilter
->type
) {
500 case DMXDEV_TYPE_SEC
:
501 if (!dmxdevfilter
->feed
.sec
)
503 dvb_dmxdev_feed_stop(dmxdevfilter
);
504 if (dmxdevfilter
->filter
.sec
)
505 dmxdevfilter
->feed
.sec
->
506 release_filter(dmxdevfilter
->feed
.sec
,
507 dmxdevfilter
->filter
.sec
);
508 dvb_dmxdev_feed_restart(dmxdevfilter
);
509 dmxdevfilter
->feed
.sec
= NULL
;
511 case DMXDEV_TYPE_PES
:
512 dvb_dmxdev_feed_stop(dmxdevfilter
);
513 demux
= dmxdevfilter
->dev
->demux
;
514 list_for_each_entry(feed
, &dmxdevfilter
->feed
.ts
, next
) {
515 demux
->release_ts_feed(demux
, feed
->ts
);
520 if (dmxdevfilter
->state
== DMXDEV_STATE_ALLOCATED
)
525 dvb_ringbuffer_flush(&dmxdevfilter
->buffer
);
529 static void dvb_dmxdev_delete_pids(struct dmxdev_filter
*dmxdevfilter
)
531 struct dmxdev_feed
*feed
, *tmp
;
533 /* delete all PIDs */
534 list_for_each_entry_safe(feed
, tmp
, &dmxdevfilter
->feed
.ts
, next
) {
535 list_del(&feed
->next
);
539 BUG_ON(!list_empty(&dmxdevfilter
->feed
.ts
));
542 static inline int dvb_dmxdev_filter_reset(struct dmxdev_filter
*dmxdevfilter
)
544 if (dmxdevfilter
->state
< DMXDEV_STATE_SET
)
547 if (dmxdevfilter
->type
== DMXDEV_TYPE_PES
)
548 dvb_dmxdev_delete_pids(dmxdevfilter
);
550 dmxdevfilter
->type
= DMXDEV_TYPE_NONE
;
551 dvb_dmxdev_filter_state_set(dmxdevfilter
, DMXDEV_STATE_ALLOCATED
);
555 static int dvb_dmxdev_start_feed(struct dmxdev
*dmxdev
,
556 struct dmxdev_filter
*filter
,
557 struct dmxdev_feed
*feed
)
559 struct timespec timeout
= { 0 };
560 struct dmx_pes_filter_params
*para
= &filter
->params
.pes
;
564 enum dmx_ts_pes ts_pes
;
565 struct dmx_ts_feed
*tsfeed
;
568 otype
= para
->output
;
570 ts_pes
= para
->pes_type
;
572 if (ts_pes
< DMX_PES_OTHER
)
573 ts_type
= TS_DECODER
;
577 if (otype
== DMX_OUT_TS_TAP
)
578 ts_type
|= TS_PACKET
;
579 else if (otype
== DMX_OUT_TSDEMUX_TAP
)
580 ts_type
|= TS_PACKET
| TS_DEMUX
;
581 else if (otype
== DMX_OUT_TAP
)
582 ts_type
|= TS_PACKET
| TS_DEMUX
| TS_PAYLOAD_ONLY
;
584 ret
= dmxdev
->demux
->allocate_ts_feed(dmxdev
->demux
, &feed
->ts
,
585 dvb_dmxdev_ts_callback
);
590 tsfeed
->priv
= filter
;
592 ret
= tsfeed
->set(tsfeed
, feed
->pid
, ts_type
, ts_pes
, 32768, timeout
);
594 dmxdev
->demux
->release_ts_feed(dmxdev
->demux
, tsfeed
);
598 ret
= tsfeed
->start_filtering(tsfeed
);
600 dmxdev
->demux
->release_ts_feed(dmxdev
->demux
, tsfeed
);
607 static int dvb_dmxdev_filter_start(struct dmxdev_filter
*filter
)
609 struct dmxdev
*dmxdev
= filter
->dev
;
610 struct dmxdev_feed
*feed
;
614 if (filter
->state
< DMXDEV_STATE_SET
)
617 if (filter
->state
>= DMXDEV_STATE_GO
)
618 dvb_dmxdev_filter_stop(filter
);
620 if (!filter
->buffer
.data
) {
621 mem
= vmalloc(filter
->buffer
.size
);
624 spin_lock_irq(&filter
->dev
->lock
);
625 filter
->buffer
.data
= mem
;
626 spin_unlock_irq(&filter
->dev
->lock
);
629 dvb_ringbuffer_flush(&filter
->buffer
);
631 switch (filter
->type
) {
632 case DMXDEV_TYPE_SEC
:
634 struct dmx_sct_filter_params
*para
= &filter
->params
.sec
;
635 struct dmx_section_filter
**secfilter
= &filter
->filter
.sec
;
636 struct dmx_section_feed
**secfeed
= &filter
->feed
.sec
;
642 /* find active filter/feed with same PID */
643 for (i
= 0; i
< dmxdev
->filternum
; i
++) {
644 if (dmxdev
->filter
[i
].state
>= DMXDEV_STATE_GO
&&
645 dmxdev
->filter
[i
].type
== DMXDEV_TYPE_SEC
&&
646 dmxdev
->filter
[i
].params
.sec
.pid
== para
->pid
) {
647 *secfeed
= dmxdev
->filter
[i
].feed
.sec
;
652 /* if no feed found, try to allocate new one */
654 ret
= dmxdev
->demux
->allocate_section_feed(dmxdev
->demux
,
656 dvb_dmxdev_section_callback
);
658 printk("DVB (%s): could not alloc feed\n",
663 ret
= (*secfeed
)->set(*secfeed
, para
->pid
, 32768,
664 (para
->flags
& DMX_CHECK_CRC
) ? 1 : 0);
666 printk("DVB (%s): could not set feed\n",
668 dvb_dmxdev_feed_restart(filter
);
672 dvb_dmxdev_feed_stop(filter
);
675 ret
= (*secfeed
)->allocate_filter(*secfeed
, secfilter
);
677 dvb_dmxdev_feed_restart(filter
);
678 filter
->feed
.sec
->start_filtering(*secfeed
);
679 dprintk("could not get filter\n");
683 (*secfilter
)->priv
= filter
;
685 memcpy(&((*secfilter
)->filter_value
[3]),
686 &(para
->filter
.filter
[1]), DMX_FILTER_SIZE
- 1);
687 memcpy(&(*secfilter
)->filter_mask
[3],
688 ¶
->filter
.mask
[1], DMX_FILTER_SIZE
- 1);
689 memcpy(&(*secfilter
)->filter_mode
[3],
690 ¶
->filter
.mode
[1], DMX_FILTER_SIZE
- 1);
692 (*secfilter
)->filter_value
[0] = para
->filter
.filter
[0];
693 (*secfilter
)->filter_mask
[0] = para
->filter
.mask
[0];
694 (*secfilter
)->filter_mode
[0] = para
->filter
.mode
[0];
695 (*secfilter
)->filter_mask
[1] = 0;
696 (*secfilter
)->filter_mask
[2] = 0;
700 ret
= filter
->feed
.sec
->start_filtering(filter
->feed
.sec
);
704 dvb_dmxdev_filter_timer(filter
);
707 case DMXDEV_TYPE_PES
:
708 list_for_each_entry(feed
, &filter
->feed
.ts
, next
) {
709 ret
= dvb_dmxdev_start_feed(dmxdev
, filter
, feed
);
711 dvb_dmxdev_filter_stop(filter
);
720 dvb_dmxdev_filter_state_set(filter
, DMXDEV_STATE_GO
);
724 static int dvb_demux_open(struct inode
*inode
, struct file
*file
)
726 struct dvb_device
*dvbdev
= file
->private_data
;
727 struct dmxdev
*dmxdev
= dvbdev
->priv
;
729 struct dmxdev_filter
*dmxdevfilter
;
734 if (mutex_lock_interruptible(&dmxdev
->mutex
))
737 for (i
= 0; i
< dmxdev
->filternum
; i
++)
738 if (dmxdev
->filter
[i
].state
== DMXDEV_STATE_FREE
)
741 if (i
== dmxdev
->filternum
) {
742 mutex_unlock(&dmxdev
->mutex
);
746 dmxdevfilter
= &dmxdev
->filter
[i
];
747 mutex_init(&dmxdevfilter
->mutex
);
748 file
->private_data
= dmxdevfilter
;
750 dvb_ringbuffer_init(&dmxdevfilter
->buffer
, NULL
, 8192);
751 dmxdevfilter
->type
= DMXDEV_TYPE_NONE
;
752 dvb_dmxdev_filter_state_set(dmxdevfilter
, DMXDEV_STATE_ALLOCATED
);
753 init_timer(&dmxdevfilter
->timer
);
757 mutex_unlock(&dmxdev
->mutex
);
761 static int dvb_dmxdev_filter_free(struct dmxdev
*dmxdev
,
762 struct dmxdev_filter
*dmxdevfilter
)
764 mutex_lock(&dmxdev
->mutex
);
765 mutex_lock(&dmxdevfilter
->mutex
);
767 dvb_dmxdev_filter_stop(dmxdevfilter
);
768 dvb_dmxdev_filter_reset(dmxdevfilter
);
770 if (dmxdevfilter
->buffer
.data
) {
771 void *mem
= dmxdevfilter
->buffer
.data
;
773 spin_lock_irq(&dmxdev
->lock
);
774 dmxdevfilter
->buffer
.data
= NULL
;
775 spin_unlock_irq(&dmxdev
->lock
);
779 dvb_dmxdev_filter_state_set(dmxdevfilter
, DMXDEV_STATE_FREE
);
780 wake_up(&dmxdevfilter
->buffer
.queue
);
781 mutex_unlock(&dmxdevfilter
->mutex
);
782 mutex_unlock(&dmxdev
->mutex
);
786 static inline void invert_mode(dmx_filter_t
*filter
)
790 for (i
= 0; i
< DMX_FILTER_SIZE
; i
++)
791 filter
->mode
[i
] ^= 0xff;
794 static int dvb_dmxdev_add_pid(struct dmxdev
*dmxdev
,
795 struct dmxdev_filter
*filter
, u16 pid
)
797 struct dmxdev_feed
*feed
;
799 if ((filter
->type
!= DMXDEV_TYPE_PES
) ||
800 (filter
->state
< DMXDEV_STATE_SET
))
803 /* only TS packet filters may have multiple PIDs */
804 if ((filter
->params
.pes
.output
!= DMX_OUT_TSDEMUX_TAP
) &&
805 (!list_empty(&filter
->feed
.ts
)))
808 feed
= kzalloc(sizeof(struct dmxdev_feed
), GFP_KERNEL
);
813 list_add(&feed
->next
, &filter
->feed
.ts
);
815 if (filter
->state
>= DMXDEV_STATE_GO
)
816 return dvb_dmxdev_start_feed(dmxdev
, filter
, feed
);
821 static int dvb_dmxdev_remove_pid(struct dmxdev
*dmxdev
,
822 struct dmxdev_filter
*filter
, u16 pid
)
824 struct dmxdev_feed
*feed
, *tmp
;
826 if ((filter
->type
!= DMXDEV_TYPE_PES
) ||
827 (filter
->state
< DMXDEV_STATE_SET
))
830 list_for_each_entry_safe(feed
, tmp
, &filter
->feed
.ts
, next
) {
831 if ((feed
->pid
== pid
) && (feed
->ts
!= NULL
)) {
832 feed
->ts
->stop_filtering(feed
->ts
);
833 filter
->dev
->demux
->release_ts_feed(filter
->dev
->demux
,
835 list_del(&feed
->next
);
843 static int dvb_dmxdev_filter_set(struct dmxdev
*dmxdev
,
844 struct dmxdev_filter
*dmxdevfilter
,
845 struct dmx_sct_filter_params
*params
)
847 dprintk("function : %s, PID=0x%04x, flags=%02x, timeout=%d\n",
848 __func__
, params
->pid
, params
->flags
, params
->timeout
);
850 dvb_dmxdev_filter_stop(dmxdevfilter
);
852 dmxdevfilter
->type
= DMXDEV_TYPE_SEC
;
853 memcpy(&dmxdevfilter
->params
.sec
,
854 params
, sizeof(struct dmx_sct_filter_params
));
855 invert_mode(&dmxdevfilter
->params
.sec
.filter
);
856 dvb_dmxdev_filter_state_set(dmxdevfilter
, DMXDEV_STATE_SET
);
858 if (params
->flags
& DMX_IMMEDIATE_START
)
859 return dvb_dmxdev_filter_start(dmxdevfilter
);
864 static int dvb_dmxdev_pes_filter_set(struct dmxdev
*dmxdev
,
865 struct dmxdev_filter
*dmxdevfilter
,
866 struct dmx_pes_filter_params
*params
)
870 dvb_dmxdev_filter_stop(dmxdevfilter
);
871 dvb_dmxdev_filter_reset(dmxdevfilter
);
873 if ((unsigned)params
->pes_type
> DMX_PES_OTHER
)
876 dmxdevfilter
->type
= DMXDEV_TYPE_PES
;
877 memcpy(&dmxdevfilter
->params
, params
,
878 sizeof(struct dmx_pes_filter_params
));
879 INIT_LIST_HEAD(&dmxdevfilter
->feed
.ts
);
881 dvb_dmxdev_filter_state_set(dmxdevfilter
, DMXDEV_STATE_SET
);
883 ret
= dvb_dmxdev_add_pid(dmxdev
, dmxdevfilter
,
884 dmxdevfilter
->params
.pes
.pid
);
888 if (params
->flags
& DMX_IMMEDIATE_START
)
889 return dvb_dmxdev_filter_start(dmxdevfilter
);
894 static ssize_t
dvb_dmxdev_read_sec(struct dmxdev_filter
*dfil
,
895 struct file
*file
, char __user
*buf
,
896 size_t count
, loff_t
*ppos
)
901 if (dfil
->todo
<= 0) {
902 hcount
= 3 + dfil
->todo
;
905 result
= dvb_dmxdev_buffer_read(&dfil
->buffer
,
906 file
->f_flags
& O_NONBLOCK
,
912 if (copy_from_user(dfil
->secheader
- dfil
->todo
, buf
, result
))
917 dfil
->todo
-= result
;
920 dfil
->todo
= ((dfil
->secheader
[1] << 8) | dfil
->secheader
[2]) & 0xfff;
924 if (count
> dfil
->todo
)
926 result
= dvb_dmxdev_buffer_read(&dfil
->buffer
,
927 file
->f_flags
& O_NONBLOCK
,
931 dfil
->todo
-= result
;
932 return (result
+ done
);
936 dvb_demux_read(struct file
*file
, char __user
*buf
, size_t count
,
939 struct dmxdev_filter
*dmxdevfilter
= file
->private_data
;
942 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
))
945 if (dmxdevfilter
->type
== DMXDEV_TYPE_SEC
)
946 ret
= dvb_dmxdev_read_sec(dmxdevfilter
, file
, buf
, count
, ppos
);
948 ret
= dvb_dmxdev_buffer_read(&dmxdevfilter
->buffer
,
949 file
->f_flags
& O_NONBLOCK
,
952 mutex_unlock(&dmxdevfilter
->mutex
);
956 static int dvb_demux_do_ioctl(struct file
*file
,
957 unsigned int cmd
, void *parg
)
959 struct dmxdev_filter
*dmxdevfilter
= file
->private_data
;
960 struct dmxdev
*dmxdev
= dmxdevfilter
->dev
;
961 unsigned long arg
= (unsigned long)parg
;
964 if (mutex_lock_interruptible(&dmxdev
->mutex
))
969 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
)) {
970 mutex_unlock(&dmxdev
->mutex
);
973 if (dmxdevfilter
->state
< DMXDEV_STATE_SET
)
976 ret
= dvb_dmxdev_filter_start(dmxdevfilter
);
977 mutex_unlock(&dmxdevfilter
->mutex
);
981 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
)) {
982 mutex_unlock(&dmxdev
->mutex
);
985 ret
= dvb_dmxdev_filter_stop(dmxdevfilter
);
986 mutex_unlock(&dmxdevfilter
->mutex
);
990 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
)) {
991 mutex_unlock(&dmxdev
->mutex
);
994 ret
= dvb_dmxdev_filter_set(dmxdev
, dmxdevfilter
, parg
);
995 mutex_unlock(&dmxdevfilter
->mutex
);
998 case DMX_SET_PES_FILTER
:
999 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
)) {
1000 mutex_unlock(&dmxdev
->mutex
);
1001 return -ERESTARTSYS
;
1003 ret
= dvb_dmxdev_pes_filter_set(dmxdev
, dmxdevfilter
, parg
);
1004 mutex_unlock(&dmxdevfilter
->mutex
);
1007 case DMX_SET_BUFFER_SIZE
:
1008 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
)) {
1009 mutex_unlock(&dmxdev
->mutex
);
1010 return -ERESTARTSYS
;
1012 ret
= dvb_dmxdev_set_buffer_size(dmxdevfilter
, arg
);
1013 mutex_unlock(&dmxdevfilter
->mutex
);
1016 case DMX_GET_PES_PIDS
:
1017 if (!dmxdev
->demux
->get_pes_pids
) {
1021 dmxdev
->demux
->get_pes_pids(dmxdev
->demux
, parg
);
1025 /* Not used upstream and never documented */
1028 if (!dmxdev
->demux
->get_caps
) {
1032 ret
= dmxdev
->demux
->get_caps(dmxdev
->demux
, parg
);
1035 case DMX_SET_SOURCE
:
1036 if (!dmxdev
->demux
->set_source
) {
1040 ret
= dmxdev
->demux
->set_source(dmxdev
->demux
, parg
);
1045 if (!dmxdev
->demux
->get_stc
) {
1049 ret
= dmxdev
->demux
->get_stc(dmxdev
->demux
,
1050 ((struct dmx_stc
*)parg
)->num
,
1051 &((struct dmx_stc
*)parg
)->stc
,
1052 &((struct dmx_stc
*)parg
)->base
);
1056 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
)) {
1060 ret
= dvb_dmxdev_add_pid(dmxdev
, dmxdevfilter
, *(u16
*)parg
);
1061 mutex_unlock(&dmxdevfilter
->mutex
);
1064 case DMX_REMOVE_PID
:
1065 if (mutex_lock_interruptible(&dmxdevfilter
->mutex
)) {
1069 ret
= dvb_dmxdev_remove_pid(dmxdev
, dmxdevfilter
, *(u16
*)parg
);
1070 mutex_unlock(&dmxdevfilter
->mutex
);
1077 mutex_unlock(&dmxdev
->mutex
);
1081 static long dvb_demux_ioctl(struct file
*file
, unsigned int cmd
,
1084 return dvb_usercopy(file
, cmd
, arg
, dvb_demux_do_ioctl
);
1087 static unsigned int dvb_demux_poll(struct file
*file
, poll_table
*wait
)
1089 struct dmxdev_filter
*dmxdevfilter
= file
->private_data
;
1090 unsigned int mask
= 0;
1092 if ((!dmxdevfilter
) || dmxdevfilter
->dev
->exit
)
1095 poll_wait(file
, &dmxdevfilter
->buffer
.queue
, wait
);
1097 if (dmxdevfilter
->state
!= DMXDEV_STATE_GO
&&
1098 dmxdevfilter
->state
!= DMXDEV_STATE_DONE
&&
1099 dmxdevfilter
->state
!= DMXDEV_STATE_TIMEDOUT
)
1102 if (dmxdevfilter
->buffer
.error
)
1103 mask
|= (POLLIN
| POLLRDNORM
| POLLPRI
| POLLERR
);
1105 if (!dvb_ringbuffer_empty(&dmxdevfilter
->buffer
))
1106 mask
|= (POLLIN
| POLLRDNORM
| POLLPRI
);
1111 static int dvb_demux_release(struct inode
*inode
, struct file
*file
)
1113 struct dmxdev_filter
*dmxdevfilter
= file
->private_data
;
1114 struct dmxdev
*dmxdev
= dmxdevfilter
->dev
;
1118 ret
= dvb_dmxdev_filter_free(dmxdev
, dmxdevfilter
);
1120 mutex_lock(&dmxdev
->mutex
);
1121 dmxdev
->dvbdev
->users
--;
1122 if(dmxdev
->dvbdev
->users
==1 && dmxdev
->exit
==1) {
1123 mutex_unlock(&dmxdev
->mutex
);
1124 wake_up(&dmxdev
->dvbdev
->wait_queue
);
1126 mutex_unlock(&dmxdev
->mutex
);
1131 static const struct file_operations dvb_demux_fops
= {
1132 .owner
= THIS_MODULE
,
1133 .read
= dvb_demux_read
,
1134 .unlocked_ioctl
= dvb_demux_ioctl
,
1135 .open
= dvb_demux_open
,
1136 .release
= dvb_demux_release
,
1137 .poll
= dvb_demux_poll
,
1138 .llseek
= default_llseek
,
1141 static const struct dvb_device dvbdev_demux
= {
1145 #if defined(CONFIG_MEDIA_CONTROLLER_DVB)
1146 .name
= "dvb-demux",
1148 .fops
= &dvb_demux_fops
1151 static int dvb_dvr_do_ioctl(struct file
*file
,
1152 unsigned int cmd
, void *parg
)
1154 struct dvb_device
*dvbdev
= file
->private_data
;
1155 struct dmxdev
*dmxdev
= dvbdev
->priv
;
1156 unsigned long arg
= (unsigned long)parg
;
1159 if (mutex_lock_interruptible(&dmxdev
->mutex
))
1160 return -ERESTARTSYS
;
1163 case DMX_SET_BUFFER_SIZE
:
1164 ret
= dvb_dvr_set_buffer_size(dmxdev
, arg
);
1171 mutex_unlock(&dmxdev
->mutex
);
1175 static long dvb_dvr_ioctl(struct file
*file
,
1176 unsigned int cmd
, unsigned long arg
)
1178 return dvb_usercopy(file
, cmd
, arg
, dvb_dvr_do_ioctl
);
1181 static unsigned int dvb_dvr_poll(struct file
*file
, poll_table
*wait
)
1183 struct dvb_device
*dvbdev
= file
->private_data
;
1184 struct dmxdev
*dmxdev
= dvbdev
->priv
;
1185 unsigned int mask
= 0;
1187 dprintk("function : %s\n", __func__
);
1192 poll_wait(file
, &dmxdev
->dvr_buffer
.queue
, wait
);
1194 if ((file
->f_flags
& O_ACCMODE
) == O_RDONLY
) {
1195 if (dmxdev
->dvr_buffer
.error
)
1196 mask
|= (POLLIN
| POLLRDNORM
| POLLPRI
| POLLERR
);
1198 if (!dvb_ringbuffer_empty(&dmxdev
->dvr_buffer
))
1199 mask
|= (POLLIN
| POLLRDNORM
| POLLPRI
);
1201 mask
|= (POLLOUT
| POLLWRNORM
| POLLPRI
);
1206 static const struct file_operations dvb_dvr_fops
= {
1207 .owner
= THIS_MODULE
,
1208 .read
= dvb_dvr_read
,
1209 .write
= dvb_dvr_write
,
1210 .unlocked_ioctl
= dvb_dvr_ioctl
,
1211 .open
= dvb_dvr_open
,
1212 .release
= dvb_dvr_release
,
1213 .poll
= dvb_dvr_poll
,
1214 .llseek
= default_llseek
,
1217 static const struct dvb_device dvbdev_dvr
= {
1221 #if defined(CONFIG_MEDIA_CONTROLLER_DVB)
1224 .fops
= &dvb_dvr_fops
1226 int dvb_dmxdev_init(struct dmxdev
*dmxdev
, struct dvb_adapter
*dvb_adapter
)
1230 if (dmxdev
->demux
->open(dmxdev
->demux
) < 0)
1233 dmxdev
->filter
= vmalloc(dmxdev
->filternum
* sizeof(struct dmxdev_filter
));
1234 if (!dmxdev
->filter
)
1237 mutex_init(&dmxdev
->mutex
);
1238 spin_lock_init(&dmxdev
->lock
);
1239 for (i
= 0; i
< dmxdev
->filternum
; i
++) {
1240 dmxdev
->filter
[i
].dev
= dmxdev
;
1241 dmxdev
->filter
[i
].buffer
.data
= NULL
;
1242 dvb_dmxdev_filter_state_set(&dmxdev
->filter
[i
],
1246 dvb_register_device(dvb_adapter
, &dmxdev
->dvbdev
, &dvbdev_demux
, dmxdev
,
1248 dvb_register_device(dvb_adapter
, &dmxdev
->dvr_dvbdev
, &dvbdev_dvr
,
1249 dmxdev
, DVB_DEVICE_DVR
);
1251 dvb_ringbuffer_init(&dmxdev
->dvr_buffer
, NULL
, 8192);
1256 EXPORT_SYMBOL(dvb_dmxdev_init
);
1258 void dvb_dmxdev_release(struct dmxdev
*dmxdev
)
1261 if (dmxdev
->dvbdev
->users
> 1) {
1262 wait_event(dmxdev
->dvbdev
->wait_queue
,
1263 dmxdev
->dvbdev
->users
==1);
1265 if (dmxdev
->dvr_dvbdev
->users
> 1) {
1266 wait_event(dmxdev
->dvr_dvbdev
->wait_queue
,
1267 dmxdev
->dvr_dvbdev
->users
==1);
1270 dvb_unregister_device(dmxdev
->dvbdev
);
1271 dvb_unregister_device(dmxdev
->dvr_dvbdev
);
1273 vfree(dmxdev
->filter
);
1274 dmxdev
->filter
= NULL
;
1275 dmxdev
->demux
->close(dmxdev
->demux
);
1278 EXPORT_SYMBOL(dvb_dmxdev_release
);