drivers/media/v4l2-core/v4l2-ctrls.c

   1 /*
   2     V4L2 controls framework implementation.
   3
   4     Copyright (C) 2010  Hans Verkuil <hverkuil@xs4all.nl>
   5
   6     This program is free software; you can redistribute it and/or modify
   7     it under the terms of the GNU General Public License as published by
   8     the Free Software Foundation; either version 2 of the License, or
   9     (at your option) any later version.
  10
  11     This program is distributed in the hope that it will be useful,
  12     but WITHOUT ANY WARRANTY; without even the implied warranty of
  13     MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14     GNU General Public License for more details.
  15
  16     You should have received a copy of the GNU General Public License
  17     along with this program; if not, write to the Free Software
  18     Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  */
  20
  21 #include <linux/ctype.h>
  22 #include <linux/slab.h>
  23 #include <linux/export.h>
  24 #include <media/v4l2-ioctl.h>
  25 #include <media/v4l2-device.h>
  26 #include <media/v4l2-ctrls.h>
  27 #include <media/v4l2-event.h>
  28 #include <media/v4l2-dev.h>
  29
  30 #define has_op(master, op) \
  31         (master->ops && master->ops->op)
  32 #define call_op(master, op) \
  33         (has_op(master, op) ? master->ops->op(master) : 0)
  34
  35 /* Internal temporary helper struct, one for each v4l2_ext_control */
  36 struct v4l2_ctrl_helper {
  37         /* Pointer to the control reference of the master control */
  38         struct v4l2_ctrl_ref *mref;
  39         /* The control corresponding to the v4l2_ext_control ID field. */
  40         struct v4l2_ctrl *ctrl;
  41         /* v4l2_ext_control index of the next control belonging to the
  42            same cluster, or 0 if there isn't any. */
  43         u32 next;
  44 };
  45
  46 /* Small helper function to determine if the autocluster is set to manual
  47    mode. */
  48 static bool is_cur_manual(const struct v4l2_ctrl *master)
  49 {
  50         return master->is_auto && master->cur.val == master->manual_mode_value;
  51 }
  52
  53 /* Same as above, but this checks the against the new value instead of the
  54    current value. */
  55 static bool is_new_manual(const struct v4l2_ctrl *master)
  56 {
  57         return master->is_auto && master->val == master->manual_mode_value;
  58 }
  59
  60 /* Returns NULL or a character pointer array containing the menu for
  61    the given control ID. The pointer array ends with a NULL pointer.
  62    An empty string signifies a menu entry that is invalid. This allows
  63    drivers to disable certain options if it is not supported. */
  64 const char * const *v4l2_ctrl_get_menu(u32 id)
  65 {
  66         static const char * const mpeg_audio_sampling_freq[] = {
  67                 "44.1 kHz",
  68                 "48 kHz",
  69                 "32 kHz",
  70                 NULL
  71         };
  72         static const char * const mpeg_audio_encoding[] = {
  73                 "MPEG-1/2 Layer I",
  74                 "MPEG-1/2 Layer II",
  75                 "MPEG-1/2 Layer III",
  76                 "MPEG-2/4 AAC",
  77                 "AC-3",
  78                 NULL
  79         };
  80         static const char * const mpeg_audio_l1_bitrate[] = {
  81                 "32 kbps",
  82                 "64 kbps",
  83                 "96 kbps",
  84                 "128 kbps",
  85                 "160 kbps",
  86                 "192 kbps",
  87                 "224 kbps",
  88                 "256 kbps",
  89                 "288 kbps",
  90                 "320 kbps",
  91                 "352 kbps",
  92                 "384 kbps",
  93                 "416 kbps",
  94                 "448 kbps",
  95                 NULL
  96         };
  97         static const char * const mpeg_audio_l2_bitrate[] = {
  98                 "32 kbps",
  99                 "48 kbps",
 100                 "56 kbps",
 101                 "64 kbps",
 102                 "80 kbps",
 103                 "96 kbps",
 104                 "112 kbps",
 105                 "128 kbps",
 106                 "160 kbps",
 107                 "192 kbps",
 108                 "224 kbps",
 109                 "256 kbps",
 110                 "320 kbps",
 111                 "384 kbps",
 112                 NULL
 113         };
 114         static const char * const mpeg_audio_l3_bitrate[] = {
 115                 "32 kbps",
 116                 "40 kbps",
 117                 "48 kbps",
 118                 "56 kbps",
 119                 "64 kbps",
 120                 "80 kbps",
 121                 "96 kbps",
 122                 "112 kbps",
 123                 "128 kbps",
 124                 "160 kbps",
 125                 "192 kbps",
 126                 "224 kbps",
 127                 "256 kbps",
 128                 "320 kbps",
 129                 NULL
 130         };
 131         static const char * const mpeg_audio_ac3_bitrate[] = {
 132                 "32 kbps",
 133                 "40 kbps",
 134                 "48 kbps",
 135                 "56 kbps",
 136                 "64 kbps",
 137                 "80 kbps",
 138                 "96 kbps",
 139                 "112 kbps",
 140                 "128 kbps",
 141                 "160 kbps",
 142                 "192 kbps",
 143                 "224 kbps",
 144                 "256 kbps",
 145                 "320 kbps",
 146                 "384 kbps",
 147                 "448 kbps",
 148                 "512 kbps",
 149                 "576 kbps",
 150                 "640 kbps",
 151                 NULL
 152         };
 153         static const char * const mpeg_audio_mode[] = {
 154                 "Stereo",
 155                 "Joint Stereo",
 156                 "Dual",
 157                 "Mono",
 158                 NULL
 159         };
 160         static const char * const mpeg_audio_mode_extension[] = {
 161                 "Bound 4",
 162                 "Bound 8",
 163                 "Bound 12",
 164                 "Bound 16",
 165                 NULL
 166         };
 167         static const char * const mpeg_audio_emphasis[] = {
 168                 "No Emphasis",
 169                 "50/15 us",
 170                 "CCITT J17",
 171                 NULL
 172         };
 173         static const char * const mpeg_audio_crc[] = {
 174                 "No CRC",
 175                 "16-bit CRC",
 176                 NULL
 177         };
 178         static const char * const mpeg_audio_dec_playback[] = {
 179                 "Auto",
 180                 "Stereo",
 181                 "Left",
 182                 "Right",
 183                 "Mono",
 184                 "Swapped Stereo",
 185                 NULL
 186         };
 187         static const char * const mpeg_video_encoding[] = {
 188                 "MPEG-1",
 189                 "MPEG-2",
 190                 "MPEG-4 AVC",
 191                 NULL
 192         };
 193         static const char * const mpeg_video_aspect[] = {
 194                 "1x1",
 195                 "4x3",
 196                 "16x9",
 197                 "2.21x1",
 198                 NULL
 199         };
 200         static const char * const mpeg_video_bitrate_mode[] = {
 201                 "Variable Bitrate",
 202                 "Constant Bitrate",
 203                 NULL
 204         };
 205         static const char * const mpeg_stream_type[] = {
 206                 "MPEG-2 Program Stream",
 207                 "MPEG-2 Transport Stream",
 208                 "MPEG-1 System Stream",
 209                 "MPEG-2 DVD-compatible Stream",
 210                 "MPEG-1 VCD-compatible Stream",
 211                 "MPEG-2 SVCD-compatible Stream",
 212                 NULL
 213         };
 214         static const char * const mpeg_stream_vbi_fmt[] = {
 215                 "No VBI",
 216                 "Private Packet, IVTV Format",
 217                 NULL
 218         };
 219         static const char * const camera_power_line_frequency[] = {
 220                 "Disabled",
 221                 "50 Hz",
 222                 "60 Hz",
 223                 "Auto",
 224                 NULL
 225         };
 226         static const char * const camera_exposure_auto[] = {
 227                 "Auto Mode",
 228                 "Manual Mode",
 229                 "Shutter Priority Mode",
 230                 "Aperture Priority Mode",
 231                 NULL
 232         };
 233         static const char * const camera_exposure_metering[] = {
 234                 "Average",
 235                 "Center Weighted",
 236                 "Spot",
 237                 "Matrix",
 238                 NULL
 239         };
 240         static const char * const camera_auto_focus_range[] = {
 241                 "Auto",
 242                 "Normal",
 243                 "Macro",
 244                 "Infinity",
 245                 NULL
 246         };
 247         static const char * const colorfx[] = {
 248                 "None",
 249                 "Black & White",
 250                 "Sepia",
 251                 "Negative",
 252                 "Emboss",
 253                 "Sketch",
 254                 "Sky Blue",
 255                 "Grass Green",
 256                 "Skin Whiten",
 257                 "Vivid",
 258                 "Aqua",
 259                 "Art Freeze",
 260                 "Silhouette",
 261                 "Solarization",
 262                 "Antique",
 263                 "Set Cb/Cr",
 264                 NULL
 265         };
 266         static const char * const auto_n_preset_white_balance[] = {
 267                 "Manual",
 268                 "Auto",
 269                 "Incandescent",
 270                 "Fluorescent",
 271                 "Fluorescent H",
 272                 "Horizon",
 273                 "Daylight",
 274                 "Flash",
 275                 "Cloudy",
 276                 "Shade",
 277                 NULL,
 278         };
 279         static const char * const camera_iso_sensitivity_auto[] = {
 280                 "Manual",
 281                 "Auto",
 282                 NULL
 283         };
 284         static const char * const scene_mode[] = {
 285                 "None",
 286                 "Backlight",
 287                 "Beach/Snow",
 288                 "Candle Light",
 289                 "Dusk/Dawn",
 290                 "Fall Colors",
 291                 "Fireworks",
 292                 "Landscape",
 293                 "Night",
 294                 "Party/Indoor",
 295                 "Portrait",
 296                 "Sports",
 297                 "Sunset",
 298                 "Text",
 299                 NULL
 300         };
 301         static const char * const tune_emphasis[] = {
 302                 "None",
 303                 "50 Microseconds",
 304                 "75 Microseconds",
 305                 NULL,
 306         };
 307         static const char * const header_mode[] = {
 308                 "Separate Buffer",
 309                 "Joined With 1st Frame",
 310                 NULL,
 311         };
 312         static const char * const multi_slice[] = {
 313                 "Single",
 314                 "Max Macroblocks",
 315                 "Max Bytes",
 316                 NULL,
 317         };
 318         static const char * const entropy_mode[] = {
 319                 "CAVLC",
 320                 "CABAC",
 321                 NULL,
 322         };
 323         static const char * const mpeg_h264_level[] = {
 324                 "1",
 325                 "1b",
 326                 "1.1",
 327                 "1.2",
 328                 "1.3",
 329                 "2",
 330                 "2.1",
 331                 "2.2",
 332                 "3",
 333                 "3.1",
 334                 "3.2",
 335                 "4",
 336                 "4.1",
 337                 "4.2",
 338                 "5",
 339                 "5.1",
 340                 NULL,
 341         };
 342         static const char * const h264_loop_filter[] = {
 343                 "Enabled",
 344                 "Disabled",
 345                 "Disabled at Slice Boundary",
 346                 NULL,
 347         };
 348         static const char * const h264_profile[] = {
 349                 "Baseline",
 350                 "Constrained Baseline",
 351                 "Main",
 352                 "Extended",
 353                 "High",
 354                 "High 10",
 355                 "High 422",
 356                 "High 444 Predictive",
 357                 "High 10 Intra",
 358                 "High 422 Intra",
 359                 "High 444 Intra",
 360                 "CAVLC 444 Intra",
 361                 "Scalable Baseline",
 362                 "Scalable High",
 363                 "Scalable High Intra",
 364                 "Multiview High",
 365                 NULL,
 366         };
 367         static const char * const vui_sar_idc[] = {
 368                 "Unspecified",
 369                 "1:1",
 370                 "12:11",
 371                 "10:11",
 372                 "16:11",
 373                 "40:33",
 374                 "24:11",
 375                 "20:11",
 376                 "32:11",
 377                 "80:33",
 378                 "18:11",
 379                 "15:11",
 380                 "64:33",
 381                 "160:99",
 382                 "4:3",
 383                 "3:2",
 384                 "2:1",
 385                 "Extended SAR",
 386                 NULL,
 387         };
 388         static const char * const h264_fp_arrangement_type[] = {
 389                 "Checkerboard",
 390                 "Column",
 391                 "Row",
 392                 "Side by Side",
 393                 "Top Bottom",
 394                 "Temporal",
 395                 NULL,
 396         };
 397         static const char * const h264_fmo_map_type[] = {
 398                 "Interleaved Slices",
 399                 "Scattered Slices",
 400                 "Foreground with Leftover",
 401                 "Box Out",
 402                 "Raster Scan",
 403                 "Wipe Scan",
 404                 "Explicit",
 405                 NULL,
 406         };
 407         static const char * const mpeg_mpeg4_level[] = {
 408                 "0",
 409                 "0b",
 410                 "1",
 411                 "2",
 412                 "3",
 413                 "3b",
 414                 "4",
 415                 "5",
 416                 NULL,
 417         };
 418         static const char * const mpeg4_profile[] = {
 419                 "Simple",
 420                 "Advanced Simple",
 421                 "Core",
 422                 "Simple Scalable",
 423                 "Advanced Coding Efficiency",
 424                 NULL,
 425         };
 426
 427         static const char * const vpx_golden_frame_sel[] = {
 428                 "Use Previous Frame",
 429                 "Use Previous Specific Frame",
 430                 NULL,
 431         };
 432
 433         static const char * const flash_led_mode[] = {
 434                 "Off",
 435                 "Flash",
 436                 "Torch",
 437                 NULL,
 438         };
 439         static const char * const flash_strobe_source[] = {
 440                 "Software",
 441                 "External",
 442                 NULL,
 443         };
 444
 445         static const char * const jpeg_chroma_subsampling[] = {
 446                 "4:4:4",
 447                 "4:2:2",
 448                 "4:2:0",
 449                 "4:1:1",
 450                 "4:1:0",
 451                 "Gray",
 452                 NULL,
 453         };
 454         static const char * const dv_tx_mode[] = {
 455                 "DVI-D",
 456                 "HDMI",
 457                 NULL,
 458         };
 459         static const char * const dv_rgb_range[] = {
 460                 "Automatic",
 461                 "RGB limited range (16-235)",
 462                 "RGB full range (0-255)",
 463                 NULL,
 464         };
 465
 466
 467         switch (id) {
 468         case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ:
 469                 return mpeg_audio_sampling_freq;
 470         case V4L2_CID_MPEG_AUDIO_ENCODING:
 471                 return mpeg_audio_encoding;
 472         case V4L2_CID_MPEG_AUDIO_L1_BITRATE:
 473                 return mpeg_audio_l1_bitrate;
 474         case V4L2_CID_MPEG_AUDIO_L2_BITRATE:
 475                 return mpeg_audio_l2_bitrate;
 476         case V4L2_CID_MPEG_AUDIO_L3_BITRATE:
 477                 return mpeg_audio_l3_bitrate;
 478         case V4L2_CID_MPEG_AUDIO_AC3_BITRATE:
 479                 return mpeg_audio_ac3_bitrate;
 480         case V4L2_CID_MPEG_AUDIO_MODE:
 481                 return mpeg_audio_mode;
 482         case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION:
 483                 return mpeg_audio_mode_extension;
 484         case V4L2_CID_MPEG_AUDIO_EMPHASIS:
 485                 return mpeg_audio_emphasis;
 486         case V4L2_CID_MPEG_AUDIO_CRC:
 487                 return mpeg_audio_crc;
 488         case V4L2_CID_MPEG_AUDIO_DEC_PLAYBACK:
 489         case V4L2_CID_MPEG_AUDIO_DEC_MULTILINGUAL_PLAYBACK:
 490                 return mpeg_audio_dec_playback;
 491         case V4L2_CID_MPEG_VIDEO_ENCODING:
 492                 return mpeg_video_encoding;
 493         case V4L2_CID_MPEG_VIDEO_ASPECT:
 494                 return mpeg_video_aspect;
 495         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
 496                 return mpeg_video_bitrate_mode;
 497         case V4L2_CID_MPEG_STREAM_TYPE:
 498                 return mpeg_stream_type;
 499         case V4L2_CID_MPEG_STREAM_VBI_FMT:
 500                 return mpeg_stream_vbi_fmt;
 501         case V4L2_CID_POWER_LINE_FREQUENCY:
 502                 return camera_power_line_frequency;
 503         case V4L2_CID_EXPOSURE_AUTO:
 504                 return camera_exposure_auto;
 505         case V4L2_CID_EXPOSURE_METERING:
 506                 return camera_exposure_metering;
 507         case V4L2_CID_AUTO_FOCUS_RANGE:
 508                 return camera_auto_focus_range;
 509         case V4L2_CID_COLORFX:
 510                 return colorfx;
 511         case V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE:
 512                 return auto_n_preset_white_balance;
 513         case V4L2_CID_ISO_SENSITIVITY_AUTO:
 514                 return camera_iso_sensitivity_auto;
 515         case V4L2_CID_SCENE_MODE:
 516                 return scene_mode;
 517         case V4L2_CID_TUNE_PREEMPHASIS:
 518                 return tune_emphasis;
 519         case V4L2_CID_TUNE_DEEMPHASIS:
 520                 return tune_emphasis;
 521         case V4L2_CID_FLASH_LED_MODE:
 522                 return flash_led_mode;
 523         case V4L2_CID_FLASH_STROBE_SOURCE:
 524                 return flash_strobe_source;
 525         case V4L2_CID_MPEG_VIDEO_HEADER_MODE:
 526                 return header_mode;
 527         case V4L2_CID_MPEG_VIDEO_MULTI_SLICE_MODE:
 528                 return multi_slice;
 529         case V4L2_CID_MPEG_VIDEO_H264_ENTROPY_MODE:
 530                 return entropy_mode;
 531         case V4L2_CID_MPEG_VIDEO_H264_LEVEL:
 532                 return mpeg_h264_level;
 533         case V4L2_CID_MPEG_VIDEO_H264_LOOP_FILTER_MODE:
 534                 return h264_loop_filter;
 535         case V4L2_CID_MPEG_VIDEO_H264_PROFILE:
 536                 return h264_profile;
 537         case V4L2_CID_MPEG_VIDEO_H264_VUI_SAR_IDC:
 538                 return vui_sar_idc;
 539         case V4L2_CID_MPEG_VIDEO_H264_SEI_FP_ARRANGEMENT_TYPE:
 540                 return h264_fp_arrangement_type;
 541         case V4L2_CID_MPEG_VIDEO_H264_FMO_MAP_TYPE:
 542                 return h264_fmo_map_type;
 543         case V4L2_CID_MPEG_VIDEO_MPEG4_LEVEL:
 544                 return mpeg_mpeg4_level;
 545         case V4L2_CID_MPEG_VIDEO_MPEG4_PROFILE:
 546                 return mpeg4_profile;
 547         case V4L2_CID_MPEG_VIDEO_VPX_GOLDEN_FRAME_SEL:
 548                 return vpx_golden_frame_sel;
 549         case V4L2_CID_JPEG_CHROMA_SUBSAMPLING:
 550                 return jpeg_chroma_subsampling;
 551         case V4L2_CID_DV_TX_MODE:
 552                 return dv_tx_mode;
 553         case V4L2_CID_DV_TX_RGB_RANGE:
 554         case V4L2_CID_DV_RX_RGB_RANGE:
 555                 return dv_rgb_range;
 556
 557         default:
 558                 return NULL;
 559         }
 560 }
 561 EXPORT_SYMBOL(v4l2_ctrl_get_menu);
 562
 563 #define __v4l2_qmenu_int_len(arr, len) ({ *(len) = ARRAY_SIZE(arr); arr; })
 564 /*
 565  * Returns NULL or an s64 type array containing the menu for given
 566  * control ID. The total number of the menu items is returned in @len.
 567  */
 568 const s64 *v4l2_ctrl_get_int_menu(u32 id, u32 *len)
 569 {
 570         static const s64 qmenu_int_vpx_num_partitions[] = {
 571                 1, 2, 4, 8,
 572         };
 573
 574         static const s64 qmenu_int_vpx_num_ref_frames[] = {
 575                 1, 2, 3,
 576         };
 577
 578         switch (id) {
 579         case V4L2_CID_MPEG_VIDEO_VPX_NUM_PARTITIONS:
 580                 return __v4l2_qmenu_int_len(qmenu_int_vpx_num_partitions, len);
 581         case V4L2_CID_MPEG_VIDEO_VPX_NUM_REF_FRAMES:
 582                 return __v4l2_qmenu_int_len(qmenu_int_vpx_num_ref_frames, len);
 583         default:
 584                 *len = 0;
 585                 return NULL;
 586         }
 587 }
 588 EXPORT_SYMBOL(v4l2_ctrl_get_int_menu);
 589
 590 /* Return the control name. */
 591 const char *v4l2_ctrl_get_name(u32 id)
 592 {
 593         switch (id) {
 594         /* USER controls */
 595         /* Keep the order of the 'case's the same as in videodev2.h! */
 596         case V4L2_CID_USER_CLASS:               return "User Controls";
 597         case V4L2_CID_BRIGHTNESS:               return "Brightness";
 598         case V4L2_CID_CONTRAST:                 return "Contrast";
 599         case V4L2_CID_SATURATION:               return "Saturation";
 600         case V4L2_CID_HUE:                      return "Hue";
 601         case V4L2_CID_AUDIO_VOLUME:             return "Volume";
 602         case V4L2_CID_AUDIO_BALANCE:            return "Balance";
 603         case V4L2_CID_AUDIO_BASS:               return "Bass";
 604         case V4L2_CID_AUDIO_TREBLE:             return "Treble";
 605         case V4L2_CID_AUDIO_MUTE:               return "Mute";
 606         case V4L2_CID_AUDIO_LOUDNESS:           return "Loudness";
 607         case V4L2_CID_BLACK_LEVEL:              return "Black Level";
 608         case V4L2_CID_AUTO_WHITE_BALANCE:       return "White Balance, Automatic";
 609         case V4L2_CID_DO_WHITE_BALANCE:         return "Do White Balance";
 610         case V4L2_CID_RED_BALANCE:              return "Red Balance";
 611         case V4L2_CID_BLUE_BALANCE:             return "Blue Balance";
 612         case V4L2_CID_GAMMA:                    return "Gamma";
 613         case V4L2_CID_EXPOSURE:                 return "Exposure";
 614         case V4L2_CID_AUTOGAIN:                 return "Gain, Automatic";
 615         case V4L2_CID_GAIN:                     return "Gain";
 616         case V4L2_CID_HFLIP:                    return "Horizontal Flip";
 617         case V4L2_CID_VFLIP:                    return "Vertical Flip";
 618         case V4L2_CID_POWER_LINE_FREQUENCY:     return "Power Line Frequency";
 619         case V4L2_CID_HUE_AUTO:                 return "Hue, Automatic";
 620         case V4L2_CID_WHITE_BALANCE_TEMPERATURE: return "White Balance Temperature";
 621         case V4L2_CID_SHARPNESS:                return "Sharpness";
 622         case V4L2_CID_BACKLIGHT_COMPENSATION:   return "Backlight Compensation";
 623         case V4L2_CID_CHROMA_AGC:               return "Chroma AGC";
 624         case V4L2_CID_COLOR_KILLER:             return "Color Killer";
 625         case V4L2_CID_COLORFX:                  return "Color Effects";
 626         case V4L2_CID_AUTOBRIGHTNESS:           return "Brightness, Automatic";
 627         case V4L2_CID_BAND_STOP_FILTER:         return "Band-Stop Filter";
 628         case V4L2_CID_ROTATE:                   return "Rotate";
 629         case V4L2_CID_BG_COLOR:                 return "Background Color";
 630         case V4L2_CID_CHROMA_GAIN:              return "Chroma Gain";
 631         case V4L2_CID_ILLUMINATORS_1:           return "Illuminator 1";
 632         case V4L2_CID_ILLUMINATORS_2:           return "Illuminator 2";
 633         case V4L2_CID_MIN_BUFFERS_FOR_CAPTURE:  return "Min Number of Capture Buffers";
 634         case V4L2_CID_MIN_BUFFERS_FOR_OUTPUT:   return "Min Number of Output Buffers";
 635         case V4L2_CID_ALPHA_COMPONENT:          return "Alpha Component";
 636         case V4L2_CID_COLORFX_CBCR:             return "Color Effects, CbCr";
 637
 638         /* Codec controls */
 639         /* The MPEG controls are applicable to all codec controls
 640          * and the 'MPEG' part of the define is historical */
 641         /* Keep the order of the 'case's the same as in videodev2.h! */
 642         case V4L2_CID_MPEG_CLASS:               return "Codec Controls";
 643         case V4L2_CID_MPEG_STREAM_TYPE:         return "Stream Type";
 644         case V4L2_CID_MPEG_STREAM_PID_PMT:      return "Stream PMT Program ID";
 645         case V4L2_CID_MPEG_STREAM_PID_AUDIO:    return "Stream Audio Program ID";
 646         case V4L2_CID_MPEG_STREAM_PID_VIDEO:    return "Stream Video Program ID";
 647         case V4L2_CID_MPEG_STREAM_PID_PCR:      return "Stream PCR Program ID";
 648         case V4L2_CID_MPEG_STREAM_PES_ID_AUDIO: return "Stream PES Audio ID";
 649         case V4L2_CID_MPEG_STREAM_PES_ID_VIDEO: return "Stream PES Video ID";
 650         case V4L2_CID_MPEG_STREAM_VBI_FMT:      return "Stream VBI Format";
 651         case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: return "Audio Sampling Frequency";
 652         case V4L2_CID_MPEG_AUDIO_ENCODING:      return "Audio Encoding";
 653         case V4L2_CID_MPEG_AUDIO_L1_BITRATE:    return "Audio Layer I Bitrate";
 654         case V4L2_CID_MPEG_AUDIO_L2_BITRATE:    return "Audio Layer II Bitrate";
 655         case V4L2_CID_MPEG_AUDIO_L3_BITRATE:    return "Audio Layer III Bitrate";
 656         case V4L2_CID_MPEG_AUDIO_MODE:          return "Audio Stereo Mode";
 657         case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION: return "Audio Stereo Mode Extension";
 658         case V4L2_CID_MPEG_AUDIO_EMPHASIS:      return "Audio Emphasis";
 659         case V4L2_CID_MPEG_AUDIO_CRC:           return "Audio CRC";
 660         case V4L2_CID_MPEG_AUDIO_MUTE:          return "Audio Mute";
 661         case V4L2_CID_MPEG_AUDIO_AAC_BITRATE:   return "Audio AAC Bitrate";
 662         case V4L2_CID_MPEG_AUDIO_AC3_BITRATE:   return "Audio AC-3 Bitrate";
 663         case V4L2_CID_MPEG_AUDIO_DEC_PLAYBACK:  return "Audio Playback";
 664         case V4L2_CID_MPEG_AUDIO_DEC_MULTILINGUAL_PLAYBACK: return "Audio Multilingual Playback";
 665         case V4L2_CID_MPEG_VIDEO_ENCODING:      return "Video Encoding";
 666         case V4L2_CID_MPEG_VIDEO_ASPECT:        return "Video Aspect";
 667         case V4L2_CID_MPEG_VIDEO_B_FRAMES:      return "Video B Frames";
 668         case V4L2_CID_MPEG_VIDEO_GOP_SIZE:      return "Video GOP Size";
 669         case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE:   return "Video GOP Closure";
 670         case V4L2_CID_MPEG_VIDEO_PULLDOWN:      return "Video Pulldown";
 671         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:  return "Video Bitrate Mode";
 672         case V4L2_CID_MPEG_VIDEO_BITRATE:       return "Video Bitrate";
 673         case V4L2_CID_MPEG_VIDEO_BITRATE_PEAK:  return "Video Peak Bitrate";
 674         case V4L2_CID_MPEG_VIDEO_TEMPORAL_DECIMATION: return "Video Temporal Decimation";
 675         case V4L2_CID_MPEG_VIDEO_MUTE:          return "Video Mute";
 676         case V4L2_CID_MPEG_VIDEO_MUTE_YUV:      return "Video Mute YUV";
 677         case V4L2_CID_MPEG_VIDEO_DECODER_SLICE_INTERFACE:       return "Decoder Slice Interface";
 678         case V4L2_CID_MPEG_VIDEO_DECODER_MPEG4_DEBLOCK_FILTER:  return "MPEG4 Loop Filter Enable";
 679         case V4L2_CID_MPEG_VIDEO_CYCLIC_INTRA_REFRESH_MB:       return "Number of Intra Refresh MBs";
 680         case V4L2_CID_MPEG_VIDEO_FRAME_RC_ENABLE:               return "Frame Level Rate Control Enable";
 681         case V4L2_CID_MPEG_VIDEO_MB_RC_ENABLE:                  return "H264 MB Level Rate Control";
 682         case V4L2_CID_MPEG_VIDEO_HEADER_MODE:                   return "Sequence Header Mode";
 683         case V4L2_CID_MPEG_VIDEO_MAX_REF_PIC:                   return "Max Number of Reference Pics";
 684         case V4L2_CID_MPEG_VIDEO_H263_I_FRAME_QP:               return "H263 I-Frame QP Value";
 685         case V4L2_CID_MPEG_VIDEO_H263_P_FRAME_QP:               return "H263 P-Frame QP Value";
 686         case V4L2_CID_MPEG_VIDEO_H263_B_FRAME_QP:               return "H263 B-Frame QP Value";
 687         case V4L2_CID_MPEG_VIDEO_H263_MIN_QP:                   return "H263 Minimum QP Value";
 688         case V4L2_CID_MPEG_VIDEO_H263_MAX_QP:                   return "H263 Maximum QP Value";
 689         case V4L2_CID_MPEG_VIDEO_H264_I_FRAME_QP:               return "H264 I-Frame QP Value";
 690         case V4L2_CID_MPEG_VIDEO_H264_P_FRAME_QP:               return "H264 P-Frame QP Value";
 691         case V4L2_CID_MPEG_VIDEO_H264_B_FRAME_QP:               return "H264 B-Frame QP Value";
 692         case V4L2_CID_MPEG_VIDEO_H264_MAX_QP:                   return "H264 Maximum QP Value";
 693         case V4L2_CID_MPEG_VIDEO_H264_MIN_QP:                   return "H264 Minimum QP Value";
 694         case V4L2_CID_MPEG_VIDEO_H264_8X8_TRANSFORM:            return "H264 8x8 Transform Enable";
 695         case V4L2_CID_MPEG_VIDEO_H264_CPB_SIZE:                 return "H264 CPB Buffer Size";
 696         case V4L2_CID_MPEG_VIDEO_H264_ENTROPY_MODE:             return "H264 Entropy Mode";
 697         case V4L2_CID_MPEG_VIDEO_H264_I_PERIOD:                 return "H264 I-Frame Period";
 698         case V4L2_CID_MPEG_VIDEO_H264_LEVEL:                    return "H264 Level";
 699         case V4L2_CID_MPEG_VIDEO_H264_LOOP_FILTER_ALPHA:        return "H264 Loop Filter Alpha Offset";
 700         case V4L2_CID_MPEG_VIDEO_H264_LOOP_FILTER_BETA:         return "H264 Loop Filter Beta Offset";
 701         case V4L2_CID_MPEG_VIDEO_H264_LOOP_FILTER_MODE:         return "H264 Loop Filter Mode";
 702         case V4L2_CID_MPEG_VIDEO_H264_PROFILE:                  return "H264 Profile";
 703         case V4L2_CID_MPEG_VIDEO_H264_VUI_EXT_SAR_HEIGHT:       return "Vertical Size of SAR";
 704         case V4L2_CID_MPEG_VIDEO_H264_VUI_EXT_SAR_WIDTH:        return "Horizontal Size of SAR";
 705         case V4L2_CID_MPEG_VIDEO_H264_VUI_SAR_ENABLE:           return "Aspect Ratio VUI Enable";
 706         case V4L2_CID_MPEG_VIDEO_H264_VUI_SAR_IDC:              return "VUI Aspect Ratio IDC";
 707         case V4L2_CID_MPEG_VIDEO_H264_SEI_FRAME_PACKING:        return "H264 Enable Frame Packing SEI";
 708         case V4L2_CID_MPEG_VIDEO_H264_SEI_FP_CURRENT_FRAME_0:   return "H264 Set Curr. Frame as Frame0";
 709         case V4L2_CID_MPEG_VIDEO_H264_SEI_FP_ARRANGEMENT_TYPE:  return "H264 FP Arrangement Type";
 710         case V4L2_CID_MPEG_VIDEO_H264_FMO:                      return "H264 Flexible MB Ordering";
 711         case V4L2_CID_MPEG_VIDEO_H264_FMO_MAP_TYPE:             return "H264 Map Type for FMO";
 712         case V4L2_CID_MPEG_VIDEO_H264_FMO_SLICE_GROUP:          return "H264 FMO Number of Slice Groups";
 713         case V4L2_CID_MPEG_VIDEO_H264_FMO_CHANGE_DIRECTION:     return "H264 FMO Direction of Change";
 714         case V4L2_CID_MPEG_VIDEO_H264_FMO_CHANGE_RATE:          return "H264 FMO Size of 1st Slice Grp";
 715         case V4L2_CID_MPEG_VIDEO_H264_FMO_RUN_LENGTH:           return "H264 FMO No. of Consecutive MBs";
 716         case V4L2_CID_MPEG_VIDEO_H264_ASO:                      return "H264 Arbitrary Slice Ordering";
 717         case V4L2_CID_MPEG_VIDEO_H264_ASO_SLICE_ORDER:          return "H264 ASO Slice Order";
 718         case V4L2_CID_MPEG_VIDEO_H264_HIERARCHICAL_CODING:      return "Enable H264 Hierarchical Coding";
 719         case V4L2_CID_MPEG_VIDEO_H264_HIERARCHICAL_CODING_TYPE: return "H264 Hierarchical Coding Type";
 720         case V4L2_CID_MPEG_VIDEO_H264_HIERARCHICAL_CODING_LAYER:return "H264 Number of HC Layers";
 721         case V4L2_CID_MPEG_VIDEO_H264_HIERARCHICAL_CODING_LAYER_QP:
 722                                                                 return "H264 Set QP Value for HC Layers";
 723         case V4L2_CID_MPEG_VIDEO_MPEG4_I_FRAME_QP:              return "MPEG4 I-Frame QP Value";
 724         case V4L2_CID_MPEG_VIDEO_MPEG4_P_FRAME_QP:              return "MPEG4 P-Frame QP Value";
 725         case V4L2_CID_MPEG_VIDEO_MPEG4_B_FRAME_QP:              return "MPEG4 B-Frame QP Value";
 726         case V4L2_CID_MPEG_VIDEO_MPEG4_MIN_QP:                  return "MPEG4 Minimum QP Value";
 727         case V4L2_CID_MPEG_VIDEO_MPEG4_MAX_QP:                  return "MPEG4 Maximum QP Value";
 728         case V4L2_CID_MPEG_VIDEO_MPEG4_LEVEL:                   return "MPEG4 Level";
 729         case V4L2_CID_MPEG_VIDEO_MPEG4_PROFILE:                 return "MPEG4 Profile";
 730         case V4L2_CID_MPEG_VIDEO_MPEG4_QPEL:                    return "Quarter Pixel Search Enable";
 731         case V4L2_CID_MPEG_VIDEO_MULTI_SLICE_MAX_BYTES:         return "Maximum Bytes in a Slice";
 732         case V4L2_CID_MPEG_VIDEO_MULTI_SLICE_MAX_MB:            return "Number of MBs in a Slice";
 733         case V4L2_CID_MPEG_VIDEO_MULTI_SLICE_MODE:              return "Slice Partitioning Method";
 734         case V4L2_CID_MPEG_VIDEO_VBV_SIZE:                      return "VBV Buffer Size";
 735         case V4L2_CID_MPEG_VIDEO_DEC_PTS:                       return "Video Decoder PTS";
 736         case V4L2_CID_MPEG_VIDEO_DEC_FRAME:                     return "Video Decoder Frame Count";
 737         case V4L2_CID_MPEG_VIDEO_VBV_DELAY:                     return "Initial Delay for VBV Control";
 738         case V4L2_CID_MPEG_VIDEO_MV_H_SEARCH_RANGE:             return "Horizontal MV Search Range";
 739         case V4L2_CID_MPEG_VIDEO_MV_V_SEARCH_RANGE:             return "Vertical MV Search Range";
 740         case V4L2_CID_MPEG_VIDEO_REPEAT_SEQ_HEADER:             return "Repeat Sequence Header";
 741
 742         /* VPX controls */
 743         case V4L2_CID_MPEG_VIDEO_VPX_NUM_PARTITIONS:            return "VPX Number of Partitions";
 744         case V4L2_CID_MPEG_VIDEO_VPX_IMD_DISABLE_4X4:           return "VPX Intra Mode Decision Disable";
 745         case V4L2_CID_MPEG_VIDEO_VPX_NUM_REF_FRAMES:            return "VPX No. of Refs for P Frame";
 746         case V4L2_CID_MPEG_VIDEO_VPX_FILTER_LEVEL:              return "VPX Loop Filter Level Range";
 747         case V4L2_CID_MPEG_VIDEO_VPX_FILTER_SHARPNESS:          return "VPX Deblocking Effect Control";
 748         case V4L2_CID_MPEG_VIDEO_VPX_GOLDEN_FRAME_REF_PERIOD:   return "VPX Golden Frame Refresh Period";
 749         case V4L2_CID_MPEG_VIDEO_VPX_GOLDEN_FRAME_SEL:          return "VPX Golden Frame Indicator";
 750         case V4L2_CID_MPEG_VIDEO_VPX_MIN_QP:                    return "VPX Minimum QP Value";
 751         case V4L2_CID_MPEG_VIDEO_VPX_MAX_QP:                    return "VPX Maximum QP Value";
 752         case V4L2_CID_MPEG_VIDEO_VPX_I_FRAME_QP:                return "VPX I-Frame QP Value";
 753         case V4L2_CID_MPEG_VIDEO_VPX_P_FRAME_QP:                return "VPX P-Frame QP Value";
 754         case V4L2_CID_MPEG_VIDEO_VPX_PROFILE:                   return "VPX Profile";
 755
 756         /* CAMERA controls */
 757         /* Keep the order of the 'case's the same as in videodev2.h! */
 758         case V4L2_CID_CAMERA_CLASS:             return "Camera Controls";
 759         case V4L2_CID_EXPOSURE_AUTO:            return "Auto Exposure";
 760         case V4L2_CID_EXPOSURE_ABSOLUTE:        return "Exposure Time, Absolute";
 761         case V4L2_CID_EXPOSURE_AUTO_PRIORITY:   return "Exposure, Dynamic Framerate";
 762         case V4L2_CID_PAN_RELATIVE:             return "Pan, Relative";
 763         case V4L2_CID_TILT_RELATIVE:            return "Tilt, Relative";
 764         case V4L2_CID_PAN_RESET:                return "Pan, Reset";
 765         case V4L2_CID_TILT_RESET:               return "Tilt, Reset";
 766         case V4L2_CID_PAN_ABSOLUTE:             return "Pan, Absolute";
 767         case V4L2_CID_TILT_ABSOLUTE:            return "Tilt, Absolute";
 768         case V4L2_CID_FOCUS_ABSOLUTE:           return "Focus, Absolute";
 769         case V4L2_CID_FOCUS_RELATIVE:           return "Focus, Relative";
 770         case V4L2_CID_FOCUS_AUTO:               return "Focus, Automatic Continuous";
 771         case V4L2_CID_ZOOM_ABSOLUTE:            return "Zoom, Absolute";
 772         case V4L2_CID_ZOOM_RELATIVE:            return "Zoom, Relative";
 773         case V4L2_CID_ZOOM_CONTINUOUS:          return "Zoom, Continuous";
 774         case V4L2_CID_PRIVACY:                  return "Privacy";
 775         case V4L2_CID_IRIS_ABSOLUTE:            return "Iris, Absolute";
 776         case V4L2_CID_IRIS_RELATIVE:            return "Iris, Relative";
 777         case V4L2_CID_AUTO_EXPOSURE_BIAS:       return "Auto Exposure, Bias";
 778         case V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE: return "White Balance, Auto & Preset";
 779         case V4L2_CID_WIDE_DYNAMIC_RANGE:       return "Wide Dynamic Range";
 780         case V4L2_CID_IMAGE_STABILIZATION:      return "Image Stabilization";
 781         case V4L2_CID_ISO_SENSITIVITY:          return "ISO Sensitivity";
 782         case V4L2_CID_ISO_SENSITIVITY_AUTO:     return "ISO Sensitivity, Auto";
 783         case V4L2_CID_EXPOSURE_METERING:        return "Exposure, Metering Mode";
 784         case V4L2_CID_SCENE_MODE:               return "Scene Mode";
 785         case V4L2_CID_3A_LOCK:                  return "3A Lock";
 786         case V4L2_CID_AUTO_FOCUS_START:         return "Auto Focus, Start";
 787         case V4L2_CID_AUTO_FOCUS_STOP:          return "Auto Focus, Stop";
 788         case V4L2_CID_AUTO_FOCUS_STATUS:        return "Auto Focus, Status";
 789         case V4L2_CID_AUTO_FOCUS_RANGE:         return "Auto Focus, Range";
 790
 791         /* FM Radio Modulator control */
 792         /* Keep the order of the 'case's the same as in videodev2.h! */
 793         case V4L2_CID_FM_TX_CLASS:              return "FM Radio Modulator Controls";
 794         case V4L2_CID_RDS_TX_DEVIATION:         return "RDS Signal Deviation";
 795         case V4L2_CID_RDS_TX_PI:                return "RDS Program ID";
 796         case V4L2_CID_RDS_TX_PTY:               return "RDS Program Type";
 797         case V4L2_CID_RDS_TX_PS_NAME:           return "RDS PS Name";
 798         case V4L2_CID_RDS_TX_RADIO_TEXT:        return "RDS Radio Text";
 799         case V4L2_CID_AUDIO_LIMITER_ENABLED:    return "Audio Limiter Feature Enabled";
 800         case V4L2_CID_AUDIO_LIMITER_RELEASE_TIME: return "Audio Limiter Release Time";
 801         case V4L2_CID_AUDIO_LIMITER_DEVIATION:  return "Audio Limiter Deviation";
 802         case V4L2_CID_AUDIO_COMPRESSION_ENABLED: return "Audio Compression Enabled";
 803         case V4L2_CID_AUDIO_COMPRESSION_GAIN:   return "Audio Compression Gain";
 804         case V4L2_CID_AUDIO_COMPRESSION_THRESHOLD: return "Audio Compression Threshold";
 805         case V4L2_CID_AUDIO_COMPRESSION_ATTACK_TIME: return "Audio Compression Attack Time";
 806         case V4L2_CID_AUDIO_COMPRESSION_RELEASE_TIME: return "Audio Compression Release Time";
 807         case V4L2_CID_PILOT_TONE_ENABLED:       return "Pilot Tone Feature Enabled";
 808         case V4L2_CID_PILOT_TONE_DEVIATION:     return "Pilot Tone Deviation";
 809         case V4L2_CID_PILOT_TONE_FREQUENCY:     return "Pilot Tone Frequency";
 810         case V4L2_CID_TUNE_PREEMPHASIS:         return "Pre-Emphasis";
 811         case V4L2_CID_TUNE_POWER_LEVEL:         return "Tune Power Level";
 812         case V4L2_CID_TUNE_ANTENNA_CAPACITOR:   return "Tune Antenna Capacitor";
 813
 814         /* Flash controls */
 815         case V4L2_CID_FLASH_CLASS:              return "Flash Controls";
 816         case V4L2_CID_FLASH_LED_MODE:           return "LED Mode";
 817         case V4L2_CID_FLASH_STROBE_SOURCE:      return "Strobe Source";
 818         case V4L2_CID_FLASH_STROBE:             return "Strobe";
 819         case V4L2_CID_FLASH_STROBE_STOP:        return "Stop Strobe";
 820         case V4L2_CID_FLASH_STROBE_STATUS:      return "Strobe Status";
 821         case V4L2_CID_FLASH_TIMEOUT:            return "Strobe Timeout";
 822         case V4L2_CID_FLASH_INTENSITY:          return "Intensity, Flash Mode";
 823         case V4L2_CID_FLASH_TORCH_INTENSITY:    return "Intensity, Torch Mode";
 824         case V4L2_CID_FLASH_INDICATOR_INTENSITY: return "Intensity, Indicator";
 825         case V4L2_CID_FLASH_FAULT:              return "Faults";
 826         case V4L2_CID_FLASH_CHARGE:             return "Charge";
 827         case V4L2_CID_FLASH_READY:              return "Ready to Strobe";
 828
 829         /* JPEG encoder controls */
 830         /* Keep the order of the 'case's the same as in videodev2.h! */
 831         case V4L2_CID_JPEG_CLASS:               return "JPEG Compression Controls";
 832         case V4L2_CID_JPEG_CHROMA_SUBSAMPLING:  return "Chroma Subsampling";
 833         case V4L2_CID_JPEG_RESTART_INTERVAL:    return "Restart Interval";
 834         case V4L2_CID_JPEG_COMPRESSION_QUALITY: return "Compression Quality";
 835         case V4L2_CID_JPEG_ACTIVE_MARKER:       return "Active Markers";
 836
 837         /* Image source controls */
 838         case V4L2_CID_IMAGE_SOURCE_CLASS:       return "Image Source Controls";
 839         case V4L2_CID_VBLANK:                   return "Vertical Blanking";
 840         case V4L2_CID_HBLANK:                   return "Horizontal Blanking";
 841         case V4L2_CID_ANALOGUE_GAIN:            return "Analogue Gain";
 842
 843         /* Image processing controls */
 844         case V4L2_CID_IMAGE_PROC_CLASS:         return "Image Processing Controls";
 845         case V4L2_CID_LINK_FREQ:                return "Link Frequency";
 846         case V4L2_CID_PIXEL_RATE:               return "Pixel Rate";
 847         case V4L2_CID_TEST_PATTERN:             return "Test Pattern";
 848
 849         /* DV controls */
 850         case V4L2_CID_DV_CLASS:                 return "Digital Video Controls";
 851         case V4L2_CID_DV_TX_HOTPLUG:            return "Hotplug Present";
 852         case V4L2_CID_DV_TX_RXSENSE:            return "RxSense Present";
 853         case V4L2_CID_DV_TX_EDID_PRESENT:       return "EDID Present";
 854         case V4L2_CID_DV_TX_MODE:               return "Transmit Mode";
 855         case V4L2_CID_DV_TX_RGB_RANGE:          return "Tx RGB Quantization Range";
 856         case V4L2_CID_DV_RX_POWER_PRESENT:      return "Power Present";
 857         case V4L2_CID_DV_RX_RGB_RANGE:          return "Rx RGB Quantization Range";
 858
 859         case V4L2_CID_FM_RX_CLASS:              return "FM Radio Receiver Controls";
 860         case V4L2_CID_TUNE_DEEMPHASIS:          return "De-Emphasis";
 861         case V4L2_CID_RDS_RECEPTION:            return "RDS Reception";
 862
 863         case V4L2_CID_RF_TUNER_CLASS:           return "RF Tuner Controls";
 864         case V4L2_CID_RF_TUNER_LNA_GAIN_AUTO:   return "LNA Gain, Auto";
 865         case V4L2_CID_RF_TUNER_LNA_GAIN:        return "LNA Gain";
 866         case V4L2_CID_RF_TUNER_MIXER_GAIN_AUTO: return "Mixer Gain, Auto";
 867         case V4L2_CID_RF_TUNER_MIXER_GAIN:      return "Mixer Gain";
 868         case V4L2_CID_RF_TUNER_IF_GAIN_AUTO:    return "IF Gain, Auto";
 869         case V4L2_CID_RF_TUNER_IF_GAIN:         return "IF Gain";
 870         case V4L2_CID_RF_TUNER_BANDWIDTH_AUTO:  return "Bandwidth, Auto";
 871         case V4L2_CID_RF_TUNER_BANDWIDTH:       return "Bandwidth";
 872         case V4L2_CID_RF_TUNER_PLL_LOCK:        return "PLL Lock";
 873         default:
 874                 return NULL;
 875         }
 876 }
 877 EXPORT_SYMBOL(v4l2_ctrl_get_name);
 878
 879 void v4l2_ctrl_fill(u32 id, const char **name, enum v4l2_ctrl_type *type,
 880                     s64 *min, s64 *max, u64 *step, s64 *def, u32 *flags)
 881 {
 882         *name = v4l2_ctrl_get_name(id);
 883         *flags = 0;
 884
 885         switch (id) {
 886         case V4L2_CID_AUDIO_MUTE:
 887         case V4L2_CID_AUDIO_LOUDNESS:
 888         case V4L2_CID_AUTO_WHITE_BALANCE:
 889         case V4L2_CID_AUTOGAIN:
 890         case V4L2_CID_HFLIP:
 891         case V4L2_CID_VFLIP:
 892         case V4L2_CID_HUE_AUTO:
 893         case V4L2_CID_CHROMA_AGC:
 894         case V4L2_CID_COLOR_KILLER:
 895         case V4L2_CID_AUTOBRIGHTNESS:
 896         case V4L2_CID_MPEG_AUDIO_MUTE:
 897         case V4L2_CID_MPEG_VIDEO_MUTE:
 898         case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE:
 899         case V4L2_CID_MPEG_VIDEO_PULLDOWN:
 900         case V4L2_CID_EXPOSURE_AUTO_PRIORITY:
 901         case V4L2_CID_FOCUS_AUTO:
 902         case V4L2_CID_PRIVACY:
 903         case V4L2_CID_AUDIO_LIMITER_ENABLED:
 904         case V4L2_CID_AUDIO_COMPRESSION_ENABLED:
 905         case V4L2_CID_PILOT_TONE_ENABLED:
 906         case V4L2_CID_ILLUMINATORS_1:
 907         case V4L2_CID_ILLUMINATORS_2:
 908         case V4L2_CID_FLASH_STROBE_STATUS:
 909         case V4L2_CID_FLASH_CHARGE:
 910         case V4L2_CID_FLASH_READY:
 911         case V4L2_CID_MPEG_VIDEO_DECODER_MPEG4_DEBLOCK_FILTER:
 912         case V4L2_CID_MPEG_VIDEO_DECODER_SLICE_INTERFACE:
 913         case V4L2_CID_MPEG_VIDEO_FRAME_RC_ENABLE:
 914         case V4L2_CID_MPEG_VIDEO_MB_RC_ENABLE:
 915         case V4L2_CID_MPEG_VIDEO_H264_8X8_TRANSFORM:
 916         case V4L2_CID_MPEG_VIDEO_H264_VUI_SAR_ENABLE:
 917         case V4L2_CID_MPEG_VIDEO_MPEG4_QPEL:
 918         case V4L2_CID_MPEG_VIDEO_REPEAT_SEQ_HEADER:
 919         case V4L2_CID_WIDE_DYNAMIC_RANGE:
 920         case V4L2_CID_IMAGE_STABILIZATION:
 921         case V4L2_CID_RDS_RECEPTION:
 922         case V4L2_CID_RF_TUNER_LNA_GAIN_AUTO:
 923         case V4L2_CID_RF_TUNER_MIXER_GAIN_AUTO:
 924         case V4L2_CID_RF_TUNER_IF_GAIN_AUTO:
 925         case V4L2_CID_RF_TUNER_BANDWIDTH_AUTO:
 926         case V4L2_CID_RF_TUNER_PLL_LOCK:
 927                 *type = V4L2_CTRL_TYPE_BOOLEAN;
 928                 *min = 0;
 929                 *max = *step = 1;
 930                 break;
 931         case V4L2_CID_MPEG_VIDEO_MV_H_SEARCH_RANGE:
 932         case V4L2_CID_MPEG_VIDEO_MV_V_SEARCH_RANGE:
 933                 *type = V4L2_CTRL_TYPE_INTEGER;
 934                 break;
 935         case V4L2_CID_PAN_RESET:
 936         case V4L2_CID_TILT_RESET:
 937         case V4L2_CID_FLASH_STROBE:
 938         case V4L2_CID_FLASH_STROBE_STOP:
 939         case V4L2_CID_AUTO_FOCUS_START:
 940         case V4L2_CID_AUTO_FOCUS_STOP:
 941                 *type = V4L2_CTRL_TYPE_BUTTON;
 942                 *flags |= V4L2_CTRL_FLAG_WRITE_ONLY;
 943                 *min = *max = *step = *def = 0;
 944                 break;
 945         case V4L2_CID_POWER_LINE_FREQUENCY:
 946         case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ:
 947         case V4L2_CID_MPEG_AUDIO_ENCODING:
 948         case V4L2_CID_MPEG_AUDIO_L1_BITRATE:
 949         case V4L2_CID_MPEG_AUDIO_L2_BITRATE:
 950         case V4L2_CID_MPEG_AUDIO_L3_BITRATE:
 951         case V4L2_CID_MPEG_AUDIO_AC3_BITRATE:
 952         case V4L2_CID_MPEG_AUDIO_MODE:
 953         case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION:
 954         case V4L2_CID_MPEG_AUDIO_EMPHASIS:
 955         case V4L2_CID_MPEG_AUDIO_CRC:
 956         case V4L2_CID_MPEG_AUDIO_DEC_PLAYBACK:
 957         case V4L2_CID_MPEG_AUDIO_DEC_MULTILINGUAL_PLAYBACK:
 958         case V4L2_CID_MPEG_VIDEO_ENCODING:
 959         case V4L2_CID_MPEG_VIDEO_ASPECT:
 960         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
 961         case V4L2_CID_MPEG_STREAM_TYPE:
 962         case V4L2_CID_MPEG_STREAM_VBI_FMT:
 963         case V4L2_CID_EXPOSURE_AUTO:
 964         case V4L2_CID_AUTO_FOCUS_RANGE:
 965         case V4L2_CID_COLORFX:
 966         case V4L2_CID_AUTO_N_PRESET_WHITE_BALANCE:
 967         case V4L2_CID_TUNE_PREEMPHASIS:
 968         case V4L2_CID_FLASH_LED_MODE:
 969         case V4L2_CID_FLASH_STROBE_SOURCE:
 970         case V4L2_CID_MPEG_VIDEO_HEADER_MODE:
 971         case V4L2_CID_MPEG_VIDEO_MULTI_SLICE_MODE:
 972         case V4L2_CID_MPEG_VIDEO_H264_ENTROPY_MODE:
 973         case V4L2_CID_MPEG_VIDEO_H264_LEVEL:
 974         case V4L2_CID_MPEG_VIDEO_H264_LOOP_FILTER_MODE:
 975         case V4L2_CID_MPEG_VIDEO_H264_PROFILE:
 976         case V4L2_CID_MPEG_VIDEO_H264_VUI_SAR_IDC:
 977         case V4L2_CID_MPEG_VIDEO_H264_SEI_FP_ARRANGEMENT_TYPE:
 978         case V4L2_CID_MPEG_VIDEO_H264_FMO_MAP_TYPE:
 979         case V4L2_CID_MPEG_VIDEO_MPEG4_LEVEL:
 980         case V4L2_CID_MPEG_VIDEO_MPEG4_PROFILE:
 981         case V4L2_CID_JPEG_CHROMA_SUBSAMPLING:
 982         case V4L2_CID_ISO_SENSITIVITY_AUTO:
 983         case V4L2_CID_EXPOSURE_METERING:
 984         case V4L2_CID_SCENE_MODE:
 985         case V4L2_CID_DV_TX_MODE:
 986         case V4L2_CID_DV_TX_RGB_RANGE:
 987         case V4L2_CID_DV_RX_RGB_RANGE:
 988         case V4L2_CID_TEST_PATTERN:
 989         case V4L2_CID_TUNE_DEEMPHASIS:
 990         case V4L2_CID_MPEG_VIDEO_VPX_GOLDEN_FRAME_SEL:
 991                 *type = V4L2_CTRL_TYPE_MENU;
 992                 break;
 993         case V4L2_CID_LINK_FREQ:
 994                 *type = V4L2_CTRL_TYPE_INTEGER_MENU;
 995                 break;
 996         case V4L2_CID_RDS_TX_PS_NAME:
 997         case V4L2_CID_RDS_TX_RADIO_TEXT:
 998                 *type = V4L2_CTRL_TYPE_STRING;
 999                 break;
1000         case V4L2_CID_ISO_SENSITIVITY:
1001         case V4L2_CID_AUTO_EXPOSURE_BIAS:
1002         case V4L2_CID_MPEG_VIDEO_VPX_NUM_PARTITIONS:
1003         case V4L2_CID_MPEG_VIDEO_VPX_NUM_REF_FRAMES:
1004                 *type = V4L2_CTRL_TYPE_INTEGER_MENU;
1005                 break;
1006         case V4L2_CID_USER_CLASS:
1007         case V4L2_CID_CAMERA_CLASS:
1008         case V4L2_CID_MPEG_CLASS:
1009         case V4L2_CID_FM_TX_CLASS:
1010         case V4L2_CID_FLASH_CLASS:
1011         case V4L2_CID_JPEG_CLASS:
1012         case V4L2_CID_IMAGE_SOURCE_CLASS:
1013         case V4L2_CID_IMAGE_PROC_CLASS:
1014         case V4L2_CID_DV_CLASS:
1015         case V4L2_CID_FM_RX_CLASS:
1016         case V4L2_CID_RF_TUNER_CLASS:
1017                 *type = V4L2_CTRL_TYPE_CTRL_CLASS;
1018                 /* You can neither read not write these */
1019                 *flags |= V4L2_CTRL_FLAG_READ_ONLY | V4L2_CTRL_FLAG_WRITE_ONLY;
1020                 *min = *max = *step = *def = 0;
1021                 break;
1022         case V4L2_CID_BG_COLOR:
1023                 *type = V4L2_CTRL_TYPE_INTEGER;
1024                 *step = 1;
1025                 *min = 0;
1026                 /* Max is calculated as RGB888 that is 2^24 */
1027                 *max = 0xFFFFFF;
1028                 break;
1029         case V4L2_CID_FLASH_FAULT:
1030         case V4L2_CID_JPEG_ACTIVE_MARKER:
1031         case V4L2_CID_3A_LOCK:
1032         case V4L2_CID_AUTO_FOCUS_STATUS:
1033         case V4L2_CID_DV_TX_HOTPLUG:
1034         case V4L2_CID_DV_TX_RXSENSE:
1035         case V4L2_CID_DV_TX_EDID_PRESENT:
1036         case V4L2_CID_DV_RX_POWER_PRESENT:
1037                 *type = V4L2_CTRL_TYPE_BITMASK;
1038                 break;
1039         case V4L2_CID_MIN_BUFFERS_FOR_CAPTURE:
1040         case V4L2_CID_MIN_BUFFERS_FOR_OUTPUT:
1041                 *type = V4L2_CTRL_TYPE_INTEGER;
1042                 *flags |= V4L2_CTRL_FLAG_READ_ONLY;
1043                 break;
1044         case V4L2_CID_MPEG_VIDEO_DEC_PTS:
1045                 *type = V4L2_CTRL_TYPE_INTEGER64;
1046                 *flags |= V4L2_CTRL_FLAG_VOLATILE | V4L2_CTRL_FLAG_READ_ONLY;
1047                 *min = *def = 0;
1048                 *max = 0x1ffffffffLL;
1049                 *step = 1;
1050                 break;
1051         case V4L2_CID_MPEG_VIDEO_DEC_FRAME:
1052                 *type = V4L2_CTRL_TYPE_INTEGER64;
1053                 *flags |= V4L2_CTRL_FLAG_VOLATILE | V4L2_CTRL_FLAG_READ_ONLY;
1054                 *min = *def = 0;
1055                 *max = 0x7fffffffffffffffLL;
1056                 *step = 1;
1057                 break;
1058         case V4L2_CID_PIXEL_RATE:
1059                 *type = V4L2_CTRL_TYPE_INTEGER64;
1060                 *flags |= V4L2_CTRL_FLAG_READ_ONLY;
1061                 break;
1062         default:
1063                 *type = V4L2_CTRL_TYPE_INTEGER;
1064                 break;
1065         }
1066         switch (id) {
1067         case V4L2_CID_MPEG_AUDIO_ENCODING:
1068         case V4L2_CID_MPEG_AUDIO_MODE:
1069         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
1070         case V4L2_CID_MPEG_VIDEO_B_FRAMES:
1071         case V4L2_CID_MPEG_STREAM_TYPE:
1072                 *flags |= V4L2_CTRL_FLAG_UPDATE;
1073                 break;
1074         case V4L2_CID_AUDIO_VOLUME:
1075         case V4L2_CID_AUDIO_BALANCE:
1076         case V4L2_CID_AUDIO_BASS:
1077         case V4L2_CID_AUDIO_TREBLE:
1078         case V4L2_CID_BRIGHTNESS:
1079         case V4L2_CID_CONTRAST:
1080         case V4L2_CID_SATURATION:
1081         case V4L2_CID_HUE:
1082         case V4L2_CID_RED_BALANCE:
1083         case V4L2_CID_BLUE_BALANCE:
1084         case V4L2_CID_GAMMA:
1085         case V4L2_CID_SHARPNESS:
1086         case V4L2_CID_CHROMA_GAIN:
1087         case V4L2_CID_RDS_TX_DEVIATION:
1088         case V4L2_CID_AUDIO_LIMITER_RELEASE_TIME:
1089         case V4L2_CID_AUDIO_LIMITER_DEVIATION:
1090         case V4L2_CID_AUDIO_COMPRESSION_GAIN:
1091         case V4L2_CID_AUDIO_COMPRESSION_THRESHOLD:
1092         case V4L2_CID_AUDIO_COMPRESSION_ATTACK_TIME:
1093         case V4L2_CID_AUDIO_COMPRESSION_RELEASE_TIME:
1094         case V4L2_CID_PILOT_TONE_DEVIATION:
1095         case V4L2_CID_PILOT_TONE_FREQUENCY:
1096         case V4L2_CID_TUNE_POWER_LEVEL:
1097         case V4L2_CID_TUNE_ANTENNA_CAPACITOR:
1098         case V4L2_CID_RF_TUNER_LNA_GAIN:
1099         case V4L2_CID_RF_TUNER_MIXER_GAIN:
1100         case V4L2_CID_RF_TUNER_IF_GAIN:
1101         case V4L2_CID_RF_TUNER_BANDWIDTH:
1102                 *flags |= V4L2_CTRL_FLAG_SLIDER;
1103                 break;
1104         case V4L2_CID_PAN_RELATIVE:
1105         case V4L2_CID_TILT_RELATIVE:
1106         case V4L2_CID_FOCUS_RELATIVE:
1107         case V4L2_CID_IRIS_RELATIVE:
1108         case V4L2_CID_ZOOM_RELATIVE:
1109                 *flags |= V4L2_CTRL_FLAG_WRITE_ONLY;
1110                 break;
1111         case V4L2_CID_FLASH_STROBE_STATUS:
1112         case V4L2_CID_AUTO_FOCUS_STATUS:
1113         case V4L2_CID_FLASH_READY:
1114         case V4L2_CID_DV_TX_HOTPLUG:
1115         case V4L2_CID_DV_TX_RXSENSE:
1116         case V4L2_CID_DV_TX_EDID_PRESENT:
1117         case V4L2_CID_DV_RX_POWER_PRESENT:
1118                 *flags |= V4L2_CTRL_FLAG_READ_ONLY;
1119                 break;
1120         case V4L2_CID_RF_TUNER_PLL_LOCK:
1121                 *flags |= V4L2_CTRL_FLAG_VOLATILE;
1122                 break;
1123         }
1124 }
1125 EXPORT_SYMBOL(v4l2_ctrl_fill);
1126
1127 static void fill_event(struct v4l2_event *ev, struct v4l2_ctrl *ctrl, u32 changes)
1128 {
1129         memset(ev->reserved, 0, sizeof(ev->reserved));
1130         ev->type = V4L2_EVENT_CTRL;
1131         ev->id = ctrl->id;
1132         ev->u.ctrl.changes = changes;
1133         ev->u.ctrl.type = ctrl->type;
1134         ev->u.ctrl.flags = ctrl->flags;
1135         if (ctrl->is_ptr)
1136                 ev->u.ctrl.value64 = 0;
1137         else
1138                 ev->u.ctrl.value64 = *ctrl->p_cur.p_s64;
1139         ev->u.ctrl.minimum = ctrl->minimum;
1140         ev->u.ctrl.maximum = ctrl->maximum;
1141         if (ctrl->type == V4L2_CTRL_TYPE_MENU
1142             || ctrl->type == V4L2_CTRL_TYPE_INTEGER_MENU)
1143                 ev->u.ctrl.step = 1;
1144         else
1145                 ev->u.ctrl.step = ctrl->step;
1146         ev->u.ctrl.default_value = ctrl->default_value;
1147 }
1148
1149 static void send_event(struct v4l2_fh *fh, struct v4l2_ctrl *ctrl, u32 changes)
1150 {
1151         struct v4l2_event ev;
1152         struct v4l2_subscribed_event *sev;
1153
1154         if (list_empty(&ctrl->ev_subs))
1155                 return;
1156         fill_event(&ev, ctrl, changes);
1157
1158         list_for_each_entry(sev, &ctrl->ev_subs, node)
1159                 if (sev->fh != fh ||
1160                     (sev->flags & V4L2_EVENT_SUB_FL_ALLOW_FEEDBACK))
1161                         v4l2_event_queue_fh(sev->fh, &ev);
1162 }
1163
1164 static bool std_equal(const struct v4l2_ctrl *ctrl, u32 idx,
1165                       union v4l2_ctrl_ptr ptr1,
1166                       union v4l2_ctrl_ptr ptr2)
1167 {
1168         switch (ctrl->type) {
1169         case V4L2_CTRL_TYPE_BUTTON:
1170                 return false;
1171         case V4L2_CTRL_TYPE_STRING:
1172                 idx *= ctrl->elem_size;
1173                 /* strings are always 0-terminated */
1174                 return !strcmp(ptr1.p_char + idx, ptr2.p_char + idx);
1175         case V4L2_CTRL_TYPE_INTEGER64:
1176                 return ptr1.p_s64[idx] == ptr2.p_s64[idx];
1177         case V4L2_CTRL_TYPE_U8:
1178                 return ptr1.p_u8[idx] == ptr2.p_u8[idx];
1179         case V4L2_CTRL_TYPE_U16:
1180                 return ptr1.p_u16[idx] == ptr2.p_u16[idx];
1181         default:
1182                 if (ctrl->is_int)
1183                         return ptr1.p_s32[idx] == ptr2.p_s32[idx];
1184                 idx *= ctrl->elem_size;
1185                 return !memcmp(ptr1.p + idx, ptr2.p + idx, ctrl->elem_size);
1186         }
1187 }
1188
1189 static void std_init(const struct v4l2_ctrl *ctrl, u32 idx,
1190                      union v4l2_ctrl_ptr ptr)
1191 {
1192         switch (ctrl->type) {
1193         case V4L2_CTRL_TYPE_STRING:
1194                 idx *= ctrl->elem_size;
1195                 memset(ptr.p_char + idx, ' ', ctrl->minimum);
1196                 ptr.p_char[idx + ctrl->minimum] = '\0';
1197                 break;
1198         case V4L2_CTRL_TYPE_INTEGER64:
1199                 ptr.p_s64[idx] = ctrl->default_value;
1200                 break;
1201         case V4L2_CTRL_TYPE_INTEGER:
1202         case V4L2_CTRL_TYPE_INTEGER_MENU:
1203         case V4L2_CTRL_TYPE_MENU:
1204         case V4L2_CTRL_TYPE_BITMASK:
1205         case V4L2_CTRL_TYPE_BOOLEAN:
1206                 ptr.p_s32[idx] = ctrl->default_value;
1207                 break;
1208         case V4L2_CTRL_TYPE_U8:
1209                 ptr.p_u8[idx] = ctrl->default_value;
1210                 break;
1211         case V4L2_CTRL_TYPE_U16:
1212                 ptr.p_u16[idx] = ctrl->default_value;
1213                 break;
1214         default:
1215                 idx *= ctrl->elem_size;
1216                 memset(ptr.p + idx, 0, ctrl->elem_size);
1217                 break;
1218         }
1219 }
1220
1221 static void std_log(const struct v4l2_ctrl *ctrl)
1222 {
1223         union v4l2_ctrl_ptr ptr = ctrl->p_cur;
1224
1225         if (ctrl->is_array) {
1226                 unsigned i;
1227
1228                 for (i = 0; i < ctrl->nr_of_dims; i++)
1229                         pr_cont("[%u]", ctrl->dims[i]);
1230                 pr_cont(" ");
1231         }
1232
1233         switch (ctrl->type) {
1234         case V4L2_CTRL_TYPE_INTEGER:
1235                 pr_cont("%d", *ptr.p_s32);
1236                 break;
1237         case V4L2_CTRL_TYPE_BOOLEAN:
1238                 pr_cont("%s", *ptr.p_s32 ? "true" : "false");
1239                 break;
1240         case V4L2_CTRL_TYPE_MENU:
1241                 pr_cont("%s", ctrl->qmenu[*ptr.p_s32]);
1242                 break;
1243         case V4L2_CTRL_TYPE_INTEGER_MENU:
1244                 pr_cont("%lld", ctrl->qmenu_int[*ptr.p_s32]);
1245                 break;
1246         case V4L2_CTRL_TYPE_BITMASK:
1247                 pr_cont("0x%08x", *ptr.p_s32);
1248                 break;
1249         case V4L2_CTRL_TYPE_INTEGER64:
1250                 pr_cont("%lld", *ptr.p_s64);
1251                 break;
1252         case V4L2_CTRL_TYPE_STRING:
1253                 pr_cont("%s", ptr.p_char);
1254                 break;
1255         case V4L2_CTRL_TYPE_U8:
1256                 pr_cont("%u", (unsigned)*ptr.p_u8);
1257                 break;
1258         case V4L2_CTRL_TYPE_U16:
1259                 pr_cont("%u", (unsigned)*ptr.p_u16);
1260                 break;
1261         default:
1262                 pr_cont("unknown type %d", ctrl->type);
1263                 break;
1264         }
1265 }
1266
1267 /* Round towards the closest legal value */
1268 #define ROUND_TO_RANGE(val, offset_type, ctrl)                  \
1269 ({                                                              \
1270         offset_type offset;                                     \
1271         val += (ctrl)->step / 2;                                \
1272         val = clamp_t(typeof(val), val,                         \
1273                       (ctrl)->minimum, (ctrl)->maximum);        \
1274         offset = (val) - (ctrl)->minimum;                       \
1275         offset = (ctrl)->step * (offset / (ctrl)->step);        \
1276         val = (ctrl)->minimum + offset;                         \
1277         0;                                                      \
1278 })
1279
1280 /* Validate a new control */
1281 static int std_validate(const struct v4l2_ctrl *ctrl, u32 idx,
1282                         union v4l2_ctrl_ptr ptr)
1283 {
1284         size_t len;
1285
1286         switch (ctrl->type) {
1287         case V4L2_CTRL_TYPE_INTEGER:
1288                 return ROUND_TO_RANGE(ptr.p_s32[idx], u32, ctrl);
1289         case V4L2_CTRL_TYPE_INTEGER64:
1290                 return ROUND_TO_RANGE(ptr.p_s64[idx], u64, ctrl);
1291         case V4L2_CTRL_TYPE_U8:
1292                 return ROUND_TO_RANGE(ptr.p_u8[idx], u8, ctrl);
1293         case V4L2_CTRL_TYPE_U16:
1294                 return ROUND_TO_RANGE(ptr.p_u16[idx], u16, ctrl);
1295
1296         case V4L2_CTRL_TYPE_BOOLEAN:
1297                 ptr.p_s32[idx] = !!ptr.p_s32[idx];
1298                 return 0;
1299
1300         case V4L2_CTRL_TYPE_MENU:
1301         case V4L2_CTRL_TYPE_INTEGER_MENU:
1302                 if (ptr.p_s32[idx] < ctrl->minimum || ptr.p_s32[idx] > ctrl->maximum)
1303                         return -ERANGE;
1304                 if (ctrl->menu_skip_mask & (1 << ptr.p_s32[idx]))
1305                         return -EINVAL;
1306                 if (ctrl->type == V4L2_CTRL_TYPE_MENU &&
1307                     ctrl->qmenu[ptr.p_s32[idx]][0] == '\0')
1308                         return -EINVAL;
1309                 return 0;
1310
1311         case V4L2_CTRL_TYPE_BITMASK:
1312                 ptr.p_s32[idx] &= ctrl->maximum;
1313                 return 0;
1314
1315         case V4L2_CTRL_TYPE_BUTTON:
1316         case V4L2_CTRL_TYPE_CTRL_CLASS:
1317                 ptr.p_s32[idx] = 0;
1318                 return 0;
1319
1320         case V4L2_CTRL_TYPE_STRING:
1321                 idx *= ctrl->elem_size;
1322                 len = strlen(ptr.p_char + idx);
1323                 if (len < ctrl->minimum)
1324                         return -ERANGE;
1325                 if ((len - ctrl->minimum) % ctrl->step)
1326                         return -ERANGE;
1327                 return 0;
1328
1329         default:
1330                 return -EINVAL;
1331         }
1332 }
1333
1334 static const struct v4l2_ctrl_type_ops std_type_ops = {
1335         .equal = std_equal,
1336         .init = std_init,
1337         .log = std_log,
1338         .validate = std_validate,
1339 };
1340
1341 /* Helper function: copy the given control value back to the caller */
1342 static int ptr_to_user(struct v4l2_ext_control *c,
1343                        struct v4l2_ctrl *ctrl,
1344                        union v4l2_ctrl_ptr ptr)
1345 {
1346         u32 len;
1347
1348         if (ctrl->is_ptr && !ctrl->is_string)
1349                 return copy_to_user(c->ptr, ptr.p, c->size) ?
1350                        -EFAULT : 0;
1351
1352         switch (ctrl->type) {
1353         case V4L2_CTRL_TYPE_STRING:
1354                 len = strlen(ptr.p_char);
1355                 if (c->size < len + 1) {
1356                         c->size = ctrl->elem_size;
1357                         return -ENOSPC;
1358                 }
1359                 return copy_to_user(c->string, ptr.p_char, len + 1) ?
1360                        -EFAULT : 0;
1361         case V4L2_CTRL_TYPE_INTEGER64:
1362                 c->value64 = *ptr.p_s64;
1363                 break;
1364         default:
1365                 c->value = *ptr.p_s32;
1366                 break;
1367         }
1368         return 0;
1369 }
1370
1371 /* Helper function: copy the current control value back to the caller */
1372 static int cur_to_user(struct v4l2_ext_control *c,
1373                        struct v4l2_ctrl *ctrl)
1374 {
1375         return ptr_to_user(c, ctrl, ctrl->p_cur);
1376 }
1377
1378 /* Helper function: copy the new control value back to the caller */
1379 static int new_to_user(struct v4l2_ext_control *c,
1380                        struct v4l2_ctrl *ctrl)
1381 {
1382         return ptr_to_user(c, ctrl, ctrl->p_new);
1383 }
1384
1385 /* Helper function: copy the caller-provider value to the given control value */
1386 static int user_to_ptr(struct v4l2_ext_control *c,
1387                        struct v4l2_ctrl *ctrl,
1388                        union v4l2_ctrl_ptr ptr)
1389 {
1390         int ret;
1391         u32 size;
1392
1393         ctrl->is_new = 1;
1394         if (ctrl->is_ptr && !ctrl->is_string) {
1395                 unsigned idx;
1396
1397                 ret = copy_from_user(ptr.p, c->ptr, c->size) ? -EFAULT : 0;
1398                 if (ret || !ctrl->is_array)
1399                         return ret;
1400                 for (idx = c->size / ctrl->elem_size; idx < ctrl->elems; idx++)
1401                         ctrl->type_ops->init(ctrl, idx, ptr);
1402                 return 0;
1403         }
1404
1405         switch (ctrl->type) {
1406         case V4L2_CTRL_TYPE_INTEGER64:
1407                 *ptr.p_s64 = c->value64;
1408                 break;
1409         case V4L2_CTRL_TYPE_STRING:
1410                 size = c->size;
1411                 if (size == 0)
1412                         return -ERANGE;
1413                 if (size > ctrl->maximum + 1)
1414                         size = ctrl->maximum + 1;
1415                 ret = copy_from_user(ptr.p_char, c->string, size) ? -EFAULT : 0;
1416                 if (!ret) {
1417                         char last = ptr.p_char[size - 1];
1418
1419                         ptr.p_char[size - 1] = 0;
1420                         /* If the string was longer than ctrl->maximum,
1421                            then return an error. */
1422                         if (strlen(ptr.p_char) == ctrl->maximum && last)
1423                                 return -ERANGE;
1424                 }
1425                 return ret;
1426         default:
1427                 *ptr.p_s32 = c->value;
1428                 break;
1429         }
1430         return 0;
1431 }
1432
1433 /* Helper function: copy the caller-provider value as the new control value */
1434 static int user_to_new(struct v4l2_ext_control *c,
1435                        struct v4l2_ctrl *ctrl)
1436 {
1437         return user_to_ptr(c, ctrl, ctrl->p_new);
1438 }
1439
1440 /* Copy the one value to another. */
1441 static void ptr_to_ptr(struct v4l2_ctrl *ctrl,
1442                        union v4l2_ctrl_ptr from, union v4l2_ctrl_ptr to)
1443 {
1444         if (ctrl == NULL)
1445                 return;
1446         memcpy(to.p, from.p, ctrl->elems * ctrl->elem_size);
1447 }
1448
1449 /* Copy the new value to the current value. */
1450 static void new_to_cur(struct v4l2_fh *fh, struct v4l2_ctrl *ctrl, u32 ch_flags)
1451 {
1452         bool changed;
1453
1454         if (ctrl == NULL)
1455                 return;
1456
1457         /* has_changed is set by cluster_changed */
1458         changed = ctrl->has_changed;
1459         if (changed)
1460                 ptr_to_ptr(ctrl, ctrl->p_new, ctrl->p_cur);
1461
1462         if (ch_flags & V4L2_EVENT_CTRL_CH_FLAGS) {
1463                 /* Note: CH_FLAGS is only set for auto clusters. */
1464                 ctrl->flags &=
1465                         ~(V4L2_CTRL_FLAG_INACTIVE | V4L2_CTRL_FLAG_VOLATILE);
1466                 if (!is_cur_manual(ctrl->cluster[0])) {
1467                         ctrl->flags |= V4L2_CTRL_FLAG_INACTIVE;
1468                         if (ctrl->cluster[0]->has_volatiles)
1469                                 ctrl->flags |= V4L2_CTRL_FLAG_VOLATILE;
1470                 }
1471                 fh = NULL;
1472         }
1473         if (changed || ch_flags) {
1474                 /* If a control was changed that was not one of the controls
1475                    modified by the application, then send the event to all. */
1476                 if (!ctrl->is_new)
1477                         fh = NULL;
1478                 send_event(fh, ctrl,
1479                         (changed ? V4L2_EVENT_CTRL_CH_VALUE : 0) | ch_flags);
1480                 if (ctrl->call_notify && changed && ctrl->handler->notify)
1481                         ctrl->handler->notify(ctrl, ctrl->handler->notify_priv);
1482         }
1483 }
1484
1485 /* Copy the current value to the new value */
1486 static void cur_to_new(struct v4l2_ctrl *ctrl)
1487 {
1488         if (ctrl == NULL)
1489                 return;
1490         ptr_to_ptr(ctrl, ctrl->p_cur, ctrl->p_new);
1491 }
1492
1493 /* Return non-zero if one or more of the controls in the cluster has a new
1494    value that differs from the current value. */
1495 static int cluster_changed(struct v4l2_ctrl *master)
1496 {
1497         bool changed = false;
1498         unsigned idx;
1499         int i;
1500
1501         for (i = 0; i < master->ncontrols; i++) {
1502                 struct v4l2_ctrl *ctrl = master->cluster[i];
1503                 bool ctrl_changed = false;
1504
1505                 if (ctrl == NULL)
1506                         continue;
1507                 for (idx = 0; !ctrl_changed && idx < ctrl->elems; idx++)
1508                         ctrl_changed = !ctrl->type_ops->equal(ctrl, idx,
1509                                 ctrl->p_cur, ctrl->p_new);
1510                 ctrl->has_changed = ctrl_changed;
1511                 changed |= ctrl->has_changed;
1512         }
1513         return changed;
1514 }
1515
1516 /* Control range checking */
1517 static int check_range(enum v4l2_ctrl_type type,
1518                 s64 min, s64 max, u64 step, s64 def)
1519 {
1520         switch (type) {
1521         case V4L2_CTRL_TYPE_BOOLEAN:
1522                 if (step != 1 || max > 1 || min < 0)
1523                         return -ERANGE;
1524                 /* fall through */
1525         case V4L2_CTRL_TYPE_U8:
1526         case V4L2_CTRL_TYPE_U16:
1527         case V4L2_CTRL_TYPE_INTEGER:
1528         case V4L2_CTRL_TYPE_INTEGER64:
1529                 if (step == 0 || min > max || def < min || def > max)
1530                         return -ERANGE;
1531                 return 0;
1532         case V4L2_CTRL_TYPE_BITMASK:
1533                 if (step || min || !max || (def & ~max))
1534                         return -ERANGE;
1535                 return 0;
1536         case V4L2_CTRL_TYPE_MENU:
1537         case V4L2_CTRL_TYPE_INTEGER_MENU:
1538                 if (min > max || def < min || def > max)
1539                         return -ERANGE;
1540                 /* Note: step == menu_skip_mask for menu controls.
1541                    So here we check if the default value is masked out. */
1542                 if (step && ((1 << def) & step))
1543                         return -EINVAL;
1544                 return 0;
1545         case V4L2_CTRL_TYPE_STRING:
1546                 if (min > max || min < 0 || step < 1 || def)
1547                         return -ERANGE;
1548                 return 0;
1549         default:
1550                 return 0;
1551         }
1552 }
1553
1554 /* Validate a new control */
1555 static int validate_new(const struct v4l2_ctrl *ctrl,
1556                         struct v4l2_ext_control *c)
1557 {
1558         union v4l2_ctrl_ptr ptr;
1559         unsigned idx;
1560         int err = 0;
1561
1562         if (!ctrl->is_ptr) {
1563                 switch (ctrl->type) {
1564                 case V4L2_CTRL_TYPE_INTEGER:
1565                 case V4L2_CTRL_TYPE_INTEGER_MENU:
1566                 case V4L2_CTRL_TYPE_MENU:
1567                 case V4L2_CTRL_TYPE_BITMASK:
1568                 case V4L2_CTRL_TYPE_BOOLEAN:
1569                 case V4L2_CTRL_TYPE_BUTTON:
1570                 case V4L2_CTRL_TYPE_CTRL_CLASS:
1571                         ptr.p_s32 = &c->value;
1572                         return ctrl->type_ops->validate(ctrl, 0, ptr);
1573
1574                 case V4L2_CTRL_TYPE_INTEGER64:
1575                         ptr.p_s64 = &c->value64;
1576                         return ctrl->type_ops->validate(ctrl, 0, ptr);
1577                 default:
1578                         break;
1579                 }
1580         }
1581         ptr.p = c->ptr;
1582         for (idx = 0; !err && idx < c->size / ctrl->elem_size; idx++)
1583                 err = ctrl->type_ops->validate(ctrl, idx, ptr);
1584         return err;
1585 }
1586
1587 static inline u32 node2id(struct list_head *node)
1588 {
1589         return list_entry(node, struct v4l2_ctrl_ref, node)->ctrl->id;
1590 }
1591
1592 /* Set the handler's error code if it wasn't set earlier already */
1593 static inline int handler_set_err(struct v4l2_ctrl_handler *hdl, int err)
1594 {
1595         if (hdl->error == 0)
1596                 hdl->error = err;
1597         return err;
1598 }
1599
1600 /* Initialize the handler */
1601 int v4l2_ctrl_handler_init_class(struct v4l2_ctrl_handler *hdl,
1602                                  unsigned nr_of_controls_hint,
1603                                  struct lock_class_key *key, const char *name)
1604 {
1605         hdl->lock = &hdl->_lock;
1606         mutex_init(hdl->lock);
1607         lockdep_set_class_and_name(hdl->lock, key, name);
1608         INIT_LIST_HEAD(&hdl->ctrls);
1609         INIT_LIST_HEAD(&hdl->ctrl_refs);
1610         hdl->nr_of_buckets = 1 + nr_of_controls_hint / 8;
1611         hdl->buckets = kcalloc(hdl->nr_of_buckets, sizeof(hdl->buckets[0]),
1612                                GFP_KERNEL);
1613         hdl->error = hdl->buckets ? 0 : -ENOMEM;
1614         return hdl->error;
1615 }
1616 EXPORT_SYMBOL(v4l2_ctrl_handler_init_class);
1617
1618 /* Free all controls and control refs */
1619 void v4l2_ctrl_handler_free(struct v4l2_ctrl_handler *hdl)
1620 {
1621         struct v4l2_ctrl_ref *ref, *next_ref;
1622         struct v4l2_ctrl *ctrl, *next_ctrl;
1623         struct v4l2_subscribed_event *sev, *next_sev;
1624
1625         if (hdl == NULL || hdl->buckets == NULL)
1626                 return;
1627
1628         mutex_lock(hdl->lock);
1629         /* Free all nodes */
1630         list_for_each_entry_safe(ref, next_ref, &hdl->ctrl_refs, node) {
1631                 list_del(&ref->node);
1632                 kfree(ref);
1633         }
1634         /* Free all controls owned by the handler */
1635         list_for_each_entry_safe(ctrl, next_ctrl, &hdl->ctrls, node) {
1636                 list_del(&ctrl->node);
1637                 list_for_each_entry_safe(sev, next_sev, &ctrl->ev_subs, node)
1638                         list_del(&sev->node);
1639                 kfree(ctrl);
1640         }
1641         kfree(hdl->buckets);
1642         hdl->buckets = NULL;
1643         hdl->cached = NULL;
1644         hdl->error = 0;
1645         mutex_unlock(hdl->lock);
1646 }
1647 EXPORT_SYMBOL(v4l2_ctrl_handler_free);
1648
1649 /* For backwards compatibility: V4L2_CID_PRIVATE_BASE should no longer
1650    be used except in G_CTRL, S_CTRL, QUERYCTRL and QUERYMENU when dealing
1651    with applications that do not use the NEXT_CTRL flag.
1652
1653    We just find the n-th private user control. It's O(N), but that should not
1654    be an issue in this particular case. */
1655 static struct v4l2_ctrl_ref *find_private_ref(
1656                 struct v4l2_ctrl_handler *hdl, u32 id)
1657 {
1658         struct v4l2_ctrl_ref *ref;
1659
1660         id -= V4L2_CID_PRIVATE_BASE;
1661         list_for_each_entry(ref, &hdl->ctrl_refs, node) {
1662                 /* Search for private user controls that are compatible with
1663                    VIDIOC_G/S_CTRL. */
1664                 if (V4L2_CTRL_ID2CLASS(ref->ctrl->id) == V4L2_CTRL_CLASS_USER &&
1665                     V4L2_CTRL_DRIVER_PRIV(ref->ctrl->id)) {
1666                         if (!ref->ctrl->is_int)
1667                                 continue;
1668                         if (id == 0)
1669                                 return ref;
1670                         id--;
1671                 }
1672         }
1673         return NULL;
1674 }
1675
1676 /* Find a control with the given ID. */
1677 static struct v4l2_ctrl_ref *find_ref(struct v4l2_ctrl_handler *hdl, u32 id)
1678 {
1679         struct v4l2_ctrl_ref *ref;
1680         int bucket;
1681
1682         id &= V4L2_CTRL_ID_MASK;
1683
1684         /* Old-style private controls need special handling */
1685         if (id >= V4L2_CID_PRIVATE_BASE)
1686                 return find_private_ref(hdl, id);
1687         bucket = id % hdl->nr_of_buckets;
1688
1689         /* Simple optimization: cache the last control found */
1690         if (hdl->cached && hdl->cached->ctrl->id == id)
1691                 return hdl->cached;
1692
1693         /* Not in cache, search the hash */
1694         ref = hdl->buckets ? hdl->buckets[bucket] : NULL;
1695         while (ref && ref->ctrl->id != id)
1696                 ref = ref->next;
1697
1698         if (ref)
1699                 hdl->cached = ref; /* cache it! */
1700         return ref;
1701 }
1702
1703 /* Find a control with the given ID. Take the handler's lock first. */
1704 static struct v4l2_ctrl_ref *find_ref_lock(
1705                 struct v4l2_ctrl_handler *hdl, u32 id)
1706 {
1707         struct v4l2_ctrl_ref *ref = NULL;
1708
1709         if (hdl) {
1710                 mutex_lock(hdl->lock);
1711                 ref = find_ref(hdl, id);
1712                 mutex_unlock(hdl->lock);
1713         }
1714         return ref;
1715 }
1716
1717 /* Find a control with the given ID. */
1718 struct v4l2_ctrl *v4l2_ctrl_find(struct v4l2_ctrl_handler *hdl, u32 id)
1719 {
1720         struct v4l2_ctrl_ref *ref = find_ref_lock(hdl, id);
1721
1722         return ref ? ref->ctrl : NULL;
1723 }
1724 EXPORT_SYMBOL(v4l2_ctrl_find);
1725
1726 /* Allocate a new v4l2_ctrl_ref and hook it into the handler. */
1727 static int handler_new_ref(struct v4l2_ctrl_handler *hdl,
1728                            struct v4l2_ctrl *ctrl)
1729 {
1730         struct v4l2_ctrl_ref *ref;
1731         struct v4l2_ctrl_ref *new_ref;
1732         u32 id = ctrl->id;
1733         u32 class_ctrl = V4L2_CTRL_ID2CLASS(id) | 1;
1734         int bucket = id % hdl->nr_of_buckets;   /* which bucket to use */
1735
1736         /*
1737          * Automatically add the control class if it is not yet present and
1738          * the new control is not a compound control.
1739          */
1740         if (ctrl->type < V4L2_CTRL_COMPOUND_TYPES &&
1741             id != class_ctrl && find_ref_lock(hdl, class_ctrl) == NULL)
1742                 if (!v4l2_ctrl_new_std(hdl, NULL, class_ctrl, 0, 0, 0, 0))
1743                         return hdl->error;
1744
1745         if (hdl->error)
1746                 return hdl->error;
1747
1748         new_ref = kzalloc(sizeof(*new_ref), GFP_KERNEL);
1749         if (!new_ref)
1750                 return handler_set_err(hdl, -ENOMEM);
1751         new_ref->ctrl = ctrl;
1752         if (ctrl->handler == hdl) {
1753                 /* By default each control starts in a cluster of its own.
1754                    new_ref->ctrl is basically a cluster array with one
1755                    element, so that's perfect to use as the cluster pointer.
1756                    But only do this for the handler that owns the control. */
1757                 ctrl->cluster = &new_ref->ctrl;
1758                 ctrl->ncontrols = 1;
1759         }
1760
1761         INIT_LIST_HEAD(&new_ref->node);
1762
1763         mutex_lock(hdl->lock);
1764
1765         /* Add immediately at the end of the list if the list is empty, or if
1766            the last element in the list has a lower ID.
1767            This ensures that when elements are added in ascending order the
1768            insertion is an O(1) operation. */
1769         if (list_empty(&hdl->ctrl_refs) || id > node2id(hdl->ctrl_refs.prev)) {
1770                 list_add_tail(&new_ref->node, &hdl->ctrl_refs);
1771                 goto insert_in_hash;
1772         }
1773
1774         /* Find insert position in sorted list */
1775         list_for_each_entry(ref, &hdl->ctrl_refs, node) {
1776                 if (ref->ctrl->id < id)
1777                         continue;
1778                 /* Don't add duplicates */
1779                 if (ref->ctrl->id == id) {
1780                         kfree(new_ref);
1781                         goto unlock;
1782                 }
1783                 list_add(&new_ref->node, ref->node.prev);
1784                 break;
1785         }
1786
1787 insert_in_hash:
1788         /* Insert the control node in the hash */
1789         new_ref->next = hdl->buckets[bucket];
1790         hdl->buckets[bucket] = new_ref;
1791
1792 unlock:
1793         mutex_unlock(hdl->lock);
1794         return 0;
1795 }
1796
1797 /* Add a new control */
1798 static struct v4l2_ctrl *v4l2_ctrl_new(struct v4l2_ctrl_handler *hdl,
1799                         const struct v4l2_ctrl_ops *ops,
1800                         const struct v4l2_ctrl_type_ops *type_ops,
1801                         u32 id, const char *name, enum v4l2_ctrl_type type,
1802                         s64 min, s64 max, u64 step, s64 def,
1803                         const u32 dims[V4L2_CTRL_MAX_DIMS], u32 elem_size,
1804                         u32 flags, const char * const *qmenu,
1805                         const s64 *qmenu_int, void *priv)
1806 {
1807         struct v4l2_ctrl *ctrl;
1808         unsigned sz_extra;
1809         unsigned nr_of_dims = 0;
1810         unsigned elems = 1;
1811         bool is_array;
1812         unsigned tot_ctrl_size;
1813         unsigned idx;
1814         void *data;
1815         int err;
1816
1817         if (hdl->error)
1818                 return NULL;
1819
1820         while (dims && dims[nr_of_dims]) {
1821                 elems *= dims[nr_of_dims];
1822                 nr_of_dims++;
1823                 if (nr_of_dims == V4L2_CTRL_MAX_DIMS)
1824                         break;
1825         }
1826         is_array = nr_of_dims > 0;
1827
1828         /* Prefill elem_size for all types handled by std_type_ops */
1829         switch (type) {
1830         case V4L2_CTRL_TYPE_INTEGER64:
1831                 elem_size = sizeof(s64);
1832                 break;
1833         case V4L2_CTRL_TYPE_STRING:
1834                 elem_size = max + 1;
1835                 break;
1836         case V4L2_CTRL_TYPE_U8:
1837                 elem_size = sizeof(u8);
1838                 break;
1839         case V4L2_CTRL_TYPE_U16:
1840                 elem_size = sizeof(u16);
1841                 break;
1842         default:
1843                 if (type < V4L2_CTRL_COMPOUND_TYPES)
1844                         elem_size = sizeof(s32);
1845                 break;
1846         }
1847         tot_ctrl_size = elem_size * elems;
1848
1849         /* Sanity checks */
1850         if (id == 0 || name == NULL || !elem_size ||
1851             id >= V4L2_CID_PRIVATE_BASE ||
1852             (type == V4L2_CTRL_TYPE_MENU && qmenu == NULL) ||
1853             (type == V4L2_CTRL_TYPE_INTEGER_MENU && qmenu_int == NULL)) {
1854                 handler_set_err(hdl, -ERANGE);
1855                 return NULL;
1856         }
1857         err = check_range(type, min, max, step, def);
1858         if (err) {
1859                 handler_set_err(hdl, err);
1860                 return NULL;
1861         }
1862         if (type == V4L2_CTRL_TYPE_BITMASK && ((def & ~max) || min || step)) {
1863                 handler_set_err(hdl, -ERANGE);
1864                 return NULL;
1865         }
1866         if (is_array &&
1867             (type == V4L2_CTRL_TYPE_BUTTON ||
1868              type == V4L2_CTRL_TYPE_CTRL_CLASS)) {
1869                 handler_set_err(hdl, -EINVAL);
1870                 return NULL;
1871         }
1872
1873         sz_extra = 0;
1874         if (type == V4L2_CTRL_TYPE_BUTTON)
1875                 flags |= V4L2_CTRL_FLAG_WRITE_ONLY;
1876         else if (type == V4L2_CTRL_TYPE_CTRL_CLASS)
1877                 flags |= V4L2_CTRL_FLAG_READ_ONLY;
1878         else if (type == V4L2_CTRL_TYPE_INTEGER64 ||
1879                  type == V4L2_CTRL_TYPE_STRING ||
1880                  type >= V4L2_CTRL_COMPOUND_TYPES ||
1881                  is_array)
1882                 sz_extra += 2 * tot_ctrl_size;
1883
1884         ctrl = kzalloc(sizeof(*ctrl) + sz_extra, GFP_KERNEL);
1885         if (ctrl == NULL) {
1886                 handler_set_err(hdl, -ENOMEM);
1887                 return NULL;
1888         }
1889
1890         INIT_LIST_HEAD(&ctrl->node);
1891         INIT_LIST_HEAD(&ctrl->ev_subs);
1892         ctrl->handler = hdl;
1893         ctrl->ops = ops;
1894         ctrl->type_ops = type_ops ? type_ops : &std_type_ops;
1895         ctrl->id = id;
1896         ctrl->name = name;
1897         ctrl->type = type;
1898         ctrl->flags = flags;
1899         ctrl->minimum = min;
1900         ctrl->maximum = max;
1901         ctrl->step = step;
1902         ctrl->default_value = def;
1903         ctrl->is_string = !is_array && type == V4L2_CTRL_TYPE_STRING;
1904         ctrl->is_ptr = is_array || type >= V4L2_CTRL_COMPOUND_TYPES || ctrl->is_string;
1905         ctrl->is_int = !ctrl->is_ptr && type != V4L2_CTRL_TYPE_INTEGER64;
1906         ctrl->is_array = is_array;
1907         ctrl->elems = elems;
1908         ctrl->nr_of_dims = nr_of_dims;
1909         if (nr_of_dims)
1910                 memcpy(ctrl->dims, dims, nr_of_dims * sizeof(dims[0]));
1911         ctrl->elem_size = elem_size;
1912         if (type == V4L2_CTRL_TYPE_MENU)
1913                 ctrl->qmenu = qmenu;
1914         else if (type == V4L2_CTRL_TYPE_INTEGER_MENU)
1915                 ctrl->qmenu_int = qmenu_int;
1916         ctrl->priv = priv;
1917         ctrl->cur.val = ctrl->val = def;
1918         data = &ctrl[1];
1919
1920         if (!ctrl->is_int) {
1921                 ctrl->p_new.p = data;
1922                 ctrl->p_cur.p = data + tot_ctrl_size;
1923         } else {
1924                 ctrl->p_new.p = &ctrl->val;
1925                 ctrl->p_cur.p = &ctrl->cur.val;
1926         }
1927         for (idx = 0; idx < elems; idx++) {
1928                 ctrl->type_ops->init(ctrl, idx, ctrl->p_cur);
1929                 ctrl->type_ops->init(ctrl, idx, ctrl->p_new);
1930         }
1931
1932         if (handler_new_ref(hdl, ctrl)) {
1933                 kfree(ctrl);
1934                 return NULL;
1935         }
1936         mutex_lock(hdl->lock);
1937         list_add_tail(&ctrl->node, &hdl->ctrls);
1938         mutex_unlock(hdl->lock);
1939         return ctrl;
1940 }
1941
1942 struct v4l2_ctrl *v4l2_ctrl_new_custom(struct v4l2_ctrl_handler *hdl,
1943                         const struct v4l2_ctrl_config *cfg, void *priv)
1944 {
1945         bool is_menu;
1946         struct v4l2_ctrl *ctrl;
1947         const char *name = cfg->name;
1948         const char * const *qmenu = cfg->qmenu;
1949         const s64 *qmenu_int = cfg->qmenu_int;
1950         enum v4l2_ctrl_type type = cfg->type;
1951         u32 flags = cfg->flags;
1952         s64 min = cfg->min;
1953         s64 max = cfg->max;
1954         u64 step = cfg->step;
1955         s64 def = cfg->def;
1956
1957         if (name == NULL)
1958                 v4l2_ctrl_fill(cfg->id, &name, &type, &min, &max, &step,
1959                                                                 &def, &flags);
1960
1961         is_menu = (cfg->type == V4L2_CTRL_TYPE_MENU ||
1962                    cfg->type == V4L2_CTRL_TYPE_INTEGER_MENU);
1963         if (is_menu)
1964                 WARN_ON(step);
1965         else
1966                 WARN_ON(cfg->menu_skip_mask);
1967         if (cfg->type == V4L2_CTRL_TYPE_MENU && qmenu == NULL)
1968                 qmenu = v4l2_ctrl_get_menu(cfg->id);
1969         else if (cfg->type == V4L2_CTRL_TYPE_INTEGER_MENU &&
1970                  qmenu_int == NULL) {
1971                 handler_set_err(hdl, -EINVAL);
1972                 return NULL;
1973         }
1974
1975         ctrl = v4l2_ctrl_new(hdl, cfg->ops, cfg->type_ops, cfg->id, name,
1976                         type, min, max,
1977                         is_menu ? cfg->menu_skip_mask : step, def,
1978                         cfg->dims, cfg->elem_size,
1979                         flags, qmenu, qmenu_int, priv);
1980         if (ctrl)
1981                 ctrl->is_private = cfg->is_private;
1982         return ctrl;
1983 }
1984 EXPORT_SYMBOL(v4l2_ctrl_new_custom);
1985
1986 /* Helper function for standard non-menu controls */
1987 struct v4l2_ctrl *v4l2_ctrl_new_std(struct v4l2_ctrl_handler *hdl,
1988                         const struct v4l2_ctrl_ops *ops,
1989                         u32 id, s64 min, s64 max, u64 step, s64 def)
1990 {
1991         const char *name;
1992         enum v4l2_ctrl_type type;
1993         u32 flags;
1994
1995         v4l2_ctrl_fill(id, &name, &type, &min, &max, &step, &def, &flags);
1996         if (type == V4L2_CTRL_TYPE_MENU ||
1997             type == V4L2_CTRL_TYPE_INTEGER_MENU ||
1998             type >= V4L2_CTRL_COMPOUND_TYPES) {
1999                 handler_set_err(hdl, -EINVAL);
2000                 return NULL;
2001         }
2002         return v4l2_ctrl_new(hdl, ops, NULL, id, name, type,
2003                              min, max, step, def, NULL, 0,
2004                              flags, NULL, NULL, NULL);
2005 }
2006 EXPORT_SYMBOL(v4l2_ctrl_new_std);
2007
2008 /* Helper function for standard menu controls */
2009 struct v4l2_ctrl *v4l2_ctrl_new_std_menu(struct v4l2_ctrl_handler *hdl,
2010                         const struct v4l2_ctrl_ops *ops,
2011                         u32 id, u8 _max, u64 mask, u8 _def)
2012 {
2013         const char * const *qmenu = NULL;
2014         const s64 *qmenu_int = NULL;
2015         unsigned int qmenu_int_len = 0;
2016         const char *name;
2017         enum v4l2_ctrl_type type;
2018         s64 min;
2019         s64 max = _max;
2020         s64 def = _def;
2021         u64 step;
2022         u32 flags;
2023
2024         v4l2_ctrl_fill(id, &name, &type, &min, &max, &step, &def, &flags);
2025
2026         if (type == V4L2_CTRL_TYPE_MENU)
2027                 qmenu = v4l2_ctrl_get_menu(id);
2028         else if (type == V4L2_CTRL_TYPE_INTEGER_MENU)
2029                 qmenu_int = v4l2_ctrl_get_int_menu(id, &qmenu_int_len);
2030
2031         if ((!qmenu && !qmenu_int) || (qmenu_int && max > qmenu_int_len)) {
2032                 handler_set_err(hdl, -EINVAL);
2033                 return NULL;
2034         }
2035         return v4l2_ctrl_new(hdl, ops, NULL, id, name, type,
2036                              0, max, mask, def, NULL, 0,
2037                              flags, qmenu, qmenu_int, NULL);
2038 }
2039 EXPORT_SYMBOL(v4l2_ctrl_new_std_menu);
2040
2041 /* Helper function for standard menu controls with driver defined menu */
2042 struct v4l2_ctrl *v4l2_ctrl_new_std_menu_items(struct v4l2_ctrl_handler *hdl,
2043                         const struct v4l2_ctrl_ops *ops, u32 id, u8 _max,
2044                         u64 mask, u8 _def, const char * const *qmenu)
2045 {
2046         enum v4l2_ctrl_type type;
2047         const char *name;
2048         u32 flags;
2049         u64 step;
2050         s64 min;
2051         s64 max = _max;
2052         s64 def = _def;
2053
2054         /* v4l2_ctrl_new_std_menu_items() should only be called for
2055          * standard controls without a standard menu.
2056          */
2057         if (v4l2_ctrl_get_menu(id)) {
2058                 handler_set_err(hdl, -EINVAL);
2059                 return NULL;
2060         }
2061
2062         v4l2_ctrl_fill(id, &name, &type, &min, &max, &step, &def, &flags);
2063         if (type != V4L2_CTRL_TYPE_MENU || qmenu == NULL) {
2064                 handler_set_err(hdl, -EINVAL);
2065                 return NULL;
2066         }
2067         return v4l2_ctrl_new(hdl, ops, NULL, id, name, type,
2068                              0, max, mask, def, NULL, 0,
2069                              flags, qmenu, NULL, NULL);
2070
2071 }
2072 EXPORT_SYMBOL(v4l2_ctrl_new_std_menu_items);
2073
2074 /* Helper function for standard integer menu controls */
2075 struct v4l2_ctrl *v4l2_ctrl_new_int_menu(struct v4l2_ctrl_handler *hdl,
2076                         const struct v4l2_ctrl_ops *ops,
2077                         u32 id, u8 _max, u8 _def, const s64 *qmenu_int)
2078 {
2079         const char *name;
2080         enum v4l2_ctrl_type type;
2081         s64 min;
2082         u64 step;
2083         s64 max = _max;
2084         s64 def = _def;
2085         u32 flags;
2086
2087         v4l2_ctrl_fill(id, &name, &type, &min, &max, &step, &def, &flags);
2088         if (type != V4L2_CTRL_TYPE_INTEGER_MENU) {
2089                 handler_set_err(hdl, -EINVAL);
2090                 return NULL;
2091         }
2092         return v4l2_ctrl_new(hdl, ops, NULL, id, name, type,
2093                              0, max, 0, def, NULL, 0,
2094                              flags, NULL, qmenu_int, NULL);
2095 }
2096 EXPORT_SYMBOL(v4l2_ctrl_new_int_menu);
2097
2098 /* Add a control from another handler to this handler */
2099 struct v4l2_ctrl *v4l2_ctrl_add_ctrl(struct v4l2_ctrl_handler *hdl,
2100                                           struct v4l2_ctrl *ctrl)
2101 {
2102         if (hdl == NULL || hdl->error)
2103                 return NULL;
2104         if (ctrl == NULL) {
2105                 handler_set_err(hdl, -EINVAL);
2106                 return NULL;
2107         }
2108         if (ctrl->handler == hdl)
2109                 return ctrl;
2110         return handler_new_ref(hdl, ctrl) ? NULL : ctrl;
2111 }
2112 EXPORT_SYMBOL(v4l2_ctrl_add_ctrl);
2113
2114 /* Add the controls from another handler to our own. */
2115 int v4l2_ctrl_add_handler(struct v4l2_ctrl_handler *hdl,
2116                           struct v4l2_ctrl_handler *add,
2117                           bool (*filter)(const struct v4l2_ctrl *ctrl))
2118 {
2119         struct v4l2_ctrl_ref *ref;
2120         int ret = 0;
2121
2122         /* Do nothing if either handler is NULL or if they are the same */
2123         if (!hdl || !add || hdl == add)
2124                 return 0;
2125         if (hdl->error)
2126                 return hdl->error;
2127         mutex_lock(add->lock);
2128         list_for_each_entry(ref, &add->ctrl_refs, node) {
2129                 struct v4l2_ctrl *ctrl = ref->ctrl;
2130
2131                 /* Skip handler-private controls. */
2132                 if (ctrl->is_private)
2133                         continue;
2134                 /* And control classes */
2135                 if (ctrl->type == V4L2_CTRL_TYPE_CTRL_CLASS)
2136                         continue;
2137                 /* Filter any unwanted controls */
2138                 if (filter && !filter(ctrl))
2139                         continue;
2140                 ret = handler_new_ref(hdl, ctrl);
2141                 if (ret)
2142                         break;
2143         }
2144         mutex_unlock(add->lock);
2145         return ret;
2146 }
2147 EXPORT_SYMBOL(v4l2_ctrl_add_handler);
2148
2149 bool v4l2_ctrl_radio_filter(const struct v4l2_ctrl *ctrl)
2150 {
2151         if (V4L2_CTRL_ID2CLASS(ctrl->id) == V4L2_CTRL_CLASS_FM_TX)
2152                 return true;
2153         if (V4L2_CTRL_ID2CLASS(ctrl->id) == V4L2_CTRL_CLASS_FM_RX)
2154                 return true;
2155         switch (ctrl->id) {
2156         case V4L2_CID_AUDIO_MUTE:
2157         case V4L2_CID_AUDIO_VOLUME:
2158         case V4L2_CID_AUDIO_BALANCE:
2159         case V4L2_CID_AUDIO_BASS:
2160         case V4L2_CID_AUDIO_TREBLE:
2161         case V4L2_CID_AUDIO_LOUDNESS:
2162                 return true;
2163         default:
2164                 break;
2165         }
2166         return false;
2167 }
2168 EXPORT_SYMBOL(v4l2_ctrl_radio_filter);
2169
2170 /* Cluster controls */
2171 void v4l2_ctrl_cluster(unsigned ncontrols, struct v4l2_ctrl **controls)
2172 {
2173         bool has_volatiles = false;
2174         int i;
2175
2176         /* The first control is the master control and it must not be NULL */
2177         if (WARN_ON(ncontrols == 0 || controls[0] == NULL))
2178                 return;
2179
2180         for (i = 0; i < ncontrols; i++) {
2181                 if (controls[i]) {
2182                         controls[i]->cluster = controls;
2183                         controls[i]->ncontrols = ncontrols;
2184                         if (controls[i]->flags & V4L2_CTRL_FLAG_VOLATILE)
2185                                 has_volatiles = true;
2186                 }
2187         }
2188         controls[0]->has_volatiles = has_volatiles;
2189 }
2190 EXPORT_SYMBOL(v4l2_ctrl_cluster);
2191
2192 void v4l2_ctrl_auto_cluster(unsigned ncontrols, struct v4l2_ctrl **controls,
2193                             u8 manual_val, bool set_volatile)
2194 {
2195         struct v4l2_ctrl *master = controls[0];
2196         u32 flag = 0;
2197         int i;
2198
2199         v4l2_ctrl_cluster(ncontrols, controls);
2200         WARN_ON(ncontrols <= 1);
2201         WARN_ON(manual_val < master->minimum || manual_val > master->maximum);
2202         WARN_ON(set_volatile && !has_op(master, g_volatile_ctrl));
2203         master->is_auto = true;
2204         master->has_volatiles = set_volatile;
2205         master->manual_mode_value = manual_val;
2206         master->flags |= V4L2_CTRL_FLAG_UPDATE;
2207
2208         if (!is_cur_manual(master))
2209                 flag = V4L2_CTRL_FLAG_INACTIVE |
2210                         (set_volatile ? V4L2_CTRL_FLAG_VOLATILE : 0);
2211
2212         for (i = 1; i < ncontrols; i++)
2213                 if (controls[i])
2214                         controls[i]->flags |= flag;
2215 }
2216 EXPORT_SYMBOL(v4l2_ctrl_auto_cluster);
2217
2218 /* Activate/deactivate a control. */
2219 void v4l2_ctrl_activate(struct v4l2_ctrl *ctrl, bool active)
2220 {
2221         /* invert since the actual flag is called 'inactive' */
2222         bool inactive = !active;
2223         bool old;
2224
2225         if (ctrl == NULL)
2226                 return;
2227
2228         if (inactive)
2229                 /* set V4L2_CTRL_FLAG_INACTIVE */
2230                 old = test_and_set_bit(4, &ctrl->flags);
2231         else
2232                 /* clear V4L2_CTRL_FLAG_INACTIVE */
2233                 old = test_and_clear_bit(4, &ctrl->flags);
2234         if (old != inactive)
2235                 send_event(NULL, ctrl, V4L2_EVENT_CTRL_CH_FLAGS);
2236 }
2237 EXPORT_SYMBOL(v4l2_ctrl_activate);
2238
2239 /* Grab/ungrab a control.
2240    Typically used when streaming starts and you want to grab controls,
2241    preventing the user from changing them.
2242
2243    Just call this and the framework will block any attempts to change
2244    these controls. */
2245 void v4l2_ctrl_grab(struct v4l2_ctrl *ctrl, bool grabbed)
2246 {
2247         bool old;
2248
2249         if (ctrl == NULL)
2250                 return;
2251
2252         v4l2_ctrl_lock(ctrl);
2253         if (grabbed)
2254                 /* set V4L2_CTRL_FLAG_GRABBED */
2255                 old = test_and_set_bit(1, &ctrl->flags);
2256         else
2257                 /* clear V4L2_CTRL_FLAG_GRABBED */
2258                 old = test_and_clear_bit(1, &ctrl->flags);
2259         if (old != grabbed)
2260                 send_event(NULL, ctrl, V4L2_EVENT_CTRL_CH_FLAGS);
2261         v4l2_ctrl_unlock(ctrl);
2262 }
2263 EXPORT_SYMBOL(v4l2_ctrl_grab);
2264
2265 /* Log the control name and value */
2266 static void log_ctrl(const struct v4l2_ctrl *ctrl,
2267                      const char *prefix, const char *colon)
2268 {
2269         if (ctrl->flags & (V4L2_CTRL_FLAG_DISABLED | V4L2_CTRL_FLAG_WRITE_ONLY))
2270                 return;
2271         if (ctrl->type == V4L2_CTRL_TYPE_CTRL_CLASS)
2272                 return;
2273
2274         pr_info("%s%s%s: ", prefix, colon, ctrl->name);
2275
2276         ctrl->type_ops->log(ctrl);
2277
2278         if (ctrl->flags & (V4L2_CTRL_FLAG_INACTIVE |
2279                            V4L2_CTRL_FLAG_GRABBED |
2280                            V4L2_CTRL_FLAG_VOLATILE)) {
2281                 if (ctrl->flags & V4L2_CTRL_FLAG_INACTIVE)
2282                         pr_cont(" inactive");
2283                 if (ctrl->flags & V4L2_CTRL_FLAG_GRABBED)
2284                         pr_cont(" grabbed");
2285                 if (ctrl->flags & V4L2_CTRL_FLAG_VOLATILE)
2286                         pr_cont(" volatile");
2287         }
2288         pr_cont("\n");
2289 }
2290
2291 /* Log all controls owned by the handler */
2292 void v4l2_ctrl_handler_log_status(struct v4l2_ctrl_handler *hdl,
2293                                   const char *prefix)
2294 {
2295         struct v4l2_ctrl *ctrl;
2296         const char *colon = "";
2297         int len;
2298
2299         if (hdl == NULL)
2300                 return;
2301         if (prefix == NULL)
2302                 prefix = "";
2303         len = strlen(prefix);
2304         if (len && prefix[len - 1] != ' ')
2305                 colon = ": ";
2306         mutex_lock(hdl->lock);
2307         list_for_each_entry(ctrl, &hdl->ctrls, node)
2308                 if (!(ctrl->flags & V4L2_CTRL_FLAG_DISABLED))
2309                         log_ctrl(ctrl, prefix, colon);
2310         mutex_unlock(hdl->lock);
2311 }
2312 EXPORT_SYMBOL(v4l2_ctrl_handler_log_status);
2313
2314 int v4l2_ctrl_subdev_log_status(struct v4l2_subdev *sd)
2315 {
2316         v4l2_ctrl_handler_log_status(sd->ctrl_handler, sd->name);
2317         return 0;
2318 }
2319 EXPORT_SYMBOL(v4l2_ctrl_subdev_log_status);
2320
2321 /* Call s_ctrl for all controls owned by the handler */
2322 int v4l2_ctrl_handler_setup(struct v4l2_ctrl_handler *hdl)
2323 {
2324         struct v4l2_ctrl *ctrl;
2325         int ret = 0;
2326
2327         if (hdl == NULL)
2328                 return 0;
2329         mutex_lock(hdl->lock);
2330         list_for_each_entry(ctrl, &hdl->ctrls, node)
2331                 ctrl->done = false;
2332
2333         list_for_each_entry(ctrl, &hdl->ctrls, node) {
2334                 struct v4l2_ctrl *master = ctrl->cluster[0];
2335                 int i;
2336
2337                 /* Skip if this control was already handled by a cluster. */
2338                 /* Skip button controls and read-only controls. */
2339                 if (ctrl->done || ctrl->type == V4L2_CTRL_TYPE_BUTTON ||
2340                     (ctrl->flags & V4L2_CTRL_FLAG_READ_ONLY))
2341                         continue;
2342
2343                 for (i = 0; i < master->ncontrols; i++) {
2344                         if (master->cluster[i]) {
2345                                 cur_to_new(master->cluster[i]);
2346                                 master->cluster[i]->is_new = 1;
2347                                 master->cluster[i]->done = true;
2348                         }
2349                 }
2350                 ret = call_op(master, s_ctrl);
2351                 if (ret)
2352                         break;
2353         }
2354         mutex_unlock(hdl->lock);
2355         return ret;
2356 }
2357 EXPORT_SYMBOL(v4l2_ctrl_handler_setup);
2358
2359 /* Implement VIDIOC_QUERY_EXT_CTRL */
2360 int v4l2_query_ext_ctrl(struct v4l2_ctrl_handler *hdl, struct v4l2_query_ext_ctrl *qc)
2361 {
2362         const unsigned next_flags = V4L2_CTRL_FLAG_NEXT_CTRL | V4L2_CTRL_FLAG_NEXT_COMPOUND;
2363         u32 id = qc->id & V4L2_CTRL_ID_MASK;
2364         struct v4l2_ctrl_ref *ref;
2365         struct v4l2_ctrl *ctrl;
2366
2367         if (hdl == NULL)
2368                 return -EINVAL;
2369
2370         mutex_lock(hdl->lock);
2371
2372         /* Try to find it */
2373         ref = find_ref(hdl, id);
2374
2375         if ((qc->id & next_flags) && !list_empty(&hdl->ctrl_refs)) {
2376                 bool is_compound;
2377                 /* Match any control that is not hidden */
2378                 unsigned mask = 1;
2379                 bool match = false;
2380
2381                 if ((qc->id & next_flags) == V4L2_CTRL_FLAG_NEXT_COMPOUND) {
2382                         /* Match any hidden control */
2383                         match = true;
2384                 } else if ((qc->id & next_flags) == next_flags) {
2385                         /* Match any control, compound or not */
2386                         mask = 0;
2387                 }
2388
2389                 /* Find the next control with ID > qc->id */
2390
2391                 /* Did we reach the end of the control list? */
2392                 if (id >= node2id(hdl->ctrl_refs.prev)) {
2393                         ref = NULL; /* Yes, so there is no next control */
2394                 } else if (ref) {
2395                         /* We found a control with the given ID, so just get
2396                            the next valid one in the list. */
2397                         list_for_each_entry_continue(ref, &hdl->ctrl_refs, node) {
2398                                 is_compound =
2399                                         ref->ctrl->type >= V4L2_CTRL_COMPOUND_TYPES;
2400                                 if (id < ref->ctrl->id &&
2401                                     (is_compound & mask) == match)
2402                                         break;
2403                         }
2404                         if (&ref->node == &hdl->ctrl_refs)
2405                                 ref = NULL;
2406                 } else {
2407                         /* No control with the given ID exists, so start
2408                            searching for the next largest ID. We know there
2409                            is one, otherwise the first 'if' above would have
2410                            been true. */
2411                         list_for_each_entry(ref, &hdl->ctrl_refs, node) {
2412                                 is_compound =
2413                                         ref->ctrl->type >= V4L2_CTRL_COMPOUND_TYPES;
2414                                 if (id < ref->ctrl->id &&
2415                                     (is_compound & mask) == match)
2416                                         break;
2417                         }
2418                         if (&ref->node == &hdl->ctrl_refs)
2419                                 ref = NULL;
2420                 }
2421         }
2422         mutex_unlock(hdl->lock);
2423
2424         if (!ref)
2425                 return -EINVAL;
2426
2427         ctrl = ref->ctrl;
2428         memset(qc, 0, sizeof(*qc));
2429         if (id >= V4L2_CID_PRIVATE_BASE)
2430                 qc->id = id;
2431         else
2432                 qc->id = ctrl->id;
2433         strlcpy(qc->name, ctrl->name, sizeof(qc->name));
2434         qc->flags = ctrl->flags;
2435         qc->type = ctrl->type;
2436         if (ctrl->is_ptr)
2437                 qc->flags |= V4L2_CTRL_FLAG_HAS_PAYLOAD;
2438         qc->elem_size = ctrl->elem_size;
2439         qc->elems = ctrl->elems;
2440         qc->nr_of_dims = ctrl->nr_of_dims;
2441         memcpy(qc->dims, ctrl->dims, qc->nr_of_dims * sizeof(qc->dims[0]));
2442         qc->minimum = ctrl->minimum;
2443         qc->maximum = ctrl->maximum;
2444         qc->default_value = ctrl->default_value;
2445         if (ctrl->type == V4L2_CTRL_TYPE_MENU
2446             || ctrl->type == V4L2_CTRL_TYPE_INTEGER_MENU)
2447                 qc->step = 1;
2448         else
2449                 qc->step = ctrl->step;
2450         return 0;
2451 }
2452 EXPORT_SYMBOL(v4l2_query_ext_ctrl);
2453
2454 /* Implement VIDIOC_QUERYCTRL */
2455 int v4l2_queryctrl(struct v4l2_ctrl_handler *hdl, struct v4l2_queryctrl *qc)
2456 {
2457         struct v4l2_query_ext_ctrl qec = { qc->id };
2458         int rc;
2459
2460         rc = v4l2_query_ext_ctrl(hdl, &qec);
2461         if (rc)
2462                 return rc;
2463
2464         qc->id = qec.id;
2465         qc->type = qec.type;
2466         qc->flags = qec.flags;
2467         strlcpy(qc->name, qec.name, sizeof(qc->name));
2468         switch (qc->type) {
2469         case V4L2_CTRL_TYPE_INTEGER:
2470         case V4L2_CTRL_TYPE_BOOLEAN:
2471         case V4L2_CTRL_TYPE_MENU:
2472         case V4L2_CTRL_TYPE_INTEGER_MENU:
2473         case V4L2_CTRL_TYPE_STRING:
2474         case V4L2_CTRL_TYPE_BITMASK:
2475                 qc->minimum = qec.minimum;
2476                 qc->maximum = qec.maximum;
2477                 qc->step = qec.step;
2478                 qc->default_value = qec.default_value;
2479                 break;
2480         default:
2481                 qc->minimum = 0;
2482                 qc->maximum = 0;
2483                 qc->step = 0;
2484                 qc->default_value = 0;
2485                 break;
2486         }
2487         return 0;
2488 }
2489 EXPORT_SYMBOL(v4l2_queryctrl);
2490
2491 int v4l2_subdev_queryctrl(struct v4l2_subdev *sd, struct v4l2_queryctrl *qc)
2492 {
2493         if (qc->id & (V4L2_CTRL_FLAG_NEXT_CTRL | V4L2_CTRL_FLAG_NEXT_COMPOUND))
2494                 return -EINVAL;
2495         return v4l2_queryctrl(sd->ctrl_handler, qc);
2496 }
2497 EXPORT_SYMBOL(v4l2_subdev_queryctrl);
2498
2499 /* Implement VIDIOC_QUERYMENU */
2500 int v4l2_querymenu(struct v4l2_ctrl_handler *hdl, struct v4l2_querymenu *qm)
2501 {
2502         struct v4l2_ctrl *ctrl;
2503         u32 i = qm->index;
2504
2505         ctrl = v4l2_ctrl_find(hdl, qm->id);
2506         if (!ctrl)
2507                 return -EINVAL;
2508
2509         qm->reserved = 0;
2510         /* Sanity checks */
2511         switch (ctrl->type) {
2512         case V4L2_CTRL_TYPE_MENU:
2513                 if (ctrl->qmenu == NULL)
2514                         return -EINVAL;
2515                 break;
2516         case V4L2_CTRL_TYPE_INTEGER_MENU:
2517                 if (ctrl->qmenu_int == NULL)
2518                         return -EINVAL;
2519                 break;
2520         default:
2521                 return -EINVAL;
2522         }
2523
2524         if (i < ctrl->minimum || i > ctrl->maximum)
2525                 return -EINVAL;
2526
2527         /* Use mask to see if this menu item should be skipped */
2528         if (ctrl->menu_skip_mask & (1 << i))
2529                 return -EINVAL;
2530         /* Empty menu items should also be skipped */
2531         if (ctrl->type == V4L2_CTRL_TYPE_MENU) {
2532                 if (ctrl->qmenu[i] == NULL || ctrl->qmenu[i][0] == '\0')
2533                         return -EINVAL;
2534                 strlcpy(qm->name, ctrl->qmenu[i], sizeof(qm->name));
2535         } else {
2536                 qm->value = ctrl->qmenu_int[i];
2537         }
2538         return 0;
2539 }
2540 EXPORT_SYMBOL(v4l2_querymenu);
2541
2542 int v4l2_subdev_querymenu(struct v4l2_subdev *sd, struct v4l2_querymenu *qm)
2543 {
2544         return v4l2_querymenu(sd->ctrl_handler, qm);
2545 }
2546 EXPORT_SYMBOL(v4l2_subdev_querymenu);
2547
2548
2549
2550 /* Some general notes on the atomic requirements of VIDIOC_G/TRY/S_EXT_CTRLS:
2551
2552    It is not a fully atomic operation, just best-effort only. After all, if
2553    multiple controls have to be set through multiple i2c writes (for example)
2554    then some initial writes may succeed while others fail. Thus leaving the
2555    system in an inconsistent state. The question is how much effort you are
2556    willing to spend on trying to make something atomic that really isn't.
2557
2558    From the point of view of an application the main requirement is that
2559    when you call VIDIOC_S_EXT_CTRLS and some values are invalid then an
2560    error should be returned without actually affecting any controls.
2561
2562    If all the values are correct, then it is acceptable to just give up
2563    in case of low-level errors.
2564
2565    It is important though that the application can tell when only a partial
2566    configuration was done. The way we do that is through the error_idx field
2567    of struct v4l2_ext_controls: if that is equal to the count field then no
2568    controls were affected. Otherwise all controls before that index were
2569    successful in performing their 'get' or 'set' operation, the control at
2570    the given index failed, and you don't know what happened with the controls
2571    after the failed one. Since if they were part of a control cluster they
2572    could have been successfully processed (if a cluster member was encountered
2573    at index < error_idx), they could have failed (if a cluster member was at
2574    error_idx), or they may not have been processed yet (if the first cluster
2575    member appeared after error_idx).
2576
2577    It is all fairly theoretical, though. In practice all you can do is to
2578    bail out. If error_idx == count, then it is an application bug. If
2579    error_idx < count then it is only an application bug if the error code was
2580    EBUSY. That usually means that something started streaming just when you
2581    tried to set the controls. In all other cases it is a driver/hardware
2582    problem and all you can do is to retry or bail out.
2583
2584    Note that these rules do not apply to VIDIOC_TRY_EXT_CTRLS: since that
2585    never modifies controls the error_idx is just set to whatever control
2586    has an invalid value.
2587  */
2588
2589 /* Prepare for the extended g/s/try functions.
2590    Find the controls in the control array and do some basic checks. */
2591 static int prepare_ext_ctrls(struct v4l2_ctrl_handler *hdl,
2592                              struct v4l2_ext_controls *cs,
2593                              struct v4l2_ctrl_helper *helpers,
2594                              bool get)
2595 {
2596         struct v4l2_ctrl_helper *h;
2597         bool have_clusters = false;
2598         u32 i;
2599
2600         for (i = 0, h = helpers; i < cs->count; i++, h++) {
2601                 struct v4l2_ext_control *c = &cs->controls[i];
2602                 struct v4l2_ctrl_ref *ref;
2603                 struct v4l2_ctrl *ctrl;
2604                 u32 id = c->id & V4L2_CTRL_ID_MASK;
2605
2606                 cs->error_idx = i;
2607
2608                 if (cs->ctrl_class && V4L2_CTRL_ID2CLASS(id) != cs->ctrl_class)
2609                         return -EINVAL;
2610
2611                 /* Old-style private controls are not allowed for
2612                    extended controls */
2613                 if (id >= V4L2_CID_PRIVATE_BASE)
2614                         return -EINVAL;
2615                 ref = find_ref_lock(hdl, id);
2616                 if (ref == NULL)
2617                         return -EINVAL;
2618                 ctrl = ref->ctrl;
2619                 if (ctrl->flags & V4L2_CTRL_FLAG_DISABLED)
2620                         return -EINVAL;
2621
2622                 if (ctrl->cluster[0]->ncontrols > 1)
2623                         have_clusters = true;
2624                 if (ctrl->cluster[0] != ctrl)
2625                         ref = find_ref_lock(hdl, ctrl->cluster[0]->id);
2626                 if (ctrl->is_ptr && !ctrl->is_string) {
2627                         unsigned tot_size = ctrl->elems * ctrl->elem_size;
2628
2629                         if (c->size < tot_size) {
2630                                 if (get) {
2631                                         c->size = tot_size;
2632                                         return -ENOSPC;
2633                                 }
2634                                 return -EFAULT;
2635                         }
2636                         c->size = tot_size;
2637                 }
2638                 /* Store the ref to the master control of the cluster */
2639                 h->mref = ref;
2640                 h->ctrl = ctrl;
2641                 /* Initially set next to 0, meaning that there is no other
2642                    control in this helper array belonging to the same
2643                    cluster */
2644                 h->next = 0;
2645         }
2646
2647         /* We are done if there were no controls that belong to a multi-
2648            control cluster. */
2649         if (!have_clusters)
2650                 return 0;
2651
2652         /* The code below figures out in O(n) time which controls in the list
2653            belong to the same cluster. */
2654
2655         /* This has to be done with the handler lock taken. */
2656         mutex_lock(hdl->lock);
2657
2658         /* First zero the helper field in the master control references */
2659         for (i = 0; i < cs->count; i++)
2660                 helpers[i].mref->helper = NULL;
2661         for (i = 0, h = helpers; i < cs->count; i++, h++) {
2662                 struct v4l2_ctrl_ref *mref = h->mref;
2663
2664                 /* If the mref->helper is set, then it points to an earlier
2665                    helper that belongs to the same cluster. */
2666                 if (mref->helper) {
2667                         /* Set the next field of mref->helper to the current
2668                            index: this means that that earlier helper now
2669                            points to the next helper in the same cluster. */
2670                         mref->helper->next = i;
2671                         /* mref should be set only for the first helper in the
2672                            cluster, clear the others. */
2673                         h->mref = NULL;
2674                 }
2675                 /* Point the mref helper to the current helper struct. */
2676                 mref->helper = h;
2677         }
2678         mutex_unlock(hdl->lock);
2679         return 0;
2680 }
2681
2682 /* Handles the corner case where cs->count == 0. It checks whether the
2683    specified control class exists. If that class ID is 0, then it checks
2684    whether there are any controls at all. */
2685 static int class_check(struct v4l2_ctrl_handler *hdl, u32 ctrl_class)
2686 {
2687         if (ctrl_class == 0)
2688                 return list_empty(&hdl->ctrl_refs) ? -EINVAL : 0;
2689         return find_ref_lock(hdl, ctrl_class | 1) ? 0 : -EINVAL;
2690 }
2691
2692
2693
2694 /* Get extended controls. Allocates the helpers array if needed. */
2695 int v4l2_g_ext_ctrls(struct v4l2_ctrl_handler *hdl, struct v4l2_ext_controls *cs)
2696 {
2697         struct v4l2_ctrl_helper helper[4];
2698         struct v4l2_ctrl_helper *helpers = helper;
2699         int ret;
2700         int i, j;
2701
2702         cs->error_idx = cs->count;
2703         cs->ctrl_class = V4L2_CTRL_ID2CLASS(cs->ctrl_class);
2704
2705         if (hdl == NULL)
2706                 return -EINVAL;
2707
2708         if (cs->count == 0)
2709                 return class_check(hdl, cs->ctrl_class);
2710
2711         if (cs->count > ARRAY_SIZE(helper)) {
2712                 helpers = kmalloc_array(cs->count, sizeof(helper[0]),
2713                                         GFP_KERNEL);
2714                 if (helpers == NULL)
2715                         return -ENOMEM;
2716         }
2717
2718         ret = prepare_ext_ctrls(hdl, cs, helpers, true);
2719         cs->error_idx = cs->count;
2720
2721         for (i = 0; !ret && i < cs->count; i++)
2722                 if (helpers[i].ctrl->flags & V4L2_CTRL_FLAG_WRITE_ONLY)
2723                         ret = -EACCES;
2724
2725         for (i = 0; !ret && i < cs->count; i++) {
2726                 int (*ctrl_to_user)(struct v4l2_ext_control *c,
2727                                     struct v4l2_ctrl *ctrl) = cur_to_user;
2728                 struct v4l2_ctrl *master;
2729
2730                 if (helpers[i].mref == NULL)
2731                         continue;
2732
2733                 master = helpers[i].mref->ctrl;
2734                 cs->error_idx = i;
2735
2736                 v4l2_ctrl_lock(master);
2737
2738                 /* g_volatile_ctrl will update the new control values */
2739                 if ((master->flags & V4L2_CTRL_FLAG_VOLATILE) ||
2740                         (master->has_volatiles && !is_cur_manual(master))) {
2741                         for (j = 0; j < master->ncontrols; j++)
2742                                 cur_to_new(master->cluster[j]);
2743                         ret = call_op(master, g_volatile_ctrl);
2744                         ctrl_to_user = new_to_user;
2745                 }
2746                 /* If OK, then copy the current (for non-volatile controls)
2747                    or the new (for volatile controls) control values to the
2748                    caller */
2749                 if (!ret) {
2750                         u32 idx = i;
2751
2752                         do {
2753                                 ret = ctrl_to_user(cs->controls + idx,
2754                                                    helpers[idx].ctrl);
2755                                 idx = helpers[idx].next;
2756                         } while (!ret && idx);
2757                 }
2758                 v4l2_ctrl_unlock(master);
2759         }
2760
2761         if (cs->count > ARRAY_SIZE(helper))
2762                 kfree(helpers);
2763         return ret;
2764 }
2765 EXPORT_SYMBOL(v4l2_g_ext_ctrls);
2766
2767 int v4l2_subdev_g_ext_ctrls(struct v4l2_subdev *sd, struct v4l2_ext_controls *cs)
2768 {
2769         return v4l2_g_ext_ctrls(sd->ctrl_handler, cs);
2770 }
2771 EXPORT_SYMBOL(v4l2_subdev_g_ext_ctrls);
2772
2773 /* Helper function to get a single control */
2774 static int get_ctrl(struct v4l2_ctrl *ctrl, struct v4l2_ext_control *c)
2775 {
2776         struct v4l2_ctrl *master = ctrl->cluster[0];
2777         int ret = 0;
2778         int i;
2779
2780         /* Compound controls are not supported. The new_to_user() and
2781          * cur_to_user() calls below would need to be modified not to access
2782          * userspace memory when called from get_ctrl().
2783          */
2784         if (!ctrl->is_int)
2785                 return -EINVAL;
2786
2787         if (ctrl->flags & V4L2_CTRL_FLAG_WRITE_ONLY)
2788                 return -EACCES;
2789
2790         v4l2_ctrl_lock(master);
2791         /* g_volatile_ctrl will update the current control values */
2792         if (ctrl->flags & V4L2_CTRL_FLAG_VOLATILE) {
2793                 for (i = 0; i < master->ncontrols; i++)
2794                         cur_to_new(master->cluster[i]);
2795                 ret = call_op(master, g_volatile_ctrl);
2796                 new_to_user(c, ctrl);
2797         } else {
2798                 cur_to_user(c, ctrl);
2799         }
2800         v4l2_ctrl_unlock(master);
2801         return ret;
2802 }
2803
2804 int v4l2_g_ctrl(struct v4l2_ctrl_handler *hdl, struct v4l2_control *control)
2805 {
2806         struct v4l2_ctrl *ctrl = v4l2_ctrl_find(hdl, control->id);
2807         struct v4l2_ext_control c;
2808         int ret;
2809
2810         if (ctrl == NULL || !ctrl->is_int)
2811                 return -EINVAL;
2812         ret = get_ctrl(ctrl, &c);
2813         control->value = c.value;
2814         return ret;
2815 }
2816 EXPORT_SYMBOL(v4l2_g_ctrl);
2817
2818 int v4l2_subdev_g_ctrl(struct v4l2_subdev *sd, struct v4l2_control *control)
2819 {
2820         return v4l2_g_ctrl(sd->ctrl_handler, control);
2821 }
2822 EXPORT_SYMBOL(v4l2_subdev_g_ctrl);
2823
2824 s32 v4l2_ctrl_g_ctrl(struct v4l2_ctrl *ctrl)
2825 {
2826         struct v4l2_ext_control c;
2827
2828         /* It's a driver bug if this happens. */
2829         WARN_ON(!ctrl->is_int);
2830         c.value = 0;
2831         get_ctrl(ctrl, &c);
2832         return c.value;
2833 }
2834 EXPORT_SYMBOL(v4l2_ctrl_g_ctrl);
2835
2836 s64 v4l2_ctrl_g_ctrl_int64(struct v4l2_ctrl *ctrl)
2837 {
2838         struct v4l2_ext_control c;
2839
2840         /* It's a driver bug if this happens. */
2841         WARN_ON(ctrl->is_ptr || ctrl->type != V4L2_CTRL_TYPE_INTEGER64);
2842         c.value = 0;
2843         get_ctrl(ctrl, &c);
2844         return c.value;
2845 }
2846 EXPORT_SYMBOL(v4l2_ctrl_g_ctrl_int64);
2847
2848
2849 /* Core function that calls try/s_ctrl and ensures that the new value is
2850    copied to the current value on a set.
2851    Must be called with ctrl->handler->lock held. */
2852 static int try_or_set_cluster(struct v4l2_fh *fh, struct v4l2_ctrl *master,
2853                               bool set, u32 ch_flags)
2854 {
2855         bool update_flag;
2856         int ret;
2857         int i;
2858
2859         /* Go through the cluster and either validate the new value or
2860            (if no new value was set), copy the current value to the new
2861            value, ensuring a consistent view for the control ops when
2862            called. */
2863         for (i = 0; i < master->ncontrols; i++) {
2864                 struct v4l2_ctrl *ctrl = master->cluster[i];
2865
2866                 if (ctrl == NULL)
2867                         continue;
2868
2869                 if (!ctrl->is_new) {
2870                         cur_to_new(ctrl);
2871                         continue;
2872                 }
2873                 /* Check again: it may have changed since the
2874                    previous check in try_or_set_ext_ctrls(). */
2875                 if (set && (ctrl->flags & V4L2_CTRL_FLAG_GRABBED))
2876                         return -EBUSY;
2877         }
2878
2879         ret = call_op(master, try_ctrl);
2880
2881         /* Don't set if there is no change */
2882         if (ret || !set || !cluster_changed(master))
2883                 return ret;
2884         ret = call_op(master, s_ctrl);
2885         if (ret)
2886                 return ret;
2887
2888         /* If OK, then make the new values permanent. */
2889         update_flag = is_cur_manual(master) != is_new_manual(master);
2890         for (i = 0; i < master->ncontrols; i++)
2891                 new_to_cur(fh, master->cluster[i], ch_flags |
2892                         ((update_flag && i > 0) ? V4L2_EVENT_CTRL_CH_FLAGS : 0));
2893         return 0;
2894 }
2895
2896 /* Validate controls. */
2897 static int validate_ctrls(struct v4l2_ext_controls *cs,
2898                           struct v4l2_ctrl_helper *helpers, bool set)
2899 {
2900         unsigned i;
2901         int ret = 0;
2902
2903         cs->error_idx = cs->count;
2904         for (i = 0; i < cs->count; i++) {
2905                 struct v4l2_ctrl *ctrl = helpers[i].ctrl;
2906
2907                 cs->error_idx = i;
2908
2909                 if (ctrl->flags & V4L2_CTRL_FLAG_READ_ONLY)
2910                         return -EACCES;
2911                 /* This test is also done in try_set_control_cluster() which
2912                    is called in atomic context, so that has the final say,
2913                    but it makes sense to do an up-front check as well. Once
2914                    an error occurs in try_set_control_cluster() some other
2915                    controls may have been set already and we want to do a
2916                    best-effort to avoid that. */
2917                 if (set && (ctrl->flags & V4L2_CTRL_FLAG_GRABBED))
2918                         return -EBUSY;
2919                 ret = validate_new(ctrl, &cs->controls[i]);
2920                 if (ret)
2921                         return ret;
2922         }
2923         return 0;
2924 }
2925
2926 /* Obtain the current volatile values of an autocluster and mark them
2927    as new. */
2928 static void update_from_auto_cluster(struct v4l2_ctrl *master)
2929 {
2930         int i;
2931
2932         for (i = 0; i < master->ncontrols; i++)
2933                 cur_to_new(master->cluster[i]);
2934         if (!call_op(master, g_volatile_ctrl))
2935                 for (i = 1; i < master->ncontrols; i++)
2936                         if (master->cluster[i])
2937                                 master->cluster[i]->is_new = 1;
2938 }
2939
2940 /* Try or try-and-set controls */
2941 static int try_set_ext_ctrls(struct v4l2_fh *fh, struct v4l2_ctrl_handler *hdl,
2942                              struct v4l2_ext_controls *cs,
2943                              bool set)
2944 {
2945         struct v4l2_ctrl_helper helper[4];
2946         struct v4l2_ctrl_helper *helpers = helper;
2947         unsigned i, j;
2948         int ret;
2949
2950         cs->error_idx = cs->count;
2951         cs->ctrl_class = V4L2_CTRL_ID2CLASS(cs->ctrl_class);
2952
2953         if (hdl == NULL)
2954                 return -EINVAL;
2955
2956         if (cs->count == 0)
2957                 return class_check(hdl, cs->ctrl_class);
2958
2959         if (cs->count > ARRAY_SIZE(helper)) {
2960                 helpers = kmalloc_array(cs->count, sizeof(helper[0]),
2961                                         GFP_KERNEL);
2962                 if (!helpers)
2963                         return -ENOMEM;
2964         }
2965         ret = prepare_ext_ctrls(hdl, cs, helpers, false);
2966         if (!ret)
2967                 ret = validate_ctrls(cs, helpers, set);
2968         if (ret && set)
2969                 cs->error_idx = cs->count;
2970         for (i = 0; !ret && i < cs->count; i++) {
2971                 struct v4l2_ctrl *master;
2972                 u32 idx = i;
2973
2974                 if (helpers[i].mref == NULL)
2975                         continue;
2976
2977                 cs->error_idx = i;
2978                 master = helpers[i].mref->ctrl;
2979                 v4l2_ctrl_lock(master);
2980
2981                 /* Reset the 'is_new' flags of the cluster */
2982                 for (j = 0; j < master->ncontrols; j++)
2983                         if (master->cluster[j])
2984                                 master->cluster[j]->is_new = 0;
2985
2986                 /* For volatile autoclusters that are currently in auto mode
2987                    we need to discover if it will be set to manual mode.
2988                    If so, then we have to copy the current volatile values
2989                    first since those will become the new manual values (which
2990                    may be overwritten by explicit new values from this set
2991                    of controls). */
2992                 if (master->is_auto && master->has_volatiles &&
2993                                                 !is_cur_manual(master)) {
2994                         /* Pick an initial non-manual value */
2995                         s32 new_auto_val = master->manual_mode_value + 1;
2996                         u32 tmp_idx = idx;
2997
2998                         do {
2999                                 /* Check if the auto control is part of the
3000                                    list, and remember the new value. */
3001                                 if (helpers[tmp_idx].ctrl == master)
3002                                         new_auto_val = cs->controls[tmp_idx].value;
3003                                 tmp_idx = helpers[tmp_idx].next;
3004                         } while (tmp_idx);
3005                         /* If the new value == the manual value, then copy
3006                            the current volatile values. */
3007                         if (new_auto_val == master->manual_mode_value)
3008                                 update_from_auto_cluster(master);
3009                 }
3010
3011                 /* Copy the new caller-supplied control values.
3012                    user_to_new() sets 'is_new' to 1. */
3013                 do {
3014                         ret = user_to_new(cs->controls + idx, helpers[idx].ctrl);
3015                         idx = helpers[idx].next;
3016                 } while (!ret && idx);
3017
3018                 if (!ret)
3019                         ret = try_or_set_cluster(fh, master, set, 0);
3020
3021                 /* Copy the new values back to userspace. */
3022                 if (!ret) {
3023                         idx = i;
3024                         do {
3025                                 ret = new_to_user(cs->controls + idx,
3026                                                 helpers[idx].ctrl);
3027                                 idx = helpers[idx].next;
3028                         } while (!ret && idx);
3029                 }
3030                 v4l2_ctrl_unlock(master);
3031         }
3032
3033         if (cs->count > ARRAY_SIZE(helper))
3034                 kfree(helpers);
3035         return ret;
3036 }
3037
3038 int v4l2_try_ext_ctrls(struct v4l2_ctrl_handler *hdl, struct v4l2_ext_controls *cs)
3039 {
3040         return try_set_ext_ctrls(NULL, hdl, cs, false);
3041 }
3042 EXPORT_SYMBOL(v4l2_try_ext_ctrls);
3043
3044 int v4l2_s_ext_ctrls(struct v4l2_fh *fh, struct v4l2_ctrl_handler *hdl,
3045                                         struct v4l2_ext_controls *cs)
3046 {
3047         return try_set_ext_ctrls(fh, hdl, cs, true);
3048 }
3049 EXPORT_SYMBOL(v4l2_s_ext_ctrls);
3050
3051 int v4l2_subdev_try_ext_ctrls(struct v4l2_subdev *sd, struct v4l2_ext_controls *cs)
3052 {
3053         return try_set_ext_ctrls(NULL, sd->ctrl_handler, cs, false);
3054 }
3055 EXPORT_SYMBOL(v4l2_subdev_try_ext_ctrls);
3056
3057 int v4l2_subdev_s_ext_ctrls(struct v4l2_subdev *sd, struct v4l2_ext_controls *cs)
3058 {
3059         return try_set_ext_ctrls(NULL, sd->ctrl_handler, cs, true);
3060 }
3061 EXPORT_SYMBOL(v4l2_subdev_s_ext_ctrls);
3062
3063 /* Helper function for VIDIOC_S_CTRL compatibility */
3064 static int set_ctrl(struct v4l2_fh *fh, struct v4l2_ctrl *ctrl,
3065                     struct v4l2_ext_control *c, u32 ch_flags)
3066 {
3067         struct v4l2_ctrl *master = ctrl->cluster[0];
3068         int i;
3069
3070         /* Compound controls are not supported. The user_to_new() and
3071          * cur_to_user() calls below would need to be modified not to access
3072          * userspace memory when called from set_ctrl().
3073          */
3074         if (ctrl->is_ptr)
3075                 return -EINVAL;
3076
3077         /* Reset the 'is_new' flags of the cluster */
3078         for (i = 0; i < master->ncontrols; i++)
3079                 if (master->cluster[i])
3080                         master->cluster[i]->is_new = 0;
3081
3082         /* For autoclusters with volatiles that are switched from auto to
3083            manual mode we have to update the current volatile values since
3084            those will become the initial manual values after such a switch. */
3085         if (master->is_auto && master->has_volatiles && ctrl == master &&
3086             !is_cur_manual(master) && c->value == master->manual_mode_value)
3087                 update_from_auto_cluster(master);
3088
3089         user_to_new(c, ctrl);
3090         return try_or_set_cluster(fh, master, true, ch_flags);
3091 }
3092
3093 /* Helper function for VIDIOC_S_CTRL compatibility */
3094 static int set_ctrl_lock(struct v4l2_fh *fh, struct v4l2_ctrl *ctrl,
3095                          struct v4l2_ext_control *c)
3096 {
3097         int ret = validate_new(ctrl, c);
3098
3099         if (!ret) {
3100                 v4l2_ctrl_lock(ctrl);
3101                 ret = set_ctrl(fh, ctrl, c, 0);
3102                 if (!ret)
3103                         cur_to_user(c, ctrl);
3104                 v4l2_ctrl_unlock(ctrl);
3105         }
3106         return ret;
3107 }
3108
3109 int v4l2_s_ctrl(struct v4l2_fh *fh, struct v4l2_ctrl_handler *hdl,
3110                                         struct v4l2_control *control)
3111 {
3112         struct v4l2_ctrl *ctrl = v4l2_ctrl_find(hdl, control->id);
3113         struct v4l2_ext_control c;
3114         int ret;
3115
3116         if (ctrl == NULL || !ctrl->is_int)
3117                 return -EINVAL;
3118
3119         if (ctrl->flags & V4L2_CTRL_FLAG_READ_ONLY)
3120                 return -EACCES;
3121
3122         c.value = control->value;
3123         ret = set_ctrl_lock(fh, ctrl, &c);
3124         control->value = c.value;
3125         return ret;
3126 }
3127 EXPORT_SYMBOL(v4l2_s_ctrl);
3128
3129 int v4l2_subdev_s_ctrl(struct v4l2_subdev *sd, struct v4l2_control *control)
3130 {
3131         return v4l2_s_ctrl(NULL, sd->ctrl_handler, control);
3132 }
3133 EXPORT_SYMBOL(v4l2_subdev_s_ctrl);
3134
3135 int v4l2_ctrl_s_ctrl(struct v4l2_ctrl *ctrl, s32 val)
3136 {
3137         struct v4l2_ext_control c;
3138
3139         /* It's a driver bug if this happens. */
3140         WARN_ON(!ctrl->is_int);
3141         c.value = val;
3142         return set_ctrl_lock(NULL, ctrl, &c);
3143 }
3144 EXPORT_SYMBOL(v4l2_ctrl_s_ctrl);
3145
3146 int v4l2_ctrl_s_ctrl_int64(struct v4l2_ctrl *ctrl, s64 val)
3147 {
3148         struct v4l2_ext_control c;
3149
3150         /* It's a driver bug if this happens. */
3151         WARN_ON(ctrl->is_ptr || ctrl->type != V4L2_CTRL_TYPE_INTEGER64);
3152         c.value64 = val;
3153         return set_ctrl_lock(NULL, ctrl, &c);
3154 }
3155 EXPORT_SYMBOL(v4l2_ctrl_s_ctrl_int64);
3156
3157 void v4l2_ctrl_notify(struct v4l2_ctrl *ctrl, v4l2_ctrl_notify_fnc notify, void *priv)
3158 {
3159         if (ctrl == NULL)
3160                 return;
3161         if (notify == NULL) {
3162                 ctrl->call_notify = 0;
3163                 return;
3164         }
3165         if (WARN_ON(ctrl->handler->notify && ctrl->handler->notify != notify))
3166                 return;
3167         ctrl->handler->notify = notify;
3168         ctrl->handler->notify_priv = priv;
3169         ctrl->call_notify = 1;
3170 }
3171 EXPORT_SYMBOL(v4l2_ctrl_notify);
3172
3173 int v4l2_ctrl_modify_range(struct v4l2_ctrl *ctrl,
3174                         s64 min, s64 max, u64 step, s64 def)
3175 {
3176         int ret;
3177         struct v4l2_ext_control c;
3178
3179         switch (ctrl->type) {
3180         case V4L2_CTRL_TYPE_INTEGER:
3181         case V4L2_CTRL_TYPE_INTEGER64:
3182         case V4L2_CTRL_TYPE_BOOLEAN:
3183         case V4L2_CTRL_TYPE_MENU:
3184         case V4L2_CTRL_TYPE_INTEGER_MENU:
3185         case V4L2_CTRL_TYPE_BITMASK:
3186         case V4L2_CTRL_TYPE_U8:
3187         case V4L2_CTRL_TYPE_U16:
3188                 if (ctrl->is_array)
3189                         return -EINVAL;
3190                 ret = check_range(ctrl->type, min, max, step, def);
3191                 if (ret)
3192                         return ret;
3193                 break;
3194         default:
3195                 return -EINVAL;
3196         }
3197         v4l2_ctrl_lock(ctrl);
3198         ctrl->minimum = min;
3199         ctrl->maximum = max;
3200         ctrl->step = step;
3201         ctrl->default_value = def;
3202         c.value = *ctrl->p_cur.p_s32;
3203         if (validate_new(ctrl, &c))
3204                 c.value = def;
3205         if (c.value != *ctrl->p_cur.p_s32)
3206                 ret = set_ctrl(NULL, ctrl, &c, V4L2_EVENT_CTRL_CH_RANGE);
3207         else
3208                 send_event(NULL, ctrl, V4L2_EVENT_CTRL_CH_RANGE);
3209         v4l2_ctrl_unlock(ctrl);
3210         return ret;
3211 }
3212 EXPORT_SYMBOL(v4l2_ctrl_modify_range);
3213
3214 static int v4l2_ctrl_add_event(struct v4l2_subscribed_event *sev, unsigned elems)
3215 {
3216         struct v4l2_ctrl *ctrl = v4l2_ctrl_find(sev->fh->ctrl_handler, sev->id);
3217
3218         if (ctrl == NULL)
3219                 return -EINVAL;
3220
3221         v4l2_ctrl_lock(ctrl);
3222         list_add_tail(&sev->node, &ctrl->ev_subs);
3223         if (ctrl->type != V4L2_CTRL_TYPE_CTRL_CLASS &&
3224             (sev->flags & V4L2_EVENT_SUB_FL_SEND_INITIAL)) {
3225                 struct v4l2_event ev;
3226                 u32 changes = V4L2_EVENT_CTRL_CH_FLAGS;
3227
3228                 if (!(ctrl->flags & V4L2_CTRL_FLAG_WRITE_ONLY))
3229                         changes |= V4L2_EVENT_CTRL_CH_VALUE;
3230                 fill_event(&ev, ctrl, changes);
3231                 /* Mark the queue as active, allowing this initial
3232                    event to be accepted. */
3233                 sev->elems = elems;
3234                 v4l2_event_queue_fh(sev->fh, &ev);
3235         }
3236         v4l2_ctrl_unlock(ctrl);
3237         return 0;
3238 }
3239
3240 static void v4l2_ctrl_del_event(struct v4l2_subscribed_event *sev)
3241 {
3242         struct v4l2_ctrl *ctrl = v4l2_ctrl_find(sev->fh->ctrl_handler, sev->id);
3243
3244         v4l2_ctrl_lock(ctrl);
3245         list_del(&sev->node);
3246         v4l2_ctrl_unlock(ctrl);
3247 }
3248
3249 void v4l2_ctrl_replace(struct v4l2_event *old, const struct v4l2_event *new)
3250 {
3251         u32 old_changes = old->u.ctrl.changes;
3252
3253         old->u.ctrl = new->u.ctrl;
3254         old->u.ctrl.changes |= old_changes;
3255 }
3256 EXPORT_SYMBOL(v4l2_ctrl_replace);
3257
3258 void v4l2_ctrl_merge(const struct v4l2_event *old, struct v4l2_event *new)
3259 {
3260         new->u.ctrl.changes |= old->u.ctrl.changes;
3261 }
3262 EXPORT_SYMBOL(v4l2_ctrl_merge);
3263
3264 const struct v4l2_subscribed_event_ops v4l2_ctrl_sub_ev_ops = {
3265         .add = v4l2_ctrl_add_event,
3266         .del = v4l2_ctrl_del_event,
3267         .replace = v4l2_ctrl_replace,
3268         .merge = v4l2_ctrl_merge,
3269 };
3270 EXPORT_SYMBOL(v4l2_ctrl_sub_ev_ops);
3271
3272 int v4l2_ctrl_log_status(struct file *file, void *fh)
3273 {
3274         struct video_device *vfd = video_devdata(file);
3275         struct v4l2_fh *vfh = file->private_data;
3276
3277         if (test_bit(V4L2_FL_USES_V4L2_FH, &vfd->flags) && vfd->v4l2_dev)
3278                 v4l2_ctrl_handler_log_status(vfh->ctrl_handler,
3279                         vfd->v4l2_dev->name);
3280         return 0;
3281 }
3282 EXPORT_SYMBOL(v4l2_ctrl_log_status);
3283
3284 int v4l2_ctrl_subscribe_event(struct v4l2_fh *fh,
3285                                 const struct v4l2_event_subscription *sub)
3286 {
3287         if (sub->type == V4L2_EVENT_CTRL)
3288                 return v4l2_event_subscribe(fh, sub, 0, &v4l2_ctrl_sub_ev_ops);
3289         return -EINVAL;
3290 }
3291 EXPORT_SYMBOL(v4l2_ctrl_subscribe_event);
3292
3293 int v4l2_ctrl_subdev_subscribe_event(struct v4l2_subdev *sd, struct v4l2_fh *fh,
3294                                      struct v4l2_event_subscription *sub)
3295 {
3296         if (!sd->ctrl_handler)
3297                 return -EINVAL;
3298         return v4l2_ctrl_subscribe_event(fh, sub);
3299 }
3300 EXPORT_SYMBOL(v4l2_ctrl_subdev_subscribe_event);
3301
3302 unsigned int v4l2_ctrl_poll(struct file *file, struct poll_table_struct *wait)
3303 {
3304         struct v4l2_fh *fh = file->private_data;
3305
3306         if (v4l2_event_pending(fh))
3307                 return POLLPRI;
3308         poll_wait(file, &fh->wait, wait);
3309         return 0;
3310 }
3311 EXPORT_SYMBOL(v4l2_ctrl_poll);