Skip to content

L
linux
Commit b524f7b0 authored by Marcin Slusarz's avatar Marcin Slusarz Committed by Mauro Carvalho Chehab
Browse files
Options

V4L/DVB (7364): reduce stack usage of v4l_compat_translate_ioctl 

v4l_compat_translate_ioctl used 1376 bytes of stack (x86_64),
so split this 800 lines long function into ~20 small noinline functions;
the biggest function takes now 712 bytes (v4l1_compat_sync)

fix VIDIOCSWIN handler which printked wrong errors
Signed-off-by: default avatarMarcin Slusarz <marcin.slusarz@gmail.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab@infradead.org>
parent 8b3b90ac
Hide whitespace changes
Inline Side-by-side
Showing with 938 additions and 743 deletions
drivers/media/video/v4l1-compat.c
View file @ b524f7b0
...@@ -203,7 +203,7 @@ static int poll_one(struct file *file) ...@@ -203,7 +203,7 @@ static int poll_one(struct file *file)
{ {
int retval = 1; int retval = 1;
poll_table *table; poll_table *table;
struct poll_wqueues pwq; struct poll_wqueues pwq; /*TODO: allocate dynamically*/
poll_initwait(&pwq); poll_initwait(&pwq);
table = &pwq.pt; table = &pwq.pt;
...@@ -225,9 +225,10 @@ static int poll_one(struct file *file) ...@@ -225,9 +225,10 @@ static int poll_one(struct file *file)
return retval; return retval;
} }
static int count_inputs(struct inode *inode, static int count_inputs(
struct file *file, struct inode *inode,
v4l2_kioctl drv) struct file *file,
v4l2_kioctl drv)
{ {
struct v4l2_input input2; struct v4l2_input input2;
int i; int i;
...@@ -241,10 +242,12 @@ static int count_inputs(struct inode *inode, ...@@ -241,10 +242,12 @@ static int count_inputs(struct inode *inode,
return i; return i;
} }
static int check_size(struct inode *inode, static int check_size(
struct file *file, struct inode *inode,
v4l2_kioctl drv, struct file *file,
int *maxw, int *maxh) v4l2_kioctl drv,
int *maxw,
int *maxh)
{ {
struct v4l2_fmtdesc desc2; struct v4l2_fmtdesc desc2;
struct v4l2_format fmt2; struct v4l2_format fmt2;
...@@ -266,828 +269,1020 @@ static int check_size(struct inode *inode, ...@@ -266,828 +269,1020 @@ static int check_size(struct inode *inode,
*maxw = fmt2.fmt.pix.width; *maxw = fmt2.fmt.pix.width;
*maxh = fmt2.fmt.pix.height; *maxh = fmt2.fmt.pix.height;
done: done:
return 0; return 0;
} }
/* ----------------------------------------------------------------- */ /* ----------------------------------------------------------------- */
/* static noinline int v4l1_compat_get_capabilities(
* This function is exported. struct video_capability *cap,
*/ struct inode *inode,
int struct file *file,
v4l_compat_translate_ioctl(struct inode *inode, v4l2_kioctl drv)
struct file *file,
int cmd,
void *arg,
v4l2_kioctl drv)
{ {
struct v4l2_capability *cap2 = NULL; int err;
struct v4l2_format *fmt2 = NULL; struct v4l2_framebuffer fbuf;
enum v4l2_buf_type captype = V4L2_BUF_TYPE_VIDEO_CAPTURE; struct v4l2_capability *cap2;
struct v4l2_framebuffer fbuf2; cap2 = kzalloc(sizeof(*cap2), GFP_KERNEL);
struct v4l2_input input2; if (!cap2) {
struct v4l2_tuner tun2; err = -ENOMEM;
struct v4l2_standard std2; return err;
struct v4l2_frequency freq2; }
struct v4l2_audio aud2; memset(cap, 0, sizeof(*cap));
struct v4l2_queryctrl qctrl2; memset(&fbuf, 0, sizeof(fbuf));
struct v4l2_buffer buf2;
v4l2_std_id sid;
int i, err = 0;
switch (cmd) {
case VIDIOCGCAP: /* capability */
{
struct video_capability *cap = arg;
cap2 = kzalloc(sizeof(*cap2), GFP_KERNEL);
if (!cap2) {
err = -ENOMEM;
break;
}
memset(cap, 0, sizeof(*cap));
memset(&fbuf2, 0, sizeof(fbuf2));
err = drv(inode, file, VIDIOC_QUERYCAP, cap2); err = drv(inode, file, VIDIOC_QUERYCAP, cap2);
if (err < 0) {
dprintk("VIDIOCGCAP / VIDIOC_QUERYCAP: %d\n", err);
goto done;
}
if (cap2->capabilities & V4L2_CAP_VIDEO_OVERLAY) {
err = drv(inode, file, VIDIOC_G_FBUF, &fbuf);
if (err < 0) { if (err < 0) {
dprintk("VIDIOCGCAP / VIDIOC_QUERYCAP: %d\n", err); dprintk("VIDIOCGCAP / VIDIOC_G_FBUF: %d\n", err);
break; memset(&fbuf, 0, sizeof(fbuf));
}
if (cap2->capabilities & V4L2_CAP_VIDEO_OVERLAY) {
err = drv(inode, file, VIDIOC_G_FBUF, &fbuf2);
if (err < 0) {
dprintk("VIDIOCGCAP / VIDIOC_G_FBUF: %d\n", err);
memset(&fbuf2, 0, sizeof(fbuf2));
}
err = 0;
} }
err = 0;
memcpy(cap->name, cap2->card,
min(sizeof(cap->name), sizeof(cap2->card)));
cap->name[sizeof(cap->name) - 1] = 0;
if (cap2->capabilities & V4L2_CAP_VIDEO_CAPTURE)
cap->type |= VID_TYPE_CAPTURE;
if (cap2->capabilities & V4L2_CAP_TUNER)
cap->type |= VID_TYPE_TUNER;
if (cap2->capabilities & V4L2_CAP_VBI_CAPTURE)
cap->type |= VID_TYPE_TELETEXT;
if (cap2->capabilities & V4L2_CAP_VIDEO_OVERLAY)
cap->type |= VID_TYPE_OVERLAY;
if (fbuf2.capability & V4L2_FBUF_CAP_LIST_CLIPPING)
cap->type |= VID_TYPE_CLIPPING;
cap->channels = count_inputs(inode, file, drv);
check_size(inode, file, drv,
&cap->maxwidth, &cap->maxheight);
cap->audios = 0; /* FIXME */
cap->minwidth = 48; /* FIXME */
cap->minheight = 32; /* FIXME */
break;
} }
case VIDIOCGFBUF: /* get frame buffer */
{
struct video_buffer *buffer = arg;
memset(buffer, 0, sizeof(*buffer)); memcpy(cap->name, cap2->card,
memset(&fbuf2, 0, sizeof(fbuf2)); min(sizeof(cap->name), sizeof(cap2->card)));
cap->name[sizeof(cap->name) - 1] = 0;
if (cap2->capabilities & V4L2_CAP_VIDEO_CAPTURE)
cap->type |= VID_TYPE_CAPTURE;
if (cap2->capabilities & V4L2_CAP_TUNER)
cap->type |= VID_TYPE_TUNER;
if (cap2->capabilities & V4L2_CAP_VBI_CAPTURE)
cap->type |= VID_TYPE_TELETEXT;
if (cap2->capabilities & V4L2_CAP_VIDEO_OVERLAY)
cap->type |= VID_TYPE_OVERLAY;
if (fbuf.capability & V4L2_FBUF_CAP_LIST_CLIPPING)
cap->type |= VID_TYPE_CLIPPING;
cap->channels = count_inputs(inode, file, drv);
check_size(inode, file, drv,
&cap->maxwidth, &cap->maxheight);
cap->audios = 0; /* FIXME */
cap->minwidth = 48; /* FIXME */
cap->minheight = 32; /* FIXME */
done:
kfree(cap2);
return err;
}
err = drv(inode, file, VIDIOC_G_FBUF, &fbuf2); static noinline int v4l1_compat_get_frame_buffer(
if (err < 0) { struct video_buffer *buffer,
dprintk("VIDIOCGFBUF / VIDIOC_G_FBUF: %d\n", err); struct inode *inode,
break; struct file *file,
} v4l2_kioctl drv)
buffer->base = fbuf2.base; {
buffer->height = fbuf2.fmt.height; int err;
buffer->width = fbuf2.fmt.width; struct v4l2_framebuffer fbuf;
switch (fbuf2.fmt.pixelformat) { memset(buffer, 0, sizeof(*buffer));
case V4L2_PIX_FMT_RGB332: memset(&fbuf, 0, sizeof(fbuf));
buffer->depth = 8;
break; err = drv(inode, file, VIDIOC_G_FBUF, &fbuf);
case V4L2_PIX_FMT_RGB555: if (err < 0) {
buffer->depth = 15; dprintk("VIDIOCGFBUF / VIDIOC_G_FBUF: %d\n", err);
break; goto done;
case V4L2_PIX_FMT_RGB565: }
buffer->depth = 16; buffer->base = fbuf.base;
break; buffer->height = fbuf.fmt.height;
case V4L2_PIX_FMT_BGR24: buffer->width = fbuf.fmt.width;
buffer->depth = 24;
break; switch (fbuf.fmt.pixelformat) {
case V4L2_PIX_FMT_BGR32: case V4L2_PIX_FMT_RGB332:
buffer->depth = 32; buffer->depth = 8;
break;
default:
buffer->depth = 0;
}
if (fbuf2.fmt.bytesperline) {
buffer->bytesperline = fbuf2.fmt.bytesperline;
if (!buffer->depth && buffer->width)
buffer->depth = ((fbuf2.fmt.bytesperline<<3)
+ (buffer->width-1))
/ buffer->width;
} else {
buffer->bytesperline =
(buffer->width * buffer->depth + 7) & 7;
buffer->bytesperline >>= 3;
}
break; break;
case V4L2_PIX_FMT_RGB555:
buffer->depth = 15;
break;
case V4L2_PIX_FMT_RGB565:
buffer->depth = 16;
break;
case V4L2_PIX_FMT_BGR24:
buffer->depth = 24;
break;
case V4L2_PIX_FMT_BGR32:
buffer->depth = 32;
break;
default:
buffer->depth = 0;
} }
case VIDIOCSFBUF: /* set frame buffer */ if (fbuf.fmt.bytesperline) {
{ buffer->bytesperline = fbuf.fmt.bytesperline;
struct video_buffer *buffer = arg; if (!buffer->depth && buffer->width)
buffer->depth = ((fbuf.fmt.bytesperline<<3)
memset(&fbuf2, 0, sizeof(fbuf2)); + (buffer->width-1))
fbuf2.base = buffer->base; / buffer->width;
fbuf2.fmt.height = buffer->height; } else {
fbuf2.fmt.width = buffer->width; buffer->bytesperline =
switch (buffer->depth) { (buffer->width * buffer->depth + 7) & 7;
case 8: buffer->bytesperline >>= 3;
fbuf2.fmt.pixelformat = V4L2_PIX_FMT_RGB332; }
break; done:
case 15: return err;
fbuf2.fmt.pixelformat = V4L2_PIX_FMT_RGB555; }
break;
case 16: static noinline int v4l1_compat_set_frame_buffer(
fbuf2.fmt.pixelformat = V4L2_PIX_FMT_RGB565; struct video_buffer *buffer,
break; struct inode *inode,
case 24: struct file *file,
fbuf2.fmt.pixelformat = V4L2_PIX_FMT_BGR24; v4l2_kioctl drv)
break; {
case 32: int err;
fbuf2.fmt.pixelformat = V4L2_PIX_FMT_BGR32; struct v4l2_framebuffer fbuf;
break;
} memset(&fbuf, 0, sizeof(fbuf));
fbuf2.fmt.bytesperline = buffer->bytesperline; fbuf.base = buffer->base;
err = drv(inode, file, VIDIOC_S_FBUF, &fbuf2); fbuf.fmt.height = buffer->height;
if (err < 0) fbuf.fmt.width = buffer->width;
dprintk("VIDIOCSFBUF / VIDIOC_S_FBUF: %d\n", err); switch (buffer->depth) {
case 8:
fbuf.fmt.pixelformat = V4L2_PIX_FMT_RGB332;
break;
case 15:
fbuf.fmt.pixelformat = V4L2_PIX_FMT_RGB555;
break;
case 16:
fbuf.fmt.pixelformat = V4L2_PIX_FMT_RGB565;
break;
case 24:
fbuf.fmt.pixelformat = V4L2_PIX_FMT_BGR24;
break;
case 32:
fbuf.fmt.pixelformat = V4L2_PIX_FMT_BGR32;
break; break;
} }
case VIDIOCGWIN: /* get window or capture dimensions */ fbuf.fmt.bytesperline = buffer->bytesperline;
{ err = drv(inode, file, VIDIOC_S_FBUF, &fbuf);
struct video_window *win = arg; if (err < 0)
dprintk("VIDIOCSFBUF / VIDIOC_S_FBUF: %d\n", err);
return err;
}
fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL); static noinline int v4l1_compat_get_win_cap_dimensions(
if (!fmt2) { struct video_window *win,
err = -ENOMEM; struct inode *inode,
break; struct file *file,
} v4l2_kioctl drv)
memset(win, 0, sizeof(*win)); {
int err;
struct v4l2_format *fmt;
fmt2->type = V4L2_BUF_TYPE_VIDEO_OVERLAY; fmt = kzalloc(sizeof(*fmt), GFP_KERNEL);
err = drv(inode, file, VIDIOC_G_FMT, fmt2); if (!fmt) {
if (err < 0) err = -ENOMEM;
dprintk("VIDIOCGWIN / VIDIOC_G_WIN: %d\n", err); return err;
if (err == 0) { }
win->x = fmt2->fmt.win.w.left; memset(win, 0, sizeof(*win));
win->y = fmt2->fmt.win.w.top;
win->width = fmt2->fmt.win.w.width;
win->height = fmt2->fmt.win.w.height;
win->chromakey = fmt2->fmt.win.chromakey;
win->clips = NULL;
win->clipcount = 0;
break;
}
fmt2->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; fmt->type = V4L2_BUF_TYPE_VIDEO_OVERLAY;
err = drv(inode, file, VIDIOC_G_FMT, fmt2); err = drv(inode, file, VIDIOC_G_FMT, fmt);
if (err < 0) { if (err < 0)
dprintk("VIDIOCGWIN / VIDIOC_G_FMT: %d\n", err); dprintk("VIDIOCGWIN / VIDIOC_G_WIN: %d\n", err);
break; if (err == 0) {
} win->x = fmt->fmt.win.w.left;
win->x = 0; win->y = fmt->fmt.win.w.top;
win->y = 0; win->width = fmt->fmt.win.w.width;
win->width = fmt2->fmt.pix.width; win->height = fmt->fmt.win.w.height;
win->height = fmt2->fmt.pix.height; win->chromakey = fmt->fmt.win.chromakey;
win->chromakey = 0;
win->clips = NULL; win->clips = NULL;
win->clipcount = 0; win->clipcount = 0;
break; goto done;
} }
case VIDIOCSWIN: /* set window and/or capture dimensions */
{
struct video_window *win = arg;
int err1, err2;
fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL); fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
if (!fmt2) { err = drv(inode, file, VIDIOC_G_FMT, fmt);
err = -ENOMEM; if (err < 0) {
break; dprintk("VIDIOCGWIN / VIDIOC_G_FMT: %d\n", err);
} goto done;
fmt2->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; }
drv(inode, file, VIDIOC_STREAMOFF, &fmt2->type); win->x = 0;
err1 = drv(inode, file, VIDIOC_G_FMT, fmt2); win->y = 0;
if (err1 < 0) win->width = fmt->fmt.pix.width;
dprintk("VIDIOCSWIN / VIDIOC_G_FMT: %d\n", err); win->height = fmt->fmt.pix.height;
if (err1 == 0) { win->chromakey = 0;
fmt2->fmt.pix.width = win->width; win->clips = NULL;
fmt2->fmt.pix.height = win->height; win->clipcount = 0;
fmt2->fmt.pix.field = V4L2_FIELD_ANY; done:
fmt2->fmt.pix.bytesperline = 0; kfree(fmt);
err = drv(inode, file, VIDIOC_S_FMT, fmt2); return err;
if (err < 0) }
dprintk("VIDIOCSWIN / VIDIOC_S_FMT #1: %d\n",
err);
win->width = fmt2->fmt.pix.width;
win->height = fmt2->fmt.pix.height;
}
memset(fmt2, 0, sizeof(*fmt2)); static noinline int v4l1_compat_set_win_cap_dimensions(
fmt2->type = V4L2_BUF_TYPE_VIDEO_OVERLAY; struct video_window *win,
fmt2->fmt.win.w.left = win->x; struct inode *inode,
fmt2->fmt.win.w.top = win->y; struct file *file,
fmt2->fmt.win.w.width = win->width; v4l2_kioctl drv)
fmt2->fmt.win.w.height = win->height; {
fmt2->fmt.win.chromakey = win->chromakey; int err, err1, err2;
fmt2->fmt.win.clips = (void __user *)win->clips; struct v4l2_format *fmt;
fmt2->fmt.win.clipcount = win->clipcount;
err2 = drv(inode, file, VIDIOC_S_FMT, fmt2); fmt = kzalloc(sizeof(*fmt), GFP_KERNEL);
if (err2 < 0) if (!fmt) {
dprintk("VIDIOCSWIN / VIDIOC_S_FMT #2: %d\n", err); err = -ENOMEM;
return err;
if (err1 != 0 && err2 != 0)
err = err1;
break;
} }
case VIDIOCCAPTURE: /* turn on/off preview */ fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
{ drv(inode, file, VIDIOC_STREAMOFF, &fmt->type);
int *on = arg; err1 = drv(inode, file, VIDIOC_G_FMT, fmt);
if (err1 < 0)
if (0 == *on) { dprintk("VIDIOCSWIN / VIDIOC_G_FMT: %d\n", err1);
/* dirty hack time. But v4l1 has no STREAMOFF if (err1 == 0) {
* equivalent in the API, and this one at fmt->fmt.pix.width = win->width;
* least comes close ... */ fmt->fmt.pix.height = win->height;
drv(inode, file, VIDIOC_STREAMOFF, &captype); fmt->fmt.pix.field = V4L2_FIELD_ANY;
} fmt->fmt.pix.bytesperline = 0;
err = drv(inode, file, VIDIOC_OVERLAY, arg); err = drv(inode, file, VIDIOC_S_FMT, fmt);
if (err < 0) if (err < 0)
dprintk("VIDIOCCAPTURE / VIDIOC_PREVIEW: %d\n", err); dprintk("VIDIOCSWIN / VIDIOC_S_FMT #1: %d\n",
break; err);
win->width = fmt->fmt.pix.width;
win->height = fmt->fmt.pix.height;
} }
case VIDIOCGCHAN: /* get input information */
{
struct video_channel *chan = arg;
memset(&input2, 0, sizeof(input2)); memset(fmt, 0, sizeof(*fmt));
input2.index = chan->channel; fmt->type = V4L2_BUF_TYPE_VIDEO_OVERLAY;
err = drv(inode, file, VIDIOC_ENUMINPUT, &input2); fmt->fmt.win.w.left = win->x;
if (err < 0) { fmt->fmt.win.w.top = win->y;
dprintk("VIDIOCGCHAN / VIDIOC_ENUMINPUT: " fmt->fmt.win.w.width = win->width;
"channel=%d err=%d\n", chan->channel, err); fmt->fmt.win.w.height = win->height;
break; fmt->fmt.win.chromakey = win->chromakey;
} fmt->fmt.win.clips = (void __user *)win->clips;
chan->channel = input2.index; fmt->fmt.win.clipcount = win->clipcount;
memcpy(chan->name, input2.name, err2 = drv(inode, file, VIDIOC_S_FMT, fmt);
min(sizeof(chan->name), sizeof(input2.name))); if (err2 < 0)
chan->name[sizeof(chan->name) - 1] = 0; dprintk("VIDIOCSWIN / VIDIOC_S_FMT #2: %d\n", err2);
chan->tuners = (input2.type == V4L2_INPUT_TYPE_TUNER) ? 1 : 0;
chan->flags = (chan->tuners) ? VIDEO_VC_TUNER : 0; if (err1 != 0 && err2 != 0)
switch (input2.type) { err = err1;
case V4L2_INPUT_TYPE_TUNER: else
chan->type = VIDEO_TYPE_TV; err = 0;
break; kfree(fmt);
default: return err;
case V4L2_INPUT_TYPE_CAMERA: }
chan->type = VIDEO_TYPE_CAMERA;
break;
}
chan->norm = 0;
err = drv(inode, file, VIDIOC_G_STD, &sid);
if (err < 0)
dprintk("VIDIOCGCHAN / VIDIOC_G_STD: %d\n", err);
if (err == 0) {
if (sid & V4L2_STD_PAL)
chan->norm = VIDEO_MODE_PAL;
if (sid & V4L2_STD_NTSC)
chan->norm = VIDEO_MODE_NTSC;
if (sid & V4L2_STD_SECAM)
chan->norm = VIDEO_MODE_SECAM;
}
break;
}
case VIDIOCSCHAN: /* set input */
{
struct video_channel *chan = arg;
sid = 0; static noinline int v4l1_compat_turn_preview_on_off(
err = drv(inode, file, VIDIOC_S_INPUT, &chan->channel); int *on,
if (err < 0) struct inode *inode,
dprintk("VIDIOCSCHAN / VIDIOC_S_INPUT: %d\n", err); struct file *file,
switch (chan->norm) { v4l2_kioctl drv)
case VIDEO_MODE_PAL: {
sid = V4L2_STD_PAL; int err;
break; enum v4l2_buf_type captype = V4L2_BUF_TYPE_VIDEO_CAPTURE;
case VIDEO_MODE_NTSC:
sid = V4L2_STD_NTSC; if (0 == *on) {
break; /* dirty hack time. But v4l1 has no STREAMOFF
case VIDEO_MODE_SECAM: * equivalent in the API, and this one at
sid = V4L2_STD_SECAM; * least comes close ... */
break; drv(inode, file, VIDIOC_STREAMOFF, &captype);
}
if (0 != sid) {
err = drv(inode, file, VIDIOC_S_STD, &sid);
if (err < 0)
dprintk("VIDIOCSCHAN / VIDIOC_S_STD: %d\n", err);
}
break;
} }
case VIDIOCGPICT: /* get tone controls & partial capture format */ err = drv(inode, file, VIDIOC_OVERLAY, on);
{ if (err < 0)
struct video_picture *pict = arg; dprintk("VIDIOCCAPTURE / VIDIOC_PREVIEW: %d\n", err);
return err;
fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL); }
if (!fmt2) {
err = -ENOMEM;
break;
}
pict->brightness = get_v4l_control(inode, file, static noinline int v4l1_compat_get_input_info(
V4L2_CID_BRIGHTNESS, drv); struct video_channel *chan,
pict->hue = get_v4l_control(inode, file, struct inode *inode,
V4L2_CID_HUE, drv); struct file *file,
pict->contrast = get_v4l_control(inode, file, v4l2_kioctl drv)
V4L2_CID_CONTRAST, drv); {
pict->colour = get_v4l_control(inode, file, int err;
V4L2_CID_SATURATION, drv); struct v4l2_input input2;
pict->whiteness = get_v4l_control(inode, file, v4l2_std_id sid;
V4L2_CID_WHITENESS, drv);
fmt2->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_G_FMT, fmt2);
if (err < 0) {
dprintk("VIDIOCGPICT / VIDIOC_G_FMT: %d\n", err);
break;
}
pict->depth = ((fmt2->fmt.pix.bytesperline << 3) memset(&input2, 0, sizeof(input2));
+ (fmt2->fmt.pix.width - 1)) input2.index = chan->channel;
/ fmt2->fmt.pix.width; err = drv(inode, file, VIDIOC_ENUMINPUT, &input2);
pict->palette = pixelformat_to_palette( if (err < 0) {
fmt2->fmt.pix.pixelformat); dprintk("VIDIOCGCHAN / VIDIOC_ENUMINPUT: "
"channel=%d err=%d\n", chan->channel, err);
goto done;
}
chan->channel = input2.index;
memcpy(chan->name, input2.name,
min(sizeof(chan->name), sizeof(input2.name)));
chan->name[sizeof(chan->name) - 1] = 0;
chan->tuners = (input2.type == V4L2_INPUT_TYPE_TUNER) ? 1 : 0;
chan->flags = (chan->tuners) ? VIDEO_VC_TUNER : 0;
switch (input2.type) {
case V4L2_INPUT_TYPE_TUNER:
chan->type = VIDEO_TYPE_TV;
break;
default:
case V4L2_INPUT_TYPE_CAMERA:
chan->type = VIDEO_TYPE_CAMERA;
break; break;
} }
case VIDIOCSPICT: /* set tone controls & partial capture format */ chan->norm = 0;
{ err = drv(inode, file, VIDIOC_G_STD, &sid);
struct video_picture *pict = arg; if (err < 0)
int mem_err = 0, ovl_err = 0; dprintk("VIDIOCGCHAN / VIDIOC_G_STD: %d\n", err);
if (err == 0) {
if (sid & V4L2_STD_PAL)
chan->norm = VIDEO_MODE_PAL;
if (sid & V4L2_STD_NTSC)
chan->norm = VIDEO_MODE_NTSC;
if (sid & V4L2_STD_SECAM)
chan->norm = VIDEO_MODE_SECAM;
}
done:
return err;
}
fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL); static noinline int v4l1_compat_set_input(
if (!fmt2) { struct video_channel *chan,
err = -ENOMEM; struct inode *inode,
break; struct file *file,
} v4l2_kioctl drv)
memset(&fbuf2, 0, sizeof(fbuf2)); {
int err;
set_v4l_control(inode, file, v4l2_std_id sid = 0;
V4L2_CID_BRIGHTNESS, pict->brightness, drv);
set_v4l_control(inode, file,
V4L2_CID_HUE, pict->hue, drv);
set_v4l_control(inode, file,
V4L2_CID_CONTRAST, pict->contrast, drv);
set_v4l_control(inode, file,
V4L2_CID_SATURATION, pict->colour, drv);
set_v4l_control(inode, file,
V4L2_CID_WHITENESS, pict->whiteness, drv);
/*
* V4L1 uses this ioctl to set both memory capture and overlay
* pixel format, while V4L2 has two different ioctls for this.
* Some cards may not support one or the other, and may support
* different pixel formats for memory vs overlay.
*/
fmt2->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_G_FMT, fmt2);
/* If VIDIOC_G_FMT failed, then the driver likely doesn't
support memory capture. Trying to set the memory capture
parameters would be pointless. */
if (err < 0) {
dprintk("VIDIOCSPICT / VIDIOC_G_FMT: %d\n", err);
mem_err = -1000; /* didn't even try */
} else if (fmt2->fmt.pix.pixelformat !=
palette_to_pixelformat(pict->palette)) {
fmt2->fmt.pix.pixelformat = palette_to_pixelformat(
pict->palette);
mem_err = drv(inode, file, VIDIOC_S_FMT, fmt2);
if (mem_err < 0)
dprintk("VIDIOCSPICT / VIDIOC_S_FMT: %d\n",
mem_err);
}
err = drv(inode, file, VIDIOC_G_FBUF, &fbuf2); err = drv(inode, file, VIDIOC_S_INPUT, &chan->channel);
/* If VIDIOC_G_FBUF failed, then the driver likely doesn't if (err < 0)
support overlay. Trying to set the overlay parameters dprintk("VIDIOCSCHAN / VIDIOC_S_INPUT: %d\n", err);
would be quite pointless. */ switch (chan->norm) {
if (err < 0) { case VIDEO_MODE_PAL:
dprintk("VIDIOCSPICT / VIDIOC_G_FBUF: %d\n", err); sid = V4L2_STD_PAL;
ovl_err = -1000; /* didn't even try */ break;
} else if (fbuf2.fmt.pixelformat != case VIDEO_MODE_NTSC:
palette_to_pixelformat(pict->palette)) { sid = V4L2_STD_NTSC;
fbuf2.fmt.pixelformat = palette_to_pixelformat( break;
pict->palette); case VIDEO_MODE_SECAM:
ovl_err = drv(inode, file, VIDIOC_S_FBUF, &fbuf2); sid = V4L2_STD_SECAM;
if (ovl_err < 0)
dprintk("VIDIOCSPICT / VIDIOC_S_FBUF: %d\n",
ovl_err);
}
if (ovl_err < 0 && mem_err < 0) {
/* ioctl failed, couldn't set either parameter */
if (mem_err != -1000)
err = mem_err;
else if (ovl_err == -EPERM)
err = 0;
else
err = ovl_err;
} else
err = 0;
break; break;
} }
case VIDIOCGTUNER: /* get tuner information */ if (0 != sid) {
{ err = drv(inode, file, VIDIOC_S_STD, &sid);
struct video_tuner *tun = arg;
memset(&tun2, 0, sizeof(tun2));
err = drv(inode, file, VIDIOC_G_TUNER, &tun2);
if (err < 0) {
dprintk("VIDIOCGTUNER / VIDIOC_G_TUNER: %d\n", err);
break;
}
memcpy(tun->name, tun2.name,
min(sizeof(tun->name), sizeof(tun2.name)));
tun->name[sizeof(tun->name) - 1] = 0;
tun->rangelow = tun2.rangelow;
tun->rangehigh = tun2.rangehigh;
tun->flags = 0;
tun->mode = VIDEO_MODE_AUTO;
for (i = 0; i < 64; i++) {
memset(&std2, 0, sizeof(std2));
std2.index = i;
if (0 != drv(inode, file, VIDIOC_ENUMSTD, &std2))
break;
if (std2.id & V4L2_STD_PAL)
tun->flags |= VIDEO_TUNER_PAL;
if (std2.id & V4L2_STD_NTSC)
tun->flags |= VIDEO_TUNER_NTSC;
if (std2.id & V4L2_STD_SECAM)
tun->flags |= VIDEO_TUNER_SECAM;
}
err = drv(inode, file, VIDIOC_G_STD, &sid);
if (err < 0) if (err < 0)
dprintk("VIDIOCGTUNER / VIDIOC_G_STD: %d\n", err); dprintk("VIDIOCSCHAN / VIDIOC_S_STD: %d\n", err);
if (err == 0) {
if (sid & V4L2_STD_PAL)
tun->mode = VIDEO_MODE_PAL;
if (sid & V4L2_STD_NTSC)
tun->mode = VIDEO_MODE_NTSC;
if (sid & V4L2_STD_SECAM)
tun->mode = VIDEO_MODE_SECAM;
}
if (tun2.capability & V4L2_TUNER_CAP_LOW)
tun->flags |= VIDEO_TUNER_LOW;
if (tun2.rxsubchans & V4L2_TUNER_SUB_STEREO)
tun->flags |= VIDEO_TUNER_STEREO_ON;
tun->signal = tun2.signal;
break;
} }
case VIDIOCSTUNER: /* select a tuner input */ return err;
{ }
struct video_tuner *tun = arg;
struct v4l2_tuner t;
memset(&t, 0, sizeof(t));
t.index = tun->tuner;
err = drv(inode, file, VIDIOC_S_INPUT, &t); static noinline int v4l1_compat_get_picture(
if (err < 0) struct video_picture *pict,
dprintk("VIDIOCSTUNER / VIDIOC_S_INPUT: %d\n", err); struct inode *inode,
struct file *file,
v4l2_kioctl drv)
{
int err;
struct v4l2_format *fmt;
break; fmt = kzalloc(sizeof(*fmt), GFP_KERNEL);
if (!fmt) {
err = -ENOMEM;
return err;
} }
case VIDIOCGFREQ: /* get frequency */
{
unsigned long *freq = arg;
memset(&freq2, 0, sizeof(freq2));
freq2.tuner = 0; pict->brightness = get_v4l_control(inode, file,
err = drv(inode, file, VIDIOC_G_FREQUENCY, &freq2); V4L2_CID_BRIGHTNESS, drv);
if (err < 0) pict->hue = get_v4l_control(inode, file,
dprintk("VIDIOCGFREQ / VIDIOC_G_FREQUENCY: %d\n", err); V4L2_CID_HUE, drv);
if (0 == err) pict->contrast = get_v4l_control(inode, file,
*freq = freq2.frequency; V4L2_CID_CONTRAST, drv);
break; pict->colour = get_v4l_control(inode, file,
V4L2_CID_SATURATION, drv);
pict->whiteness = get_v4l_control(inode, file,
V4L2_CID_WHITENESS, drv);
fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_G_FMT, fmt);
if (err < 0) {
dprintk("VIDIOCGPICT / VIDIOC_G_FMT: %d\n", err);
goto done;
} }
case VIDIOCSFREQ: /* set frequency */
{
unsigned long *freq = arg;
memset(&freq2, 0, sizeof(freq2));
drv(inode, file, VIDIOC_G_FREQUENCY, &freq2); pict->depth = ((fmt->fmt.pix.bytesperline << 3)
freq2.frequency = *freq; + (fmt->fmt.pix.width - 1))
err = drv(inode, file, VIDIOC_S_FREQUENCY, &freq2); / fmt->fmt.pix.width;
if (err < 0) pict->palette = pixelformat_to_palette(
dprintk("VIDIOCSFREQ / VIDIOC_S_FREQUENCY: %d\n", err); fmt->fmt.pix.pixelformat);
break; done:
kfree(fmt);
return err;
}
static noinline int v4l1_compat_set_picture(
struct video_picture *pict,
struct inode *inode,
struct file *file,
v4l2_kioctl drv)
{
int err;
struct v4l2_framebuffer fbuf;
int mem_err = 0, ovl_err = 0;
struct v4l2_format *fmt;
fmt = kzalloc(sizeof(*fmt), GFP_KERNEL);
if (!fmt) {
err = -ENOMEM;
return err;
}
memset(&fbuf, 0, sizeof(fbuf));
set_v4l_control(inode, file,
V4L2_CID_BRIGHTNESS, pict->brightness, drv);
set_v4l_control(inode, file,
V4L2_CID_HUE, pict->hue, drv);
set_v4l_control(inode, file,
V4L2_CID_CONTRAST, pict->contrast, drv);
set_v4l_control(inode, file,
V4L2_CID_SATURATION, pict->colour, drv);
set_v4l_control(inode, file,
V4L2_CID_WHITENESS, pict->whiteness, drv);
/*
* V4L1 uses this ioctl to set both memory capture and overlay
* pixel format, while V4L2 has two different ioctls for this.
* Some cards may not support one or the other, and may support
* different pixel formats for memory vs overlay.
*/
fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_G_FMT, fmt);
/* If VIDIOC_G_FMT failed, then the driver likely doesn't
support memory capture. Trying to set the memory capture
parameters would be pointless. */
if (err < 0) {
dprintk("VIDIOCSPICT / VIDIOC_G_FMT: %d\n", err);
mem_err = -1000; /* didn't even try */
} else if (fmt->fmt.pix.pixelformat !=
palette_to_pixelformat(pict->palette)) {
fmt->fmt.pix.pixelformat = palette_to_pixelformat(
pict->palette);
mem_err = drv(inode, file, VIDIOC_S_FMT, fmt);
if (mem_err < 0)
dprintk("VIDIOCSPICT / VIDIOC_S_FMT: %d\n",
mem_err);
} }
case VIDIOCGAUDIO: /* get audio properties/controls */
{
struct video_audio *aud = arg;
memset(&aud2, 0, sizeof(aud2));
err = drv(inode, file, VIDIOC_G_AUDIO, &aud2); err = drv(inode, file, VIDIOC_G_FBUF, &fbuf);
if (err < 0) { /* If VIDIOC_G_FBUF failed, then the driver likely doesn't
dprintk("VIDIOCGAUDIO / VIDIOC_G_AUDIO: %d\n", err); support overlay. Trying to set the overlay parameters
break; would be quite pointless. */
} if (err < 0) {
memcpy(aud->name, aud2.name, dprintk("VIDIOCSPICT / VIDIOC_G_FBUF: %d\n", err);
min(sizeof(aud->name), sizeof(aud2.name))); ovl_err = -1000; /* didn't even try */
aud->name[sizeof(aud->name) - 1] = 0; } else if (fbuf.fmt.pixelformat !=
aud->audio = aud2.index; palette_to_pixelformat(pict->palette)) {
aud->flags = 0; fbuf.fmt.pixelformat = palette_to_pixelformat(
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_VOLUME, drv); pict->palette);
if (i >= 0) { ovl_err = drv(inode, file, VIDIOC_S_FBUF, &fbuf);
aud->volume = i; if (ovl_err < 0)
aud->flags |= VIDEO_AUDIO_VOLUME; dprintk("VIDIOCSPICT / VIDIOC_S_FBUF: %d\n",
} ovl_err);
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_BASS, drv); }
if (i >= 0) { if (ovl_err < 0 && mem_err < 0) {
aud->bass = i; /* ioctl failed, couldn't set either parameter */
aud->flags |= VIDEO_AUDIO_BASS; if (mem_err != -1000)
} err = mem_err;
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_TREBLE, drv); else if (ovl_err == -EPERM)
if (i >= 0) {
aud->treble = i;
aud->flags |= VIDEO_AUDIO_TREBLE;
}
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_BALANCE, drv);
if (i >= 0) {
aud->balance = i;
aud->flags |= VIDEO_AUDIO_BALANCE;
}
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_MUTE, drv);
if (i >= 0) {
if (i)
aud->flags |= VIDEO_AUDIO_MUTE;
aud->flags |= VIDEO_AUDIO_MUTABLE;
}
aud->step = 1;
qctrl2.id = V4L2_CID_AUDIO_VOLUME;
if (drv(inode, file, VIDIOC_QUERYCTRL, &qctrl2) == 0 &&
!(qctrl2.flags & V4L2_CTRL_FLAG_DISABLED))
aud->step = qctrl2.step;
aud->mode = 0;
memset(&tun2, 0, sizeof(tun2));
err = drv(inode, file, VIDIOC_G_TUNER, &tun2);
if (err < 0) {
dprintk("VIDIOCGAUDIO / VIDIOC_G_TUNER: %d\n", err);
err = 0; err = 0;
else
err = ovl_err;
} else
err = 0;
kfree(fmt);
return err;
}
static noinline int v4l1_compat_get_tuner(
struct video_tuner *tun,
struct inode *inode,
struct file *file,
v4l2_kioctl drv)
{
int err, i;
struct v4l2_tuner tun2;
struct v4l2_standard std2;
v4l2_std_id sid;
memset(&tun2, 0, sizeof(tun2));
err = drv(inode, file, VIDIOC_G_TUNER, &tun2);
if (err < 0) {
dprintk("VIDIOCGTUNER / VIDIOC_G_TUNER: %d\n", err);
goto done;
}
memcpy(tun->name, tun2.name,
min(sizeof(tun->name), sizeof(tun2.name)));
tun->name[sizeof(tun->name) - 1] = 0;
tun->rangelow = tun2.rangelow;
tun->rangehigh = tun2.rangehigh;
tun->flags = 0;
tun->mode = VIDEO_MODE_AUTO;
for (i = 0; i < 64; i++) {
memset(&std2, 0, sizeof(std2));
std2.index = i;
if (0 != drv(inode, file, VIDIOC_ENUMSTD, &std2))
break; break;
} if (std2.id & V4L2_STD_PAL)
tun->flags |= VIDEO_TUNER_PAL;
if (std2.id & V4L2_STD_NTSC)
tun->flags |= VIDEO_TUNER_NTSC;
if (std2.id & V4L2_STD_SECAM)
tun->flags |= VIDEO_TUNER_SECAM;
}
if (tun2.rxsubchans & V4L2_TUNER_SUB_LANG2) err = drv(inode, file, VIDIOC_G_STD, &sid);
aud->mode = VIDEO_SOUND_LANG1 | VIDEO_SOUND_LANG2; if (err < 0)
else if (tun2.rxsubchans & V4L2_TUNER_SUB_STEREO) dprintk("VIDIOCGTUNER / VIDIOC_G_STD: %d\n", err);
aud->mode = VIDEO_SOUND_STEREO; if (err == 0) {
else if (tun2.rxsubchans & V4L2_TUNER_SUB_MONO) if (sid & V4L2_STD_PAL)
aud->mode = VIDEO_SOUND_MONO; tun->mode = VIDEO_MODE_PAL;
break; if (sid & V4L2_STD_NTSC)
tun->mode = VIDEO_MODE_NTSC;
if (sid & V4L2_STD_SECAM)
tun->mode = VIDEO_MODE_SECAM;
} }
case VIDIOCSAUDIO: /* set audio controls */
{
struct video_audio *aud = arg;
memset(&aud2, 0, sizeof(aud2)); if (tun2.capability & V4L2_TUNER_CAP_LOW)
memset(&tun2, 0, sizeof(tun2)); tun->flags |= VIDEO_TUNER_LOW;
if (tun2.rxsubchans & V4L2_TUNER_SUB_STEREO)
tun->flags |= VIDEO_TUNER_STEREO_ON;
tun->signal = tun2.signal;
done:
return err;
}
aud2.index = aud->audio; static noinline int v4l1_compat_select_tuner(
err = drv(inode, file, VIDIOC_S_AUDIO, &aud2); struct video_tuner *tun,
if (err < 0) { struct inode *inode,
dprintk("VIDIOCSAUDIO / VIDIOC_S_AUDIO: %d\n", err); struct file *file,
break; v4l2_kioctl drv)
} {
int err;
struct v4l2_tuner t;/*84 bytes on x86_64*/
memset(&t, 0, sizeof(t));
set_v4l_control(inode, file, V4L2_CID_AUDIO_VOLUME, t.index = tun->tuner;
aud->volume, drv);
set_v4l_control(inode, file, V4L2_CID_AUDIO_BASS, err = drv(inode, file, VIDIOC_S_INPUT, &t);
aud->bass, drv); if (err < 0)
set_v4l_control(inode, file, V4L2_CID_AUDIO_TREBLE, dprintk("VIDIOCSTUNER / VIDIOC_S_INPUT: %d\n", err);
aud->treble, drv); return err;
set_v4l_control(inode, file, V4L2_CID_AUDIO_BALANCE, }
aud->balance, drv);
set_v4l_control(inode, file, V4L2_CID_AUDIO_MUTE, static noinline int v4l1_compat_get_frequency(
!!(aud->flags & VIDEO_AUDIO_MUTE), drv); unsigned long *freq,
struct inode *inode,
err = drv(inode, file, VIDIOC_G_TUNER, &tun2); struct file *file,
if (err < 0) v4l2_kioctl drv)
dprintk("VIDIOCSAUDIO / VIDIOC_G_TUNER: %d\n", err); {
if (err == 0) { int err;
switch (aud->mode) { struct v4l2_frequency freq2;
default: memset(&freq2, 0, sizeof(freq2));
case VIDEO_SOUND_MONO:
case VIDEO_SOUND_LANG1: freq2.tuner = 0;
tun2.audmode = V4L2_TUNER_MODE_MONO; err = drv(inode, file, VIDIOC_G_FREQUENCY, &freq2);
break; if (err < 0)
case VIDEO_SOUND_STEREO: dprintk("VIDIOCGFREQ / VIDIOC_G_FREQUENCY: %d\n", err);
tun2.audmode = V4L2_TUNER_MODE_STEREO; if (0 == err)
break; *freq = freq2.frequency;
case VIDEO_SOUND_LANG2: return err;
tun2.audmode = V4L2_TUNER_MODE_LANG2; }
break;
} static noinline int v4l1_compat_set_frequency(
err = drv(inode, file, VIDIOC_S_TUNER, &tun2); unsigned long *freq,
if (err < 0) struct inode *inode,
dprintk("VIDIOCSAUDIO / VIDIOC_S_TUNER: %d\n", err); struct file *file,
} v4l2_kioctl drv)
{
int err;
struct v4l2_frequency freq2;
memset(&freq2, 0, sizeof(freq2));
drv(inode, file, VIDIOC_G_FREQUENCY, &freq2);
freq2.frequency = *freq;
err = drv(inode, file, VIDIOC_S_FREQUENCY, &freq2);
if (err < 0)
dprintk("VIDIOCSFREQ / VIDIOC_S_FREQUENCY: %d\n", err);
return err;
}
static noinline int v4l1_compat_get_audio(
struct video_audio *aud,
struct inode *inode,
struct file *file,
v4l2_kioctl drv)
{
int err, i;
struct v4l2_queryctrl qctrl2;
struct v4l2_audio aud2;
struct v4l2_tuner tun2;
memset(&aud2, 0, sizeof(aud2));
err = drv(inode, file, VIDIOC_G_AUDIO, &aud2);
if (err < 0) {
dprintk("VIDIOCGAUDIO / VIDIOC_G_AUDIO: %d\n", err);
goto done;
}
memcpy(aud->name, aud2.name,
min(sizeof(aud->name), sizeof(aud2.name)));
aud->name[sizeof(aud->name) - 1] = 0;
aud->audio = aud2.index;
aud->flags = 0;
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_VOLUME, drv);
if (i >= 0) {
aud->volume = i;
aud->flags |= VIDEO_AUDIO_VOLUME;
}
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_BASS, drv);
if (i >= 0) {
aud->bass = i;
aud->flags |= VIDEO_AUDIO_BASS;
}
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_TREBLE, drv);
if (i >= 0) {
aud->treble = i;
aud->flags |= VIDEO_AUDIO_TREBLE;
}
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_BALANCE, drv);
if (i >= 0) {
aud->balance = i;
aud->flags |= VIDEO_AUDIO_BALANCE;
}
i = get_v4l_control(inode, file, V4L2_CID_AUDIO_MUTE, drv);
if (i >= 0) {
if (i)
aud->flags |= VIDEO_AUDIO_MUTE;
aud->flags |= VIDEO_AUDIO_MUTABLE;
}
aud->step = 1;
qctrl2.id = V4L2_CID_AUDIO_VOLUME;
if (drv(inode, file, VIDIOC_QUERYCTRL, &qctrl2) == 0 &&
!(qctrl2.flags & V4L2_CTRL_FLAG_DISABLED))
aud->step = qctrl2.step;
aud->mode = 0;
memset(&tun2, 0, sizeof(tun2));
err = drv(inode, file, VIDIOC_G_TUNER, &tun2);
if (err < 0) {
dprintk("VIDIOCGAUDIO / VIDIOC_G_TUNER: %d\n", err);
err = 0; err = 0;
break; goto done;
} }
case VIDIOCMCAPTURE: /* capture a frame */
{
struct video_mmap *mm = arg;
fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL); if (tun2.rxsubchans & V4L2_TUNER_SUB_LANG2)
if (!fmt2) { aud->mode = VIDEO_SOUND_LANG1 | VIDEO_SOUND_LANG2;
err = -ENOMEM; else if (tun2.rxsubchans & V4L2_TUNER_SUB_STEREO)
break; aud->mode = VIDEO_SOUND_STEREO;
} else if (tun2.rxsubchans & V4L2_TUNER_SUB_MONO)
memset(&buf2, 0, sizeof(buf2)); aud->mode = VIDEO_SOUND_MONO;
done:
return err;
}
fmt2->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; static noinline int v4l1_compat_set_audio(
err = drv(inode, file, VIDIOC_G_FMT, fmt2); struct video_audio *aud,
if (err < 0) { struct inode *inode,
dprintk("VIDIOCMCAPTURE / VIDIOC_G_FMT: %d\n", err); struct file *file,
v4l2_kioctl drv)
{
int err;
struct v4l2_audio aud2;
struct v4l2_tuner tun2;
memset(&aud2, 0, sizeof(aud2));
memset(&tun2, 0, sizeof(tun2));
aud2.index = aud->audio;
err = drv(inode, file, VIDIOC_S_AUDIO, &aud2);
if (err < 0) {
dprintk("VIDIOCSAUDIO / VIDIOC_S_AUDIO: %d\n", err);
goto done;
}
set_v4l_control(inode, file, V4L2_CID_AUDIO_VOLUME,
aud->volume, drv);
set_v4l_control(inode, file, V4L2_CID_AUDIO_BASS,
aud->bass, drv);
set_v4l_control(inode, file, V4L2_CID_AUDIO_TREBLE,
aud->treble, drv);
set_v4l_control(inode, file, V4L2_CID_AUDIO_BALANCE,
aud->balance, drv);
set_v4l_control(inode, file, V4L2_CID_AUDIO_MUTE,
!!(aud->flags & VIDEO_AUDIO_MUTE), drv);
err = drv(inode, file, VIDIOC_G_TUNER, &tun2);
if (err < 0)
dprintk("VIDIOCSAUDIO / VIDIOC_G_TUNER: %d\n", err);
if (err == 0) {
switch (aud->mode) {
default:
case VIDEO_SOUND_MONO:
case VIDEO_SOUND_LANG1:
tun2.audmode = V4L2_TUNER_MODE_MONO;
break; break;
} case VIDEO_SOUND_STEREO:
if (mm->width != fmt2->fmt.pix.width || tun2.audmode = V4L2_TUNER_MODE_STEREO;
mm->height != fmt2->fmt.pix.height ||
palette_to_pixelformat(mm->format) !=
fmt2->fmt.pix.pixelformat) {
/* New capture format... */
fmt2->fmt.pix.width = mm->width;
fmt2->fmt.pix.height = mm->height;
fmt2->fmt.pix.pixelformat =
palette_to_pixelformat(mm->format);
fmt2->fmt.pix.field = V4L2_FIELD_ANY;
fmt2->fmt.pix.bytesperline = 0;
err = drv(inode, file, VIDIOC_S_FMT, fmt2);
if (err < 0) {
dprintk("VIDIOCMCAPTURE / VIDIOC_S_FMT: %d\n", err);
break;
}
}
buf2.index = mm->frame;
buf2.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_QUERYBUF, &buf2);
if (err < 0) {
dprintk("VIDIOCMCAPTURE / VIDIOC_QUERYBUF: %d\n", err);
break; break;
} case VIDEO_SOUND_LANG2:
err = drv(inode, file, VIDIOC_QBUF, &buf2); tun2.audmode = V4L2_TUNER_MODE_LANG2;
if (err < 0) {
dprintk("VIDIOCMCAPTURE / VIDIOC_QBUF: %d\n", err);
break; break;
} }
err = drv(inode, file, VIDIOC_STREAMON, &captype); err = drv(inode, file, VIDIOC_S_TUNER, &tun2);
if (err < 0) if (err < 0)
dprintk("VIDIOCMCAPTURE / VIDIOC_STREAMON: %d\n", err); dprintk("VIDIOCSAUDIO / VIDIOC_S_TUNER: %d\n", err);
break;
} }
case VIDIOCSYNC: /* wait for a frame */ err = 0;
{ done:
int *i = arg; return err;
}
memset(&buf2, 0, sizeof(buf2)); static noinline int v4l1_compat_capture_frame(
buf2.index = *i; struct video_mmap *mm,
buf2.type = V4L2_BUF_TYPE_VIDEO_CAPTURE; struct inode *inode,
err = drv(inode, file, VIDIOC_QUERYBUF, &buf2); struct file *file,
if (err < 0) { v4l2_kioctl drv)
/* No such buffer */ {
dprintk("VIDIOCSYNC / VIDIOC_QUERYBUF: %d\n", err); int err;
break; enum v4l2_buf_type captype = V4L2_BUF_TYPE_VIDEO_CAPTURE;
} struct v4l2_buffer buf;
if (!(buf2.flags & V4L2_BUF_FLAG_MAPPED)) { struct v4l2_format *fmt;
/* Buffer is not mapped */
err = -EINVAL;
break;
}
/* make sure capture actually runs so we don't block forever */ fmt = kzalloc(sizeof(*fmt), GFP_KERNEL);
err = drv(inode, file, VIDIOC_STREAMON, &captype); if (!fmt) {
err = -ENOMEM;
return err;
}
memset(&buf, 0, sizeof(buf));
fmt->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_G_FMT, fmt);
if (err < 0) {
dprintk("VIDIOCMCAPTURE / VIDIOC_G_FMT: %d\n", err);
goto done;
}
if (mm->width != fmt->fmt.pix.width ||
mm->height != fmt->fmt.pix.height ||
palette_to_pixelformat(mm->format) !=
fmt->fmt.pix.pixelformat) {
/* New capture format... */
fmt->fmt.pix.width = mm->width;
fmt->fmt.pix.height = mm->height;
fmt->fmt.pix.pixelformat =
palette_to_pixelformat(mm->format);
fmt->fmt.pix.field = V4L2_FIELD_ANY;
fmt->fmt.pix.bytesperline = 0;
err = drv(inode, file, VIDIOC_S_FMT, fmt);
if (err < 0) { if (err < 0) {
dprintk("VIDIOCSYNC / VIDIOC_STREAMON: %d\n", err); dprintk("VIDIOCMCAPTURE / VIDIOC_S_FMT: %d\n", err);
break; goto done;
} }
}
buf.index = mm->frame;
buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_QUERYBUF, &buf);
if (err < 0) {
dprintk("VIDIOCMCAPTURE / VIDIOC_QUERYBUF: %d\n", err);
goto done;
}
err = drv(inode, file, VIDIOC_QBUF, &buf);
if (err < 0) {
dprintk("VIDIOCMCAPTURE / VIDIOC_QBUF: %d\n", err);
goto done;
}
err = drv(inode, file, VIDIOC_STREAMON, &captype);
if (err < 0)
dprintk("VIDIOCMCAPTURE / VIDIOC_STREAMON: %d\n", err);
done:
kfree(fmt);
return err;
}
/* Loop as long as the buffer is queued, but not done */ static noinline int v4l1_compat_sync(
while ((buf2.flags & int *i,
(V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE)) struct inode *inode,
== V4L2_BUF_FLAG_QUEUED) { struct file *file,
err = poll_one(file); v4l2_kioctl drv)
if (err < 0 || /* error or sleep was interrupted */ {
err == 0) /* timeout? Shouldn't occur. */ int err;
break; enum v4l2_buf_type captype = V4L2_BUF_TYPE_VIDEO_CAPTURE;
err = drv(inode, file, VIDIOC_QUERYBUF, &buf2); struct v4l2_buffer buf;
if (err < 0)
dprintk("VIDIOCSYNC / VIDIOC_QUERYBUF: %d\n", err); memset(&buf, 0, sizeof(buf));
} buf.index = *i;
if (!(buf2.flags & V4L2_BUF_FLAG_DONE)) /* not done */ buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
break; err = drv(inode, file, VIDIOC_QUERYBUF, &buf);
do { if (err < 0) {
err = drv(inode, file, VIDIOC_DQBUF, &buf2); /* No such buffer */
if (err < 0) dprintk("VIDIOCSYNC / VIDIOC_QUERYBUF: %d\n", err);
dprintk("VIDIOCSYNC / VIDIOC_DQBUF: %d\n", err); goto done;
} while (err == 0 && buf2.index != *i); }
break; if (!(buf.flags & V4L2_BUF_FLAG_MAPPED)) {
/* Buffer is not mapped */
err = -EINVAL;
goto done;
} }
case VIDIOCGVBIFMT: /* query VBI data capture format */ /* make sure capture actually runs so we don't block forever */
{ err = drv(inode, file, VIDIOC_STREAMON, &captype);
struct vbi_format *fmt = arg; if (err < 0) {
dprintk("VIDIOCSYNC / VIDIOC_STREAMON: %d\n", err);
goto done;
}
fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL); /* Loop as long as the buffer is queued, but not done */
if (!fmt2) { while ((buf.flags & (V4L2_BUF_FLAG_QUEUED | V4L2_BUF_FLAG_DONE))
err = -ENOMEM; == V4L2_BUF_FLAG_QUEUED) {
err = poll_one(file);
if (err < 0 || /* error or sleep was interrupted */
err == 0) /* timeout? Shouldn't occur. */
break; break;
} err = drv(inode, file, VIDIOC_QUERYBUF, &buf);
fmt2->type = V4L2_BUF_TYPE_VBI_CAPTURE; if (err < 0)
dprintk("VIDIOCSYNC / VIDIOC_QUERYBUF: %d\n", err);
}
if (!(buf.flags & V4L2_BUF_FLAG_DONE)) /* not done */
goto done;
do {
err = drv(inode, file, VIDIOC_DQBUF, &buf);
if (err < 0)
dprintk("VIDIOCSYNC / VIDIOC_DQBUF: %d\n", err);
} while (err == 0 && buf.index != *i);
done:
return err;
}
err = drv(inode, file, VIDIOC_G_FMT, fmt2); static noinline int v4l1_compat_get_vbi_format(
if (err < 0) { struct vbi_format *fmt,
dprintk("VIDIOCGVBIFMT / VIDIOC_G_FMT: %d\n", err); struct inode *inode,
break; struct file *file,
} v4l2_kioctl drv)
if (fmt2->fmt.vbi.sample_format != V4L2_PIX_FMT_GREY) { {
err = -EINVAL; int err;
break; struct v4l2_format *fmt2;
}
memset(fmt, 0, sizeof(*fmt)); fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL);
fmt->samples_per_line = fmt2->fmt.vbi.samples_per_line; if (!fmt2) {
fmt->sampling_rate = fmt2->fmt.vbi.sampling_rate; err = -ENOMEM;
fmt->sample_format = VIDEO_PALETTE_RAW; return err;
fmt->start[0] = fmt2->fmt.vbi.start[0];
fmt->count[0] = fmt2->fmt.vbi.count[0];
fmt->start[1] = fmt2->fmt.vbi.start[1];
fmt->count[1] = fmt2->fmt.vbi.count[1];
fmt->flags = fmt2->fmt.vbi.flags & 0x03;
break;
} }
case VIDIOCSVBIFMT: fmt2->type = V4L2_BUF_TYPE_VBI_CAPTURE;
{
struct vbi_format *fmt = arg;
if (VIDEO_PALETTE_RAW != fmt->sample_format) { err = drv(inode, file, VIDIOC_G_FMT, fmt2);
err = -EINVAL; if (err < 0) {
break; dprintk("VIDIOCGVBIFMT / VIDIOC_G_FMT: %d\n", err);
} goto done;
}
if (fmt2->fmt.vbi.sample_format != V4L2_PIX_FMT_GREY) {
err = -EINVAL;
goto done;
}
memset(fmt, 0, sizeof(*fmt));
fmt->samples_per_line = fmt2->fmt.vbi.samples_per_line;
fmt->sampling_rate = fmt2->fmt.vbi.sampling_rate;
fmt->sample_format = VIDEO_PALETTE_RAW;
fmt->start[0] = fmt2->fmt.vbi.start[0];
fmt->count[0] = fmt2->fmt.vbi.count[0];
fmt->start[1] = fmt2->fmt.vbi.start[1];
fmt->count[1] = fmt2->fmt.vbi.count[1];
fmt->flags = fmt2->fmt.vbi.flags & 0x03;
done:
kfree(fmt2);
return err;
}
fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL); static noinline int v4l1_compat_set_vbi_format(
if (!fmt2) { struct vbi_format *fmt,
err = -ENOMEM; struct inode *inode,
break; struct file *file,
} v4l2_kioctl drv)
fmt2->type = V4L2_BUF_TYPE_VBI_CAPTURE; {
fmt2->fmt.vbi.samples_per_line = fmt->samples_per_line; int err;
fmt2->fmt.vbi.sampling_rate = fmt->sampling_rate; struct v4l2_format *fmt2 = NULL;
fmt2->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
fmt2->fmt.vbi.start[0] = fmt->start[0];
fmt2->fmt.vbi.count[0] = fmt->count[0];
fmt2->fmt.vbi.start[1] = fmt->start[1];
fmt2->fmt.vbi.count[1] = fmt->count[1];
fmt2->fmt.vbi.flags = fmt->flags;
err = drv(inode, file, VIDIOC_TRY_FMT, fmt2);
if (err < 0) {
dprintk("VIDIOCSVBIFMT / VIDIOC_TRY_FMT: %d\n", err);
break;
}
if (fmt2->fmt.vbi.samples_per_line != fmt->samples_per_line || if (VIDEO_PALETTE_RAW != fmt->sample_format) {
fmt2->fmt.vbi.sampling_rate != fmt->sampling_rate || err = -EINVAL;
fmt2->fmt.vbi.sample_format != V4L2_PIX_FMT_GREY || return err;
fmt2->fmt.vbi.start[0] != fmt->start[0] || }
fmt2->fmt.vbi.count[0] != fmt->count[0] ||
fmt2->fmt.vbi.start[1] != fmt->start[1] || fmt2 = kzalloc(sizeof(*fmt2), GFP_KERNEL);
fmt2->fmt.vbi.count[1] != fmt->count[1] || if (!fmt2) {
fmt2->fmt.vbi.flags != fmt->flags) { err = -ENOMEM;
err = -EINVAL; return err;
break;
}
err = drv(inode, file, VIDIOC_S_FMT, fmt2);
if (err < 0)
dprintk("VIDIOCSVBIFMT / VIDIOC_S_FMT: %d\n", err);
break;
} }
fmt2->type = V4L2_BUF_TYPE_VBI_CAPTURE;
fmt2->fmt.vbi.samples_per_line = fmt->samples_per_line;
fmt2->fmt.vbi.sampling_rate = fmt->sampling_rate;
fmt2->fmt.vbi.sample_format = V4L2_PIX_FMT_GREY;
fmt2->fmt.vbi.start[0] = fmt->start[0];
fmt2->fmt.vbi.count[0] = fmt->count[0];
fmt2->fmt.vbi.start[1] = fmt->start[1];
fmt2->fmt.vbi.count[1] = fmt->count[1];
fmt2->fmt.vbi.flags = fmt->flags;
err = drv(inode, file, VIDIOC_TRY_FMT, fmt2);
if (err < 0) {
dprintk("VIDIOCSVBIFMT / VIDIOC_TRY_FMT: %d\n", err);
goto done;
}
if (fmt2->fmt.vbi.samples_per_line != fmt->samples_per_line ||
fmt2->fmt.vbi.sampling_rate != fmt->sampling_rate ||
fmt2->fmt.vbi.sample_format != V4L2_PIX_FMT_GREY ||
fmt2->fmt.vbi.start[0] != fmt->start[0] ||
fmt2->fmt.vbi.count[0] != fmt->count[0] ||
fmt2->fmt.vbi.start[1] != fmt->start[1] ||
fmt2->fmt.vbi.count[1] != fmt->count[1] ||
fmt2->fmt.vbi.flags != fmt->flags) {
err = -EINVAL;
goto done;
}
err = drv(inode, file, VIDIOC_S_FMT, fmt2);
if (err < 0)
dprintk("VIDIOCSVBIFMT / VIDIOC_S_FMT: %d\n", err);
done:
kfree(fmt2);
return err;
}
/*
* This function is exported.
*/
int
v4l_compat_translate_ioctl(struct inode *inode,
struct file *file,
int cmd,
void *arg,
v4l2_kioctl drv)
{
int err;
switch (cmd) {
case VIDIOCGCAP: /* capability */
err = v4l1_compat_get_capabilities(arg, inode, file, drv);
break;
case VIDIOCGFBUF: /* get frame buffer */
err = v4l1_compat_get_frame_buffer(arg, inode, file, drv);
break;
case VIDIOCSFBUF: /* set frame buffer */
err = v4l1_compat_set_frame_buffer(arg, inode, file, drv);
break;
case VIDIOCGWIN: /* get window or capture dimensions */
err = v4l1_compat_get_win_cap_dimensions(arg, inode, file, drv);
break;
case VIDIOCSWIN: /* set window and/or capture dimensions */
err = v4l1_compat_set_win_cap_dimensions(arg, inode, file, drv);
break;
case VIDIOCCAPTURE: /* turn on/off preview */
err = v4l1_compat_turn_preview_on_off(arg, inode, file, drv);
break;
case VIDIOCGCHAN: /* get input information */
err = v4l1_compat_get_input_info(arg, inode, file, drv);
break;
case VIDIOCSCHAN: /* set input */
err = v4l1_compat_set_input(arg, inode, file, drv);
break;
case VIDIOCGPICT: /* get tone controls & partial capture format */
err = v4l1_compat_get_picture(arg, inode, file, drv);
break;
case VIDIOCSPICT: /* set tone controls & partial capture format */
err = v4l1_compat_set_picture(arg, inode, file, drv);
break;
case VIDIOCGTUNER: /* get tuner information */
err = v4l1_compat_get_tuner(arg, inode, file, drv);
break;
case VIDIOCSTUNER: /* select a tuner input */
err = v4l1_compat_select_tuner(arg, inode, file, drv);
break;
case VIDIOCGFREQ: /* get frequency */
err = v4l1_compat_get_frequency(arg, inode, file, drv);
break;
case VIDIOCSFREQ: /* set frequency */
err = v4l1_compat_set_frequency(arg, inode, file, drv);
break;
case VIDIOCGAUDIO: /* get audio properties/controls */
err = v4l1_compat_get_audio(arg, inode, file, drv);
break;
case VIDIOCSAUDIO: /* set audio controls */
err = v4l1_compat_set_audio(arg, inode, file, drv);
break;
case VIDIOCMCAPTURE: /* capture a frame */
err = v4l1_compat_capture_frame(arg, inode, file, drv);
break;
case VIDIOCSYNC: /* wait for a frame */
err = v4l1_compat_sync(arg, inode, file, drv);
break;
case VIDIOCGVBIFMT: /* query VBI data capture format */
err = v4l1_compat_get_vbi_format(arg, inode, file, drv);
break;
case VIDIOCSVBIFMT:
err = v4l1_compat_set_vbi_format(arg, inode, file, drv);
break;
default: default:
err = -ENOIOCTLCMD; err = -ENOIOCTLCMD;
break; break;
} }
kfree(cap2);
kfree(fmt2);
return err; return err;
} }
EXPORT_SYMBOL(v4l_compat_translate_ioctl); EXPORT_SYMBOL(v4l_compat_translate_ioctl);
......
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
GitLab Nexedi Edition | About GitLab | About Nexedi | 沪ICP备2021021310号-2 | 沪ICP备2021021310号-7