[deliverable/linux.git] / drivers / media / common / saa7146_fops.c

#include <media/saa7146_vv.h>

#define BOARD_CAN_DO_VBI(dev)   (dev->revision != 0 && dev->vv_data->vbi_minor != -1)

/****************************************************************************/
/* resource management functions, shamelessly stolen from saa7134 driver */

int saa7146_res_get(struct saa7146_fh *fh, unsigned int bit)
{
	struct saa7146_dev *dev = fh->dev;
	struct saa7146_vv *vv = dev->vv_data;

	if (fh->resources & bit) {
		DEB_D(("already allocated! want: 0x%02x, cur:0x%02x\n",bit,vv->resources));
		/* have it already allocated */
		return 1;
	}

	/* is it free? */
	down(&dev->lock);
	if (vv->resources & bit) {
		DEB_D(("locked! vv->resources:0x%02x, we want:0x%02x\n",vv->resources,bit));
		/* no, someone else uses it */
		up(&dev->lock);
		return 0;
	}
	/* it's free, grab it */
	fh->resources  |= bit;
	vv->resources |= bit;
	DEB_D(("res: get 0x%02x, cur:0x%02x\n",bit,vv->resources));
	up(&dev->lock);
	return 1;
}

void saa7146_res_free(struct saa7146_fh *fh, unsigned int bits)
{
	struct saa7146_dev *dev = fh->dev;
	struct saa7146_vv *vv = dev->vv_data;

	if ((fh->resources & bits) != bits)
		BUG();

	down(&dev->lock);
	fh->resources  &= ~bits;
	vv->resources &= ~bits;
	DEB_D(("res: put 0x%02x, cur:0x%02x\n",bits,vv->resources));
	up(&dev->lock);
}


/********************************************************************************/
/* common dma functions */

void saa7146_dma_free(struct saa7146_dev *dev,struct saa7146_buf *buf)
{
	DEB_EE(("dev:%p, buf:%p\n",dev,buf));

	if (in_interrupt())
		BUG();

	videobuf_waiton(&buf->vb,0,0);
	videobuf_dma_pci_unmap(dev->pci, &buf->vb.dma);
	videobuf_dma_free(&buf->vb.dma);
	buf->vb.state = STATE_NEEDS_INIT;
}


/********************************************************************************/
/* common buffer functions */

int saa7146_buffer_queue(struct saa7146_dev *dev,
			 struct saa7146_dmaqueue *q,
			 struct saa7146_buf *buf)
{
	assert_spin_locked(&dev->slock);
	DEB_EE(("dev:%p, dmaq:%p, buf:%p\n", dev, q, buf));

	BUG_ON(!q);

	if (NULL == q->curr) {
		q->curr = buf;
		DEB_D(("immediately activating buffer %p\n", buf));
		buf->activate(dev,buf,NULL);
	} else {
		list_add_tail(&buf->vb.queue,&q->queue);
		buf->vb.state = STATE_QUEUED;
		DEB_D(("adding buffer %p to queue. (active buffer present)\n", buf));
	}
	return 0;
}

void saa7146_buffer_finish(struct saa7146_dev *dev,
			   struct saa7146_dmaqueue *q,
			   int state)
{
	assert_spin_locked(&dev->slock);
	DEB_EE(("dev:%p, dmaq:%p, state:%d\n", dev, q, state));
	DEB_EE(("q->curr:%p\n",q->curr));

	BUG_ON(!q->curr);

	/* finish current buffer */
	if (NULL == q->curr) {
		DEB_D(("aiii. no current buffer\n"));
		return;
	}

	q->curr->vb.state = state;
	do_gettimeofday(&q->curr->vb.ts);
	wake_up(&q->curr->vb.done);

	q->curr = NULL;
}

void saa7146_buffer_next(struct saa7146_dev *dev,
			 struct saa7146_dmaqueue *q, int vbi)
{
	struct saa7146_buf *buf,*next = NULL;

	BUG_ON(!q);

	DEB_INT(("dev:%p, dmaq:%p, vbi:%d\n", dev, q, vbi));

	assert_spin_locked(&dev->slock);
	if (!list_empty(&q->queue)) {
		/* activate next one from queue */
		buf = list_entry(q->queue.next,struct saa7146_buf,vb.queue);
		list_del(&buf->vb.queue);
		if (!list_empty(&q->queue))
			next = list_entry(q->queue.next,struct saa7146_buf, vb.queue);
		q->curr = buf;
		DEB_INT(("next buffer: buf:%p, prev:%p, next:%p\n", buf, q->queue.prev,q->queue.next));
		buf->activate(dev,buf,next);
	} else {
		DEB_INT(("no next buffer. stopping.\n"));
		if( 0 != vbi ) {
			/* turn off video-dma3 */
			saa7146_write(dev,MC1, MASK_20);
		} else {
			/* nothing to do -- just prevent next video-dma1 transfer
			   by lowering the protection address */

			// fixme: fix this for vflip != 0

			saa7146_write(dev, PROT_ADDR1, 0);
			saa7146_write(dev, MC2, (MASK_02|MASK_18));

			/* write the address of the rps-program */
			saa7146_write(dev, RPS_ADDR0, dev->d_rps0.dma_handle);
			/* turn on rps */
			saa7146_write(dev, MC1, (MASK_12 | MASK_28));

/*
			printk("vdma%d.base_even:     0x%08x\n", 1,saa7146_read(dev,BASE_EVEN1));
			printk("vdma%d.base_odd:      0x%08x\n", 1,saa7146_read(dev,BASE_ODD1));
			printk("vdma%d.prot_addr:     0x%08x\n", 1,saa7146_read(dev,PROT_ADDR1));
			printk("vdma%d.base_page:     0x%08x\n", 1,saa7146_read(dev,BASE_PAGE1));
			printk("vdma%d.pitch:         0x%08x\n", 1,saa7146_read(dev,PITCH1));
			printk("vdma%d.num_line_byte: 0x%08x\n", 1,saa7146_read(dev,NUM_LINE_BYTE1));
*/
		}
		del_timer(&q->timeout);
	}
}

void saa7146_buffer_timeout(unsigned long data)
{
	struct saa7146_dmaqueue *q = (struct saa7146_dmaqueue*)data;
	struct saa7146_dev *dev = q->dev;
	unsigned long flags;

	DEB_EE(("dev:%p, dmaq:%p\n", dev, q));

	spin_lock_irqsave(&dev->slock,flags);
	if (q->curr) {
		DEB_D(("timeout on %p\n", q->curr));
		saa7146_buffer_finish(dev,q,STATE_ERROR);
	}

	/* we don't restart the transfer here like other drivers do. when
	   a streaming capture is disabled, the timeout function will be
	   called for the current buffer. if we activate the next buffer now,
	   we mess up our capture logic. if a timeout occurs on another buffer,
	   then something is seriously broken before, so no need to buffer the
	   next capture IMHO... */
/*
	saa7146_buffer_next(dev,q);
*/
	spin_unlock_irqrestore(&dev->slock,flags);
}

/********************************************************************************/
/* file operations */

static int fops_open(struct inode *inode, struct file *file)
{
	unsigned int minor = iminor(inode);
	struct saa7146_dev *h = NULL, *dev = NULL;
	struct list_head *list;
	struct saa7146_fh *fh = NULL;
	int result = 0;

	enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;

	DEB_EE(("inode:%p, file:%p, minor:%d\n",inode,file,minor));

	if (down_interruptible(&saa7146_devices_lock))
		return -ERESTARTSYS;

	list_for_each(list,&saa7146_devices) {
		h = list_entry(list, struct saa7146_dev, item);
		if( NULL == h->vv_data ) {
			DEB_D(("device %p has not registered video devices.\n",h));
			continue;
		}
		DEB_D(("trying: %p @ major %d,%d\n",h,h->vv_data->video_minor,h->vv_data->vbi_minor));

		if (h->vv_data->video_minor == minor) {
			dev = h;
		}
		if (h->vv_data->vbi_minor == minor) {
			type = V4L2_BUF_TYPE_VBI_CAPTURE;
			dev = h;
		}
	}
	if (NULL == dev) {
		DEB_S(("no such video device.\n"));
		result = -ENODEV;
		goto out;
	}

	DEB_D(("using: %p\n",dev));

	/* check if an extension is registered */
	if( NULL == dev->ext ) {
		DEB_S(("no extension registered for this device.\n"));
		result = -ENODEV;
		goto out;
	}

	/* allocate per open data */
	fh = kmalloc(sizeof(*fh),GFP_KERNEL);
	if (NULL == fh) {
		DEB_S(("cannot allocate memory for per open data.\n"));
		result = -ENOMEM;
		goto out;
	}
	memset(fh,0,sizeof(*fh));

	file->private_data = fh;
	fh->dev = dev;
	fh->type = type;

	if( fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) {
		DEB_S(("initializing vbi...\n"));
		result = saa7146_vbi_uops.open(dev,file);
	} else {
		DEB_S(("initializing video...\n"));
		result = saa7146_video_uops.open(dev,file);
	}

	if (0 != result) {
		goto out;
	}

	if( 0 == try_module_get(dev->ext->module)) {
		result = -EINVAL;
		goto out;
	}

	result = 0;
out:
	if( fh != 0 && result != 0 ) {
		kfree(fh);
		file->private_data = NULL;
	}
	up(&saa7146_devices_lock);
	return result;
}

static int fops_release(struct inode *inode, struct file *file)
{
	struct saa7146_fh  *fh  = file->private_data;
	struct saa7146_dev *dev = fh->dev;

	DEB_EE(("inode:%p, file:%p\n",inode,file));

	if (down_interruptible(&saa7146_devices_lock))
		return -ERESTARTSYS;

	if( fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) {
		saa7146_vbi_uops.release(dev,file);
	} else {
		saa7146_video_uops.release(dev,file);
	}

	module_put(dev->ext->module);
	file->private_data = NULL;
	kfree(fh);

	up(&saa7146_devices_lock);

	return 0;
}

int saa7146_video_do_ioctl(struct inode *inode, struct file *file, unsigned int cmd, void *arg);
static int fops_ioctl(struct inode *inode, struct file *file, unsigned int cmd, unsigned long arg)
{
/*
	DEB_EE(("inode:%p, file:%p, cmd:%d, arg:%li\n",inode, file, cmd, arg));
*/
	return video_usercopy(inode, file, cmd, arg, saa7146_video_do_ioctl);
}

static int fops_mmap(struct file *file, struct vm_area_struct * vma)
{
	struct saa7146_fh *fh = file->private_data;
	struct videobuf_queue *q;

	switch (fh->type) {
	case V4L2_BUF_TYPE_VIDEO_CAPTURE: {
		DEB_EE(("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, vma:%p\n",file, vma));
		q = &fh->video_q;
		break;
		}
	case V4L2_BUF_TYPE_VBI_CAPTURE: {
		DEB_EE(("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, vma:%p\n",file, vma));
		q = &fh->vbi_q;
		break;
		}
	default:
		BUG();
		return 0;
	}
	return videobuf_mmap_mapper(q,vma);
}

static unsigned int fops_poll(struct file *file, struct poll_table_struct *wait)
{
	struct saa7146_fh *fh = file->private_data;
	struct videobuf_buffer *buf = NULL;
	struct videobuf_queue *q;

	DEB_EE(("file:%p, poll:%p\n",file, wait));

	if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type) {
		if( 0 == fh->vbi_q.streaming )
			return videobuf_poll_stream(file, &fh->vbi_q, wait);
		q = &fh->vbi_q;
	} else {
		DEB_D(("using video queue.\n"));
		q = &fh->video_q;
	}

	if (!list_empty(&q->stream))
		buf = list_entry(q->stream.next, struct videobuf_buffer, stream);

	if (!buf) {
		DEB_D(("buf == NULL!\n"));
		return POLLERR;
	}

	poll_wait(file, &buf->done, wait);
	if (buf->state == STATE_DONE || buf->state == STATE_ERROR) {
		DEB_D(("poll succeeded!\n"));
		return POLLIN|POLLRDNORM;
	}

	DEB_D(("nothing to poll for, buf->state:%d\n",buf->state));
	return 0;
}

static ssize_t fops_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
{
	struct saa7146_fh *fh = file->private_data;

	switch (fh->type) {
	case V4L2_BUF_TYPE_VIDEO_CAPTURE: {
//		DEB_EE(("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, data:%p, count:%lun", file, data, (unsigned long)count));
		return saa7146_video_uops.read(file,data,count,ppos);
		}
	case V4L2_BUF_TYPE_VBI_CAPTURE: {
//		DEB_EE(("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, data:%p, count:%lu\n", file, data, (unsigned long)count));
		return saa7146_vbi_uops.read(file,data,count,ppos);
		}
		break;
	default:
		BUG();
		return 0;
	}
}

static struct file_operations video_fops =
{
	.owner		= THIS_MODULE,
	.open		= fops_open,
	.release	= fops_release,
	.read		= fops_read,
	.poll		= fops_poll,
	.mmap		= fops_mmap,
	.ioctl		= fops_ioctl,
	.llseek		= no_llseek,
};

static void vv_callback(struct saa7146_dev *dev, unsigned long status)
{
	u32 isr = status;

	DEB_INT(("dev:%p, isr:0x%08x\n",dev,(u32)status));

	if (0 != (isr & (MASK_27))) {
		DEB_INT(("irq: RPS0 (0x%08x).\n",isr));
		saa7146_video_uops.irq_done(dev,isr);
	}

	if (0 != (isr & (MASK_28))) {
		u32 mc2 = saa7146_read(dev, MC2);
		if( 0 != (mc2 & MASK_15)) {
			DEB_INT(("irq: RPS1 vbi workaround (0x%08x).\n",isr));
			wake_up(&dev->vv_data->vbi_wq);
			saa7146_write(dev,MC2, MASK_31);
			return;
		}
		DEB_INT(("irq: RPS1 (0x%08x).\n",isr));
		saa7146_vbi_uops.irq_done(dev,isr);
	}
}

static struct video_device device_template =
{
	.hardware	= VID_HARDWARE_SAA7146,
	.fops		= &video_fops,
	.minor		= -1,
};

int saa7146_vv_init(struct saa7146_dev* dev, struct saa7146_ext_vv *ext_vv)
{
	struct saa7146_vv *vv = kmalloc (sizeof(struct saa7146_vv),GFP_KERNEL);
	if( NULL == vv ) {
		ERR(("out of memory. aborting.\n"));
		return -1;
	}
	memset(vv, 0x0, sizeof(*vv));

	DEB_EE(("dev:%p\n",dev));

	/* set default values for video parts of the saa7146 */
	saa7146_write(dev, BCS_CTRL, 0x80400040);

	/* enable video-port pins */
	saa7146_write(dev, MC1, (MASK_10 | MASK_26));

	/* save per-device extension data (one extension can
	   handle different devices that might need different
	   configuration data) */
	dev->ext_vv_data = ext_vv;

	vv->video_minor = -1;
	vv->vbi_minor = -1;

	vv->d_clipping.cpu_addr = pci_alloc_consistent(dev->pci, SAA7146_CLIPPING_MEM, &vv->d_clipping.dma_handle);
	if( NULL == vv->d_clipping.cpu_addr ) {
		ERR(("out of memory. aborting.\n"));
		kfree(vv);
		return -1;
	}
	memset(vv->d_clipping.cpu_addr, 0x0, SAA7146_CLIPPING_MEM);

	saa7146_video_uops.init(dev,vv);
	saa7146_vbi_uops.init(dev,vv);

	dev->vv_data = vv;
	dev->vv_callback = &vv_callback;

	return 0;
}

int saa7146_vv_release(struct saa7146_dev* dev)
{
	struct saa7146_vv *vv = dev->vv_data;

	DEB_EE(("dev:%p\n",dev));

	pci_free_consistent(dev->pci, SAA7146_RPS_MEM, vv->d_clipping.cpu_addr, vv->d_clipping.dma_handle);
	kfree(vv);
	dev->vv_data = NULL;
	dev->vv_callback = NULL;

	return 0;
}

int saa7146_register_device(struct video_device **vid, struct saa7146_dev* dev,
			    char *name, int type)
{
	struct saa7146_vv *vv = dev->vv_data;
	struct video_device *vfd;

	DEB_EE(("dev:%p, name:'%s', type:%d\n",dev,name,type));

	// released by vfd->release
	vfd = video_device_alloc();
	if (vfd == NULL)
		return -ENOMEM;

	memcpy(vfd, &device_template, sizeof(struct video_device));
	strlcpy(vfd->name, name, sizeof(vfd->name));
	vfd->release = video_device_release;
	vfd->priv = dev;

	// fixme: -1 should be an insmod parameter *for the extension* (like "video_nr");
	if (video_register_device(vfd, type, -1) < 0) {
		ERR(("cannot register v4l2 device. skipping.\n"));
		return -1;
	}

	if( VFL_TYPE_GRABBER == type ) {
		vv->video_minor = vfd->minor;
		INFO(("%s: registered device video%d [v4l2]\n",
			dev->name, vfd->minor & 0x1f));
	} else {
		vv->vbi_minor = vfd->minor;
		INFO(("%s: registered device vbi%d [v4l2]\n",
			dev->name, vfd->minor & 0x1f));
	}

	*vid = vfd;
	return 0;
}

int saa7146_unregister_device(struct video_device **vid, struct saa7146_dev* dev)
{
	struct saa7146_vv *vv = dev->vv_data;

	DEB_EE(("dev:%p\n",dev));

	if( VFL_TYPE_GRABBER == (*vid)->type ) {
		vv->video_minor = -1;
	} else {
		vv->vbi_minor = -1;
	}

	video_unregister_device(*vid);
	*vid = NULL;

	return 0;
}

static int __init saa7146_vv_init_module(void)
{
	return 0;
}


static void __exit saa7146_vv_cleanup_module(void)
{
}

module_init(saa7146_vv_init_module);
module_exit(saa7146_vv_cleanup_module);

MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware");
MODULE_LICENSE("GPL");
Commit	Line	Data
1da177e4	1	#include <media/saa7146_vv.h>
1da177e4	2
afd1a0c9	3	#define BOARD_CAN_DO_VBI(dev) (dev->revision != 0 && dev->vv_data->vbi_minor != -1)
1da177e4 LT	4
	5	/****************************************************************************/
	6	/* resource management functions, shamelessly stolen from saa7134 driver */
	7
	8	int saa7146_res_get(struct saa7146_fh *fh, unsigned int bit)
	9	{
	10	struct saa7146_dev *dev = fh->dev;
	11	struct saa7146_vv *vv = dev->vv_data;
	12
	13	if (fh->resources & bit) {
	14	DEB_D(("already allocated! want: 0x%02x, cur:0x%02x\n",bit,vv->resources));
	15	/* have it already allocated */
	16	return 1;
	17	}
	18
	19	/* is it free? */
	20	down(&dev->lock);
	21	if (vv->resources & bit) {
	22	DEB_D(("locked! vv->resources:0x%02x, we want:0x%02x\n",vv->resources,bit));
	23	/* no, someone else uses it */
	24	up(&dev->lock);
	25	return 0;
	26	}
	27	/* it's free, grab it */
	28	fh->resources \|= bit;
	29	vv->resources \|= bit;
	30	DEB_D(("res: get 0x%02x, cur:0x%02x\n",bit,vv->resources));
	31	up(&dev->lock);
	32	return 1;
	33	}
	34
	35	void saa7146_res_free(struct saa7146_fh *fh, unsigned int bits)
	36	{
	37	struct saa7146_dev *dev = fh->dev;
	38	struct saa7146_vv *vv = dev->vv_data;
	39
	40	if ((fh->resources & bits) != bits)
	41	BUG();
	42
	43	down(&dev->lock);
	44	fh->resources &= ~bits;
	45	vv->resources &= ~bits;
	46	DEB_D(("res: put 0x%02x, cur:0x%02x\n",bits,vv->resources));
	47	up(&dev->lock);
	48	}
	49
	50
	51	/********************************************************************************/
	52	/* common dma functions */
	53
	54	void saa7146_dma_free(struct saa7146_dev dev,struct saa7146_buf buf)
	55	{
	56	DEB_EE(("dev:%p, buf:%p\n",dev,buf));
	57
	58	if (in_interrupt())
	59	BUG();
	60
	61	videobuf_waiton(&buf->vb,0,0);
	62	videobuf_dma_pci_unmap(dev->pci, &buf->vb.dma);
	63	videobuf_dma_free(&buf->vb.dma);
	64	buf->vb.state = STATE_NEEDS_INIT;
	65	}
	66
	67
68	/********************************************************************************/
69	/* common buffer functions */
70
71	int saa7146_buffer_queue(struct saa7146_dev *dev,
72	struct saa7146_dmaqueue *q,
73	struct saa7146_buf *buf)
74	{
75	assert_spin_locked(&dev->slock);
76	DEB_EE(("dev:%p, dmaq:%p, buf:%p\n", dev, q, buf));
77
78	BUG_ON(!q);
79
80	if (NULL == q->curr) {
81	q->curr = buf;
82	DEB_D(("immediately activating buffer %p\n", buf));
83	buf->activate(dev,buf,NULL);
84	} else {
85	list_add_tail(&buf->vb.queue,&q->queue);
86	buf->vb.state = STATE_QUEUED;
87	DEB_D(("adding buffer %p to queue. (active buffer present)\n", buf));
88	}
89	return 0;
90	}
91
92	void saa7146_buffer_finish(struct saa7146_dev *dev,
93	struct saa7146_dmaqueue *q,
94	int state)
95	{
96	assert_spin_locked(&dev->slock);
97	DEB_EE(("dev:%p, dmaq:%p, state:%d\n", dev, q, state));
98	DEB_EE(("q->curr:%p\n",q->curr));
99
100	BUG_ON(!q->curr);
101
102	/* finish current buffer */
103	if (NULL == q->curr) {
104	DEB_D(("aiii. no current buffer\n"));
afd1a0c9	105	return;
1da177e4	106	}
afd1a0c9	107
1da177e4 LT	108	q->curr->vb.state = state;
	109	do_gettimeofday(&q->curr->vb.ts);
	110	wake_up(&q->curr->vb.done);
	111
	112	q->curr = NULL;
	113	}
	114
	115	void saa7146_buffer_next(struct saa7146_dev *dev,
	116	struct saa7146_dmaqueue *q, int vbi)
	117	{
	118	struct saa7146_buf buf,next = NULL;
	119
	120	BUG_ON(!q);
	121
	122	DEB_INT(("dev:%p, dmaq:%p, vbi:%d\n", dev, q, vbi));
	123
	124	assert_spin_locked(&dev->slock);
	125	if (!list_empty(&q->queue)) {
	126	/* activate next one from queue */
	127	buf = list_entry(q->queue.next,struct saa7146_buf,vb.queue);
	128	list_del(&buf->vb.queue);
	129	if (!list_empty(&q->queue))
	130	next = list_entry(q->queue.next,struct saa7146_buf, vb.queue);
	131	q->curr = buf;
	132	DEB_INT(("next buffer: buf:%p, prev:%p, next:%p\n", buf, q->queue.prev,q->queue.next));
	133	buf->activate(dev,buf,next);
	134	} else {
	135	DEB_INT(("no next buffer. stopping.\n"));
	136	if( 0 != vbi ) {
	137	/* turn off video-dma3 */
	138	saa7146_write(dev,MC1, MASK_20);
	139	} else {
	140	/* nothing to do -- just prevent next video-dma1 transfer
	141	by lowering the protection address */
	142
	143	// fixme: fix this for vflip != 0
	144
	145	saa7146_write(dev, PROT_ADDR1, 0);
afd1a0c9	146	saa7146_write(dev, MC2, (MASK_02\|MASK_18));
1da177e4 LT	147
	148	/* write the address of the rps-program */
	149	saa7146_write(dev, RPS_ADDR0, dev->d_rps0.dma_handle);
	150	/* turn on rps */
	151	saa7146_write(dev, MC1, (MASK_12 \| MASK_28));
afd1a0c9	152
1da177e4 LT	153	/*
	154	printk("vdma%d.base_even: 0x%08x\n", 1,saa7146_read(dev,BASE_EVEN1));
	155	printk("vdma%d.base_odd: 0x%08x\n", 1,saa7146_read(dev,BASE_ODD1));
	156	printk("vdma%d.prot_addr: 0x%08x\n", 1,saa7146_read(dev,PROT_ADDR1));
	157	printk("vdma%d.base_page: 0x%08x\n", 1,saa7146_read(dev,BASE_PAGE1));
	158	printk("vdma%d.pitch: 0x%08x\n", 1,saa7146_read(dev,PITCH1));
	159	printk("vdma%d.num_line_byte: 0x%08x\n", 1,saa7146_read(dev,NUM_LINE_BYTE1));
	160	*/
	161	}
	162	del_timer(&q->timeout);
	163	}
	164	}
	165
	166	void saa7146_buffer_timeout(unsigned long data)
	167	{
	168	struct saa7146_dmaqueue q = (struct saa7146_dmaqueue)data;
	169	struct saa7146_dev *dev = q->dev;
	170	unsigned long flags;
	171
	172	DEB_EE(("dev:%p, dmaq:%p\n", dev, q));
	173
	174	spin_lock_irqsave(&dev->slock,flags);
	175	if (q->curr) {
	176	DEB_D(("timeout on %p\n", q->curr));
	177	saa7146_buffer_finish(dev,q,STATE_ERROR);
	178	}
	179
	180	/* we don't restart the transfer here like other drivers do. when
	181	a streaming capture is disabled, the timeout function will be
	182	called for the current buffer. if we activate the next buffer now,
	183	we mess up our capture logic. if a timeout occurs on another buffer,
	184	then something is seriously broken before, so no need to buffer the
	185	next capture IMHO... */
	186	/*
	187	saa7146_buffer_next(dev,q);
	188	*/
	189	spin_unlock_irqrestore(&dev->slock,flags);
	190	}
	191
	192	/********************************************************************************/
	193	/* file operations */
	194
	195	static int fops_open(struct inode inode, struct file file)
	196	{
	197	unsigned int minor = iminor(inode);
	198	struct saa7146_dev h = NULL, dev = NULL;
	199	struct list_head *list;
	200	struct saa7146_fh *fh = NULL;
	201	int result = 0;
	202
	203	enum v4l2_buf_type type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
	204
	205	DEB_EE(("inode:%p, file:%p, minor:%d\n",inode,file,minor));
	206
	207	if (down_interruptible(&saa7146_devices_lock))
	208	return -ERESTARTSYS;
	209
	210	list_for_each(list,&saa7146_devices) {
	211	h = list_entry(list, struct saa7146_dev, item);
	212	if( NULL == h->vv_data ) {
	213	DEB_D(("device %p has not registered video devices.\n",h));
	214	continue;
	215	}
	216	DEB_D(("trying: %p @ major %d,%d\n",h,h->vv_data->video_minor,h->vv_data->vbi_minor));
217
218	if (h->vv_data->video_minor == minor) {
219	dev = h;
220	}
221	if (h->vv_data->vbi_minor == minor) {
222	type = V4L2_BUF_TYPE_VBI_CAPTURE;
223	dev = h;
224	}
225	}
226	if (NULL == dev) {
227	DEB_S(("no such video device.\n"));
228	result = -ENODEV;
229	goto out;
230	}
231
232	DEB_D(("using: %p\n",dev));
233
234	/* check if an extension is registered */
235	if( NULL == dev->ext ) {
236	DEB_S(("no extension registered for this device.\n"));
237	result = -ENODEV;
238	goto out;
239	}
240
241	/* allocate per open data */
242	fh = kmalloc(sizeof(*fh),GFP_KERNEL);
243	if (NULL == fh) {
244	DEB_S(("cannot allocate memory for per open data.\n"));
245	result = -ENOMEM;
246	goto out;
247	}
248	memset(fh,0,sizeof(*fh));
afd1a0c9	249
1da177e4 LT	250	file->private_data = fh;
	251	fh->dev = dev;
	252	fh->type = type;
	253
	254	if( fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) {
	255	DEB_S(("initializing vbi...\n"));
	256	result = saa7146_vbi_uops.open(dev,file);
	257	} else {
	258	DEB_S(("initializing video...\n"));
	259	result = saa7146_video_uops.open(dev,file);
	260	}
	261
	262	if (0 != result) {
	263	goto out;
	264	}
	265
	266	if( 0 == try_module_get(dev->ext->module)) {
	267	result = -EINVAL;
	268	goto out;
	269	}
	270
	271	result = 0;
	272	out:
	273	if( fh != 0 && result != 0 ) {
	274	kfree(fh);
	275	file->private_data = NULL;
	276	}
	277	up(&saa7146_devices_lock);
afd1a0c9	278	return result;
1da177e4 LT	279	}
	280
	281	static int fops_release(struct inode inode, struct file file)
	282	{
	283	struct saa7146_fh *fh = file->private_data;
	284	struct saa7146_dev *dev = fh->dev;
	285
	286	DEB_EE(("inode:%p, file:%p\n",inode,file));
	287
	288	if (down_interruptible(&saa7146_devices_lock))
	289	return -ERESTARTSYS;
	290
	291	if( fh->type == V4L2_BUF_TYPE_VBI_CAPTURE) {
	292	saa7146_vbi_uops.release(dev,file);
	293	} else {
	294	saa7146_video_uops.release(dev,file);
	295	}
	296
	297	module_put(dev->ext->module);
	298	file->private_data = NULL;
	299	kfree(fh);
	300
	301	up(&saa7146_devices_lock);
	302
	303	return 0;
	304	}
	305
	306	int saa7146_video_do_ioctl(struct inode inode, struct file file, unsigned int cmd, void *arg);
	307	static int fops_ioctl(struct inode inode, struct file file, unsigned int cmd, unsigned long arg)
	308	{
	309	/*
	310	DEB_EE(("inode:%p, file:%p, cmd:%d, arg:%li\n",inode, file, cmd, arg));
	311	*/
	312	return video_usercopy(inode, file, cmd, arg, saa7146_video_do_ioctl);
	313	}
	314
	315	static int fops_mmap(struct file file, struct vm_area_struct vma)
	316	{
	317	struct saa7146_fh *fh = file->private_data;
	318	struct videobuf_queue *q;
	319
	320	switch (fh->type) {
	321	case V4L2_BUF_TYPE_VIDEO_CAPTURE: {
	322	DEB_EE(("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, vma:%p\n",file, vma));
	323	q = &fh->video_q;
	324	break;
	325	}
	326	case V4L2_BUF_TYPE_VBI_CAPTURE: {
	327	DEB_EE(("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, vma:%p\n",file, vma));
	328	q = &fh->vbi_q;
	329	break;
	330	}
	331	default:
	332	BUG();
	333	return 0;
	334	}
	335	return videobuf_mmap_mapper(q,vma);
	336	}
	337
	338	static unsigned int fops_poll(struct file file, struct poll_table_struct wait)
	339	{
	340	struct saa7146_fh *fh = file->private_data;
	341	struct videobuf_buffer *buf = NULL;
	342	struct videobuf_queue *q;
343
344	DEB_EE(("file:%p, poll:%p\n",file, wait));
345
346	if (V4L2_BUF_TYPE_VBI_CAPTURE == fh->type) {
347	if( 0 == fh->vbi_q.streaming )
348	return videobuf_poll_stream(file, &fh->vbi_q, wait);
349	q = &fh->vbi_q;
350	} else {
351	DEB_D(("using video queue.\n"));
352	q = &fh->video_q;
353	}
354
355	if (!list_empty(&q->stream))
356	buf = list_entry(q->stream.next, struct videobuf_buffer, stream);
357
358	if (!buf) {
359	DEB_D(("buf == NULL!\n"));
360	return POLLERR;
361	}
362
363	poll_wait(file, &buf->done, wait);
364	if (buf->state == STATE_DONE \|\| buf->state == STATE_ERROR) {
365	DEB_D(("poll succeeded!\n"));
366	return POLLIN\|POLLRDNORM;
367	}
368
369	DEB_D(("nothing to poll for, buf->state:%d\n",buf->state));
370	return 0;
371	}
372
373	static ssize_t fops_read(struct file file, char __user data, size_t count, loff_t *ppos)
374	{
375	struct saa7146_fh *fh = file->private_data;
376
377	switch (fh->type) {
378	case V4L2_BUF_TYPE_VIDEO_CAPTURE: {
379	// DEB_EE(("V4L2_BUF_TYPE_VIDEO_CAPTURE: file:%p, data:%p, count:%lun", file, data, (unsigned long)count));
380	return saa7146_video_uops.read(file,data,count,ppos);
381	}
382	case V4L2_BUF_TYPE_VBI_CAPTURE: {
383	// DEB_EE(("V4L2_BUF_TYPE_VBI_CAPTURE: file:%p, data:%p, count:%lu\n", file, data, (unsigned long)count));
384	return saa7146_vbi_uops.read(file,data,count,ppos);
385	}
386	break;
387	default:
388	BUG();
389	return 0;
390	}
391	}
392
393	static struct file_operations video_fops =
394	{
395	.owner = THIS_MODULE,
396	.open = fops_open,
397	.release = fops_release,
398	.read = fops_read,
399	.poll = fops_poll,
400	.mmap = fops_mmap,
401	.ioctl = fops_ioctl,
402	.llseek = no_llseek,
403	};
404
52c1da39	405	static void vv_callback(struct saa7146_dev *dev, unsigned long status)
1da177e4 LT	406	{
1da177e4 LT	407	u32 isr = status;
afd1a0c9	408
1da177e4 LT	409	DEB_INT(("dev:%p, isr:0x%08x\n",dev,(u32)status));
	410
	411	if (0 != (isr & (MASK_27))) {
	412	DEB_INT(("irq: RPS0 (0x%08x).\n",isr));
	413	saa7146_video_uops.irq_done(dev,isr);
	414	}
	415
	416	if (0 != (isr & (MASK_28))) {
	417	u32 mc2 = saa7146_read(dev, MC2);
	418	if( 0 != (mc2 & MASK_15)) {
	419	DEB_INT(("irq: RPS1 vbi workaround (0x%08x).\n",isr));
	420	wake_up(&dev->vv_data->vbi_wq);
	421	saa7146_write(dev,MC2, MASK_31);
	422	return;
	423	}
	424	DEB_INT(("irq: RPS1 (0x%08x).\n",isr));
	425	saa7146_vbi_uops.irq_done(dev,isr);
	426	}
	427	}
	428
	429	static struct video_device device_template =
	430	{
	431	.hardware = VID_HARDWARE_SAA7146,
	432	.fops = &video_fops,
	433	.minor = -1,
	434	};
	435
	436	int saa7146_vv_init(struct saa7146_dev* dev, struct saa7146_ext_vv *ext_vv)
	437	{
	438	struct saa7146_vv *vv = kmalloc (sizeof(struct saa7146_vv),GFP_KERNEL);
	439	if( NULL == vv ) {
	440	ERR(("out of memory. aborting.\n"));
	441	return -1;
	442	}
	443	memset(vv, 0x0, sizeof(*vv));
	444
	445	DEB_EE(("dev:%p\n",dev));
	446
	447	/* set default values for video parts of the saa7146 */
	448	saa7146_write(dev, BCS_CTRL, 0x80400040);
	449
	450	/* enable video-port pins */
	451	saa7146_write(dev, MC1, (MASK_10 \| MASK_26));
	452
	453	/* save per-device extension data (one extension can
	454	handle different devices that might need different
	455	configuration data) */
	456	dev->ext_vv_data = ext_vv;
afd1a0c9	457
1da177e4 LT	458	vv->video_minor = -1;
	459	vv->vbi_minor = -1;
	460
afd1a0c9	461	vv->d_clipping.cpu_addr = pci_alloc_consistent(dev->pci, SAA7146_CLIPPING_MEM, &vv->d_clipping.dma_handle);
1da177e4 LT	462	if( NULL == vv->d_clipping.cpu_addr ) {
	463	ERR(("out of memory. aborting.\n"));
	464	kfree(vv);
	465	return -1;
	466	}
	467	memset(vv->d_clipping.cpu_addr, 0x0, SAA7146_CLIPPING_MEM);
	468
	469	saa7146_video_uops.init(dev,vv);
	470	saa7146_vbi_uops.init(dev,vv);
afd1a0c9	471
1da177e4 LT	472	dev->vv_data = vv;
	473	dev->vv_callback = &vv_callback;
	474
	475	return 0;
	476	}
	477
	478	int saa7146_vv_release(struct saa7146_dev* dev)
	479	{
	480	struct saa7146_vv *vv = dev->vv_data;
	481
	482	DEB_EE(("dev:%p\n",dev));
afd1a0c9	483
1da177e4	484	pci_free_consistent(dev->pci, SAA7146_RPS_MEM, vv->d_clipping.cpu_addr, vv->d_clipping.dma_handle);
afd1a0c9	485	kfree(vv);
1da177e4 LT	486	dev->vv_data = NULL;
1da177e4 LT	487	dev->vv_callback = NULL;
afd1a0c9	488
1da177e4 LT	489	return 0;
	490	}
	491
	492	int saa7146_register_device(struct video_device *vid, struct saa7146_dev dev,
	493	char *name, int type)
	494	{
	495	struct saa7146_vv *vv = dev->vv_data;
	496	struct video_device *vfd;
	497
	498	DEB_EE(("dev:%p, name:'%s', type:%d\n",dev,name,type));
	499
	500	// released by vfd->release
afd1a0c9	501	vfd = video_device_alloc();
1da177e4 LT	502	if (vfd == NULL)
	503	return -ENOMEM;
	504
	505	memcpy(vfd, &device_template, sizeof(struct video_device));
	506	strlcpy(vfd->name, name, sizeof(vfd->name));
	507	vfd->release = video_device_release;
	508	vfd->priv = dev;
	509
	510	// fixme: -1 should be an insmod parameter for the extension (like "video_nr");
	511	if (video_register_device(vfd, type, -1) < 0) {
	512	ERR(("cannot register v4l2 device. skipping.\n"));
	513	return -1;
	514	}
	515
	516	if( VFL_TYPE_GRABBER == type ) {
	517	vv->video_minor = vfd->minor;
	518	INFO(("%s: registered device video%d [v4l2]\n",
	519	dev->name, vfd->minor & 0x1f));
	520	} else {
	521	vv->vbi_minor = vfd->minor;
	522	INFO(("%s: registered device vbi%d [v4l2]\n",
	523	dev->name, vfd->minor & 0x1f));
	524	}
	525
	526	*vid = vfd;
	527	return 0;
	528	}
	529
	530	int saa7146_unregister_device(struct video_device *vid, struct saa7146_dev dev)
	531	{
	532	struct saa7146_vv *vv = dev->vv_data;
afd1a0c9	533
1da177e4 LT	534	DEB_EE(("dev:%p\n",dev));
	535
	536	if( VFL_TYPE_GRABBER == (*vid)->type ) {
	537	vv->video_minor = -1;
	538	} else {
	539	vv->vbi_minor = -1;
	540	}
	541
	542	video_unregister_device(*vid);
	543	*vid = NULL;
	544
	545	return 0;
	546	}
	547
	548	static int __init saa7146_vv_init_module(void)
	549	{
	550	return 0;
	551	}
	552
	553
	554	static void __exit saa7146_vv_cleanup_module(void)
	555	{
	556	}
	557
	558	module_init(saa7146_vv_init_module);
	559	module_exit(saa7146_vv_cleanup_module);
	560
	561	MODULE_AUTHOR("Michael Hunold <michael@mihu.de>");
	562	MODULE_DESCRIPTION("video4linux driver for saa7146-based hardware");
	563	MODULE_LICENSE("GPL");