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