11da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 21da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 31da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * device driver for philips saa7134 based TV cards 41da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * video4linux video interface 51da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 61da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (c) 2001,02 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs] 71da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 81da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is free software; you can redistribute it and/or modify 91da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * it under the terms of the GNU General Public License as published by 101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * the Free Software Foundation; either version 2 of the License, or 111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * (at your option) any later version. 121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * This program is distributed in the hope that it will be useful, 141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * but WITHOUT ANY WARRANTY; without even the implied warranty of 151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * GNU General Public License for more details. 171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * 181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * You should have received a copy of the GNU General Public License 191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * along with this program; if not, write to the Free Software 201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA. 211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/init.h> 241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/list.h> 251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/module.h> 261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include <linux/kernel.h> 271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "saa7134-reg.h" 291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#include "saa7134.h" 301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ------------------------------------------------------------------ */ 321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 33ff699e6bd02eb1c6d02c7c2b576c2ee6caab201cDouglas Schilling Landgrafstatic unsigned int vbi_debug; 341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_param(vbi_debug, int, 0644); 351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(vbi_debug,"enable debug messages [vbi]"); 361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic unsigned int vbibufs = 4; 381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsmodule_param(vbibufs, int, 0444); 391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus TorvaldsMODULE_PARM_DESC(vbibufs,"number of vbi buffers, range 2-32"); 401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define dprintk(fmt, arg...) if (vbi_debug) \ 421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds printk(KERN_DEBUG "%s/vbi: " fmt, dev->name , ## arg) 431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ------------------------------------------------------------------ */ 451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define VBI_LINE_COUNT 16 471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define VBI_LINE_LENGTH 2048 481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds#define VBI_SCALE 0x200 491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void task_init(struct saa7134_dev *dev, struct saa7134_buf *buf, 511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int task) 521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_tvnorm *norm = dev->tvnorm; 541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* setup video scaler */ 561da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_START1(task), norm->h_start & 0xff); 571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_START2(task), norm->h_start >> 8); 581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_STOP1(task), norm->h_stop & 0xff); 591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_STOP2(task), norm->h_stop >> 8); 60f246a8172a9e403b78c34568f766990f1506a0abMichael Schimek saa_writeb(SAA7134_VBI_V_START1(task), norm->vbi_v_start_0 & 0xff); 61f246a8172a9e403b78c34568f766990f1506a0abMichael Schimek saa_writeb(SAA7134_VBI_V_START2(task), norm->vbi_v_start_0 >> 8); 62f246a8172a9e403b78c34568f766990f1506a0abMichael Schimek saa_writeb(SAA7134_VBI_V_STOP1(task), norm->vbi_v_stop_0 & 0xff); 63f246a8172a9e403b78c34568f766990f1506a0abMichael Schimek saa_writeb(SAA7134_VBI_V_STOP2(task), norm->vbi_v_stop_0 >> 8); 641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_SCALE_INC1(task), VBI_SCALE & 0xff); 661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_SCALE_INC2(task), VBI_SCALE >> 8); 671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_PHASE_OFFSET_LUMA(task), 0x00); 681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_PHASE_OFFSET_CHROMA(task), 0x00); 691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_LEN1(task), buf->vb.width & 0xff); 711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_H_LEN2(task), buf->vb.width >> 8); 721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_V_LEN1(task), buf->vb.height & 0xff); 731da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_VBI_V_LEN2(task), buf->vb.height >> 8); 741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_andorb(SAA7134_DATA_PATH(task), 0xc0, 0x00); 761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ------------------------------------------------------------------ */ 791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int buffer_activate(struct saa7134_dev *dev, 811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_buf *buf, 821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_buf *next) 831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned long control,base; 851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dprintk("buffer_activate [%p]\n",buf); 870fc0686e64d21a6abded96af2b1a895dfa8b2530Brandon Philips buf->vb.state = VIDEOBUF_ACTIVE; 881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->top_seen = 0; 891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds task_init(dev,buf,TASK_A); 911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds task_init(dev,buf,TASK_B); 921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_OFMT_DATA_A, 0x06); 931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writeb(SAA7134_OFMT_DATA_B, 0x06); 941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 951da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* DMA: setup channel 2+3 (= VBI Task A+B) */ 961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds base = saa7134_buffer_base(buf); 971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds control = SAA7134_RS_CONTROL_BURST_16 | 981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds SAA7134_RS_CONTROL_ME | 991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds (buf->pt->dma >> 12); 1001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_BA1(2),base); 1011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_BA2(2),base + buf->vb.size/2); 1021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_PITCH(2),buf->vb.width); 1031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_CONTROL(2),control); 1041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_BA1(3),base); 1051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_BA2(3),base + buf->vb.size/2); 1061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_PITCH(3),buf->vb.width); 1071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa_writel(SAA7134_RS_CONTROL(3),control); 1081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* start DMA */ 1101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa7134_set_dmabits(dev); 1111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds mod_timer(&dev->vbi_q.timeout, jiffies+BUFFER_TIMEOUT); 1121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int buffer_prepare(struct videobuf_queue *q, 1171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct videobuf_buffer *vb, 1181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds enum v4l2_field field) 1191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_fh *fh = q->priv_data; 1211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_dev *dev = fh->dev; 1221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb); 1231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_tvnorm *norm = dev->tvnorm; 1241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds unsigned int lines, llength, size; 1251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int err; 1261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 127f246a8172a9e403b78c34568f766990f1506a0abMichael Schimek lines = norm->vbi_v_stop_0 - norm->vbi_v_start_0 +1; 1281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (lines > VBI_LINE_COUNT) 1291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds lines = VBI_LINE_COUNT; 1301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds llength = VBI_LINE_LENGTH; 1311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds size = lines * llength * 2; 1321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (0 != buf->vb.baddr && buf->vb.bsize < size) 1331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return -EINVAL; 1341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (buf->vb.size != size) 136c7b0ac0546985fc6361a8d92cf808d46da797677Mauro Carvalho Chehab saa7134_dma_free(q,buf); 1371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1380fc0686e64d21a6abded96af2b1a895dfa8b2530Brandon Philips if (VIDEOBUF_NEEDS_INIT == buf->vb.state) { 139c1accaa21bdef38ec0f36eaaf7ce3384fff9d0c5Mauro Carvalho Chehab struct videobuf_dmabuf *dma=videobuf_to_dma(&buf->vb); 140c1accaa21bdef38ec0f36eaaf7ce3384fff9d0c5Mauro Carvalho Chehab 1411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->vb.width = llength; 1421da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->vb.height = lines; 1431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->vb.size = size; 1441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->pt = &fh->pt_vbi; 1451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 146c7b0ac0546985fc6361a8d92cf808d46da797677Mauro Carvalho Chehab err = videobuf_iolock(q,&buf->vb,NULL); 1471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 1481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto oops; 1491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds err = saa7134_pgtable_build(dev->pci,buf->pt, 150c1accaa21bdef38ec0f36eaaf7ce3384fff9d0c5Mauro Carvalho Chehab dma->sglist, 151c1accaa21bdef38ec0f36eaaf7ce3384fff9d0c5Mauro Carvalho Chehab dma->sglen, 1521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa7134_buffer_startpage(buf)); 1531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (err) 1541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto oops; 1551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 1560fc0686e64d21a6abded96af2b1a895dfa8b2530Brandon Philips buf->vb.state = VIDEOBUF_PREPARED; 1571da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->activate = buffer_activate; 1581da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds buf->vb.field = field; 1591da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1601da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1611da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds oops: 162c7b0ac0546985fc6361a8d92cf808d46da797677Mauro Carvalho Chehab saa7134_dma_free(q,buf); 1631da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return err; 1641da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1651da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1661da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic int 1671da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsbuffer_setup(struct videobuf_queue *q, unsigned int *count, unsigned int *size) 1681da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1691da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_fh *fh = q->priv_data; 1701da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_dev *dev = fh->dev; 1711da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds int llength,lines; 1721da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 173f246a8172a9e403b78c34568f766990f1506a0abMichael Schimek lines = dev->tvnorm->vbi_v_stop_0 - dev->tvnorm->vbi_v_start_0 +1; 1741da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds llength = VBI_LINE_LENGTH; 1751da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *size = lines * llength * 2; 1761da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (0 == *count) 1771da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *count = vbibufs; 1781da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds *count = saa7134_buffer_count(*size,*count); 1791da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 1801da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1811da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1821da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void buffer_queue(struct videobuf_queue *q, struct videobuf_buffer *vb) 1831da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1841da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_fh *fh = q->priv_data; 1851da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_dev *dev = fh->dev; 1861da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb); 1871da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1881da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa7134_buffer_queue(dev,&dev->vbi_q,buf); 1891da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1901da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1911da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstatic void buffer_release(struct videobuf_queue *q, struct videobuf_buffer *vb) 1921da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 1931da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds struct saa7134_buf *buf = container_of(vb,struct saa7134_buf,vb); 1941da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 195c7b0ac0546985fc6361a8d92cf808d46da797677Mauro Carvalho Chehab saa7134_dma_free(q,buf); 1961da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 1971da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 1981da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsstruct videobuf_queue_ops saa7134_vbi_qops = { 1991da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .buf_setup = buffer_setup, 2001da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .buf_prepare = buffer_prepare, 2011da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .buf_queue = buffer_queue, 2021da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds .buf_release = buffer_release, 2031da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds}; 2041da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2051da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ------------------------------------------------------------------ */ 2061da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2071da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint saa7134_vbi_init1(struct saa7134_dev *dev) 2081da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2091da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds INIT_LIST_HEAD(&dev->vbi_q.queue); 2101da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds init_timer(&dev->vbi_q.timeout); 2111da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->vbi_q.timeout.function = saa7134_buffer_timeout; 2121da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->vbi_q.timeout.data = (unsigned long)(&dev->vbi_q); 2131da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->vbi_q.dev = dev; 2141da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2151da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (vbibufs < 2) 2161da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vbibufs = 2; 2171da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (vbibufs > VIDEO_MAX_FRAME) 2181da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds vbibufs = VIDEO_MAX_FRAME; 2191da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2201da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2211da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2221da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsint saa7134_vbi_fini(struct saa7134_dev *dev) 2231da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2241da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* nothing */ 2251da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds return 0; 2261da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2271da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2281da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvaldsvoid saa7134_irq_vbi_done(struct saa7134_dev *dev, unsigned long status) 2291da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds{ 2301da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_lock(&dev->slock); 2311da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (dev->vbi_q.curr) { 2321da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->vbi_fieldcount++; 2331da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds /* make sure we have seen both fields */ 2341da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if ((status & 0x10) == 0x00) { 2351da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->vbi_q.curr->top_seen = 1; 2361da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto done; 2371da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2381da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds if (!dev->vbi_q.curr->top_seen) 2391da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds goto done; 2401da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2411da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds dev->vbi_q.curr->vb.field_count = dev->vbi_fieldcount; 2420fc0686e64d21a6abded96af2b1a895dfa8b2530Brandon Philips saa7134_buffer_finish(dev,&dev->vbi_q,VIDEOBUF_DONE); 2431da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds } 2441da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds saa7134_buffer_next(dev,&dev->vbi_q); 2451da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2461da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds done: 2471da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds spin_unlock(&dev->slock); 2481da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds} 2491da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds 2501da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* ----------------------------------------------------------- */ 2511da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds/* 2521da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * Local variables: 2531da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * c-basic-offset: 8 2541da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds * End: 2551da177e4c3f41524e886b7f1b8a0c1fc7321cacLinus Torvalds */ 256