Commit 83cb9a50 authored by Stefan Ringel's avatar Stefan Ringel Committed by Mauro Carvalho Chehab

V4L/DVB: tm6000: rewrite copy_streams

Merge function copy streams() and copy_packets() into a new function
copy_streams(), fixing the bugs.
Signed-off-by: default avatarStefan Ringel <stefan.ringel@arcor.de>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 3b23db39
...@@ -39,7 +39,7 @@ struct usb_isoc_ctl { ...@@ -39,7 +39,7 @@ struct usb_isoc_ctl {
int pos, size, pktsize; int pos, size, pktsize;
/* Last field: ODD or EVEN? */ /* Last field: ODD or EVEN? */
int field; int vfield;
/* Stores incomplete commands */ /* Stores incomplete commands */
u32 tmp_buf; u32 tmp_buf;
...@@ -47,7 +47,4 @@ struct usb_isoc_ctl { ...@@ -47,7 +47,4 @@ struct usb_isoc_ctl {
/* Stores already requested buffers */ /* Stores already requested buffers */
struct tm6000_buffer *buf; struct tm6000_buffer *buf;
/* Stores the number of received fields */
int nfields;
}; };
...@@ -186,236 +186,148 @@ const char *tm6000_msg_type[] = { ...@@ -186,236 +186,148 @@ const char *tm6000_msg_type[] = {
/* /*
* Identify the tm5600/6000 buffer header type and properly handles * Identify the tm5600/6000 buffer header type and properly handles
*/ */
static int copy_packet(struct urb *urb, u32 header, u8 **ptr, u8 *endp, static int copy_streams(u8 *data, unsigned long len,
u8 *out_p, struct tm6000_buffer **buf) struct urb *urb)
{ {
struct tm6000_dmaqueue *dma_q = urb->context; struct tm6000_dmaqueue *dma_q = urb->context;
struct tm6000_core *dev = container_of(dma_q, struct tm6000_core, vidq); struct tm6000_core *dev= container_of(dma_q,struct tm6000_core,vidq);
u8 c; u8 *ptr=data, *endp=data+len, c;
unsigned long header=0;
int rc=0;
unsigned int cmd, cpysize, pktsize, size, field, block, line, pos = 0; unsigned int cmd, cpysize, pktsize, size, field, block, line, pos = 0;
int rc = 0; struct tm6000_buffer *vbuf;
/* FIXME: move to tm6000-isoc */ char *voutp = NULL;
static int last_line = -2, start_line = -2, last_field = -2; unsigned int linewidth;
/* FIXME: this is the hardcoded window size /* get video buffer */
*/ get_next_buf (dma_q, &vbuf);
unsigned int linewidth = (*buf)->vb.width << 1; if (!vbuf)
return rc;
voutp = videobuf_to_vmalloc(&vbuf->vb);
if (!voutp)
return 0;
for (ptr = data; ptr < endp;) {
if (!dev->isoc_ctl.cmd) { if (!dev->isoc_ctl.cmd) {
c = (header >> 24) & 0xff; /* Header */
if (dev->isoc_ctl.tmp_buf_len > 0) {
/* from last urb or packet */
header = dev->isoc_ctl.tmp_buf;
if (4 - dev->isoc_ctl.tmp_buf_len > 0) {
memcpy ((u8 *)&header +
dev->isoc_ctl.tmp_buf_len,
ptr,
4 - dev->isoc_ctl.tmp_buf_len);
ptr += 4 - dev->isoc_ctl.tmp_buf_len;
}
dev->isoc_ctl.tmp_buf_len = 0;
} else {
if (ptr + 3 >= endp) {
/* have incomplete header */
dev->isoc_ctl.tmp_buf_len = endp - ptr;
memcpy (&dev->isoc_ctl.tmp_buf, ptr,
dev->isoc_ctl.tmp_buf_len);
return rc;
}
/* Seek for sync */
for (; ptr < endp - 3; ptr++) {
if (*(ptr + 3) == 0x47)
break;
}
/* Get message header */
header = *(unsigned long *)ptr;
ptr += 4;
}
/* split the header fields */ /* split the header fields */
c = (header >> 24) & 0xff;
size = ((header & 0x7e) << 1); size = ((header & 0x7e) << 1);
if (size > 0) if (size > 0)
size -= 4; size -= 4;
block = (header >> 7) & 0xf; block = (header >> 7) & 0xf;
field = (header >> 11) & 0x1; field = (header >> 11) & 0x1;
line = (header >> 12) & 0x1ff; line = (header >> 12) & 0x1ff;
cmd = (header >> 21) & 0x7; cmd = (header >> 21) & 0x7;
/* Validates haeder fields */
/* Validates header fields */ if (size > TM6000_URB_MSG_LEN)
if(size > TM6000_URB_MSG_LEN)
size = TM6000_URB_MSG_LEN; size = TM6000_URB_MSG_LEN;
pktsize = TM6000_URB_MSG_LEN;
if (cmd == TM6000_URB_MSG_VIDEO) { /* calculate position in buffer
if ((block+1)*TM6000_URB_MSG_LEN>linewidth) * and change the buffer
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 - 1) * linewidth + switch (cmd) {
block * TM6000_URB_MSG_LEN; case TM6000_URB_MSG_VIDEO:
if ((dev->isoc_ctl.vfield != field) &&
/* Don't allow to write out of the buffer */ (field == 1)) {
if (pos+TM6000_URB_MSG_LEN > (*buf)->vb.size) { /* Announces that a new buffer
dprintk(dev, V4L2_DEBUG_ISOC, * were filled
"ERR: size=%d, num=%d, line=%d, " */
"field=%d\n", buffer_filled (dev, dma_q, vbuf);
size, block, line, field); dprintk (dev, V4L2_DEBUG_ISOC,
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"); "new buffer filled\n");
get_next_buf (dma_q, buf); get_next_buf (dma_q, &vbuf);
if (!*buf) if (!vbuf)
return rc; return rc;
out_p = videobuf_to_vmalloc(&((*buf)->vb)); voutp = videobuf_to_vmalloc (&vbuf->vb);
if (!out_p) if (!voutp)
return rc; return rc;
pos = dev->isoc_ctl.pos = 0;
}
} }
linewidth = vbuf->vb.width << 1;
start_line=line; pos = ((line << 1) - field - 1) * linewidth +
last_field=field; block * TM6000_URB_MSG_LEN;
/* Don't allow to write out of the buffer */
if (pos + size > vbuf->vb.size)
cmd = TM6000_URB_MSG_ERR;
dev->isoc_ctl.vfield = field;
break;
case TM6000_URB_MSG_AUDIO:
case TM6000_URB_MSG_VBI:
case TM6000_URB_MSG_PTS:
break;
} }
if (cmd == TM6000_URB_MSG_VIDEO)
last_line = line;
pktsize = TM6000_URB_MSG_LEN;
} else { } else {
/* Continue the last copy */ /* Continue the last copy */
cmd = dev->isoc_ctl.cmd; cmd = dev->isoc_ctl.cmd;
size= dev->isoc_ctl.size; size = dev->isoc_ctl.size;
pos = dev->isoc_ctl.pos; pos = dev->isoc_ctl.pos;
pktsize = dev->isoc_ctl.pktsize; pktsize = dev->isoc_ctl.pktsize;
} }
cpysize = (endp - ptr > size) ? size : endp - ptr;
cpysize = (endp-(*ptr) > size) ? size : endp - *ptr;
if (cpysize) { if (cpysize) {
/* handles each different URB message */ /* copy data in different buffers */
switch(cmd) { switch (cmd) {
case TM6000_URB_MSG_VIDEO: case TM6000_URB_MSG_VIDEO:
/* Fills video buffer */ /* Fills video buffer */
memcpy(&out_p[pos], *ptr, cpysize); if (vbuf)
break; memcpy (&voutp[pos], ptr, cpysize);
case TM6000_URB_MSG_PTS:
break; break;
case TM6000_URB_MSG_AUDIO: case TM6000_URB_MSG_AUDIO:
/* Need some code to process audio */ /* Need some code to copy audio buffer */
printk ("%ld: cmd=%s, size=%d\n", jiffies,
tm6000_msg_type[cmd],size);
break; break;
case TM6000_URB_MSG_VBI: case TM6000_URB_MSG_VBI:
/* Need some code to copy vbi buffer */
break;
case TM6000_URB_MSG_PTS:
/* Need some code to copy pts */
break; break;
default:
dprintk (dev, V4L2_DEBUG_ISOC, "cmd=%s, size=%d\n",
tm6000_msg_type[cmd],size);
} }
} }
if (cpysize<size) { if (ptr + pktsize > endp) {
/* End of URB packet, but cmd processing is not /* End of URB packet, but cmd processing is not
* complete. Preserve the state for a next packet * complete. Preserve the state for a next packet
*/ */
dev->isoc_ctl.pos = pos+cpysize; dev->isoc_ctl.pos = pos + cpysize;
dev->isoc_ctl.size= size-cpysize; dev->isoc_ctl.size = size - cpysize;
dev->isoc_ctl.cmd = cmd; dev->isoc_ctl.cmd = cmd;
dev->isoc_ctl.pktsize = pktsize-cpysize; dev->isoc_ctl.pktsize = pktsize - (endp - ptr);
(*ptr)+=cpysize; ptr += endp - ptr;
} else { } else {
dev->isoc_ctl.cmd = 0; dev->isoc_ctl.cmd = 0;
(*ptr)+=pktsize; ptr += pktsize;
} }
return rc;
}
static int copy_streams(u8 *data, unsigned long len,
struct urb *urb)
{
struct tm6000_dmaqueue *dma_q = urb->context;
struct tm6000_core *dev= container_of(dma_q,struct tm6000_core,vidq);
u8 *ptr=data, *endp=data+len;
unsigned long header=0;
int rc=0;
struct tm6000_buffer *buf;
char *outp = NULL;
get_next_buf(dma_q, &buf);
if (buf)
outp = videobuf_to_vmalloc(&buf->vb);
if (!outp)
return 0;
for (ptr=data; ptr<endp;) {
if (!dev->isoc_ctl.cmd) {
u8 *p=(u8 *)&dev->isoc_ctl.tmp_buf;
/* FIXME: This seems very complex
* It just recovers up to 3 bytes of the header that
* might be at the previous packet
*/
if (dev->isoc_ctl.tmp_buf_len) {
while (dev->isoc_ctl.tmp_buf_len) {
if ( *(ptr+3-dev->isoc_ctl.tmp_buf_len) == 0x47) {
break;
}
p++;
dev->isoc_ctl.tmp_buf_len--;
}
if (dev->isoc_ctl.tmp_buf_len) {
memcpy(&header, p,
dev->isoc_ctl.tmp_buf_len);
memcpy((u8 *)&header +
dev->isoc_ctl.tmp_buf_len,
ptr,
4 - dev->isoc_ctl.tmp_buf_len);
ptr += 4 - dev->isoc_ctl.tmp_buf_len;
goto HEADER;
}
}
/* Seek for sync */
for (;ptr<endp-3;ptr++) {
if (*(ptr+3)==0x47)
break;
}
if (ptr+3>=endp) {
dev->isoc_ctl.tmp_buf_len=endp-ptr;
memcpy (&dev->isoc_ctl.tmp_buf,ptr,
dev->isoc_ctl.tmp_buf_len);
dev->isoc_ctl.cmd=0;
return rc;
}
/* Get message header */
header=*(unsigned long *)ptr;
ptr+=4;
}
HEADER:
/* Copy or continue last copy */
rc=copy_packet(urb,header,&ptr,endp,outp,&buf);
if (rc<0) {
buf=NULL;
printk(KERN_ERR "tm6000: buffer underrun at %ld\n",
jiffies);
return rc;
} }
if (!buf)
return 0;
}
return 0; return 0;
} }
/* /*
* Identify the tm5600/6000 buffer header type and properly handles * Identify the tm5600/6000 buffer header type and properly handles
*/ */
...@@ -510,7 +422,6 @@ static inline int tm6000_isoc_copy(struct urb *urb) ...@@ -510,7 +422,6 @@ static inline int tm6000_isoc_copy(struct urb *urb)
{ {
struct tm6000_dmaqueue *dma_q = urb->context; struct tm6000_dmaqueue *dma_q = urb->context;
struct tm6000_core *dev= container_of(dma_q,struct tm6000_core,vidq); struct tm6000_core *dev= container_of(dma_q,struct tm6000_core,vidq);
struct tm6000_buffer *buf;
int i, len=0, rc=1, status; int i, len=0, rc=1, status;
char *p; char *p;
...@@ -585,7 +496,6 @@ static void tm6000_uninit_isoc(struct tm6000_core *dev) ...@@ -585,7 +496,6 @@ static void tm6000_uninit_isoc(struct tm6000_core *dev)
struct urb *urb; struct urb *urb;
int i; int i;
dev->isoc_ctl.nfields = -1;
dev->isoc_ctl.buf = NULL; dev->isoc_ctl.buf = NULL;
for (i = 0; i < dev->isoc_ctl.num_bufs; i++) { for (i = 0; i < dev->isoc_ctl.num_bufs; i++) {
urb=dev->isoc_ctl.urb[i]; urb=dev->isoc_ctl.urb[i];
...@@ -610,8 +520,6 @@ static void tm6000_uninit_isoc(struct tm6000_core *dev) ...@@ -610,8 +520,6 @@ static void tm6000_uninit_isoc(struct tm6000_core *dev)
dev->isoc_ctl.urb=NULL; dev->isoc_ctl.urb=NULL;
dev->isoc_ctl.transfer_buffer=NULL; dev->isoc_ctl.transfer_buffer=NULL;
dev->isoc_ctl.num_bufs = 0; dev->isoc_ctl.num_bufs = 0;
dev->isoc_ctl.num_bufs=0;
} }
/* /*
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment