drivers/media/video/v4l2-common.c

   1 /*
   2  *      Video for Linux Two
   3  *
   4  *      A generic video device interface for the LINUX operating system
   5  *      using a set of device structures/vectors for low level operations.
   6  *
   7  *      This file replaces the videodev.c file that comes with the
   8  *      regular kernel distribution.
   9  *
  10  *      This program is free software; you can redistribute it and/or
  11  *      modify it under the terms of the GNU General Public License
  12  *      as published by the Free Software Foundation; either version
  13  *      2 of the License, or (at your option) any later version.
  14  *
  15  * Author:      Bill Dirks <bill@thedirks.org>
  16  *              based on code by Alan Cox, <alan@cymru.net>
  17  *
  18  */
  19
  20 /*
  21  * Video capture interface for Linux
  22  *
  23  *      A generic video device interface for the LINUX operating system
  24  *      using a set of device structures/vectors for low level operations.
  25  *
  26  *              This program is free software; you can redistribute it and/or
  27  *              modify it under the terms of the GNU General Public License
  28  *              as published by the Free Software Foundation; either version
  29  *              2 of the License, or (at your option) any later version.
  30  *
  31  * Author:      Alan Cox, <alan@lxorguk.ukuu.org.uk>
  32  *
  33  * Fixes:
  34  */
  35
  36 /*
  37  * Video4linux 1/2 integration by Justin Schoeman
  38  * <justin@suntiger.ee.up.ac.za>
  39  * 2.4 PROCFS support ported from 2.4 kernels by
  40  *  Iñaki García Etxebarria <garetxe@euskalnet.net>
  41  * Makefile fix by "W. Michael Petullo" <mike@flyn.org>
  42  * 2.4 devfs support ported from 2.4 kernels by
  43  *  Dan Merillat <dan@merillat.org>
  44  * Added Gerd Knorrs v4l1 enhancements (Justin Schoeman)
  45  */
  46
  47 #include <linux/module.h>
  48 #include <linux/types.h>
  49 #include <linux/kernel.h>
  50 #include <linux/mm.h>
  51 #include <linux/string.h>
  52 #include <linux/errno.h>
  53 #include <linux/i2c.h>
  54 #include <asm/uaccess.h>
  55 #include <asm/system.h>
  56 #include <asm/pgtable.h>
  57 #include <asm/io.h>
  58 #include <asm/div64.h>
  59 #define __OLD_VIDIOC_ /* To allow fixing old calls*/
  60 #include <media/v4l2-common.h>
  61 #include <media/v4l2-device.h>
  62 #include <media/v4l2-chip-ident.h>
  63
  64 #include <linux/videodev2.h>
  65
  66 MODULE_AUTHOR("Bill Dirks, Justin Schoeman, Gerd Knorr");
  67 MODULE_DESCRIPTION("misc helper functions for v4l2 device drivers");
  68 MODULE_LICENSE("GPL");
  69
  70 /*
  71  *
  72  *      V 4 L 2   D R I V E R   H E L P E R   A P I
  73  *
  74  */
  75
  76 /*
  77  *  Video Standard Operations (contributed by Michael Schimek)
  78  */
  79
  80
  81 /* ----------------------------------------------------------------- */
  82 /* priority handling                                                 */
  83
  84 #define V4L2_PRIO_VALID(val) (val == V4L2_PRIORITY_BACKGROUND   || \
  85                               val == V4L2_PRIORITY_INTERACTIVE  || \
  86                               val == V4L2_PRIORITY_RECORD)
  87
  88 int v4l2_prio_init(struct v4l2_prio_state *global)
  89 {
  90         memset(global,0,sizeof(*global));
  91         return 0;
  92 }
  93 EXPORT_SYMBOL(v4l2_prio_init);
  94
  95 int v4l2_prio_change(struct v4l2_prio_state *global, enum v4l2_priority *local,
  96                      enum v4l2_priority new)
  97 {
  98         if (!V4L2_PRIO_VALID(new))
  99                 return -EINVAL;
 100         if (*local == new)
 101                 return 0;
 102
 103         atomic_inc(&global->prios[new]);
 104         if (V4L2_PRIO_VALID(*local))
 105                 atomic_dec(&global->prios[*local]);
 106         *local = new;
 107         return 0;
 108 }
 109 EXPORT_SYMBOL(v4l2_prio_change);
 110
 111 int v4l2_prio_open(struct v4l2_prio_state *global, enum v4l2_priority *local)
 112 {
 113         return v4l2_prio_change(global,local,V4L2_PRIORITY_DEFAULT);
 114 }
 115 EXPORT_SYMBOL(v4l2_prio_open);
 116
 117 int v4l2_prio_close(struct v4l2_prio_state *global, enum v4l2_priority *local)
 118 {
 119         if (V4L2_PRIO_VALID(*local))
 120                 atomic_dec(&global->prios[*local]);
 121         return 0;
 122 }
 123 EXPORT_SYMBOL(v4l2_prio_close);
 124
 125 enum v4l2_priority v4l2_prio_max(struct v4l2_prio_state *global)
 126 {
 127         if (atomic_read(&global->prios[V4L2_PRIORITY_RECORD]) > 0)
 128                 return V4L2_PRIORITY_RECORD;
 129         if (atomic_read(&global->prios[V4L2_PRIORITY_INTERACTIVE]) > 0)
 130                 return V4L2_PRIORITY_INTERACTIVE;
 131         if (atomic_read(&global->prios[V4L2_PRIORITY_BACKGROUND]) > 0)
 132                 return V4L2_PRIORITY_BACKGROUND;
 133         return V4L2_PRIORITY_UNSET;
 134 }
 135 EXPORT_SYMBOL(v4l2_prio_max);
 136
 137 int v4l2_prio_check(struct v4l2_prio_state *global, enum v4l2_priority *local)
 138 {
 139         if (*local < v4l2_prio_max(global))
 140                 return -EBUSY;
 141         return 0;
 142 }
 143 EXPORT_SYMBOL(v4l2_prio_check);
 144
 145 /* ----------------------------------------------------------------- */
 146
 147 /* Helper functions for control handling                             */
 148
 149 /* Check for correctness of the ctrl's value based on the data from
 150    struct v4l2_queryctrl and the available menu items. Note that
 151    menu_items may be NULL, in that case it is ignored. */
 152 int v4l2_ctrl_check(struct v4l2_ext_control *ctrl, struct v4l2_queryctrl *qctrl,
 153                 const char **menu_items)
 154 {
 155         if (qctrl->flags & V4L2_CTRL_FLAG_DISABLED)
 156                 return -EINVAL;
 157         if (qctrl->flags & V4L2_CTRL_FLAG_GRABBED)
 158                 return -EBUSY;
 159         if (qctrl->type == V4L2_CTRL_TYPE_BUTTON ||
 160             qctrl->type == V4L2_CTRL_TYPE_INTEGER64 ||
 161             qctrl->type == V4L2_CTRL_TYPE_CTRL_CLASS)
 162                 return 0;
 163         if (ctrl->value < qctrl->minimum || ctrl->value > qctrl->maximum)
 164                 return -ERANGE;
 165         if (qctrl->type == V4L2_CTRL_TYPE_MENU && menu_items != NULL) {
 166                 if (menu_items[ctrl->value] == NULL ||
 167                     menu_items[ctrl->value][0] == '\0')
 168                         return -EINVAL;
 169         }
 170         return 0;
 171 }
 172 EXPORT_SYMBOL(v4l2_ctrl_check);
 173
 174 /* Returns NULL or a character pointer array containing the menu for
 175    the given control ID. The pointer array ends with a NULL pointer.
 176    An empty string signifies a menu entry that is invalid. This allows
 177    drivers to disable certain options if it is not supported. */
 178 const char **v4l2_ctrl_get_menu(u32 id)
 179 {
 180         static const char *mpeg_audio_sampling_freq[] = {
 181                 "44.1 kHz",
 182                 "48 kHz",
 183                 "32 kHz",
 184                 NULL
 185         };
 186         static const char *mpeg_audio_encoding[] = {
 187                 "MPEG-1/2 Layer I",
 188                 "MPEG-1/2 Layer II",
 189                 "MPEG-1/2 Layer III",
 190                 "MPEG-2/4 AAC",
 191                 "AC-3",
 192                 NULL
 193         };
 194         static const char *mpeg_audio_l1_bitrate[] = {
 195                 "32 kbps",
 196                 "64 kbps",
 197                 "96 kbps",
 198                 "128 kbps",
 199                 "160 kbps",
 200                 "192 kbps",
 201                 "224 kbps",
 202                 "256 kbps",
 203                 "288 kbps",
 204                 "320 kbps",
 205                 "352 kbps",
 206                 "384 kbps",
 207                 "416 kbps",
 208                 "448 kbps",
 209                 NULL
 210         };
 211         static const char *mpeg_audio_l2_bitrate[] = {
 212                 "32 kbps",
 213                 "48 kbps",
 214                 "56 kbps",
 215                 "64 kbps",
 216                 "80 kbps",
 217                 "96 kbps",
 218                 "112 kbps",
 219                 "128 kbps",
 220                 "160 kbps",
 221                 "192 kbps",
 222                 "224 kbps",
 223                 "256 kbps",
 224                 "320 kbps",
 225                 "384 kbps",
 226                 NULL
 227         };
 228         static const char *mpeg_audio_l3_bitrate[] = {
 229                 "32 kbps",
 230                 "40 kbps",
 231                 "48 kbps",
 232                 "56 kbps",
 233                 "64 kbps",
 234                 "80 kbps",
 235                 "96 kbps",
 236                 "112 kbps",
 237                 "128 kbps",
 238                 "160 kbps",
 239                 "192 kbps",
 240                 "224 kbps",
 241                 "256 kbps",
 242                 "320 kbps",
 243                 NULL
 244         };
 245         static const char *mpeg_audio_ac3_bitrate[] = {
 246                 "32 kbps",
 247                 "40 kbps",
 248                 "48 kbps",
 249                 "56 kbps",
 250                 "64 kbps",
 251                 "80 kbps",
 252                 "96 kbps",
 253                 "112 kbps",
 254                 "128 kbps",
 255                 "160 kbps",
 256                 "192 kbps",
 257                 "224 kbps",
 258                 "256 kbps",
 259                 "320 kbps",
 260                 "384 kbps",
 261                 "448 kbps",
 262                 "512 kbps",
 263                 "576 kbps",
 264                 "640 kbps",
 265                 NULL
 266         };
 267         static const char *mpeg_audio_mode[] = {
 268                 "Stereo",
 269                 "Joint Stereo",
 270                 "Dual",
 271                 "Mono",
 272                 NULL
 273         };
 274         static const char *mpeg_audio_mode_extension[] = {
 275                 "Bound 4",
 276                 "Bound 8",
 277                 "Bound 12",
 278                 "Bound 16",
 279                 NULL
 280         };
 281         static const char *mpeg_audio_emphasis[] = {
 282                 "No Emphasis",
 283                 "50/15 us",
 284                 "CCITT J17",
 285                 NULL
 286         };
 287         static const char *mpeg_audio_crc[] = {
 288                 "No CRC",
 289                 "16-bit CRC",
 290                 NULL
 291         };
 292         static const char *mpeg_video_encoding[] = {
 293                 "MPEG-1",
 294                 "MPEG-2",
 295                 "MPEG-4 AVC",
 296                 NULL
 297         };
 298         static const char *mpeg_video_aspect[] = {
 299                 "1x1",
 300                 "4x3",
 301                 "16x9",
 302                 "2.21x1",
 303                 NULL
 304         };
 305         static const char *mpeg_video_bitrate_mode[] = {
 306                 "Variable Bitrate",
 307                 "Constant Bitrate",
 308                 NULL
 309         };
 310         static const char *mpeg_stream_type[] = {
 311                 "MPEG-2 Program Stream",
 312                 "MPEG-2 Transport Stream",
 313                 "MPEG-1 System Stream",
 314                 "MPEG-2 DVD-compatible Stream",
 315                 "MPEG-1 VCD-compatible Stream",
 316                 "MPEG-2 SVCD-compatible Stream",
 317                 NULL
 318         };
 319         static const char *mpeg_stream_vbi_fmt[] = {
 320                 "No VBI",
 321                 "Private packet, IVTV format",
 322                 NULL
 323         };
 324         static const char *camera_power_line_frequency[] = {
 325                 "Disabled",
 326                 "50 Hz",
 327                 "60 Hz",
 328                 NULL
 329         };
 330         static const char *camera_exposure_auto[] = {
 331                 "Auto Mode",
 332                 "Manual Mode",
 333                 "Shutter Priority Mode",
 334                 "Aperture Priority Mode",
 335                 NULL
 336         };
 337         static const char *colorfx[] = {
 338                 "None",
 339                 "Black & White",
 340                 "Sepia",
 341                 NULL
 342         };
 343
 344         switch (id) {
 345                 case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ:
 346                         return mpeg_audio_sampling_freq;
 347                 case V4L2_CID_MPEG_AUDIO_ENCODING:
 348                         return mpeg_audio_encoding;
 349                 case V4L2_CID_MPEG_AUDIO_L1_BITRATE:
 350                         return mpeg_audio_l1_bitrate;
 351                 case V4L2_CID_MPEG_AUDIO_L2_BITRATE:
 352                         return mpeg_audio_l2_bitrate;
 353                 case V4L2_CID_MPEG_AUDIO_L3_BITRATE:
 354                         return mpeg_audio_l3_bitrate;
 355                 case V4L2_CID_MPEG_AUDIO_AC3_BITRATE:
 356                         return mpeg_audio_ac3_bitrate;
 357                 case V4L2_CID_MPEG_AUDIO_MODE:
 358                         return mpeg_audio_mode;
 359                 case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION:
 360                         return mpeg_audio_mode_extension;
 361                 case V4L2_CID_MPEG_AUDIO_EMPHASIS:
 362                         return mpeg_audio_emphasis;
 363                 case V4L2_CID_MPEG_AUDIO_CRC:
 364                         return mpeg_audio_crc;
 365                 case V4L2_CID_MPEG_VIDEO_ENCODING:
 366                         return mpeg_video_encoding;
 367                 case V4L2_CID_MPEG_VIDEO_ASPECT:
 368                         return mpeg_video_aspect;
 369                 case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
 370                         return mpeg_video_bitrate_mode;
 371                 case V4L2_CID_MPEG_STREAM_TYPE:
 372                         return mpeg_stream_type;
 373                 case V4L2_CID_MPEG_STREAM_VBI_FMT:
 374                         return mpeg_stream_vbi_fmt;
 375                 case V4L2_CID_POWER_LINE_FREQUENCY:
 376                         return camera_power_line_frequency;
 377                 case V4L2_CID_EXPOSURE_AUTO:
 378                         return camera_exposure_auto;
 379                 case V4L2_CID_COLORFX:
 380                         return colorfx;
 381                 default:
 382                         return NULL;
 383         }
 384 }
 385 EXPORT_SYMBOL(v4l2_ctrl_get_menu);
 386
 387 /* Return the control name. */
 388 const char *v4l2_ctrl_get_name(u32 id)
 389 {
 390         switch (id) {
 391         /* USER controls */
 392         case V4L2_CID_USER_CLASS:               return "User Controls";
 393         case V4L2_CID_BRIGHTNESS:               return "Brightness";
 394         case V4L2_CID_CONTRAST:                 return "Contrast";
 395         case V4L2_CID_SATURATION:               return "Saturation";
 396         case V4L2_CID_HUE:                      return "Hue";
 397         case V4L2_CID_AUDIO_VOLUME:             return "Volume";
 398         case V4L2_CID_AUDIO_BALANCE:            return "Balance";
 399         case V4L2_CID_AUDIO_BASS:               return "Bass";
 400         case V4L2_CID_AUDIO_TREBLE:             return "Treble";
 401         case V4L2_CID_AUDIO_MUTE:               return "Mute";
 402         case V4L2_CID_AUDIO_LOUDNESS:           return "Loudness";
 403         case V4L2_CID_BLACK_LEVEL:              return "Black Level";
 404         case V4L2_CID_AUTO_WHITE_BALANCE:       return "White Balance, Automatic";
 405         case V4L2_CID_DO_WHITE_BALANCE:         return "Do White Balance";
 406         case V4L2_CID_RED_BALANCE:              return "Red Balance";
 407         case V4L2_CID_BLUE_BALANCE:             return "Blue Balance";
 408         case V4L2_CID_GAMMA:                    return "Gamma";
 409         case V4L2_CID_EXPOSURE:                 return "Exposure";
 410         case V4L2_CID_AUTOGAIN:                 return "Gain, Automatic";
 411         case V4L2_CID_GAIN:                     return "Gain";
 412         case V4L2_CID_HFLIP:                    return "Horizontal Flip";
 413         case V4L2_CID_VFLIP:                    return "Vertical Flip";
 414         case V4L2_CID_HCENTER:                  return "Horizontal Center";
 415         case V4L2_CID_VCENTER:                  return "Vertical Center";
 416         case V4L2_CID_POWER_LINE_FREQUENCY:     return "Power Line Frequency";
 417         case V4L2_CID_HUE_AUTO:                 return "Hue, Automatic";
 418         case V4L2_CID_WHITE_BALANCE_TEMPERATURE: return "White Balance Temperature";
 419         case V4L2_CID_SHARPNESS:                return "Sharpness";
 420         case V4L2_CID_BACKLIGHT_COMPENSATION:   return "Backlight Compensation";
 421         case V4L2_CID_CHROMA_AGC:               return "Chroma AGC";
 422         case V4L2_CID_COLOR_KILLER:             return "Color Killer";
 423         case V4L2_CID_COLORFX:                  return "Color Effects";
 424
 425         /* MPEG controls */
 426         case V4L2_CID_MPEG_CLASS:               return "MPEG Encoder Controls";
 427         case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: return "Audio Sampling Frequency";
 428         case V4L2_CID_MPEG_AUDIO_ENCODING:      return "Audio Encoding";
 429         case V4L2_CID_MPEG_AUDIO_L1_BITRATE:    return "Audio Layer I Bitrate";
 430         case V4L2_CID_MPEG_AUDIO_L2_BITRATE:    return "Audio Layer II Bitrate";
 431         case V4L2_CID_MPEG_AUDIO_L3_BITRATE:    return "Audio Layer III Bitrate";
 432         case V4L2_CID_MPEG_AUDIO_AAC_BITRATE:   return "Audio AAC Bitrate";
 433         case V4L2_CID_MPEG_AUDIO_AC3_BITRATE:   return "Audio AC-3 Bitrate";
 434         case V4L2_CID_MPEG_AUDIO_MODE:          return "Audio Stereo Mode";
 435         case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION: return "Audio Stereo Mode Extension";
 436         case V4L2_CID_MPEG_AUDIO_EMPHASIS:      return "Audio Emphasis";
 437         case V4L2_CID_MPEG_AUDIO_CRC:           return "Audio CRC";
 438         case V4L2_CID_MPEG_AUDIO_MUTE:          return "Audio Mute";
 439         case V4L2_CID_MPEG_VIDEO_ENCODING:      return "Video Encoding";
 440         case V4L2_CID_MPEG_VIDEO_ASPECT:        return "Video Aspect";
 441         case V4L2_CID_MPEG_VIDEO_B_FRAMES:      return "Video B Frames";
 442         case V4L2_CID_MPEG_VIDEO_GOP_SIZE:      return "Video GOP Size";
 443         case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE:   return "Video GOP Closure";
 444         case V4L2_CID_MPEG_VIDEO_PULLDOWN:      return "Video Pulldown";
 445         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:  return "Video Bitrate Mode";
 446         case V4L2_CID_MPEG_VIDEO_BITRATE:       return "Video Bitrate";
 447         case V4L2_CID_MPEG_VIDEO_BITRATE_PEAK:  return "Video Peak Bitrate";
 448         case V4L2_CID_MPEG_VIDEO_TEMPORAL_DECIMATION: return "Video Temporal Decimation";
 449         case V4L2_CID_MPEG_VIDEO_MUTE:          return "Video Mute";
 450         case V4L2_CID_MPEG_VIDEO_MUTE_YUV:      return "Video Mute YUV";
 451         case V4L2_CID_MPEG_STREAM_TYPE:         return "Stream Type";
 452         case V4L2_CID_MPEG_STREAM_PID_PMT:      return "Stream PMT Program ID";
 453         case V4L2_CID_MPEG_STREAM_PID_AUDIO:    return "Stream Audio Program ID";
 454         case V4L2_CID_MPEG_STREAM_PID_VIDEO:    return "Stream Video Program ID";
 455         case V4L2_CID_MPEG_STREAM_PID_PCR:      return "Stream PCR Program ID";
 456         case V4L2_CID_MPEG_STREAM_PES_ID_AUDIO: return "Stream PES Audio ID";
 457         case V4L2_CID_MPEG_STREAM_PES_ID_VIDEO: return "Stream PES Video ID";
 458         case V4L2_CID_MPEG_STREAM_VBI_FMT:      return "Stream VBI Format";
 459
 460         /* CAMERA controls */
 461         case V4L2_CID_CAMERA_CLASS:             return "Camera Controls";
 462         case V4L2_CID_EXPOSURE_AUTO:            return "Auto Exposure";
 463         case V4L2_CID_EXPOSURE_ABSOLUTE:        return "Exposure Time, Absolute";
 464         case V4L2_CID_EXPOSURE_AUTO_PRIORITY:   return "Exposure, Dynamic Framerate";
 465         case V4L2_CID_PAN_RELATIVE:             return "Pan, Relative";
 466         case V4L2_CID_TILT_RELATIVE:            return "Tilt, Relative";
 467         case V4L2_CID_PAN_RESET:                return "Pan, Reset";
 468         case V4L2_CID_TILT_RESET:               return "Tilt, Reset";
 469         case V4L2_CID_PAN_ABSOLUTE:             return "Pan, Absolute";
 470         case V4L2_CID_TILT_ABSOLUTE:            return "Tilt, Absolute";
 471         case V4L2_CID_FOCUS_ABSOLUTE:           return "Focus, Absolute";
 472         case V4L2_CID_FOCUS_RELATIVE:           return "Focus, Relative";
 473         case V4L2_CID_FOCUS_AUTO:               return "Focus, Automatic";
 474         case V4L2_CID_ZOOM_ABSOLUTE:            return "Zoom, Absolute";
 475         case V4L2_CID_ZOOM_RELATIVE:            return "Zoom, Relative";
 476         case V4L2_CID_ZOOM_CONTINUOUS:          return "Zoom, Continuous";
 477         case V4L2_CID_PRIVACY:                  return "Privacy";
 478
 479         default:
 480                 return NULL;
 481         }
 482 }
 483 EXPORT_SYMBOL(v4l2_ctrl_get_name);
 484
 485 /* Fill in a struct v4l2_queryctrl */
 486 int v4l2_ctrl_query_fill(struct v4l2_queryctrl *qctrl, s32 min, s32 max, s32 step, s32 def)
 487 {
 488         const char *name = v4l2_ctrl_get_name(qctrl->id);
 489
 490         qctrl->flags = 0;
 491         if (name == NULL)
 492                 return -EINVAL;
 493
 494         switch (qctrl->id) {
 495         case V4L2_CID_AUDIO_MUTE:
 496         case V4L2_CID_AUDIO_LOUDNESS:
 497         case V4L2_CID_AUTO_WHITE_BALANCE:
 498         case V4L2_CID_AUTOGAIN:
 499         case V4L2_CID_HFLIP:
 500         case V4L2_CID_VFLIP:
 501         case V4L2_CID_HUE_AUTO:
 502         case V4L2_CID_CHROMA_AGC:
 503         case V4L2_CID_COLOR_KILLER:
 504         case V4L2_CID_MPEG_AUDIO_MUTE:
 505         case V4L2_CID_MPEG_VIDEO_MUTE:
 506         case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE:
 507         case V4L2_CID_MPEG_VIDEO_PULLDOWN:
 508         case V4L2_CID_EXPOSURE_AUTO_PRIORITY:
 509         case V4L2_CID_FOCUS_AUTO:
 510         case V4L2_CID_PRIVACY:
 511                 qctrl->type = V4L2_CTRL_TYPE_BOOLEAN;
 512                 min = 0;
 513                 max = step = 1;
 514                 break;
 515         case V4L2_CID_PAN_RESET:
 516         case V4L2_CID_TILT_RESET:
 517                 qctrl->type = V4L2_CTRL_TYPE_BUTTON;
 518                 qctrl->flags |= V4L2_CTRL_FLAG_WRITE_ONLY;
 519                 min = max = step = def = 0;
 520                 break;
 521         case V4L2_CID_POWER_LINE_FREQUENCY:
 522         case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ:
 523         case V4L2_CID_MPEG_AUDIO_ENCODING:
 524         case V4L2_CID_MPEG_AUDIO_L1_BITRATE:
 525         case V4L2_CID_MPEG_AUDIO_L2_BITRATE:
 526         case V4L2_CID_MPEG_AUDIO_L3_BITRATE:
 527         case V4L2_CID_MPEG_AUDIO_AC3_BITRATE:
 528         case V4L2_CID_MPEG_AUDIO_MODE:
 529         case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION:
 530         case V4L2_CID_MPEG_AUDIO_EMPHASIS:
 531         case V4L2_CID_MPEG_AUDIO_CRC:
 532         case V4L2_CID_MPEG_VIDEO_ENCODING:
 533         case V4L2_CID_MPEG_VIDEO_ASPECT:
 534         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
 535         case V4L2_CID_MPEG_STREAM_TYPE:
 536         case V4L2_CID_MPEG_STREAM_VBI_FMT:
 537         case V4L2_CID_EXPOSURE_AUTO:
 538         case V4L2_CID_COLORFX:
 539                 qctrl->type = V4L2_CTRL_TYPE_MENU;
 540                 step = 1;
 541                 break;
 542         case V4L2_CID_USER_CLASS:
 543         case V4L2_CID_CAMERA_CLASS:
 544         case V4L2_CID_MPEG_CLASS:
 545                 qctrl->type = V4L2_CTRL_TYPE_CTRL_CLASS;
 546                 qctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY;
 547                 min = max = step = def = 0;
 548                 break;
 549         default:
 550                 qctrl->type = V4L2_CTRL_TYPE_INTEGER;
 551                 break;
 552         }
 553         switch (qctrl->id) {
 554         case V4L2_CID_MPEG_AUDIO_ENCODING:
 555         case V4L2_CID_MPEG_AUDIO_MODE:
 556         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
 557         case V4L2_CID_MPEG_VIDEO_B_FRAMES:
 558         case V4L2_CID_MPEG_STREAM_TYPE:
 559                 qctrl->flags |= V4L2_CTRL_FLAG_UPDATE;
 560                 break;
 561         case V4L2_CID_AUDIO_VOLUME:
 562         case V4L2_CID_AUDIO_BALANCE:
 563         case V4L2_CID_AUDIO_BASS:
 564         case V4L2_CID_AUDIO_TREBLE:
 565         case V4L2_CID_BRIGHTNESS:
 566         case V4L2_CID_CONTRAST:
 567         case V4L2_CID_SATURATION:
 568         case V4L2_CID_HUE:
 569         case V4L2_CID_RED_BALANCE:
 570         case V4L2_CID_BLUE_BALANCE:
 571         case V4L2_CID_GAMMA:
 572                 qctrl->flags |= V4L2_CTRL_FLAG_SLIDER;
 573                 break;
 574         case V4L2_CID_PAN_RELATIVE:
 575         case V4L2_CID_TILT_RELATIVE:
 576         case V4L2_CID_FOCUS_RELATIVE:
 577         case V4L2_CID_ZOOM_RELATIVE:
 578                 qctrl->flags |= V4L2_CTRL_FLAG_WRITE_ONLY;
 579                 break;
 580         }
 581         qctrl->minimum = min;
 582         qctrl->maximum = max;
 583         qctrl->step = step;
 584         qctrl->default_value = def;
 585         qctrl->reserved[0] = qctrl->reserved[1] = 0;
 586         strlcpy(qctrl->name, name, sizeof(qctrl->name));
 587         return 0;
 588 }
 589 EXPORT_SYMBOL(v4l2_ctrl_query_fill);
 590
 591 /* Fill in a struct v4l2_queryctrl with standard values based on
 592    the control ID. */
 593 int v4l2_ctrl_query_fill_std(struct v4l2_queryctrl *qctrl)
 594 {
 595         switch (qctrl->id) {
 596         /* USER controls */
 597         case V4L2_CID_USER_CLASS:
 598         case V4L2_CID_MPEG_CLASS:
 599         case V4L2_CID_CAMERA_CLASS:
 600                 return v4l2_ctrl_query_fill(qctrl, 0, 0, 0, 0);
 601         case V4L2_CID_AUDIO_VOLUME:
 602                 return v4l2_ctrl_query_fill(qctrl, 0, 65535, 65535 / 100, 58880);
 603         case V4L2_CID_AUDIO_MUTE:
 604         case V4L2_CID_AUDIO_LOUDNESS:
 605                 return v4l2_ctrl_query_fill(qctrl, 0, 1, 1, 0);
 606         case V4L2_CID_AUDIO_BALANCE:
 607         case V4L2_CID_AUDIO_BASS:
 608         case V4L2_CID_AUDIO_TREBLE:
 609                 return v4l2_ctrl_query_fill(qctrl, 0, 65535, 65535 / 100, 32768);
 610         case V4L2_CID_BRIGHTNESS:
 611                 return v4l2_ctrl_query_fill(qctrl, 0, 255, 1, 128);
 612         case V4L2_CID_CONTRAST:
 613         case V4L2_CID_SATURATION:
 614                 return v4l2_ctrl_query_fill(qctrl, 0, 127, 1, 64);
 615         case V4L2_CID_HUE:
 616                 return v4l2_ctrl_query_fill(qctrl, -128, 127, 1, 0);
 617         case V4L2_CID_COLORFX:
 618                 return v4l2_ctrl_query_fill(qctrl, 0, 1, 1, 0);
 619
 620         /* MPEG controls */
 621         case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ:
 622                 return v4l2_ctrl_query_fill(qctrl,
 623                                 V4L2_MPEG_AUDIO_SAMPLING_FREQ_44100,
 624                                 V4L2_MPEG_AUDIO_SAMPLING_FREQ_32000, 1,
 625                                 V4L2_MPEG_AUDIO_SAMPLING_FREQ_48000);
 626         case V4L2_CID_MPEG_AUDIO_ENCODING:
 627                 return v4l2_ctrl_query_fill(qctrl,
 628                                 V4L2_MPEG_AUDIO_ENCODING_LAYER_1,
 629                                 V4L2_MPEG_AUDIO_ENCODING_AC3, 1,
 630                                 V4L2_MPEG_AUDIO_ENCODING_LAYER_2);
 631         case V4L2_CID_MPEG_AUDIO_L1_BITRATE:
 632                 return v4l2_ctrl_query_fill(qctrl,
 633                                 V4L2_MPEG_AUDIO_L1_BITRATE_32K,
 634                                 V4L2_MPEG_AUDIO_L1_BITRATE_448K, 1,
 635                                 V4L2_MPEG_AUDIO_L1_BITRATE_256K);
 636         case V4L2_CID_MPEG_AUDIO_L2_BITRATE:
 637                 return v4l2_ctrl_query_fill(qctrl,
 638                                 V4L2_MPEG_AUDIO_L2_BITRATE_32K,
 639                                 V4L2_MPEG_AUDIO_L2_BITRATE_384K, 1,
 640                                 V4L2_MPEG_AUDIO_L2_BITRATE_224K);
 641         case V4L2_CID_MPEG_AUDIO_L3_BITRATE:
 642                 return v4l2_ctrl_query_fill(qctrl,
 643                                 V4L2_MPEG_AUDIO_L3_BITRATE_32K,
 644                                 V4L2_MPEG_AUDIO_L3_BITRATE_320K, 1,
 645                                 V4L2_MPEG_AUDIO_L3_BITRATE_192K);
 646         case V4L2_CID_MPEG_AUDIO_AAC_BITRATE:
 647                 return v4l2_ctrl_query_fill(qctrl, 0, 6400, 1, 3200000);
 648         case V4L2_CID_MPEG_AUDIO_AC3_BITRATE:
 649                 return v4l2_ctrl_query_fill(qctrl,
 650                                 V4L2_MPEG_AUDIO_AC3_BITRATE_32K,
 651                                 V4L2_MPEG_AUDIO_AC3_BITRATE_640K, 1,
 652                                 V4L2_MPEG_AUDIO_AC3_BITRATE_384K);
 653         case V4L2_CID_MPEG_AUDIO_MODE:
 654                 return v4l2_ctrl_query_fill(qctrl,
 655                                 V4L2_MPEG_AUDIO_MODE_STEREO,
 656                                 V4L2_MPEG_AUDIO_MODE_MONO, 1,
 657                                 V4L2_MPEG_AUDIO_MODE_STEREO);
 658         case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION:
 659                 return v4l2_ctrl_query_fill(qctrl,
 660                                 V4L2_MPEG_AUDIO_MODE_EXTENSION_BOUND_4,
 661                                 V4L2_MPEG_AUDIO_MODE_EXTENSION_BOUND_16, 1,
 662                                 V4L2_MPEG_AUDIO_MODE_EXTENSION_BOUND_4);
 663         case V4L2_CID_MPEG_AUDIO_EMPHASIS:
 664                 return v4l2_ctrl_query_fill(qctrl,
 665                                 V4L2_MPEG_AUDIO_EMPHASIS_NONE,
 666                                 V4L2_MPEG_AUDIO_EMPHASIS_CCITT_J17, 1,
 667                                 V4L2_MPEG_AUDIO_EMPHASIS_NONE);
 668         case V4L2_CID_MPEG_AUDIO_CRC:
 669                 return v4l2_ctrl_query_fill(qctrl,
 670                                 V4L2_MPEG_AUDIO_CRC_NONE,
 671                                 V4L2_MPEG_AUDIO_CRC_CRC16, 1,
 672                                 V4L2_MPEG_AUDIO_CRC_NONE);
 673         case V4L2_CID_MPEG_AUDIO_MUTE:
 674                 return v4l2_ctrl_query_fill(qctrl, 0, 1, 1, 0);
 675         case V4L2_CID_MPEG_VIDEO_ENCODING:
 676                 return v4l2_ctrl_query_fill(qctrl,
 677                                 V4L2_MPEG_VIDEO_ENCODING_MPEG_1,
 678                                 V4L2_MPEG_VIDEO_ENCODING_MPEG_4_AVC, 1,
 679                                 V4L2_MPEG_VIDEO_ENCODING_MPEG_2);
 680         case V4L2_CID_MPEG_VIDEO_ASPECT:
 681                 return v4l2_ctrl_query_fill(qctrl,
 682                                 V4L2_MPEG_VIDEO_ASPECT_1x1,
 683                                 V4L2_MPEG_VIDEO_ASPECT_221x100, 1,
 684                                 V4L2_MPEG_VIDEO_ASPECT_4x3);
 685         case V4L2_CID_MPEG_VIDEO_B_FRAMES:
 686                 return v4l2_ctrl_query_fill(qctrl, 0, 33, 1, 2);
 687         case V4L2_CID_MPEG_VIDEO_GOP_SIZE:
 688                 return v4l2_ctrl_query_fill(qctrl, 1, 34, 1, 12);
 689         case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE:
 690                 return v4l2_ctrl_query_fill(qctrl, 0, 1, 1, 1);
 691         case V4L2_CID_MPEG_VIDEO_PULLDOWN:
 692                 return v4l2_ctrl_query_fill(qctrl, 0, 1, 1, 0);
 693         case V4L2_CID_MPEG_VIDEO_BITRATE_MODE:
 694                 return v4l2_ctrl_query_fill(qctrl,
 695                                 V4L2_MPEG_VIDEO_BITRATE_MODE_VBR,
 696                                 V4L2_MPEG_VIDEO_BITRATE_MODE_CBR, 1,
 697                                 V4L2_MPEG_VIDEO_BITRATE_MODE_VBR);
 698         case V4L2_CID_MPEG_VIDEO_BITRATE:
 699                 return v4l2_ctrl_query_fill(qctrl, 0, 27000000, 1, 6000000);
 700         case V4L2_CID_MPEG_VIDEO_BITRATE_PEAK:
 701                 return v4l2_ctrl_query_fill(qctrl, 0, 27000000, 1, 8000000);
 702         case V4L2_CID_MPEG_VIDEO_TEMPORAL_DECIMATION:
 703                 return v4l2_ctrl_query_fill(qctrl, 0, 255, 1, 0);
 704         case V4L2_CID_MPEG_VIDEO_MUTE:
 705                 return v4l2_ctrl_query_fill(qctrl, 0, 1, 1, 0);
 706         case V4L2_CID_MPEG_VIDEO_MUTE_YUV:  /* Init YUV (really YCbCr) to black */
 707                 return v4l2_ctrl_query_fill(qctrl, 0, 0xffffff, 1, 0x008080);
 708         case V4L2_CID_MPEG_STREAM_TYPE:
 709                 return v4l2_ctrl_query_fill(qctrl,
 710                                 V4L2_MPEG_STREAM_TYPE_MPEG2_PS,
 711                                 V4L2_MPEG_STREAM_TYPE_MPEG2_SVCD, 1,
 712                                 V4L2_MPEG_STREAM_TYPE_MPEG2_PS);
 713         case V4L2_CID_MPEG_STREAM_PID_PMT:
 714                 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 16);
 715         case V4L2_CID_MPEG_STREAM_PID_AUDIO:
 716                 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 260);
 717         case V4L2_CID_MPEG_STREAM_PID_VIDEO:
 718                 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 256);
 719         case V4L2_CID_MPEG_STREAM_PID_PCR:
 720                 return v4l2_ctrl_query_fill(qctrl, 0, (1 << 14) - 1, 1, 259);
 721         case V4L2_CID_MPEG_STREAM_PES_ID_AUDIO:
 722                 return v4l2_ctrl_query_fill(qctrl, 0, 255, 1, 0);
 723         case V4L2_CID_MPEG_STREAM_PES_ID_VIDEO:
 724                 return v4l2_ctrl_query_fill(qctrl, 0, 255, 1, 0);
 725         case V4L2_CID_MPEG_STREAM_VBI_FMT:
 726                 return v4l2_ctrl_query_fill(qctrl,
 727                                 V4L2_MPEG_STREAM_VBI_FMT_NONE,
 728                                 V4L2_MPEG_STREAM_VBI_FMT_IVTV, 1,
 729                                 V4L2_MPEG_STREAM_VBI_FMT_NONE);
 730         default:
 731                 return -EINVAL;
 732         }
 733 }
 734 EXPORT_SYMBOL(v4l2_ctrl_query_fill_std);
 735
 736 /* Fill in a struct v4l2_querymenu based on the struct v4l2_queryctrl and
 737    the menu. The qctrl pointer may be NULL, in which case it is ignored.
 738    If menu_items is NULL, then the menu items are retrieved using
 739    v4l2_ctrl_get_menu. */
 740 int v4l2_ctrl_query_menu(struct v4l2_querymenu *qmenu, struct v4l2_queryctrl *qctrl,
 741                const char **menu_items)
 742 {
 743         int i;
 744
 745         qmenu->reserved = 0;
 746         if (menu_items == NULL)
 747                 menu_items = v4l2_ctrl_get_menu(qmenu->id);
 748         if (menu_items == NULL ||
 749             (qctrl && (qmenu->index < qctrl->minimum || qmenu->index > qctrl->maximum)))
 750                 return -EINVAL;
 751         for (i = 0; i < qmenu->index && menu_items[i]; i++) ;
 752         if (menu_items[i] == NULL || menu_items[i][0] == '\0')
 753                 return -EINVAL;
 754         strlcpy(qmenu->name, menu_items[qmenu->index], sizeof(qmenu->name));
 755         return 0;
 756 }
 757 EXPORT_SYMBOL(v4l2_ctrl_query_menu);
 758
 759 /* Fill in a struct v4l2_querymenu based on the specified array of valid
 760    menu items (terminated by V4L2_CTRL_MENU_IDS_END).
 761    Use this if there are 'holes' in the list of valid menu items. */
 762 int v4l2_ctrl_query_menu_valid_items(struct v4l2_querymenu *qmenu, const u32 *ids)
 763 {
 764         const char **menu_items = v4l2_ctrl_get_menu(qmenu->id);
 765
 766         qmenu->reserved = 0;
 767         if (menu_items == NULL || ids == NULL)
 768                 return -EINVAL;
 769         while (*ids != V4L2_CTRL_MENU_IDS_END) {
 770                 if (*ids++ == qmenu->index) {
 771                         strlcpy(qmenu->name, menu_items[qmenu->index],
 772                                         sizeof(qmenu->name));
 773                         return 0;
 774                 }
 775         }
 776         return -EINVAL;
 777 }
 778 EXPORT_SYMBOL(v4l2_ctrl_query_menu_valid_items);
 779
 780 /* ctrl_classes points to an array of u32 pointers, the last element is
 781    a NULL pointer. Each u32 array is a 0-terminated array of control IDs.
 782    Each array must be sorted low to high and belong to the same control
 783    class. The array of u32 pointers must also be sorted, from low class IDs
 784    to high class IDs.
 785
 786    This function returns the first ID that follows after the given ID.
 787    When no more controls are available 0 is returned. */
 788 u32 v4l2_ctrl_next(const u32 * const * ctrl_classes, u32 id)
 789 {
 790         u32 ctrl_class = V4L2_CTRL_ID2CLASS(id);
 791         const u32 *pctrl;
 792
 793         if (ctrl_classes == NULL)
 794                 return 0;
 795
 796         /* if no query is desired, then check if the ID is part of ctrl_classes */
 797         if ((id & V4L2_CTRL_FLAG_NEXT_CTRL) == 0) {
 798                 /* find class */
 799                 while (*ctrl_classes && V4L2_CTRL_ID2CLASS(**ctrl_classes) != ctrl_class)
 800                         ctrl_classes++;
 801                 if (*ctrl_classes == NULL)
 802                         return 0;
 803                 pctrl = *ctrl_classes;
 804                 /* find control ID */
 805                 while (*pctrl && *pctrl != id) pctrl++;
 806                 return *pctrl ? id : 0;
 807         }
 808         id &= V4L2_CTRL_ID_MASK;
 809         id++;   /* select next control */
 810         /* find first class that matches (or is greater than) the class of
 811            the ID */
 812         while (*ctrl_classes && V4L2_CTRL_ID2CLASS(**ctrl_classes) < ctrl_class)
 813                 ctrl_classes++;
 814         /* no more classes */
 815         if (*ctrl_classes == NULL)
 816                 return 0;
 817         pctrl = *ctrl_classes;
 818         /* find first ctrl within the class that is >= ID */
 819         while (*pctrl && *pctrl < id) pctrl++;
 820         if (*pctrl)
 821                 return *pctrl;
 822         /* we are at the end of the controls of the current class. */
 823         /* continue with next class if available */
 824         ctrl_classes++;
 825         if (*ctrl_classes == NULL)
 826                 return 0;
 827         return **ctrl_classes;
 828 }
 829 EXPORT_SYMBOL(v4l2_ctrl_next);
 830
 831 int v4l2_chip_match_host(const struct v4l2_dbg_match *match)
 832 {
 833         switch (match->type) {
 834         case V4L2_CHIP_MATCH_HOST:
 835                 return match->addr == 0;
 836         default:
 837                 return 0;
 838         }
 839 }
 840 EXPORT_SYMBOL(v4l2_chip_match_host);
 841
 842 #if defined(CONFIG_I2C) || (defined(CONFIG_I2C_MODULE) && defined(MODULE))
 843 int v4l2_chip_match_i2c_client(struct i2c_client *c, const struct v4l2_dbg_match *match)
 844 {
 845         int len;
 846
 847         if (c == NULL || match == NULL)
 848                 return 0;
 849
 850         switch (match->type) {
 851         case V4L2_CHIP_MATCH_I2C_DRIVER:
 852                 if (c->driver == NULL || c->driver->driver.name == NULL)
 853                         return 0;
 854                 len = strlen(c->driver->driver.name);
 855                 /* legacy drivers have a ' suffix, don't try to match that */
 856                 if (len && c->driver->driver.name[len - 1] == '\'')
 857                         len--;
 858                 return len && !strncmp(c->driver->driver.name, match->name, len);
 859         case V4L2_CHIP_MATCH_I2C_ADDR:
 860                 return c->addr == match->addr;
 861         default:
 862                 return 0;
 863         }
 864 }
 865 EXPORT_SYMBOL(v4l2_chip_match_i2c_client);
 866
 867 int v4l2_chip_ident_i2c_client(struct i2c_client *c, struct v4l2_dbg_chip_ident *chip,
 868                 u32 ident, u32 revision)
 869 {
 870         if (!v4l2_chip_match_i2c_client(c, &chip->match))
 871                 return 0;
 872         if (chip->ident == V4L2_IDENT_NONE) {
 873                 chip->ident = ident;
 874                 chip->revision = revision;
 875         }
 876         else {
 877                 chip->ident = V4L2_IDENT_AMBIGUOUS;
 878                 chip->revision = 0;
 879         }
 880         return 0;
 881 }
 882 EXPORT_SYMBOL(v4l2_chip_ident_i2c_client);
 883
 884 /* ----------------------------------------------------------------- */
 885
 886 /* Helper function for I2C legacy drivers */
 887
 888 int v4l2_i2c_attach(struct i2c_adapter *adapter, int address, struct i2c_driver *driver,
 889                 const char *name,
 890                 int (*probe)(struct i2c_client *, const struct i2c_device_id *))
 891 {
 892         struct i2c_client *client;
 893         int err;
 894
 895         client = kzalloc(sizeof(struct i2c_client), GFP_KERNEL);
 896         if (!client)
 897                 return -ENOMEM;
 898
 899         client->addr = address;
 900         client->adapter = adapter;
 901         client->driver = driver;
 902         strlcpy(client->name, name, sizeof(client->name));
 903
 904         err = probe(client, NULL);
 905         if (err == 0) {
 906                 i2c_attach_client(client);
 907         } else {
 908                 kfree(client);
 909         }
 910         return err != -ENOMEM ? 0 : err;
 911 }
 912 EXPORT_SYMBOL(v4l2_i2c_attach);
 913
 914 void v4l2_i2c_subdev_init(struct v4l2_subdev *sd, struct i2c_client *client,
 915                 const struct v4l2_subdev_ops *ops)
 916 {
 917         v4l2_subdev_init(sd, ops);
 918         /* the owner is the same as the i2c_client's driver owner */
 919         sd->owner = client->driver->driver.owner;
 920         /* i2c_client and v4l2_subdev point to one another */
 921         v4l2_set_subdevdata(sd, client);
 922         i2c_set_clientdata(client, sd);
 923         /* initialize name */
 924         snprintf(sd->name, sizeof(sd->name), "%s %d-%04x",
 925                 client->driver->driver.name, i2c_adapter_id(client->adapter),
 926                 client->addr);
 927 }
 928 EXPORT_SYMBOL_GPL(v4l2_i2c_subdev_init);
 929
 930
 931
 932 /* Load an i2c sub-device. It assumes that i2c_get_adapdata(adapter)
 933    returns the v4l2_device and that i2c_get_clientdata(client)
 934    returns the v4l2_subdev. */
 935 struct v4l2_subdev *v4l2_i2c_new_subdev(struct i2c_adapter *adapter,
 936                 const char *module_name, const char *client_type, u8 addr)
 937 {
 938         struct v4l2_device *dev = i2c_get_adapdata(adapter);
 939         struct v4l2_subdev *sd = NULL;
 940         struct i2c_client *client;
 941         struct i2c_board_info info;
 942
 943         BUG_ON(!dev);
 944 #ifdef MODULE
 945         if (module_name)
 946                 request_module(module_name);
 947 #endif
 948         /* Setup the i2c board info with the device type and
 949            the device address. */
 950         memset(&info, 0, sizeof(info));
 951         strlcpy(info.type, client_type, sizeof(info.type));
 952         info.addr = addr;
 953
 954         /* Create the i2c client */
 955         client = i2c_new_device(adapter, &info);
 956         /* Note: it is possible in the future that
 957            c->driver is NULL if the driver is still being loaded.
 958            We need better support from the kernel so that we
 959            can easily wait for the load to finish. */
 960         if (client == NULL || client->driver == NULL)
 961                 return NULL;
 962
 963         /* Lock the module so we can safely get the v4l2_subdev pointer */
 964         if (!try_module_get(client->driver->driver.owner))
 965                 return NULL;
 966         sd = i2c_get_clientdata(client);
 967
 968         /* Register with the v4l2_device which increases the module's
 969            use count as well. */
 970         if (v4l2_device_register_subdev(dev, sd))
 971                 sd = NULL;
 972         /* Decrease the module use count to match the first try_module_get. */
 973         module_put(client->driver->driver.owner);
 974         return sd;
 975
 976 }
 977 EXPORT_SYMBOL_GPL(v4l2_i2c_new_subdev);
 978
 979 /* Probe and load an i2c sub-device. It assumes that i2c_get_adapdata(adapter)
 980    returns the v4l2_device and that i2c_get_clientdata(client)
 981    returns the v4l2_subdev. */
 982 struct v4l2_subdev *v4l2_i2c_new_probed_subdev(struct i2c_adapter *adapter,
 983         const char *module_name, const char *client_type,
 984         const unsigned short *addrs)
 985 {
 986         struct v4l2_device *dev = i2c_get_adapdata(adapter);
 987         struct v4l2_subdev *sd = NULL;
 988         struct i2c_client *client = NULL;
 989         struct i2c_board_info info;
 990
 991         BUG_ON(!dev);
 992 #ifdef MODULE
 993         if (module_name)
 994                 request_module(module_name);
 995 #endif
 996         /* Setup the i2c board info with the device type and
 997            the device address. */
 998         memset(&info, 0, sizeof(info));
 999         strlcpy(info.type, client_type, sizeof(info.type));
1000
1001         /* Probe and create the i2c client */
1002         client = i2c_new_probed_device(adapter, &info, addrs);
1003         /* Note: it is possible in the future that
1004            c->driver is NULL if the driver is still being loaded.
1005            We need better support from the kernel so that we
1006            can easily wait for the load to finish. */
1007         if (client == NULL || client->driver == NULL)
1008                 return NULL;
1009
1010         /* Lock the module so we can safely get the v4l2_subdev pointer */
1011         if (!try_module_get(client->driver->driver.owner))
1012                 return NULL;
1013         sd = i2c_get_clientdata(client);
1014
1015         /* Register with the v4l2_device which increases the module's
1016            use count as well. */
1017         if (v4l2_device_register_subdev(dev, sd))
1018                 sd = NULL;
1019         /* Decrease the module use count to match the first try_module_get. */
1020         module_put(client->driver->driver.owner);
1021         return sd;
1022 }
1023 EXPORT_SYMBOL_GPL(v4l2_i2c_new_probed_subdev);
1024
1025 /* Return i2c client address of v4l2_subdev. */
1026 unsigned short v4l2_i2c_subdev_addr(struct v4l2_subdev *sd)
1027 {
1028         struct i2c_client *client = v4l2_get_subdevdata(sd);
1029
1030         return client ? client->addr : I2C_CLIENT_END;
1031 }
1032 EXPORT_SYMBOL_GPL(v4l2_i2c_subdev_addr);
1033
1034 /* Return a list of I2C tuner addresses to probe. Use only if the tuner
1035    addresses are unknown. */
1036 const unsigned short *v4l2_i2c_tuner_addrs(enum v4l2_i2c_tuner_type type)
1037 {
1038         static const unsigned short radio_addrs[] = {
1039 #if defined(CONFIG_MEDIA_TUNER_TEA5761) || defined(CONFIG_MEDIA_TUNER_TEA5761_MODULE)
1040                 0x10,
1041 #endif
1042                 0x60,
1043                 I2C_CLIENT_END
1044         };
1045         static const unsigned short demod_addrs[] = {
1046                 0x42, 0x43, 0x4a, 0x4b,
1047                 I2C_CLIENT_END
1048         };
1049         static const unsigned short tv_addrs[] = {
1050                 0x42, 0x43, 0x4a, 0x4b,         /* tda8290 */
1051                 0x60, 0x61, 0x62, 0x63, 0x64, 0x65, 0x66, 0x67,
1052                 0x68, 0x69, 0x6a, 0x6b, 0x6c, 0x6d, 0x6e, 0x6f,
1053                 I2C_CLIENT_END
1054         };
1055
1056         switch (type) {
1057         case ADDRS_RADIO:
1058                 return radio_addrs;
1059         case ADDRS_DEMOD:
1060                 return demod_addrs;
1061         case ADDRS_TV:
1062                 return tv_addrs;
1063         case ADDRS_TV_WITH_DEMOD:
1064                 return tv_addrs + 4;
1065         }
1066         return NULL;
1067 }
1068 EXPORT_SYMBOL_GPL(v4l2_i2c_tuner_addrs);
1069
1070 #endif