[thirdparty/kernel/stable.git] / drivers / media / pci / ngene / ngene-dvb.c

/*
 * ngene-dvb.c: nGene PCIe bridge driver - DVB functions
 *
 * Copyright (C) 2005-2007 Micronas
 *
 * Copyright (C) 2008-2009 Ralph Metzler <rjkm@metzlerbros.de>
 *                         Modifications for new nGene firmware,
 *                         support for EEPROM-copying,
 *                         support for new dual DVB-S2 card prototype
 *
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * version 2 only, as published by the Free Software Foundation.
 *
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * To obtain the license, point your browser to
 * http://www.gnu.org/copyleft/gpl.html
 */

#include <linux/module.h>
#include <linux/init.h>
#include <linux/delay.h>
#include <linux/slab.h>
#include <linux/poll.h>
#include <linux/io.h>
#include <asm/div64.h>
#include <linux/pci.h>
#include <linux/timer.h>
#include <linux/byteorder/generic.h>
#include <linux/firmware.h>
#include <linux/vmalloc.h>

#include "ngene.h"


/****************************************************************************/
/* COMMAND API interface ****************************************************/
/****************************************************************************/

static ssize_t ts_write(struct file *file, const char __user *buf,
			size_t count, loff_t *ppos)
{
	struct dvb_device *dvbdev = file->private_data;
	struct ngene_channel *chan = dvbdev->priv;
	struct ngene *dev = chan->dev;

	if (wait_event_interruptible(dev->tsout_rbuf.queue,
				     dvb_ringbuffer_free
				     (&dev->tsout_rbuf) >= count) < 0)
		return 0;

	dvb_ringbuffer_write_user(&dev->tsout_rbuf, buf, count);

	return count;
}

static ssize_t ts_read(struct file *file, char __user *buf,
		       size_t count, loff_t *ppos)
{
	struct dvb_device *dvbdev = file->private_data;
	struct ngene_channel *chan = dvbdev->priv;
	struct ngene *dev = chan->dev;
	int left, avail;

	left = count;
	while (left) {
		if (wait_event_interruptible(
			    dev->tsin_rbuf.queue,
			    dvb_ringbuffer_avail(&dev->tsin_rbuf) > 0) < 0)
			return -EAGAIN;
		avail = dvb_ringbuffer_avail(&dev->tsin_rbuf);
		if (avail > left)
			avail = left;
		dvb_ringbuffer_read_user(&dev->tsin_rbuf, buf, avail);
		left -= avail;
		buf += avail;
	}
	return count;
}

static __poll_t ts_poll(struct file *file, poll_table *wait)
{
	struct dvb_device *dvbdev = file->private_data;
	struct ngene_channel *chan = dvbdev->priv;
	struct ngene *dev = chan->dev;
	struct dvb_ringbuffer *rbuf = &dev->tsin_rbuf;
	struct dvb_ringbuffer *wbuf = &dev->tsout_rbuf;
	__poll_t mask = 0;

	poll_wait(file, &rbuf->queue, wait);
	poll_wait(file, &wbuf->queue, wait);

	if (!dvb_ringbuffer_empty(rbuf))
		mask |= EPOLLIN | EPOLLRDNORM;
	if (dvb_ringbuffer_free(wbuf) >= 188)
		mask |= EPOLLOUT | EPOLLWRNORM;

	return mask;
}

static const struct file_operations ci_fops = {
	.owner   = THIS_MODULE,
	.read    = ts_read,
	.write   = ts_write,
	.open    = dvb_generic_open,
	.release = dvb_generic_release,
	.poll    = ts_poll,
	.mmap    = NULL,
};

struct dvb_device ngene_dvbdev_ci = {
	.priv    = NULL,
	.readers = 1,
	.writers = 1,
	.users   = 2,
	.fops    = &ci_fops,
};


/****************************************************************************/
/* DVB functions and API interface ******************************************/
/****************************************************************************/

static void swap_buffer(u32 *p, u32 len)
{
	while (len) {
		*p = swab32(*p);
		p++;
		len -= 4;
	}
}

/* start of filler packet */
static u8 fill_ts[] = { 0x47, 0x1f, 0xff, 0x10, TS_FILLER };

static inline void tsin_copy_stripped(struct ngene *dev, void *buf)
{
	if (memcmp(buf, fill_ts, sizeof(fill_ts)) != 0) {
		if (dvb_ringbuffer_free(&dev->tsin_rbuf) >= 188) {
			dvb_ringbuffer_write(&dev->tsin_rbuf, buf, 188);
			wake_up(&dev->tsin_rbuf.queue);
		}
	}
}

void *tsin_exchange(void *priv, void *buf, u32 len, u32 clock, u32 flags)
{
	struct ngene_channel *chan = priv;
	struct ngene *dev = chan->dev;


	if (flags & DF_SWAP32)
		swap_buffer(buf, len);

	if (dev->ci.en && chan->number == 2) {
		while (len >= 188) {
			tsin_copy_stripped(dev, buf);

			buf += 188;
			len -= 188;
		}
		return NULL;
	}

	if (chan->users > 0)
		dvb_dmx_swfilter(&chan->demux, buf, len);

	return NULL;
}

void *tsout_exchange(void *priv, void *buf, u32 len, u32 clock, u32 flags)
{
	struct ngene_channel *chan = priv;
	struct ngene *dev = chan->dev;
	u32 alen;

	alen = dvb_ringbuffer_avail(&dev->tsout_rbuf);
	alen -= alen % 188;

	if (alen < len)
		FillTSBuffer(buf + alen, len - alen, flags);
	else
		alen = len;
	dvb_ringbuffer_read(&dev->tsout_rbuf, buf, alen);
	if (flags & DF_SWAP32)
		swap_buffer((u32 *)buf, alen);
	wake_up_interruptible(&dev->tsout_rbuf.queue);
	return buf;
}


int ngene_start_feed(struct dvb_demux_feed *dvbdmxfeed)
{
	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
	struct ngene_channel *chan = dvbdmx->priv;

	if (chan->users == 0) {
		if (!chan->dev->cmd_timeout_workaround || !chan->running)
			set_transfer(chan, 1);
	}

	return ++chan->users;
}

int ngene_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
{
	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
	struct ngene_channel *chan = dvbdmx->priv;

	if (--chan->users)
		return chan->users;

	if (!chan->dev->cmd_timeout_workaround)
		set_transfer(chan, 0);

	return 0;
}

int my_dvb_dmx_ts_card_init(struct dvb_demux *dvbdemux, char *id,
			    int (*start_feed)(struct dvb_demux_feed *),
			    int (*stop_feed)(struct dvb_demux_feed *),
			    void *priv)
{
	dvbdemux->priv = priv;

	dvbdemux->filternum = 256;
	dvbdemux->feednum = 256;
	dvbdemux->start_feed = start_feed;
	dvbdemux->stop_feed = stop_feed;
	dvbdemux->write_to_decoder = NULL;
	dvbdemux->dmx.capabilities = (DMX_TS_FILTERING |
				      DMX_SECTION_FILTERING |
				      DMX_MEMORY_BASED_FILTERING);
	return dvb_dmx_init(dvbdemux);
}

int my_dvb_dmxdev_ts_card_init(struct dmxdev *dmxdev,
			       struct dvb_demux *dvbdemux,
			       struct dmx_frontend *hw_frontend,
			       struct dmx_frontend *mem_frontend,
			       struct dvb_adapter *dvb_adapter)
{
	int ret;

	dmxdev->filternum = 256;
	dmxdev->demux = &dvbdemux->dmx;
	dmxdev->capabilities = 0;
	ret = dvb_dmxdev_init(dmxdev, dvb_adapter);
	if (ret < 0)
		return ret;

	hw_frontend->source = DMX_FRONTEND_0;
	dvbdemux->dmx.add_frontend(&dvbdemux->dmx, hw_frontend);
	mem_frontend->source = DMX_MEMORY_FE;
	dvbdemux->dmx.add_frontend(&dvbdemux->dmx, mem_frontend);
	return dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, hw_frontend);
}
Commit	Line	Data
1899e97c DH	1	/*
	2	* ngene-dvb.c: nGene PCIe bridge driver - DVB functions
	3	*
	4	* Copyright (C) 2005-2007 Micronas
	5	*
	6	* Copyright (C) 2008-2009 Ralph Metzler <rjkm@metzlerbros.de>
	7	* Modifications for new nGene firmware,
	8	* support for EEPROM-copying,
	9	* support for new dual DVB-S2 card prototype
	10	*
	11	*
	12	* This program is free software; you can redistribute it and/or
	13	* modify it under the terms of the GNU General Public License
	14	* version 2 only, as published by the Free Software Foundation.
	15	*
	16	*
	17	* This program is distributed in the hope that it will be useful,
	18	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	19	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	20	* GNU General Public License for more details.
	21	*
bcb63314 SA	22	* To obtain the license, point your browser to
bcb63314 SA	23	* http://www.gnu.org/copyleft/gpl.html
1899e97c DH	24	*/
	25
	26	#include <linux/module.h>
	27	#include <linux/init.h>
	28	#include <linux/delay.h>
	29	#include <linux/slab.h>
	30	#include <linux/poll.h>
	31	#include <linux/io.h>
	32	#include <asm/div64.h>
	33	#include <linux/pci.h>
1899e97c	34	#include <linux/timer.h>
1899e97c DH	35	#include <linux/byteorder/generic.h>
	36	#include <linux/firmware.h>
	37	#include <linux/vmalloc.h>
	38
	39	#include "ngene.h"
	40
1899e97c DH	41
	42	/****************************************************************************/
	43	/* COMMAND API interface ****************************************************/
	44	/****************************************************************************/
	45
c463c979	46	static ssize_t ts_write(struct file file, const char __user buf,
0f0b270f RM	47	size_t count, loff_t *ppos)
	48	{
	49	struct dvb_device *dvbdev = file->private_data;
	50	struct ngene_channel *chan = dvbdev->priv;
	51	struct ngene *dev = chan->dev;
	52
	53	if (wait_event_interruptible(dev->tsout_rbuf.queue,
	54	dvb_ringbuffer_free
	55	(&dev->tsout_rbuf) >= count) < 0)
	56	return 0;
	57
04da2dae	58	dvb_ringbuffer_write_user(&dev->tsout_rbuf, buf, count);
0f0b270f RM	59
	60	return count;
	61	}
	62
c463c979	63	static ssize_t ts_read(struct file file, char __user buf,
0f0b270f RM	64	size_t count, loff_t *ppos)
	65	{
	66	struct dvb_device *dvbdev = file->private_data;
	67	struct ngene_channel *chan = dvbdev->priv;
	68	struct ngene *dev = chan->dev;
	69	int left, avail;
	70
	71	left = count;
	72	while (left) {
	73	if (wait_event_interruptible(
	74	dev->tsin_rbuf.queue,
	75	dvb_ringbuffer_avail(&dev->tsin_rbuf) > 0) < 0)
	76	return -EAGAIN;
	77	avail = dvb_ringbuffer_avail(&dev->tsin_rbuf);
	78	if (avail > left)
	79	avail = left;
	80	dvb_ringbuffer_read_user(&dev->tsin_rbuf, buf, avail);
	81	left -= avail;
	82	buf += avail;
	83	}
	84	return count;
	85	}
	86
6294513d DS	87	static __poll_t ts_poll(struct file file, poll_table wait)
	88	{
	89	struct dvb_device *dvbdev = file->private_data;
	90	struct ngene_channel *chan = dvbdev->priv;
	91	struct ngene *dev = chan->dev;
	92	struct dvb_ringbuffer *rbuf = &dev->tsin_rbuf;
	93	struct dvb_ringbuffer *wbuf = &dev->tsout_rbuf;
	94	__poll_t mask = 0;
	95
	96	poll_wait(file, &rbuf->queue, wait);
	97	poll_wait(file, &wbuf->queue, wait);
	98
	99	if (!dvb_ringbuffer_empty(rbuf))
	100	mask \|= EPOLLIN \| EPOLLRDNORM;
	101	if (dvb_ringbuffer_free(wbuf) >= 188)
	102	mask \|= EPOLLOUT \| EPOLLWRNORM;
	103
	104	return mask;
	105	}
	106
0f0b270f RM	107	static const struct file_operations ci_fops = {
	108	.owner = THIS_MODULE,
	109	.read = ts_read,
	110	.write = ts_write,
	111	.open = dvb_generic_open,
	112	.release = dvb_generic_release,
6294513d DS	113	.poll = ts_poll,
6294513d DS	114	.mmap = NULL,
0f0b270f RM	115	};
	116
	117	struct dvb_device ngene_dvbdev_ci = {
6294513d DS	118	.priv = NULL,
	119	.readers = 1,
	120	.writers = 1,
	121	.users = 2,
0f0b270f RM	122	.fops = &ci_fops,
	123	};
	124
	125
1899e97c DH	126	/****************************************************************************/
	127	/* DVB functions and API interface ******************************************/
	128	/****************************************************************************/
	129
	130	static void swap_buffer(u32 *p, u32 len)
	131	{
	132	while (len) {
	133	p = swab32(p);
	134	p++;
	135	len -= 4;
	136	}
	137	}
	138
36e3fc89 OE	139	/* start of filler packet */
	140	static u8 fill_ts[] = { 0x47, 0x1f, 0xff, 0x10, TS_FILLER };
	141
e5fc6767 DS	142	static inline void tsin_copy_stripped(struct ngene dev, void buf)
	143	{
	144	if (memcmp(buf, fill_ts, sizeof(fill_ts)) != 0) {
	145	if (dvb_ringbuffer_free(&dev->tsin_rbuf) >= 188) {
	146	dvb_ringbuffer_write(&dev->tsin_rbuf, buf, 188);
	147	wake_up(&dev->tsin_rbuf.queue);
	148	}
	149	}
	150	}
36e3fc89	151
1899e97c DH	152	void tsin_exchange(void priv, void *buf, u32 len, u32 clock, u32 flags)
	153	{
	154	struct ngene_channel *chan = priv;
0f0b270f	155	struct ngene *dev = chan->dev;
1899e97c DH	156
1899e97c DH	157
0f0b270f RM	158	if (flags & DF_SWAP32)
0f0b270f RM	159	swap_buffer(buf, len);
36e3fc89	160
0f0b270f	161	if (dev->ci.en && chan->number == 2) {
36e3fc89	162	while (len >= 188) {
e5fc6767 DS	163	tsin_copy_stripped(dev, buf);
e5fc6767 DS	164
36e3fc89 OE	165	buf += 188;
36e3fc89 OE	166	len -= 188;
0f0b270f	167	}
36e3fc89	168	return NULL;
0f0b270f	169	}
36e3fc89	170
9143a437	171	if (chan->users > 0)
1899e97c	172	dvb_dmx_swfilter(&chan->demux, buf, len);
9143a437	173
1899e97c DH	174	return NULL;
	175	}
	176
1899e97c DH	177	void tsout_exchange(void priv, void *buf, u32 len, u32 clock, u32 flags)
	178	{
	179	struct ngene_channel *chan = priv;
	180	struct ngene *dev = chan->dev;
	181	u32 alen;
	182
	183	alen = dvb_ringbuffer_avail(&dev->tsout_rbuf);
	184	alen -= alen % 188;
	185
	186	if (alen < len)
	187	FillTSBuffer(buf + alen, len - alen, flags);
	188	else
	189	alen = len;
	190	dvb_ringbuffer_read(&dev->tsout_rbuf, buf, alen);
	191	if (flags & DF_SWAP32)
	192	swap_buffer((u32 *)buf, alen);
	193	wake_up_interruptible(&dev->tsout_rbuf.queue);
	194	return buf;
	195	}
	196
	197
	198
	199	int ngene_start_feed(struct dvb_demux_feed *dvbdmxfeed)
	200	{
	201	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
	202	struct ngene_channel *chan = dvbdmx->priv;
	203
	204	if (chan->users == 0) {
5a2a1848	205	if (!chan->dev->cmd_timeout_workaround \|\| !chan->running)
1899e97c	206	set_transfer(chan, 1);
1899e97c DH	207	}
	208
	209	return ++chan->users;
	210	}
	211
	212	int ngene_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
	213	{
	214	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
	215	struct ngene_channel *chan = dvbdmx->priv;
	216
	217	if (--chan->users)
	218	return chan->users;
	219
5a2a1848 OE	220	if (!chan->dev->cmd_timeout_workaround)
5a2a1848 OE	221	set_transfer(chan, 0);
1899e97c DH	222
	223	return 0;
	224	}
	225
	226	int my_dvb_dmx_ts_card_init(struct dvb_demux dvbdemux, char id,
	227	int (start_feed)(struct dvb_demux_feed ),
	228	int (stop_feed)(struct dvb_demux_feed ),
	229	void *priv)
	230	{
	231	dvbdemux->priv = priv;
	232
	233	dvbdemux->filternum = 256;
	234	dvbdemux->feednum = 256;
	235	dvbdemux->start_feed = start_feed;
	236	dvbdemux->stop_feed = stop_feed;
	237	dvbdemux->write_to_decoder = NULL;
	238	dvbdemux->dmx.capabilities = (DMX_TS_FILTERING \|
	239	DMX_SECTION_FILTERING \|
	240	DMX_MEMORY_BASED_FILTERING);
	241	return dvb_dmx_init(dvbdemux);
	242	}
	243
	244	int my_dvb_dmxdev_ts_card_init(struct dmxdev *dmxdev,
	245	struct dvb_demux *dvbdemux,
	246	struct dmx_frontend *hw_frontend,
	247	struct dmx_frontend *mem_frontend,
	248	struct dvb_adapter *dvb_adapter)
	249	{
	250	int ret;
	251
	252	dmxdev->filternum = 256;
	253	dmxdev->demux = &dvbdemux->dmx;
	254	dmxdev->capabilities = 0;
	255	ret = dvb_dmxdev_init(dmxdev, dvb_adapter);
	256	if (ret < 0)
	257	return ret;
	258
	259	hw_frontend->source = DMX_FRONTEND_0;
	260	dvbdemux->dmx.add_frontend(&dvbdemux->dmx, hw_frontend);
	261	mem_frontend->source = DMX_MEMORY_FE;
	262	dvbdemux->dmx.add_frontend(&dvbdemux->dmx, mem_frontend);
	263	return dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, hw_frontend);
	264	}