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