Commit 36016a35 authored by Frank Schaefer's avatar Frank Schaefer Committed by Mauro Carvalho Chehab

[media] em28xx: clean up and unify functions em28xx_copy_vbi() em28xx_copy_video()

The code in em28xx_vbi_copy can be simplified a lot.
Also rename some variables to something more meaningful and fix+add the
function descriptions.
Signed-off-by: default avatarFrank Schäfer <fschaefer.oss@googlemail.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@redhat.com>
parent 227b7c90
...@@ -168,28 +168,27 @@ static inline void finish_buffer(struct em28xx *dev, ...@@ -168,28 +168,27 @@ static inline void finish_buffer(struct em28xx *dev,
} }
/* /*
* Identify the buffer header type and properly handles * Copy picture data from USB buffer to videobuf buffer
*/ */
static void em28xx_copy_video(struct em28xx *dev, static void em28xx_copy_video(struct em28xx *dev,
struct em28xx_buffer *buf, struct em28xx_buffer *buf,
unsigned char *p, unsigned char *usb_buf,
unsigned long len) unsigned long len)
{ {
void *fieldstart, *startwrite, *startread; void *fieldstart, *startwrite, *startread;
int linesdone, currlinedone, offset, lencopy, remain; int linesdone, currlinedone, offset, lencopy, remain;
int bytesperline = dev->width << 1; int bytesperline = dev->width << 1;
unsigned char *outp = buf->vb_buf;
if (buf->pos + len > buf->vb.size) if (buf->pos + len > buf->vb.size)
len = buf->vb.size - buf->pos; len = buf->vb.size - buf->pos;
startread = p; startread = usb_buf;
remain = len; remain = len;
if (dev->progressive || buf->top_field) if (dev->progressive || buf->top_field)
fieldstart = outp; fieldstart = buf->vb_buf;
else /* interlaced mode, even nr. of lines */ else /* interlaced mode, even nr. of lines */
fieldstart = outp + bytesperline; fieldstart = buf->vb_buf + bytesperline;
linesdone = buf->pos / bytesperline; linesdone = buf->pos / bytesperline;
currlinedone = buf->pos % bytesperline; currlinedone = buf->pos % bytesperline;
...@@ -203,11 +202,12 @@ static void em28xx_copy_video(struct em28xx *dev, ...@@ -203,11 +202,12 @@ static void em28xx_copy_video(struct em28xx *dev,
lencopy = bytesperline - currlinedone; lencopy = bytesperline - currlinedone;
lencopy = lencopy > remain ? remain : lencopy; lencopy = lencopy > remain ? remain : lencopy;
if ((char *)startwrite + lencopy > (char *)outp + buf->vb.size) { if ((char *)startwrite + lencopy > (char *)buf->vb_buf + buf->vb.size) {
em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n", em28xx_isocdbg("Overflow of %zi bytes past buffer end (1)\n",
((char *)startwrite + lencopy) - ((char *)startwrite + lencopy) -
((char *)outp + buf->vb.size)); ((char *)buf->vb_buf + buf->vb.size));
remain = (char *)outp + buf->vb.size - (char *)startwrite; remain = (char *)buf->vb_buf + buf->vb.size -
(char *)startwrite;
lencopy = remain; lencopy = remain;
} }
if (lencopy <= 0) if (lencopy <= 0)
...@@ -227,13 +227,13 @@ static void em28xx_copy_video(struct em28xx *dev, ...@@ -227,13 +227,13 @@ static void em28xx_copy_video(struct em28xx *dev,
else else
lencopy = bytesperline; lencopy = bytesperline;
if ((char *)startwrite + lencopy > (char *)outp + if ((char *)startwrite + lencopy > (char *)buf->vb_buf +
buf->vb.size) { buf->vb.size) {
em28xx_isocdbg("Overflow of %zi bytes past buffer end" em28xx_isocdbg("Overflow of %zi bytes past buffer end"
"(2)\n", "(2)\n",
((char *)startwrite + lencopy) - ((char *)startwrite + lencopy) -
((char *)outp + buf->vb.size)); ((char *)buf->vb_buf + buf->vb.size));
lencopy = remain = (char *)outp + buf->vb.size - lencopy = remain = (char *)buf->vb_buf + buf->vb.size -
(char *)startwrite; (char *)startwrite;
} }
if (lencopy <= 0) if (lencopy <= 0)
...@@ -247,50 +247,25 @@ static void em28xx_copy_video(struct em28xx *dev, ...@@ -247,50 +247,25 @@ static void em28xx_copy_video(struct em28xx *dev,
buf->pos += len; buf->pos += len;
} }
/*
* Copy VBI data from USB buffer to videobuf buffer
*/
static void em28xx_copy_vbi(struct em28xx *dev, static void em28xx_copy_vbi(struct em28xx *dev,
struct em28xx_buffer *buf, struct em28xx_buffer *buf,
unsigned char *p, unsigned char *usb_buf,
unsigned long len) unsigned long len)
{ {
void *startwrite, *startread; unsigned int offset;
int offset;
int bytesperline;
unsigned char *outp;
if (dev == NULL) {
em28xx_isocdbg("dev is null\n");
return;
}
bytesperline = dev->vbi_width;
if (buf == NULL) {
return;
}
if (p == NULL) {
em28xx_isocdbg("p is null\n");
return;
}
outp = buf->vb_buf;
if (outp == NULL) {
em28xx_isocdbg("outp is null\n");
return;
}
if (buf->pos + len > buf->vb.size) if (buf->pos + len > buf->vb.size)
len = buf->vb.size - buf->pos; len = buf->vb.size - buf->pos;
startread = p;
startwrite = outp + buf->pos;
offset = buf->pos; offset = buf->pos;
/* Make sure the bottom field populates the second half of the frame */ /* Make sure the bottom field populates the second half of the frame */
if (buf->top_field == 0) { if (buf->top_field == 0)
startwrite += bytesperline * dev->vbi_height; offset += dev->vbi_width * dev->vbi_height;
offset += bytesperline * dev->vbi_height;
}
memcpy(startwrite, startread, len); memcpy(buf->vb_buf + offset, usb_buf, len);
buf->pos += len; buf->pos += len;
} }
......
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