| /* |
| * Copyright (c) 2014 Philippe De Muyter <phdm@macqel.be> |
| * Copyright (c) 2014 William Manley <will@williammanley.net> |
| * Copyright (c) 2011 Peter Zotov <whitequark@whitequark.org> |
| * All rights reserved. |
| * |
| * Redistribution and use in source and binary forms, with or without |
| * modification, are permitted provided that the following conditions |
| * are met: |
| * 1. Redistributions of source code must retain the above copyright |
| * notice, this list of conditions and the following disclaimer. |
| * 2. Redistributions in binary form must reproduce the above copyright |
| * notice, this list of conditions and the following disclaimer in the |
| * documentation and/or other materials provided with the distribution. |
| * 3. The name of the author may not be used to endorse or promote products |
| * derived from this software without specific prior written permission. |
| * |
| * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR |
| * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES |
| * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. |
| * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT, |
| * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT |
| * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, |
| * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY |
| * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF |
| * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| */ |
| |
| #include "defs.h" |
| |
| #include <stdint.h> |
| #include <sys/ioctl.h> |
| #include <linux/videodev2.h> |
| /* some historical constants */ |
| #ifndef V4L2_CID_HCENTER |
| #define V4L2_CID_HCENTER (V4L2_CID_BASE+22) |
| #endif |
| #ifndef V4L2_CID_VCENTER |
| #define V4L2_CID_VCENTER (V4L2_CID_BASE+23) |
| #endif |
| #ifndef V4L2_CID_BAND_STOP_FILTER |
| #define V4L2_CID_BAND_STOP_FILTER (V4L2_CID_BASE+33) |
| #endif |
| |
| #include "xlat/v4l2_device_capabilities_flags.h" |
| #include "xlat/v4l2_buf_types.h" |
| #include "xlat/v4l2_buf_flags.h" |
| #include "xlat/v4l2_framesize_types.h" |
| #include "xlat/v4l2_frameinterval_types.h" |
| #include "xlat/v4l2_fields.h" |
| #include "xlat/v4l2_colorspaces.h" |
| #include "xlat/v4l2_format_description_flags.h" |
| #include "xlat/v4l2_memories.h" |
| #include "xlat/v4l2_control_ids.h" |
| #include "xlat/v4l2_control_types.h" |
| #include "xlat/v4l2_control_flags.h" |
| #include "xlat/v4l2_control_classes.h" |
| #include "xlat/v4l2_streaming_capabilities.h" |
| #include "xlat/v4l2_capture_modes.h" |
| #include "xlat/v4l2_input_types.h" |
| |
| #define FMT_FRACT "%u/%u" |
| #define ARGS_FRACT(x) ((x).numerator), ((x).denominator) |
| |
| #define FMT_RECT "{left=%i, top=%i, width=%i, height=%i}" |
| #define ARGS_RECT(x) (x).left, (x).top, (x).width, (x).height |
| |
| static void print_pixelformat(uint32_t fourcc) |
| { |
| #if WORDS_BIGENDIAN |
| fourcc = htole32(fourcc); |
| #endif |
| tprintf("%.4s", (char*)&fourcc); |
| } |
| |
| static void print_v4l2_format_fmt(const struct v4l2_format *f) |
| { |
| tprints("fmt."); |
| switch (f->type) { |
| case V4L2_BUF_TYPE_VIDEO_CAPTURE: |
| case V4L2_BUF_TYPE_VIDEO_OUTPUT: { |
| const struct v4l2_pix_format *pix = &f->fmt.pix; |
| |
| tprintf("pix={width=%u, height=%u, pixelformat=", |
| pix->width, pix->height); |
| print_pixelformat(pix->pixelformat); |
| tprints(", field="); |
| printxval(v4l2_fields, pix->field, "V4L2_FIELD_???"); |
| tprintf(", bytesperline=%u, sizeimage=%u, colorspace=", |
| pix->bytesperline, pix->sizeimage); |
| printxval(v4l2_colorspaces, pix->colorspace, |
| "V4L2_COLORSPACE_???"); |
| tprints("}"); |
| break; |
| } |
| #if HAVE_DECL_V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE |
| case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE: |
| case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE: { |
| const struct v4l2_pix_format_mplane *pix_mp = &f->fmt.pix_mp; |
| unsigned int i, max; |
| |
| tprintf("pix_mp={width=%u, height=%u, pixelformat=", |
| pix_mp->width, pix_mp->height); |
| print_pixelformat(pix_mp->pixelformat); |
| tprints(", field="); |
| printxval(v4l2_fields, pix_mp->field, "V4L2_FIELD_???"); |
| tprints(", colorspace="); |
| printxval(v4l2_colorspaces, pix_mp->colorspace, |
| "V4L2_COLORSPACE_???"); |
| tprints("plane_fmt=["); |
| max = pix_mp->num_planes; |
| if (max > VIDEO_MAX_PLANES) |
| max = VIDEO_MAX_PLANES; |
| for (i = 0; i < max; i++) { |
| if (i > 0) |
| tprints(", "); |
| tprintf("{sizeimage=%u, bytesperline=%u}", |
| pix_mp->plane_fmt[i].sizeimage, |
| pix_mp->plane_fmt[i].bytesperline); |
| } |
| tprintf("], num_planes=%u}", (unsigned) pix_mp->num_planes); |
| break; |
| } |
| #endif |
| |
| /* TODO: Complete this switch statement */ |
| case V4L2_BUF_TYPE_VIDEO_OVERLAY: |
| case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY: |
| tprints("win={???}"); |
| break; |
| |
| case V4L2_BUF_TYPE_VBI_CAPTURE: |
| case V4L2_BUF_TYPE_VBI_OUTPUT: |
| tprints("vbi={???}"); |
| break; |
| |
| case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE: |
| case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT: |
| tprints("sliced={???}"); |
| break; |
| |
| default: |
| tprints("???"); |
| break; |
| } |
| } |
| |
| int |
| v4l2_ioctl(struct tcb *tcp, unsigned long code, long arg) |
| { |
| if (!verbose(tcp)) |
| return 0; |
| |
| switch (code) { |
| case VIDIOC_QUERYCAP: /* decode on exit */ { |
| struct v4l2_capability caps; |
| |
| if (entering(tcp) || syserror(tcp) || umove(tcp, arg, &caps) < 0) |
| return 0; |
| tprintf(", {driver=\"%s\", card=\"%s\", bus_info=\"%s\", " |
| "version=%u.%u.%u, capabilities=", caps.driver, caps.card, |
| caps.bus_info, (caps.version >> 16) & 0xFF, |
| (caps.version >> 8) & 0xFF, caps.version & 0xFF); |
| printflags(v4l2_device_capabilities_flags, caps.capabilities, |
| "V4L2_CAP_???"); |
| #ifdef V4L2_CAP_DEVICE_CAPS |
| tprints(", device_caps="); |
| printflags(v4l2_device_capabilities_flags, caps.device_caps, |
| "V4L2_CAP_???"); |
| #endif |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_ENUM_FRAMESIZES: /* decode on exit */ { |
| struct v4l2_frmsizeenum s; |
| |
| if (entering(tcp) || umove(tcp, arg, &s) < 0) |
| return 0; |
| tprintf(", {index=%u, pixel_format=", s.index); |
| print_pixelformat(s.pixel_format); |
| |
| if (!syserror(tcp)) { |
| tprints(", type="); |
| printxval(v4l2_framesize_types, s.type, "V4L2_FRMSIZE_TYPE_???"); |
| switch (s.type) { |
| case V4L2_FRMSIZE_TYPE_DISCRETE: |
| tprintf(", discrete={width=%u, height=%u}", |
| s.discrete.width, s.discrete.height); |
| break; |
| case V4L2_FRMSIZE_TYPE_STEPWISE: |
| tprintf(", stepwise={min_width=%u, max_width=%u, " |
| "step_width=%u, min_height=%u, max_height=%u, " |
| "step_height=%u}", |
| s.stepwise.min_width, s.stepwise.max_width, |
| s.stepwise.step_width, s.stepwise.min_height, |
| s.stepwise.max_height, s.stepwise.step_height); |
| break; |
| } |
| } |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_G_FMT: |
| case VIDIOC_S_FMT: |
| case VIDIOC_TRY_FMT: { |
| struct v4l2_format f; |
| |
| if (umove(tcp, arg, &f) < 0) |
| return 0; |
| if (entering(tcp)) { |
| tprints(", {type="); |
| printxval(v4l2_buf_types, f.type, "V4L2_BUF_TYPE_???"); |
| } |
| if ((entering(tcp) && code != VIDIOC_G_FMT) |
| || (exiting(tcp) && !syserror(tcp))) { |
| tprints(exiting(tcp) && code != VIDIOC_G_FMT ? " => " : ", "); |
| print_v4l2_format_fmt(&f); |
| } |
| if (exiting(tcp)) |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_ENUM_FMT: { |
| struct v4l2_fmtdesc f; |
| |
| if (entering(tcp) || umove(tcp, arg, &f) < 0) |
| return 0; |
| |
| tprintf(", {index=%u", f.index); |
| if (!syserror(tcp)) { |
| tprints(", type="); |
| printxval(v4l2_buf_types, f.type, "V4L2_BUF_TYPE_???"); |
| tprints(", flags="); |
| printflags(v4l2_format_description_flags, f.flags, |
| "V4L2_FMT_FLAG_???"); |
| tprintf(", description=\"%s\", pixelformat=", |
| f.description); |
| print_pixelformat(f.pixelformat); |
| } |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_G_PARM: |
| case VIDIOC_S_PARM: { |
| struct v4l2_streamparm s; |
| |
| if (entering(tcp) && code == VIDIOC_G_PARM) |
| return 1; |
| if (exiting(tcp) && syserror(tcp)) |
| return code == VIDIOC_S_PARM; |
| if (umove(tcp, arg, &s) < 0) |
| return 0; |
| if (entering(tcp)) { |
| tprints(", {type="); |
| printxval(v4l2_buf_types, s.type, "V4L2_BUF_TYPE_???"); |
| } |
| |
| tprints(exiting(tcp) && code == VIDIOC_S_PARM ? " => {" : ", {"); |
| if (s.type == V4L2_BUF_TYPE_VIDEO_CAPTURE) { |
| struct v4l2_captureparm *cap = &s.parm.capture; |
| |
| tprints("capability="); |
| printflags(v4l2_streaming_capabilities, |
| cap->capability, "V4L2_CAP_???"); |
| |
| tprints(", capturemode="); |
| printflags(v4l2_capture_modes, |
| cap->capturemode, "V4L2_MODE_???"); |
| |
| tprintf(", timeperframe=" FMT_FRACT, |
| ARGS_FRACT(cap->timeperframe)); |
| |
| tprintf(", extendedmode=%u, readbuffers=%u", |
| cap->extendedmode, |
| cap->readbuffers); |
| } else |
| tprints("..."); |
| tprints("}"); |
| if (exiting(tcp)) |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_QUERYCTRL: { |
| struct v4l2_queryctrl c; |
| |
| if (umove(tcp, arg, &c) < 0) |
| return 0; |
| /* 'id' field must be printed : |
| * on enter |
| * on exit if !syserror(tcp) && V4L2_CTRL_FLAG_NEXT_CTRL was set |
| */ |
| if (entering(tcp) |
| || (exiting(tcp) && tcp->auxstr && !syserror(tcp))) { |
| tprints(exiting(tcp) ? " => " : ", {id="); |
| tcp->auxstr = (c.id & V4L2_CTRL_FLAG_NEXT_CTRL) ? "" : NULL; |
| if (tcp->auxstr) { |
| tprints("V4L2_CTRL_FLAG_NEXT_CTRL|"); |
| c.id &= ~V4L2_CTRL_FLAG_NEXT_CTRL; |
| } |
| printxval(v4l2_control_ids, c.id, "V4L2_CID_???"); |
| } |
| if (exiting(tcp)) { |
| if (!syserror(tcp)) { |
| tprints(", type="); |
| printxval(v4l2_control_types, c.type, |
| "V4L2_CTRL_TYPE_???"); |
| tprintf(", name=\"%s\", minimum=%i, maximum=%i, step=%i, " |
| "default_value=%i, flags=", |
| c.name, c.minimum, c.maximum, |
| c.step, c.default_value); |
| printflags(v4l2_control_flags, c.flags, |
| "V4L2_CTRL_FLAG_???"); |
| } |
| tprints("}"); |
| } |
| return 1; |
| } |
| |
| case VIDIOC_G_CTRL: |
| case VIDIOC_S_CTRL: { |
| struct v4l2_control c; |
| |
| if (entering(tcp) || umove(tcp, arg, &c) < 0) |
| return 0; |
| tprints(", {id="); |
| printxval(v4l2_control_ids, c.id, "V4L2_CID_???"); |
| if (!syserror(tcp) || code != VIDIOC_G_CTRL) |
| tprintf(", value=%i", c.value); |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_S_EXT_CTRLS: |
| case VIDIOC_TRY_EXT_CTRLS: |
| case VIDIOC_G_EXT_CTRLS: { |
| struct v4l2_ext_controls c; |
| unsigned int n; |
| bool must_print_values; |
| |
| if (entering(tcp) && code == VIDIOC_G_EXT_CTRLS) |
| return 0; |
| if (exiting(tcp) && syserror(tcp) && code != VIDIOC_G_EXT_CTRLS) |
| return 0; |
| must_print_values = ((entering(tcp) && code != VIDIOC_G_EXT_CTRLS) |
| || (exiting(tcp) && !syserror(tcp))); |
| if (umove(tcp, arg, &c) < 0) |
| return 0; |
| tprints(code != VIDIOC_G_EXT_CTRLS && exiting(tcp) ? " => " : ", "); |
| tprints("{ctrl_class="); |
| printxval(v4l2_control_classes, c.ctrl_class, |
| "V4L2_CTRL_CLASS_???"); |
| tprintf(", count=%u", c.count); |
| if (exiting(tcp) && syserror(tcp)) |
| tprintf(", error_idx=%u", c.error_idx); |
| tprints(", controls=["); |
| for (n = 0; n < c.count; ++n) { |
| struct v4l2_ext_control ctrl; |
| |
| if (n > 0) |
| tprints(", "); |
| if (umove(tcp, (long) (c.controls + n), &ctrl) < 0) |
| break; |
| if (abbrev(tcp) && n == 2) { |
| tprints("..."); |
| break; |
| } |
| tprints("{id="); |
| printxval(v4l2_control_ids, ctrl.id, "V4L2_CID_???"); |
| #if HAVE_DECL_V4L2_CTRL_TYPE_STRING |
| tprintf(", size=%u", ctrl.size); |
| if (ctrl.size > 0) { |
| if (must_print_values) { |
| tprints(", string="); |
| printstr(tcp, (long) ctrl.string, ctrl.size); |
| } |
| } else |
| #endif |
| { |
| if (must_print_values) { |
| tprintf(", value=%i, value64=%lli", ctrl.value, |
| ctrl.value64); |
| } |
| } |
| tprints("}"); |
| } |
| tprints("]}"); |
| return 1; |
| } |
| |
| case VIDIOC_ENUMSTD: { |
| struct v4l2_standard s; |
| |
| if (umove(tcp, arg, &s) < 0) |
| return 0; |
| if (entering(tcp)) |
| tprintf(", {index=%i", s.index); |
| else { |
| if (!syserror(tcp)) { |
| tprintf(", name=\"%s\"", s.name); |
| tprintf(", frameperiod=" FMT_FRACT, ARGS_FRACT(s.frameperiod)); |
| tprintf(", framelines=%i", s.framelines); |
| } |
| tprints("}"); |
| } |
| return 1; |
| } |
| |
| case VIDIOC_G_STD: |
| case VIDIOC_S_STD: { |
| v4l2_std_id s; |
| |
| if (code == VIDIOC_G_STD && exiting(tcp) && syserror(tcp)) |
| return 0; |
| if (umove(tcp, arg, &s) < 0) |
| return 0; |
| if ((code == VIDIOC_S_STD) == entering(tcp)) |
| tprintf(", std=%#llx", s); |
| return 1; |
| } |
| |
| case VIDIOC_ENUMINPUT: { |
| struct v4l2_input i; |
| |
| if (entering(tcp) || umove(tcp, arg, &i) < 0) |
| return 0; |
| tprintf(", {index=%i", i.index); |
| if (!syserror(tcp)) { |
| tprintf(", name=\"%s\", type=", i.name); |
| printxval(v4l2_input_types, i.type, |
| "V4L2_INPUT_TYPE_???"); |
| } |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_G_INPUT: |
| case VIDIOC_S_INPUT: { |
| int index; |
| |
| if (entering(tcp) || syserror(tcp) || umove(tcp, arg, &index) < 0) |
| return 0; |
| |
| tprintf(", index=%i", index); |
| return 1; |
| } |
| |
| case VIDIOC_ENUM_FRAMEINTERVALS: { |
| struct v4l2_frmivalenum f; |
| |
| if (entering(tcp) || umove(tcp, arg, &f) < 0) |
| return 0; |
| tprintf(", {index=%i, pixel_format=", f.index); |
| print_pixelformat(f.pixel_format); |
| tprintf(", width=%u, height=%u", f.width, f.height); |
| if (!syserror(tcp)) { |
| tprints(", type="); |
| printxval(v4l2_frameinterval_types, f.type, |
| "V4L2_FRMIVAL_TYPE_???"); |
| switch (f.type) { |
| case V4L2_FRMIVAL_TYPE_DISCRETE: |
| tprintf(", discrete=" FMT_FRACT, |
| ARGS_FRACT(f.discrete)); |
| break; |
| case V4L2_FRMIVAL_TYPE_STEPWISE: |
| case V4L2_FRMSIZE_TYPE_CONTINUOUS: |
| tprintf(", stepwise={min=" FMT_FRACT ", max=" |
| FMT_FRACT ", step=" FMT_FRACT "}", |
| ARGS_FRACT(f.stepwise.min), |
| ARGS_FRACT(f.stepwise.max), |
| ARGS_FRACT(f.stepwise.step)); |
| break; |
| } |
| } |
| tprints("}"); |
| return 1; |
| } |
| |
| case VIDIOC_CROPCAP: { |
| struct v4l2_cropcap c; |
| |
| if (entering(tcp) || umove(tcp, arg, &c) < 0) |
| return 0; |
| tprints(", type="); |
| printxval(v4l2_buf_types, c.type, "V4L2_BUF_TYPE_???"); |
| if (syserror(tcp)) |
| return 1; |
| tprintf(", bounds=" FMT_RECT ", defrect=" FMT_RECT ", " |
| "pixelaspect=" FMT_FRACT, ARGS_RECT(c.bounds), |
| ARGS_RECT(c.defrect), ARGS_FRACT(c.pixelaspect)); |
| return 1; |
| } |
| |
| case VIDIOC_G_FBUF: |
| case VIDIOC_S_FBUF: { |
| struct v4l2_framebuffer b; |
| |
| if (syserror(tcp) && code == VIDIOC_G_FBUF) |
| return 0; |
| if (entering(tcp) || umove(tcp, arg, &b) < 0) |
| return 0; |
| tprintf(", {capability=%x, flags=%x, base=%p}", |
| b.capability, b.flags, b.base); |
| return 1; |
| } |
| |
| case VIDIOC_REQBUFS: { |
| struct v4l2_requestbuffers reqbufs; |
| |
| if (umove(tcp, arg, &reqbufs) < 0) |
| return 0; |
| if (entering(tcp)) { |
| tprintf(", {count=%u, type=", reqbufs.count); |
| printxval(v4l2_buf_types, reqbufs.type, "V4L2_BUF_TYPE_???"); |
| tprints(", memory="); |
| printxval(v4l2_memories, reqbufs.memory, "V4L2_MEMORY_???"); |
| tprints("}"); |
| return 1; |
| } else if (syserror(tcp)) |
| return 1; |
| else { |
| static char outstr[sizeof("{count=}") + sizeof(int) * 3]; |
| |
| sprintf(outstr, "{count=%u}", reqbufs.count); |
| tcp->auxstr = outstr; |
| return 1 + RVAL_STR; |
| } |
| } |
| |
| case VIDIOC_QUERYBUF: |
| case VIDIOC_QBUF: |
| case VIDIOC_DQBUF: { |
| struct v4l2_buffer b; |
| |
| if (umove(tcp, arg, &b) < 0) |
| return 0; |
| if (entering(tcp)) { |
| tprints(", {type="); |
| printxval(v4l2_buf_types, b.type, "V4L2_BUF_TYPE_???"); |
| if (code != VIDIOC_DQBUF) |
| tprintf(", index=%u", b.index); |
| } else { |
| if (!syserror(tcp)) { |
| if (code == VIDIOC_DQBUF) |
| tprintf(", index=%u", b.index); |
| tprints(", memory="); |
| printxval(v4l2_memories, b.memory, "V4L2_MEMORY_???"); |
| |
| if (b.memory == V4L2_MEMORY_MMAP) { |
| tprintf(", m.offset=%#x", b.m.offset); |
| } else if (b.memory == V4L2_MEMORY_USERPTR) { |
| tprintf(", m.userptr=%#lx", b.m.userptr); |
| } |
| |
| tprintf(", length=%u, bytesused=%u, flags=", |
| b.length, b.bytesused); |
| printflags(v4l2_buf_flags, b.flags, "V4L2_BUF_FLAG_???"); |
| if (code == VIDIOC_DQBUF) |
| tprintf(", timestamp = {%lu.%06lu}", |
| b.timestamp.tv_sec, |
| b.timestamp.tv_usec); |
| tprints(", ..."); |
| } |
| tprints("}"); |
| } |
| return 1; |
| } |
| |
| case VIDIOC_STREAMON: |
| case VIDIOC_STREAMOFF: { |
| int type; |
| |
| if (umove(tcp, arg, &type) < 0) |
| return 0; |
| if (entering(tcp)) { |
| tprints(", "); |
| printxval(v4l2_buf_types, type, "V4L2_BUF_TYPE_???"); |
| } |
| return 1; |
| } |
| |
| default: /* decode on exit */ |
| return 0; |
| } |
| } |