drivers/media/pci/saa7134/saa7134-ts.c - kernel/msm-4.9 - Gitiles

 /*
  *
  * device driver for philips saa7134 based TV cards
  * video4linux video interface
  *
  * (c) 2001,02 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
  *
  *  This program is free software; you can redistribute it and/or modify
  *  it under the terms of the GNU General Public License as published by
  *  the Free Software Foundation; either version 2 of the License, or
  *  (at your option) any later version.
  *
  *  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.
  *
  *  You should have received a copy of the GNU General Public License
  *  along with this program; if not, write to the Free Software
  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  */

 #include <linux/init.h>
 #include <linux/list.h>
 #include <linux/module.h>
 #include <linux/kernel.h>
 #include <linux/delay.h>

 #include "saa7134-reg.h"
 #include "saa7134.h"

 /* ------------------------------------------------------------------ */

 static unsigned int ts_debug;
 module_param(ts_debug, int, 0644);
 MODULE_PARM_DESC(ts_debug,"enable debug messages [ts]");

 #define dprintk(fmt, arg...)	if (ts_debug) \
 	printk(KERN_DEBUG "%s/ts: " fmt, dev->name , ## arg)

 /* ------------------------------------------------------------------ */

 static int buffer_activate(struct saa7134_dev *dev,
 			   struct saa7134_buf *buf,
 			   struct saa7134_buf *next)
 {

 	dprintk("buffer_activate [%p]",buf);
 	buf->vb.state = VIDEOBUF_ACTIVE;
 	buf->top_seen = 0;

 	if (NULL == next)
 		next = buf;
 	if (V4L2_FIELD_TOP == buf->vb.field) {
 		dprintk("- [top]     buf=%p next=%p\n",buf,next);
 		saa_writel(SAA7134_RS_BA1(5),saa7134_buffer_base(buf));
 		saa_writel(SAA7134_RS_BA2(5),saa7134_buffer_base(next));
 	} else {
 		dprintk("- [bottom]  buf=%p next=%p\n",buf,next);
 		saa_writel(SAA7134_RS_BA1(5),saa7134_buffer_base(next));
 		saa_writel(SAA7134_RS_BA2(5),saa7134_buffer_base(buf));
 	}

 	/* start DMA */
 	saa7134_set_dmabits(dev);

 	mod_timer(&dev->ts_q.timeout, jiffies+TS_BUFFER_TIMEOUT);

 	if (!dev->ts_started)
 		saa7134_ts_start(dev);

 	return 0;
 }

 static int buffer_prepare(struct videobuf_queue *q, struct videobuf_buffer *vb,
 		enum v4l2_field field)
 {
 	struct saa7134_dmaqueue *dmaq = q->priv_data;
 	struct saa7134_dev *dev = dmaq->dev;
 	struct saa7134_buf *buf = container_of(vb, struct saa7134_buf, vb);
 	unsigned int lines, llength, size;
 	int err;

 	dprintk("buffer_prepare [%p,%s]\n", buf, v4l2_field_names[field]);

 	llength = TS_PACKET_SIZE;
 	lines = dev->ts.nr_packets;

 	size = lines * llength;
 	if (0 != buf->vb.baddr  &&  buf->vb.bsize < size)
 		return -EINVAL;

 	if (buf->vb.size != size) {
 		saa7134_dma_free(q,buf);
 	}

 	if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {

 		struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb);

 		dprintk("buffer_prepare: needs_init\n");

 		buf->vb.width  = llength;
 		buf->vb.height = lines;
 		buf->vb.size   = size;

 		err = videobuf_iolock(q,&buf->vb,NULL);
 		if (err)
 			goto oops;
 		err = saa7134_pgtable_build(dev->pci, &dmaq->pt,
 					    dma->sglist,
 					    dma->sglen,
 					    saa7134_buffer_startpage(buf));
 		if (err)
 			goto oops;
 	}

 	buf->vb.state = VIDEOBUF_PREPARED;
 	buf->activate = buffer_activate;
 	buf->vb.field = field;
 	return 0;

  oops:
 	saa7134_dma_free(q,buf);
 	return err;
 }

 static int
 buffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size)
 {
 	struct saa7134_dmaqueue *dmaq = q->priv_data;
 	struct saa7134_dev *dev = dmaq->dev;

 	*size = TS_PACKET_SIZE * dev->ts.nr_packets;
 	if (0 == *count)
 		*count = dev->ts.nr_bufs;
 	*count = saa7134_buffer_count(*size,*count);

 	return 0;
 }

 static void buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb)
 {
 	struct saa7134_dmaqueue *dmaq = q->priv_data;
 	struct saa7134_dev *dev = dmaq->dev;
 	struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);

 	saa7134_buffer_queue(dev,&dev->ts_q,buf);
 }

 static void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb)
 {
 	struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
 	struct saa7134_dmaqueue *dmaq = q->priv_data;
 	struct saa7134_dev *dev = dmaq->dev;

 	if (dev->ts_started)
 		saa7134_ts_stop(dev);

 	saa7134_dma_free(q,buf);
 }

 struct videobuf_queue_ops saa7134_ts_qops = {
 	.buf_setup    = buffer_setup,
 	.buf_prepare  = buffer_prepare,
 	.buf_queue    = buffer_queue,
 	.buf_release  = buffer_release,
 };
 EXPORT_SYMBOL_GPL(saa7134_ts_qops);

 /* ----------------------------------------------------------- */
 /* exported stuff                                              */

 static unsigned int tsbufs = 8;
 module_param(tsbufs, int, 0444);
 MODULE_PARM_DESC(tsbufs, "number of ts buffers for read/write IO, range 2-32");

 static unsigned int ts_nr_packets = 64;
 module_param(ts_nr_packets, int, 0444);
 MODULE_PARM_DESC(ts_nr_packets,"size of a ts buffers (in ts packets)");

 int saa7134_ts_init_hw(struct saa7134_dev *dev)
 {
 	/* deactivate TS softreset */
 	saa_writeb(SAA7134_TS_SERIAL1, 0x00);
 	/* TSSOP high active, TSVAL high active, TSLOCK ignored */
 	saa_writeb(SAA7134_TS_PARALLEL, 0x6c);
 	saa_writeb(SAA7134_TS_PARALLEL_SERIAL, (TS_PACKET_SIZE-1));
 	saa_writeb(SAA7134_TS_DMA0, ((dev->ts.nr_packets-1)&0xff));
 	saa_writeb(SAA7134_TS_DMA1, (((dev->ts.nr_packets-1)>>8)&0xff));
 	/* TSNOPIT=0, TSCOLAP=0 */
 	saa_writeb(SAA7134_TS_DMA2,
 		((((dev->ts.nr_packets-1)>>16)&0x3f) | 0x00));

 	return 0;
 }

 int saa7134_ts_init1(struct saa7134_dev *dev)
 {
 	/* sanitycheck insmod options */
 	if (tsbufs < 2)
 		tsbufs = 2;
 	if (tsbufs > VIDEO_MAX_FRAME)
 		tsbufs = VIDEO_MAX_FRAME;
 	if (ts_nr_packets < 4)
 		ts_nr_packets = 4;
 	if (ts_nr_packets > 312)
 		ts_nr_packets = 312;
 	dev->ts.nr_bufs    = tsbufs;
 	dev->ts.nr_packets = ts_nr_packets;

 	INIT_LIST_HEAD(&dev->ts_q.queue);
 	init_timer(&dev->ts_q.timeout);
 	dev->ts_q.timeout.function = saa7134_buffer_timeout;
 	dev->ts_q.timeout.data     = (unsigned long)(&dev->ts_q);
 	dev->ts_q.dev              = dev;
 	dev->ts_q.need_two         = 1;
 	dev->ts_started            = 0;
 	saa7134_pgtable_alloc(dev->pci, &dev->ts_q.pt);

 	/* init TS hw */
 	saa7134_ts_init_hw(dev);

 	return 0;
 }

 /* Function for stop TS */
 int saa7134_ts_stop(struct saa7134_dev *dev)
 {
 	dprintk("TS stop\n");

 	BUG_ON(!dev->ts_started);

 	/* Stop TS stream */
 	switch (saa7134_boards[dev->board].ts_type) {
 	case SAA7134_MPEG_TS_PARALLEL:
 		saa_writeb(SAA7134_TS_PARALLEL, 0x6c);
 		dev->ts_started = 0;
 		break;
 	case SAA7134_MPEG_TS_SERIAL:
 		saa_writeb(SAA7134_TS_SERIAL0, 0x40);
 		dev->ts_started = 0;
 		break;
 	}
 	return 0;
 }

 /* Function for start TS */
 int saa7134_ts_start(struct saa7134_dev *dev)
 {
 	dprintk("TS start\n");

 	BUG_ON(dev->ts_started);

 	/* dma: setup channel 5 (= TS) */
 	saa_writeb(SAA7134_TS_DMA0, (dev->ts.nr_packets - 1) & 0xff);
 	saa_writeb(SAA7134_TS_DMA1,
 		((dev->ts.nr_packets - 1) >> 8) & 0xff);
 	/* TSNOPIT=0, TSCOLAP=0 */
 	saa_writeb(SAA7134_TS_DMA2,
 		(((dev->ts.nr_packets - 1) >> 16) & 0x3f) | 0x00);
 	saa_writel(SAA7134_RS_PITCH(5), TS_PACKET_SIZE);
 	saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_16 |
 					  SAA7134_RS_CONTROL_ME |
 					  (dev->ts_q.pt.dma >> 12));

 	/* reset hardware TS buffers */
 	saa_writeb(SAA7134_TS_SERIAL1, 0x00);
 	saa_writeb(SAA7134_TS_SERIAL1, 0x03);
 	saa_writeb(SAA7134_TS_SERIAL1, 0x00);
 	saa_writeb(SAA7134_TS_SERIAL1, 0x01);

 	/* TS clock non-inverted */
 	saa_writeb(SAA7134_TS_SERIAL1, 0x00);

 	/* Start TS stream */
 	switch (saa7134_boards[dev->board].ts_type) {
 	case SAA7134_MPEG_TS_PARALLEL:
 		saa_writeb(SAA7134_TS_SERIAL0, 0x40);
 		saa_writeb(SAA7134_TS_PARALLEL, 0xec |
 			(saa7134_boards[dev->board].ts_force_val << 4));
 		break;
 	case SAA7134_MPEG_TS_SERIAL:
 		saa_writeb(SAA7134_TS_SERIAL0, 0xd8);
 		saa_writeb(SAA7134_TS_PARALLEL, 0x6c |
 			(saa7134_boards[dev->board].ts_force_val << 4));
 		saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 0xbc);
 		saa_writeb(SAA7134_TS_SERIAL1, 0x02);
 		break;
 	}

 	dev->ts_started = 1;

 	return 0;
 }

 int saa7134_ts_fini(struct saa7134_dev *dev)
 {
 	saa7134_pgtable_free(dev->pci, &dev->ts_q.pt);
 	return 0;
 }

 void saa7134_irq_ts_done(struct saa7134_dev *dev, unsigned long status)
 {
 	enum v4l2_field field;

 	spin_lock(&dev->slock);
 	if (dev->ts_q.curr) {
 		field = dev->ts_q.curr->vb.field;
 		if (field == V4L2_FIELD_TOP) {
 			if ((status & 0x100000) != 0x000000)
 				goto done;
 		} else {
 			if ((status & 0x100000) != 0x100000)
 				goto done;
 		}
 		saa7134_buffer_finish(dev, &dev->ts_q, VIDEOBUF_DONE);
 	}
 	saa7134_buffer_next(dev,&dev->ts_q);

  done:
 	spin_unlock(&dev->slock);
 }
	/*
	*
	* device driver for philips saa7134 based TV cards
	* video4linux video interface
	*
	* (c) 2001,02 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
	*
	* This program is free software; you can redistribute it and/or modify
	* it under the terms of the GNU General Public License as published by
	* the Free Software Foundation; either version 2 of the License, or
	* (at your option) any later version.
	*
	* 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.
	*
	* You should have received a copy of the GNU General Public License
	* along with this program; if not, write to the Free Software
	* Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
	*/

	#include <linux/init.h>
	#include <linux/list.h>
	#include <linux/module.h>
	#include <linux/kernel.h>
	#include <linux/delay.h>

	#include "saa7134-reg.h"
	#include "saa7134.h"

	/* ------------------------------------------------------------------ */

	static unsigned int ts_debug;
	module_param(ts_debug, int, 0644);
	MODULE_PARM_DESC(ts_debug,"enable debug messages [ts]");

	#define dprintk(fmt, arg...) if (ts_debug) \
	printk(KERN_DEBUG "%s/ts: " fmt, dev->name , ## arg)

	/* ------------------------------------------------------------------ */

	static int buffer_activate(struct saa7134_dev *dev,
	struct saa7134_buf *buf,
	struct saa7134_buf *next)
	{

	dprintk("buffer_activate [%p]",buf);
	buf->vb.state = VIDEOBUF_ACTIVE;
	buf->top_seen = 0;

	if (NULL == next)
	next = buf;
	if (V4L2_FIELD_TOP == buf->vb.field) {
	dprintk("- [top] buf=%p next=%p\n",buf,next);
	saa_writel(SAA7134_RS_BA1(5),saa7134_buffer_base(buf));
	saa_writel(SAA7134_RS_BA2(5),saa7134_buffer_base(next));
	} else {
	dprintk("- [bottom] buf=%p next=%p\n",buf,next);
	saa_writel(SAA7134_RS_BA1(5),saa7134_buffer_base(next));
	saa_writel(SAA7134_RS_BA2(5),saa7134_buffer_base(buf));
	}

	/* start DMA */
	saa7134_set_dmabits(dev);

	mod_timer(&dev->ts_q.timeout, jiffies+TS_BUFFER_TIMEOUT);

	if (!dev->ts_started)
	saa7134_ts_start(dev);

	return 0;
	}

	static int buffer_prepare(struct videobuf_queue q, struct videobuf_buffer vb,
	enum v4l2_field field)
	{
	struct saa7134_dmaqueue *dmaq = q->priv_data;
	struct saa7134_dev *dev = dmaq->dev;
	struct saa7134_buf *buf = container_of(vb, struct saa7134_buf, vb);
	unsigned int lines, llength, size;
	int err;

	dprintk("buffer_prepare [%p,%s]\n", buf, v4l2_field_names[field]);

	llength = TS_PACKET_SIZE;
	lines = dev->ts.nr_packets;

	size = lines * llength;
	if (0 != buf->vb.baddr && buf->vb.bsize < size)
	return -EINVAL;

	if (buf->vb.size != size) {
	saa7134_dma_free(q,buf);
	}

	if (VIDEOBUF_NEEDS_INIT == buf->vb.state) {

	struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb);

	dprintk("buffer_prepare: needs_init\n");

	buf->vb.width = llength;
	buf->vb.height = lines;
	buf->vb.size = size;

	err = videobuf_iolock(q,&buf->vb,NULL);
	if (err)
	goto oops;
	err = saa7134_pgtable_build(dev->pci, &dmaq->pt,
	dma->sglist,
	dma->sglen,
	saa7134_buffer_startpage(buf));
	if (err)
	goto oops;
	}

	buf->vb.state = VIDEOBUF_PREPARED;
	buf->activate = buffer_activate;
	buf->vb.field = field;
	return 0;

	oops:
	saa7134_dma_free(q,buf);
	return err;
	}

	static int
	buffer_setup(struct videobuf_queue q, unsigned int count, unsigned int *size)
	{
	struct saa7134_dmaqueue *dmaq = q->priv_data;
	struct saa7134_dev *dev = dmaq->dev;

	size = TS_PACKET_SIZE dev->ts.nr_packets;
	if (0 == *count)
	*count = dev->ts.nr_bufs;
	count = saa7134_buffer_count(size,*count);

	return 0;
	}

	static void buffer_queue(struct videobuf_queue q, struct videobuf_buffer vb)
	{
	struct saa7134_dmaqueue *dmaq = q->priv_data;
	struct saa7134_dev *dev = dmaq->dev;
	struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);

	saa7134_buffer_queue(dev,&dev->ts_q,buf);
	}

	static void buffer_release(struct videobuf_queue q, struct videobuf_buffer vb)
	{
	struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb);
	struct saa7134_dmaqueue *dmaq = q->priv_data;
	struct saa7134_dev *dev = dmaq->dev;

	if (dev->ts_started)
	saa7134_ts_stop(dev);

	saa7134_dma_free(q,buf);
	}

	struct videobuf_queue_ops saa7134_ts_qops = {
	.buf_setup = buffer_setup,
	.buf_prepare = buffer_prepare,
	.buf_queue = buffer_queue,
	.buf_release = buffer_release,
	};
	EXPORT_SYMBOL_GPL(saa7134_ts_qops);

	/* ----------------------------------------------------------- */
	/* exported stuff */

	static unsigned int tsbufs = 8;
	module_param(tsbufs, int, 0444);
	MODULE_PARM_DESC(tsbufs, "number of ts buffers for read/write IO, range 2-32");

	static unsigned int ts_nr_packets = 64;
	module_param(ts_nr_packets, int, 0444);
	MODULE_PARM_DESC(ts_nr_packets,"size of a ts buffers (in ts packets)");

	int saa7134_ts_init_hw(struct saa7134_dev *dev)
	{
	/* deactivate TS softreset */
	saa_writeb(SAA7134_TS_SERIAL1, 0x00);
	/* TSSOP high active, TSVAL high active, TSLOCK ignored */
	saa_writeb(SAA7134_TS_PARALLEL, 0x6c);
	saa_writeb(SAA7134_TS_PARALLEL_SERIAL, (TS_PACKET_SIZE-1));
	saa_writeb(SAA7134_TS_DMA0, ((dev->ts.nr_packets-1)&0xff));
	saa_writeb(SAA7134_TS_DMA1, (((dev->ts.nr_packets-1)>>8)&0xff));
	/* TSNOPIT=0, TSCOLAP=0 */
	saa_writeb(SAA7134_TS_DMA2,
	((((dev->ts.nr_packets-1)>>16)&0x3f) \| 0x00));

	return 0;
	}

	int saa7134_ts_init1(struct saa7134_dev *dev)
	{
	/* sanitycheck insmod options */
	if (tsbufs < 2)
	tsbufs = 2;
	if (tsbufs > VIDEO_MAX_FRAME)
	tsbufs = VIDEO_MAX_FRAME;
	if (ts_nr_packets < 4)
	ts_nr_packets = 4;
	if (ts_nr_packets > 312)
	ts_nr_packets = 312;
	dev->ts.nr_bufs = tsbufs;
	dev->ts.nr_packets = ts_nr_packets;

	INIT_LIST_HEAD(&dev->ts_q.queue);
	init_timer(&dev->ts_q.timeout);
	dev->ts_q.timeout.function = saa7134_buffer_timeout;
	dev->ts_q.timeout.data = (unsigned long)(&dev->ts_q);
	dev->ts_q.dev = dev;
	dev->ts_q.need_two = 1;
	dev->ts_started = 0;
	saa7134_pgtable_alloc(dev->pci, &dev->ts_q.pt);

	/* init TS hw */
	saa7134_ts_init_hw(dev);

	return 0;
	}

	/* Function for stop TS */
	int saa7134_ts_stop(struct saa7134_dev *dev)
	{
	dprintk("TS stop\n");

	BUG_ON(!dev->ts_started);

	/* Stop TS stream */
	switch (saa7134_boards[dev->board].ts_type) {
	case SAA7134_MPEG_TS_PARALLEL:
	saa_writeb(SAA7134_TS_PARALLEL, 0x6c);
	dev->ts_started = 0;
	break;
	case SAA7134_MPEG_TS_SERIAL:
	saa_writeb(SAA7134_TS_SERIAL0, 0x40);
	dev->ts_started = 0;
	break;
	}
	return 0;
	}

	/* Function for start TS */
	int saa7134_ts_start(struct saa7134_dev *dev)
	{
	dprintk("TS start\n");

	BUG_ON(dev->ts_started);

	/* dma: setup channel 5 (= TS) */
	saa_writeb(SAA7134_TS_DMA0, (dev->ts.nr_packets - 1) & 0xff);
	saa_writeb(SAA7134_TS_DMA1,
	((dev->ts.nr_packets - 1) >> 8) & 0xff);
	/* TSNOPIT=0, TSCOLAP=0 */
	saa_writeb(SAA7134_TS_DMA2,
	(((dev->ts.nr_packets - 1) >> 16) & 0x3f) \| 0x00);
	saa_writel(SAA7134_RS_PITCH(5), TS_PACKET_SIZE);
	saa_writel(SAA7134_RS_CONTROL(5), SAA7134_RS_CONTROL_BURST_16 \|
	SAA7134_RS_CONTROL_ME \|
	(dev->ts_q.pt.dma >> 12));

	/* reset hardware TS buffers */
	saa_writeb(SAA7134_TS_SERIAL1, 0x00);
	saa_writeb(SAA7134_TS_SERIAL1, 0x03);
	saa_writeb(SAA7134_TS_SERIAL1, 0x00);
	saa_writeb(SAA7134_TS_SERIAL1, 0x01);

	/* TS clock non-inverted */
	saa_writeb(SAA7134_TS_SERIAL1, 0x00);

	/* Start TS stream */
	switch (saa7134_boards[dev->board].ts_type) {
	case SAA7134_MPEG_TS_PARALLEL:
	saa_writeb(SAA7134_TS_SERIAL0, 0x40);
	saa_writeb(SAA7134_TS_PARALLEL, 0xec \|
	(saa7134_boards[dev->board].ts_force_val << 4));
	break;
	case SAA7134_MPEG_TS_SERIAL:
	saa_writeb(SAA7134_TS_SERIAL0, 0xd8);
	saa_writeb(SAA7134_TS_PARALLEL, 0x6c \|
	(saa7134_boards[dev->board].ts_force_val << 4));
	saa_writeb(SAA7134_TS_PARALLEL_SERIAL, 0xbc);
	saa_writeb(SAA7134_TS_SERIAL1, 0x02);
	break;
	}

	dev->ts_started = 1;

	return 0;
	}

	int saa7134_ts_fini(struct saa7134_dev *dev)
	{
	saa7134_pgtable_free(dev->pci, &dev->ts_q.pt);
	return 0;
	}

	void saa7134_irq_ts_done(struct saa7134_dev *dev, unsigned long status)
	{
	enum v4l2_field field;

	spin_lock(&dev->slock);
	if (dev->ts_q.curr) {
	field = dev->ts_q.curr->vb.field;
	if (field == V4L2_FIELD_TOP) {
	if ((status & 0x100000) != 0x000000)
	goto done;
	} else {
	if ((status & 0x100000) != 0x100000)
	goto done;
	}
	saa7134_buffer_finish(dev, &dev->ts_q, VIDEOBUF_DONE);
	}
	saa7134_buffer_next(dev,&dev->ts_q);

	done:
	spin_unlock(&dev->slock);
	}