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

// SPDX-License-Identifier: GPL-2.0-only
/*
 * 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
 */

#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"

static int ci_tsfix = 1;
module_param(ci_tsfix, int, 0444);
MODULE_PARM_DESC(ci_tsfix, "Detect and fix TS buffer offset shifts in conjunction with CI expansions (default: 1/enabled)");

/****************************************************************************/
/* 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 int tsin_find_offset(void *buf, u32 len)
{
	int i, l;

	l = len - sizeof(fill_ts);
	if (l <= 0)
		return -1;

	for (i = 0; i < l; i++) {
		if (((char *)buf)[i] == 0x47) {
			if (!memcmp(buf + i, fill_ts, sizeof(fill_ts)))
				return i % 188;
		}
	}

	return -1;
}

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;
	int tsoff;

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

	if (dev->ci.en && chan->number == 2) {
		/* blindly copy buffers if ci_tsfix is disabled */
		if (!ci_tsfix) {
			while (len >= 188) {
				tsin_copy_stripped(dev, buf);

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

		/* ci_tsfix = 1 */

		/*
		 * since the remainder of the TS packet which got cut off
		 * in the previous tsin_exchange() run is at the beginning
		 * of the new TS buffer, append this to the temp buffer and
		 * send it to the DVB ringbuffer afterwards.
		 */
		if (chan->tsin_offset) {
			memcpy(&chan->tsin_buffer[(188 - chan->tsin_offset)],
			       buf, chan->tsin_offset);
			tsin_copy_stripped(dev, &chan->tsin_buffer);

			buf += chan->tsin_offset;
			len -= chan->tsin_offset;
		}

		/*
		 * copy TS packets to the DVB ringbuffer and detect new offset
		 * shifts by checking for a valid TS SYNC byte
		 */
		while (len >= 188) {
			if (*((char *)buf) != 0x47) {
				/*
				 * no SYNC header, find new offset shift
				 * (max. 188 bytes, tsoff will be mod 188)
				 */
				tsoff = tsin_find_offset(buf, len);
				if (tsoff > 0) {
					chan->tsin_offset += tsoff;
					chan->tsin_offset %= 188;

					buf += tsoff;
					len -= tsoff;

					dev_info(&dev->pci_dev->dev,
						 "%s(): tsin_offset shift by %d on channel %d\n",
						 __func__, tsoff,
						 chan->number);

					/*
					 * offset corrected. re-check remaining
					 * len for a full TS frame, break and
					 * skip to fragment handling if < 188.
					 */
					if (len < 188)
						break;
				}
			}

			tsin_copy_stripped(dev, buf);

			buf += 188;
			len -= 188;
		}

		/*
		 * if a fragment is left, copy to temp buffer. The remainder
		 * will be appended in the next tsin_exchange() iteration.
		 */
		if (len > 0 && len < 188)
			memcpy(&chan->tsin_buffer, buf, len);

		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
89ee7f4f	1	// SPDX-License-Identifier: GPL-2.0-only
1899e97c DH	2	/*
	3	* ngene-dvb.c: nGene PCIe bridge driver - DVB functions
	4	*
	5	* Copyright (C) 2005-2007 Micronas
	6	*
	7	* Copyright (C) 2008-2009 Ralph Metzler <rjkm@metzlerbros.de>
	8	* Modifications for new nGene firmware,
	9	* support for EEPROM-copying,
	10	* support for new dual DVB-S2 card prototype
1899e97c DH	11	*/
	12
	13	#include <linux/module.h>
	14	#include <linux/init.h>
	15	#include <linux/delay.h>
	16	#include <linux/slab.h>
	17	#include <linux/poll.h>
	18	#include <linux/io.h>
	19	#include <asm/div64.h>
	20	#include <linux/pci.h>
1899e97c	21	#include <linux/timer.h>
1899e97c DH	22	#include <linux/byteorder/generic.h>
	23	#include <linux/firmware.h>
	24	#include <linux/vmalloc.h>
	25
	26	#include "ngene.h"
	27
60d0bbec DS	28	static int ci_tsfix = 1;
60d0bbec DS	29	module_param(ci_tsfix, int, 0444);
87a06379	30	MODULE_PARM_DESC(ci_tsfix, "Detect and fix TS buffer offset shifts in conjunction with CI expansions (default: 1/enabled)");
1899e97c DH	31
	32	/****************************************************************************/
	33	/* COMMAND API interface ****************************************************/
	34	/****************************************************************************/
	35
c463c979	36	static ssize_t ts_write(struct file file, const char __user buf,
0f0b270f RM	37	size_t count, loff_t *ppos)
	38	{
	39	struct dvb_device *dvbdev = file->private_data;
	40	struct ngene_channel *chan = dvbdev->priv;
	41	struct ngene *dev = chan->dev;
	42
	43	if (wait_event_interruptible(dev->tsout_rbuf.queue,
	44	dvb_ringbuffer_free
	45	(&dev->tsout_rbuf) >= count) < 0)
	46	return 0;
	47
04da2dae	48	dvb_ringbuffer_write_user(&dev->tsout_rbuf, buf, count);
0f0b270f RM	49
	50	return count;
	51	}
	52
c463c979	53	static ssize_t ts_read(struct file file, char __user buf,
0f0b270f RM	54	size_t count, loff_t *ppos)
	55	{
	56	struct dvb_device *dvbdev = file->private_data;
	57	struct ngene_channel *chan = dvbdev->priv;
	58	struct ngene *dev = chan->dev;
	59	int left, avail;
	60
	61	left = count;
	62	while (left) {
	63	if (wait_event_interruptible(
	64	dev->tsin_rbuf.queue,
	65	dvb_ringbuffer_avail(&dev->tsin_rbuf) > 0) < 0)
	66	return -EAGAIN;
	67	avail = dvb_ringbuffer_avail(&dev->tsin_rbuf);
	68	if (avail > left)
	69	avail = left;
	70	dvb_ringbuffer_read_user(&dev->tsin_rbuf, buf, avail);
	71	left -= avail;
	72	buf += avail;
	73	}
	74	return count;
	75	}
	76
6294513d DS	77	static __poll_t ts_poll(struct file file, poll_table wait)
	78	{
	79	struct dvb_device *dvbdev = file->private_data;
	80	struct ngene_channel *chan = dvbdev->priv;
	81	struct ngene *dev = chan->dev;
	82	struct dvb_ringbuffer *rbuf = &dev->tsin_rbuf;
	83	struct dvb_ringbuffer *wbuf = &dev->tsout_rbuf;
	84	__poll_t mask = 0;
	85
	86	poll_wait(file, &rbuf->queue, wait);
	87	poll_wait(file, &wbuf->queue, wait);
	88
	89	if (!dvb_ringbuffer_empty(rbuf))
	90	mask \|= EPOLLIN \| EPOLLRDNORM;
	91	if (dvb_ringbuffer_free(wbuf) >= 188)
	92	mask \|= EPOLLOUT \| EPOLLWRNORM;
	93
	94	return mask;
	95	}
	96
0f0b270f RM	97	static const struct file_operations ci_fops = {
	98	.owner = THIS_MODULE,
	99	.read = ts_read,
	100	.write = ts_write,
	101	.open = dvb_generic_open,
	102	.release = dvb_generic_release,
6294513d DS	103	.poll = ts_poll,
6294513d DS	104	.mmap = NULL,
0f0b270f RM	105	};
	106
	107	struct dvb_device ngene_dvbdev_ci = {
6294513d DS	108	.priv = NULL,
	109	.readers = 1,
	110	.writers = 1,
	111	.users = 2,
0f0b270f RM	112	.fops = &ci_fops,
	113	};
	114
	115
1899e97c DH	116	/****************************************************************************/
	117	/* DVB functions and API interface ******************************************/
	118	/****************************************************************************/
	119
	120	static void swap_buffer(u32 *p, u32 len)
	121	{
	122	while (len) {
	123	p = swab32(p);
	124	p++;
	125	len -= 4;
	126	}
	127	}
	128
36e3fc89 OE	129	/* start of filler packet */
	130	static u8 fill_ts[] = { 0x47, 0x1f, 0xff, 0x10, TS_FILLER };
	131
60d0bbec DS	132	static int tsin_find_offset(void *buf, u32 len)
	133	{
	134	int i, l;
	135
	136	l = len - sizeof(fill_ts);
	137	if (l <= 0)
	138	return -1;
	139
	140	for (i = 0; i < l; i++) {
	141	if (((char *)buf)[i] == 0x47) {
	142	if (!memcmp(buf + i, fill_ts, sizeof(fill_ts)))
	143	return i % 188;
	144	}
	145	}
	146
	147	return -1;
	148	}
	149
e5fc6767 DS	150	static inline void tsin_copy_stripped(struct ngene dev, void buf)
	151	{
	152	if (memcmp(buf, fill_ts, sizeof(fill_ts)) != 0) {
	153	if (dvb_ringbuffer_free(&dev->tsin_rbuf) >= 188) {
	154	dvb_ringbuffer_write(&dev->tsin_rbuf, buf, 188);
	155	wake_up(&dev->tsin_rbuf.queue);
	156	}
	157	}
	158	}
36e3fc89	159
1899e97c DH	160	void tsin_exchange(void priv, void *buf, u32 len, u32 clock, u32 flags)
	161	{
	162	struct ngene_channel *chan = priv;
0f0b270f	163	struct ngene *dev = chan->dev;
60d0bbec	164	int tsoff;
1899e97c	165
0f0b270f RM	166	if (flags & DF_SWAP32)
0f0b270f RM	167	swap_buffer(buf, len);
36e3fc89	168
0f0b270f	169	if (dev->ci.en && chan->number == 2) {
60d0bbec DS	170	/* blindly copy buffers if ci_tsfix is disabled */
	171	if (!ci_tsfix) {
	172	while (len >= 188) {
	173	tsin_copy_stripped(dev, buf);
	174
	175	buf += 188;
	176	len -= 188;
	177	}
	178	return NULL;
	179	}
	180
	181	/* ci_tsfix = 1 */
	182
	183	/*
	184	* since the remainder of the TS packet which got cut off
	185	* in the previous tsin_exchange() run is at the beginning
	186	* of the new TS buffer, append this to the temp buffer and
	187	* send it to the DVB ringbuffer afterwards.
	188	*/
	189	if (chan->tsin_offset) {
	190	memcpy(&chan->tsin_buffer[(188 - chan->tsin_offset)],
	191	buf, chan->tsin_offset);
	192	tsin_copy_stripped(dev, &chan->tsin_buffer);
	193
	194	buf += chan->tsin_offset;
	195	len -= chan->tsin_offset;
	196	}
	197
	198	/*
	199	* copy TS packets to the DVB ringbuffer and detect new offset
	200	* shifts by checking for a valid TS SYNC byte
	201	*/
36e3fc89	202	while (len >= 188) {
60d0bbec DS	203	if (((char )buf) != 0x47) {
	204	/*
	205	* no SYNC header, find new offset shift
	206	* (max. 188 bytes, tsoff will be mod 188)
	207	*/
	208	tsoff = tsin_find_offset(buf, len);
	209	if (tsoff > 0) {
	210	chan->tsin_offset += tsoff;
	211	chan->tsin_offset %= 188;
	212
	213	buf += tsoff;
	214	len -= tsoff;
	215
	216	dev_info(&dev->pci_dev->dev,
	217	"%s(): tsin_offset shift by %d on channel %d\n",
	218	__func__, tsoff,
	219	chan->number);
	220
	221	/*
	222	* offset corrected. re-check remaining
	223	* len for a full TS frame, break and
	224	* skip to fragment handling if < 188.
	225	*/
	226	if (len < 188)
	227	break;
	228	}
	229	}
	230
e5fc6767 DS	231	tsin_copy_stripped(dev, buf);
e5fc6767 DS	232
36e3fc89 OE	233	buf += 188;
36e3fc89 OE	234	len -= 188;
0f0b270f	235	}
60d0bbec DS	236
	237	/*
	238	* if a fragment is left, copy to temp buffer. The remainder
	239	* will be appended in the next tsin_exchange() iteration.
	240	*/
	241	if (len > 0 && len < 188)
	242	memcpy(&chan->tsin_buffer, buf, len);
	243
36e3fc89	244	return NULL;
0f0b270f	245	}
36e3fc89	246
9143a437	247	if (chan->users > 0)
1899e97c	248	dvb_dmx_swfilter(&chan->demux, buf, len);
9143a437	249
1899e97c DH	250	return NULL;
	251	}
	252
1899e97c DH	253	void tsout_exchange(void priv, void *buf, u32 len, u32 clock, u32 flags)
	254	{
	255	struct ngene_channel *chan = priv;
	256	struct ngene *dev = chan->dev;
	257	u32 alen;
	258
	259	alen = dvb_ringbuffer_avail(&dev->tsout_rbuf);
	260	alen -= alen % 188;
	261
	262	if (alen < len)
	263	FillTSBuffer(buf + alen, len - alen, flags);
	264	else
	265	alen = len;
	266	dvb_ringbuffer_read(&dev->tsout_rbuf, buf, alen);
	267	if (flags & DF_SWAP32)
	268	swap_buffer((u32 *)buf, alen);
	269	wake_up_interruptible(&dev->tsout_rbuf.queue);
	270	return buf;
	271	}
	272
	273
	274
	275	int ngene_start_feed(struct dvb_demux_feed *dvbdmxfeed)
	276	{
	277	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
	278	struct ngene_channel *chan = dvbdmx->priv;
	279
	280	if (chan->users == 0) {
5a2a1848	281	if (!chan->dev->cmd_timeout_workaround \|\| !chan->running)
1899e97c	282	set_transfer(chan, 1);
1899e97c DH	283	}
	284
	285	return ++chan->users;
	286	}
	287
	288	int ngene_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
	289	{
	290	struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
	291	struct ngene_channel *chan = dvbdmx->priv;
	292
	293	if (--chan->users)
	294	return chan->users;
	295
5a2a1848 OE	296	if (!chan->dev->cmd_timeout_workaround)
5a2a1848 OE	297	set_transfer(chan, 0);
1899e97c DH	298
	299	return 0;
	300	}
	301
	302	int my_dvb_dmx_ts_card_init(struct dvb_demux dvbdemux, char id,
	303	int (start_feed)(struct dvb_demux_feed ),
	304	int (stop_feed)(struct dvb_demux_feed ),
	305	void *priv)
	306	{
	307	dvbdemux->priv = priv;
	308
	309	dvbdemux->filternum = 256;
	310	dvbdemux->feednum = 256;
	311	dvbdemux->start_feed = start_feed;
	312	dvbdemux->stop_feed = stop_feed;
	313	dvbdemux->write_to_decoder = NULL;
	314	dvbdemux->dmx.capabilities = (DMX_TS_FILTERING \|
	315	DMX_SECTION_FILTERING \|
	316	DMX_MEMORY_BASED_FILTERING);
	317	return dvb_dmx_init(dvbdemux);
	318	}
	319
	320	int my_dvb_dmxdev_ts_card_init(struct dmxdev *dmxdev,
	321	struct dvb_demux *dvbdemux,
	322	struct dmx_frontend *hw_frontend,
	323	struct dmx_frontend *mem_frontend,
	324	struct dvb_adapter *dvb_adapter)
	325	{
	326	int ret;
	327
	328	dmxdev->filternum = 256;
	329	dmxdev->demux = &dvbdemux->dmx;
	330	dmxdev->capabilities = 0;
	331	ret = dvb_dmxdev_init(dmxdev, dvb_adapter);
	332	if (ret < 0)
	333	return ret;
	334
	335	hw_frontend->source = DMX_FRONTEND_0;
	336	dvbdemux->dmx.add_frontend(&dvbdemux->dmx, hw_frontend);
	337	mem_frontend->source = DMX_MEMORY_FE;
	338	dvbdemux->dmx.add_frontend(&dvbdemux->dmx, mem_frontend);
	339	return dvbdemux->dmx.connect_frontend(&dvbdemux->dmx, hw_frontend);
	340	}