sys/v4l2/gstv4l2object.c

   1 /* GStreamer
   2  *
   3  * Copyright (C) 2001-2002 Ronald Bultje <rbultje@ronald.bitfreak.net>
   4  *               2006 Edgard Lima <edgard.lima@indt.org.br>
   5  *
   6  * gstv4l2object.c: base class for V4L2 elements
   7  *
   8  * This library is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU Library General Public License as published
  10  * by the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version. This library is distributed in the hope
  12  * that it will be useful, but WITHOUT ANY WARRANTY; without even the
  13  * implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
  14  * PURPOSE.  See the GNU Library General Public License for more details.
  15  * You should have received a copy of the GNU Library General Public
  16  * License along with this library; if not, write to the Free Software
  17  * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307,
  18  * USA.
  19  */
  20
  21 #ifdef HAVE_CONFIG_H
  22 #include <config.h>
  23 #endif
  24
  25 #include <sys/stat.h>
  26 #include <fcntl.h>
  27 #include <errno.h>
  28 #include <unistd.h>
  29 #include <string.h>
  30
  31 #ifdef HAVE_GUDEV
  32 #include <gudev/gudev.h>
  33 #endif
  34
  35 #include "v4l2_calls.h"
  36 #include "gstv4l2tuner.h"
  37 #ifdef HAVE_XVIDEO
  38 #include "gstv4l2xoverlay.h"
  39 #endif
  40 #include "gstv4l2colorbalance.h"
  41
  42 #include "gst/gst-i18n-plugin.h"
  43
  44 /* videodev2.h is not versioned and we can't easily check for the presence
  45  * of enum values at compile time, but the V4L2_CAP_VIDEO_OUTPUT_OVERLAY define
  46  * was added in the same commit as V4L2_FIELD_INTERLACED_{TB,BT} (b2787845) */
  47 #ifndef V4L2_CAP_VIDEO_OUTPUT_OVERLAY
  48 #define V4L2_FIELD_INTERLACED_TB 8
  49 #define V4L2_FIELD_INTERLACED_BT 9
  50 #endif
  51
  52 GST_DEBUG_CATEGORY_EXTERN (v4l2_debug);
  53 #define GST_CAT_DEFAULT v4l2_debug
  54
  55
  56 #define DEFAULT_PROP_DEVICE_NAME        NULL
  57 #define DEFAULT_PROP_DEVICE_FD          -1
  58 #define DEFAULT_PROP_FLAGS              0
  59 #define DEFAULT_PROP_NORM               NULL
  60 #define DEFAULT_PROP_CHANNEL            NULL
  61 #define DEFAULT_PROP_FREQUENCY          0
  62
  63 enum
  64 {
  65   PROP_0,
  66   V4L2_STD_OBJECT_PROPS,
  67 };
  68
  69 const GList *
  70 gst_v4l2_probe_get_properties (GstPropertyProbe * probe)
  71 {
  72   GObjectClass *klass = G_OBJECT_GET_CLASS (probe);
  73   static GList *list = NULL;
  74
  75   /* well, not perfect, but better than no locking at all.
  76    * In the worst case we leak a list node, so who cares? */
  77   GST_CLASS_LOCK (GST_OBJECT_CLASS (klass));
  78
  79   if (!list) {
  80     list = g_list_append (NULL, g_object_class_find_property (klass, "device"));
  81   }
  82
  83   GST_CLASS_UNLOCK (GST_OBJECT_CLASS (klass));
  84
  85   return list;
  86 }
  87
  88 static gboolean init = FALSE;
  89 static GList *devices = NULL;
  90
  91 #ifdef HAVE_GUDEV
  92 static gboolean
  93 gst_v4l2_class_probe_devices_with_udev (GstElementClass * klass, gboolean check,
  94     GList ** klass_devices)
  95 {
  96   GUdevClient *client = NULL;
  97   GList *item;
  98
  99   if (!check) {
 100     while (devices) {
 101       gchar *device = devices->data;
 102       devices = g_list_remove (devices, device);
 103       g_free (device);
 104     }
 105
 106     GST_INFO ("Enumerating video4linux devices from udev");
 107     client = g_udev_client_new (NULL);
 108     if (!client) {
 109       GST_WARNING ("Failed to initialize gudev client");
 110       goto finish;
 111     }
 112
 113     item = g_udev_client_query_by_subsystem (client, "video4linux");
 114     while (item) {
 115       GUdevDevice *device = item->data;
 116       gchar *devnode = g_strdup (g_udev_device_get_device_file (device));
 117       gint api = g_udev_device_get_property_as_int (device, "ID_V4L_VERSION");
 118       GST_INFO ("Found new device: %s, API: %d", devnode, api);
 119       /* Append v4l2 devices only. If api is 0 probably v4l_id has
 120          been stripped out of the current udev installation, append
 121          anyway */
 122       if (api == 0) {
 123         GST_WARNING
 124             ("Couldn't retrieve ID_V4L_VERSION, silly udev installation?");
 125       }
 126       if ((api == 2 || api == 0)) {
 127         devices = g_list_append (devices, devnode);
 128       } else {
 129         g_free (devnode);
 130       }
 131       g_object_unref (device);
 132       item = item->next;
 133     }
 134     g_list_free (item);
 135     init = TRUE;
 136   }
 137
 138 finish:
 139   if (client) {
 140     g_object_unref (client);
 141   }
 142
 143   *klass_devices = devices;
 144
 145   return init;
 146 }
 147 #endif /* HAVE_GUDEV */
 148
 149 static gboolean
 150 gst_v4l2_class_probe_devices (GstElementClass * klass, gboolean check,
 151     GList ** klass_devices)
 152 {
 153   if (!check) {
 154     const gchar *dev_base[] = { "/dev/video", "/dev/v4l2/video", NULL };
 155     gint base, n, fd;
 156
 157     while (devices) {
 158       gchar *device = devices->data;
 159       devices = g_list_remove (devices, device);
 160       g_free (device);
 161     }
 162
 163     /*
 164      * detect /dev entries
 165      */
 166     for (n = 0; n < 64; n++) {
 167       for (base = 0; dev_base[base] != NULL; base++) {
 168         struct stat s;
 169         gchar *device = g_strdup_printf ("%s%d",
 170             dev_base[base],
 171             n);
 172
 173         /*
 174          * does the /dev/ entry exist at all?
 175          */
 176         if (stat (device, &s) == 0) {
 177           /*
 178            * yes: is a device attached?
 179            */
 180           if (S_ISCHR (s.st_mode)) {
 181
 182             if ((fd = open (device, O_RDWR | O_NONBLOCK)) > 0 || errno == EBUSY) {
 183               if (fd > 0)
 184                 close (fd);
 185
 186               devices = g_list_append (devices, device);
 187               break;
 188             }
 189           }
 190         }
 191         g_free (device);
 192       }
 193     }
 194     init = TRUE;
 195   }
 196
 197   *klass_devices = devices;
 198
 199   return init;
 200 }
 201
 202 void
 203 gst_v4l2_probe_probe_property (GstPropertyProbe * probe,
 204     guint prop_id, const GParamSpec * pspec, GList ** klass_devices)
 205 {
 206   GstElementClass *klass = GST_ELEMENT_GET_CLASS (probe);
 207
 208   switch (prop_id) {
 209     case PROP_DEVICE:
 210 #ifdef HAVE_GUDEV
 211       if (!gst_v4l2_class_probe_devices_with_udev (klass, FALSE, klass_devices))
 212         gst_v4l2_class_probe_devices (klass, FALSE, klass_devices);
 213 #else /* !HAVE_GUDEV */
 214       gst_v4l2_class_probe_devices (klass, FALSE, klass_devices);
 215 #endif /* HAVE_GUDEV */
 216       break;
 217     default:
 218       G_OBJECT_WARN_INVALID_PROPERTY_ID (probe, prop_id, pspec);
 219       break;
 220   }
 221 }
 222
 223 gboolean
 224 gst_v4l2_probe_needs_probe (GstPropertyProbe * probe,
 225     guint prop_id, const GParamSpec * pspec, GList ** klass_devices)
 226 {
 227   GstElementClass *klass = GST_ELEMENT_GET_CLASS (probe);
 228   gboolean ret = FALSE;
 229
 230   switch (prop_id) {
 231     case PROP_DEVICE:
 232 #ifdef HAVE_GUDEV
 233       ret =
 234           !gst_v4l2_class_probe_devices_with_udev (klass, FALSE, klass_devices);
 235 #else /* !HAVE_GUDEV */
 236       ret = !gst_v4l2_class_probe_devices (klass, TRUE, klass_devices);
 237 #endif /* HAVE_GUDEV */
 238       break;
 239     default:
 240       G_OBJECT_WARN_INVALID_PROPERTY_ID (probe, prop_id, pspec);
 241       break;
 242   }
 243   return ret;
 244 }
 245
 246 static GValueArray *
 247 gst_v4l2_class_list_devices (GstElementClass * klass, GList ** klass_devices)
 248 {
 249   GValueArray *array;
 250   GValue value = { 0 };
 251   GList *item;
 252
 253   if (!*klass_devices)
 254     return NULL;
 255
 256   array = g_value_array_new (g_list_length (*klass_devices));
 257   item = *klass_devices;
 258   g_value_init (&value, G_TYPE_STRING);
 259   while (item) {
 260     gchar *device = item->data;
 261
 262     g_value_set_string (&value, device);
 263     g_value_array_append (array, &value);
 264
 265     item = item->next;
 266   }
 267   g_value_unset (&value);
 268
 269   return array;
 270 }
 271
 272 GValueArray *
 273 gst_v4l2_probe_get_values (GstPropertyProbe * probe,
 274     guint prop_id, const GParamSpec * pspec, GList ** klass_devices)
 275 {
 276   GstElementClass *klass = GST_ELEMENT_GET_CLASS (probe);
 277   GValueArray *array = NULL;
 278
 279   switch (prop_id) {
 280     case PROP_DEVICE:
 281       array = gst_v4l2_class_list_devices (klass, klass_devices);
 282       break;
 283     default:
 284       G_OBJECT_WARN_INVALID_PROPERTY_ID (probe, prop_id, pspec);
 285       break;
 286   }
 287
 288   return array;
 289 }
 290
 291 #define GST_TYPE_V4L2_DEVICE_FLAGS (gst_v4l2_device_get_type ())
 292 static GType
 293 gst_v4l2_device_get_type (void)
 294 {
 295   static GType v4l2_device_type = 0;
 296
 297   if (v4l2_device_type == 0) {
 298     static const GFlagsValue values[] = {
 299       {V4L2_CAP_VIDEO_CAPTURE, "Device supports video capture", "capture"},
 300       {V4L2_CAP_VIDEO_OUTPUT, "Device supports video playback", "output"},
 301       {V4L2_CAP_VIDEO_OVERLAY, "Device supports video overlay", "overlay"},
 302
 303       {V4L2_CAP_VBI_CAPTURE, "Device supports the VBI capture", "vbi-capture"},
 304       {V4L2_CAP_VBI_OUTPUT, "Device supports the VBI output", "vbi-output"},
 305
 306       {V4L2_CAP_TUNER, "Device has a tuner or modulator", "tuner"},
 307       {V4L2_CAP_AUDIO, "Device has audio inputs or outputs", "audio"},
 308
 309       {0, NULL, NULL}
 310     };
 311
 312     v4l2_device_type =
 313         g_flags_register_static ("GstV4l2DeviceTypeFlags", values);
 314   }
 315
 316   return v4l2_device_type;
 317 }
 318
 319 void
 320 gst_v4l2_object_install_properties_helper (GObjectClass * gobject_class,
 321     const char *default_device)
 322 {
 323   g_object_class_install_property (gobject_class, PROP_DEVICE,
 324       g_param_spec_string ("device", "Device", "Device location",
 325           default_device, G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS));
 326   g_object_class_install_property (gobject_class, PROP_DEVICE_NAME,
 327       g_param_spec_string ("device-name", "Device name",
 328           "Name of the device", DEFAULT_PROP_DEVICE_NAME,
 329           G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
 330   g_object_class_install_property (gobject_class, PROP_DEVICE_FD,
 331       g_param_spec_int ("device-fd", "File descriptor",
 332           "File descriptor of the device", -1, G_MAXINT, DEFAULT_PROP_DEVICE_FD,
 333           G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
 334   g_object_class_install_property (gobject_class, PROP_FLAGS,
 335       g_param_spec_flags ("flags", "Flags", "Device type flags",
 336           GST_TYPE_V4L2_DEVICE_FLAGS, DEFAULT_PROP_FLAGS,
 337           G_PARAM_READABLE | G_PARAM_STATIC_STRINGS));
 338
 339   /**
 340    * GstV4l2Src:brightness
 341    *
 342    * Picture brightness, or more precisely, the black level
 343    *
 344    * Since: 0.10.26
 345    */
 346   g_object_class_install_property (gobject_class, PROP_BRIGHTNESS,
 347       g_param_spec_int ("brightness", "Brightness",
 348           "Picture brightness, or more precisely, the black level", G_MININT,
 349           G_MAXINT, 0,
 350           G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
 351   /**
 352    * GstV4l2Src:contrast
 353    *
 354    * Picture contrast or luma gain
 355    *
 356    * Since: 0.10.26
 357    */
 358   g_object_class_install_property (gobject_class, PROP_CONTRAST,
 359       g_param_spec_int ("contrast", "Contrast",
 360           "Picture contrast or luma gain", G_MININT,
 361           G_MAXINT, 0,
 362           G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
 363   /**
 364    * GstV4l2Src:saturation
 365    *
 366    * Picture color saturation or chroma gain
 367    *
 368    * Since: 0.10.26
 369    */
 370   g_object_class_install_property (gobject_class, PROP_SATURATION,
 371       g_param_spec_int ("saturation", "Saturation",
 372           "Picture color saturation or chroma gain", G_MININT,
 373           G_MAXINT, 0,
 374           G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
 375   /**
 376    * GstV4l2Src:hue
 377    *
 378    * Hue or color balance
 379    *
 380    * Since: 0.10.26
 381    */
 382   g_object_class_install_property (gobject_class, PROP_HUE,
 383       g_param_spec_int ("hue", "Hue",
 384           "Hue or color balance", G_MININT,
 385           G_MAXINT, 0,
 386           G_PARAM_READWRITE | G_PARAM_STATIC_STRINGS | GST_PARAM_CONTROLLABLE));
 387 }
 388
 389 GstV4l2Object *
 390 gst_v4l2_object_new (GstElement * element,
 391     enum v4l2_buf_type type,
 392     const char *default_device,
 393     GstV4l2GetInOutFunction get_in_out_func,
 394     GstV4l2SetInOutFunction set_in_out_func,
 395     GstV4l2UpdateFpsFunction update_fps_func)
 396 {
 397   GstV4l2Object *v4l2object;
 398
 399   /*
 400    * some default values
 401    */
 402   v4l2object = g_new0 (GstV4l2Object, 1);
 403
 404   v4l2object->type = type;
 405   v4l2object->formats = NULL;
 406
 407   v4l2object->element = element;
 408   v4l2object->get_in_out_func = get_in_out_func;
 409   v4l2object->set_in_out_func = set_in_out_func;
 410   v4l2object->update_fps_func = update_fps_func;
 411
 412   v4l2object->video_fd = -1;
 413   v4l2object->poll = gst_poll_new (TRUE);
 414   v4l2object->buffer = NULL;
 415   v4l2object->videodev = g_strdup (default_device);
 416
 417   v4l2object->norms = NULL;
 418   v4l2object->channels = NULL;
 419   v4l2object->colors = NULL;
 420
 421   v4l2object->xwindow_id = 0;
 422
 423   return v4l2object;
 424 }
 425
 426 static gboolean gst_v4l2_object_clear_format_list (GstV4l2Object * v4l2object);
 427
 428
 429 void
 430 gst_v4l2_object_destroy (GstV4l2Object * v4l2object)
 431 {
 432   g_return_if_fail (v4l2object != NULL);
 433
 434   if (v4l2object->videodev)
 435     g_free (v4l2object->videodev);
 436
 437   if (v4l2object->poll)
 438     gst_poll_free (v4l2object->poll);
 439
 440   if (v4l2object->channel)
 441     g_free (v4l2object->channel);
 442
 443   if (v4l2object->norm)
 444     g_free (v4l2object->norm);
 445
 446   if (v4l2object->formats) {
 447     gst_v4l2_object_clear_format_list (v4l2object);
 448   }
 449
 450   g_free (v4l2object);
 451 }
 452
 453
 454 static gboolean
 455 gst_v4l2_object_clear_format_list (GstV4l2Object * v4l2object)
 456 {
 457   g_slist_foreach (v4l2object->formats, (GFunc) g_free, NULL);
 458   g_slist_free (v4l2object->formats);
 459   v4l2object->formats = NULL;
 460
 461   return TRUE;
 462 }
 463
 464 static gint
 465 gst_v4l2_object_prop_to_cid (guint prop_id)
 466 {
 467   gint cid = -1;
 468
 469   switch (prop_id) {
 470     case PROP_BRIGHTNESS:
 471       cid = V4L2_CID_BRIGHTNESS;
 472       break;
 473     case PROP_CONTRAST:
 474       cid = V4L2_CID_CONTRAST;
 475       break;
 476     case PROP_SATURATION:
 477       cid = V4L2_CID_SATURATION;
 478       break;
 479     case PROP_HUE:
 480       cid = V4L2_CID_HUE;
 481       break;
 482     default:
 483       GST_WARNING ("unmapped property id: %d", prop_id);
 484   }
 485   return cid;
 486 }
 487
 488
 489 gboolean
 490 gst_v4l2_object_set_property_helper (GstV4l2Object * v4l2object,
 491     guint prop_id, const GValue * value, GParamSpec * pspec)
 492 {
 493   switch (prop_id) {
 494     case PROP_DEVICE:
 495       g_free (v4l2object->videodev);
 496       v4l2object->videodev = g_value_dup_string (value);
 497       break;
 498     case PROP_BRIGHTNESS:
 499     case PROP_CONTRAST:
 500     case PROP_SATURATION:
 501     case PROP_HUE:
 502     {
 503       gint cid = gst_v4l2_object_prop_to_cid (prop_id);
 504
 505       if (cid != -1) {
 506         if (GST_V4L2_IS_OPEN (v4l2object)) {
 507           gst_v4l2_set_attribute (v4l2object, cid, g_value_get_int (value));
 508         }
 509       }
 510       return TRUE;
 511     }
 512       break;
 513 #if 0
 514     case PROP_NORM:
 515       if (GST_V4L2_IS_OPEN (v4l2object)) {
 516         GstTuner *tuner = GST_TUNER (v4l2object->element);
 517         GstTunerNorm *norm = gst_tuner_find_norm_by_name (tuner,
 518             (gchar *) g_value_get_string (value));
 519
 520         if (norm) {
 521           /* like gst_tuner_set_norm (tuner, norm)
 522              without g_object_notify */
 523           gst_v4l2_tuner_set_norm (v4l2object, norm);
 524         }
 525       } else {
 526         g_free (v4l2object->norm);
 527         v4l2object->norm = g_value_dup_string (value);
 528       }
 529       break;
 530     case PROP_CHANNEL:
 531       if (GST_V4L2_IS_OPEN (v4l2object)) {
 532         GstTuner *tuner = GST_TUNER (v4l2object->element);
 533         GstTunerChannel *channel = gst_tuner_find_channel_by_name (tuner,
 534             (gchar *) g_value_get_string (value));
 535
 536         if (channel) {
 537           /* like gst_tuner_set_channel (tuner, channel)
 538              without g_object_notify */
 539           gst_v4l2_tuner_set_channel (v4l2object, channel);
 540         }
 541       } else {
 542         g_free (v4l2object->channel);
 543         v4l2object->channel = g_value_dup_string (value);
 544       }
 545       break;
 546     case PROP_FREQUENCY:
 547       if (GST_V4L2_IS_OPEN (v4l2object)) {
 548         GstTuner *tuner = GST_TUNER (v4l2object->element);
 549         GstTunerChannel *channel = gst_tuner_get_channel (tuner);
 550
 551         if (channel &&
 552             GST_TUNER_CHANNEL_HAS_FLAG (channel, GST_TUNER_CHANNEL_FREQUENCY)) {
 553           /* like
 554              gst_tuner_set_frequency (tuner, channel, g_value_get_ulong (value))
 555              without g_object_notify */
 556           gst_v4l2_tuner_set_frequency (v4l2object, channel,
 557               g_value_get_ulong (value));
 558         }
 559       } else {
 560         v4l2object->frequency = g_value_get_ulong (value);
 561       }
 562       break;
 563 #endif
 564     default:
 565       return FALSE;
 566       break;
 567   }
 568   return TRUE;
 569 }
 570
 571
 572 gboolean
 573 gst_v4l2_object_get_property_helper (GstV4l2Object * v4l2object,
 574     guint prop_id, GValue * value, GParamSpec * pspec)
 575 {
 576   switch (prop_id) {
 577     case PROP_DEVICE:
 578       g_value_set_string (value, v4l2object->videodev);
 579       break;
 580     case PROP_DEVICE_NAME:
 581     {
 582       const guchar *new = NULL;
 583
 584       if (GST_V4L2_IS_OPEN (v4l2object)) {
 585         new = v4l2object->vcap.card;
 586       } else if (gst_v4l2_open (v4l2object)) {
 587         new = v4l2object->vcap.card;
 588         gst_v4l2_close (v4l2object);
 589       }
 590       g_value_set_string (value, (gchar *) new);
 591       break;
 592     }
 593     case PROP_DEVICE_FD:
 594     {
 595       if (GST_V4L2_IS_OPEN (v4l2object))
 596         g_value_set_int (value, v4l2object->video_fd);
 597       else
 598         g_value_set_int (value, DEFAULT_PROP_DEVICE_FD);
 599       break;
 600     }
 601     case PROP_FLAGS:
 602     {
 603       guint flags = 0;
 604
 605       if (GST_V4L2_IS_OPEN (v4l2object)) {
 606         flags |= v4l2object->vcap.capabilities &
 607             (V4L2_CAP_VIDEO_CAPTURE |
 608             V4L2_CAP_VIDEO_OUTPUT |
 609             V4L2_CAP_VIDEO_OVERLAY |
 610             V4L2_CAP_VBI_CAPTURE |
 611             V4L2_CAP_VBI_OUTPUT | V4L2_CAP_TUNER | V4L2_CAP_AUDIO);
 612       }
 613       g_value_set_flags (value, flags);
 614       break;
 615     }
 616     case PROP_BRIGHTNESS:
 617     case PROP_CONTRAST:
 618     case PROP_SATURATION:
 619     case PROP_HUE:
 620     {
 621       gint cid = gst_v4l2_object_prop_to_cid (prop_id);
 622
 623       if (cid != -1) {
 624         if (GST_V4L2_IS_OPEN (v4l2object)) {
 625           gint v;
 626           if (gst_v4l2_get_attribute (v4l2object, cid, &v)) {
 627             g_value_set_int (value, v);
 628           }
 629         }
 630       }
 631       return TRUE;
 632     }
 633       break;
 634     default:
 635       return FALSE;
 636       break;
 637   }
 638   return TRUE;
 639 }
 640
 641 static void
 642 gst_v4l2_set_defaults (GstV4l2Object * v4l2object)
 643 {
 644   GstTunerNorm *norm = NULL;
 645   GstTunerChannel *channel = NULL;
 646   GstTuner *tuner;
 647
 648   if (!GST_IS_TUNER (v4l2object->element))
 649     return;
 650
 651   tuner = GST_TUNER (v4l2object->element);
 652
 653   if (v4l2object->norm)
 654     norm = gst_tuner_find_norm_by_name (tuner, v4l2object->norm);
 655   if (norm) {
 656     gst_tuner_set_norm (tuner, norm);
 657   } else {
 658     norm =
 659         GST_TUNER_NORM (gst_tuner_get_norm (GST_TUNER (v4l2object->element)));
 660     if (norm) {
 661       g_free (v4l2object->norm);
 662       v4l2object->norm = g_strdup (norm->label);
 663       gst_tuner_norm_changed (tuner, norm);
 664     }
 665   }
 666
 667   if (v4l2object->channel)
 668     channel = gst_tuner_find_channel_by_name (tuner, v4l2object->channel);
 669   if (channel) {
 670     gst_tuner_set_channel (tuner, channel);
 671   } else {
 672     channel =
 673         GST_TUNER_CHANNEL (gst_tuner_get_channel (GST_TUNER
 674             (v4l2object->element)));
 675     if (channel) {
 676       g_free (v4l2object->channel);
 677       v4l2object->channel = g_strdup (channel->label);
 678       gst_tuner_channel_changed (tuner, channel);
 679     }
 680   }
 681
 682   if (channel
 683       && GST_TUNER_CHANNEL_HAS_FLAG (channel, GST_TUNER_CHANNEL_FREQUENCY)) {
 684     if (v4l2object->frequency != 0) {
 685       gst_tuner_set_frequency (tuner, channel, v4l2object->frequency);
 686     } else {
 687       v4l2object->frequency = gst_tuner_get_frequency (tuner, channel);
 688       if (v4l2object->frequency == 0) {
 689         /* guess */
 690         gst_tuner_set_frequency (tuner, channel, 1000);
 691       } else {
 692       }
 693     }
 694   }
 695 }
 696
 697 gboolean
 698 gst_v4l2_object_start (GstV4l2Object * v4l2object)
 699 {
 700   if (gst_v4l2_open (v4l2object))
 701     gst_v4l2_set_defaults (v4l2object);
 702   else
 703     return FALSE;
 704
 705 #ifdef HAVE_XVIDEO
 706   gst_v4l2_xoverlay_start (v4l2object);
 707 #endif
 708
 709   return TRUE;
 710 }
 711
 712 gboolean
 713 gst_v4l2_object_stop (GstV4l2Object * v4l2object)
 714 {
 715 #ifdef HAVE_XVIDEO
 716   gst_v4l2_xoverlay_stop (v4l2object);
 717 #endif
 718
 719   if (!gst_v4l2_close (v4l2object))
 720     return FALSE;
 721
 722   if (v4l2object->formats) {
 723     gst_v4l2_object_clear_format_list (v4l2object);
 724   }
 725
 726   return TRUE;
 727 }
 728
 729
 730 /*
 731  * common format / caps utilities:
 732  */
 733 typedef struct
 734 {
 735   guint32 format;
 736   gboolean dimensions;
 737 } GstV4L2FormatDesc;
 738
 739 static const GstV4L2FormatDesc gst_v4l2_formats[] = {
 740   /* from Linux 2.6.15 videodev2.h */
 741   {V4L2_PIX_FMT_RGB332, TRUE},
 742   {V4L2_PIX_FMT_RGB555, TRUE},
 743   {V4L2_PIX_FMT_RGB565, TRUE},
 744   {V4L2_PIX_FMT_RGB555X, TRUE},
 745   {V4L2_PIX_FMT_RGB565X, TRUE},
 746   {V4L2_PIX_FMT_BGR24, TRUE},
 747   {V4L2_PIX_FMT_RGB24, TRUE},
 748   {V4L2_PIX_FMT_BGR32, TRUE},
 749   {V4L2_PIX_FMT_RGB32, TRUE},
 750   {V4L2_PIX_FMT_GREY, TRUE},
 751   {V4L2_PIX_FMT_YVU410, TRUE},
 752   {V4L2_PIX_FMT_YVU420, TRUE},
 753   {V4L2_PIX_FMT_YUYV, TRUE},
 754   {V4L2_PIX_FMT_UYVY, TRUE},
 755   {V4L2_PIX_FMT_YUV422P, TRUE},
 756   {V4L2_PIX_FMT_YUV411P, TRUE},
 757   {V4L2_PIX_FMT_Y41P, TRUE},
 758
 759   /* two planes -- one Y, one Cr + Cb interleaved  */
 760   {V4L2_PIX_FMT_NV12, TRUE},
 761   {V4L2_PIX_FMT_NV21, TRUE},
 762
 763   /*  The following formats are not defined in the V4L2 specification */
 764   {V4L2_PIX_FMT_YUV410, TRUE},
 765   {V4L2_PIX_FMT_YUV420, TRUE},
 766   {V4L2_PIX_FMT_YYUV, TRUE},
 767   {V4L2_PIX_FMT_HI240, TRUE},
 768
 769   /* see http://www.siliconimaging.com/RGB%20Bayer.htm */
 770 #ifdef V4L2_PIX_FMT_SBGGR8
 771   {V4L2_PIX_FMT_SBGGR8, TRUE},
 772 #endif
 773
 774   /* compressed formats */
 775   {V4L2_PIX_FMT_MJPEG, TRUE},
 776   {V4L2_PIX_FMT_JPEG, TRUE},
 777   {V4L2_PIX_FMT_DV, TRUE},
 778   {V4L2_PIX_FMT_MPEG, FALSE},
 779
 780   /*  Vendor-specific formats   */
 781   {V4L2_PIX_FMT_WNVA, TRUE},
 782
 783 #ifdef V4L2_PIX_FMT_SN9C10X
 784   {V4L2_PIX_FMT_SN9C10X, TRUE},
 785 #endif
 786 #ifdef V4L2_PIX_FMT_PWC1
 787   {V4L2_PIX_FMT_PWC1, TRUE},
 788 #endif
 789 #ifdef V4L2_PIX_FMT_PWC2
 790   {V4L2_PIX_FMT_PWC2, TRUE},
 791 #endif
 792 #ifdef V4L2_PIX_FMT_YVYU
 793   {V4L2_PIX_FMT_YVYU, TRUE},
 794 #endif
 795 };
 796
 797 #define GST_V4L2_FORMAT_COUNT (G_N_ELEMENTS (gst_v4l2_formats))
 798
 799
 800 static struct v4l2_fmtdesc *
 801 gst_v4l2_object_get_format_from_fourcc (GstV4l2Object * v4l2object,
 802     guint32 fourcc)
 803 {
 804   struct v4l2_fmtdesc *fmt;
 805   GSList *walk;
 806
 807   if (fourcc == 0)
 808     return NULL;
 809
 810   walk = gst_v4l2_object_get_format_list (v4l2object);
 811   while (walk) {
 812     fmt = (struct v4l2_fmtdesc *) walk->data;
 813     if (fmt->pixelformat == fourcc)
 814       return fmt;
 815     /* special case for jpeg */
 816     if ((fmt->pixelformat == V4L2_PIX_FMT_MJPEG && fourcc == V4L2_PIX_FMT_JPEG)
 817         || (fmt->pixelformat == V4L2_PIX_FMT_JPEG
 818             && fourcc == V4L2_PIX_FMT_MJPEG)) {
 819       return fmt;
 820     }
 821     walk = g_slist_next (walk);
 822   }
 823
 824   return NULL;
 825 }
 826
 827
 828
 829 /* complete made up ranking, the values themselves are meaningless */
 830 #define YUV_BASE_RANK     1000
 831 #define JPEG_BASE_RANK     500
 832 #define DV_BASE_RANK       200
 833 #define RGB_BASE_RANK      100
 834 #define YUV_ODD_BASE_RANK   50
 835 #define RGB_ODD_BASE_RANK   25
 836 #define BAYER_BASE_RANK     15
 837 #define S910_BASE_RANK      10
 838 #define GREY_BASE_RANK       5
 839 #define PWC_BASE_RANK        1
 840
 841 /* This flag is already used by libv4l2 although
 842  * it was added to the Linux kernel in 2.6.32
 843  */
 844 #ifndef V4L2_FMT_FLAG_EMULATED
 845 #define V4L2_FMT_FLAG_EMULATED 0x0002
 846 #endif
 847
 848 static gint
 849 gst_v4l2_object_format_get_rank (const struct v4l2_fmtdesc *fmt)
 850 {
 851   guint32 fourcc = fmt->pixelformat;
 852   gboolean emulated = ((fmt->flags & V4L2_FMT_FLAG_EMULATED) != 0);
 853   gint rank = 0;
 854
 855   switch (fourcc) {
 856     case V4L2_PIX_FMT_MJPEG:
 857       rank = JPEG_BASE_RANK;
 858       break;
 859     case V4L2_PIX_FMT_JPEG:
 860       rank = JPEG_BASE_RANK + 1;
 861       break;
 862     case V4L2_PIX_FMT_MPEG:    /* MPEG          */
 863       rank = JPEG_BASE_RANK + 2;
 864       break;
 865
 866     case V4L2_PIX_FMT_RGB332:
 867     case V4L2_PIX_FMT_RGB555:
 868     case V4L2_PIX_FMT_RGB555X:
 869     case V4L2_PIX_FMT_RGB565:
 870     case V4L2_PIX_FMT_RGB565X:
 871       rank = RGB_ODD_BASE_RANK;
 872       break;
 873
 874     case V4L2_PIX_FMT_RGB24:
 875     case V4L2_PIX_FMT_BGR24:
 876       rank = RGB_BASE_RANK - 1;
 877       break;
 878
 879     case V4L2_PIX_FMT_RGB32:
 880     case V4L2_PIX_FMT_BGR32:
 881       rank = RGB_BASE_RANK;
 882       break;
 883
 884     case V4L2_PIX_FMT_GREY:    /*  8  Greyscale     */
 885       rank = GREY_BASE_RANK;
 886       break;
 887
 888     case V4L2_PIX_FMT_NV12:    /* 12  Y/CbCr 4:2:0  */
 889     case V4L2_PIX_FMT_NV21:    /* 12  Y/CrCb 4:2:0  */
 890     case V4L2_PIX_FMT_YYUV:    /* 16  YUV 4:2:2     */
 891     case V4L2_PIX_FMT_HI240:   /*  8  8-bit color   */
 892       rank = YUV_ODD_BASE_RANK;
 893       break;
 894
 895     case V4L2_PIX_FMT_YVU410:  /* YVU9,  9 bits per pixel */
 896       rank = YUV_BASE_RANK + 3;
 897       break;
 898     case V4L2_PIX_FMT_YUV410:  /* YUV9,  9 bits per pixel */
 899       rank = YUV_BASE_RANK + 2;
 900       break;
 901     case V4L2_PIX_FMT_YUV420:  /* I420, 12 bits per pixel */
 902       rank = YUV_BASE_RANK + 7;
 903       break;
 904     case V4L2_PIX_FMT_YUYV:    /* YUY2, 16 bits per pixel */
 905       rank = YUV_BASE_RANK + 10;
 906       break;
 907     case V4L2_PIX_FMT_YVU420:  /* YV12, 12 bits per pixel */
 908       rank = YUV_BASE_RANK + 6;
 909       break;
 910     case V4L2_PIX_FMT_UYVY:    /* UYVY, 16 bits per pixel */
 911       rank = YUV_BASE_RANK + 9;
 912       break;
 913     case V4L2_PIX_FMT_Y41P:    /* Y41P, 12 bits per pixel */
 914       rank = YUV_BASE_RANK + 5;
 915       break;
 916     case V4L2_PIX_FMT_YUV411P: /* Y41B, 12 bits per pixel */
 917       rank = YUV_BASE_RANK + 4;
 918       break;
 919     case V4L2_PIX_FMT_YUV422P: /* Y42B, 16 bits per pixel */
 920       rank = YUV_BASE_RANK + 8;
 921       break;
 922
 923     case V4L2_PIX_FMT_DV:
 924       rank = DV_BASE_RANK;
 925       break;
 926
 927     case V4L2_PIX_FMT_WNVA:    /* Winnov hw compres */
 928       rank = 0;
 929       break;
 930
 931 #ifdef V4L2_PIX_FMT_SBGGR8
 932     case V4L2_PIX_FMT_SBGGR8:
 933       rank = BAYER_BASE_RANK;
 934       break;
 935 #endif
 936
 937 #ifdef V4L2_PIX_FMT_SN9C10X
 938     case V4L2_PIX_FMT_SN9C10X:
 939       rank = S910_BASE_RANK;
 940       break;
 941 #endif
 942
 943 #ifdef V4L2_PIX_FMT_PWC1
 944     case V4L2_PIX_FMT_PWC1:
 945       rank = PWC_BASE_RANK;
 946       break;
 947 #endif
 948 #ifdef V4L2_PIX_FMT_PWC2
 949     case V4L2_PIX_FMT_PWC2:
 950       rank = PWC_BASE_RANK;
 951       break;
 952 #endif
 953
 954     default:
 955       rank = 0;
 956       break;
 957   }
 958
 959   /* All ranks are below 1<<15 so a shift by 15
 960    * will a) make all non-emulated formats larger
 961    * than emulated and b) will not overflow
 962    */
 963   if (!emulated)
 964     rank <<= 15;
 965
 966   return rank;
 967 }
 968
 969
 970
 971 static gint
 972 format_cmp_func (gconstpointer a, gconstpointer b)
 973 {
 974   const struct v4l2_fmtdesc *fa = a;
 975   const struct v4l2_fmtdesc *fb = b;
 976
 977   if (fa->pixelformat == fb->pixelformat)
 978     return 0;
 979
 980   return gst_v4l2_object_format_get_rank (fb) -
 981       gst_v4l2_object_format_get_rank (fa);
 982 }
 983
 984 /******************************************************
 985  * gst_v4l2_object_fill_format_list():
 986  *   create list of supported capture formats
 987  * return value: TRUE on success, FALSE on error
 988  ******************************************************/
 989 static gboolean
 990 gst_v4l2_object_fill_format_list (GstV4l2Object * v4l2object)
 991 {
 992   gint n;
 993   struct v4l2_fmtdesc *format;
 994
 995   GST_DEBUG_OBJECT (v4l2object->element, "getting src format enumerations");
 996
 997   /* format enumeration */
 998   for (n = 0;; n++) {
 999     format = g_new0 (struct v4l2_fmtdesc, 1);
1000
1001     format->index = n;
1002     format->type = v4l2object->type;
1003
1004     if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_ENUM_FMT, format) < 0) {
1005       if (errno == EINVAL) {
1006         g_free (format);
1007         break;                  /* end of enumeration */
1008       } else {
1009         goto failed;
1010       }
1011     }
1012
1013     GST_LOG_OBJECT (v4l2object->element, "index:       %u", format->index);
1014     GST_LOG_OBJECT (v4l2object->element, "type:        %d", format->type);
1015     GST_LOG_OBJECT (v4l2object->element, "flags:       %08x", format->flags);
1016     GST_LOG_OBJECT (v4l2object->element, "description: '%s'",
1017         format->description);
1018     GST_LOG_OBJECT (v4l2object->element, "pixelformat: %" GST_FOURCC_FORMAT,
1019         GST_FOURCC_ARGS (format->pixelformat));
1020
1021     /* sort formats according to our preference;  we do this, because caps
1022      * are probed in the order the formats are in the list, and the order of
1023      * formats in the final probed caps matters for things like fixation */
1024     v4l2object->formats = g_slist_insert_sorted (v4l2object->formats, format,
1025         (GCompareFunc) format_cmp_func);
1026   }
1027
1028 #ifndef GST_DISABLE_GST_DEBUG
1029   {
1030     GSList *l;
1031
1032     GST_INFO_OBJECT (v4l2object->element, "got %d format(s):", n);
1033     for (l = v4l2object->formats; l != NULL; l = l->next) {
1034       format = l->data;
1035
1036       GST_INFO_OBJECT (v4l2object->element,
1037           "  %" GST_FOURCC_FORMAT "%s", GST_FOURCC_ARGS (format->pixelformat),
1038           ((format->flags & V4L2_FMT_FLAG_EMULATED)) ? " (emulated)" : "");
1039     }
1040   }
1041 #endif
1042
1043   return TRUE;
1044
1045   /* ERRORS */
1046 failed:
1047   {
1048     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
1049         (_("Failed to enumerate possible video formats device '%s' can work with"), v4l2object->videodev), ("Failed to get number %d in pixelformat enumeration for %s. (%d - %s)", n, v4l2object->videodev, errno, g_strerror (errno)));
1050     g_free (format);
1051     return FALSE;
1052   }
1053 }
1054
1055 /*
1056  * Get the list of supported capture formats, a list of
1057  * <code>struct v4l2_fmtdesc</code>.
1058  */
1059 GSList *
1060 gst_v4l2_object_get_format_list (GstV4l2Object * v4l2object)
1061 {
1062   if (!v4l2object->formats)
1063     gst_v4l2_object_fill_format_list (v4l2object);
1064   return v4l2object->formats;
1065 }
1066
1067
1068 GstStructure *
1069 gst_v4l2_object_v4l2fourcc_to_structure (guint32 fourcc)
1070 {
1071   GstStructure *structure = NULL;
1072
1073   switch (fourcc) {
1074     case V4L2_PIX_FMT_MJPEG:   /* Motion-JPEG */
1075     case V4L2_PIX_FMT_JPEG:    /* JFIF JPEG */
1076       structure = gst_structure_new ("image/jpeg", NULL);
1077       break;
1078     case V4L2_PIX_FMT_RGB332:
1079     case V4L2_PIX_FMT_RGB555:
1080     case V4L2_PIX_FMT_RGB555X:
1081     case V4L2_PIX_FMT_RGB565:
1082     case V4L2_PIX_FMT_RGB565X:
1083     case V4L2_PIX_FMT_RGB24:
1084     case V4L2_PIX_FMT_BGR24:
1085     case V4L2_PIX_FMT_RGB32:
1086     case V4L2_PIX_FMT_BGR32:{
1087       guint depth = 0, bpp = 0;
1088
1089       gint endianness = 0;
1090
1091       guint32 r_mask = 0, b_mask = 0, g_mask = 0;
1092
1093       switch (fourcc) {
1094         case V4L2_PIX_FMT_RGB332:
1095           bpp = depth = 8;
1096           endianness = G_BYTE_ORDER;    /* 'like, whatever' */
1097           r_mask = 0xe0;
1098           g_mask = 0x1c;
1099           b_mask = 0x03;
1100           break;
1101         case V4L2_PIX_FMT_RGB555:
1102         case V4L2_PIX_FMT_RGB555X:
1103           bpp = 16;
1104           depth = 15;
1105           endianness =
1106               fourcc == V4L2_PIX_FMT_RGB555X ? G_BIG_ENDIAN : G_LITTLE_ENDIAN;
1107           r_mask = 0x7c00;
1108           g_mask = 0x03e0;
1109           b_mask = 0x001f;
1110           break;
1111         case V4L2_PIX_FMT_RGB565:
1112         case V4L2_PIX_FMT_RGB565X:
1113           bpp = depth = 16;
1114           endianness =
1115               fourcc == V4L2_PIX_FMT_RGB565X ? G_BIG_ENDIAN : G_LITTLE_ENDIAN;
1116           r_mask = 0xf800;
1117           g_mask = 0x07e0;
1118           b_mask = 0x001f;
1119           break;
1120         case V4L2_PIX_FMT_RGB24:
1121           bpp = depth = 24;
1122           endianness = G_BIG_ENDIAN;
1123           r_mask = 0xff0000;
1124           g_mask = 0x00ff00;
1125           b_mask = 0x0000ff;
1126           break;
1127         case V4L2_PIX_FMT_BGR24:
1128           bpp = depth = 24;
1129           endianness = G_BIG_ENDIAN;
1130           r_mask = 0x0000ff;
1131           g_mask = 0x00ff00;
1132           b_mask = 0xff0000;
1133           break;
1134         case V4L2_PIX_FMT_RGB32:
1135           bpp = depth = 32;
1136           endianness = G_BIG_ENDIAN;
1137           r_mask = 0xff000000;
1138           g_mask = 0x00ff0000;
1139           b_mask = 0x0000ff00;
1140           break;
1141         case V4L2_PIX_FMT_BGR32:
1142           bpp = depth = 32;
1143           endianness = G_BIG_ENDIAN;
1144           r_mask = 0x000000ff;
1145           g_mask = 0x0000ff00;
1146           b_mask = 0x00ff0000;
1147           break;
1148         default:
1149           g_assert_not_reached ();
1150           break;
1151       }
1152       structure = gst_structure_new ("video/x-raw-rgb",
1153           "bpp", G_TYPE_INT, bpp,
1154           "depth", G_TYPE_INT, depth,
1155           "red_mask", G_TYPE_INT, r_mask,
1156           "green_mask", G_TYPE_INT, g_mask,
1157           "blue_mask", G_TYPE_INT, b_mask,
1158           "endianness", G_TYPE_INT, endianness, NULL);
1159       break;
1160     }
1161     case V4L2_PIX_FMT_GREY:    /*  8  Greyscale     */
1162       structure = gst_structure_new ("video/x-raw-gray",
1163           "bpp", G_TYPE_INT, 8, NULL);
1164       break;
1165     case V4L2_PIX_FMT_YYUV:    /* 16  YUV 4:2:2     */
1166     case V4L2_PIX_FMT_HI240:   /*  8  8-bit color   */
1167       /* FIXME: get correct fourccs here */
1168       break;
1169     case V4L2_PIX_FMT_NV12:    /* 12  Y/CbCr 4:2:0  */
1170     case V4L2_PIX_FMT_NV21:    /* 12  Y/CrCb 4:2:0  */
1171     case V4L2_PIX_FMT_YVU410:
1172     case V4L2_PIX_FMT_YUV410:
1173     case V4L2_PIX_FMT_YUV420:  /* I420/IYUV */
1174     case V4L2_PIX_FMT_YUYV:
1175     case V4L2_PIX_FMT_YVU420:
1176     case V4L2_PIX_FMT_UYVY:
1177     case V4L2_PIX_FMT_Y41P:
1178     case V4L2_PIX_FMT_YUV422P:
1179 #ifdef V4L2_PIX_FMT_YVYU
1180     case V4L2_PIX_FMT_YVYU:
1181 #endif
1182     case V4L2_PIX_FMT_YUV411P:{
1183       guint32 fcc = 0;
1184
1185       switch (fourcc) {
1186         case V4L2_PIX_FMT_NV12:
1187           fcc = GST_MAKE_FOURCC ('N', 'V', '1', '2');
1188           break;
1189         case V4L2_PIX_FMT_NV21:
1190           fcc = GST_MAKE_FOURCC ('N', 'V', '2', '1');
1191           break;
1192         case V4L2_PIX_FMT_YVU410:
1193           fcc = GST_MAKE_FOURCC ('Y', 'V', 'U', '9');
1194           break;
1195         case V4L2_PIX_FMT_YUV410:
1196           fcc = GST_MAKE_FOURCC ('Y', 'U', 'V', '9');
1197           break;
1198         case V4L2_PIX_FMT_YUV420:
1199           fcc = GST_MAKE_FOURCC ('I', '4', '2', '0');
1200           break;
1201         case V4L2_PIX_FMT_YUYV:
1202           fcc = GST_MAKE_FOURCC ('Y', 'U', 'Y', '2');
1203           break;
1204         case V4L2_PIX_FMT_YVU420:
1205           fcc = GST_MAKE_FOURCC ('Y', 'V', '1', '2');
1206           break;
1207         case V4L2_PIX_FMT_UYVY:
1208           fcc = GST_MAKE_FOURCC ('U', 'Y', 'V', 'Y');
1209           break;
1210         case V4L2_PIX_FMT_Y41P:
1211           fcc = GST_MAKE_FOURCC ('Y', '4', '1', 'P');
1212           break;
1213         case V4L2_PIX_FMT_YUV411P:
1214           fcc = GST_MAKE_FOURCC ('Y', '4', '1', 'B');
1215           break;
1216         case V4L2_PIX_FMT_YUV422P:
1217           fcc = GST_MAKE_FOURCC ('Y', '4', '2', 'B');
1218           break;
1219 #ifdef V4L2_PIX_FMT_YVYU
1220         case V4L2_PIX_FMT_YVYU:
1221           fcc = GST_MAKE_FOURCC ('Y', 'V', 'Y', 'U');
1222           break;
1223 #endif
1224         default:
1225           g_assert_not_reached ();
1226           break;
1227       }
1228       structure = gst_structure_new ("video/x-raw-yuv",
1229           "format", GST_TYPE_FOURCC, fcc, NULL);
1230       break;
1231     }
1232     case V4L2_PIX_FMT_DV:
1233       structure =
1234           gst_structure_new ("video/x-dv", "systemstream", G_TYPE_BOOLEAN, TRUE,
1235           NULL);
1236       break;
1237     case V4L2_PIX_FMT_MPEG:    /* MPEG          */
1238       structure = gst_structure_new ("video/mpegts", NULL);
1239       break;
1240     case V4L2_PIX_FMT_WNVA:    /* Winnov hw compres */
1241       break;
1242 #ifdef V4L2_PIX_FMT_SBGGR8
1243     case V4L2_PIX_FMT_SBGGR8:
1244       structure = gst_structure_new ("video/x-raw-bayer", NULL);
1245       break;
1246 #endif
1247 #ifdef V4L2_PIX_FMT_SN9C10X
1248     case V4L2_PIX_FMT_SN9C10X:
1249       structure = gst_structure_new ("video/x-sonix", NULL);
1250       break;
1251 #endif
1252 #ifdef V4L2_PIX_FMT_PWC1
1253     case V4L2_PIX_FMT_PWC1:
1254       structure = gst_structure_new ("video/x-pwc1", NULL);
1255       break;
1256 #endif
1257 #ifdef V4L2_PIX_FMT_PWC2
1258     case V4L2_PIX_FMT_PWC2:
1259       structure = gst_structure_new ("video/x-pwc2", NULL);
1260       break;
1261 #endif
1262     default:
1263       GST_DEBUG ("Unknown fourcc 0x%08x %" GST_FOURCC_FORMAT,
1264           fourcc, GST_FOURCC_ARGS (fourcc));
1265       break;
1266   }
1267
1268   return structure;
1269 }
1270
1271
1272
1273 GstCaps *
1274 gst_v4l2_object_get_all_caps (void)
1275 {
1276   static GstCaps *caps = NULL;
1277
1278   if (caps == NULL) {
1279     GstStructure *structure;
1280
1281     guint i;
1282
1283     caps = gst_caps_new_empty ();
1284     for (i = 0; i < GST_V4L2_FORMAT_COUNT; i++) {
1285       structure =
1286           gst_v4l2_object_v4l2fourcc_to_structure (gst_v4l2_formats[i].format);
1287       if (structure) {
1288         if (gst_v4l2_formats[i].dimensions) {
1289           gst_structure_set (structure,
1290               "width", GST_TYPE_INT_RANGE, 1, GST_V4L2_MAX_SIZE,
1291               "height", GST_TYPE_INT_RANGE, 1, GST_V4L2_MAX_SIZE,
1292               "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, 100, 1, NULL);
1293         }
1294         gst_caps_append_structure (caps, structure);
1295       }
1296     }
1297   }
1298
1299   return gst_caps_ref (caps);
1300 }
1301
1302
1303 /* collect data for the given caps
1304  * @caps: given input caps
1305  * @format: location for the v4l format
1306  * @w/@h: location for width and height
1307  * @fps_n/@fps_d: location for framerate
1308  * @size: location for expected size of the frame or 0 if unknown
1309  */
1310 gboolean
1311 gst_v4l2_object_get_caps_info (GstV4l2Object * v4l2object, GstCaps * caps,
1312     struct v4l2_fmtdesc ** format, gint * w, gint * h,
1313     gboolean * interlaced, guint * fps_n, guint * fps_d, guint * size)
1314 {
1315   GstStructure *structure;
1316   const GValue *framerate;
1317   guint32 fourcc;
1318   const gchar *mimetype;
1319   guint outsize;
1320
1321   /* default unknown values */
1322   fourcc = 0;
1323   outsize = 0;
1324
1325   structure = gst_caps_get_structure (caps, 0);
1326
1327   mimetype = gst_structure_get_name (structure);
1328
1329   if (strcmp (mimetype, "video/mpegts") == 0) {
1330     fourcc = V4L2_PIX_FMT_MPEG;
1331     *fps_n = 0;
1332     *fps_d = 1;
1333     goto done;
1334   }
1335
1336   if (!gst_structure_get_int (structure, "width", w))
1337     return FALSE;
1338
1339   if (!gst_structure_get_int (structure, "height", h))
1340     return FALSE;
1341
1342   if (!gst_structure_get_boolean (structure, "interlaced", interlaced))
1343     *interlaced = FALSE;
1344
1345   framerate = gst_structure_get_value (structure, "framerate");
1346   if (!framerate)
1347     return FALSE;
1348
1349   *fps_n = gst_value_get_fraction_numerator (framerate);
1350   *fps_d = gst_value_get_fraction_denominator (framerate);
1351
1352   if (!strcmp (mimetype, "video/x-raw-yuv")) {
1353     gst_structure_get_fourcc (structure, "format", &fourcc);
1354
1355     switch (fourcc) {
1356       case GST_MAKE_FOURCC ('I', '4', '2', '0'):
1357       case GST_MAKE_FOURCC ('I', 'Y', 'U', 'V'):
1358         fourcc = V4L2_PIX_FMT_YUV420;
1359         outsize = GST_ROUND_UP_4 (*w) * GST_ROUND_UP_2 (*h);
1360         outsize += 2 * ((GST_ROUND_UP_8 (*w) / 2) * (GST_ROUND_UP_2 (*h) / 2));
1361         break;
1362       case GST_MAKE_FOURCC ('Y', 'U', 'Y', '2'):
1363         fourcc = V4L2_PIX_FMT_YUYV;
1364         outsize = (GST_ROUND_UP_2 (*w) * 2) * *h;
1365         break;
1366       case GST_MAKE_FOURCC ('Y', '4', '1', 'P'):
1367         fourcc = V4L2_PIX_FMT_Y41P;
1368         outsize = (GST_ROUND_UP_2 (*w) * 2) * *h;
1369         break;
1370       case GST_MAKE_FOURCC ('U', 'Y', 'V', 'Y'):
1371         fourcc = V4L2_PIX_FMT_UYVY;
1372         outsize = (GST_ROUND_UP_2 (*w) * 2) * *h;
1373         break;
1374       case GST_MAKE_FOURCC ('Y', 'V', '1', '2'):
1375         fourcc = V4L2_PIX_FMT_YVU420;
1376         outsize = GST_ROUND_UP_4 (*w) * GST_ROUND_UP_2 (*h);
1377         outsize += 2 * ((GST_ROUND_UP_8 (*w) / 2) * (GST_ROUND_UP_2 (*h) / 2));
1378         break;
1379       case GST_MAKE_FOURCC ('Y', '4', '1', 'B'):
1380         fourcc = V4L2_PIX_FMT_YUV411P;
1381         outsize = GST_ROUND_UP_4 (*w) * *h;
1382         outsize += 2 * ((GST_ROUND_UP_8 (*w) / 4) * *h);
1383         break;
1384       case GST_MAKE_FOURCC ('Y', '4', '2', 'B'):
1385         fourcc = V4L2_PIX_FMT_YUV422P;
1386         outsize = GST_ROUND_UP_4 (*w) * *h;
1387         outsize += 2 * ((GST_ROUND_UP_8 (*w) / 2) * *h);
1388         break;
1389       case GST_MAKE_FOURCC ('N', 'V', '1', '2'):
1390         fourcc = V4L2_PIX_FMT_NV12;
1391         outsize = GST_ROUND_UP_4 (*w) * GST_ROUND_UP_2 (*h);
1392         outsize += (GST_ROUND_UP_4 (*w) * *h) / 2;
1393         break;
1394       case GST_MAKE_FOURCC ('N', 'V', '2', '1'):
1395         fourcc = V4L2_PIX_FMT_NV21;
1396         outsize = GST_ROUND_UP_4 (*w) * GST_ROUND_UP_2 (*h);
1397         outsize += (GST_ROUND_UP_4 (*w) * *h) / 2;
1398         break;
1399 #ifdef V4L2_PIX_FMT_YVYU
1400       case GST_MAKE_FOURCC ('Y', 'V', 'Y', 'U'):
1401         fourcc = V4L2_PIX_FMT_YVYU;
1402         outsize = (GST_ROUND_UP_2 (*w) * 2) * *h;
1403         break;
1404 #endif
1405     }
1406   } else if (!strcmp (mimetype, "video/x-raw-rgb")) {
1407     gint depth, endianness, r_mask;
1408
1409     gst_structure_get_int (structure, "depth", &depth);
1410     gst_structure_get_int (structure, "endianness", &endianness);
1411     gst_structure_get_int (structure, "red_mask", &r_mask);
1412
1413     switch (depth) {
1414       case 8:
1415         fourcc = V4L2_PIX_FMT_RGB332;
1416         break;
1417       case 15:
1418         fourcc = (endianness == G_LITTLE_ENDIAN) ?
1419             V4L2_PIX_FMT_RGB555 : V4L2_PIX_FMT_RGB555X;
1420         break;
1421       case 16:
1422         fourcc = (endianness == G_LITTLE_ENDIAN) ?
1423             V4L2_PIX_FMT_RGB565 : V4L2_PIX_FMT_RGB565X;
1424         break;
1425       case 24:
1426         fourcc = (r_mask == 0xFF) ? V4L2_PIX_FMT_BGR24 : V4L2_PIX_FMT_RGB24;
1427         break;
1428       case 32:
1429         fourcc = (r_mask == 0xFF) ? V4L2_PIX_FMT_BGR32 : V4L2_PIX_FMT_RGB32;
1430         break;
1431     }
1432   } else if (strcmp (mimetype, "video/x-dv") == 0) {
1433     fourcc = V4L2_PIX_FMT_DV;
1434   } else if (strcmp (mimetype, "image/jpeg") == 0) {
1435     fourcc = V4L2_PIX_FMT_JPEG;
1436 #ifdef V4L2_PIX_FMT_SBGGR8
1437   } else if (strcmp (mimetype, "video/x-raw-bayer") == 0) {
1438     fourcc = V4L2_PIX_FMT_SBGGR8;
1439 #endif
1440 #ifdef V4L2_PIX_FMT_SN9C10X
1441   } else if (strcmp (mimetype, "video/x-sonix") == 0) {
1442     fourcc = V4L2_PIX_FMT_SN9C10X;
1443 #endif
1444 #ifdef V4L2_PIX_FMT_PWC1
1445   } else if (strcmp (mimetype, "video/x-pwc1") == 0) {
1446     fourcc = V4L2_PIX_FMT_PWC1;
1447 #endif
1448 #ifdef V4L2_PIX_FMT_PWC2
1449   } else if (strcmp (mimetype, "video/x-pwc2") == 0) {
1450     fourcc = V4L2_PIX_FMT_PWC2;
1451 #endif
1452   } else if (strcmp (mimetype, "video/x-raw-gray") == 0) {
1453     fourcc = V4L2_PIX_FMT_GREY;
1454   }
1455
1456   if (fourcc == 0)
1457     return FALSE;
1458
1459 done:
1460   *format = gst_v4l2_object_get_format_from_fourcc (v4l2object, fourcc);
1461   *size = outsize;
1462
1463   return TRUE;
1464 }
1465
1466
1467 static gboolean
1468 gst_v4l2_object_get_nearest_size (GstV4l2Object * v4l2object,
1469     guint32 pixelformat, gint * width, gint * height, gboolean * interlaced);
1470
1471
1472 /* The frame interval enumeration code first appeared in Linux 2.6.19. */
1473 #ifdef VIDIOC_ENUM_FRAMEINTERVALS
1474 static GstStructure *
1475 gst_v4l2_object_probe_caps_for_format_and_size (GstV4l2Object * v4l2object,
1476     guint32 pixelformat,
1477     guint32 width, guint32 height, const GstStructure * template)
1478 {
1479   gint fd = v4l2object->video_fd;
1480   struct v4l2_frmivalenum ival;
1481   guint32 num, denom;
1482   GstStructure *s;
1483   GValue rates = { 0, };
1484   gboolean interlaced;
1485   gint int_width = width;
1486   gint int_height = height;
1487
1488   /* interlaced detection using VIDIOC_TRY/S_FMT */
1489   if (!gst_v4l2_object_get_nearest_size (v4l2object, pixelformat,
1490           &int_width, &int_height, &interlaced))
1491     return NULL;
1492
1493   memset (&ival, 0, sizeof (struct v4l2_frmivalenum));
1494   ival.index = 0;
1495   ival.pixel_format = pixelformat;
1496   ival.width = width;
1497   ival.height = height;
1498
1499   GST_LOG_OBJECT (v4l2object->element,
1500       "get frame interval for %ux%u, %" GST_FOURCC_FORMAT, width, height,
1501       GST_FOURCC_ARGS (pixelformat));
1502
1503   /* keep in mind that v4l2 gives us frame intervals (durations); we invert the
1504    * fraction to get framerate */
1505   if (v4l2_ioctl (fd, VIDIOC_ENUM_FRAMEINTERVALS, &ival) < 0)
1506     goto enum_frameintervals_failed;
1507
1508   if (ival.type == V4L2_FRMIVAL_TYPE_DISCRETE) {
1509     GValue rate = { 0, };
1510
1511     g_value_init (&rates, GST_TYPE_LIST);
1512     g_value_init (&rate, GST_TYPE_FRACTION);
1513
1514     do {
1515       num = ival.discrete.numerator;
1516       denom = ival.discrete.denominator;
1517
1518       if (num > G_MAXINT || denom > G_MAXINT) {
1519         /* let us hope we don't get here... */
1520         num >>= 1;
1521         denom >>= 1;
1522       }
1523
1524       GST_LOG_OBJECT (v4l2object->element, "adding discrete framerate: %d/%d",
1525           denom, num);
1526
1527       /* swap to get the framerate */
1528       gst_value_set_fraction (&rate, denom, num);
1529       gst_value_list_append_value (&rates, &rate);
1530
1531       ival.index++;
1532     } while (v4l2_ioctl (fd, VIDIOC_ENUM_FRAMEINTERVALS, &ival) >= 0);
1533   } else if (ival.type == V4L2_FRMIVAL_TYPE_STEPWISE) {
1534     GValue min = { 0, };
1535     GValue step = { 0, };
1536     GValue max = { 0, };
1537     gboolean added = FALSE;
1538     guint32 minnum, mindenom;
1539     guint32 maxnum, maxdenom;
1540
1541     g_value_init (&rates, GST_TYPE_LIST);
1542
1543     g_value_init (&min, GST_TYPE_FRACTION);
1544     g_value_init (&step, GST_TYPE_FRACTION);
1545     g_value_init (&max, GST_TYPE_FRACTION);
1546
1547     /* get the min */
1548     minnum = ival.stepwise.min.numerator;
1549     mindenom = ival.stepwise.min.denominator;
1550     if (minnum > G_MAXINT || mindenom > G_MAXINT) {
1551       minnum >>= 1;
1552       mindenom >>= 1;
1553     }
1554     GST_LOG_OBJECT (v4l2object->element, "stepwise min frame interval: %d/%d",
1555         minnum, mindenom);
1556     gst_value_set_fraction (&min, minnum, mindenom);
1557
1558     /* get the max */
1559     maxnum = ival.stepwise.max.numerator;
1560     maxdenom = ival.stepwise.max.denominator;
1561     if (maxnum > G_MAXINT || maxdenom > G_MAXINT) {
1562       maxnum >>= 1;
1563       maxdenom >>= 1;
1564     }
1565
1566     GST_LOG_OBJECT (v4l2object->element, "stepwise max frame interval: %d/%d",
1567         maxnum, maxdenom);
1568     gst_value_set_fraction (&max, maxnum, maxdenom);
1569
1570     /* get the step */
1571     num = ival.stepwise.step.numerator;
1572     denom = ival.stepwise.step.denominator;
1573     if (num > G_MAXINT || denom > G_MAXINT) {
1574       num >>= 1;
1575       denom >>= 1;
1576     }
1577
1578     if (num == 0 || denom == 0) {
1579       /* in this case we have a wrong fraction or no step, set the step to max
1580        * so that we only add the min value in the loop below */
1581       num = maxnum;
1582       denom = maxdenom;
1583     }
1584
1585     /* since we only have gst_value_fraction_subtract and not add, negate the
1586      * numerator */
1587     GST_LOG_OBJECT (v4l2object->element, "stepwise step frame interval: %d/%d",
1588         num, denom);
1589     gst_value_set_fraction (&step, -num, denom);
1590
1591     while (gst_value_compare (&min, &max) <= 0) {
1592       GValue rate = { 0, };
1593
1594       num = gst_value_get_fraction_numerator (&min);
1595       denom = gst_value_get_fraction_denominator (&min);
1596       GST_LOG_OBJECT (v4l2object->element, "adding stepwise framerate: %d/%d",
1597           denom, num);
1598
1599       /* invert to get the framerate */
1600       g_value_init (&rate, GST_TYPE_FRACTION);
1601       gst_value_set_fraction (&rate, denom, num);
1602       gst_value_list_append_value (&rates, &rate);
1603       added = TRUE;
1604
1605       /* we're actually adding because step was negated above. This is because
1606        * there is no _add function... */
1607       if (!gst_value_fraction_subtract (&min, &min, &step)) {
1608         GST_WARNING_OBJECT (v4l2object->element, "could not step fraction!");
1609         break;
1610       }
1611     }
1612     if (!added) {
1613       /* no range was added, leave the default range from the template */
1614       GST_WARNING_OBJECT (v4l2object->element,
1615           "no range added, leaving default");
1616       g_value_unset (&rates);
1617     }
1618   } else if (ival.type == V4L2_FRMIVAL_TYPE_CONTINUOUS) {
1619     guint32 maxnum, maxdenom;
1620
1621     g_value_init (&rates, GST_TYPE_FRACTION_RANGE);
1622
1623     num = ival.stepwise.min.numerator;
1624     denom = ival.stepwise.min.denominator;
1625     if (num > G_MAXINT || denom > G_MAXINT) {
1626       num >>= 1;
1627       denom >>= 1;
1628     }
1629
1630     maxnum = ival.stepwise.max.numerator;
1631     maxdenom = ival.stepwise.max.denominator;
1632     if (maxnum > G_MAXINT || maxdenom > G_MAXINT) {
1633       maxnum >>= 1;
1634       maxdenom >>= 1;
1635     }
1636
1637     GST_LOG_OBJECT (v4l2object->element,
1638         "continuous frame interval %d/%d to %d/%d", maxdenom, maxnum, denom,
1639         num);
1640
1641     gst_value_set_fraction_range_full (&rates, maxdenom, maxnum, denom, num);
1642   } else {
1643     goto unknown_type;
1644   }
1645
1646 return_data:
1647   s = gst_structure_copy (template);
1648   gst_structure_set (s, "width", G_TYPE_INT, (gint) width,
1649       "height", G_TYPE_INT, (gint) height,
1650       "interlaced", G_TYPE_BOOLEAN, interlaced, NULL);
1651
1652   if (G_IS_VALUE (&rates)) {
1653     /* only change the framerate on the template when we have a valid probed new
1654      * value */
1655     gst_structure_set_value (s, "framerate", &rates);
1656     g_value_unset (&rates);
1657   } else {
1658     gst_structure_set (s, "framerate", GST_TYPE_FRACTION_RANGE, 0, 1, 100, 1,
1659         NULL);
1660   }
1661   return s;
1662
1663   /* ERRORS */
1664 enum_frameintervals_failed:
1665   {
1666     GST_DEBUG_OBJECT (v4l2object->element,
1667         "Unable to enumerate intervals for %" GST_FOURCC_FORMAT "@%ux%u",
1668         GST_FOURCC_ARGS (pixelformat), width, height);
1669     goto return_data;
1670   }
1671 unknown_type:
1672   {
1673     /* I don't see how this is actually an error, we ignore the format then */
1674     GST_WARNING_OBJECT (v4l2object->element,
1675         "Unknown frame interval type at %" GST_FOURCC_FORMAT "@%ux%u: %u",
1676         GST_FOURCC_ARGS (pixelformat), width, height, ival.type);
1677     return NULL;
1678   }
1679 }
1680 #endif /* defined VIDIOC_ENUM_FRAMEINTERVALS */
1681
1682 #ifdef VIDIOC_ENUM_FRAMESIZES
1683 static gint
1684 sort_by_frame_size (GstStructure * s1, GstStructure * s2)
1685 {
1686   int w1, h1, w2, h2;
1687
1688   gst_structure_get_int (s1, "width", &w1);
1689   gst_structure_get_int (s1, "height", &h1);
1690   gst_structure_get_int (s2, "width", &w2);
1691   gst_structure_get_int (s2, "height", &h2);
1692
1693   /* I think it's safe to assume that this won't overflow for a while */
1694   return ((w2 * h2) - (w1 * h1));
1695 }
1696 #endif
1697
1698 GstCaps *
1699 gst_v4l2_object_probe_caps_for_format (GstV4l2Object * v4l2object,
1700     guint32 pixelformat, const GstStructure * template)
1701 {
1702   GstCaps *ret = gst_caps_new_empty ();
1703   GstStructure *tmp;
1704
1705 #ifdef VIDIOC_ENUM_FRAMESIZES
1706   gint fd = v4l2object->video_fd;
1707   struct v4l2_frmsizeenum size;
1708   GList *results = NULL;
1709   guint32 w, h;
1710
1711   if (pixelformat == GST_MAKE_FOURCC ('M', 'P', 'E', 'G'))
1712     return gst_caps_new_simple ("video/mpegts", NULL);
1713
1714   memset (&size, 0, sizeof (struct v4l2_frmsizeenum));
1715   size.index = 0;
1716   size.pixel_format = pixelformat;
1717
1718   GST_DEBUG_OBJECT (v4l2object->element, "Enumerating frame sizes");
1719
1720   if (v4l2_ioctl (fd, VIDIOC_ENUM_FRAMESIZES, &size) < 0)
1721     goto enum_framesizes_failed;
1722
1723   if (size.type == V4L2_FRMSIZE_TYPE_DISCRETE) {
1724     do {
1725       GST_LOG_OBJECT (v4l2object->element, "got discrete frame size %dx%d",
1726           size.discrete.width, size.discrete.height);
1727
1728       w = MIN (size.discrete.width, G_MAXINT);
1729       h = MIN (size.discrete.height, G_MAXINT);
1730
1731       if (w && h) {
1732         tmp =
1733             gst_v4l2_object_probe_caps_for_format_and_size (v4l2object,
1734             pixelformat, w, h, template);
1735
1736         if (tmp)
1737           results = g_list_prepend (results, tmp);
1738       }
1739
1740       size.index++;
1741     } while (v4l2_ioctl (fd, VIDIOC_ENUM_FRAMESIZES, &size) >= 0);
1742     GST_DEBUG_OBJECT (v4l2object->element,
1743         "done iterating discrete frame sizes");
1744   } else if (size.type == V4L2_FRMSIZE_TYPE_STEPWISE) {
1745     GST_DEBUG_OBJECT (v4l2object->element, "we have stepwise frame sizes:");
1746     GST_DEBUG_OBJECT (v4l2object->element, "min width:   %d",
1747         size.stepwise.min_width);
1748     GST_DEBUG_OBJECT (v4l2object->element, "min height:  %d",
1749         size.stepwise.min_height);
1750     GST_DEBUG_OBJECT (v4l2object->element, "max width:   %d",
1751         size.stepwise.max_width);
1752     GST_DEBUG_OBJECT (v4l2object->element, "min height:  %d",
1753         size.stepwise.max_height);
1754     GST_DEBUG_OBJECT (v4l2object->element, "step width:  %d",
1755         size.stepwise.step_width);
1756     GST_DEBUG_OBJECT (v4l2object->element, "step height: %d",
1757         size.stepwise.step_height);
1758
1759     for (w = size.stepwise.min_width, h = size.stepwise.min_height;
1760         w < size.stepwise.max_width && h < size.stepwise.max_height;
1761         w += size.stepwise.step_width, h += size.stepwise.step_height) {
1762       if (w == 0 || h == 0)
1763         continue;
1764
1765       tmp =
1766           gst_v4l2_object_probe_caps_for_format_and_size (v4l2object,
1767           pixelformat, w, h, template);
1768
1769       if (tmp)
1770         results = g_list_prepend (results, tmp);
1771     }
1772     GST_DEBUG_OBJECT (v4l2object->element,
1773         "done iterating stepwise frame sizes");
1774   } else if (size.type == V4L2_FRMSIZE_TYPE_CONTINUOUS) {
1775     guint32 maxw, maxh;
1776
1777     GST_DEBUG_OBJECT (v4l2object->element, "we have continuous frame sizes:");
1778     GST_DEBUG_OBJECT (v4l2object->element, "min width:   %d",
1779         size.stepwise.min_width);
1780     GST_DEBUG_OBJECT (v4l2object->element, "min height:  %d",
1781         size.stepwise.min_height);
1782     GST_DEBUG_OBJECT (v4l2object->element, "max width:   %d",
1783         size.stepwise.max_width);
1784     GST_DEBUG_OBJECT (v4l2object->element, "min height:  %d",
1785         size.stepwise.max_height);
1786
1787     w = MAX (size.stepwise.min_width, 1);
1788     h = MAX (size.stepwise.min_height, 1);
1789     maxw = MIN (size.stepwise.max_width, G_MAXINT);
1790     maxh = MIN (size.stepwise.max_height, G_MAXINT);
1791
1792     tmp =
1793         gst_v4l2_object_probe_caps_for_format_and_size (v4l2object, pixelformat,
1794         w, h, template);
1795     if (tmp) {
1796       gst_structure_set (tmp, "width", GST_TYPE_INT_RANGE, (gint) w,
1797           (gint) maxw, "height", GST_TYPE_INT_RANGE, (gint) h, (gint) maxh,
1798           NULL);
1799
1800       /* no point using the results list here, since there's only one struct */
1801       gst_caps_append_structure (ret, tmp);
1802     }
1803   } else {
1804     goto unknown_type;
1805   }
1806
1807   /* we use an intermediary list to store and then sort the results of the
1808    * probing because we can't make any assumptions about the order in which
1809    * the driver will give us the sizes, but we want the final caps to contain
1810    * the results starting with the highest resolution and having the lowest
1811    * resolution last, since order in caps matters for things like fixation. */
1812   results = g_list_sort (results, (GCompareFunc) sort_by_frame_size);
1813   while (results != NULL) {
1814     gst_caps_append_structure (ret, GST_STRUCTURE (results->data));
1815     results = g_list_delete_link (results, results);
1816   }
1817
1818   if (gst_caps_is_empty (ret))
1819     goto enum_framesizes_no_results;
1820
1821   return ret;
1822
1823   /* ERRORS */
1824 enum_framesizes_failed:
1825   {
1826     /* I don't see how this is actually an error */
1827     GST_DEBUG_OBJECT (v4l2object->element,
1828         "Failed to enumerate frame sizes for pixelformat %" GST_FOURCC_FORMAT
1829         " (%s)", GST_FOURCC_ARGS (pixelformat), g_strerror (errno));
1830     goto default_frame_sizes;
1831   }
1832 enum_framesizes_no_results:
1833   {
1834     /* it's possible that VIDIOC_ENUM_FRAMESIZES is defined but the driver in
1835      * question doesn't actually support it yet */
1836     GST_DEBUG_OBJECT (v4l2object->element,
1837         "No results for pixelformat %" GST_FOURCC_FORMAT
1838         " enumerating frame sizes, trying fallback",
1839         GST_FOURCC_ARGS (pixelformat));
1840     goto default_frame_sizes;
1841   }
1842 unknown_type:
1843   {
1844     GST_WARNING_OBJECT (v4l2object->element,
1845         "Unknown frame sizeenum type for pixelformat %" GST_FOURCC_FORMAT
1846         ": %u", GST_FOURCC_ARGS (pixelformat), size.type);
1847     goto default_frame_sizes;
1848   }
1849 default_frame_sizes:
1850 #endif /* defined VIDIOC_ENUM_FRAMESIZES */
1851   {
1852     gint min_w, max_w, min_h, max_h, fix_num = 0, fix_denom = 0;
1853     gboolean interlaced;
1854
1855     /* This code is for Linux < 2.6.19 */
1856     min_w = min_h = 1;
1857     max_w = max_h = GST_V4L2_MAX_SIZE;
1858     if (!gst_v4l2_object_get_nearest_size (v4l2object, pixelformat, &min_w,
1859             &min_h, &interlaced)) {
1860       GST_WARNING_OBJECT (v4l2object->element,
1861           "Could not probe minimum capture size for pixelformat %"
1862           GST_FOURCC_FORMAT, GST_FOURCC_ARGS (pixelformat));
1863     }
1864     if (!gst_v4l2_object_get_nearest_size (v4l2object, pixelformat, &max_w,
1865             &max_h, &interlaced)) {
1866       GST_WARNING_OBJECT (v4l2object->element,
1867           "Could not probe maximum capture size for pixelformat %"
1868           GST_FOURCC_FORMAT, GST_FOURCC_ARGS (pixelformat));
1869     }
1870
1871     /* Since we can't get framerate directly, try to use the current norm */
1872     if (v4l2object->norm && v4l2object->norms) {
1873       GList *norms;
1874       GstTunerNorm *norm = NULL;
1875
1876       for (norms = v4l2object->norms; norms != NULL; norms = norms->next) {
1877         norm = (GstTunerNorm *) norms->data;
1878         if (!strcmp (norm->label, v4l2object->norm))
1879           break;
1880       }
1881       /* If it's possible, set framerate to that (discrete) value */
1882       if (norm) {
1883         fix_num = gst_value_get_fraction_numerator (&norm->framerate);
1884         fix_denom = gst_value_get_fraction_denominator (&norm->framerate);
1885       }
1886     }
1887
1888     tmp = gst_structure_copy (template);
1889     if (fix_num) {
1890       gst_structure_set (tmp, "framerate", GST_TYPE_FRACTION, fix_num,
1891           fix_denom, NULL);
1892     } else {
1893       /* if norm can't be used, copy the template framerate */
1894       gst_structure_set (tmp, "framerate", GST_TYPE_FRACTION_RANGE, 0, 1,
1895           100, 1, NULL);
1896     }
1897
1898     if (min_w == max_w)
1899       gst_structure_set (tmp, "width", G_TYPE_INT, max_w, NULL);
1900     else
1901       gst_structure_set (tmp, "width", GST_TYPE_INT_RANGE, min_w, max_w, NULL);
1902
1903     if (min_h == max_h)
1904       gst_structure_set (tmp, "height", G_TYPE_INT, max_h, NULL);
1905     else
1906       gst_structure_set (tmp, "height", GST_TYPE_INT_RANGE, min_h, max_h, NULL);
1907
1908     gst_structure_set (tmp, "interlaced", G_TYPE_BOOLEAN, interlaced, NULL);
1909
1910     gst_caps_append_structure (ret, tmp);
1911
1912     return ret;
1913   }
1914 }
1915
1916 static gboolean
1917 gst_v4l2_object_get_nearest_size (GstV4l2Object * v4l2object,
1918     guint32 pixelformat, gint * width, gint * height, gboolean * interlaced)
1919 {
1920   struct v4l2_format fmt;
1921   int fd;
1922   int r;
1923
1924   g_return_val_if_fail (width != NULL, FALSE);
1925   g_return_val_if_fail (height != NULL, FALSE);
1926
1927   GST_LOG_OBJECT (v4l2object->element,
1928       "getting nearest size to %dx%d with format %" GST_FOURCC_FORMAT,
1929       *width, *height, GST_FOURCC_ARGS (pixelformat));
1930
1931   fd = v4l2object->video_fd;
1932
1933   /* get size delimiters */
1934   memset (&fmt, 0, sizeof (fmt));
1935   fmt.type = v4l2object->type;
1936   fmt.fmt.pix.width = *width;
1937   fmt.fmt.pix.height = *height;
1938   fmt.fmt.pix.pixelformat = pixelformat;
1939   fmt.fmt.pix.field = V4L2_FIELD_NONE;
1940
1941   r = v4l2_ioctl (fd, VIDIOC_TRY_FMT, &fmt);
1942   if (r < 0 && errno == EINVAL) {
1943     /* try again with interlaced video */
1944     fmt.fmt.pix.width = *width;
1945     fmt.fmt.pix.height = *height;
1946     fmt.fmt.pix.pixelformat = pixelformat;
1947     fmt.fmt.pix.field = V4L2_FIELD_INTERLACED;
1948     r = v4l2_ioctl (fd, VIDIOC_TRY_FMT, &fmt);
1949   }
1950
1951   if (r < 0) {
1952     /* The driver might not implement TRY_FMT, in which case we will try
1953        S_FMT to probe */
1954     if (errno != ENOTTY)
1955       return FALSE;
1956
1957     /* Only try S_FMT if we're not actively capturing yet, which we shouldn't
1958        be, because we're still probing */
1959     if (GST_V4L2_IS_ACTIVE (v4l2object))
1960       return FALSE;
1961
1962     GST_LOG_OBJECT (v4l2object->element,
1963         "Failed to probe size limit with VIDIOC_TRY_FMT, trying VIDIOC_S_FMT");
1964
1965     fmt.fmt.pix.width = *width;
1966     fmt.fmt.pix.height = *height;
1967
1968     r = v4l2_ioctl (fd, VIDIOC_S_FMT, &fmt);
1969     if (r < 0 && errno == EINVAL) {
1970       /* try again with progressive video */
1971       fmt.fmt.pix.width = *width;
1972       fmt.fmt.pix.height = *height;
1973       fmt.fmt.pix.pixelformat = pixelformat;
1974       fmt.fmt.pix.field = V4L2_FIELD_NONE;
1975       r = v4l2_ioctl (fd, VIDIOC_S_FMT, &fmt);
1976     }
1977
1978     if (r < 0)
1979       return FALSE;
1980   }
1981
1982   GST_LOG_OBJECT (v4l2object->element,
1983       "got nearest size %dx%d", fmt.fmt.pix.width, fmt.fmt.pix.height);
1984
1985   *width = fmt.fmt.pix.width;
1986   *height = fmt.fmt.pix.height;
1987
1988   switch (fmt.fmt.pix.field) {
1989     case V4L2_FIELD_ANY:
1990     case V4L2_FIELD_NONE:
1991       *interlaced = FALSE;
1992       break;
1993     case V4L2_FIELD_INTERLACED:
1994     case V4L2_FIELD_INTERLACED_TB:
1995     case V4L2_FIELD_INTERLACED_BT:
1996       *interlaced = TRUE;
1997       break;
1998     default:
1999       GST_WARNING_OBJECT (v4l2object->element,
2000           "Unsupported field type for %" GST_FOURCC_FORMAT "@%ux%u",
2001           GST_FOURCC_ARGS (pixelformat), *width, *height);
2002       return FALSE;
2003   }
2004
2005   return TRUE;
2006 }
2007
2008
2009 gboolean
2010 gst_v4l2_object_set_format (GstV4l2Object * v4l2object, guint32 pixelformat,
2011     guint32 width, guint32 height, gboolean interlaced)
2012 {
2013   gint fd = v4l2object->video_fd;
2014   struct v4l2_format format;
2015   enum v4l2_field field;
2016
2017   if (interlaced) {
2018     GST_DEBUG_OBJECT (v4l2object->element, "interlaced video");
2019     /* ideally we would differentiate between types of interlaced video
2020      * but there is not sufficient information in the caps..
2021      */
2022     field = V4L2_FIELD_INTERLACED;
2023   } else {
2024     GST_DEBUG_OBJECT (v4l2object->element, "progressive video");
2025     field = V4L2_FIELD_NONE;
2026   }
2027
2028   GST_DEBUG_OBJECT (v4l2object->element, "Setting format to %dx%d, format "
2029       "%" GST_FOURCC_FORMAT, width, height, GST_FOURCC_ARGS (pixelformat));
2030
2031   GST_V4L2_CHECK_OPEN (v4l2object);
2032   GST_V4L2_CHECK_NOT_ACTIVE (v4l2object);
2033
2034   if (pixelformat == GST_MAKE_FOURCC ('M', 'P', 'E', 'G'))
2035     return TRUE;
2036
2037   memset (&format, 0x00, sizeof (struct v4l2_format));
2038   format.type = v4l2object->type;
2039
2040   if (v4l2_ioctl (fd, VIDIOC_G_FMT, &format) < 0)
2041     goto get_fmt_failed;
2042
2043   if (format.type == v4l2object->type &&
2044       format.fmt.pix.width == width &&
2045       format.fmt.pix.height == height &&
2046       format.fmt.pix.pixelformat == pixelformat &&
2047       format.fmt.pix.field == field) {
2048     /* Nothing to do. We want to succeed immediately
2049      * here because setting the same format back
2050      * can still fail due to EBUSY. By short-circuiting
2051      * here, we allow pausing and re-playing pipelines
2052      * with changed caps, as long as the changed caps
2053      * do not change the webcam's format. Otherwise,
2054      * any caps change would require us to go to NULL
2055      * state to close the device and set format.
2056      */
2057     return TRUE;
2058   }
2059
2060   format.type = v4l2object->type;
2061   format.fmt.pix.width = width;
2062   format.fmt.pix.height = height;
2063   format.fmt.pix.pixelformat = pixelformat;
2064   format.fmt.pix.field = field;
2065
2066   if (v4l2_ioctl (fd, VIDIOC_S_FMT, &format) < 0) {
2067     goto set_fmt_failed;
2068   }
2069
2070   if (format.fmt.pix.width != width || format.fmt.pix.height != height)
2071     goto invalid_dimensions;
2072
2073   if (format.fmt.pix.pixelformat != pixelformat)
2074     goto invalid_pixelformat;
2075
2076   return TRUE;
2077
2078   /* ERRORS */
2079 get_fmt_failed:
2080   {
2081     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
2082         (_("Device '%s' does not support video capture"),
2083             v4l2object->videodev),
2084         ("Call to G_FMT failed: (%s)", g_strerror (errno)));
2085     return FALSE;
2086   }
2087 set_fmt_failed:
2088   {
2089     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
2090         (_("Device '%s' cannot capture at %dx%d"),
2091             v4l2object->videodev, width, height),
2092         ("Call to S_FMT failed for %" GST_FOURCC_FORMAT " @ %dx%d: %s",
2093             GST_FOURCC_ARGS (pixelformat), width, height, g_strerror (errno)));
2094     return FALSE;
2095   }
2096 invalid_dimensions:
2097   {
2098     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
2099         (_("Device '%s' cannot capture at %dx%d"),
2100             v4l2object->videodev, width, height),
2101         ("Tried to capture at %dx%d, but device returned size %dx%d",
2102             width, height, format.fmt.pix.width, format.fmt.pix.height));
2103     return FALSE;
2104   }
2105 invalid_pixelformat:
2106   {
2107     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, SETTINGS,
2108         (_("Device '%s' cannot capture in the specified format"),
2109             v4l2object->videodev),
2110         ("Tried to capture in %" GST_FOURCC_FORMAT
2111             ", but device returned format" " %" GST_FOURCC_FORMAT,
2112             GST_FOURCC_ARGS (pixelformat),
2113             GST_FOURCC_ARGS (format.fmt.pix.pixelformat)));
2114     return FALSE;
2115   }
2116 }
2117
2118 gboolean
2119 gst_v4l2_object_start_streaming (GstV4l2Object * v4l2object)
2120 {
2121   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_STREAMON,
2122           &(v4l2object->type)) < 0) {
2123     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ,
2124         (_("Error starting streaming on device '%s'."), v4l2object->videodev),
2125         GST_ERROR_SYSTEM);
2126     return FALSE;
2127   }
2128   return TRUE;
2129 }
2130
2131 gboolean
2132 gst_v4l2_object_stop_streaming (GstV4l2Object * v4l2object)
2133 {
2134   if (v4l2_ioctl (v4l2object->video_fd, VIDIOC_STREAMOFF,
2135           &(v4l2object->type)) < 0) {
2136     GST_ELEMENT_ERROR (v4l2object->element, RESOURCE, OPEN_READ,
2137         (_("Error stopping streaming on device '%s'."), v4l2object->videodev),
2138         GST_ERROR_SYSTEM);
2139     return FALSE;
2140   }
2141   return TRUE;
2142 }