mirror of
https://gitlab.freedesktop.org/gstreamer/gstreamer.git
synced 2024-12-24 01:00:37 +00:00
5a9c0aa9f5
This fixes regression where M2M error out saying they have no output format (the V4L2 CAPTURE side). https://bugzilla.gnome.org/show_bug.cgi?id=768195
1134 lines
34 KiB
C
1134 lines
34 KiB
C
/* GStreamer
|
|
*
|
|
* Copyright (C) 2002 Ronald Bultje <rbultje@ronald.bitfreak.net>
|
|
* 2006 Edgard Lima <edgard.lima@indt.org.br>
|
|
*
|
|
* v4l2_calls.c - generic V4L2 calls handling
|
|
*
|
|
* This library is free software; you can redistribute it and/or
|
|
* modify it under the terms of the GNU Library General Public
|
|
* License as published by the Free Software Foundation; either
|
|
* version 2 of the License, or (at your option) any later version.
|
|
*
|
|
* This library is distributed in the hope that it will be useful,
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
* Library General Public License for more details.
|
|
*
|
|
* You should have received a copy of the GNU Library General Public
|
|
* License along with this library; if not, write to the
|
|
* Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
|
|
* Boston, MA 02110-1301, USA.
|
|
*/
|
|
|
|
#ifdef HAVE_CONFIG_H
|
|
#include <config.h>
|
|
#endif
|
|
|
|
#include <sys/types.h>
|
|
#include <sys/stat.h>
|
|
#include <fcntl.h>
|
|
#include <sys/ioctl.h>
|
|
#include <sys/mman.h>
|
|
#include <string.h>
|
|
#include <errno.h>
|
|
#include <unistd.h>
|
|
#ifdef __sun
|
|
/* Needed on older Solaris Nevada builds (72 at least) */
|
|
#include <stropts.h>
|
|
#include <sys/ioccom.h>
|
|
#endif
|
|
#include "v4l2_calls.h"
|
|
#include "gstv4l2tuner.h"
|
|
#if 0
|
|
#include "gstv4l2xoverlay.h"
|
|
#endif
|
|
#include "gstv4l2colorbalance.h"
|
|
|
|
#include "gstv4l2src.h"
|
|
#include "gstv4l2sink.h"
|
|
#include "gstv4l2videodec.h"
|
|
|
|
#include "gst/gst-i18n-plugin.h"
|
|
|
|
GST_DEBUG_CATEGORY_EXTERN (v4l2_debug);
|
|
#define GST_CAT_DEFAULT v4l2_debug
|
|
|
|
/******************************************************
|
|
* gst_v4l2_get_capabilities():
|
|
* get the device's capturing capabilities
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_get_capabilities (GstV4l2Object * v4l2object)
|
|
{
|
|
GstElement *e;
|
|
|
|
e = v4l2object->element;
|
|
|
|
GST_DEBUG_OBJECT (e, "getting capabilities");
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_QUERYCAP, &v4l2object->vcap) < 0)
|
|
goto cap_failed;
|
|
|
|
if (v4l2object->vcap.capabilities & V4L2_CAP_DEVICE_CAPS)
|
|
v4l2object->device_caps = v4l2object->vcap.device_caps;
|
|
else
|
|
v4l2object->device_caps = v4l2object->vcap.capabilities;
|
|
|
|
GST_LOG_OBJECT (e, "driver: '%s'", v4l2object->vcap.driver);
|
|
GST_LOG_OBJECT (e, "card: '%s'", v4l2object->vcap.card);
|
|
GST_LOG_OBJECT (e, "bus_info: '%s'", v4l2object->vcap.bus_info);
|
|
GST_LOG_OBJECT (e, "version: %08x", v4l2object->vcap.version);
|
|
GST_LOG_OBJECT (e, "capabilites: %08x", v4l2object->device_caps);
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
cap_failed:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Error getting capabilities for device '%s': "
|
|
"It isn't a v4l2 driver. Check if it is a v4l1 driver."),
|
|
v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
/******************************************************
|
|
* The video4linux command line tool v4l2-ctrl
|
|
* normalises the names of the controls received from
|
|
* the kernel like:
|
|
*
|
|
* "Exposure (absolute)" -> "exposure_absolute"
|
|
*
|
|
* We follow their lead here. @name is modified
|
|
* in-place.
|
|
******************************************************/
|
|
static void
|
|
gst_v4l2_normalise_control_name (gchar * name)
|
|
{
|
|
int i, j;
|
|
for (i = 0, j = 0; name[j]; ++j) {
|
|
if (g_ascii_isalnum (name[j])) {
|
|
if (i > 0 && !g_ascii_isalnum (name[j - 1]))
|
|
name[i++] = '_';
|
|
name[i++] = g_ascii_tolower (name[j]);
|
|
}
|
|
}
|
|
name[i++] = '\0';
|
|
}
|
|
|
|
/******************************************************
|
|
* gst_v4l2_empty_lists() and gst_v4l2_fill_lists():
|
|
* fill/empty the lists of enumerations
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
static gboolean
|
|
gst_v4l2_fill_lists (GstV4l2Object * v4l2object)
|
|
{
|
|
gint n, next;
|
|
struct v4l2_queryctrl control = { 0, };
|
|
|
|
GstElement *e;
|
|
|
|
e = v4l2object->element;
|
|
|
|
GST_DEBUG_OBJECT (e, "getting enumerations");
|
|
GST_V4L2_CHECK_OPEN (v4l2object);
|
|
|
|
GST_DEBUG_OBJECT (e, " channels");
|
|
/* and now, the channels */
|
|
for (n = 0;; n++) {
|
|
struct v4l2_input input;
|
|
GstV4l2TunerChannel *v4l2channel;
|
|
GstTunerChannel *channel;
|
|
|
|
memset (&input, 0, sizeof (input));
|
|
|
|
input.index = n;
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_ENUMINPUT, &input) < 0) {
|
|
if (errno == EINVAL || errno == ENOTTY)
|
|
break; /* end of enumeration */
|
|
else {
|
|
GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
|
|
(_("Failed to query attributes of input %d in device %s"),
|
|
n, v4l2object->videodev),
|
|
("Failed to get %d in input enumeration for %s. (%d - %s)",
|
|
n, v4l2object->videodev, errno, strerror (errno)));
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
GST_LOG_OBJECT (e, " index: %d", input.index);
|
|
GST_LOG_OBJECT (e, " name: '%s'", input.name);
|
|
GST_LOG_OBJECT (e, " type: %08x", input.type);
|
|
GST_LOG_OBJECT (e, " audioset: %08x", input.audioset);
|
|
GST_LOG_OBJECT (e, " std: %016" G_GINT64_MODIFIER "x",
|
|
(guint64) input.std);
|
|
GST_LOG_OBJECT (e, " status: %08x", input.status);
|
|
|
|
v4l2channel = g_object_new (GST_TYPE_V4L2_TUNER_CHANNEL, NULL);
|
|
channel = GST_TUNER_CHANNEL (v4l2channel);
|
|
channel->label = g_strdup ((const gchar *) input.name);
|
|
channel->flags = GST_TUNER_CHANNEL_INPUT;
|
|
v4l2channel->index = n;
|
|
|
|
if (input.type == V4L2_INPUT_TYPE_TUNER) {
|
|
struct v4l2_tuner vtun;
|
|
|
|
v4l2channel->tuner = input.tuner;
|
|
channel->flags |= GST_TUNER_CHANNEL_FREQUENCY;
|
|
|
|
vtun.index = input.tuner;
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_TUNER, &vtun) < 0) {
|
|
GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
|
|
(_("Failed to get setting of tuner %d on device '%s'."),
|
|
input.tuner, v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
g_object_unref (G_OBJECT (channel));
|
|
return FALSE;
|
|
}
|
|
|
|
channel->freq_multiplicator =
|
|
62.5 * ((vtun.capability & V4L2_TUNER_CAP_LOW) ? 1 : 1000);
|
|
channel->min_frequency = vtun.rangelow * channel->freq_multiplicator;
|
|
channel->max_frequency = vtun.rangehigh * channel->freq_multiplicator;
|
|
channel->min_signal = 0;
|
|
channel->max_signal = 0xffff;
|
|
}
|
|
if (input.audioset) {
|
|
/* we take the first. We don't care for
|
|
* the others for now */
|
|
while (!(input.audioset & (1 << v4l2channel->audio)))
|
|
v4l2channel->audio++;
|
|
channel->flags |= GST_TUNER_CHANNEL_AUDIO;
|
|
}
|
|
|
|
v4l2object->channels =
|
|
g_list_prepend (v4l2object->channels, (gpointer) channel);
|
|
}
|
|
v4l2object->channels = g_list_reverse (v4l2object->channels);
|
|
|
|
GST_DEBUG_OBJECT (e, " norms");
|
|
/* norms... */
|
|
for (n = 0;; n++) {
|
|
struct v4l2_standard standard = { 0, };
|
|
GstV4l2TunerNorm *v4l2norm;
|
|
|
|
GstTunerNorm *norm;
|
|
|
|
/* fill in defaults */
|
|
standard.frameperiod.numerator = 1;
|
|
standard.frameperiod.denominator = 0;
|
|
standard.index = n;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_ENUMSTD, &standard) < 0) {
|
|
if (errno == EINVAL || errno == ENOTTY)
|
|
break; /* end of enumeration */
|
|
#ifdef ENODATA
|
|
else if (errno == ENODATA)
|
|
break; /* end of enumeration, as of Linux 3.7-rc1 */
|
|
#endif
|
|
else {
|
|
GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
|
|
(_("Failed to query norm on device '%s'."),
|
|
v4l2object->videodev),
|
|
("Failed to get attributes for norm %d on devide '%s'. (%d - %s)",
|
|
n, v4l2object->videodev, errno, strerror (errno)));
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
GST_DEBUG_OBJECT (e, " '%s', fps: %d / %d",
|
|
standard.name, standard.frameperiod.denominator,
|
|
standard.frameperiod.numerator);
|
|
|
|
v4l2norm = g_object_new (GST_TYPE_V4L2_TUNER_NORM, NULL);
|
|
norm = GST_TUNER_NORM (v4l2norm);
|
|
norm->label = g_strdup ((const gchar *) standard.name);
|
|
gst_value_set_fraction (&norm->framerate,
|
|
standard.frameperiod.denominator, standard.frameperiod.numerator);
|
|
v4l2norm->index = standard.id;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "index=%08x, label=%s",
|
|
(unsigned int) v4l2norm->index, norm->label);
|
|
|
|
v4l2object->norms = g_list_prepend (v4l2object->norms, (gpointer) norm);
|
|
}
|
|
v4l2object->norms = g_list_reverse (v4l2object->norms);
|
|
|
|
GST_DEBUG_OBJECT (e, " controls+menus");
|
|
|
|
/* and lastly, controls+menus (if appropriate) */
|
|
next = V4L2_CTRL_FLAG_NEXT_CTRL;
|
|
n = 0;
|
|
control.id = next;
|
|
|
|
while (TRUE) {
|
|
GstV4l2ColorBalanceChannel *v4l2channel;
|
|
GstColorBalanceChannel *channel;
|
|
|
|
if (!next)
|
|
n++;
|
|
|
|
retry:
|
|
/* when we reached the last official CID, continue with private CIDs */
|
|
if (n == V4L2_CID_LASTP1) {
|
|
GST_DEBUG_OBJECT (e, "checking private CIDs");
|
|
n = V4L2_CID_PRIVATE_BASE;
|
|
}
|
|
GST_DEBUG_OBJECT (e, "checking control %08x", n);
|
|
|
|
control.id = n | next;
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_QUERYCTRL, &control) < 0) {
|
|
if (next) {
|
|
if (n > 0) {
|
|
GST_DEBUG_OBJECT (e, "controls finished");
|
|
break;
|
|
} else {
|
|
GST_DEBUG_OBJECT (e, "V4L2_CTRL_FLAG_NEXT_CTRL not supported.");
|
|
next = 0;
|
|
n = V4L2_CID_BASE;
|
|
goto retry;
|
|
}
|
|
}
|
|
if (errno == EINVAL || errno == ENOTTY || errno == EIO || errno == ENOENT) {
|
|
if (n < V4L2_CID_PRIVATE_BASE) {
|
|
GST_DEBUG_OBJECT (e, "skipping control %08x", n);
|
|
/* continue so that we also check private controls */
|
|
n = V4L2_CID_PRIVATE_BASE - 1;
|
|
continue;
|
|
} else {
|
|
GST_DEBUG_OBJECT (e, "controls finished");
|
|
break;
|
|
}
|
|
} else {
|
|
GST_WARNING_OBJECT (e, "Failed querying control %d on device '%s'. "
|
|
"(%d - %s)", n, v4l2object->videodev, errno, strerror (errno));
|
|
continue;
|
|
}
|
|
}
|
|
/* bogus driver might mess with id in unexpected ways (e.g. set to 0), so
|
|
* make sure to simply try all if V4L2_CTRL_FLAG_NEXT_CTRL not supported */
|
|
if (next)
|
|
n = control.id;
|
|
if (control.flags & V4L2_CTRL_FLAG_DISABLED) {
|
|
GST_DEBUG_OBJECT (e, "skipping disabled control");
|
|
continue;
|
|
}
|
|
|
|
if (control.type == V4L2_CTRL_TYPE_CTRL_CLASS) {
|
|
GST_DEBUG_OBJECT (e, "starting control class '%s'", control.name);
|
|
continue;
|
|
}
|
|
|
|
switch (control.type) {
|
|
case V4L2_CTRL_TYPE_INTEGER:
|
|
case V4L2_CTRL_TYPE_BOOLEAN:
|
|
case V4L2_CTRL_TYPE_MENU:
|
|
case V4L2_CTRL_TYPE_INTEGER_MENU:
|
|
case V4L2_CTRL_TYPE_BITMASK:
|
|
case V4L2_CTRL_TYPE_BUTTON:{
|
|
control.name[31] = '\0';
|
|
gst_v4l2_normalise_control_name ((gchar *) control.name);
|
|
g_datalist_id_set_data (&v4l2object->controls,
|
|
g_quark_from_string ((const gchar *) control.name),
|
|
GINT_TO_POINTER (n));
|
|
break;
|
|
}
|
|
default:
|
|
GST_DEBUG_OBJECT (e,
|
|
"Control type for '%s' not suppored for extra controls.",
|
|
control.name);
|
|
break;
|
|
}
|
|
|
|
switch (n) {
|
|
case V4L2_CID_BRIGHTNESS:
|
|
case V4L2_CID_CONTRAST:
|
|
case V4L2_CID_SATURATION:
|
|
case V4L2_CID_HUE:
|
|
case V4L2_CID_BLACK_LEVEL:
|
|
case V4L2_CID_AUTO_WHITE_BALANCE:
|
|
case V4L2_CID_DO_WHITE_BALANCE:
|
|
case V4L2_CID_RED_BALANCE:
|
|
case V4L2_CID_BLUE_BALANCE:
|
|
case V4L2_CID_GAMMA:
|
|
case V4L2_CID_EXPOSURE:
|
|
case V4L2_CID_AUTOGAIN:
|
|
case V4L2_CID_GAIN:
|
|
case V4L2_CID_SHARPNESS:
|
|
/* we only handle these for now (why?) */
|
|
break;
|
|
case V4L2_CID_HFLIP:
|
|
case V4L2_CID_VFLIP:
|
|
case V4L2_CID_PAN_RESET:
|
|
case V4L2_CID_TILT_RESET:
|
|
/* not handled here, handled by VideoOrientation interface */
|
|
control.id++;
|
|
break;
|
|
case V4L2_CID_AUDIO_VOLUME:
|
|
case V4L2_CID_AUDIO_BALANCE:
|
|
case V4L2_CID_AUDIO_BASS:
|
|
case V4L2_CID_AUDIO_TREBLE:
|
|
case V4L2_CID_AUDIO_MUTE:
|
|
case V4L2_CID_AUDIO_LOUDNESS:
|
|
/* FIXME: We should implement GstMixer interface instead */
|
|
/* but let's not be pedantic and make element more useful for now */
|
|
break;
|
|
case V4L2_CID_ALPHA_COMPONENT:
|
|
v4l2object->has_alpha_component = TRUE;
|
|
break;
|
|
default:
|
|
GST_DEBUG_OBJECT (e,
|
|
"ControlID %s (%x) unhandled, FIXME", control.name, n);
|
|
control.id++;
|
|
break;
|
|
}
|
|
if (n != control.id)
|
|
continue;
|
|
|
|
GST_DEBUG_OBJECT (e, "Adding ControlID %s (%x)", control.name, n);
|
|
v4l2channel = g_object_new (GST_TYPE_V4L2_COLOR_BALANCE_CHANNEL, NULL);
|
|
channel = GST_COLOR_BALANCE_CHANNEL (v4l2channel);
|
|
channel->label = g_strdup ((const gchar *) control.name);
|
|
v4l2channel->id = n;
|
|
|
|
#if 0
|
|
/* FIXME: it will be need just when handling private controls
|
|
*(currently none of base controls are of this type) */
|
|
if (control.type == V4L2_CTRL_TYPE_MENU) {
|
|
struct v4l2_querymenu menu, *mptr;
|
|
|
|
int i;
|
|
|
|
menu.id = n;
|
|
for (i = 0;; i++) {
|
|
menu.index = i;
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_QUERYMENU, &menu) < 0) {
|
|
if (errno == EINVAL)
|
|
break; /* end of enumeration */
|
|
else {
|
|
GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
|
|
(_("Failed getting controls attributes on device '%s'."),
|
|
v4l2object->videodev),
|
|
("Failed to get %d in menu enumeration for %s. (%d - %s)",
|
|
n, v4l2object->videodev, errno, strerror (errno)));
|
|
return FALSE;
|
|
}
|
|
}
|
|
mptr = g_malloc (sizeof (menu));
|
|
memcpy (mptr, &menu, sizeof (menu));
|
|
menus = g_list_append (menus, mptr);
|
|
}
|
|
}
|
|
v4l2object->menus = g_list_append (v4l2object->menus, menus);
|
|
#endif
|
|
|
|
switch (control.type) {
|
|
case V4L2_CTRL_TYPE_INTEGER:
|
|
channel->min_value = control.minimum;
|
|
channel->max_value = control.maximum;
|
|
break;
|
|
case V4L2_CTRL_TYPE_BOOLEAN:
|
|
channel->min_value = FALSE;
|
|
channel->max_value = TRUE;
|
|
break;
|
|
default:
|
|
/* FIXME we should find out how to handle V4L2_CTRL_TYPE_BUTTON.
|
|
BUTTON controls like V4L2_CID_DO_WHITE_BALANCE can just be set (1) or
|
|
unset (0), but can't be queried */
|
|
GST_DEBUG_OBJECT (e,
|
|
"Control with non supported type %s (%x), type=%d",
|
|
control.name, n, control.type);
|
|
channel->min_value = channel->max_value = 0;
|
|
break;
|
|
}
|
|
|
|
v4l2object->colors =
|
|
g_list_prepend (v4l2object->colors, (gpointer) channel);
|
|
}
|
|
v4l2object->colors = g_list_reverse (v4l2object->colors);
|
|
|
|
GST_DEBUG_OBJECT (e, "done");
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
static void
|
|
gst_v4l2_empty_lists (GstV4l2Object * v4l2object)
|
|
{
|
|
GST_DEBUG_OBJECT (v4l2object->element, "deleting enumerations");
|
|
|
|
g_list_foreach (v4l2object->channels, (GFunc) g_object_unref, NULL);
|
|
g_list_free (v4l2object->channels);
|
|
v4l2object->channels = NULL;
|
|
|
|
g_list_foreach (v4l2object->norms, (GFunc) g_object_unref, NULL);
|
|
g_list_free (v4l2object->norms);
|
|
v4l2object->norms = NULL;
|
|
|
|
g_list_foreach (v4l2object->colors, (GFunc) g_object_unref, NULL);
|
|
g_list_free (v4l2object->colors);
|
|
v4l2object->colors = NULL;
|
|
|
|
g_datalist_clear (&v4l2object->controls);
|
|
}
|
|
|
|
static void
|
|
gst_v4l2_adjust_buf_type (GstV4l2Object * v4l2object)
|
|
{
|
|
/* when calling gst_v4l2_object_new the user decides the initial type
|
|
* so adjust it if multi-planar is supported
|
|
* the driver should make it exclusive. So the driver should
|
|
* not support both MPLANE and non-PLANE.
|
|
* Because even when using MPLANE it still possibles to use it
|
|
* in a contiguous manner. In this case the first v4l2 plane
|
|
* contains all the gst planes.
|
|
*/
|
|
switch (v4l2object->type) {
|
|
case V4L2_BUF_TYPE_VIDEO_OUTPUT:
|
|
if (v4l2object->device_caps &
|
|
(V4L2_CAP_VIDEO_OUTPUT_MPLANE | V4L2_CAP_VIDEO_M2M_MPLANE)) {
|
|
GST_DEBUG ("adjust type to multi-planar output");
|
|
v4l2object->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
|
|
}
|
|
break;
|
|
case V4L2_BUF_TYPE_VIDEO_CAPTURE:
|
|
if (v4l2object->device_caps &
|
|
(V4L2_CAP_VIDEO_CAPTURE_MPLANE | V4L2_CAP_VIDEO_M2M_MPLANE)) {
|
|
GST_DEBUG ("adjust type to multi-planar capture");
|
|
v4l2object->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
|
|
}
|
|
break;
|
|
default:
|
|
break;
|
|
}
|
|
}
|
|
|
|
/******************************************************
|
|
* gst_v4l2_open():
|
|
* open the video device (v4l2object->videodev)
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_open (GstV4l2Object * v4l2object)
|
|
{
|
|
struct stat st;
|
|
int libv4l2_fd;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "Trying to open device %s",
|
|
v4l2object->videodev);
|
|
|
|
GST_V4L2_CHECK_NOT_OPEN (v4l2object);
|
|
GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
|
|
|
|
/* be sure we have a device */
|
|
if (!v4l2object->videodev)
|
|
v4l2object->videodev = g_strdup ("/dev/video");
|
|
|
|
/* check if it is a device */
|
|
if (stat (v4l2object->videodev, &st) == -1)
|
|
goto stat_failed;
|
|
|
|
if (!S_ISCHR (st.st_mode))
|
|
goto no_device;
|
|
|
|
/* open the device */
|
|
v4l2object->video_fd =
|
|
open (v4l2object->videodev, O_RDWR /* | O_NONBLOCK */ );
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
goto not_open;
|
|
|
|
libv4l2_fd = v4l2_fd_open (v4l2object->video_fd,
|
|
V4L2_ENABLE_ENUM_FMT_EMULATION);
|
|
/* Note the v4l2_xxx functions are designed so that if they get passed an
|
|
unknown fd, the will behave exactly as their regular xxx counterparts, so
|
|
if v4l2_fd_open fails, we continue as normal (missing the libv4l2 custom
|
|
cam format to normal formats conversion). Chances are big we will still
|
|
fail then though, as normally v4l2_fd_open only fails if the device is not
|
|
a v4l2 device. */
|
|
if (libv4l2_fd != -1)
|
|
v4l2object->video_fd = libv4l2_fd;
|
|
|
|
/* get capabilities, error will be posted */
|
|
if (!gst_v4l2_get_capabilities (v4l2object))
|
|
goto error;
|
|
|
|
/* do we need to be a capture device? */
|
|
if (GST_IS_V4L2SRC (v4l2object->element) &&
|
|
!(v4l2object->device_caps & (V4L2_CAP_VIDEO_CAPTURE |
|
|
V4L2_CAP_VIDEO_CAPTURE_MPLANE)))
|
|
goto not_capture;
|
|
|
|
if (GST_IS_V4L2SINK (v4l2object->element) &&
|
|
!(v4l2object->device_caps & (V4L2_CAP_VIDEO_OUTPUT |
|
|
V4L2_CAP_VIDEO_OUTPUT_MPLANE)))
|
|
goto not_output;
|
|
|
|
if (GST_IS_V4L2_VIDEO_DEC (v4l2object->element) &&
|
|
/* Today's M2M device only expose M2M */
|
|
!((v4l2object->device_caps & (V4L2_CAP_VIDEO_M2M |
|
|
V4L2_CAP_VIDEO_M2M_MPLANE)) ||
|
|
/* But legacy driver may expose both CAPTURE and OUTPUT */
|
|
((v4l2object->device_caps &
|
|
(V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_VIDEO_CAPTURE_MPLANE)) &&
|
|
(v4l2object->device_caps &
|
|
(V4L2_CAP_VIDEO_OUTPUT | V4L2_CAP_VIDEO_OUTPUT_MPLANE)))))
|
|
goto not_m2m;
|
|
|
|
gst_v4l2_adjust_buf_type (v4l2object);
|
|
|
|
/* create enumerations, posts errors. */
|
|
if (!gst_v4l2_fill_lists (v4l2object))
|
|
goto error;
|
|
|
|
GST_INFO_OBJECT (v4l2object->element,
|
|
"Opened device '%s' (%s) successfully",
|
|
v4l2object->vcap.card, v4l2object->videodev);
|
|
|
|
if (v4l2object->extra_controls)
|
|
gst_v4l2_set_controls (v4l2object, v4l2object->extra_controls);
|
|
|
|
/* UVC devices are never interlaced, and doing VIDIOC_TRY_FMT on them
|
|
* causes expensive and slow USB IO, so don't probe them for interlaced
|
|
*/
|
|
if (!strcmp ((char *) v4l2object->vcap.driver, "uvcusb")) {
|
|
v4l2object->never_interlaced = TRUE;
|
|
}
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
stat_failed:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
|
|
(_("Cannot identify device '%s'."), v4l2object->videodev),
|
|
GST_ERROR_SYSTEM);
|
|
goto error;
|
|
}
|
|
no_device:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
|
|
(_("This isn't a device '%s'."), v4l2object->videodev),
|
|
GST_ERROR_SYSTEM);
|
|
goto error;
|
|
}
|
|
not_open:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ_WRITE,
|
|
(_("Could not open device '%s' for reading and writing."),
|
|
v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
goto error;
|
|
}
|
|
not_capture:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
|
|
(_("Device '%s' is not a capture device."),
|
|
v4l2object->videodev),
|
|
("Capabilities: 0x%x", v4l2object->device_caps));
|
|
goto error;
|
|
}
|
|
not_output:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
|
|
(_("Device '%s' is not a output device."),
|
|
v4l2object->videodev),
|
|
("Capabilities: 0x%x", v4l2object->device_caps));
|
|
goto error;
|
|
}
|
|
not_m2m:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
|
|
(_("Device '%s' is not a M2M device."),
|
|
v4l2object->videodev),
|
|
("Capabilities: 0x%x", v4l2object->device_caps));
|
|
goto error;
|
|
}
|
|
error:
|
|
{
|
|
if (GST_V4L2_IS_OPEN (v4l2object)) {
|
|
/* close device */
|
|
v4l2_close (v4l2object->video_fd);
|
|
v4l2object->video_fd = -1;
|
|
}
|
|
/* empty lists */
|
|
gst_v4l2_empty_lists (v4l2object);
|
|
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_dup (GstV4l2Object * v4l2object, GstV4l2Object * other)
|
|
{
|
|
GST_DEBUG_OBJECT (v4l2object->element, "Trying to dup device %s",
|
|
other->videodev);
|
|
|
|
GST_V4L2_CHECK_OPEN (other);
|
|
GST_V4L2_CHECK_NOT_OPEN (v4l2object);
|
|
GST_V4L2_CHECK_NOT_ACTIVE (other);
|
|
GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
|
|
|
|
v4l2object->vcap = other->vcap;
|
|
v4l2object->device_caps = other->device_caps;
|
|
gst_v4l2_adjust_buf_type (v4l2object);
|
|
|
|
v4l2object->video_fd = v4l2_dup (other->video_fd);
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
goto not_open;
|
|
|
|
g_free (v4l2object->videodev);
|
|
v4l2object->videodev = g_strdup (other->videodev);
|
|
|
|
GST_INFO_OBJECT (v4l2object->element,
|
|
"Cloned device '%s' (%s) successfully",
|
|
v4l2object->vcap.card, v4l2object->videodev);
|
|
|
|
v4l2object->never_interlaced = other->never_interlaced;
|
|
|
|
return TRUE;
|
|
|
|
not_open:
|
|
{
|
|
GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ_WRITE,
|
|
(_("Could not dup device '%s' for reading and writing."),
|
|
v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4l2_close():
|
|
* close the video device (v4l2object->video_fd)
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_close (GstV4l2Object * v4l2object)
|
|
{
|
|
GST_DEBUG_OBJECT (v4l2object->element, "Trying to close %s",
|
|
v4l2object->videodev);
|
|
|
|
GST_V4L2_CHECK_OPEN (v4l2object);
|
|
GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
|
|
|
|
/* close device */
|
|
v4l2_close (v4l2object->video_fd);
|
|
v4l2object->video_fd = -1;
|
|
|
|
/* empty lists */
|
|
gst_v4l2_empty_lists (v4l2object);
|
|
|
|
return TRUE;
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4l2_get_norm()
|
|
* Get the norm of the current device
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_get_norm (GstV4l2Object * v4l2object, v4l2_std_id * norm)
|
|
{
|
|
GST_DEBUG_OBJECT (v4l2object->element, "getting norm");
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_STD, norm) < 0)
|
|
goto std_failed;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
std_failed:
|
|
{
|
|
GST_DEBUG ("Failed to get the current norm for device %s",
|
|
v4l2object->videodev);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4l2_set_norm()
|
|
* Set the norm of the current device
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_set_norm (GstV4l2Object * v4l2object, v4l2_std_id norm)
|
|
{
|
|
GST_DEBUG_OBJECT (v4l2object->element, "trying to set norm to "
|
|
"%" G_GINT64_MODIFIER "x", (guint64) norm);
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_STD, &norm) < 0)
|
|
goto std_failed;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
std_failed:
|
|
{
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to set norm for device '%s'."),
|
|
v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
/******************************************************
|
|
* gst_v4l2_get_frequency():
|
|
* get the current frequency
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_get_frequency (GstV4l2Object * v4l2object,
|
|
gint tunernum, gulong * frequency)
|
|
{
|
|
struct v4l2_frequency freq = { 0, };
|
|
|
|
GstTunerChannel *channel;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "getting current tuner frequency");
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
channel = gst_tuner_get_channel (GST_TUNER (v4l2object->element));
|
|
|
|
freq.tuner = tunernum;
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_FREQUENCY, &freq) < 0)
|
|
goto freq_failed;
|
|
|
|
*frequency = freq.frequency * channel->freq_multiplicator;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
freq_failed:
|
|
{
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to get current tuner frequency for device '%s'."),
|
|
v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4l2_set_frequency():
|
|
* set frequency
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_set_frequency (GstV4l2Object * v4l2object,
|
|
gint tunernum, gulong frequency)
|
|
{
|
|
struct v4l2_frequency freq = { 0, };
|
|
|
|
GstTunerChannel *channel;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element,
|
|
"setting current tuner frequency to %lu", frequency);
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
channel = gst_tuner_get_channel (GST_TUNER (v4l2object->element));
|
|
|
|
freq.tuner = tunernum;
|
|
/* fill in type - ignore error */
|
|
(void) v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_FREQUENCY, &freq);
|
|
freq.frequency = frequency / channel->freq_multiplicator;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_FREQUENCY, &freq) < 0)
|
|
goto freq_failed;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
freq_failed:
|
|
{
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to set current tuner frequency for device '%s' to %lu Hz."),
|
|
v4l2object->videodev, frequency), GST_ERROR_SYSTEM);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
/******************************************************
|
|
* gst_v4l2_signal_strength():
|
|
* get the strength of the signal on the current input
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_signal_strength (GstV4l2Object * v4l2object,
|
|
gint tunernum, gulong * signal_strength)
|
|
{
|
|
struct v4l2_tuner tuner = { 0, };
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "trying to get signal strength");
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
tuner.index = tunernum;
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_TUNER, &tuner) < 0)
|
|
goto tuner_failed;
|
|
|
|
*signal_strength = tuner.signal;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
tuner_failed:
|
|
{
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to get signal strength for device '%s'."),
|
|
v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
/******************************************************
|
|
* gst_v4l2_get_attribute():
|
|
* try to get the value of one specific attribute
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_get_attribute (GstV4l2Object * v4l2object,
|
|
int attribute_num, int *value)
|
|
{
|
|
struct v4l2_control control = { 0, };
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "getting value of attribute %d",
|
|
attribute_num);
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
control.id = attribute_num;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_CTRL, &control) < 0)
|
|
goto ctrl_failed;
|
|
|
|
*value = control.value;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
ctrl_failed:
|
|
{
|
|
GST_WARNING_OBJECT (v4l2object,
|
|
_("Failed to get value for control %d on device '%s'."),
|
|
attribute_num, v4l2object->videodev);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
|
|
/******************************************************
|
|
* gst_v4l2_set_attribute():
|
|
* try to set the value of one specific attribute
|
|
* return value: TRUE on success, FALSE on error
|
|
******************************************************/
|
|
gboolean
|
|
gst_v4l2_set_attribute (GstV4l2Object * v4l2object,
|
|
int attribute_num, const int value)
|
|
{
|
|
struct v4l2_control control = { 0, };
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "setting value of attribute %d to %d",
|
|
attribute_num, value);
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
control.id = attribute_num;
|
|
control.value = value;
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_CTRL, &control) < 0)
|
|
goto ctrl_failed;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
ctrl_failed:
|
|
{
|
|
GST_WARNING_OBJECT (v4l2object,
|
|
_("Failed to set value %d for control %d on device '%s'."),
|
|
value, attribute_num, v4l2object->videodev);
|
|
return FALSE;
|
|
}
|
|
}
|
|
|
|
static gboolean
|
|
set_control (GQuark field_id, const GValue * value, gpointer user_data)
|
|
{
|
|
GstV4l2Object *v4l2object = user_data;
|
|
GQuark normalised_field_id;
|
|
gpointer *d;
|
|
|
|
/* 32 bytes is the maximum size for a control name according to v4l2 */
|
|
gchar name[32];
|
|
|
|
/* Backwards compatibility: in the past GStreamer would normalise strings in
|
|
a subtly different way to v4l2-ctl. e.g. the kernel's "Focus (absolute)"
|
|
would become "focus__absolute_" whereas now it becomes "focus_absolute".
|
|
Please remove the following in GStreamer 1.5 for 1.6 */
|
|
strncpy (name, g_quark_to_string (field_id), sizeof (name));
|
|
name[31] = '\0';
|
|
gst_v4l2_normalise_control_name (name);
|
|
normalised_field_id = g_quark_from_string (name);
|
|
if (normalised_field_id != field_id)
|
|
g_warning ("In GStreamer 1.4 the way V4L2 control names were normalised "
|
|
"changed. Instead of setting \"%s\" please use \"%s\". The former is "
|
|
"deprecated and will be removed in a future version of GStreamer",
|
|
g_quark_to_string (field_id), name);
|
|
field_id = normalised_field_id;
|
|
|
|
d = g_datalist_id_get_data (&v4l2object->controls, field_id);
|
|
if (!d) {
|
|
GST_WARNING_OBJECT (v4l2object,
|
|
"Control '%s' does not exist or has an unsupported type.",
|
|
g_quark_to_string (field_id));
|
|
return TRUE;
|
|
}
|
|
if (!G_VALUE_HOLDS (value, G_TYPE_INT)) {
|
|
GST_WARNING_OBJECT (v4l2object,
|
|
"'int' value expected for control '%s'.", g_quark_to_string (field_id));
|
|
return TRUE;
|
|
}
|
|
gst_v4l2_set_attribute (v4l2object, GPOINTER_TO_INT (d),
|
|
g_value_get_int (value));
|
|
return TRUE;
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_set_controls (GstV4l2Object * v4l2object, GstStructure * controls)
|
|
{
|
|
return gst_structure_foreach (controls, set_control, v4l2object);
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_get_input (GstV4l2Object * v4l2object, gint * input)
|
|
{
|
|
gint n;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "trying to get input");
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_INPUT, &n) < 0)
|
|
goto input_failed;
|
|
|
|
*input = n;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "input: %d", n);
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
input_failed:
|
|
if (v4l2object->device_caps & V4L2_CAP_TUNER) {
|
|
/* only give a warning message if driver actually claims to have tuner
|
|
* support
|
|
*/
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to get current input on device '%s'. May be it is a radio device"), v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
}
|
|
return FALSE;
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_set_input (GstV4l2Object * v4l2object, gint input)
|
|
{
|
|
GST_DEBUG_OBJECT (v4l2object->element, "trying to set input to %d", input);
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_INPUT, &input) < 0)
|
|
goto input_failed;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
input_failed:
|
|
if (v4l2object->device_caps & V4L2_CAP_TUNER) {
|
|
/* only give a warning message if driver actually claims to have tuner
|
|
* support
|
|
*/
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to set input %d on device %s."),
|
|
input, v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
}
|
|
return FALSE;
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_get_output (GstV4l2Object * v4l2object, gint * output)
|
|
{
|
|
gint n;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "trying to get output");
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_OUTPUT, &n) < 0)
|
|
goto output_failed;
|
|
|
|
*output = n;
|
|
|
|
GST_DEBUG_OBJECT (v4l2object->element, "output: %d", n);
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
output_failed:
|
|
if (v4l2object->device_caps & V4L2_CAP_TUNER) {
|
|
/* only give a warning message if driver actually claims to have tuner
|
|
* support
|
|
*/
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to get current output on device '%s'. May be it is a radio device"), v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
}
|
|
return FALSE;
|
|
}
|
|
|
|
gboolean
|
|
gst_v4l2_set_output (GstV4l2Object * v4l2object, gint output)
|
|
{
|
|
GST_DEBUG_OBJECT (v4l2object->element, "trying to set output to %d", output);
|
|
|
|
if (!GST_V4L2_IS_OPEN (v4l2object))
|
|
return FALSE;
|
|
|
|
if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_OUTPUT, &output) < 0)
|
|
goto output_failed;
|
|
|
|
return TRUE;
|
|
|
|
/* ERRORS */
|
|
output_failed:
|
|
if (v4l2object->device_caps & V4L2_CAP_TUNER) {
|
|
/* only give a warning message if driver actually claims to have tuner
|
|
* support
|
|
*/
|
|
GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
|
|
(_("Failed to set output %d on device %s."),
|
|
output, v4l2object->videodev), GST_ERROR_SYSTEM);
|
|
}
|
|
return FALSE;
|
|
}
|