git.sesse.net Git - vlc/blob - modules/access/v4l2.c

   1 /*****************************************************************************
   2  * v4l2.c : Video4Linux2 input module for vlc
   3  *****************************************************************************
   4  * Copyright (C) 2002-2009 the VideoLAN team
   5  * $Id$
   6  *
   7  * Authors: Benjamin Pracht <bigben at videolan dot org>
   8  *          Richard Hosking <richard at hovis dot net>
   9  *          Antoine Cellerier <dionoea at videolan d.t org>
  10  *          Dennis Lou <dlou99 at yahoo dot com>
  11  *
  12  * This program is free software; you can redistribute it and/or modify
  13  * it under the terms of the GNU General Public License as published by
  14  * the Free Software Foundation; either version 2 of the License, or
  15  * (at your option) any later version.
  16  *
  17  * This program is distributed in the hope that it will be useful,
  18  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  19  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  20  * GNU General Public License for more details.
  21  *
  22  * You should have received a copy of the GNU General Public License
  23  * along with this program; if not, write to the Free Software
  24  * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston MA 02110-1301, USA.
  25  *****************************************************************************/
  26
  27 /*
  28  * Sections based on the reference V4L2 capture example at
  29  * http://v4l2spec.bytesex.org/spec/capture-example.html
  30  */
  31
  32 /*****************************************************************************
  33  * Preamble
  34  *****************************************************************************/
  35
  36 #ifdef HAVE_CONFIG_H
  37 # include "config.h"
  38 #endif
  39
  40 #include <vlc_common.h>
  41 #include <vlc_plugin.h>
  42 #include <vlc_access.h>
  43 #include <vlc_demux.h>
  44 #include <vlc_input.h>
  45
  46 #include <ctype.h>
  47 #include <errno.h>
  48 #include <fcntl.h>
  49 #include <sys/ioctl.h>
  50 #include <sys/mman.h>
  51
  52 #include <linux/videodev2.h>
  53
  54 #include <poll.h>
  55
  56 #ifdef HAVE_LIBV4L2
  57 #   include <libv4l2.h>
  58 #endif
  59
  60 /*****************************************************************************
  61  * Module descriptior
  62  *****************************************************************************/
  63
  64 static int  DemuxOpen ( vlc_object_t * );
  65 static void DemuxClose( vlc_object_t * );
  66 static int  AccessOpen ( vlc_object_t * );
  67 static void AccessClose( vlc_object_t * );
  68
  69 #define STANDARD_TEXT N_( "Standard" )
  70 #define STANDARD_LONGTEXT N_( \
  71     "Video standard (Default, SECAM, PAL, or NTSC)." )
  72 #define CHROMA_TEXT N_("Video input chroma format")
  73 #define CHROMA_LONGTEXT N_( \
  74     "Force the Video4Linux2 video device to use a specific chroma format " \
  75     "(eg. I420 or I422 for raw images, MJPG for M-JPEG compressed input) " \
  76     "(Complete list: GREY, I240, RV16, RV15, RV24, RV32, YUY2, YUYV, UYVY, " \
  77     "I41N, I422, I420, I411, I410, MJPG)")
  78 #define INPUT_TEXT N_( "Input" )
  79 #define INPUT_LONGTEXT N_( \
  80     "Input of the card to use (see debug)." )
  81 #define AUDIO_INPUT_TEXT N_( "Audio input" )
  82 #define AUDIO_INPUT_LONGTEXT N_( \
  83     "Audio input of the card to use (see debug)." )
  84 #define IOMETHOD_TEXT N_( "IO Method" )
  85 #define IOMETHOD_LONGTEXT N_( \
  86     "IO Method (READ, MMAP, USERPTR)." )
  87 #define WIDTH_TEXT N_( "Width" )
  88 #define WIDTH_LONGTEXT N_( \
  89     "Force width (-1 for autodetect, 0 for driver default)." )
  90 #define HEIGHT_TEXT N_( "Height" )
  91 #define HEIGHT_LONGTEXT N_( \
  92     "Force height (-1 for autodetect, 0 for driver default)." )
  93 #define FPS_TEXT N_( "Framerate" )
  94 #define FPS_LONGTEXT N_( "Framerate to capture, if applicable " \
  95     "(0 for autodetect)." )
  96
  97 #ifdef HAVE_LIBV4L2
  98 #define LIBV4L2_TEXT N_( "Use libv4l2" )
  99 #define LIBV4L2_LONGTEXT N_( \
 100     "Force usage of the libv4l2 wrapper." )
 101 #endif
 102
 103 #define CTRL_RESET_TEXT N_( "Reset v4l2 controls" )
 104 #define CTRL_RESET_LONGTEXT N_( \
 105     "Reset controls to defaults provided by the v4l2 driver." )
 106 #define BRIGHTNESS_TEXT N_( "Brightness" )
 107 #define BRIGHTNESS_LONGTEXT N_( \
 108     "Brightness of the video input (if supported by the v4l2 driver)." )
 109 #define CONTRAST_TEXT N_( "Contrast" )
 110 #define CONTRAST_LONGTEXT N_( \
 111     "Contrast of the video input (if supported by the v4l2 driver)." )
 112 #define SATURATION_TEXT N_( "Saturation" )
 113 #define SATURATION_LONGTEXT N_( \
 114     "Saturation of the video input (if supported by the v4l2 driver)." )
 115 #define HUE_TEXT N_( "Hue" )
 116 #define HUE_LONGTEXT N_( \
 117     "Hue of the video input (if supported by the v4l2 driver)." )
 118 #define BLACKLEVEL_TEXT N_( "Black level" )
 119 #define BLACKLEVEL_LONGTEXT N_( \
 120     "Black level of the video input (if supported by the v4l2 driver)." )
 121 #define AUTOWHITEBALANCE_TEXT N_( "Auto white balance" )
 122 #define AUTOWHITEBALANCE_LONGTEXT N_( \
 123     "Automatically set the white balance of the video input " \
 124     "(if supported by the v4l2 driver)." )
 125 #define DOWHITEBALANCE_TEXT N_( "Do white balance" )
 126 #define DOWHITEBALANCE_LONGTEXT N_( \
 127     "Trigger a white balancing action, useless if auto white balance is " \
 128     "activated (if supported by the v4l2 driver)." )
 129 #define REDBALANCE_TEXT N_( "Red balance" )
 130 #define REDBALANCE_LONGTEXT N_( \
 131     "Red balance of the video input (if supported by the v4l2 driver)." )
 132 #define BLUEBALANCE_TEXT N_( "Blue balance" )
 133 #define BLUEBALANCE_LONGTEXT N_( \
 134     "Blue balance of the video input (if supported by the v4l2 driver)." )
 135 #define GAMMA_TEXT N_( "Gamma" )
 136 #define GAMMA_LONGTEXT N_( \
 137     "Gamma of the video input (if supported by the v4l2 driver)." )
 138 #define EXPOSURE_TEXT N_( "Exposure" )
 139 #define EXPOSURE_LONGTEXT N_( \
 140     "Exposure of the video input (if supported by the v4L2 driver)." )
 141 #define AUTOGAIN_TEXT N_( "Auto gain" )
 142 #define AUTOGAIN_LONGTEXT N_( \
 143     "Automatically set the video input's gain (if supported by the " \
 144     "v4l2 driver)." )
 145 #define GAIN_TEXT N_( "Gain" )
 146 #define GAIN_LONGTEXT N_( \
 147     "Video input's gain (if supported by the v4l2 driver)." )
 148 #define HFLIP_TEXT N_( "Horizontal flip" )
 149 #define HFLIP_LONGTEXT N_( \
 150     "Flip the video horizontally (if supported by the v4l2 driver)." )
 151 #define VFLIP_TEXT N_( "Vertical flip" )
 152 #define VFLIP_LONGTEXT N_( \
 153     "Flip the video vertically (if supported by the v4l2 driver)." )
 154 #define HCENTER_TEXT N_( "Horizontal centering" )
 155 #define HCENTER_LONGTEXT N_( \
 156     "Set the camera's horizontal centering (if supported by the v4l2 driver)." )
 157 #define VCENTER_TEXT N_( "Vertical centering" )
 158 #define VCENTER_LONGTEXT N_( \
 159     "Set the camera's vertical centering (if supported by the v4l2 driver)." )
 160
 161 #define AUDIO_VOLUME_TEXT N_( "Volume" )
 162 #define AUDIO_VOLUME_LONGTEXT N_( \
 163     "Volume of the audio input (if supported by the v4l2 driver)." )
 164 #define AUDIO_BALANCE_TEXT N_( "Balance" )
 165 #define AUDIO_BALANCE_LONGTEXT N_( \
 166     "Balance of the audio input (if supported by the v4l2 driver)." )
 167 #define AUDIO_MUTE_TEXT N_( "Mute" )
 168 #define AUDIO_MUTE_LONGTEXT N_( \
 169     "Mute audio input (if supported by the v4l2 driver)." )
 170 #define AUDIO_BASS_TEXT N_( "Bass" )
 171 #define AUDIO_BASS_LONGTEXT N_( \
 172     "Bass level of the audio input (if supported by the v4l2 driver)." )
 173 #define AUDIO_TREBLE_TEXT N_( "Treble" )
 174 #define AUDIO_TREBLE_LONGTEXT N_( \
 175     "Treble level of the audio input (if supported by the v4l2 driver)." )
 176 #define AUDIO_LOUDNESS_TEXT N_( "Loudness" )
 177 #define AUDIO_LOUDNESS_LONGTEXT N_( \
 178     "Loudness of the audio input (if supported by the v4l2 driver)." )
 179
 180 #define CACHING_TEXT N_("Caching value in ms")
 181 #define CACHING_LONGTEXT N_( \
 182     "Caching value for V4L2 captures. This " \
 183     "value should be set in milliseconds." )
 184 #define S_CTRLS_TEXT N_("v4l2 driver controls")
 185 #define S_CTRLS_LONGTEXT N_( \
 186     "Set the v4l2 driver controls to the values specified using a comma " \
 187     "separated list optionally encapsulated by curly braces " \
 188     "(e.g.: {video_bitrate=6000000,audio_crc=0,stream_type=3} ). " \
 189     "To list available controls, increase verbosity (-vvv) " \
 190     "or use the v4l2-ctl application." )
 191
 192 #define TUNER_TEXT N_("Tuner id")
 193 #define TUNER_LONGTEXT N_( \
 194     "Tuner id (see debug output)." )
 195 #define FREQUENCY_TEXT N_("Frequency")
 196 #define FREQUENCY_LONGTEXT N_( \
 197     "Tuner frequency in Hz or kHz (see debug output)" )
 198 #define TUNER_AUDIO_MODE_TEXT N_("Audio mode")
 199 #define TUNER_AUDIO_MODE_LONGTEXT N_( \
 200     "Tuner audio mono/stereo and track selection." )
 201
 202 #define AUDIO_DEPRECATED_ERROR N_( \
 203     "Alsa or OSS audio capture in the v4l2 access is deprecated. " \
 204     "please use 'v4l2:/""/ :input-slave=alsa:/""/' or " \
 205     "'v4l2:/""/ :input-slave=oss:/""/' instead." )
 206
 207 #define ASPECT_TEXT N_("Picture aspect-ratio n:m")
 208 #define ASPECT_LONGTEXT N_("Define input picture aspect-ratio to use. Default is 4:3" )
 209
 210 typedef enum {
 211     IO_METHOD_READ,
 212     IO_METHOD_MMAP,
 213     IO_METHOD_USERPTR,
 214 } io_method;
 215
 216 static const int i_standards_list[] =
 217     { V4L2_STD_UNKNOWN, V4L2_STD_SECAM, V4L2_STD_PAL, V4L2_STD_NTSC };
 218 static const char *const psz_standards_list_text[] =
 219     { N_("Default"), N_("SECAM"), N_("PAL"),  N_("NTSC") };
 220
 221 static const int i_iomethod_list[] =
 222     { IO_METHOD_READ, IO_METHOD_MMAP, IO_METHOD_USERPTR };
 223 static const char *const psz_iomethod_list_text[] =
 224     { N_("READ"), N_("MMAP"),  N_("USERPTR") };
 225
 226 static const int i_tuner_audio_modes_list[] =
 227     { V4L2_TUNER_MODE_MONO, V4L2_TUNER_MODE_STEREO,
 228       V4L2_TUNER_MODE_LANG1, V4L2_TUNER_MODE_LANG2,
 229       V4L2_TUNER_MODE_SAP, V4L2_TUNER_MODE_LANG1_LANG2 };
 230 static const char *const psz_tuner_audio_modes_list_text[] =
 231     { N_( "Mono" ),
 232       N_( "Stereo" ),
 233       N_( "Primary language (Analog TV tuners only)" ),
 234       N_( "Secondary language (Analog TV tuners only)" ),
 235       N_( "Second audio program (Analog TV tuners only)" ),
 236       N_( "Primary language left, Secondary language right" ) };
 237
 238 #define V4L2_DEFAULT "/dev/video0"
 239 #define CFG_PREFIX "v4l2-"
 240
 241 vlc_module_begin ()
 242     set_shortname( N_("Video4Linux2") )
 243     set_description( N_("Video4Linux2 input") )
 244     set_category( CAT_INPUT )
 245     set_subcategory( SUBCAT_INPUT_ACCESS )
 246
 247     set_section( N_( "Video input" ), NULL )
 248     add_integer( CFG_PREFIX "standard", 0, NULL, STANDARD_TEXT,
 249                  STANDARD_LONGTEXT, false )
 250         change_integer_list( i_standards_list, psz_standards_list_text, NULL )
 251     add_string( CFG_PREFIX "chroma", NULL, NULL, CHROMA_TEXT, CHROMA_LONGTEXT,
 252                 true )
 253     add_integer( CFG_PREFIX "input", 0, NULL, INPUT_TEXT, INPUT_LONGTEXT,
 254                 true )
 255     add_integer( CFG_PREFIX "audio-input", 0, NULL, AUDIO_INPUT_TEXT,
 256                  AUDIO_INPUT_LONGTEXT, true )
 257     add_integer( CFG_PREFIX "io", IO_METHOD_MMAP, NULL, IOMETHOD_TEXT,
 258                  IOMETHOD_LONGTEXT, true )
 259         change_integer_list( i_iomethod_list, psz_iomethod_list_text, NULL )
 260     add_integer( CFG_PREFIX "width", -1, NULL, WIDTH_TEXT,
 261                 WIDTH_LONGTEXT, true )
 262     add_integer( CFG_PREFIX "height", -1, NULL, HEIGHT_TEXT,
 263                 HEIGHT_LONGTEXT, true )
 264     add_string( CFG_PREFIX "aspect-ratio", "4:3", NULL, ASPECT_TEXT,
 265               ASPECT_LONGTEXT, true )
 266     add_float( CFG_PREFIX "fps", 0, NULL, FPS_TEXT, FPS_LONGTEXT, true )
 267     add_integer( CFG_PREFIX "caching", DEFAULT_PTS_DELAY / 1000, NULL,
 268                 CACHING_TEXT, CACHING_LONGTEXT, true )
 269 #ifdef HAVE_LIBV4L2
 270     add_bool( CFG_PREFIX "use-libv4l2", false, NULL, LIBV4L2_TEXT, LIBV4L2_LONGTEXT, true );
 271 #endif
 272
 273     set_section( N_( "Tuner" ), NULL )
 274     add_integer( CFG_PREFIX "tuner", 0, NULL, TUNER_TEXT, TUNER_LONGTEXT,
 275                  true )
 276     add_integer( CFG_PREFIX "tuner-frequency", -1, NULL, FREQUENCY_TEXT,
 277                  FREQUENCY_LONGTEXT, true )
 278     add_integer( CFG_PREFIX "tuner-audio-mode", -1, NULL, TUNER_AUDIO_MODE_TEXT,
 279                  TUNER_AUDIO_MODE_LONGTEXT, true )
 280         change_integer_list( i_tuner_audio_modes_list,
 281                              psz_tuner_audio_modes_list_text, 0 )
 282
 283     set_section( N_( "Controls" ),
 284                  N_( "v4l2 driver controls, if supported by your v4l2 driver." ) )
 285     add_bool( CFG_PREFIX "controls-reset", false, NULL, CTRL_RESET_TEXT,
 286               CTRL_RESET_LONGTEXT, true )
 287     add_integer( CFG_PREFIX "brightness", -1, NULL, BRIGHTNESS_TEXT,
 288                  BRIGHTNESS_LONGTEXT, true )
 289     add_integer( CFG_PREFIX "contrast", -1, NULL, CONTRAST_TEXT,
 290                  CONTRAST_LONGTEXT, true )
 291     add_integer( CFG_PREFIX "saturation", -1, NULL, SATURATION_TEXT,
 292                  SATURATION_LONGTEXT, true )
 293     add_integer( CFG_PREFIX "hue", -1, NULL, HUE_TEXT,
 294                  HUE_LONGTEXT, true )
 295     add_integer( CFG_PREFIX "black-level", -1, NULL, BLACKLEVEL_TEXT,
 296                  BLACKLEVEL_LONGTEXT, true )
 297     add_integer( CFG_PREFIX "auto-white-balance", -1, NULL,
 298                  AUTOWHITEBALANCE_TEXT, AUTOWHITEBALANCE_LONGTEXT, true )
 299     add_integer( CFG_PREFIX "do-white-balance", -1, NULL, DOWHITEBALANCE_TEXT,
 300                  DOWHITEBALANCE_LONGTEXT, true )
 301     add_integer( CFG_PREFIX "red-balance", -1, NULL, REDBALANCE_TEXT,
 302                  REDBALANCE_LONGTEXT, true )
 303     add_integer( CFG_PREFIX "blue-balance", -1, NULL, BLUEBALANCE_TEXT,
 304                  BLUEBALANCE_LONGTEXT, true )
 305     add_integer( CFG_PREFIX "gamma", -1, NULL, GAMMA_TEXT,
 306                  GAMMA_LONGTEXT, true )
 307     add_integer( CFG_PREFIX "exposure", -1, NULL, EXPOSURE_TEXT,
 308                  EXPOSURE_LONGTEXT, true )
 309     add_integer( CFG_PREFIX "autogain", -1, NULL, AUTOGAIN_TEXT,
 310                  AUTOGAIN_LONGTEXT, true )
 311     add_integer( CFG_PREFIX "gain", -1, NULL, GAIN_TEXT,
 312                  GAIN_LONGTEXT, true )
 313     add_integer( CFG_PREFIX "hflip", -1, NULL, HFLIP_TEXT,
 314                  HFLIP_LONGTEXT, true )
 315     add_integer( CFG_PREFIX "vflip", -1, NULL, VFLIP_TEXT,
 316                  VFLIP_LONGTEXT, true )
 317     add_integer( CFG_PREFIX "hcenter", -1, NULL, HCENTER_TEXT,
 318                  HCENTER_LONGTEXT, true )
 319     add_integer( CFG_PREFIX "vcenter", -1, NULL, VCENTER_TEXT,
 320                  VCENTER_LONGTEXT, true )
 321     add_integer( CFG_PREFIX "audio-volume", -1, NULL, AUDIO_VOLUME_TEXT,
 322                 AUDIO_VOLUME_LONGTEXT, true )
 323     add_integer( CFG_PREFIX "audio-balance", -1, NULL, AUDIO_BALANCE_TEXT,
 324                 AUDIO_BALANCE_LONGTEXT, true )
 325     add_bool( CFG_PREFIX "audio-mute", false, NULL, AUDIO_MUTE_TEXT,
 326               AUDIO_MUTE_LONGTEXT, true )
 327     add_integer( CFG_PREFIX "audio-bass", -1, NULL, AUDIO_BASS_TEXT,
 328                 AUDIO_BASS_LONGTEXT, true )
 329     add_integer( CFG_PREFIX "audio-treble", -1, NULL, AUDIO_TREBLE_TEXT,
 330                 AUDIO_TREBLE_LONGTEXT, true )
 331     add_integer( CFG_PREFIX "audio-loudness", -1, NULL, AUDIO_LOUDNESS_TEXT,
 332                 AUDIO_LOUDNESS_LONGTEXT, true )
 333     add_string( CFG_PREFIX "set-ctrls", NULL, NULL, S_CTRLS_TEXT,
 334               S_CTRLS_LONGTEXT, true )
 335
 336     add_obsolete_string( CFG_PREFIX "dev" )
 337
 338     add_obsolete_string( CFG_PREFIX "adev" )
 339     add_obsolete_integer( CFG_PREFIX "audio-method" )
 340     add_obsolete_bool( CFG_PREFIX "stereo" )
 341     add_obsolete_integer( CFG_PREFIX "samplerate" )
 342
 343     add_shortcut( "v4l2" )
 344     set_capability( "access_demux", 10 )
 345     set_callbacks( DemuxOpen, DemuxClose )
 346
 347     add_submodule ()
 348     add_shortcut( "v4l2" )
 349     add_shortcut( "v4l2c" )
 350     set_description( N_("Video4Linux2 Compressed A/V") )
 351     set_capability( "access", 0 )
 352     /* use these when open as access_demux fails; VLC will use another demux */
 353     set_callbacks( AccessOpen, AccessClose )
 354
 355 vlc_module_end ()
 356
 357 /*****************************************************************************
 358  * Access: local prototypes
 359  *****************************************************************************/
 360
 361 static void CommonClose( vlc_object_t *, demux_sys_t * );
 362 static void ParseMRL( demux_sys_t *, char *, vlc_object_t * );
 363 static void GetV4L2Params( demux_sys_t *, vlc_object_t * );
 364 static void SetAvailControlsByString( vlc_object_t *, demux_sys_t *, int );
 365
 366 static int DemuxControl( demux_t *, int, va_list );
 367 static int AccessControl( access_t *, int, va_list );
 368
 369 static int Demux( demux_t * );
 370 static block_t *AccessRead( access_t * );
 371
 372 static block_t* GrabVideo( vlc_object_t *p_demux, demux_sys_t *p_sys );
 373 static block_t* ProcessVideoFrame( vlc_object_t *p_demux, uint8_t *p_frame, size_t );
 374
 375 static bool IsPixelFormatSupported( demux_t *p_demux,
 376                                           unsigned int i_pixelformat );
 377
 378 static int OpenVideoDev( vlc_object_t *, demux_sys_t *, bool );
 379 static bool ProbeVideoDev( vlc_object_t *, demux_sys_t *,
 380                                  const char *psz_device );
 381
 382 static int ControlList( vlc_object_t *, demux_sys_t *, int , bool, bool );
 383 static int Control( vlc_object_t *, demux_sys_t *, int i_fd,
 384                     const char *psz_name, int i_cid, int i_value );
 385
 386 static int DemuxControlCallback( vlc_object_t *p_this, const char *psz_var,
 387                                  vlc_value_t oldval, vlc_value_t newval,
 388                                  void *p_data );
 389 static int DemuxControlResetCallback( vlc_object_t *p_this, const char *psz_var,
 390                                       vlc_value_t oldval, vlc_value_t newval,
 391                                       void *p_data );
 392 static int AccessControlCallback( vlc_object_t *p_this, const char *psz_var,
 393                                   vlc_value_t oldval, vlc_value_t newval,
 394                                   void *p_data );
 395 static int AccessControlResetCallback( vlc_object_t *p_this,
 396                                        const char *psz_var, vlc_value_t oldval,
 397                                        vlc_value_t newval, void *p_data );
 398
 399 static const struct
 400 {
 401     unsigned int i_v4l2;
 402     vlc_fourcc_t i_fourcc;
 403     int i_rmask;
 404     int i_gmask;
 405     int i_bmask;
 406 } v4l2chroma_to_fourcc[] =
 407 {
 408     /* Raw data types */
 409     { V4L2_PIX_FMT_GREY,    VLC_CODEC_GREY, 0, 0, 0 },
 410     { V4L2_PIX_FMT_HI240,   VLC_FOURCC('I','2','4','0'), 0, 0, 0 },
 411     { V4L2_PIX_FMT_RGB555,  VLC_CODEC_RGB15, 0x001f,0x03e0,0x7c00 },
 412     { V4L2_PIX_FMT_RGB565,  VLC_CODEC_RGB16, 0x001f,0x07e0,0xf800 },
 413     /* Won't work since we don't know how to handle such gmask values
 414      * correctly
 415     { V4L2_PIX_FMT_RGB555X, VLC_CODEC_RGB15, 0x007c,0xe003,0x1f00 },
 416     { V4L2_PIX_FMT_RGB565X, VLC_CODEC_RGB16, 0x00f8,0xe007,0x1f00 },
 417     */
 418     { V4L2_PIX_FMT_BGR24,   VLC_CODEC_RGB24, 0xff0000,0xff00,0xff },
 419     { V4L2_PIX_FMT_RGB24,   VLC_CODEC_RGB24, 0xff,0xff00,0xff0000 },
 420     { V4L2_PIX_FMT_BGR32,   VLC_CODEC_RGB32, 0xff0000,0xff00,0xff },
 421     { V4L2_PIX_FMT_RGB32,   VLC_CODEC_RGB32, 0xff,0xff00,0xff0000 },
 422     { V4L2_PIX_FMT_YUYV,    VLC_CODEC_YUYV, 0, 0, 0 },
 423     { V4L2_PIX_FMT_UYVY,    VLC_CODEC_UYVY, 0, 0, 0 },
 424     { V4L2_PIX_FMT_Y41P,    VLC_FOURCC('I','4','1','N'), 0, 0, 0 },
 425     { V4L2_PIX_FMT_YUV422P, VLC_CODEC_I422, 0, 0, 0 },
 426     { V4L2_PIX_FMT_YVU420,  VLC_CODEC_YV12, 0, 0, 0 },
 427     { V4L2_PIX_FMT_YUV411P, VLC_CODEC_I411, 0, 0, 0 },
 428     { V4L2_PIX_FMT_YUV410,  VLC_CODEC_I410, 0, 0, 0 },
 429
 430     /* Raw data types, not in V4L2 spec but still in videodev2.h and supported
 431      * by VLC */
 432     { V4L2_PIX_FMT_YUV420,  VLC_CODEC_I420, 0, 0, 0 },
 433     /* FIXME { V4L2_PIX_FMT_RGB444,  VLC_CODEC_RGB32 }, */
 434
 435     /* Compressed data types */
 436     { V4L2_PIX_FMT_MJPEG,   VLC_CODEC_MJPG, 0, 0, 0 },
 437     { V4L2_PIX_FMT_JPEG,    VLC_CODEC_JPEG, 0, 0, 0 },
 438 #if 0
 439     { V4L2_PIX_FMT_DV,      VLC_FOURCC('?','?','?','?') },
 440     { V4L2_PIX_FMT_MPEG,    VLC_FOURCC('?','?','?','?') },
 441 #endif
 442     { 0, 0, 0, 0, 0 }
 443 };
 444
 445 /**
 446  * List of V4L2 chromas were confident enough to use as fallbacks if the
 447  * user hasn't provided a --v4l2-chroma value.
 448  *
 449  * Try YUV chromas first, then RGB little endian and MJPEG as last resort.
 450  */
 451 static const __u32 p_chroma_fallbacks[] =
 452 { V4L2_PIX_FMT_YUV420, V4L2_PIX_FMT_YVU420, V4L2_PIX_FMT_YUV422P,
 453   V4L2_PIX_FMT_YUYV, V4L2_PIX_FMT_UYVY, V4L2_PIX_FMT_BGR24,
 454   V4L2_PIX_FMT_BGR32, V4L2_PIX_FMT_MJPEG, V4L2_PIX_FMT_JPEG };
 455
 456 static const struct
 457 {
 458     const char *psz_name;
 459     unsigned int i_cid;
 460 } controls[] =
 461 {
 462     { "brightness", V4L2_CID_BRIGHTNESS },
 463     { "contrast", V4L2_CID_CONTRAST },
 464     { "saturation", V4L2_CID_SATURATION },
 465     { "hue", V4L2_CID_HUE },
 466     { "audio-volume", V4L2_CID_AUDIO_VOLUME },
 467     { "audio-balance", V4L2_CID_AUDIO_BALANCE },
 468     { "audio-bass", V4L2_CID_AUDIO_BASS },
 469     { "audio-treble", V4L2_CID_AUDIO_TREBLE },
 470     { "audio-mute", V4L2_CID_AUDIO_MUTE },
 471     { "audio-loudness", V4L2_CID_AUDIO_LOUDNESS },
 472     { "black-level", V4L2_CID_BLACK_LEVEL },
 473     { "auto-white-balance", V4L2_CID_AUTO_WHITE_BALANCE },
 474     { "do-white-balance", V4L2_CID_DO_WHITE_BALANCE },
 475     { "red-balance", V4L2_CID_RED_BALANCE },
 476     { "blue-balance", V4L2_CID_BLUE_BALANCE },
 477     { "gamma", V4L2_CID_GAMMA },
 478     { "exposure", V4L2_CID_EXPOSURE },
 479     { "autogain", V4L2_CID_AUTOGAIN },
 480     { "gain", V4L2_CID_GAIN },
 481     { "hflip", V4L2_CID_HFLIP },
 482     { "vflip", V4L2_CID_VFLIP },
 483     { "hcenter", V4L2_CID_HCENTER },
 484     { "vcenter", V4L2_CID_VCENTER },
 485     { NULL, 0 }
 486 };
 487
 488 struct buffer_t
 489 {
 490     void *  start;
 491     size_t  length;
 492 };
 493
 494 struct demux_sys_t
 495 {
 496     char *psz_device;  /* Main device from MRL */
 497     int  i_fd;
 498
 499     char *psz_requested_chroma;
 500
 501     /* Video */
 502     io_method io;
 503
 504     int i_cache;
 505
 506     struct v4l2_capability dev_cap;
 507
 508     int i_input;
 509     struct v4l2_input *p_inputs;
 510     int i_selected_input;
 511
 512     int i_standard;
 513     struct v4l2_standard *p_standards;
 514     v4l2_std_id i_selected_standard_id;
 515
 516     int i_audio;
 517     /* V4L2 devices cannot have more than 32 audio inputs */
 518     struct v4l2_audio p_audios[32];
 519     int i_selected_audio_input;
 520
 521     int i_tuner;
 522     struct v4l2_tuner *p_tuners;
 523
 524     int i_codec;
 525     struct v4l2_fmtdesc *p_codecs;
 526
 527     struct buffer_t *p_buffers;
 528     unsigned int i_nbuffers;
 529
 530     int i_width;
 531     int i_height;
 532     unsigned int i_aspect;
 533     float f_fps;            /* <= 0.0 mean to grab at full rate */
 534     mtime_t i_video_pts;    /* only used when f_fps > 0 */
 535     int i_fourcc;
 536
 537     es_out_id_t *p_es;
 538
 539     /* Tuner */
 540     int i_cur_tuner;
 541     int i_frequency;
 542     int i_audio_mode;
 543
 544     /* Controls */
 545     char *psz_set_ctrls;
 546
 547
 548 #ifdef HAVE_LIBV4L2
 549     /* */
 550     int (*pf_close)( int );
 551     int (*pf_dup)( int );
 552     int (*pf_ioctl)( int, unsigned long int, ... );
 553     ssize_t (*pf_read)( int, void *, size_t );
 554     void *(*pf_mmap)( void *, size_t, int, int, int, off_t );
 555     int (*pf_munmap)( void *, size_t );
 556     bool b_libv4l2;
 557 #endif
 558 };
 559
 560 #ifdef HAVE_LIBV4L2
 561 static void use_kernel_v4l2( demux_sys_t *p_sys )
 562 {
 563     p_sys->pf_close = close;
 564     p_sys->pf_dup = dup;
 565     p_sys->pf_ioctl = ioctl;
 566     p_sys->pf_read = read;
 567     p_sys->pf_mmap = mmap;
 568     p_sys->pf_munmap = munmap;
 569     p_sys->b_libv4l2 = false;
 570 }
 571
 572 static void use_libv4l2( demux_sys_t *p_sys )
 573 {
 574     p_sys->pf_close = v4l2_close;
 575     p_sys->pf_dup = v4l2_dup;
 576     p_sys->pf_ioctl = v4l2_ioctl;
 577     p_sys->pf_read = v4l2_read;
 578     p_sys->pf_mmap = v4l2_mmap;
 579     p_sys->pf_munmap = v4l2_munmap;
 580     p_sys->b_libv4l2 = true;
 581 }
 582
 583 #   define v4l2_close (p_sys->pf_close)
 584 #   define v4l2_dup (p_sys->pf_dup)
 585 #   define v4l2_ioctl (p_sys->pf_ioctl)
 586 #   define v4l2_read (p_sys->pf_read)
 587 #   define v4l2_mmap (p_sys->pf_mmap)
 588 #   define v4l2_munmap (p_sys->pf_munmap)
 589 #else
 590 #   define v4l2_close close
 591 #   define v4l2_dup dup
 592 #   define v4l2_ioctl ioctl
 593 #   define v4l2_read read
 594 #   define v4l2_mmap mmap
 595 #   define v4l2_munmap munmap
 596 #endif
 597
 598 static int FindMainDevice( vlc_object_t *p_this, demux_sys_t *p_sys,
 599                            bool b_demux )
 600 {
 601     /* TODO: if using default device, loop through all /dev/video* until
 602      * one works */
 603     msg_Dbg( p_this, "opening device '%s'", p_sys->psz_device );
 604     if( ProbeVideoDev( p_this, p_sys, p_sys->psz_device ) )
 605     {
 606         msg_Dbg( p_this, "'%s' is a video device", p_sys->psz_device );
 607         p_sys->i_fd = OpenVideoDev( p_this, p_sys, b_demux );
 608     }
 609
 610     if( p_sys->i_fd < 0 ) return VLC_EGENERIC;
 611     return VLC_SUCCESS;
 612 }
 613
 614 /*****************************************************************************
 615  * DemuxOpen: opens v4l2 device, access_demux callback
 616  *****************************************************************************
 617  *
 618  * url: <video device>::::
 619  *
 620  *****************************************************************************/
 621 static int DemuxOpen( vlc_object_t *p_this )
 622 {
 623     demux_t     *p_demux = (demux_t*)p_this;
 624     demux_sys_t *p_sys;
 625
 626     /* Only when selected */
 627     if( strcmp( p_demux->psz_access, "v4l2" ) )
 628         return VLC_EGENERIC;
 629
 630     /* Set up p_demux */
 631     p_demux->pf_control = DemuxControl;
 632     p_demux->pf_demux = Demux;
 633     p_demux->info.i_update = 0;
 634     p_demux->info.i_title = 0;
 635     p_demux->info.i_seekpoint = 0;
 636
 637     p_demux->p_sys = p_sys = calloc( 1, sizeof( demux_sys_t ) );
 638     if( p_sys == NULL ) return VLC_ENOMEM;
 639
 640     GetV4L2Params(p_sys, (vlc_object_t *) p_demux);
 641
 642     ParseMRL( p_sys, p_demux->psz_path, (vlc_object_t *) p_demux );
 643
 644 #ifdef HAVE_LIBV4L2
 645     if( !config_GetInt( p_this, CFG_PREFIX "use-libv4l2" ) )
 646     {
 647         msg_Dbg( p_this, "Trying direct kernel v4l2" );
 648         use_kernel_v4l2( p_sys );
 649         if( FindMainDevice( p_this, p_sys, true ) == VLC_SUCCESS)
 650             return VLC_SUCCESS;
 651     }
 652
 653     msg_Dbg( p_this, "Trying libv4l2 wrapper" );
 654     use_libv4l2( p_sys );
 655 #endif
 656     if( FindMainDevice( p_this, p_sys, true ) == VLC_SUCCESS)
 657         return VLC_SUCCESS;
 658
 659     DemuxClose( p_this );
 660     return VLC_EGENERIC;
 661 }
 662
 663 /*****************************************************************************
 664  * GetV4L2Params: fill in p_sys parameters (shared by DemuxOpen and AccessOpen)
 665  *****************************************************************************/
 666 static void GetV4L2Params( demux_sys_t *p_sys, vlc_object_t *p_obj )
 667 {
 668     p_sys->i_video_pts = -1;
 669
 670     p_sys->i_selected_standard_id =
 671         i_standards_list[var_CreateGetInteger( p_obj, "v4l2-standard" )];
 672
 673     p_sys->i_selected_input = var_CreateGetInteger( p_obj, "v4l2-input" );
 674     p_sys->i_selected_audio_input =
 675         var_CreateGetInteger( p_obj, "v4l2-audio-input" );
 676
 677     p_sys->io = var_CreateGetInteger( p_obj, "v4l2-io" );
 678
 679     p_sys->i_width = var_CreateGetInteger( p_obj, "v4l2-width" );
 680     p_sys->i_height = var_CreateGetInteger( p_obj, "v4l2-height" );
 681
 682     var_Create( p_obj, "v4l2-controls-reset", VLC_VAR_BOOL | VLC_VAR_DOINHERIT );
 683
 684     p_sys->f_fps = var_CreateGetFloat( p_obj, "v4l2-fps" );
 685     p_sys->psz_requested_chroma = var_CreateGetString( p_obj, "v4l2-chroma" );
 686
 687     p_sys->i_cache = var_CreateGetInteger( p_obj, "v4l2-caching" );
 688
 689     p_sys->i_cur_tuner = var_CreateGetInteger( p_obj, "v4l2-tuner" );
 690     p_sys->i_frequency = var_CreateGetInteger( p_obj, "v4l2-tuner-frequency" );
 691     p_sys->i_audio_mode = var_CreateGetInteger( p_obj, "v4l2-tuner-audio-mode" );
 692
 693     p_sys->psz_set_ctrls = var_CreateGetString( p_obj, "v4l2-set-ctrls" );
 694
 695     char *psz_aspect = var_CreateGetString( p_obj, "v4l2-aspect-ratio" );
 696     if( psz_aspect && *psz_aspect && strchr( psz_aspect, ':' ) )
 697     {
 698         char *psz_delim = strchr( psz_aspect, ':' );
 699         p_sys->i_aspect = atoi( psz_aspect ) * VOUT_ASPECT_FACTOR / atoi( psz_delim + 1 );
 700     }
 701     else
 702     {
 703         p_sys->i_aspect = 4 * VOUT_ASPECT_FACTOR / 3 ;
 704
 705     }
 706     free( psz_aspect );
 707
 708     p_sys->psz_device = NULL;
 709     p_sys->i_fd = -1;
 710
 711     p_sys->p_es = NULL;
 712 }
 713
 714 /*****************************************************************************
 715  * ParseMRL: parse the options contained in the MRL
 716  *****************************************************************************/
 717 static void ParseMRL( demux_sys_t *p_sys, char *psz_path, vlc_object_t *p_obj )
 718 {
 719     char *psz_dup = strdup( psz_path );
 720     char *psz_parser = psz_dup;
 721
 722     while( *psz_parser && *psz_parser != ':' )
 723     {
 724         psz_parser++;
 725     }
 726
 727     if( *psz_parser == ':' )
 728     {
 729         /* read options */
 730         for( ;; )
 731         {
 732             *psz_parser++ = '\0';
 733
 734             if( !strncmp( psz_parser, "standard=", strlen( "standard=" ) ) )
 735             {
 736                 psz_parser += strlen( "standard=" );
 737                 if( !strncmp( psz_parser, "pal", strlen( "pal" ) ) )
 738                 {
 739                     p_sys->i_selected_standard_id = V4L2_STD_PAL;
 740                     psz_parser += strlen( "pal" );
 741                 }
 742                 else if( !strncmp( psz_parser, "ntsc", strlen( "ntsc" ) ) )
 743                 {
 744                     p_sys->i_selected_standard_id = V4L2_STD_NTSC;
 745                     psz_parser += strlen( "ntsc" );
 746                 }
 747                 else if( !strncmp( psz_parser, "secam", strlen( "secam" ) ) )
 748                 {
 749                     p_sys->i_selected_standard_id = V4L2_STD_SECAM;
 750                     psz_parser += strlen( "secam" );
 751                 }
 752                 else if( !strncmp( psz_parser, "default", strlen( "default" ) ) )
 753                 {
 754                     p_sys->i_selected_standard_id = V4L2_STD_UNKNOWN;
 755                     psz_parser += strlen( "default" );
 756                 }
 757                 else
 758                 {
 759                     p_sys->i_selected_standard_id = i_standards_list[strtol( psz_parser, &psz_parser, 0 )];
 760                 }
 761             }
 762             else if( !strncmp( psz_parser, "chroma=", strlen( "chroma=" ) ) )
 763             {
 764                 int  i_len;
 765
 766                 psz_parser += strlen( "chroma=" );
 767                 if( strchr( psz_parser, ':' ) )
 768                 {
 769                     i_len = strchr( psz_parser, ':' ) - psz_parser;
 770                 }
 771                 else
 772                 {
 773                     i_len = strlen( psz_parser );
 774                 }
 775
 776                 free( p_sys->psz_requested_chroma );
 777                 p_sys->psz_requested_chroma = strndup( psz_parser, i_len );
 778
 779                 psz_parser += i_len;
 780             }
 781             else if( !strncmp( psz_parser, "input=", strlen( "input=" ) ) )
 782             {
 783                 p_sys->i_selected_input = strtol( psz_parser + strlen( "input=" ),
 784                                        &psz_parser, 0 );
 785             }
 786             else if( !strncmp( psz_parser, "audio-input=", strlen( "audio-input=" ) ) )
 787             {
 788                 p_sys->i_selected_audio_input = strtol( psz_parser + strlen( "audio-input=" ),
 789                                        &psz_parser, 0 );
 790             }
 791             else if( !strncmp( psz_parser, "fps=", strlen( "fps=" ) ) )
 792             {
 793                 p_sys->f_fps = strtof( psz_parser + strlen( "fps=" ),
 794                                        &psz_parser );
 795             }
 796             else if( !strncmp( psz_parser, "io=", strlen( "io=" ) ) )
 797             {
 798                 psz_parser += strlen( "io=" );
 799                 if( !strncmp( psz_parser, "read", strlen( "read" ) ) )
 800                 {
 801                     p_sys->io = IO_METHOD_READ;
 802                     psz_parser += strlen( "read" );
 803                 }
 804                 else if( !strncmp( psz_parser, "mmap", strlen( "mmap" ) ) )
 805                 {
 806                     p_sys->io = IO_METHOD_MMAP;
 807                     psz_parser += strlen( "mmap" );
 808                 }
 809                 else if( !strncmp( psz_parser, "userptr", strlen( "userptr" ) ) )
 810                 {
 811                     p_sys->io = IO_METHOD_USERPTR;
 812                     psz_parser += strlen( "userptr" );
 813                 }
 814                 else
 815                 {
 816                     p_sys->io = strtol( psz_parser, &psz_parser, 0 );
 817                 }
 818             }
 819             else if( !strncmp( psz_parser, "width=",
 820                                strlen( "width=" ) ) )
 821             {
 822                 p_sys->i_width =
 823                     strtol( psz_parser + strlen( "width=" ),
 824                             &psz_parser, 0 );
 825             }
 826             else if( !strncmp( psz_parser, "height=",
 827                                strlen( "height=" ) ) )
 828             {
 829                 p_sys->i_height =
 830                     strtol( psz_parser + strlen( "height=" ),
 831                             &psz_parser, 0 );
 832             }
 833             else if( !strncmp( psz_parser, "aspect-ratio=",
 834                                strlen( "aspect-ratio=" ) ) )
 835             {
 836                 unsigned int num,den;
 837                 num = strtol( psz_parser + strlen( "aspect-ratio=" ),
 838                               &psz_parser, 0 );
 839                 den = strtol( psz_parser + strlen( ":" ),
 840                               &psz_parser, 0 );
 841                 if( num && den )
 842                     p_sys->i_aspect = num * VOUT_ASPECT_FACTOR / den;
 843             }
 844             else if( !strncmp( psz_parser, "controls-reset",
 845                                strlen( "controls-reset" ) ) )
 846             {
 847                 var_SetBool( p_obj, "v4l2-controls-reset", true );
 848                 psz_parser += strlen( "controls-reset" );
 849             }
 850 #if 0
 851             else if( !strncmp( psz_parser, "brightness=",
 852                                strlen( "brightness=" ) ) )
 853             {
 854                 var_SetInteger( p_obj, "brightness",
 855                     strtol( psz_parser + strlen( "brightness=" ),
 856                             &psz_parser, 0 ) );
 857             }
 858             else if( !strncmp( psz_parser, "contrast=",
 859                                strlen( "contrast=" ) ) )
 860             {
 861                 var_SetInteger( p_obj, "contrast",
 862                     strtol( psz_parser + strlen( "contrast=" ),
 863                             &psz_parser, 0 ) );
 864             }
 865             else if( !strncmp( psz_parser, "saturation=",
 866                                strlen( "saturation=" ) ) )
 867             {
 868                 var_SetInteger( p_obj, "saturation",
 869                     strtol( psz_parser + strlen( "saturation=" ),
 870                             &psz_parser, 0 ) );
 871             }
 872             else if( !strncmp( psz_parser, "hue=",
 873                                strlen( "hue=" ) ) )
 874             {
 875                 var_SetInteger( p_obj, "hue",
 876                     strtol( psz_parser + strlen( "hue=" ),
 877                             &psz_parser, 0 ) );
 878             }
 879             else if( !strncmp( psz_parser, "gamma=",
 880                                strlen( "gamma=" ) ) )
 881             {
 882                 var_SetInteger( p_obj, "gamma",
 883                     strtol( psz_parser + strlen( "gamma=" ),
 884                             &psz_parser, 0 ) );
 885             }
 886 #endif
 887             else if( !strncmp( psz_parser, "caching=", strlen( "caching=" ) ) )
 888             {
 889                 p_sys->i_cache = strtol( psz_parser + strlen( "caching=" ),
 890                                          &psz_parser, 0 );
 891             }
 892             else if( !strncmp( psz_parser, "tuner=", strlen( "tuner=" ) ) )
 893             {
 894                 p_sys->i_cur_tuner = strtol( psz_parser + strlen( "tuner=" ),
 895                                          &psz_parser, 0 );
 896             }
 897             else if( !strncmp( psz_parser, "tuner-frequency=", strlen( "tuner-frequency=" ) ) )
 898             {
 899                 p_sys->i_frequency = strtol( psz_parser
 900                                           + strlen( "tuner-frequency=" ),
 901                                           &psz_parser, 0 );
 902             }
 903             else if( !strncmp( psz_parser, "tuner-audio-mode=", strlen( "tuner-audio-mode=" ) ) )
 904             {
 905                 p_sys->i_audio_mode = strtol( psz_parser
 906                                           + strlen( "tuner-audio-mode=" ),
 907                                           &psz_parser, 0 );
 908             }
 909             else if( !strncmp( psz_parser, "set-ctrls=", strlen( "set-ctrls=" )) )
 910             {
 911                 int  i_len;
 912
 913                 psz_parser += strlen( "set-ctrls=" );
 914                 if( strchr( psz_parser, ':' ) )
 915                 {
 916                     i_len = strchr( psz_parser, ':' ) - psz_parser;
 917                 }
 918                 else
 919                 {
 920                     i_len = strlen( psz_parser );
 921                 }
 922
 923                 p_sys->psz_set_ctrls = strndup( psz_parser, i_len );
 924
 925                 psz_parser += i_len;
 926             }
 927             else if( !strncmp( psz_parser, "adev=", strlen( "adev=" ) )
 928              || !strncmp( psz_parser, "samplerate=", strlen( "samplerate=" ) )
 929              || !strncmp( psz_parser, "audio-method", strlen( "audio-method" ) )
 930              || !strncmp( psz_parser, "stereo", strlen( "stereo" ) )
 931              || !strncmp( psz_parser, "mono", strlen( "mono" ) ) )
 932             {
 933                 if( strchr( psz_parser, ':' ) )
 934                 {
 935                     psz_parser = strchr( psz_parser, ':' );
 936                 }
 937                 else
 938                 {
 939                     psz_parser += strlen( psz_parser );
 940                 }
 941
 942                 msg_Err( p_obj, AUDIO_DEPRECATED_ERROR );
 943             }
 944             else
 945             {
 946                 char *psz_unk = strchr( psz_parser, ':' );
 947                 if (psz_unk)
 948                     psz_unk = strndup( psz_parser, psz_unk - psz_parser );
 949                 else
 950                     psz_unk = strdup( psz_parser);
 951                 msg_Warn( p_obj, "unknown option %s", psz_unk );
 952                 free (psz_unk);
 953             }
 954
 955             while( *psz_parser && *psz_parser != ':' )
 956             {
 957                 psz_parser++;
 958             }
 959
 960             if( *psz_parser == '\0' )
 961             {
 962                 break;
 963             }
 964         }
 965     }
 966
 967     /* Main device */
 968     if( *psz_dup )
 969         p_sys->psz_device = strdup( psz_dup );
 970     else
 971         p_sys->psz_device = strdup( V4L2_DEFAULT );
 972     free( psz_dup );
 973 }
 974
 975 /*****************************************************************************
 976  * Close: close device, free resources
 977  *****************************************************************************/
 978 static void AccessClose( vlc_object_t *p_this )
 979 {
 980     access_t    *p_access = (access_t *)p_this;
 981     demux_sys_t *p_sys   = (demux_sys_t *) p_access->p_sys;
 982
 983     CommonClose( p_this, p_sys );
 984 }
 985
 986 static void DemuxClose( vlc_object_t *p_this )
 987 {
 988     struct v4l2_buffer buf;
 989     enum v4l2_buf_type buf_type;
 990     unsigned int i;
 991
 992     demux_t     *p_demux = (demux_t *)p_this;
 993     demux_sys_t *p_sys   = p_demux->p_sys;
 994
 995     /* Stop video capture */
 996     if( p_sys->i_fd >= 0 )
 997     {
 998         switch( p_sys->io )
 999         {
1000         case IO_METHOD_READ:
1001             /* Nothing to do */
1002             break;
1003
1004         case IO_METHOD_MMAP:
1005         case IO_METHOD_USERPTR:
1006             /* Some drivers 'hang' internally if this is not done before streamoff */
1007             for( unsigned int i = 0; i < p_sys->i_nbuffers; i++ )
1008             {
1009                 memset( &buf, 0, sizeof(buf) );
1010                 buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1011                 buf.memory = ( p_sys->io == IO_METHOD_USERPTR ) ?
1012                     V4L2_MEMORY_USERPTR : V4L2_MEMORY_MMAP;
1013                 v4l2_ioctl( p_sys->i_fd, VIDIOC_DQBUF, &buf ); /* ignore result */
1014             }
1015
1016             buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1017             if( v4l2_ioctl( p_sys->i_fd, VIDIOC_STREAMOFF, &buf_type ) < 0 ) {
1018                 msg_Err( p_this, "VIDIOC_STREAMOFF failed" );
1019             }
1020
1021             break;
1022         }
1023     }
1024
1025     /* Free Video Buffers */
1026     if( p_sys->p_buffers ) {
1027         switch( p_sys->io )
1028         {
1029         case IO_METHOD_READ:
1030             free( p_sys->p_buffers[0].start );
1031             break;
1032
1033         case IO_METHOD_MMAP:
1034             for( i = 0; i < p_sys->i_nbuffers; ++i )
1035             {
1036                 if( v4l2_munmap( p_sys->p_buffers[i].start, p_sys->p_buffers[i].length ) )
1037                 {
1038                     msg_Err( p_this, "munmap failed" );
1039                 }
1040             }
1041             break;
1042
1043         case IO_METHOD_USERPTR:
1044             for( i = 0; i < p_sys->i_nbuffers; ++i )
1045             {
1046                free( p_sys->p_buffers[i].start );
1047             }
1048             break;
1049         }
1050         free( p_sys->p_buffers );
1051     }
1052
1053     CommonClose( p_this, p_sys );
1054 }
1055
1056 static void CommonClose( vlc_object_t *p_this, demux_sys_t *p_sys )
1057 {
1058     (void)p_this;
1059     /* Close */
1060     if( p_sys->i_fd >= 0 ) v4l2_close( p_sys->i_fd );
1061     free( p_sys->psz_device );
1062     free( p_sys->p_standards );
1063     free( p_sys->p_inputs );
1064     free( p_sys->p_tuners );
1065     free( p_sys->p_codecs );
1066     free( p_sys->psz_requested_chroma );
1067     free( p_sys->psz_set_ctrls );
1068
1069     free( p_sys );
1070 }
1071
1072 /*****************************************************************************
1073  * AccessOpen: opens v4l2 device, access callback
1074  *****************************************************************************
1075  *
1076  * url: <video device>::::
1077  *
1078  *****************************************************************************/
1079 static int AccessOpen( vlc_object_t * p_this )
1080 {
1081     access_t *p_access = (access_t*) p_this;
1082     demux_sys_t * p_sys;
1083
1084     /* Only when selected */
1085     if( *p_access->psz_access == '\0' ) return VLC_EGENERIC;
1086
1087     access_InitFields( p_access );
1088     ACCESS_SET_CALLBACKS( NULL, AccessRead, AccessControl, NULL );
1089     p_sys = calloc( 1, sizeof( demux_sys_t ));
1090     if( !p_sys ) return VLC_ENOMEM;
1091     p_access->p_sys = (access_sys_t*)p_sys;
1092
1093     GetV4L2Params( p_sys, (vlc_object_t *) p_access );
1094
1095     ParseMRL( p_sys, p_access->psz_path, (vlc_object_t *) p_access );
1096
1097 #ifdef HAVE_LIBV4L2
1098     if( !config_GetInt( p_this, CFG_PREFIX "use-libv4l2" ) )
1099     {
1100         msg_Dbg( p_this, "Trying direct kernel v4l2" );
1101         use_kernel_v4l2( p_sys );
1102         if( FindMainDevice( p_this, p_sys, false ) == VLC_SUCCESS)
1103             return VLC_SUCCESS;
1104     }
1105
1106     msg_Dbg( p_this, "Trying libv4l2 wrapper" );
1107     use_libv4l2( p_sys );
1108 #endif
1109     if( FindMainDevice( p_this, p_sys, false ) == VLC_SUCCESS )
1110         return VLC_SUCCESS;
1111
1112     AccessClose( p_this );
1113     return VLC_EGENERIC;
1114 }
1115
1116 /*****************************************************************************
1117  * DemuxControl:
1118  *****************************************************************************/
1119 static int DemuxControl( demux_t *p_demux, int i_query, va_list args )
1120 {
1121     switch( i_query )
1122     {
1123         /* Special for access_demux */
1124         case DEMUX_CAN_PAUSE:
1125         case DEMUX_CAN_SEEK:
1126         case DEMUX_CAN_CONTROL_PACE:
1127             *va_arg( args, bool * ) = false;
1128             return VLC_SUCCESS;
1129
1130         case DEMUX_GET_PTS_DELAY:
1131             *va_arg(args,int64_t *) = (int64_t)p_demux->p_sys->i_cache*1000;
1132             return VLC_SUCCESS;
1133
1134         case DEMUX_GET_TIME:
1135             *va_arg( args, int64_t * ) = mdate();
1136             return VLC_SUCCESS;
1137
1138         /* TODO implement others */
1139         default:
1140             return VLC_EGENERIC;
1141     }
1142
1143     return VLC_EGENERIC;
1144 }
1145
1146 /*****************************************************************************
1147  * AccessControl: access callback
1148  *****************************************************************************/
1149 static int AccessControl( access_t *p_access, int i_query, va_list args )
1150 {
1151     demux_sys_t  *p_sys = (demux_sys_t *) p_access->p_sys;
1152
1153     switch( i_query )
1154     {
1155         /* */
1156         case ACCESS_CAN_SEEK:
1157         case ACCESS_CAN_FASTSEEK:
1158         case ACCESS_CAN_PAUSE:
1159         case ACCESS_CAN_CONTROL_PACE:
1160             *va_arg( args, bool* ) = false;
1161             break;
1162
1163         /* */
1164         case ACCESS_GET_PTS_DELAY:
1165             *va_arg(args,int64_t *) = (int64_t)p_sys->i_cache*1000;
1166             break;
1167
1168         /* */
1169         case ACCESS_SET_PAUSE_STATE:
1170             /* Nothing to do */
1171             break;
1172
1173         case ACCESS_GET_TITLE_INFO:
1174         case ACCESS_SET_TITLE:
1175         case ACCESS_SET_SEEKPOINT:
1176         case ACCESS_SET_PRIVATE_ID_STATE:
1177         case ACCESS_GET_CONTENT_TYPE:
1178         case ACCESS_GET_META:
1179             return VLC_EGENERIC;
1180
1181         default:
1182             msg_Warn( p_access, "Unimplemented query in control(%d).", i_query);
1183             return VLC_EGENERIC;
1184
1185     }
1186     return VLC_SUCCESS;
1187 }
1188
1189 /*****************************************************************************
1190  * AccessRead: access callback
1191  ******************************************************************************/
1192 static block_t *AccessRead( access_t * p_access )
1193 {
1194     demux_sys_t *p_sys = (demux_sys_t *)p_access->p_sys;
1195
1196     struct pollfd fd;
1197     fd.fd = p_sys->i_fd;
1198     fd.events = POLLIN|POLLPRI;
1199     fd.revents = 0;
1200
1201     /* Wait for data */
1202     if( poll( &fd, 1, 500 ) ) /* Timeout after 0.5 seconds since I don't know if pf_demux can be blocking. */
1203     {
1204         if( fd.revents & (POLLIN|POLLPRI) )
1205         {
1206             return GrabVideo( VLC_OBJECT(p_access), p_sys );
1207         }
1208     }
1209
1210     return NULL;
1211 }
1212
1213 /*****************************************************************************
1214  * Demux: Processes the audio or video frame
1215  *****************************************************************************/
1216 static int Demux( demux_t *p_demux )
1217 {
1218     demux_sys_t *p_sys = p_demux->p_sys;
1219
1220     struct pollfd fd;
1221     fd.fd = p_sys->i_fd;
1222     fd.events = POLLIN|POLLPRI;
1223     fd.revents = 0;
1224
1225     /* Wait for data */
1226     if( poll( &fd, 1, 500 ) ) /* Timeout after 0.5 seconds since I don't know if pf_demux can be blocking. */
1227     {
1228         if( fd.revents & (POLLIN|POLLPRI) )
1229         {
1230             block_t *p_block = GrabVideo( VLC_OBJECT(p_demux), p_sys );
1231             if( p_block )
1232             {
1233                 es_out_Control( p_demux->out, ES_OUT_SET_PCR, p_block->i_pts );
1234                 es_out_Send( p_demux->out, p_sys->p_es, p_block );
1235             }
1236         }
1237     }
1238
1239     return 1;
1240 }
1241
1242 /*****************************************************************************
1243  * GrabVideo: Grab a video frame
1244  *****************************************************************************/
1245 static block_t* GrabVideo( vlc_object_t *p_demux, demux_sys_t *p_sys )
1246 {
1247     block_t *p_block = NULL;
1248     struct v4l2_buffer buf;
1249     ssize_t i_ret;
1250
1251     if( p_sys->f_fps >= 0.1 && p_sys->i_video_pts > 0 )
1252     {
1253         mtime_t i_dur = (mtime_t)((double)1000000 / (double)p_sys->f_fps);
1254
1255         /* Did we wait long enough ? (frame rate reduction) */
1256         if( p_sys->i_video_pts + i_dur > mdate() ) return 0;
1257     }
1258
1259     /* Grab Video Frame */
1260     switch( p_sys->io )
1261     {
1262     case IO_METHOD_READ:
1263         i_ret = v4l2_read( p_sys->i_fd, p_sys->p_buffers[0].start, p_sys->p_buffers[0].length );
1264         if( i_ret == -1 )
1265         {
1266             switch( errno )
1267             {
1268             case EAGAIN:
1269                 return 0;
1270             case EIO:
1271                 /* Could ignore EIO, see spec. */
1272                 /* fall through */
1273             default:
1274                 msg_Err( p_demux, "Failed to read frame" );
1275                 return 0;
1276                }
1277         }
1278
1279         p_block = ProcessVideoFrame( p_demux, (uint8_t*)p_sys->p_buffers[0].start, i_ret );
1280         if( !p_block ) return 0;
1281
1282         break;
1283
1284     case IO_METHOD_MMAP:
1285         memset( &buf, 0, sizeof(buf) );
1286         buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1287         buf.memory = V4L2_MEMORY_MMAP;
1288
1289         /* Wait for next frame */
1290         if (v4l2_ioctl( p_sys->i_fd, VIDIOC_DQBUF, &buf ) < 0 )
1291         {
1292             switch( errno )
1293             {
1294             case EAGAIN:
1295                 return 0;
1296             case EIO:
1297                 /* Could ignore EIO, see spec. */
1298                 /* fall through */
1299             default:
1300                 msg_Err( p_demux, "Failed to wait (VIDIOC_DQBUF)" );
1301                 return 0;
1302                }
1303         }
1304
1305         if( buf.index >= p_sys->i_nbuffers ) {
1306             msg_Err( p_demux, "Failed capturing new frame as i>=nbuffers" );
1307             return 0;
1308         }
1309
1310         p_block = ProcessVideoFrame( p_demux, p_sys->p_buffers[buf.index].start, buf.bytesused );
1311         if( !p_block ) return 0;
1312
1313         /* Unlock */
1314         if( v4l2_ioctl( p_sys->i_fd, VIDIOC_QBUF, &buf ) < 0 )
1315         {
1316             msg_Err( p_demux, "Failed to unlock (VIDIOC_QBUF)" );
1317             block_Release( p_block );
1318             return 0;
1319         }
1320
1321         break;
1322
1323     case IO_METHOD_USERPTR:
1324         memset( &buf, 0, sizeof(buf) );
1325         buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1326         buf.memory = V4L2_MEMORY_USERPTR;
1327
1328         /* Wait for next frame */
1329         if (v4l2_ioctl( p_sys->i_fd, VIDIOC_DQBUF, &buf ) < 0 )
1330         {
1331             switch( errno )
1332             {
1333             case EAGAIN:
1334                 return 0;
1335             case EIO:
1336                 /* Could ignore EIO, see spec. */
1337                 /* fall through */
1338             default:
1339                 msg_Err( p_demux, "Failed to wait (VIDIOC_DQBUF)" );
1340                 return 0;
1341             }
1342         }
1343
1344         /* Find frame? */
1345         unsigned int i;
1346         for( i = 0; i < p_sys->i_nbuffers; i++ )
1347         {
1348             if( buf.m.userptr == (unsigned long)p_sys->p_buffers[i].start &&
1349                 buf.length == p_sys->p_buffers[i].length ) break;
1350         }
1351
1352         if( i >= p_sys->i_nbuffers )
1353         {
1354             msg_Err( p_demux, "Failed capturing new frame as i>=nbuffers" );
1355             return 0;
1356         }
1357
1358         p_block = ProcessVideoFrame( p_demux, (uint8_t*)buf.m.userptr, buf.bytesused );
1359         if( !p_block ) return 0;
1360
1361         /* Unlock */
1362         if( v4l2_ioctl( p_sys->i_fd, VIDIOC_QBUF, &buf ) < 0 )
1363         {
1364             msg_Err( p_demux, "Failed to unlock (VIDIOC_QBUF)" );
1365             block_Release( p_block );
1366             return 0;
1367         }
1368
1369         break;
1370
1371     }
1372
1373     /* Timestamp */
1374     p_sys->i_video_pts = p_block->i_pts = p_block->i_dts = mdate();
1375
1376     return p_block;
1377 }
1378
1379 /*****************************************************************************
1380  * ProcessVideoFrame: Helper function to take a buffer and copy it into
1381  * a new block
1382  *****************************************************************************/
1383 static block_t* ProcessVideoFrame( vlc_object_t *p_demux, uint8_t *p_frame, size_t i_size )
1384 {
1385     block_t *p_block;
1386
1387     if( !p_frame ) return 0;
1388
1389     /* New block */
1390     if( !( p_block = block_New( p_demux, i_size ) ) )
1391     {
1392         msg_Warn( p_demux, "Cannot get new block" );
1393         return 0;
1394     }
1395
1396     /* Copy frame */
1397     memcpy( p_block->p_buffer, p_frame, i_size );
1398
1399     return p_block;
1400 }
1401
1402 /*****************************************************************************
1403  * Helper function to initalise video IO using the Read method
1404  *****************************************************************************/
1405 static int InitRead( vlc_object_t *p_demux, demux_sys_t *p_sys, unsigned int i_buffer_size )
1406 {
1407     (void)p_demux;
1408
1409     p_sys->p_buffers = calloc( 1, sizeof( *p_sys->p_buffers ) );
1410     if( !p_sys->p_buffers )
1411         return VLC_EGENERIC;
1412
1413     p_sys->p_buffers[0].length = i_buffer_size;
1414     p_sys->p_buffers[0].start = malloc( i_buffer_size );
1415     if( !p_sys->p_buffers[0].start )
1416         return VLC_ENOMEM;
1417
1418     return VLC_SUCCESS;
1419 }
1420
1421 /*****************************************************************************
1422  * Helper function to initalise video IO using the mmap method
1423  *****************************************************************************/
1424 static int InitMmap( vlc_object_t *p_demux, demux_sys_t *p_sys, int i_fd )
1425 {
1426     struct v4l2_requestbuffers req;
1427
1428     memset( &req, 0, sizeof(req) );
1429     req.count = 4;
1430     req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1431     req.memory = V4L2_MEMORY_MMAP;
1432
1433     if( v4l2_ioctl( i_fd, VIDIOC_REQBUFS, &req ) < 0 )
1434     {
1435         msg_Err( p_demux, "device does not support mmap i/o" );
1436         goto open_failed;
1437     }
1438
1439     if( req.count < 2 )
1440     {
1441         msg_Err( p_demux, "Insufficient buffer memory" );
1442         goto open_failed;
1443     }
1444
1445     p_sys->p_buffers = calloc( req.count, sizeof( *p_sys->p_buffers ) );
1446     if( !p_sys->p_buffers )
1447         goto open_failed;
1448
1449     for( p_sys->i_nbuffers = 0; p_sys->i_nbuffers < req.count; ++p_sys->i_nbuffers )
1450     {
1451         struct v4l2_buffer buf;
1452
1453         memset( &buf, 0, sizeof(buf) );
1454         buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1455         buf.memory = V4L2_MEMORY_MMAP;
1456         buf.index = p_sys->i_nbuffers;
1457
1458         if( v4l2_ioctl( i_fd, VIDIOC_QUERYBUF, &buf ) < 0 )
1459         {
1460             msg_Err( p_demux, "VIDIOC_QUERYBUF" );
1461             goto open_failed;
1462         }
1463
1464         p_sys->p_buffers[p_sys->i_nbuffers].length = buf.length;
1465         p_sys->p_buffers[p_sys->i_nbuffers].start =
1466             v4l2_mmap( NULL, buf.length, PROT_READ | PROT_WRITE, MAP_SHARED, i_fd, buf.m.offset );
1467
1468         if( p_sys->p_buffers[p_sys->i_nbuffers].start == MAP_FAILED )
1469         {
1470             msg_Err( p_demux, "mmap failed (%m)" );
1471             goto open_failed;
1472         }
1473     }
1474
1475     return VLC_SUCCESS;
1476
1477 open_failed:
1478     return VLC_EGENERIC;
1479
1480 }
1481
1482 /*****************************************************************************
1483  * Helper function to initalise video IO using the userbuf method
1484  *****************************************************************************/
1485 static int InitUserP( vlc_object_t *p_demux, demux_sys_t *p_sys, int i_fd, unsigned int i_buffer_size )
1486 {
1487     struct v4l2_requestbuffers req;
1488     unsigned int i_page_size;
1489
1490     i_page_size = sysconf(_SC_PAGESIZE);
1491     i_buffer_size = ( i_buffer_size + i_page_size - 1 ) & ~( i_page_size - 1);
1492
1493     memset( &req, 0, sizeof(req) );
1494     req.count = 4;
1495     req.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1496     req.memory = V4L2_MEMORY_USERPTR;
1497
1498     if( v4l2_ioctl( i_fd, VIDIOC_REQBUFS, &req ) < 0 )
1499     {
1500         msg_Err( p_demux, "device does not support user pointer i/o" );
1501         return VLC_EGENERIC;
1502     }
1503
1504     p_sys->p_buffers = calloc( 4, sizeof( *p_sys->p_buffers ) );
1505     if( !p_sys->p_buffers )
1506         goto open_failed;
1507
1508     for( p_sys->i_nbuffers = 0; p_sys->i_nbuffers < 4; ++p_sys->i_nbuffers )
1509     {
1510         p_sys->p_buffers[p_sys->i_nbuffers].length = i_buffer_size;
1511         if( posix_memalign( &p_sys->p_buffers[p_sys->i_nbuffers].start,
1512                 /* boundary */ i_page_size, i_buffer_size ) )
1513             goto open_failed;
1514     }
1515
1516     return VLC_SUCCESS;
1517
1518 open_failed:
1519     free( p_sys->p_buffers );
1520     return VLC_EGENERIC;
1521
1522 }
1523
1524 /*****************************************************************************
1525  * IsPixelFormatSupported: returns true if the specified V4L2 pixel format is
1526  * in the array of supported formats returned by the driver
1527  *****************************************************************************/
1528 static bool IsPixelFormatSupported( demux_t *p_demux, unsigned int i_pixelformat )
1529 {
1530     demux_sys_t *p_sys = p_demux->p_sys;
1531
1532     for( int i_index = 0; i_index < p_sys->i_codec; i_index++ )
1533     {
1534         if( p_sys->p_codecs[i_index].pixelformat == i_pixelformat )
1535             return true;
1536     }
1537
1538     return false;
1539 }
1540
1541 static float GetMaxFrameRate( demux_t *p_demux, int i_fd,
1542                               uint32_t i_pixel_format,
1543                               uint32_t i_width, uint32_t i_height )
1544 {
1545     (void)p_demux;
1546 #ifdef VIDIOC_ENUM_FRAMEINTERVALS
1547 #ifdef HAVE_LIBV4L2
1548     demux_sys_t *p_sys = p_demux->p_sys;
1549 #endif
1550     /* This is new in Linux 2.6.19 */
1551     struct v4l2_frmivalenum frmival;
1552     memset( &frmival, 0, sizeof(frmival) );
1553     frmival.pixel_format = i_pixel_format;
1554     frmival.width = i_width;
1555     frmival.height = i_height;
1556     if( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMEINTERVALS, &frmival ) >= 0 )
1557     {
1558         switch( frmival.type )
1559         {
1560             case V4L2_FRMIVAL_TYPE_DISCRETE:
1561             {
1562                 float f_fps_max = -1;
1563                 do
1564                 {
1565                     float f_fps = (float)frmival.discrete.denominator
1566                                 / (float)frmival.discrete.numerator;
1567                     if( f_fps > f_fps_max ) f_fps_max = f_fps;
1568                     frmival.index++;
1569                 } while( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMEINTERVALS,
1570                                      &frmival ) >= 0 );
1571                 return f_fps_max;
1572             }
1573             case V4L2_FRMSIZE_TYPE_STEPWISE:
1574             case V4L2_FRMIVAL_TYPE_CONTINUOUS:
1575                 return __MAX( (float)frmival.stepwise.max.denominator
1576                             / (float)frmival.stepwise.max.numerator,
1577                               (float)frmival.stepwise.min.denominator
1578                             / (float)frmival.stepwise.min.numerator );
1579         }
1580     }
1581 #endif
1582     return -1.;
1583 }
1584
1585 static float GetAbsoluteMaxFrameRate( demux_t *p_demux, int i_fd,
1586                                       uint32_t i_pixel_format )
1587 {
1588     float f_fps_max = -1.;
1589 #ifdef VIDIOC_ENUM_FRAMESIZES
1590 #ifdef HAVE_LIBV4L2
1591     demux_sys_t *p_sys = p_demux->p_sys;
1592 #endif
1593     /* This is new in Linux 2.6.19 */
1594     struct v4l2_frmsizeenum frmsize;
1595     memset( &frmsize, 0, sizeof(frmsize) );
1596     frmsize.pixel_format = i_pixel_format;
1597     if( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMESIZES, &frmsize ) >= 0 )
1598     {
1599         switch( frmsize.type )
1600         {
1601             case V4L2_FRMSIZE_TYPE_DISCRETE:
1602                 do
1603                 {
1604                     frmsize.index++;
1605                     float f_fps = GetMaxFrameRate( p_demux, i_fd,
1606                                                    i_pixel_format,
1607                                                    frmsize.discrete.width,
1608                                                    frmsize.discrete.height );
1609                     if( f_fps > f_fps_max ) f_fps_max = f_fps;
1610                 } while( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMESIZES,
1611                          &frmsize ) >= 0 );
1612                 break;
1613             case V4L2_FRMSIZE_TYPE_STEPWISE:
1614             {
1615                 uint32_t i_width = frmsize.stepwise.min_width;
1616                 uint32_t i_height = frmsize.stepwise.min_height;
1617                 for( ;
1618                      i_width <= frmsize.stepwise.max_width &&
1619                      i_height <= frmsize.stepwise.max_width;
1620                      i_width += frmsize.stepwise.step_width,
1621                      i_height += frmsize.stepwise.step_height )
1622                 {
1623                     float f_fps = GetMaxFrameRate( p_demux, i_fd,
1624                                                    i_pixel_format,
1625                                                    i_width, i_height );
1626                     if( f_fps > f_fps_max ) f_fps_max = f_fps;
1627                 }
1628                 break;
1629             }
1630             case V4L2_FRMSIZE_TYPE_CONTINUOUS:
1631                 /* FIXME */
1632                 msg_Err( p_demux, "GetAbsoluteMaxFrameRate implementation for V4L2_FRMSIZE_TYPE_CONTINUOUS isn't correct" );
1633                  f_fps_max = GetMaxFrameRate( p_demux, i_fd,
1634                                               i_pixel_format,
1635                                               frmsize.stepwise.max_width,
1636                                               frmsize.stepwise.max_height );
1637                 break;
1638         }
1639     }
1640 #endif
1641     return f_fps_max;
1642 }
1643
1644 static void GetMaxDimensions( demux_t *p_demux, int i_fd,
1645                               uint32_t i_pixel_format, float f_fps_min,
1646                               uint32_t *pi_width, uint32_t *pi_height )
1647 {
1648     *pi_width = 0;
1649     *pi_height = 0;
1650 #ifdef VIDIOC_ENUM_FRAMESIZES
1651 #ifdef HAVE_LIBV4L2
1652     demux_sys_t *p_sys = p_demux->p_sys;
1653 #endif
1654     /* This is new in Linux 2.6.19 */
1655     struct v4l2_frmsizeenum frmsize;
1656     memset( &frmsize, 0, sizeof(frmsize) );
1657     frmsize.pixel_format = i_pixel_format;
1658     if( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMESIZES, &frmsize ) >= 0 )
1659     {
1660         switch( frmsize.type )
1661         {
1662             case V4L2_FRMSIZE_TYPE_DISCRETE:
1663                 do
1664                 {
1665                     frmsize.index++;
1666                     float f_fps = GetMaxFrameRate( p_demux, i_fd,
1667                                                    i_pixel_format,
1668                                                    frmsize.discrete.width,
1669                                                    frmsize.discrete.height );
1670                     if( f_fps >= f_fps_min &&
1671                         frmsize.discrete.width > *pi_width )
1672                     {
1673                         *pi_width = frmsize.discrete.width;
1674                         *pi_height = frmsize.discrete.height;
1675                     }
1676                 } while( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMESIZES,
1677                          &frmsize ) >= 0 );
1678                 break;
1679             case V4L2_FRMSIZE_TYPE_STEPWISE:
1680             {
1681                 uint32_t i_width = frmsize.stepwise.min_width;
1682                 uint32_t i_height = frmsize.stepwise.min_height;
1683                 for( ;
1684                      i_width <= frmsize.stepwise.max_width &&
1685                      i_height <= frmsize.stepwise.max_width;
1686                      i_width += frmsize.stepwise.step_width,
1687                      i_height += frmsize.stepwise.step_height )
1688                 {
1689                     float f_fps = GetMaxFrameRate( p_demux, i_fd,
1690                                                    i_pixel_format,
1691                                                    i_width, i_height );
1692                     if( f_fps >= f_fps_min && i_width > *pi_width )
1693                     {
1694                         *pi_width = i_width;
1695                         *pi_height = i_height;
1696                     }
1697                 }
1698                 break;
1699             }
1700             case V4L2_FRMSIZE_TYPE_CONTINUOUS:
1701                 /* FIXME */
1702                 msg_Err( p_demux, "GetMaxDimension implementation for V4L2_FRMSIZE_TYPE_CONTINUOUS isn't correct" );
1703                 float f_fps = GetMaxFrameRate( p_demux, i_fd,
1704                                                i_pixel_format,
1705                                                frmsize.stepwise.max_width,
1706                                                frmsize.stepwise.max_height );
1707                 if( f_fps >= f_fps_min &&
1708                     frmsize.stepwise.max_width > *pi_width )
1709                 {
1710                     *pi_width = frmsize.stepwise.max_width;
1711                     *pi_height = frmsize.stepwise.max_height;
1712                 }
1713                 break;
1714         }
1715     }
1716 #endif
1717 }
1718
1719 /*****************************************************************************
1720  * OpenVideoDev: open and set up the video device and probe for capabilities
1721  *****************************************************************************/
1722 static int OpenVideoDev( vlc_object_t *p_obj, demux_sys_t *p_sys, bool b_demux )
1723 {
1724     int i_fd;
1725     struct v4l2_cropcap cropcap;
1726     struct v4l2_crop crop;
1727     struct v4l2_format fmt;
1728     unsigned int i_min;
1729     enum v4l2_buf_type buf_type;
1730     const char *psz_device = p_sys->psz_device;
1731     es_format_t es_fmt;
1732
1733     if( ( i_fd = open( psz_device, O_RDWR ) ) < 0 )
1734     {
1735         msg_Err( p_obj, "cannot open device (%m)" );
1736         goto open_failed;
1737     }
1738
1739 #ifdef HAVE_LIBV4L2
1740     /* Note the v4l2_xxx functions are designed so that if they get passed an
1741        unknown fd, the will behave exactly as their regular xxx counterparts,
1742        so if v4l2_fd_open fails, we continue as normal (missing the libv4l2
1743        custom cam format to normal formats conversion). Chances are big we will
1744        still fail then though, as normally v4l2_fd_open only fails if the
1745        device is not a v4l2 device. */
1746     if( p_sys->b_libv4l2 )
1747     {
1748         int libv4l2_fd;
1749         libv4l2_fd = v4l2_fd_open( i_fd, V4L2_ENABLE_ENUM_FMT_EMULATION );
1750         if( libv4l2_fd != -1 )
1751             i_fd = libv4l2_fd;
1752     }
1753 #endif
1754
1755     /* Tune the tuner */
1756     if( p_sys->i_frequency >= 0 )
1757     {
1758         if( p_sys->i_cur_tuner < 0 || p_sys->i_cur_tuner >= p_sys->i_tuner )
1759         {
1760             msg_Err( p_obj, "invalid tuner %d.", p_sys->i_cur_tuner );
1761             goto open_failed;
1762         }
1763         struct v4l2_frequency frequency;
1764         memset( &frequency, 0, sizeof( frequency ) );
1765         frequency.tuner = p_sys->i_cur_tuner;
1766         frequency.type = p_sys->p_tuners[p_sys->i_cur_tuner].type;
1767         frequency.frequency = p_sys->i_frequency / 62.5;
1768         if( v4l2_ioctl( i_fd, VIDIOC_S_FREQUENCY, &frequency ) < 0 )
1769         {
1770             msg_Err( p_obj, "cannot set tuner frequency (%m)" );
1771             goto open_failed;
1772         }
1773         msg_Dbg( p_obj, "Tuner frequency set" );
1774     }
1775
1776     /* Set the tuner's audio mode */
1777     if( p_sys->i_audio_mode >= 0 )
1778     {
1779         if( p_sys->i_cur_tuner < 0 || p_sys->i_cur_tuner >= p_sys->i_tuner )
1780         {
1781             msg_Err( p_obj, "invalid tuner %d.", p_sys->i_cur_tuner );
1782             goto open_failed;
1783         }
1784         struct v4l2_tuner tuner;
1785         memset( &tuner, 0, sizeof( tuner ) );
1786         tuner.index = p_sys->i_cur_tuner;
1787         tuner.audmode = p_sys->i_audio_mode;
1788         if( v4l2_ioctl( i_fd, VIDIOC_S_TUNER, &tuner ) < 0 )
1789         {
1790             msg_Err( p_obj, "cannot set tuner audio mode (%m)" );
1791             goto open_failed;
1792         }
1793         msg_Dbg( p_obj, "Tuner audio mode set" );
1794     }
1795
1796     /* Select standard */
1797
1798     if( p_sys->i_selected_standard_id != V4L2_STD_UNKNOWN )
1799     {
1800         if( v4l2_ioctl( i_fd, VIDIOC_S_STD, &p_sys->i_selected_standard_id ) < 0 )
1801         {
1802             msg_Err( p_obj, "cannot set standard (%m)" );
1803             goto open_failed;
1804         }
1805         msg_Dbg( p_obj, "Set standard" );
1806     }
1807
1808     /* Select input */
1809
1810     if( p_sys->i_selected_input >= p_sys->i_input )
1811     {
1812         msg_Warn( p_obj, "invalid input. Using the default one" );
1813         p_sys->i_selected_input = 0;
1814     }
1815
1816     if( v4l2_ioctl( i_fd, VIDIOC_S_INPUT, &p_sys->i_selected_input ) < 0 )
1817     {
1818         msg_Err( p_obj, "cannot set input (%m)" );
1819         goto open_failed;
1820     }
1821
1822     /* Set audio input */
1823
1824     if( p_sys->i_audio > 0 )
1825     {
1826         if( p_sys->i_selected_audio_input < 0
1827          || p_sys->i_selected_audio_input >= p_sys->i_audio )
1828         {
1829             msg_Warn( p_obj, "invalid audio input. Using the default one" );
1830             p_sys->i_selected_audio_input = 0;
1831         }
1832
1833         if( v4l2_ioctl( i_fd, VIDIOC_S_AUDIO, &p_sys->p_audios[p_sys->i_selected_audio_input] ) < 0 )
1834         {
1835             msg_Err( p_obj, "cannot set audio input (%m)" );
1836             goto open_failed;
1837         }
1838         msg_Dbg( p_obj, "Audio input set to %d", p_sys->i_selected_audio_input );
1839     }
1840
1841
1842     /* TODO: Move the resolution stuff up here */
1843     /* if MPEG encoder card, no need to do anything else after this */
1844     ControlList( p_obj, p_sys, i_fd,
1845                   var_GetBool( p_obj, "v4l2-controls-reset" ), b_demux );
1846     SetAvailControlsByString( p_obj, p_sys, i_fd );
1847
1848     /* Verify device support for the various IO methods */
1849     switch( p_sys->io )
1850     {
1851         case IO_METHOD_READ:
1852             if( !(p_sys->dev_cap.capabilities & V4L2_CAP_READWRITE) )
1853             {
1854                 msg_Err( p_obj, "device does not support read i/o" );
1855                 goto open_failed;
1856             }
1857             break;
1858
1859         case IO_METHOD_MMAP:
1860         case IO_METHOD_USERPTR:
1861             if( !(p_sys->dev_cap.capabilities & V4L2_CAP_STREAMING) )
1862             {
1863                 msg_Err( p_obj, "device does not support streaming i/o" );
1864                 goto open_failed;
1865             }
1866             break;
1867
1868         default:
1869             msg_Err( p_obj, "io method not supported" );
1870             goto open_failed;
1871     }
1872
1873     /* Reset Cropping */
1874     memset( &cropcap, 0, sizeof(cropcap) );
1875     cropcap.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1876     if( v4l2_ioctl( i_fd, VIDIOC_CROPCAP, &cropcap ) >= 0 )
1877     {
1878         crop.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1879         crop.c = cropcap.defrect; /* reset to default */
1880         if( v4l2_ioctl( i_fd, VIDIOC_S_CROP, &crop ) < 0 )
1881         {
1882             switch( errno )
1883             {
1884                 case EINVAL:
1885                     /* Cropping not supported. */
1886                     break;
1887                 default:
1888                     /* Errors ignored. */
1889                     break;
1890             }
1891         }
1892     }
1893
1894     /* Try and find default resolution if not specified */
1895     memset( &fmt, 0, sizeof(fmt) );
1896     fmt.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
1897
1898     if( p_sys->i_width == 0 || p_sys->i_height == 0 )
1899     {
1900         /* Use current width and height settings */
1901         if( v4l2_ioctl( i_fd, VIDIOC_G_FMT, &fmt ) < 0 )
1902         {
1903             msg_Err( p_obj, "Cannot get default width and height." );
1904             goto open_failed;
1905         }
1906
1907         p_sys->i_width = fmt.fmt.pix.width;
1908         p_sys->i_height = fmt.fmt.pix.height;
1909
1910         if( fmt.fmt.pix.field == V4L2_FIELD_ALTERNATE )
1911         {
1912             p_sys->i_height = p_sys->i_height * 2;
1913         }
1914     }
1915     else if( p_sys->i_width < 0 || p_sys->i_height < 0 )
1916     {
1917         msg_Dbg( p_obj, "will try to find optimal width and height." );
1918     }
1919     else
1920     {
1921         /* Use user specified width and height */
1922         msg_Dbg( p_obj, "trying specified size %dx%d", p_sys->i_width, p_sys->i_height );
1923     }
1924
1925     fmt.fmt.pix.width = p_sys->i_width;
1926     fmt.fmt.pix.height = p_sys->i_height;
1927     fmt.fmt.pix.field = V4L2_FIELD_NONE;
1928
1929     if (b_demux)
1930     {
1931         demux_t *p_demux = (demux_t *) p_obj;
1932
1933         /* Test and set Chroma */
1934         fmt.fmt.pix.pixelformat = 0;
1935         if( p_sys->psz_requested_chroma && *p_sys->psz_requested_chroma )
1936         {
1937             /* User specified chroma */
1938             const vlc_fourcc_t i_requested_fourcc =
1939                 vlc_fourcc_GetCodecFromString( VIDEO_ES, p_sys->psz_requested_chroma );
1940
1941             for( int i = 0; v4l2chroma_to_fourcc[i].i_v4l2 != 0; i++ )
1942             {
1943                 if( v4l2chroma_to_fourcc[i].i_fourcc == i_requested_fourcc )
1944                 {
1945                     fmt.fmt.pix.pixelformat = v4l2chroma_to_fourcc[i].i_v4l2;
1946                     break;
1947                 }
1948             }
1949             /* Try and set user chroma */
1950             bool b_error = !IsPixelFormatSupported( p_demux, fmt.fmt.pix.pixelformat );
1951             if( !b_error && fmt.fmt.pix.pixelformat )
1952             {
1953                 if( v4l2_ioctl( i_fd, VIDIOC_S_FMT, &fmt ) < 0 )
1954                 {
1955                     fmt.fmt.pix.field = V4L2_FIELD_ANY;
1956                     if( v4l2_ioctl( i_fd, VIDIOC_S_FMT, &fmt ) < 0 )
1957                     {
1958                         fmt.fmt.pix.field = V4L2_FIELD_NONE;
1959                         b_error = true;
1960                     }
1961                 }
1962             }
1963             if( b_error )
1964             {
1965                 msg_Warn( p_demux, "Driver is unable to use specified chroma %s. Trying defaults.", p_sys->psz_requested_chroma );
1966                 fmt.fmt.pix.pixelformat = 0;
1967             }
1968         }
1969
1970         /* If no user specified chroma, find best */
1971         /* This also decides if MPEG encoder card or not */
1972         if( !fmt.fmt.pix.pixelformat )
1973         {
1974             unsigned int i;
1975             for( i = 0; i < ARRAY_SIZE( p_chroma_fallbacks ); i++ )
1976             {
1977                 fmt.fmt.pix.pixelformat = p_chroma_fallbacks[i];
1978                 if( IsPixelFormatSupported( p_demux, fmt.fmt.pix.pixelformat ) )
1979                 {
1980                     if( v4l2_ioctl( i_fd, VIDIOC_S_FMT, &fmt ) >= 0 )
1981                         break;
1982                     fmt.fmt.pix.field = V4L2_FIELD_ANY;
1983                     if( v4l2_ioctl( i_fd, VIDIOC_S_FMT, &fmt ) >= 0 )
1984                         break;
1985                     fmt.fmt.pix.field = V4L2_FIELD_NONE;
1986                 }
1987             }
1988             if( i == ARRAY_SIZE( p_chroma_fallbacks ) )
1989             {
1990                 msg_Warn( p_demux, "Could not select any of the default chromas; attempting to open as MPEG encoder card (access)" );
1991                 goto open_failed;
1992             }
1993         }
1994
1995         if( p_sys->i_width < 0 || p_sys->i_height < 0 )
1996         {
1997             if( p_sys->f_fps <= 0 )
1998             {
1999                 p_sys->f_fps = GetAbsoluteMaxFrameRate( p_demux, i_fd,
2000                                                         fmt.fmt.pix.pixelformat );
2001                 msg_Dbg( p_demux, "Found maximum framerate of %f", p_sys->f_fps );
2002             }
2003             GetMaxDimensions( p_demux, i_fd,
2004                               fmt.fmt.pix.pixelformat, p_sys->f_fps,
2005                               &fmt.fmt.pix.width, &fmt.fmt.pix.height );
2006             msg_Dbg( p_demux, "Found optimal dimensions for framerate %f of %dx%d",
2007                      p_sys->f_fps, fmt.fmt.pix.width, fmt.fmt.pix.height );
2008             if( v4l2_ioctl( i_fd, VIDIOC_S_FMT, &fmt ) < 0 ) {;}
2009         }
2010
2011         /* Reassign width, height and chroma incase driver override */
2012         p_sys->i_width = fmt.fmt.pix.width;
2013         p_sys->i_height = fmt.fmt.pix.height;
2014     }
2015
2016     if( v4l2_ioctl( i_fd, VIDIOC_G_FMT, &fmt ) < 0 ) {;}
2017     /* Print extra info */
2018     msg_Dbg( p_obj, "Driver requires at most %d bytes to store a complete image", fmt.fmt.pix.sizeimage );
2019     /* Check interlacing */
2020     switch( fmt.fmt.pix.field )
2021     {
2022         case V4L2_FIELD_NONE:
2023             msg_Dbg( p_obj, "Interlacing setting: progressive" );
2024             break;
2025         case V4L2_FIELD_TOP:
2026             msg_Dbg( p_obj, "Interlacing setting: top field only" );
2027             break;
2028         case V4L2_FIELD_BOTTOM:
2029             msg_Dbg( p_obj, "Interlacing setting: bottom field only" );
2030             break;
2031         case V4L2_FIELD_INTERLACED:
2032             msg_Dbg( p_obj, "Interlacing setting: interleaved (bottom top if M/NTSC, top bottom otherwise)" );
2033             break;
2034         case V4L2_FIELD_SEQ_TB:
2035             msg_Dbg( p_obj, "Interlacing setting: sequential top bottom" );
2036             break;
2037         case V4L2_FIELD_SEQ_BT:
2038             msg_Dbg( p_obj, "Interlacing setting: sequential bottom top" );
2039             break;
2040         case V4L2_FIELD_ALTERNATE:
2041             msg_Dbg( p_obj, "Interlacing setting: alternate fields" );
2042             break;
2043         case V4L2_FIELD_INTERLACED_TB:
2044             msg_Dbg( p_obj, "Interlacing setting: interleaved top bottom" );
2045             break;
2046         case V4L2_FIELD_INTERLACED_BT:
2047             msg_Dbg( p_obj, "Interlacing setting: interleaved bottom top" );
2048             break;
2049         default:
2050             msg_Warn( p_obj, "Interlacing setting: unknown type (%d)",
2051                       fmt.fmt.pix.field );
2052             break;
2053     }
2054     if( fmt.fmt.pix.field != V4L2_FIELD_NONE )
2055         msg_Warn( p_obj, "Interlaced inputs haven't been tested. Please report any issue." );
2056
2057     /* Look up final fourcc */
2058     p_sys->i_fourcc = 0;
2059     for( int i = 0; v4l2chroma_to_fourcc[i].i_fourcc != 0; i++ )
2060     {
2061         if( v4l2chroma_to_fourcc[i].i_v4l2 == fmt.fmt.pix.pixelformat )
2062         {
2063             p_sys->i_fourcc = v4l2chroma_to_fourcc[i].i_fourcc;
2064             es_format_Init( &es_fmt, VIDEO_ES, p_sys->i_fourcc );
2065             es_fmt.video.i_rmask = v4l2chroma_to_fourcc[i].i_rmask;
2066             es_fmt.video.i_gmask = v4l2chroma_to_fourcc[i].i_gmask;
2067             es_fmt.video.i_bmask = v4l2chroma_to_fourcc[i].i_bmask;
2068             break;
2069         }
2070     }
2071
2072     /* Buggy driver paranoia */
2073     i_min = fmt.fmt.pix.width * 2;
2074     if( fmt.fmt.pix.bytesperline < i_min )
2075         fmt.fmt.pix.bytesperline = i_min;
2076     i_min = fmt.fmt.pix.bytesperline * fmt.fmt.pix.height;
2077     if( fmt.fmt.pix.sizeimage < i_min )
2078         fmt.fmt.pix.sizeimage = i_min;
2079
2080 #ifdef VIDIOC_ENUM_FRAMEINTERVALS
2081     /* This is new in Linux 2.6.19 */
2082     /* List supported frame rates */
2083     struct v4l2_frmivalenum frmival;
2084     memset( &frmival, 0, sizeof(frmival) );
2085     frmival.pixel_format = fmt.fmt.pix.pixelformat;
2086     frmival.width = p_sys->i_width;
2087     frmival.height = p_sys->i_height;
2088     if( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMEINTERVALS, &frmival ) >= 0 )
2089     {
2090         char psz_fourcc[5];
2091         memset( &psz_fourcc, 0, sizeof( psz_fourcc ) );
2092         vlc_fourcc_to_char( p_sys->i_fourcc, &psz_fourcc );
2093         msg_Dbg( p_obj, "supported frame intervals for %4s, %dx%d:",
2094                  psz_fourcc, frmival.width, frmival.height );
2095         switch( frmival.type )
2096         {
2097             case V4L2_FRMIVAL_TYPE_DISCRETE:
2098                 do
2099                 {
2100                     msg_Dbg( p_obj, "    supported frame interval: %d/%d",
2101                              frmival.discrete.numerator,
2102                              frmival.discrete.denominator );
2103                     frmival.index++;
2104                 } while( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMEINTERVALS, &frmival ) >= 0 );
2105                 break;
2106             case V4L2_FRMIVAL_TYPE_STEPWISE:
2107                 msg_Dbg( p_obj, "    supported frame intervals: %d/%d to "
2108                          "%d/%d using %d/%d increments",
2109                          frmival.stepwise.min.numerator,
2110                          frmival.stepwise.min.denominator,
2111                          frmival.stepwise.max.numerator,
2112                          frmival.stepwise.max.denominator,
2113                          frmival.stepwise.step.numerator,
2114                          frmival.stepwise.step.denominator );
2115                 break;
2116             case V4L2_FRMIVAL_TYPE_CONTINUOUS:
2117                 msg_Dbg( p_obj, "    supported frame intervals: %d/%d to %d/%d",
2118                          frmival.stepwise.min.numerator,
2119                          frmival.stepwise.min.denominator,
2120                          frmival.stepwise.max.numerator,
2121                          frmival.stepwise.max.denominator );
2122                 break;
2123         }
2124     }
2125 #endif
2126
2127
2128     /* Init IO method */
2129     switch( p_sys->io )
2130     {
2131     case IO_METHOD_READ:
2132         if( InitRead( p_obj, p_sys, fmt.fmt.pix.sizeimage ) != VLC_SUCCESS ) goto open_failed;
2133         break;
2134
2135     case IO_METHOD_MMAP:
2136         if( InitMmap( p_obj, p_sys, i_fd ) != VLC_SUCCESS ) goto open_failed;
2137         break;
2138
2139     case IO_METHOD_USERPTR:
2140         if( InitUserP( p_obj, p_sys, i_fd, fmt.fmt.pix.sizeimage ) != VLC_SUCCESS ) goto open_failed;
2141         break;
2142
2143     }
2144
2145     /* Add */
2146     es_fmt.video.i_width  = p_sys->i_width;
2147     es_fmt.video.i_height = p_sys->i_height;
2148
2149     /* Get aspect-ratio */
2150     es_fmt.video.i_aspect = p_sys->i_aspect;
2151
2152     if( b_demux )
2153     {
2154         demux_t *p_demux = (demux_t *) p_obj;
2155         msg_Dbg( p_demux, "added new video es %4.4s %dx%d",
2156             (char*)&es_fmt.i_codec, es_fmt.video.i_width, es_fmt.video.i_height );
2157         p_sys->p_es = es_out_Add( p_demux->out, &es_fmt );
2158     }
2159
2160     /* Start Capture */
2161
2162     switch( p_sys->io )
2163     {
2164     case IO_METHOD_READ:
2165         /* Nothing to do */
2166         break;
2167
2168     case IO_METHOD_MMAP:
2169         for (unsigned int i = 0; i < p_sys->i_nbuffers; ++i)
2170         {
2171             struct v4l2_buffer buf;
2172
2173             memset( &buf, 0, sizeof(buf) );
2174             buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2175             buf.memory = V4L2_MEMORY_MMAP;
2176             buf.index = i;
2177
2178             if( v4l2_ioctl( i_fd, VIDIOC_QBUF, &buf ) < 0 )
2179             {
2180                 msg_Err( p_obj, "VIDIOC_QBUF failed" );
2181                 goto open_failed;
2182             }
2183         }
2184
2185         buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2186         if( v4l2_ioctl( i_fd, VIDIOC_STREAMON, &buf_type ) < 0 )
2187         {
2188             msg_Err( p_obj, "VIDIOC_STREAMON failed" );
2189             goto open_failed;
2190         }
2191
2192         break;
2193
2194     case IO_METHOD_USERPTR:
2195         for( unsigned int i = 0; i < p_sys->i_nbuffers; ++i )
2196         {
2197             struct v4l2_buffer buf;
2198
2199             memset( &buf, 0, sizeof(buf) );
2200             buf.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2201             buf.memory = V4L2_MEMORY_USERPTR;
2202             buf.index = i;
2203             buf.m.userptr = (unsigned long)p_sys->p_buffers[i].start;
2204             buf.length = p_sys->p_buffers[i].length;
2205
2206             if( v4l2_ioctl( i_fd, VIDIOC_QBUF, &buf ) < 0 )
2207             {
2208                 msg_Err( p_obj, "VIDIOC_QBUF failed" );
2209                 goto open_failed;
2210             }
2211         }
2212
2213         buf_type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2214         if( v4l2_ioctl( i_fd, VIDIOC_STREAMON, &buf_type ) < 0 )
2215         {
2216             msg_Err( p_obj, "VIDIOC_STREAMON failed" );
2217             goto open_failed;
2218         }
2219
2220         break;
2221     }
2222
2223     /* report fps */
2224     if( p_sys->f_fps >= 0.1 )
2225     {
2226         msg_Dbg( p_obj, "User set fps=%f", p_sys->f_fps );
2227     }
2228
2229     return i_fd;
2230
2231 open_failed:
2232     if( i_fd >= 0 ) v4l2_close( i_fd );
2233     return -1;
2234
2235 }
2236
2237 /*****************************************************************************
2238  * ProbeVideoDev: probe video for capabilities
2239  *****************************************************************************/
2240 static bool ProbeVideoDev( vlc_object_t *p_obj, demux_sys_t *p_sys,
2241                                  const char *psz_device )
2242 {
2243     int i_index;
2244     int i_standard;
2245
2246     int i_fd;
2247
2248     if( ( i_fd = open( psz_device, O_RDWR ) ) < 0 )
2249     {
2250         msg_Err( p_obj, "cannot open video device '%s' (%m)", psz_device );
2251         goto open_failed;
2252     }
2253
2254 #ifdef HAVE_LIBV4L2
2255     /* Note the v4l2_xxx functions are designed so that if they get passed an
2256        unknown fd, the will behave exactly as their regular xxx counterparts,
2257        so if v4l2_fd_open fails, we continue as normal (missing the libv4l2
2258        custom cam format to normal formats conversion). Chances are big we will
2259        still fail then though, as normally v4l2_fd_open only fails if the
2260        device is not a v4l2 device. */
2261     if( p_sys->b_libv4l2 )
2262     {
2263         int libv4l2_fd;
2264         libv4l2_fd = v4l2_fd_open( i_fd, V4L2_ENABLE_ENUM_FMT_EMULATION );
2265         if( libv4l2_fd != -1 )
2266             i_fd = libv4l2_fd;
2267     }
2268 #endif
2269
2270     /* Get device capabilites */
2271
2272     if( v4l2_ioctl( i_fd, VIDIOC_QUERYCAP, &p_sys->dev_cap ) < 0 )
2273     {
2274         msg_Err( p_obj, "cannot get video capabilities (%m)" );
2275         goto open_failed;
2276     }
2277
2278     msg_Dbg( p_obj, "V4L2 device: %s using driver: %s (version: %u.%u.%u) on %s",
2279                             p_sys->dev_cap.card,
2280                             p_sys->dev_cap.driver,
2281                             (p_sys->dev_cap.version >> 16) & 0xFF,
2282                             (p_sys->dev_cap.version >> 8) & 0xFF,
2283                             p_sys->dev_cap.version & 0xFF,
2284                             p_sys->dev_cap.bus_info );
2285
2286     msg_Dbg( p_obj, "the device has the capabilities: (%c) Video Capure, "
2287                                                        "(%c) Audio, "
2288                                                        "(%c) Tuner",
2289              ( p_sys->dev_cap.capabilities & V4L2_CAP_VIDEO_CAPTURE  ? 'X':' '),
2290              ( p_sys->dev_cap.capabilities & V4L2_CAP_AUDIO  ? 'X':' '),
2291              ( p_sys->dev_cap.capabilities & V4L2_CAP_TUNER  ? 'X':' ') );
2292
2293     msg_Dbg( p_obj, "supported I/O methods are: (%c) Read/Write, "
2294                                                  "(%c) Streaming, "
2295                                                  "(%c) Asynchronous",
2296             ( p_sys->dev_cap.capabilities & V4L2_CAP_READWRITE ? 'X':' ' ),
2297             ( p_sys->dev_cap.capabilities & V4L2_CAP_STREAMING ? 'X':' ' ),
2298             ( p_sys->dev_cap.capabilities & V4L2_CAP_ASYNCIO ? 'X':' ' ) );
2299
2300     /* Now, enumerate all the video inputs. This is useless at the moment
2301        since we have no way to present that info to the user except with
2302        debug messages */
2303
2304     if( p_sys->dev_cap.capabilities & V4L2_CAP_VIDEO_CAPTURE )
2305     {
2306         struct v4l2_input t_input;
2307         memset( &t_input, 0, sizeof(t_input) );
2308         while( v4l2_ioctl( i_fd, VIDIOC_ENUMINPUT, &t_input ) >= 0 )
2309         {
2310             p_sys->i_input++;
2311             t_input.index = p_sys->i_input;
2312         }
2313
2314         p_sys->p_inputs = calloc( 1, p_sys->i_input * sizeof( struct v4l2_input ) );
2315         if( !p_sys->p_inputs ) goto open_failed;
2316
2317         for( i_index = 0; i_index < p_sys->i_input; i_index++ )
2318         {
2319             p_sys->p_inputs[i_index].index = i_index;
2320
2321             if( v4l2_ioctl( i_fd, VIDIOC_ENUMINPUT, &p_sys->p_inputs[i_index] ) )
2322             {
2323                 msg_Err( p_obj, "cannot get video input characteristics (%m)" );
2324                 goto open_failed;
2325             }
2326             msg_Dbg( p_obj, "video input %i (%s) has type: %s %c",
2327                                 i_index,
2328                                 p_sys->p_inputs[i_index].name,
2329                                 p_sys->p_inputs[i_index].type
2330                                         == V4L2_INPUT_TYPE_TUNER ?
2331                                         "Tuner adapter" :
2332                                         "External analog input",
2333                                 i_index == p_sys->i_selected_input ? '*' : ' ' );
2334         }
2335     }
2336
2337     /* Probe video standards */
2338     if( p_sys->dev_cap.capabilities & V4L2_CAP_VIDEO_CAPTURE )
2339     {
2340         struct v4l2_standard t_standards;
2341         t_standards.index = 0;
2342         p_sys->i_standard = 0;
2343         while( v4l2_ioctl( i_fd, VIDIOC_ENUMSTD, &t_standards ) >=0 )
2344         {
2345             p_sys->i_standard++;
2346             t_standards.index = p_sys->i_standard;
2347         }
2348
2349         p_sys->p_standards = calloc( 1, p_sys->i_standard * sizeof( struct v4l2_standard ) );
2350         if( !p_sys->p_standards ) goto open_failed;
2351
2352         for( i_standard = 0; i_standard < p_sys->i_standard; i_standard++ )
2353         {
2354             p_sys->p_standards[i_standard].index = i_standard;
2355
2356             if( v4l2_ioctl( i_fd, VIDIOC_ENUMSTD, &p_sys->p_standards[i_standard] ) )
2357             {
2358                 msg_Err( p_obj, "cannot get video input standards (%m)" );
2359                 goto open_failed;
2360             }
2361             msg_Dbg( p_obj, "video standard %i is: %s %c",
2362                                 i_standard,
2363                                 p_sys->p_standards[i_standard].name,
2364                                 (unsigned)i_standard == p_sys->i_selected_standard_id ? '*' : ' ' );
2365         }
2366     }
2367
2368     /* initialize the structures for the ioctls */
2369     for( i_index = 0; i_index < 32; i_index++ )
2370     {
2371         p_sys->p_audios[i_index].index = i_index;
2372     }
2373
2374     /* Probe audio inputs */
2375     if( p_sys->dev_cap.capabilities & V4L2_CAP_AUDIO )
2376     {
2377         while( p_sys->i_audio < 32 &&
2378                v4l2_ioctl( i_fd, VIDIOC_S_AUDIO, &p_sys->p_audios[p_sys->i_audio] ) >= 0 )
2379         {
2380             if( v4l2_ioctl( i_fd, VIDIOC_G_AUDIO, &p_sys->p_audios[ p_sys->i_audio] ) < 0 )
2381             {
2382                 msg_Err( p_obj, "cannot get audio input characteristics (%m)" );
2383                 goto open_failed;
2384             }
2385
2386             msg_Dbg( p_obj, "audio input %i (%s) is %s %s %c",
2387                                 p_sys->i_audio,
2388                                 p_sys->p_audios[p_sys->i_audio].name,
2389                                 p_sys->p_audios[p_sys->i_audio].capability &
2390                                                     V4L2_AUDCAP_STEREO ?
2391                                         "Stereo" : "Mono",
2392                                 p_sys->p_audios[p_sys->i_audio].capability &
2393                                                     V4L2_AUDCAP_AVL ?
2394                                     "(Automatic Volume Level supported)" : "",
2395                                 p_sys->i_audio == p_sys->i_selected_audio_input ? '*' : ' ' );
2396
2397             p_sys->i_audio++;
2398         }
2399     }
2400
2401     /* List tuner caps */
2402     if( p_sys->dev_cap.capabilities & V4L2_CAP_TUNER )
2403     {
2404         struct v4l2_tuner tuner;
2405         memset( &tuner, 0, sizeof(tuner) );
2406         p_sys->i_tuner = 0;
2407         while( v4l2_ioctl( i_fd, VIDIOC_G_TUNER, &tuner ) >= 0 )
2408         {
2409             p_sys->i_tuner++;
2410             memset( &tuner, 0, sizeof(tuner) );
2411             tuner.index = p_sys->i_tuner;
2412         }
2413
2414         p_sys->p_tuners = calloc( 1, p_sys->i_tuner * sizeof( struct v4l2_tuner ) );
2415         if( !p_sys->p_tuners ) goto open_failed;
2416
2417         for( i_index = 0; i_index < p_sys->i_tuner; i_index++ )
2418         {
2419             p_sys->p_tuners[i_index].index = i_index;
2420
2421             if( v4l2_ioctl( i_fd, VIDIOC_G_TUNER, &p_sys->p_tuners[i_index] ) )
2422             {
2423                 msg_Err( p_obj, "cannot get tuner characteristics (%m)" );
2424                 goto open_failed;
2425             }
2426             msg_Dbg( p_obj, "tuner %i (%s) has type: %s, "
2427                               "frequency range: %.1f %s -> %.1f %s",
2428                                 i_index,
2429                                 p_sys->p_tuners[i_index].name,
2430                                 p_sys->p_tuners[i_index].type
2431                                         == V4L2_TUNER_RADIO ?
2432                                         "Radio" : "Analog TV",
2433                                 p_sys->p_tuners[i_index].rangelow * 62.5,
2434                                 p_sys->p_tuners[i_index].capability &
2435                                         V4L2_TUNER_CAP_LOW ?
2436                                         "Hz" : "kHz",
2437                                 p_sys->p_tuners[i_index].rangehigh * 62.5,
2438                                 p_sys->p_tuners[i_index].capability &
2439                                         V4L2_TUNER_CAP_LOW ?
2440                                         "Hz" : "kHz" );
2441
2442             struct v4l2_frequency frequency;
2443             memset( &frequency, 0, sizeof( frequency ) );
2444             if( v4l2_ioctl( i_fd, VIDIOC_G_FREQUENCY, &frequency ) < 0 )
2445             {
2446                 msg_Err( p_obj, "cannot get tuner frequency (%m)" );
2447                 goto open_failed;
2448             }
2449             msg_Dbg( p_obj, "tuner %i (%s) frequency: %.1f %s",
2450                      i_index,
2451                      p_sys->p_tuners[i_index].name,
2452                      frequency.frequency * 62.5,
2453                      p_sys->p_tuners[i_index].capability &
2454                              V4L2_TUNER_CAP_LOW ?
2455                              "Hz" : "kHz" );
2456         }
2457     }
2458
2459     /* Probe for available chromas */
2460     if( p_sys->dev_cap.capabilities & V4L2_CAP_VIDEO_CAPTURE )
2461     {
2462         struct v4l2_fmtdesc codec;
2463
2464         i_index = 0;
2465         memset( &codec, 0, sizeof(codec) );
2466         codec.index = i_index;
2467         codec.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2468
2469         while( v4l2_ioctl( i_fd, VIDIOC_ENUM_FMT, &codec ) >= 0 )
2470         {
2471             i_index++;
2472             codec.index = i_index;
2473         }
2474
2475         p_sys->i_codec = i_index;
2476
2477         p_sys->p_codecs = calloc( 1, p_sys->i_codec * sizeof( struct v4l2_fmtdesc ) );
2478
2479         for( i_index = 0; i_index < p_sys->i_codec; i_index++ )
2480         {
2481             p_sys->p_codecs[i_index].index = i_index;
2482             p_sys->p_codecs[i_index].type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
2483
2484             if( v4l2_ioctl( i_fd, VIDIOC_ENUM_FMT, &p_sys->p_codecs[i_index] ) < 0 )
2485             {
2486                 msg_Err( p_obj, "cannot get codec description (%m)" );
2487                 goto open_failed;
2488             }
2489
2490             /* only print if vlc supports the format */
2491             char psz_fourcc_v4l2[5];
2492             memset( &psz_fourcc_v4l2, 0, sizeof( psz_fourcc_v4l2 ) );
2493             vlc_fourcc_to_char( p_sys->p_codecs[i_index].pixelformat,
2494                                 &psz_fourcc_v4l2 );
2495             bool b_codec_supported = false;
2496             for( int i = 0; v4l2chroma_to_fourcc[i].i_v4l2 != 0; i++ )
2497             {
2498                 if( v4l2chroma_to_fourcc[i].i_v4l2 == p_sys->p_codecs[i_index].pixelformat )
2499                 {
2500                     b_codec_supported = true;
2501
2502                     char psz_fourcc[5];
2503                     memset( &psz_fourcc, 0, sizeof( psz_fourcc ) );
2504                     vlc_fourcc_to_char( v4l2chroma_to_fourcc[i].i_fourcc,
2505                                         &psz_fourcc );
2506                     msg_Dbg( p_obj, "device supports chroma %4s [%s, %s]",
2507                                 psz_fourcc,
2508                                 p_sys->p_codecs[i_index].description,
2509                                 psz_fourcc_v4l2 );
2510
2511 #ifdef VIDIOC_ENUM_FRAMESIZES
2512                     /* This is new in Linux 2.6.19 */
2513                     /* List valid frame sizes for this format */
2514                     struct v4l2_frmsizeenum frmsize;
2515                     memset( &frmsize, 0, sizeof(frmsize) );
2516                     frmsize.pixel_format = p_sys->p_codecs[i_index].pixelformat;
2517                     if( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMESIZES, &frmsize ) < 0 )
2518                     {
2519                         /* Not all devices support this ioctl */
2520                         msg_Warn( p_obj, "Unable to query for frame sizes" );
2521                     }
2522                     else
2523                     {
2524                         switch( frmsize.type )
2525                         {
2526                             case V4L2_FRMSIZE_TYPE_DISCRETE:
2527                                 do
2528                                 {
2529                                     msg_Dbg( p_obj,
2530                 "    device supports size %dx%d",
2531                 frmsize.discrete.width, frmsize.discrete.height );
2532                                     frmsize.index++;
2533                                 } while( v4l2_ioctl( i_fd, VIDIOC_ENUM_FRAMESIZES, &frmsize ) >= 0 );
2534                                 break;
2535                             case V4L2_FRMSIZE_TYPE_STEPWISE:
2536                                 msg_Dbg( p_obj,
2537                 "    device supports sizes %dx%d to %dx%d using %dx%d increments",
2538                 frmsize.stepwise.min_width, frmsize.stepwise.min_height,
2539                 frmsize.stepwise.max_width, frmsize.stepwise.max_height,
2540                 frmsize.stepwise.step_width, frmsize.stepwise.step_height );
2541                                 break;
2542                             case V4L2_FRMSIZE_TYPE_CONTINUOUS:
2543                                 msg_Dbg( p_obj,
2544                 "    device supports all sizes %dx%d to %dx%d",
2545                 frmsize.stepwise.min_width, frmsize.stepwise.min_height,
2546                 frmsize.stepwise.max_width, frmsize.stepwise.max_height );
2547                                 break;
2548                         }
2549                     }
2550 #endif
2551                 }
2552             }
2553             if( !b_codec_supported )
2554             {
2555                     msg_Dbg( p_obj,
2556                          "device codec %4s (%s) not supported",
2557                          psz_fourcc_v4l2,
2558                          p_sys->p_codecs[i_index].description );
2559             }
2560         }
2561     }
2562
2563
2564     if( i_fd >= 0 ) v4l2_close( i_fd );
2565     return true;
2566
2567 open_failed:
2568
2569     if( i_fd >= 0 ) v4l2_close( i_fd );
2570     return false;
2571
2572 }
2573
2574 static void name2var( unsigned char *name )
2575 {
2576     for( ; *name; name++ )
2577         *name = (*name == ' ') ? '_' : tolower( *name );
2578 }
2579
2580 /*****************************************************************************
2581  * Print a user-class v4l2 control's details, create the relevant variable,
2582  * change the value if needed.
2583  *****************************************************************************/
2584 static void ControlListPrint( vlc_object_t *p_obj, demux_sys_t *p_sys, int i_fd,
2585                               struct v4l2_queryctrl queryctrl,
2586                               bool b_reset, bool b_demux )
2587 {
2588     struct v4l2_querymenu querymenu;
2589     unsigned int i_mid;
2590
2591     int i;
2592     int i_val;
2593
2594     char *psz_name;
2595     vlc_value_t val, val2;
2596
2597     if( queryctrl.flags & V4L2_CTRL_FLAG_GRABBED )
2598         msg_Dbg( p_obj, "    control is busy" );
2599     if( queryctrl.flags & V4L2_CTRL_FLAG_READ_ONLY )
2600         msg_Dbg( p_obj, "    control is read-only" );
2601
2602     for( i = 0; controls[i].psz_name != NULL; i++ )
2603         if( controls[i].i_cid == queryctrl.id ) break;
2604
2605     if( controls[i].psz_name )
2606     {
2607         psz_name = strdup( controls[i].psz_name );
2608         char psz_cfg_name[40];
2609         sprintf( psz_cfg_name, CFG_PREFIX "%s", psz_name );
2610         i_val = var_CreateGetInteger( p_obj, psz_cfg_name );
2611         var_Destroy( p_obj, psz_cfg_name );
2612     }
2613     else
2614     {
2615         psz_name = strdup( (const char *)queryctrl.name );
2616         name2var( (unsigned char *)psz_name );
2617         i_val = -1;
2618     }
2619
2620     switch( queryctrl.type )
2621     {
2622         case V4L2_CTRL_TYPE_INTEGER:
2623             msg_Dbg( p_obj, "    integer control" );
2624             msg_Dbg( p_obj,
2625                      "    valid values: %d to %d by steps of %d",
2626                      queryctrl.minimum, queryctrl.maximum,
2627                      queryctrl.step );
2628
2629             var_Create( p_obj, psz_name,
2630                         VLC_VAR_INTEGER | VLC_VAR_HASMIN | VLC_VAR_HASMAX
2631                       | VLC_VAR_HASSTEP | VLC_VAR_ISCOMMAND );
2632             val.i_int = queryctrl.minimum;
2633             var_Change( p_obj, psz_name, VLC_VAR_SETMIN, &val, NULL );
2634             val.i_int = queryctrl.maximum;
2635             var_Change( p_obj, psz_name, VLC_VAR_SETMAX, &val, NULL );
2636             val.i_int = queryctrl.step;
2637             var_Change( p_obj, psz_name, VLC_VAR_SETSTEP, &val, NULL );
2638             break;
2639         case V4L2_CTRL_TYPE_BOOLEAN:
2640             msg_Dbg( p_obj, "    boolean control" );
2641             var_Create( p_obj, psz_name,
2642                         VLC_VAR_BOOL | VLC_VAR_ISCOMMAND );
2643             break;
2644         case V4L2_CTRL_TYPE_MENU:
2645             msg_Dbg( p_obj, "    menu control" );
2646             var_Create( p_obj, psz_name,
2647                         VLC_VAR_INTEGER | VLC_VAR_HASCHOICE
2648                       | VLC_VAR_ISCOMMAND );
2649             memset( &querymenu, 0, sizeof( querymenu ) );
2650             for( i_mid = queryctrl.minimum;
2651                  i_mid <= (unsigned)queryctrl.maximum;
2652                  i_mid++ )
2653             {
2654                 querymenu.index = i_mid;
2655                 querymenu.id = queryctrl.id;
2656                 if( v4l2_ioctl( i_fd, VIDIOC_QUERYMENU, &querymenu ) >= 0 )
2657                 {
2658                     msg_Dbg( p_obj, "        %d: %s",
2659                              querymenu.index, querymenu.name );
2660                     val.i_int = querymenu.index;
2661                     val2.psz_string = (char *)querymenu.name;
2662                     var_Change( p_obj, psz_name,
2663                                 VLC_VAR_ADDCHOICE, &val, &val2 );
2664                 }
2665             }
2666             break;
2667         case V4L2_CTRL_TYPE_BUTTON:
2668             msg_Dbg( p_obj, "    button control" );
2669             var_Create( p_obj, psz_name,
2670                         VLC_VAR_VOID | VLC_VAR_ISCOMMAND );
2671             break;
2672         case V4L2_CTRL_TYPE_CTRL_CLASS:
2673             msg_Dbg( p_obj, "    control class" );
2674             var_Create( p_obj, psz_name, VLC_VAR_VOID );
2675             break;
2676         default:
2677             msg_Dbg( p_obj, "    unknown control type (FIXME)" );
2678             /* FIXME */
2679             break;
2680     }
2681
2682     switch( queryctrl.type )
2683     {
2684         case V4L2_CTRL_TYPE_INTEGER:
2685         case V4L2_CTRL_TYPE_BOOLEAN:
2686         case V4L2_CTRL_TYPE_MENU:
2687             {
2688                 struct v4l2_control control;
2689                 msg_Dbg( p_obj, "    default value: %d",
2690                          queryctrl.default_value );
2691                 memset( &control, 0, sizeof( control ) );
2692                 control.id = queryctrl.id;
2693                 if( v4l2_ioctl( i_fd, VIDIOC_G_CTRL, &control ) >= 0 )
2694                 {
2695                     msg_Dbg( p_obj, "    current value: %d", control.value );
2696                 }
2697                 if( i_val == -1 )
2698                 {
2699                     i_val = control.value;
2700                     if( b_reset && queryctrl.default_value != control.value )
2701                     {
2702                         msg_Dbg( p_obj, "    reset value to default" );
2703                         Control( p_obj, p_sys, i_fd, psz_name,
2704                                  queryctrl.id, queryctrl.default_value );
2705                     }
2706                 }
2707                 else
2708                 {
2709                     Control( p_obj, p_sys, i_fd, psz_name,
2710                              queryctrl.id, i_val );
2711                 }
2712             }
2713             break;
2714         default:
2715             break;
2716     }
2717
2718     val.psz_string = (char *)queryctrl.name;
2719     var_Change( p_obj, psz_name, VLC_VAR_SETTEXT, &val, NULL );
2720     val.i_int = queryctrl.id;
2721     val2.psz_string = (char *)psz_name;
2722     var_Change( p_obj, "allcontrols", VLC_VAR_ADDCHOICE, &val, &val2 );
2723     /* bad things happen changing MPEG mid-stream
2724      * so don't add to Ext Settings GUI */
2725     if( V4L2_CTRL_ID2CLASS( queryctrl.id ) != V4L2_CTRL_CLASS_MPEG )
2726         var_Change( p_obj, "controls", VLC_VAR_ADDCHOICE, &val, &val2 );
2727
2728     switch( var_Type( p_obj, psz_name ) & VLC_VAR_TYPE )
2729     {
2730         case VLC_VAR_BOOL:
2731             var_SetBool( p_obj, psz_name, i_val );
2732             break;
2733         case VLC_VAR_INTEGER:
2734             var_SetInteger( p_obj, psz_name, i_val );
2735             break;
2736         case VLC_VAR_VOID:
2737             break;
2738         default:
2739             msg_Warn( p_obj, "FIXME: %s %s %d", __FILE__, __func__,
2740                       __LINE__ );
2741             break;
2742     }
2743
2744     if( b_demux )
2745         var_AddCallback( p_obj, psz_name,
2746                         DemuxControlCallback, (void*)(intptr_t)queryctrl.id );
2747     else
2748         var_AddCallback( p_obj, psz_name,
2749                         AccessControlCallback, (void*)(intptr_t)queryctrl.id );
2750
2751     free( psz_name );
2752 }
2753
2754 /*****************************************************************************
2755  * List all user-class v4l2 controls, set them to the user specified
2756  * value and create the relevant variables to enable runtime changes
2757  *****************************************************************************/
2758 static int ControlList( vlc_object_t *p_obj, demux_sys_t *p_sys, int i_fd,
2759                         bool b_reset, bool b_demux )
2760 {
2761     struct v4l2_queryctrl queryctrl;
2762     int i_cid;
2763
2764     memset( &queryctrl, 0, sizeof( queryctrl ) );
2765
2766     /* A list of available controls (aka the variable name) will be
2767      * stored as choices in the "allcontrols" variable. We'll thus be able
2768      * to use those to create an appropriate interface
2769      * A list of available controls that can be changed mid-stream will
2770      * be stored in the "controls" variable */
2771     var_Create( p_obj, "controls", VLC_VAR_INTEGER | VLC_VAR_HASCHOICE );
2772     var_Create( p_obj, "allcontrols", VLC_VAR_INTEGER | VLC_VAR_HASCHOICE );
2773
2774     var_Create( p_obj, "controls-update", VLC_VAR_VOID | VLC_VAR_ISCOMMAND );
2775
2776     /* Add a control to reset all controls to their default values */
2777     vlc_value_t val, val2;
2778     var_Create( p_obj, "controls-reset", VLC_VAR_VOID | VLC_VAR_ISCOMMAND );
2779     val.psz_string = _( "Reset controls to default" );
2780     var_Change( p_obj, "controls-reset", VLC_VAR_SETTEXT, &val, NULL );
2781     val.i_int = -1;
2782     val2.psz_string = (char *)"controls-reset";
2783     var_Change( p_obj, "controls", VLC_VAR_ADDCHOICE, &val, &val2 );
2784     if (b_demux)
2785         var_AddCallback( p_obj, "controls-reset", DemuxControlResetCallback, NULL );
2786     else
2787         var_AddCallback( p_obj, "controls-reset", AccessControlResetCallback, NULL );
2788
2789     queryctrl.id = V4L2_CTRL_FLAG_NEXT_CTRL;
2790     if( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
2791     {
2792         msg_Dbg( p_obj, "Extended control API supported by v4l2 driver" );
2793
2794         /* List extended controls */
2795         queryctrl.id = V4L2_CTRL_FLAG_NEXT_CTRL;
2796         while( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
2797         {
2798             if( queryctrl.type == V4L2_CTRL_TYPE_CTRL_CLASS )
2799             {
2800                 msg_Dbg( p_obj, "%s", queryctrl.name );
2801                 queryctrl.id |= V4L2_CTRL_FLAG_NEXT_CTRL;
2802                 continue;
2803             }
2804             switch( V4L2_CTRL_ID2CLASS( queryctrl.id ) )
2805             {
2806                 case V4L2_CTRL_CLASS_USER:
2807                     msg_Dbg( p_obj, "Available control: %s (%x)",
2808                              queryctrl.name, queryctrl.id );
2809                     break;
2810                 case V4L2_CTRL_CLASS_MPEG:
2811                     name2var( queryctrl.name );
2812                     msg_Dbg( p_obj, "Available MPEG control: %s (%x)",
2813                              queryctrl.name, queryctrl.id );
2814                     break;
2815                 default:
2816                     msg_Dbg( p_obj, "Available private control: %s (%x)",
2817                              queryctrl.name, queryctrl.id );
2818                     break;
2819             }
2820             ControlListPrint( p_obj, p_sys, i_fd, queryctrl, b_reset, b_demux );
2821             queryctrl.id |= V4L2_CTRL_FLAG_NEXT_CTRL;
2822         }
2823     }
2824     else
2825     {
2826         msg_Dbg( p_obj, "Extended control API not supported by v4l2 driver" );
2827
2828         /* List public controls */
2829         for( i_cid = V4L2_CID_BASE;
2830              i_cid < V4L2_CID_LASTP1;
2831              i_cid ++ )
2832         {
2833             queryctrl.id = i_cid;
2834             if( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
2835             {
2836                 if( queryctrl.flags & V4L2_CTRL_FLAG_DISABLED )
2837                     continue;
2838                 msg_Dbg( p_obj, "Available control: %s (%x)",
2839                          queryctrl.name, queryctrl.id );
2840                 ControlListPrint( p_obj, p_sys, i_fd, queryctrl,
2841                                   b_reset, b_demux );
2842             }
2843         }
2844
2845         /* List private controls */
2846         for( i_cid = V4L2_CID_PRIVATE_BASE;
2847              ;
2848              i_cid ++ )
2849         {
2850             queryctrl.id = i_cid;
2851             if( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
2852             {
2853                 if( queryctrl.flags & V4L2_CTRL_FLAG_DISABLED )
2854                     continue;
2855                 msg_Dbg( p_obj, "Available private control: %s (%x)",
2856                          queryctrl.name, queryctrl.id );
2857                 ControlListPrint( p_obj, p_sys, i_fd, queryctrl,
2858                                   b_reset, b_demux );
2859             }
2860             else
2861                 break;
2862         }
2863     }
2864
2865     return VLC_SUCCESS;
2866 }
2867
2868 static void SetAvailControlsByString( vlc_object_t *p_obj, demux_sys_t *p_sys,
2869                                       int i_fd )
2870 {
2871     char *psz_parser = p_sys->psz_set_ctrls;
2872     vlc_value_t val, text, name;
2873
2874     if( psz_parser == NULL )
2875         return;
2876
2877     if( *psz_parser == '{' )
2878         psz_parser++;
2879
2880     int i_ret = var_Change( p_obj, "allcontrols", VLC_VAR_GETCHOICES,
2881                             &val, &text );
2882     if( i_ret < 0 )
2883     {
2884         msg_Err( p_obj, "Oops, can't find 'allcontrols' variable." );
2885         return;
2886     }
2887
2888     while( *psz_parser && *psz_parser != '}' )
2889     {
2890         char *psz_delim, *psz_assign;
2891
2892         while( *psz_parser == ',' || *psz_parser == ' ' )
2893             psz_parser++;
2894
2895         psz_delim = strchr( psz_parser, ',' );
2896         if( psz_delim == NULL )
2897             psz_delim = strchr( psz_parser, '}' );
2898         if( psz_delim == NULL )
2899             psz_delim = psz_parser + strlen( psz_parser );
2900
2901         psz_assign = memchr( psz_parser, '=', psz_delim - psz_parser );
2902         if( psz_assign == NULL )
2903         {
2904             char *psz_name = strndup( psz_parser, psz_delim - psz_parser );
2905             msg_Err( p_obj, "%s missing '='", psz_name );
2906             free( psz_name );
2907             psz_parser = psz_delim + 1;
2908             continue;
2909         }
2910
2911         for( int i = 0;
2912              i < val.p_list->i_count ;//&& psz_parser < psz_assign;
2913              i++ )
2914         {
2915             const char *psz_var = text.p_list->p_values[i].psz_string;
2916             int i_cid = val.p_list->p_values[i].i_int;
2917             var_Change( p_obj, psz_var, VLC_VAR_GETTEXT, &name, NULL );
2918             const char *psz_name = name.psz_string;
2919
2920             int i_availstrlen = strlen( psz_name );
2921             int i_parsestrlen = psz_assign - psz_parser;
2922             int i_maxstrlen = __MAX( i_availstrlen, i_parsestrlen);
2923
2924             if( !strncasecmp( psz_name, psz_parser, i_maxstrlen ) )
2925             {
2926                 Control( p_obj, p_sys, i_fd, psz_name, i_cid,
2927                          strtol( ++psz_assign, &psz_parser, 0) );
2928             }
2929             free( name.psz_string );
2930         }
2931
2932         if( psz_parser < psz_assign )
2933         {
2934             char *psz_name = strndup( psz_parser, psz_assign - psz_parser );
2935             msg_Err( p_obj, "Control %s not available", psz_name );
2936             free( psz_name );
2937             psz_parser = ( *psz_delim ) ? ( psz_delim + 1 ) : psz_delim;
2938         }
2939     }
2940     var_FreeList( &val, &text );
2941 }
2942
2943 /*****************************************************************************
2944  * Reset all user-class v4l2 controls to their default value
2945  *****************************************************************************/
2946 static int ControlReset( vlc_object_t *p_obj, demux_sys_t *p_sys, int i_fd )
2947 {
2948     struct v4l2_queryctrl queryctrl;
2949     int i_cid;
2950     memset( &queryctrl, 0, sizeof( queryctrl ) );
2951
2952     queryctrl.id = V4L2_CTRL_FLAG_NEXT_CTRL;
2953     if( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
2954     {
2955         /* Extended control API supported */
2956         queryctrl.id = V4L2_CTRL_FLAG_NEXT_CTRL;
2957         while( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
2958         {
2959             if( queryctrl.type == V4L2_CTRL_TYPE_CTRL_CLASS
2960              || V4L2_CTRL_ID2CLASS( queryctrl.id ) == V4L2_CTRL_CLASS_MPEG )
2961             {
2962                 queryctrl.id |= V4L2_CTRL_FLAG_NEXT_CTRL;
2963                 continue;
2964             }
2965             struct v4l2_control control;
2966             memset( &control, 0, sizeof( control ) );
2967             control.id = queryctrl.id;
2968             if( v4l2_ioctl( i_fd, VIDIOC_G_CTRL, &control ) >= 0
2969              && queryctrl.default_value != control.value )
2970             {
2971                 int i;
2972                 for( i = 0; controls[i].psz_name != NULL; i++ )
2973                     if( controls[i].i_cid == queryctrl.id ) break;
2974                 name2var( queryctrl.name );
2975                 Control( p_obj, p_sys, i_fd,
2976                          controls[i].psz_name ? controls[i].psz_name
2977                           : (const char *)queryctrl.name,
2978                          queryctrl.id, queryctrl.default_value );
2979             }
2980             queryctrl.id |= V4L2_CTRL_FLAG_NEXT_CTRL;
2981         }
2982     }
2983     else
2984     {
2985
2986         /* public controls */
2987         for( i_cid = V4L2_CID_BASE;
2988              i_cid < V4L2_CID_LASTP1;
2989              i_cid ++ )
2990         {
2991             queryctrl.id = i_cid;
2992             if( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
2993             {
2994                 struct v4l2_control control;
2995                 if( queryctrl.flags & V4L2_CTRL_FLAG_DISABLED )
2996                     continue;
2997                 memset( &control, 0, sizeof( control ) );
2998                 control.id = queryctrl.id;
2999                 if( v4l2_ioctl( i_fd, VIDIOC_G_CTRL, &control ) >= 0
3000                  && queryctrl.default_value != control.value )
3001                 {
3002                     int i;
3003                     for( i = 0; controls[i].psz_name != NULL; i++ )
3004                         if( controls[i].i_cid == queryctrl.id ) break;
3005                     name2var( queryctrl.name );
3006                     Control( p_obj, p_sys, i_fd,
3007                              controls[i].psz_name ? controls[i].psz_name
3008                               : (const char *)queryctrl.name,
3009                              queryctrl.id, queryctrl.default_value );
3010                 }
3011             }
3012         }
3013
3014         /* private controls */
3015         for( i_cid = V4L2_CID_PRIVATE_BASE;
3016              ;
3017              i_cid ++ )
3018         {
3019             queryctrl.id = i_cid;
3020             if( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) >= 0 )
3021             {
3022                 struct v4l2_control control;
3023                 if( queryctrl.flags & V4L2_CTRL_FLAG_DISABLED )
3024                     continue;
3025                 memset( &control, 0, sizeof( control ) );
3026                 control.id = queryctrl.id;
3027                 if( v4l2_ioctl( i_fd, VIDIOC_G_CTRL, &control ) >= 0
3028                  && queryctrl.default_value != control.value )
3029                 {
3030                     name2var( queryctrl.name );
3031                     Control( p_obj, p_sys, i_fd, (const char *)queryctrl.name,
3032                              queryctrl.id, queryctrl.default_value );
3033                 }
3034             }
3035             else
3036                 break;
3037         }
3038     }
3039     return VLC_SUCCESS;
3040 }
3041
3042 /*****************************************************************************
3043  * Issue user-class v4l2 controls
3044  *****************************************************************************/
3045 static int Control( vlc_object_t *p_obj, demux_sys_t *p_sys, int i_fd,
3046                     const char *psz_name, int i_cid, int i_value )
3047 {
3048     (void)p_sys;
3049     struct v4l2_queryctrl queryctrl;
3050     struct v4l2_control control;
3051     struct v4l2_ext_control ext_control;
3052     struct v4l2_ext_controls ext_controls;
3053
3054     if( i_value == -1 )
3055         return VLC_SUCCESS;
3056
3057     memset( &queryctrl, 0, sizeof( queryctrl ) );
3058
3059     queryctrl.id = i_cid;
3060
3061     if( v4l2_ioctl( i_fd, VIDIOC_QUERYCTRL, &queryctrl ) < 0
3062         || queryctrl.flags & V4L2_CTRL_FLAG_DISABLED )
3063     {
3064         msg_Dbg( p_obj, "%s (%x) control is not supported.", psz_name, i_cid );
3065         return VLC_EGENERIC;
3066     }
3067
3068     memset( &control, 0, sizeof( control ) );
3069     memset( &ext_control, 0, sizeof( ext_control ) );
3070     memset( &ext_controls, 0, sizeof( ext_controls ) );
3071     control.id = i_cid;
3072     ext_control.id = i_cid;
3073     ext_controls.ctrl_class = V4L2_CTRL_ID2CLASS( i_cid );
3074     ext_controls.count = 1;
3075     ext_controls.controls = &ext_control;
3076
3077     int i_ret = -1;
3078
3079     if( i_value >= queryctrl.minimum && i_value <= queryctrl.maximum )
3080     {
3081         ext_control.value = i_value;
3082         if( v4l2_ioctl( i_fd, VIDIOC_S_EXT_CTRLS, &ext_controls ) < 0 )
3083         {
3084             control.value = i_value;
3085             if( v4l2_ioctl( i_fd, VIDIOC_S_CTRL, &control ) < 0 )
3086             {
3087                 msg_Err( p_obj, "unable to set %s (%x) to %d (%m)",
3088                          psz_name, i_cid, i_value );
3089                 return VLC_EGENERIC;
3090             }
3091             i_ret = v4l2_ioctl( i_fd, VIDIOC_G_CTRL, &control );
3092         }
3093         else
3094         {
3095             i_ret = v4l2_ioctl( i_fd, VIDIOC_G_EXT_CTRLS, &ext_controls );
3096             control.value = ext_control.value;
3097         }
3098     }
3099
3100     if( i_ret >= 0 )
3101     {
3102         vlc_value_t val;
3103         msg_Dbg( p_obj, "video %s: %d", psz_name, control.value );
3104         switch( var_Type( p_obj, psz_name ) & VLC_VAR_TYPE )
3105         {
3106             case VLC_VAR_BOOL:
3107                 val.b_bool = control.value;
3108                 var_Change( p_obj, psz_name, VLC_VAR_SETVALUE, &val, NULL );
3109                 var_TriggerCallback( p_obj, "controls-update" );
3110                 break;
3111             case VLC_VAR_INTEGER:
3112                 val.i_int = control.value;
3113                 var_Change( p_obj, psz_name, VLC_VAR_SETVALUE, &val, NULL );
3114                 var_TriggerCallback( p_obj, "controls-update" );
3115                 break;
3116         }
3117     }
3118     return VLC_SUCCESS;
3119 }
3120
3121 /*****************************************************************************
3122  * On the fly change settings callback
3123  *****************************************************************************/
3124 static int DemuxControlCallback( vlc_object_t *p_this,
3125     const char *psz_var, vlc_value_t oldval, vlc_value_t newval,
3126     void *p_data )
3127 {
3128     (void)oldval;
3129     demux_t *p_demux = (demux_t*)p_this;
3130     demux_sys_t *p_sys = p_demux->p_sys;
3131     int i_cid = (long int)p_data;
3132
3133     int i_fd = p_sys->i_fd;
3134
3135     if( i_fd < 0 )
3136         return VLC_EGENERIC;
3137
3138     Control( p_this, p_sys, i_fd, psz_var, i_cid, newval.i_int );
3139
3140     return VLC_EGENERIC;
3141 }
3142
3143 static int DemuxControlResetCallback( vlc_object_t *p_this,
3144     const char *psz_var, vlc_value_t oldval, vlc_value_t newval, void *p_data )
3145 {
3146     (void)psz_var;    (void)oldval;    (void)newval;    (void)p_data;
3147     demux_t *p_demux = (demux_t*)p_this;
3148     demux_sys_t *p_sys = p_demux->p_sys;
3149
3150     int i_fd = p_sys->i_fd;
3151
3152     if( i_fd < 0 )
3153         return VLC_EGENERIC;
3154
3155     ControlReset( p_this, p_sys, i_fd );
3156
3157     return VLC_EGENERIC;
3158 }
3159
3160 static int AccessControlCallback( vlc_object_t *p_this,
3161     const char *psz_var, vlc_value_t oldval, vlc_value_t newval,
3162     void *p_data )
3163 {
3164     (void)oldval;
3165     access_t *p_access = (access_t *)p_this;
3166     demux_sys_t *p_sys = (demux_sys_t *) p_access->p_sys;
3167     int i_cid = (long int)p_data;
3168
3169     int i_fd = p_sys->i_fd;
3170
3171     if( i_fd < 0 )
3172         return VLC_EGENERIC;
3173
3174     Control( p_this, p_sys, i_fd, psz_var, i_cid, newval.i_int );
3175
3176     return VLC_EGENERIC;
3177 }
3178
3179 static int AccessControlResetCallback( vlc_object_t *p_this,
3180     const char *psz_var, vlc_value_t oldval, vlc_value_t newval, void *p_data )
3181 {
3182     (void)psz_var;     (void)oldval;     (void)newval;     (void)p_data;
3183     access_t *p_access = (access_t *)p_this;
3184     demux_sys_t *p_sys = (demux_sys_t *) p_access->p_sys;
3185
3186     int i_fd = p_sys->i_fd;
3187
3188     if( i_fd < 0 )
3189         return VLC_EGENERIC;
3190
3191     ControlReset( p_this, p_sys, i_fd );
3192
3193     return VLC_EGENERIC;
3194 }