V4L/DVB (12800): tm6000: fix tm6000 analog video buffer handling

Previously, there were no sync between video buffer filling and received
URBs. So, the presented image were a mix of frame and frame-1. Now, a
filled buffer should contain only data for that frame.

allocates a maximum of 64 KB per each URB area. This fixed two bugs:

- Sometimes, there were no available continuos block of about 1 MB;
- Image weren't not properly updated, since parts of the URBs aren't
  updated.

Signed-off-by: Mauro Carvalho Chehab <mchehab@redhat.com>

2 files changed, 147 insertions, 58 deletions

diff --git a/drivers/staging/tm6000/tm6000-usb-isoc.h b/drivers/staging/tm6000/tm6000-usb-isoc.h
index 83a4ed0d1bca..42de91715185 100644
--- a/drivers/staging/tm6000/tm6000-usb-isoc.h
+++ b/drivers/staging/tm6000/tm6000-usb-isoc.h
@@ -39,6 +39,13 @@ struct usb_isoc_ctl {
 		/* Last field: ODD or EVEN? */
 	int				field;
 
+		/* Stores incomplete commands */
 	u32				tmp_buf;
 	int				tmp_buf_len;
+
+		/* Stores already requested buffers */
+	struct tm6000_buffer    	*buf;
+
+		/* Stores the number of received fields */
+	int				nfields;
 };
diff --git a/drivers/staging/tm6000/tm6000-video.c b/drivers/staging/tm6000/tm6000-video.c
index 372850c3e70b..f7e8a3710b37 100644
--- a/drivers/staging/tm6000/tm6000-video.c
+++ b/drivers/staging/tm6000/tm6000-video.c
@@ -147,12 +147,6 @@ static int inline get_next_buf (struct tm6000_dmaqueue *dma_q,
 	*buf = list_entry(dma_q->active.next,
 			struct tm6000_buffer, vb.queue);
 
-	/* Nobody is waiting something to be done, just return */
-	if (!waitqueue_active(&(*buf)->vb.done)) {
-		mod_timer(&dma_q->timeout, jiffies+BUFFER_TIMEOUT);
-		return -1;
-	}
-
 	return 1;
 }
 
@@ -160,8 +154,19 @@ static int inline get_next_buf (struct tm6000_dmaqueue *dma_q,
  * Announces that a buffer were filled and request the next
  */
 static void inline buffer_filled (struct tm6000_core *dev,
+				  struct tm6000_dmaqueue *dma_q,
 				  struct tm6000_buffer *buf)
 {
+	/* Nobody is waiting something to be done, just return */
+	if (!waitqueue_active(&buf->vb.done)) {
+		mod_timer(&dma_q->timeout, jiffies+BUFFER_TIMEOUT);
+
+		printk(KERN_ERR "tm6000: buffer underrun at %ld\n",
+				jiffies);
+
+		return;
+	}
+
 	/* Advice that buffer was filled */
 	dprintk(dev, V4L2_DEBUG_ISOC, "[%p/%d] wakeup\n",buf,buf->vb.i);
 	buf->vb.state = STATE_DONE;
@@ -182,23 +187,36 @@ static void inline buffer_filled (struct tm6000_core *dev,
 			tm6000_err("copy_to_user failed.\n");		\
 	}
 
+
+const char *tm6000_msg_type[]= {
+	"unknown(0)",   //0
+	"video",        //1
+	"audio",        //2
+	"vbi",          //3
+	"pts",          //4
+	"err",          //5
+	"unknown(6)",   //6
+	"unknown(7)",   //7
+};
+
 /*
  * Identify the tm5600/6000 buffer header type and properly handles
  */
-static u8 *copy_packet (struct urb *urb, u32 header, u8 *data, u8 *endp,
+static int copy_packet (struct urb *urb, u32 header, u8 **ptr, u8 *endp,
 			u8 *out_p, struct tm6000_buffer **buf)
 {
 	struct tm6000_dmaqueue  *dma_q = urb->context;
 	struct tm6000_core *dev= container_of(dma_q,struct tm6000_core,vidq);
-	u8 *ptr=data;
 	u8 c;
 	unsigned int cmd, cpysize, pktsize, size, field, block, line, pos=0;
+	int rc=0;
+	/* FIXME: move to tm6000-isoc */
+	static int last_line=-2, start_line=-2, last_field=-2;
 
 	/* FIXME: this is the hardcoded window size
 	 */
-	unsigned int linesize=720*2;
+	unsigned int linewidth=(*buf)->vb.width<<1;
 
-//static int last_line=-2;
 
 	if (!dev->isoc_ctl.cmd) {
 		c=(header>>24) & 0xff;
@@ -213,29 +231,71 @@ static u8 *copy_packet (struct urb *urb, u32 header, u8 *data, u8 *endp,
 		/* Validates header fields */
 		if(size>TM6000_URB_MSG_LEN)
 			size = TM6000_URB_MSG_LEN;
-		if(block>=8)
-			cmd = TM6000_URB_MSG_ERR;
 
-		/* FIXME: Mounts the image as field0+field1
-		 * It should, instead, check if the user selected
-		 * entrelaced or non-entrelaced mode
-		 */
-		pos=((line<<1)+field)*linesize+block*TM6000_URB_MSG_LEN;
+		if (cmd == TM6000_URB_MSG_VIDEO) {
+			if ((block+1)*TM6000_URB_MSG_LEN>linewidth)
+				cmd = TM6000_URB_MSG_ERR;
+
+			/* FIXME: Mounts the image as field0+field1
+			 * It should, instead, check if the user selected
+			 * entrelaced or non-entrelaced mode
+			 */
+			pos= ((line<<1)+field)*linewidth +
+				block*TM6000_URB_MSG_LEN;
+
+			/* Don't allow to write out of the buffer */
+			if (pos+TM6000_URB_MSG_LEN > (*buf)->vb.size) {
+				dprintk(dev, V4L2_DEBUG_ISOC,
+					"ERR: size=%d, num=%d, line=%d, "
+					"field=%d\n",
+					size, block, line, field);
 
-		/* Don't allow to write out of the buffer */
-		if (pos+TM6000_URB_MSG_LEN > (*buf)->vb.size)
-			cmd = TM6000_URB_MSG_ERR;
+				cmd = TM6000_URB_MSG_ERR;
+			}
+		} else {
+			pos=0;
+		}
 
 		/* Prints debug info */
 		dprintk(dev, V4L2_DEBUG_ISOC, "size=%d, num=%d, "
 				" line=%d, field=%d\n",
 				size, block, line, field);
 
+		if ((last_line!=line)&&(last_line+1!=line) &&
+		    (cmd != TM6000_URB_MSG_ERR) )  {
+			if (cmd != TM6000_URB_MSG_VIDEO)  {
+				dprintk(dev, V4L2_DEBUG_ISOC,  "cmd=%d, "
+					"size=%d, num=%d, line=%d, field=%d\n",
+					cmd, size, block, line, field);
+			}
+			if (start_line<0)
+				start_line=last_line;
+			/* Prints debug info */
+			dprintk(dev, V4L2_DEBUG_ISOC, "lines= %d-%d, "
+					"field=%d\n",
+					start_line, last_line, field);
+
+			if ((start_line<6 && last_line>200) &&
+				(last_field != field) ) {
+
+				dev->isoc_ctl.nfields++;
+				if (dev->isoc_ctl.nfields>=2) {
+					dev->isoc_ctl.nfields=0;
+
+					/* Announces that a new buffer were filled */
+					buffer_filled (dev, dma_q, *buf);
+					dprintk(dev, V4L2_DEBUG_ISOC,
+							"new buffer filled\n");
+					rc=get_next_buf (dma_q, buf);
+				}
+			}
+
+			start_line=line;
+			last_field=field;
+		}
+		last_line=line;
 
 		pktsize = TM6000_URB_MSG_LEN;
-/////////////////////////////
-/// nao seria size???
-
 	} else {
 		/* Continue the last copy */
 		cmd = dev->isoc_ctl.cmd;
@@ -244,16 +304,27 @@ static u8 *copy_packet (struct urb *urb, u32 header, u8 *data, u8 *endp,
 		pktsize = dev->isoc_ctl.pktsize;
 	}
 
-	cpysize=(endp-ptr>size)?size:endp-ptr;
+	cpysize=(endp-(*ptr)>size)?size:endp-(*ptr);
 
 	if (cpysize) {
 		/* handles each different URB message */
 		switch(cmd) {
 		case TM6000_URB_MSG_VIDEO:
 			/* Fills video buffer */
-			if (__copy_to_user(&out_p[pos],ptr,cpysize)!=0)
+			if (__copy_to_user(&out_p[pos],*ptr,cpysize)!=0)
 				tm6000_err("copy_to_user failed.\n");
-		break;
+
+			break;
+		case TM6000_URB_MSG_PTS:
+			break;
+		case TM6000_URB_MSG_AUDIO:
+/* Need some code to process audio */
+printk ("%ld: cmd=%s, size=%d\n", jiffies,
+				tm6000_msg_type[cmd],size);
+			break;
+		default:
+			dprintk (dev, V4L2_DEBUG_ISOC, "cmd=%s, size=%d\n",
+						tm6000_msg_type[cmd],size);
 		}
 	}
 	if (cpysize<size) {
@@ -264,13 +335,13 @@ static u8 *copy_packet (struct urb *urb, u32 header, u8 *data, u8 *endp,
 		dev->isoc_ctl.size= size-cpysize;
 		dev->isoc_ctl.cmd = cmd;
 		dev->isoc_ctl.pktsize = pktsize-cpysize;
-		ptr+=cpysize;
+		(*ptr)+=cpysize;
 	} else {
 		dev->isoc_ctl.cmd = 0;
-		ptr+=pktsize;
+		(*ptr)+=pktsize;
 	}
 
-	return ptr;
+	return rc;
 }
 
 static int copy_streams(u8 *data, u8 *out_p, unsigned long len,
@@ -328,10 +399,16 @@ static int copy_streams(u8 *data, u8 *out_p, unsigned long len,
 		}
 HEADER:
 		/* Copy or continue last copy */
-		ptr=copy_packet(urb,header,ptr,endp,out_p,buf);
+		rc=copy_packet(urb,header,&ptr,endp,out_p,buf);
+		if (rc<0) {
+			buf=NULL;
+			printk(KERN_ERR "tm6000: buffer underrun at %ld\n",
+					jiffies);
+			return rc;
+		}
 	}
 
-	return rc;
+	return 0;
 }
 /*
  * Identify the tm5600/6000 buffer header type and properly handles
@@ -354,13 +431,11 @@ static int copy_multiplexed(u8 *ptr, u8 *out_p, unsigned long len,
 		if (pos >= (*buf)->vb.size) {
 			pos=0;
 			/* Announces that a new buffer were filled */
-			buffer_filled (dev, *buf);
+			buffer_filled (dev, dma_q, *buf);
 			dprintk(dev, V4L2_DEBUG_ISOC, "new buffer filled\n");
-
 			rc=get_next_buf (dma_q, buf);
 			if (rc<=0) {
 				*buf=NULL;
-				printk(KERN_ERR "tm6000: buffer underrun\n");
 				break;
 			}
 		}
@@ -441,7 +516,7 @@ static inline int tm6000_isoc_copy(struct urb *urb, struct tm6000_buffer **buf)
 
 		len=urb->iso_frame_desc[i].actual_length;
 
-		if (len>=TM6000_URB_MSG_LEN) {
+//		if (len>=TM6000_URB_MSG_LEN) {
 			p=urb->transfer_buffer + urb->iso_frame_desc[i].offset;
 			if (!urb->iso_frame_desc[i].status) {
 				if (((*buf)->fmt->fourcc)==V4L2_PIX_FMT_TM6000) {
@@ -449,20 +524,14 @@ static inline int tm6000_isoc_copy(struct urb *urb, struct tm6000_buffer **buf)
 					if (rc<=0)
 						return rc;
 				} else {
-					rc=copy_streams(p,outp,len,urb,buf);
+					copy_streams(p,outp,len,urb,buf);
 				}
 			}
 			copied += len;
 			if (copied>=size)
 				break;
-		}
-	}
-
-	if (((*buf)->fmt->fourcc)!=V4L2_PIX_FMT_TM6000) {
-		buffer_filled (dev, *buf);
-		dprintk(dev, V4L2_DEBUG_ISOC, "new buffer filled\n");
+//		}
 	}
-
 	return rc;
 }
 
@@ -483,13 +552,18 @@ static void tm6000_irq_callback(struct urb *urb)
 
 	spin_lock_irqsave(&dev->slock,flags);
 
-	rc=get_next_buf (dma_q, &buf);
-	if (rc<=0)
-		goto ret;
+	buf=dev->isoc_ctl.buf;
+
+	if (!buf) {
+		rc=get_next_buf (dma_q, &buf);
+		if (rc<=0)
+			goto ret;
+	}
 
 	/* Copy data from URB */
 	rc=tm6000_isoc_copy(urb, &buf);
 
+	dev->isoc_ctl.buf=buf;
 ret:
 	/* Reset urb buffers */
 	for (i = 0; i < urb->number_of_packets; i++) {
@@ -504,13 +578,9 @@ ret:
 	}
 
 	if (rc>=0) {
-		if (!rc) {
-			dprintk(dev, V4L2_DEBUG_QUEUE, "No active queue to serve\n");
-			del_timer(&dma_q->timeout);
-		} else {
 			/* Data filled, reset watchdog */
 			mod_timer(&dma_q->timeout, jiffies+BUFFER_TIMEOUT);
-		}
+//		}
 	}
 	spin_unlock_irqrestore(&dev->slock,flags);
 }
@@ -523,6 +593,8 @@ static void tm6000_uninit_isoc(struct tm6000_core *dev)
 	struct urb *urb;
 	int i;
 
+	dev->isoc_ctl.nfields=-1;
+	dev->isoc_ctl.buf=NULL;
 	for (i = 0; i < dev->isoc_ctl.num_bufs; i++) {
 		urb=dev->isoc_ctl.urb[i];
 		if (urb) {
@@ -610,8 +682,9 @@ static int tm6000_prepare_isoc(struct tm6000_core *dev,
 			sb_size, GFP_KERNEL, &urb->transfer_dma);
 		if (!dev->isoc_ctl.transfer_buffer[i]) {
 			tm6000_err ("unable to allocate %i bytes for transfer"
-					" buffer %i, in int=%i\n",
-					sb_size, i, in_interrupt());
+					" buffer %i%s\n",
+					sb_size, i,
+					in_interrupt()?" while in int":"");
 			tm6000_uninit_isoc(dev);
 			return -ENOMEM;
 		}
@@ -795,7 +868,7 @@ buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb,
 	struct tm6000_fh     *fh  = vq->priv_data;
 	struct tm6000_buffer *buf = container_of(vb,struct tm6000_buffer,vb);
 	struct tm6000_core   *dev = fh->dev;
-	int rc=0, urbsize, urb_init=0;
+	int rc=0, urbsize, urb_init=0, npackets=1;
 
 	BUG_ON(NULL == fh->fmt);
 
@@ -833,6 +906,9 @@ buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb,
 		   Vres x Vres x 2 bytes/pixel by frame */
 		urbsize=buf->vb.size;
 
+		/* Need also one PTS */
+		urbsize+=180;
+
 		 /* memory for audio
 		    Should be at least
 		    bitrate * 2 channels * 2 bytes / frame rate */
@@ -852,11 +928,17 @@ buffer_prepare(struct videobuf_queue *vq, struct videobuf_buffer *vb,
 		/* Round to an enough number of URBs */
 		urbsize=(urbsize+dev->max_isoc_in-1)/dev->max_isoc_in;
 
-printk("Allocating %d packets to handle %lu size\n",  urbsize,buf->vb.size);
+		/* Avoids allocating big memory areas for URB */
+		while ((urbsize*dev->max_isoc_in)/npackets>65535) {
+			npackets++;
+		}
+		urbsize/=(urbsize+npackets-1)/npackets;
+
+		dprintk(dev, V4L2_DEBUG_QUEUE, "Allocating %dx%d packets"
+				" of %d bytes each to handle %lu size\n",
+				npackets,urbsize,dev->max_isoc_in,buf->vb.size);
 
-		dprintk(dev, V4L2_DEBUG_QUEUE, "Allocating %d packets to handle "
-					"%lu size\n", urbsize,buf->vb.size);
-		rc = tm6000_prepare_isoc(dev, urbsize, 2);
+		rc = tm6000_prepare_isoc(dev, urbsize, npackets);
 
 		if (rc<0)
 			goto fail;