sys/v4l2/v4l2_calls.c

   1 /* GStreamer
   2  *
   3  * Copyright (C) 2002 Ronald Bultje <rbultje@ronald.bitfreak.net>
   4  *               2006 Edgard Lima <edgard.lima@indt.org.br>
   5  *
   6  * v4l2_calls.c - generic V4L2 calls handling
   7  *
   8  * This library is free software; you can redistribute it and/or
   9  * modify it under the terms of the GNU Library General Public
  10  * License as published by the Free Software Foundation; either
  11  * version 2 of the License, or (at your option) any later version.
  12  *
  13  * This library is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  16  * Library General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU Library General Public
  19  * License along with this library; if not, write to the
  20  * Free Software Foundation, Inc., 51 Franklin St, Fifth Floor,
  21  * Boston, MA 02110-1301, USA.
  22  */
  23
  24 #ifdef HAVE_CONFIG_H
  25 #include <config.h>
  26 #endif
  27
  28 #include <sys/types.h>
  29 #include <sys/stat.h>
  30 #include <fcntl.h>
  31 #include <sys/ioctl.h>
  32 #include <sys/mman.h>
  33 #include <string.h>
  34 #include <errno.h>
  35 #include <unistd.h>
  36 #ifdef __sun
  37 /* Needed on older Solaris Nevada builds (72 at least) */
  38 #include <stropts.h>
  39 #include <sys/ioccom.h>
  40 #endif
  41 #include "v4l2_calls.h"
  42 #include "gstv4l2tuner.h"
  43 #if 0
  44 #include "gstv4l2xoverlay.h"
  45 #endif
  46 #include "gstv4l2colorbalance.h"
  47
  48 #include "gstv4l2src.h"
  49 #include "gstv4l2sink.h"
  50
  51 #include "gst/gst-i18n-plugin.h"
  52
  53 /* Those are ioctl calls */
  54 #ifndef V4L2_CID_HCENTER
  55 #define V4L2_CID_HCENTER V4L2_CID_HCENTER_DEPRECATED
  56 #endif
  57 #ifndef V4L2_CID_VCENTER
  58 #define V4L2_CID_VCENTER V4L2_CID_VCENTER_DEPRECATED
  59 #endif
  60
  61 GST_DEBUG_CATEGORY_EXTERN (v4l2_debug);
  62 #define GST_CAT_DEFAULT v4l2_debug
  63
  64 /******************************************************
  65  * gst_v4l2_get_capabilities():
  66  *   get the device's capturing capabilities
  67  * return value: TRUE on success, FALSE on error
  68  ******************************************************/
  69 gboolean
  70 gst_v4l2_get_capabilities (GstV4l2Object * v4l2object)
  71 {
  72   GstElement *e;
  73
  74   e = v4l2object->element;
  75
  76   GST_DEBUG_OBJECT (e, "getting capabilities");
  77
  78   if (!GST_V4L2_IS_OPEN (v4l2object))
  79     return FALSE;
  80
  81   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_QUERYCAP, &v4l2object->vcap) < 0)
  82     goto cap_failed;
  83
  84   GST_LOG_OBJECT (e, "driver:      '%s'", v4l2object->vcap.driver);
  85   GST_LOG_OBJECT (e, "card:        '%s'", v4l2object->vcap.card);
  86   GST_LOG_OBJECT (e, "bus_info:    '%s'", v4l2object->vcap.bus_info);
  87   GST_LOG_OBJECT (e, "version:     %08x", v4l2object->vcap.version);
  88   GST_LOG_OBJECT (e, "capabilites: %08x", v4l2object->vcap.capabilities);
  89
  90   return TRUE;
  91
  92   /* ERRORS */
  93 cap_failed:
  94   {
  95     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
  96         (_("Error getting capabilities for device '%s': "
  97                 "It isn't a v4l2 driver. Check if it is a v4l1 driver."),
  98             v4l2object->videodev), GST_ERROR_SYSTEM);
  99     return FALSE;
 100   }
 101 }
 102
 103
 104 /******************************************************
 105  * gst_v4l2_empty_lists() and gst_v4l2_fill_lists():
 106  *   fill/empty the lists of enumerations
 107  * return value: TRUE on success, FALSE on error
 108  ******************************************************/
 109 static gboolean
 110 gst_v4l2_fill_lists (GstV4l2Object * v4l2object)
 111 {
 112   gint n, next;
 113   struct v4l2_queryctrl control = { 0, };
 114
 115   GstElement *e;
 116
 117   e = v4l2object->element;
 118
 119   GST_DEBUG_OBJECT (e, "getting enumerations");
 120   GST_V4L2_CHECK_OPEN (v4l2object);
 121
 122   GST_DEBUG_OBJECT (e, "  channels");
 123   /* and now, the channels */
 124   for (n = 0;; n++) {
 125     struct v4l2_input input;
 126     GstV4l2TunerChannel *v4l2channel;
 127     GstTunerChannel *channel;
 128
 129     memset (&input, 0, sizeof (input));
 130
 131     input.index = n;
 132     if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_ENUMINPUT, &input) < 0) {
 133       if (errno == EINVAL || errno == ENOTTY)
 134         break;                  /* end of enumeration */
 135       else {
 136         GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
 137             (_("Failed to query attributes of input %d in device %s"),
 138                 n, v4l2object->videodev),
 139             ("Failed to get %d in input enumeration for %s. (%d - %s)",
 140                 n, v4l2object->videodev, errno, strerror (errno)));
 141         return FALSE;
 142       }
 143     }
 144
 145     GST_LOG_OBJECT (e, "   index:     %d", input.index);
 146     GST_LOG_OBJECT (e, "   name:      '%s'", input.name);
 147     GST_LOG_OBJECT (e, "   type:      %08x", input.type);
 148     GST_LOG_OBJECT (e, "   audioset:  %08x", input.audioset);
 149     GST_LOG_OBJECT (e, "   std:       %016" G_GINT64_MODIFIER "x",
 150         (guint64) input.std);
 151     GST_LOG_OBJECT (e, "   status:    %08x", input.status);
 152
 153     v4l2channel = g_object_new (GST_TYPE_V4L2_TUNER_CHANNEL, NULL);
 154     channel = GST_TUNER_CHANNEL (v4l2channel);
 155     channel->label = g_strdup ((const gchar *) input.name);
 156     channel->flags = GST_TUNER_CHANNEL_INPUT;
 157     v4l2channel->index = n;
 158
 159     if (input.type == V4L2_INPUT_TYPE_TUNER) {
 160       struct v4l2_tuner vtun;
 161
 162       v4l2channel->tuner = input.tuner;
 163       channel->flags |= GST_TUNER_CHANNEL_FREQUENCY;
 164
 165       vtun.index = input.tuner;
 166       if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_TUNER, &vtun) < 0) {
 167         GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
 168             (_("Failed to get setting of tuner %d on device '%s'."),
 169                 input.tuner, v4l2object->videodev), GST_ERROR_SYSTEM);
 170         g_object_unref (G_OBJECT (channel));
 171         return FALSE;
 172       }
 173
 174       channel->freq_multiplicator =
 175           62.5 * ((vtun.capability & V4L2_TUNER_CAP_LOW) ? 1 : 1000);
 176       channel->min_frequency = vtun.rangelow * channel->freq_multiplicator;
 177       channel->max_frequency = vtun.rangehigh * channel->freq_multiplicator;
 178       channel->min_signal = 0;
 179       channel->max_signal = 0xffff;
 180     }
 181     if (input.audioset) {
 182       /* we take the first. We don't care for
 183        * the others for now */
 184       while (!(input.audioset & (1 << v4l2channel->audio)))
 185         v4l2channel->audio++;
 186       channel->flags |= GST_TUNER_CHANNEL_AUDIO;
 187     }
 188
 189     v4l2object->channels =
 190         g_list_prepend (v4l2object->channels, (gpointer) channel);
 191   }
 192   v4l2object->channels = g_list_reverse (v4l2object->channels);
 193
 194   GST_DEBUG_OBJECT (e, "  norms");
 195   /* norms... */
 196   for (n = 0;; n++) {
 197     struct v4l2_standard standard = { 0, };
 198     GstV4l2TunerNorm *v4l2norm;
 199
 200     GstTunerNorm *norm;
 201
 202     /* fill in defaults */
 203     standard.frameperiod.numerator = 1;
 204     standard.frameperiod.denominator = 0;
 205     standard.index = n;
 206
 207     if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_ENUMSTD, &standard) < 0) {
 208       if (errno == EINVAL || errno == ENOTTY || errno == ENODATA)
 209         break;                  /* end of enumeration */
 210       else {
 211         GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
 212             (_("Failed to query norm on device '%s'."),
 213                 v4l2object->videodev),
 214             ("Failed to get attributes for norm %d on devide '%s'. (%d - %s)",
 215                 n, v4l2object->videodev, errno, strerror (errno)));
 216         return FALSE;
 217       }
 218     }
 219
 220     GST_DEBUG_OBJECT (e, "    '%s', fps: %d / %d",
 221         standard.name, standard.frameperiod.denominator,
 222         standard.frameperiod.numerator);
 223
 224     v4l2norm = g_object_new (GST_TYPE_V4L2_TUNER_NORM, NULL);
 225     norm = GST_TUNER_NORM (v4l2norm);
 226     norm->label = g_strdup ((const gchar *) standard.name);
 227     gst_value_set_fraction (&norm->framerate,
 228         standard.frameperiod.denominator, standard.frameperiod.numerator);
 229     v4l2norm->index = standard.id;
 230
 231     GST_DEBUG_OBJECT (v4l2object->element, "index=%08x, label=%s",
 232         (unsigned int) v4l2norm->index, norm->label);
 233
 234     v4l2object->norms = g_list_prepend (v4l2object->norms, (gpointer) norm);
 235   }
 236   v4l2object->norms = g_list_reverse (v4l2object->norms);
 237
 238   GST_DEBUG_OBJECT (e, "  controls+menus");
 239
 240   /* and lastly, controls+menus (if appropriate) */
 241 #ifdef V4L2_CTRL_FLAG_NEXT_CTRL
 242   next = V4L2_CTRL_FLAG_NEXT_CTRL;
 243   n = 0;
 244 #else
 245   next = 0;
 246   n = V4L2_CID_BASE;
 247 #endif
 248   control.id = next;
 249   while (TRUE) {
 250     GstV4l2ColorBalanceChannel *v4l2channel;
 251     GstColorBalanceChannel *channel;
 252
 253     if (!next)
 254       n++;
 255
 256     /* when we reached the last official CID, continue with private CIDs */
 257     if (n == V4L2_CID_LASTP1) {
 258       GST_DEBUG_OBJECT (e, "checking private CIDs");
 259       n = V4L2_CID_PRIVATE_BASE;
 260     }
 261     GST_DEBUG_OBJECT (e, "checking control %08x", n);
 262
 263     control.id = n | next;
 264     if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_QUERYCTRL, &control) < 0) {
 265       if (next) {
 266         if (n > 0) {
 267           GST_DEBUG_OBJECT (e, "controls finished");
 268           break;
 269         } else {
 270           GST_DEBUG_OBJECT (e, "V4L2_CTRL_FLAG_NEXT_CTRL not supported.");
 271           next = 0;
 272           n = V4L2_CID_BASE;
 273           continue;
 274         }
 275       }
 276       if (errno == EINVAL || errno == ENOTTY || errno == EIO || errno == ENOENT) {
 277         if (n < V4L2_CID_PRIVATE_BASE) {
 278           GST_DEBUG_OBJECT (e, "skipping control %08x", n);
 279           /* continue so that we also check private controls */
 280           continue;
 281         } else {
 282           GST_DEBUG_OBJECT (e, "controls finished");
 283           break;
 284         }
 285       } else {
 286         GST_WARNING_OBJECT (e, "Failed querying control %d on device '%s'. "
 287             "(%d - %s)", n, v4l2object->videodev, errno, strerror (errno));
 288         continue;
 289       }
 290     }
 291     n = control.id;
 292     if (control.flags & V4L2_CTRL_FLAG_DISABLED) {
 293       GST_DEBUG_OBJECT (e, "skipping disabled control");
 294       continue;
 295     }
 296 #ifdef V4L2_CTRL_TYPE_CTRL_CLASS
 297     if (control.type == V4L2_CTRL_TYPE_CTRL_CLASS) {
 298       GST_DEBUG_OBJECT (e, "starting control class '%s'", control.name);
 299       continue;
 300     }
 301 #endif
 302     switch (control.type) {
 303       case V4L2_CTRL_TYPE_INTEGER:
 304       case V4L2_CTRL_TYPE_BOOLEAN:
 305       case V4L2_CTRL_TYPE_MENU:
 306 #ifdef V4L2_CTRL_TYPE_INTEGER_MENU
 307       case V4L2_CTRL_TYPE_INTEGER_MENU:
 308 #endif
 309 #ifdef V4L2_CTRL_TYPE_BITMASK
 310       case V4L2_CTRL_TYPE_BITMASK:
 311 #endif
 312       case V4L2_CTRL_TYPE_BUTTON:{
 313         int i;
 314         control.name[31] = '\0';
 315         for (i = 0; control.name[i]; ++i) {
 316           control.name[i] = g_ascii_tolower (control.name[i]);
 317           if (!g_ascii_isalnum (control.name[i]))
 318             control.name[i] = '_';
 319         }
 320         GST_INFO_OBJECT (e, "adding generic controls '%s'", control.name);
 321         g_datalist_id_set_data (&v4l2object->controls,
 322             g_quark_from_string ((const gchar *) control.name),
 323             GINT_TO_POINTER (n));
 324         break;
 325       }
 326       default:
 327         GST_DEBUG_OBJECT (e,
 328             "Control type for '%s' not suppored for extra controls.",
 329             control.name);
 330         break;
 331     }
 332
 333     switch (n) {
 334       case V4L2_CID_BRIGHTNESS:
 335       case V4L2_CID_CONTRAST:
 336       case V4L2_CID_SATURATION:
 337       case V4L2_CID_HUE:
 338       case V4L2_CID_BLACK_LEVEL:
 339       case V4L2_CID_AUTO_WHITE_BALANCE:
 340       case V4L2_CID_DO_WHITE_BALANCE:
 341       case V4L2_CID_RED_BALANCE:
 342       case V4L2_CID_BLUE_BALANCE:
 343       case V4L2_CID_GAMMA:
 344       case V4L2_CID_EXPOSURE:
 345       case V4L2_CID_AUTOGAIN:
 346       case V4L2_CID_GAIN:
 347 #ifdef V4L2_CID_SHARPNESS
 348       case V4L2_CID_SHARPNESS:
 349 #endif
 350         /* we only handle these for now (why?) */
 351         break;
 352       case V4L2_CID_HFLIP:
 353       case V4L2_CID_VFLIP:
 354 #ifndef V4L2_CID_PAN_RESET
 355       case V4L2_CID_HCENTER:
 356 #endif
 357 #ifndef V4L2_CID_TILT_RESET
 358       case V4L2_CID_VCENTER:
 359 #endif
 360 #ifdef V4L2_CID_PAN_RESET
 361       case V4L2_CID_PAN_RESET:
 362 #endif
 363 #ifdef V4L2_CID_TILT_RESET
 364       case V4L2_CID_TILT_RESET:
 365 #endif
 366         /* not handled here, handled by VideoOrientation interface */
 367         control.id++;
 368         break;
 369       case V4L2_CID_AUDIO_VOLUME:
 370       case V4L2_CID_AUDIO_BALANCE:
 371       case V4L2_CID_AUDIO_BASS:
 372       case V4L2_CID_AUDIO_TREBLE:
 373       case V4L2_CID_AUDIO_MUTE:
 374       case V4L2_CID_AUDIO_LOUDNESS:
 375         /* FIXME: We should implement GstMixer interface */
 376         /* fall through */
 377       default:
 378         GST_DEBUG_OBJECT (e,
 379             "ControlID %s (%x) unhandled, FIXME", control.name, n);
 380         control.id++;
 381         break;
 382     }
 383     if (n != control.id)
 384       continue;
 385
 386     GST_DEBUG_OBJECT (e, "Adding ControlID %s (%x)", control.name, n);
 387     v4l2channel = g_object_new (GST_TYPE_V4L2_COLOR_BALANCE_CHANNEL, NULL);
 388     channel = GST_COLOR_BALANCE_CHANNEL (v4l2channel);
 389     channel->label = g_strdup ((const gchar *) control.name);
 390     v4l2channel->id = n;
 391
 392 #if 0
 393     /* FIXME: it will be need just when handling private controls
 394      *(currently none of base controls are of this type) */
 395     if (control.type == V4L2_CTRL_TYPE_MENU) {
 396       struct v4l2_querymenu menu, *mptr;
 397
 398       int i;
 399
 400       menu.id = n;
 401       for (i = 0;; i++) {
 402         menu.index = i;
 403         if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_QUERYMENU, &menu) < 0) {
 404           if (errno == EINVAL)
 405             break;              /* end of enumeration */
 406           else {
 407             GST_ELEMENT_ERROR (e, RESOURCE, SETTINGS,
 408                 (_("Failed getting controls attributes on device '%s'."),
 409                     v4l2object->videodev),
 410                 ("Failed to get %d in menu enumeration for %s. (%d - %s)",
 411                     n, v4l2object->videodev, errno, strerror (errno)));
 412             return FALSE;
 413           }
 414         }
 415         mptr = g_malloc (sizeof (menu));
 416         memcpy (mptr, &menu, sizeof (menu));
 417         menus = g_list_append (menus, mptr);
 418       }
 419     }
 420     v4l2object->menus = g_list_append (v4l2object->menus, menus);
 421 #endif
 422
 423     switch (control.type) {
 424       case V4L2_CTRL_TYPE_INTEGER:
 425         channel->min_value = control.minimum;
 426         channel->max_value = control.maximum;
 427         break;
 428       case V4L2_CTRL_TYPE_BOOLEAN:
 429         channel->min_value = FALSE;
 430         channel->max_value = TRUE;
 431         break;
 432       default:
 433         /* FIXME we should find out how to handle V4L2_CTRL_TYPE_BUTTON.
 434            BUTTON controls like V4L2_CID_DO_WHITE_BALANCE can just be set (1) or
 435            unset (0), but can't be queried */
 436         GST_DEBUG_OBJECT (e,
 437             "Control with non supported type %s (%x), type=%d",
 438             control.name, n, control.type);
 439         channel->min_value = channel->max_value = 0;
 440         break;
 441     }
 442
 443     v4l2object->colors =
 444         g_list_prepend (v4l2object->colors, (gpointer) channel);
 445   }
 446   v4l2object->colors = g_list_reverse (v4l2object->colors);
 447
 448   GST_DEBUG_OBJECT (e, "done");
 449   return TRUE;
 450 }
 451
 452
 453 static void
 454 gst_v4l2_empty_lists (GstV4l2Object * v4l2object)
 455 {
 456   GST_DEBUG_OBJECT (v4l2object->element, "deleting enumerations");
 457
 458   g_list_foreach (v4l2object->channels, (GFunc) g_object_unref, NULL);
 459   g_list_free (v4l2object->channels);
 460   v4l2object->channels = NULL;
 461
 462   g_list_foreach (v4l2object->norms, (GFunc) g_object_unref, NULL);
 463   g_list_free (v4l2object->norms);
 464   v4l2object->norms = NULL;
 465
 466   g_list_foreach (v4l2object->colors, (GFunc) g_object_unref, NULL);
 467   g_list_free (v4l2object->colors);
 468   v4l2object->colors = NULL;
 469
 470   g_datalist_clear (&v4l2object->controls);
 471 }
 472
 473 static void
 474 gst_v4l2_adjust_buf_type (GstV4l2Object * v4l2object)
 475 {
 476   /* when calling gst_v4l2_object_new the user decides the initial type
 477    * so adjust it if multi-planar is supported
 478    * the driver should make it exclusive. So the driver should
 479    * not support both MPLANE and non-PLANE.
 480    * Because even when using MPLANE it still possibles to use it
 481    * in a contiguous manner. In this case the first v4l2 plane
 482    * contains all the gst planes.
 483    */
 484 #ifdef V4L2_CAP_VIDEO_M2M_MPLANE
 485 #define CHECK_CAPS (V4L2_CAP_VIDEO_OUTPUT_MPLANE | V4L2_CAP_VIDEO_M2M_MPLANE)
 486 #else
 487 #define CHECK_CAPS (V4L2_CAP_VIDEO_OUTPUT_MPLANE)
 488 #endif
 489
 490   switch (v4l2object->type) {
 491     case V4L2_BUF_TYPE_VIDEO_OUTPUT:
 492       if (v4l2object->vcap.capabilities & CHECK_CAPS) {
 493         GST_DEBUG ("adjust type to multi-planar output");
 494         v4l2object->type = V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE;
 495       }
 496       break;
 497     case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 498       if (v4l2object->vcap.capabilities & CHECK_CAPS) {
 499         /* FIXME: for now it's an untested case so just put a warning */
 500         GST_WARNING ("untested V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE");
 501
 502         GST_DEBUG ("adjust type to multi-planar capture");
 503         v4l2object->type = V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE;
 504       }
 505       break;
 506     default:
 507       break;
 508   }
 509 }
 510
 511 /******************************************************
 512  * gst_v4l2_open():
 513  *   open the video device (v4l2object->videodev)
 514  * return value: TRUE on success, FALSE on error
 515  ******************************************************/
 516 gboolean
 517 gst_v4l2_open (GstV4l2Object * v4l2object)
 518 {
 519   struct stat st;
 520   int libv4l2_fd;
 521   GstPollFD pollfd = GST_POLL_FD_INIT;
 522
 523   GST_DEBUG_OBJECT (v4l2object->element, "Trying to open device %s",
 524       v4l2object->videodev);
 525
 526   GST_V4L2_CHECK_NOT_OPEN (v4l2object);
 527   GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
 528
 529   /* be sure we have a device */
 530   if (!v4l2object->videodev)
 531     v4l2object->videodev = g_strdup ("/dev/video");
 532
 533   /* check if it is a device */
 534   if (stat (v4l2object->videodev, &st) == -1)
 535     goto stat_failed;
 536
 537   if (!S_ISCHR (st.st_mode))
 538     goto no_device;
 539
 540   /* open the device */
 541   v4l2object->video_fd =
 542       open (v4l2object->videodev, O_RDWR /* | O_NONBLOCK */ );
 543
 544   if (!GST_V4L2_IS_OPEN (v4l2object))
 545     goto not_open;
 546
 547   libv4l2_fd = v4l2_fd_open (v4l2object->video_fd,
 548       V4L2_ENABLE_ENUM_FMT_EMULATION);
 549   /* Note the v4l2_xxx functions are designed so that if they get passed an
 550      unknown fd, the will behave exactly as their regular xxx counterparts, so
 551      if v4l2_fd_open fails, we continue as normal (missing the libv4l2 custom
 552      cam format to normal formats conversion). Chances are big we will still
 553      fail then though, as normally v4l2_fd_open only fails if the device is not
 554      a v4l2 device. */
 555   if (libv4l2_fd != -1)
 556     v4l2object->video_fd = libv4l2_fd;
 557
 558   v4l2object->can_poll_device = TRUE;
 559
 560   /* get capabilities, error will be posted */
 561   if (!gst_v4l2_get_capabilities (v4l2object))
 562     goto error;
 563
 564   /* do we need to be a capture device? */
 565   if (GST_IS_V4L2SRC (v4l2object->element) &&
 566       !(v4l2object->vcap.capabilities & (V4L2_CAP_VIDEO_CAPTURE |
 567               V4L2_CAP_VIDEO_CAPTURE_MPLANE)))
 568     goto not_capture;
 569
 570   if (GST_IS_V4L2SINK (v4l2object->element) &&
 571       !(v4l2object->vcap.capabilities & (V4L2_CAP_VIDEO_OUTPUT |
 572               V4L2_CAP_VIDEO_OUTPUT_MPLANE)))
 573     goto not_output;
 574
 575
 576   gst_v4l2_adjust_buf_type (v4l2object);
 577
 578   /* create enumerations, posts errors. */
 579   if (!gst_v4l2_fill_lists (v4l2object))
 580     goto error;
 581
 582   GST_INFO_OBJECT (v4l2object->element,
 583       "Opened device '%s' (%s) successfully",
 584       v4l2object->vcap.card, v4l2object->videodev);
 585
 586   pollfd.fd = v4l2object->video_fd;
 587   gst_poll_add_fd (v4l2object->poll, &pollfd);
 588   if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE
 589       || v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
 590     gst_poll_fd_ctl_read (v4l2object->poll, &pollfd, TRUE);
 591   else
 592     gst_poll_fd_ctl_write (v4l2object->poll, &pollfd, TRUE);
 593
 594   if (v4l2object->extra_controls)
 595     gst_v4l2_set_controls (v4l2object, v4l2object->extra_controls);
 596
 597   /* UVC devices are never interlaced, and doing VIDIOC_TRY_FMT on them
 598    * causes expensive and slow USB IO, so don't probe them for interlaced
 599    */
 600   if (!strcmp ((char *) v4l2object->vcap.driver, "uvcusb")) {
 601     v4l2object->never_interlaced = TRUE;
 602   }
 603
 604   return TRUE;
 605
 606   /* ERRORS */
 607 stat_failed:
 608   {
 609     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
 610         (_("Cannot identify device '%s'."), v4l2object->videodev),
 611         GST_ERROR_SYSTEM);
 612     goto error;
 613   }
 614 no_device:
 615   {
 616     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
 617         (_("This isn't a device '%s'."), v4l2object->videodev),
 618         GST_ERROR_SYSTEM);
 619     goto error;
 620   }
 621 not_open:
 622   {
 623     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ_WRITE,
 624         (_("Could not open device '%s' for reading and writing."),
 625             v4l2object->videodev), GST_ERROR_SYSTEM);
 626     goto error;
 627   }
 628 not_capture:
 629   {
 630     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
 631         (_("Device '%s' is not a capture device."),
 632             v4l2object->videodev),
 633         ("Capabilities: 0x%x", v4l2object->vcap.capabilities));
 634     goto error;
 635   }
 636 not_output:
 637   {
 638     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, NOT_FOUND,
 639         (_("Device '%s' is not a output device."),
 640             v4l2object->videodev),
 641         ("Capabilities: 0x%x", v4l2object->vcap.capabilities));
 642     goto error;
 643   }
 644 error:
 645   {
 646     if (GST_V4L2_IS_OPEN (v4l2object)) {
 647       /* close device */
 648       v4l2_close (v4l2object->video_fd);
 649       v4l2object->video_fd = -1;
 650     }
 651     /* empty lists */
 652     gst_v4l2_empty_lists (v4l2object);
 653
 654     return FALSE;
 655   }
 656 }
 657
 658 gboolean
 659 gst_v4l2_dup (GstV4l2Object * v4l2object, GstV4l2Object * other)
 660 {
 661   GstPollFD pollfd = GST_POLL_FD_INIT;
 662
 663   GST_DEBUG_OBJECT (v4l2object->element, "Trying to dup device %s",
 664       other->videodev);
 665
 666   GST_V4L2_CHECK_OPEN (other);
 667   GST_V4L2_CHECK_NOT_OPEN (v4l2object);
 668   GST_V4L2_CHECK_NOT_ACTIVE (other);
 669   GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
 670
 671   v4l2object->vcap = other->vcap;
 672   gst_v4l2_adjust_buf_type (v4l2object);
 673
 674   v4l2object->video_fd = v4l2_dup (other->video_fd);
 675   if (!GST_V4L2_IS_OPEN (v4l2object))
 676     goto not_open;
 677
 678   g_free (v4l2object->videodev);
 679   v4l2object->videodev = g_strdup (other->videodev);
 680
 681   GST_INFO_OBJECT (v4l2object->element,
 682       "Cloned device '%s' (%s) successfully",
 683       v4l2object->vcap.card, v4l2object->videodev);
 684
 685   pollfd.fd = v4l2object->video_fd;
 686   gst_poll_add_fd (v4l2object->poll, &pollfd);
 687   if (v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE
 688       || v4l2object->type == V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE)
 689     gst_poll_fd_ctl_read (v4l2object->poll, &pollfd, TRUE);
 690   else
 691     gst_poll_fd_ctl_write (v4l2object->poll, &pollfd, TRUE);
 692
 693   v4l2object->never_interlaced = other->never_interlaced;
 694   v4l2object->can_poll_device = TRUE;
 695
 696   return TRUE;
 697
 698 not_open:
 699   {
 700     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ_WRITE,
 701         (_("Could not dup device '%s' for reading and writing."),
 702             v4l2object->videodev), GST_ERROR_SYSTEM);
 703
 704     return FALSE;
 705   }
 706 }
 707
 708
 709 /******************************************************
 710  * gst_v4l2_close():
 711  *   close the video device (v4l2object->video_fd)
 712  * return value: TRUE on success, FALSE on error
 713  ******************************************************/
 714 gboolean
 715 gst_v4l2_close (GstV4l2Object * v4l2object)
 716 {
 717   GstPollFD pollfd = GST_POLL_FD_INIT;
 718   GST_DEBUG_OBJECT (v4l2object->element, "Trying to close %s",
 719       v4l2object->videodev);
 720
 721   GST_V4L2_CHECK_OPEN (v4l2object);
 722   GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
 723
 724   /* close device */
 725   v4l2_close (v4l2object->video_fd);
 726   pollfd.fd = v4l2object->video_fd;
 727   gst_poll_remove_fd (v4l2object->poll, &pollfd);
 728   v4l2object->video_fd = -1;
 729
 730   /* empty lists */
 731   gst_v4l2_empty_lists (v4l2object);
 732
 733   return TRUE;
 734 }
 735
 736
 737 /******************************************************
 738  * gst_v4l2_get_norm()
 739  *   Get the norm of the current device
 740  * return value: TRUE on success, FALSE on error
 741  ******************************************************/
 742 gboolean
 743 gst_v4l2_get_norm (GstV4l2Object * v4l2object, v4l2_std_id * norm)
 744 {
 745   GST_DEBUG_OBJECT (v4l2object->element, "getting norm");
 746
 747   if (!GST_V4L2_IS_OPEN (v4l2object))
 748     return FALSE;
 749
 750   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_STD, norm) < 0)
 751     goto std_failed;
 752
 753   return TRUE;
 754
 755   /* ERRORS */
 756 std_failed:
 757   {
 758     GST_DEBUG ("Failed to get the current norm for device %s",
 759         v4l2object->videodev);
 760     return FALSE;
 761   }
 762 }
 763
 764
 765 /******************************************************
 766  * gst_v4l2_set_norm()
 767  *   Set the norm of the current device
 768  * return value: TRUE on success, FALSE on error
 769  ******************************************************/
 770 gboolean
 771 gst_v4l2_set_norm (GstV4l2Object * v4l2object, v4l2_std_id norm)
 772 {
 773   GST_DEBUG_OBJECT (v4l2object->element, "trying to set norm to "
 774       "%" G_GINT64_MODIFIER "x", (guint64) norm);
 775
 776   if (!GST_V4L2_IS_OPEN (v4l2object))
 777     return FALSE;
 778
 779   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_STD, &norm) < 0)
 780     goto std_failed;
 781
 782   return TRUE;
 783
 784   /* ERRORS */
 785 std_failed:
 786   {
 787     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
 788         (_("Failed to set norm for device '%s'."),
 789             v4l2object->videodev), GST_ERROR_SYSTEM);
 790     return FALSE;
 791   }
 792 }
 793
 794 /******************************************************
 795  * gst_v4l2_get_frequency():
 796  *   get the current frequency
 797  * return value: TRUE on success, FALSE on error
 798  ******************************************************/
 799 gboolean
 800 gst_v4l2_get_frequency (GstV4l2Object * v4l2object,
 801     gint tunernum, gulong * frequency)
 802 {
 803   struct v4l2_frequency freq = { 0, };
 804
 805   GstTunerChannel *channel;
 806
 807   GST_DEBUG_OBJECT (v4l2object->element, "getting current tuner frequency");
 808
 809   if (!GST_V4L2_IS_OPEN (v4l2object))
 810     return FALSE;
 811
 812   channel = gst_tuner_get_channel (GST_TUNER (v4l2object->element));
 813
 814   freq.tuner = tunernum;
 815   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_FREQUENCY, &freq) < 0)
 816     goto freq_failed;
 817
 818   *frequency = freq.frequency * channel->freq_multiplicator;
 819
 820   return TRUE;
 821
 822   /* ERRORS */
 823 freq_failed:
 824   {
 825     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
 826         (_("Failed to get current tuner frequency for device '%s'."),
 827             v4l2object->videodev), GST_ERROR_SYSTEM);
 828     return FALSE;
 829   }
 830 }
 831
 832
 833 /******************************************************
 834  * gst_v4l2_set_frequency():
 835  *   set frequency
 836  * return value: TRUE on success, FALSE on error
 837  ******************************************************/
 838 gboolean
 839 gst_v4l2_set_frequency (GstV4l2Object * v4l2object,
 840     gint tunernum, gulong frequency)
 841 {
 842   struct v4l2_frequency freq = { 0, };
 843
 844   GstTunerChannel *channel;
 845
 846   GST_DEBUG_OBJECT (v4l2object->element,
 847       "setting current tuner frequency to %lu", frequency);
 848
 849   if (!GST_V4L2_IS_OPEN (v4l2object))
 850     return FALSE;
 851
 852   channel = gst_tuner_get_channel (GST_TUNER (v4l2object->element));
 853
 854   freq.tuner = tunernum;
 855   /* fill in type - ignore error */
 856   v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_FREQUENCY, &freq);
 857   freq.frequency = frequency / channel->freq_multiplicator;
 858
 859   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_FREQUENCY, &freq) < 0)
 860     goto freq_failed;
 861
 862   return TRUE;
 863
 864   /* ERRORS */
 865 freq_failed:
 866   {
 867     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
 868         (_("Failed to set current tuner frequency for device '%s' to %lu Hz."),
 869             v4l2object->videodev, frequency), GST_ERROR_SYSTEM);
 870     return FALSE;
 871   }
 872 }
 873
 874 /******************************************************
 875  * gst_v4l2_signal_strength():
 876  *   get the strength of the signal on the current input
 877  * return value: TRUE on success, FALSE on error
 878  ******************************************************/
 879 gboolean
 880 gst_v4l2_signal_strength (GstV4l2Object * v4l2object,
 881     gint tunernum, gulong * signal_strength)
 882 {
 883   struct v4l2_tuner tuner = { 0, };
 884
 885   GST_DEBUG_OBJECT (v4l2object->element, "trying to get signal strength");
 886
 887   if (!GST_V4L2_IS_OPEN (v4l2object))
 888     return FALSE;
 889
 890   tuner.index = tunernum;
 891   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_TUNER, &tuner) < 0)
 892     goto tuner_failed;
 893
 894   *signal_strength = tuner.signal;
 895
 896   return TRUE;
 897
 898   /* ERRORS */
 899 tuner_failed:
 900   {
 901     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
 902         (_("Failed to get signal strength for device '%s'."),
 903             v4l2object->videodev), GST_ERROR_SYSTEM);
 904     return FALSE;
 905   }
 906 }
 907
 908 /******************************************************
 909  * gst_v4l2_get_attribute():
 910  *   try to get the value of one specific attribute
 911  * return value: TRUE on success, FALSE on error
 912  ******************************************************/
 913 gboolean
 914 gst_v4l2_get_attribute (GstV4l2Object * v4l2object,
 915     int attribute_num, int *value)
 916 {
 917   struct v4l2_control control = { 0, };
 918
 919   GST_DEBUG_OBJECT (v4l2object->element, "getting value of attribute %d",
 920       attribute_num);
 921
 922   if (!GST_V4L2_IS_OPEN (v4l2object))
 923     return FALSE;
 924
 925   control.id = attribute_num;
 926
 927   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_CTRL, &control) < 0)
 928     goto ctrl_failed;
 929
 930   *value = control.value;
 931
 932   return TRUE;
 933
 934   /* ERRORS */
 935 ctrl_failed:
 936   {
 937     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
 938         (_("Failed to get value for control %d on device '%s'."),
 939             attribute_num, v4l2object->videodev), GST_ERROR_SYSTEM);
 940     return FALSE;
 941   }
 942 }
 943
 944
 945 /******************************************************
 946  * gst_v4l2_set_attribute():
 947  *   try to set the value of one specific attribute
 948  * return value: TRUE on success, FALSE on error
 949  ******************************************************/
 950 gboolean
 951 gst_v4l2_set_attribute (GstV4l2Object * v4l2object,
 952     int attribute_num, const int value)
 953 {
 954   struct v4l2_control control = { 0, };
 955
 956   GST_DEBUG_OBJECT (v4l2object->element, "setting value of attribute %d to %d",
 957       attribute_num, value);
 958
 959   if (!GST_V4L2_IS_OPEN (v4l2object))
 960     return FALSE;
 961
 962   control.id = attribute_num;
 963   control.value = value;
 964   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_CTRL, &control) < 0)
 965     goto ctrl_failed;
 966
 967   return TRUE;
 968
 969   /* ERRORS */
 970 ctrl_failed:
 971   {
 972     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
 973         (_("Failed to set value %d for control %d on device '%s'."),
 974             value, attribute_num, v4l2object->videodev), GST_ERROR_SYSTEM);
 975     return FALSE;
 976   }
 977 }
 978
 979 static gboolean
 980 set_contol (GQuark field_id, const GValue * value, gpointer user_data)
 981 {
 982   GstV4l2Object *v4l2object = user_data;
 983   gpointer *d = g_datalist_id_get_data (&v4l2object->controls, field_id);
 984   if (!d) {
 985     GST_WARNING_OBJECT (v4l2object,
 986         "Control '%s' does not exist or has an unsupported type.",
 987         g_quark_to_string (field_id));
 988     return TRUE;
 989   }
 990   if (!G_VALUE_HOLDS (value, G_TYPE_INT)) {
 991     GST_WARNING_OBJECT (v4l2object,
 992         "'int' value expected for control '%s'.", g_quark_to_string (field_id));
 993     return TRUE;
 994   }
 995   gst_v4l2_set_attribute (v4l2object, GPOINTER_TO_INT (d),
 996       g_value_get_int (value));
 997   return TRUE;
 998 }
 999
1000 gboolean
1001 gst_v4l2_set_controls (GstV4l2Object * v4l2object, GstStructure * controls)
1002 {
1003   return gst_structure_foreach (controls, set_contol, v4l2object);
1004 }
1005
1006 gboolean
1007 gst_v4l2_get_input (GstV4l2Object * v4l2object, gint * input)
1008 {
1009   gint n;
1010
1011   GST_DEBUG_OBJECT (v4l2object->element, "trying to get input");
1012
1013   if (!GST_V4L2_IS_OPEN (v4l2object))
1014     return FALSE;
1015
1016   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_INPUT, &n) < 0)
1017     goto input_failed;
1018
1019   *input = n;
1020
1021   GST_DEBUG_OBJECT (v4l2object->element, "input: %d", n);
1022
1023   return TRUE;
1024
1025   /* ERRORS */
1026 input_failed:
1027   if (v4l2object->vcap.capabilities & V4L2_CAP_TUNER) {
1028     /* only give a warning message if driver actually claims to have tuner
1029      * support
1030      */
1031     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1032         (_("Failed to get current input on device '%s'. May be it is a radio device"), v4l2object->videodev), GST_ERROR_SYSTEM);
1033   }
1034   return FALSE;
1035 }
1036
1037 gboolean
1038 gst_v4l2_set_input (GstV4l2Object * v4l2object, gint input)
1039 {
1040   GST_DEBUG_OBJECT (v4l2object->element, "trying to set input to %d", input);
1041
1042   if (!GST_V4L2_IS_OPEN (v4l2object))
1043     return FALSE;
1044
1045   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_INPUT, &input) < 0)
1046     goto input_failed;
1047
1048   return TRUE;
1049
1050   /* ERRORS */
1051 input_failed:
1052   if (v4l2object->vcap.capabilities & V4L2_CAP_TUNER) {
1053     /* only give a warning message if driver actually claims to have tuner
1054      * support
1055      */
1056     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1057         (_("Failed to set input %d on device %s."),
1058             input, v4l2object->videodev), GST_ERROR_SYSTEM);
1059   }
1060   return FALSE;
1061 }
1062
1063 gboolean
1064 gst_v4l2_get_output (GstV4l2Object * v4l2object, gint * output)
1065 {
1066   gint n;
1067
1068   GST_DEBUG_OBJECT (v4l2object->element, "trying to get output");
1069
1070   if (!GST_V4L2_IS_OPEN (v4l2object))
1071     return FALSE;
1072
1073   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_G_OUTPUT, &n) < 0)
1074     goto output_failed;
1075
1076   *output = n;
1077
1078   GST_DEBUG_OBJECT (v4l2object->element, "output: %d", n);
1079
1080   return TRUE;
1081
1082   /* ERRORS */
1083 output_failed:
1084   if (v4l2object->vcap.capabilities & V4L2_CAP_TUNER) {
1085     /* only give a warning message if driver actually claims to have tuner
1086      * support
1087      */
1088     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1089         (_("Failed to get current output on device '%s'. May be it is a radio device"), v4l2object->videodev), GST_ERROR_SYSTEM);
1090   }
1091   return FALSE;
1092 }
1093
1094 gboolean
1095 gst_v4l2_set_output (GstV4l2Object * v4l2object, gint output)
1096 {
1097   GST_DEBUG_OBJECT (v4l2object->element, "trying to set output to %d", output);
1098
1099   if (!GST_V4L2_IS_OPEN (v4l2object))
1100     return FALSE;
1101
1102   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_S_OUTPUT, &output) < 0)
1103     goto output_failed;
1104
1105   return TRUE;
1106
1107   /* ERRORS */
1108 output_failed:
1109   if (v4l2object->vcap.capabilities & V4L2_CAP_TUNER) {
1110     /* only give a warning message if driver actually claims to have tuner
1111      * support
1112      */
1113     GST_ELEMENT_WARNING (v4l2object->element, RESOURCE, SETTINGS,
1114         (_("Failed to set output %d on device %s."),
1115             output, v4l2object->videodev), GST_ERROR_SYSTEM);
1116   }
1117   return FALSE;
1118 }