| /* |
| * Video for Linux Two |
| * |
| * A generic video device interface for the LINUX operating system |
| * using a set of device structures/vectors for low level operations. |
| * |
| * This file replaces the videodev.c file that comes with the |
| * regular kernel distribution. |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License |
| * as published by the Free Software Foundation; either version |
| * 2 of the License, or (at your option) any later version. |
| * |
| * Author: Bill Dirks <bill@thedirks.org> |
| * based on code by Alan Cox, <alan@cymru.net> |
| * |
| */ |
| |
| /* |
| * Video capture interface for Linux |
| * |
| * A generic video device interface for the LINUX operating system |
| * using a set of device structures/vectors for low level operations. |
| * |
| * This program is free software; you can redistribute it and/or |
| * modify it under the terms of the GNU General Public License |
| * as published by the Free Software Foundation; either version |
| * 2 of the License, or (at your option) any later version. |
| * |
| * Author: Alan Cox, <alan@lxorguk.ukuu.org.uk> |
| * |
| * Fixes: |
| */ |
| |
| /* |
| * Video4linux 1/2 integration by Justin Schoeman |
| * <justin@suntiger.ee.up.ac.za> |
| * 2.4 PROCFS support ported from 2.4 kernels by |
| * Iñaki García Etxebarria <garetxe@euskalnet.net> |
| * Makefile fix by "W. Michael Petullo" <mike@flyn.org> |
| * 2.4 devfs support ported from 2.4 kernels by |
| * Dan Merillat <dan@merillat.org> |
| * Added Gerd Knorrs v4l1 enhancements (Justin Schoeman) |
| */ |
| |
| #include <linux/module.h> |
| #include <linux/types.h> |
| #include <linux/kernel.h> |
| #include <linux/mm.h> |
| #include <linux/string.h> |
| #include <linux/errno.h> |
| #include <linux/i2c.h> |
| #include <asm/uaccess.h> |
| #include <asm/system.h> |
| #include <asm/pgtable.h> |
| #include <asm/io.h> |
| #include <asm/div64.h> |
| #define __OLD_VIDIOC_ /* To allow fixing old calls*/ |
| #include <media/v4l2-common.h> |
| #include <media/v4l2-device.h> |
| #include <media/v4l2-chip-ident.h> |
| |
| #include <linux/videodev2.h> |
| |
| MODULE_AUTHOR("Bill Dirks, Justin Schoeman, Gerd Knorr"); |
| MODULE_DESCRIPTION("misc helper functions for v4l2 device drivers"); |
| MODULE_LICENSE("GPL"); |
| |
| /* |
| * |
| * V 4 L 2 D R I V E R H E L P E R A P I |
| * |
| */ |
| |
| /* |
| * Video Standard Operations (contributed by Michael Schimek) |
| */ |
| |
| |
| /* ----------------------------------------------------------------- */ |
| /* priority handling */ |
| |
| #define V4L2_PRIO_VALID(val) (val == V4L2_PRIORITY_BACKGROUND || \ |
| val == V4L2_PRIORITY_INTERACTIVE || \ |
| val == V4L2_PRIORITY_RECORD) |
| |
| int v4l2_prio_init(struct v4l2_prio_state *global) |
| { |
| memset(global,0,sizeof(*global)); |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_prio_init); |
| |
| int v4l2_prio_change(struct v4l2_prio_state *global, enum v4l2_priority *local, |
| enum v4l2_priority new) |
| { |
| if (!V4L2_PRIO_VALID(new)) |
| return -EINVAL; |
| if (*local == new) |
| return 0; |
| |
| atomic_inc(&global->prios[new]); |
| if (V4L2_PRIO_VALID(*local)) |
| atomic_dec(&global->prios[*local]); |
| *local = new; |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_prio_change); |
| |
| int v4l2_prio_open(struct v4l2_prio_state *global, enum v4l2_priority *local) |
| { |
| return v4l2_prio_change(global,local,V4L2_PRIORITY_DEFAULT); |
| } |
| EXPORT_SYMBOL(v4l2_prio_open); |
| |
| int v4l2_prio_close(struct v4l2_prio_state *global, enum v4l2_priority *local) |
| { |
| if (V4L2_PRIO_VALID(*local)) |
| atomic_dec(&global->prios[*local]); |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_prio_close); |
| |
| enum v4l2_priority v4l2_prio_max(struct v4l2_prio_state *global) |
| { |
| if (atomic_read(&global->prios[V4L2_PRIORITY_RECORD]) > 0) |
| return V4L2_PRIORITY_RECORD; |
| if (atomic_read(&global->prios[V4L2_PRIORITY_INTERACTIVE]) > 0) |
| return V4L2_PRIORITY_INTERACTIVE; |
| if (atomic_read(&global->prios[V4L2_PRIORITY_BACKGROUND]) > 0) |
| return V4L2_PRIORITY_BACKGROUND; |
| return V4L2_PRIORITY_UNSET; |
| } |
| EXPORT_SYMBOL(v4l2_prio_max); |
| |
| int v4l2_prio_check(struct v4l2_prio_state *global, enum v4l2_priority *local) |
| { |
| if (*local < v4l2_prio_max(global)) |
| return -EBUSY; |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_prio_check); |
| |
| /* ----------------------------------------------------------------- */ |
| |
| /* Helper functions for control handling */ |
| |
| /* Check for correctness of the ctrl's value based on the data from |
| struct v4l2_queryctrl and the available menu items. Note that |
| menu_items may be NULL, in that case it is ignored. */ |
| int v4l2_ctrl_check(struct v4l2_ext_control *ctrl, struct v4l2_queryctrl *qctrl, |
| const char **menu_items) |
| { |
| if (qctrl->flags & V4L2_CTRL_FLAG_DISABLED) |
| return -EINVAL; |
| if (qctrl->flags & V4L2_CTRL_FLAG_GRABBED) |
| return -EBUSY; |
| if (qctrl->type == V4L2_CTRL_TYPE_STRING) |
| return 0; |
| if (qctrl->type == V4L2_CTRL_TYPE_BUTTON || |
| qctrl->type == V4L2_CTRL_TYPE_INTEGER64 || |
| qctrl->type == V4L2_CTRL_TYPE_CTRL_CLASS) |
| return 0; |
| if (ctrl->value < qctrl->minimum || ctrl->value > qctrl->maximum) |
| return -ERANGE; |
| if (qctrl->type == V4L2_CTRL_TYPE_MENU && menu_items != NULL) { |
| if (menu_items[ctrl->value] == NULL || |
| menu_items[ctrl->value][0] == '\0') |
| return -EINVAL; |
| } |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_ctrl_check); |
| |
| /* Returns NULL or a character pointer array containing the menu for |
| the given control ID. The pointer array ends with a NULL pointer. |
| An empty string signifies a menu entry that is invalid. This allows |
| drivers to disable certain options if it is not supported. */ |
| const char **v4l2_ctrl_get_menu(u32 id) |
| { |
| static const char *mpeg_audio_sampling_freq[] = { |
| "44.1 kHz", |
| "48 kHz", |
| "32 kHz", |
| NULL |
| }; |
| static const char *mpeg_audio_encoding[] = { |
| "MPEG-1/2 Layer I", |
| "MPEG-1/2 Layer II", |
| "MPEG-1/2 Layer III", |
| "MPEG-2/4 AAC", |
| "AC-3", |
| NULL |
| }; |
| static const char *mpeg_audio_l1_bitrate[] = { |
| "32 kbps", |
| "64 kbps", |
| "96 kbps", |
| "128 kbps", |
| "160 kbps", |
| "192 kbps", |
| "224 kbps", |
| "256 kbps", |
| "288 kbps", |
| "320 kbps", |
| "352 kbps", |
| "384 kbps", |
| "416 kbps", |
| "448 kbps", |
| NULL |
| }; |
| static const char *mpeg_audio_l2_bitrate[] = { |
| "32 kbps", |
| "48 kbps", |
| "56 kbps", |
| "64 kbps", |
| "80 kbps", |
| "96 kbps", |
| "112 kbps", |
| "128 kbps", |
| "160 kbps", |
| "192 kbps", |
| "224 kbps", |
| "256 kbps", |
| "320 kbps", |
| "384 kbps", |
| NULL |
| }; |
| static const char *mpeg_audio_l3_bitrate[] = { |
| "32 kbps", |
| "40 kbps", |
| "48 kbps", |
| "56 kbps", |
| "64 kbps", |
| "80 kbps", |
| "96 kbps", |
| "112 kbps", |
| "128 kbps", |
| "160 kbps", |
| "192 kbps", |
| "224 kbps", |
| "256 kbps", |
| "320 kbps", |
| NULL |
| }; |
| static const char *mpeg_audio_ac3_bitrate[] = { |
| "32 kbps", |
| "40 kbps", |
| "48 kbps", |
| "56 kbps", |
| "64 kbps", |
| "80 kbps", |
| "96 kbps", |
| "112 kbps", |
| "128 kbps", |
| "160 kbps", |
| "192 kbps", |
| "224 kbps", |
| "256 kbps", |
| "320 kbps", |
| "384 kbps", |
| "448 kbps", |
| "512 kbps", |
| "576 kbps", |
| "640 kbps", |
| NULL |
| }; |
| static const char *mpeg_audio_mode[] = { |
| "Stereo", |
| "Joint Stereo", |
| "Dual", |
| "Mono", |
| NULL |
| }; |
| static const char *mpeg_audio_mode_extension[] = { |
| "Bound 4", |
| "Bound 8", |
| "Bound 12", |
| "Bound 16", |
| NULL |
| }; |
| static const char *mpeg_audio_emphasis[] = { |
| "No Emphasis", |
| "50/15 us", |
| "CCITT J17", |
| NULL |
| }; |
| static const char *mpeg_audio_crc[] = { |
| "No CRC", |
| "16-bit CRC", |
| NULL |
| }; |
| static const char *mpeg_video_encoding[] = { |
| "MPEG-1", |
| "MPEG-2", |
| "MPEG-4 AVC", |
| NULL |
| }; |
| static const char *mpeg_video_aspect[] = { |
| "1x1", |
| "4x3", |
| "16x9", |
| "2.21x1", |
| NULL |
| }; |
| static const char *mpeg_video_bitrate_mode[] = { |
| "Variable Bitrate", |
| "Constant Bitrate", |
| NULL |
| }; |
| static const char *mpeg_stream_type[] = { |
| "MPEG-2 Program Stream", |
| "MPEG-2 Transport Stream", |
| "MPEG-1 System Stream", |
| "MPEG-2 DVD-compatible Stream", |
| "MPEG-1 VCD-compatible Stream", |
| "MPEG-2 SVCD-compatible Stream", |
| NULL |
| }; |
| static const char *mpeg_stream_vbi_fmt[] = { |
| "No VBI", |
| "Private packet, IVTV format", |
| NULL |
| }; |
| static const char *camera_power_line_frequency[] = { |
| "Disabled", |
| "50 Hz", |
| "60 Hz", |
| NULL |
| }; |
| static const char *camera_exposure_auto[] = { |
| "Auto Mode", |
| "Manual Mode", |
| "Shutter Priority Mode", |
| "Aperture Priority Mode", |
| NULL |
| }; |
| static const char *colorfx[] = { |
| "None", |
| "Black & White", |
| "Sepia", |
| NULL |
| }; |
| static const char *tune_preemphasis[] = { |
| "No preemphasis", |
| "50 useconds", |
| "75 useconds", |
| NULL, |
| }; |
| |
| switch (id) { |
| case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: |
| return mpeg_audio_sampling_freq; |
| case V4L2_CID_MPEG_AUDIO_ENCODING: |
| return mpeg_audio_encoding; |
| case V4L2_CID_MPEG_AUDIO_L1_BITRATE: |
| return mpeg_audio_l1_bitrate; |
| case V4L2_CID_MPEG_AUDIO_L2_BITRATE: |
| return mpeg_audio_l2_bitrate; |
| case V4L2_CID_MPEG_AUDIO_L3_BITRATE: |
| return mpeg_audio_l3_bitrate; |
| case V4L2_CID_MPEG_AUDIO_AC3_BITRATE: |
| return mpeg_audio_ac3_bitrate; |
| case V4L2_CID_MPEG_AUDIO_MODE: |
| return mpeg_audio_mode; |
| case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION: |
| return mpeg_audio_mode_extension; |
| case V4L2_CID_MPEG_AUDIO_EMPHASIS: |
| return mpeg_audio_emphasis; |
| case V4L2_CID_MPEG_AUDIO_CRC: |
| return mpeg_audio_crc; |
| case V4L2_CID_MPEG_VIDEO_ENCODING: |
| return mpeg_video_encoding; |
| case V4L2_CID_MPEG_VIDEO_ASPECT: |
| return mpeg_video_aspect; |
| case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: |
| return mpeg_video_bitrate_mode; |
| case V4L2_CID_MPEG_STREAM_TYPE: |
| return mpeg_stream_type; |
| case V4L2_CID_MPEG_STREAM_VBI_FMT: |
| return mpeg_stream_vbi_fmt; |
| case V4L2_CID_POWER_LINE_FREQUENCY: |
| return camera_power_line_frequency; |
| case V4L2_CID_EXPOSURE_AUTO: |
| return camera_exposure_auto; |
| case V4L2_CID_COLORFX: |
| return colorfx; |
| case V4L2_CID_TUNE_PREEMPHASIS: |
| return tune_preemphasis; |
| default: |
| return NULL; |
| } |
| } |
| EXPORT_SYMBOL(v4l2_ctrl_get_menu); |
| |
| /* Return the control name. */ |
| const char *v4l2_ctrl_get_name(u32 id) |
| { |
| switch (id) { |
| /* USER controls */ |
| case V4L2_CID_USER_CLASS: return "User Controls"; |
| case V4L2_CID_BRIGHTNESS: return "Brightness"; |
| case V4L2_CID_CONTRAST: return "Contrast"; |
| case V4L2_CID_SATURATION: return "Saturation"; |
| case V4L2_CID_HUE: return "Hue"; |
| case V4L2_CID_AUDIO_VOLUME: return "Volume"; |
| case V4L2_CID_AUDIO_BALANCE: return "Balance"; |
| case V4L2_CID_AUDIO_BASS: return "Bass"; |
| case V4L2_CID_AUDIO_TREBLE: return "Treble"; |
| case V4L2_CID_AUDIO_MUTE: return "Mute"; |
| case V4L2_CID_AUDIO_LOUDNESS: return "Loudness"; |
| case V4L2_CID_BLACK_LEVEL: return "Black Level"; |
| case V4L2_CID_AUTO_WHITE_BALANCE: return "White Balance, Automatic"; |
| case V4L2_CID_DO_WHITE_BALANCE: return "Do White Balance"; |
| case V4L2_CID_RED_BALANCE: return "Red Balance"; |
| case V4L2_CID_BLUE_BALANCE: return "Blue Balance"; |
| case V4L2_CID_GAMMA: return "Gamma"; |
| case V4L2_CID_EXPOSURE: return "Exposure"; |
| case V4L2_CID_AUTOGAIN: return "Gain, Automatic"; |
| case V4L2_CID_GAIN: return "Gain"; |
| case V4L2_CID_HFLIP: return "Horizontal Flip"; |
| case V4L2_CID_VFLIP: return "Vertical Flip"; |
| case V4L2_CID_HCENTER: return "Horizontal Center"; |
| case V4L2_CID_VCENTER: return "Vertical Center"; |
| case V4L2_CID_POWER_LINE_FREQUENCY: return "Power Line Frequency"; |
| case V4L2_CID_HUE_AUTO: return "Hue, Automatic"; |
| case V4L2_CID_WHITE_BALANCE_TEMPERATURE: return "White Balance Temperature"; |
| case V4L2_CID_SHARPNESS: return "Sharpness"; |
| case V4L2_CID_BACKLIGHT_COMPENSATION: return "Backlight Compensation"; |
| case V4L2_CID_CHROMA_AGC: return "Chroma AGC"; |
| case V4L2_CID_COLOR_KILLER: return "Color Killer"; |
| case V4L2_CID_COLORFX: return "Color Effects"; |
| |
| /* MPEG controls */ |
| case V4L2_CID_MPEG_CLASS: return "MPEG Encoder Controls"; |
| case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: return "Audio Sampling Frequency"; |
| case V4L2_CID_MPEG_AUDIO_ENCODING: return "Audio Encoding"; |
| case V4L2_CID_MPEG_AUDIO_L1_BITRATE: return "Audio Layer I Bitrate"; |
| case V4L2_CID_MPEG_AUDIO_L2_BITRATE: return "Audio Layer II Bitrate"; |
| case V4L2_CID_MPEG_AUDIO_L3_BITRATE: return "Audio Layer III Bitrate"; |
| case V4L2_CID_MPEG_AUDIO_AAC_BITRATE: return "Audio AAC Bitrate"; |
| case V4L2_CID_MPEG_AUDIO_AC3_BITRATE: return "Audio AC-3 Bitrate"; |
| case V4L2_CID_MPEG_AUDIO_MODE: return "Audio Stereo Mode"; |
| case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION: return "Audio Stereo Mode Extension"; |
| case V4L2_CID_MPEG_AUDIO_EMPHASIS: return "Audio Emphasis"; |
| case V4L2_CID_MPEG_AUDIO_CRC: return "Audio CRC"; |
| case V4L2_CID_MPEG_AUDIO_MUTE: return "Audio Mute"; |
| case V4L2_CID_MPEG_VIDEO_ENCODING: return "Video Encoding"; |
| case V4L2_CID_MPEG_VIDEO_ASPECT: return "Video Aspect"; |
| case V4L2_CID_MPEG_VIDEO_B_FRAMES: return "Video B Frames"; |
| case V4L2_CID_MPEG_VIDEO_GOP_SIZE: return "Video GOP Size"; |
| case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE: return "Video GOP Closure"; |
| case V4L2_CID_MPEG_VIDEO_PULLDOWN: return "Video Pulldown"; |
| case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: return "Video Bitrate Mode"; |
| case V4L2_CID_MPEG_VIDEO_BITRATE: return "Video Bitrate"; |
| case V4L2_CID_MPEG_VIDEO_BITRATE_PEAK: return "Video Peak Bitrate"; |
| case V4L2_CID_MPEG_VIDEO_TEMPORAL_DECIMATION: return "Video Temporal Decimation"; |
| case V4L2_CID_MPEG_VIDEO_MUTE: return "Video Mute"; |
| case V4L2_CID_MPEG_VIDEO_MUTE_YUV: return "Video Mute YUV"; |
| case V4L2_CID_MPEG_STREAM_TYPE: return "Stream Type"; |
| case V4L2_CID_MPEG_STREAM_PID_PMT: return "Stream PMT Program ID"; |
| case V4L2_CID_MPEG_STREAM_PID_AUDIO: return "Stream Audio Program ID"; |
| case V4L2_CID_MPEG_STREAM_PID_VIDEO: return "Stream Video Program ID"; |
| case V4L2_CID_MPEG_STREAM_PID_PCR: return "Stream PCR Program ID"; |
| case V4L2_CID_MPEG_STREAM_PES_ID_AUDIO: return "Stream PES Audio ID"; |
| case V4L2_CID_MPEG_STREAM_PES_ID_VIDEO: return "Stream PES Video ID"; |
| case V4L2_CID_MPEG_STREAM_VBI_FMT: return "Stream VBI Format"; |
| |
| /* CAMERA controls */ |
| case V4L2_CID_CAMERA_CLASS: return "Camera Controls"; |
| case V4L2_CID_EXPOSURE_AUTO: return "Auto Exposure"; |
| case V4L2_CID_EXPOSURE_ABSOLUTE: return "Exposure Time, Absolute"; |
| case V4L2_CID_EXPOSURE_AUTO_PRIORITY: return "Exposure, Dynamic Framerate"; |
| case V4L2_CID_PAN_RELATIVE: return "Pan, Relative"; |
| case V4L2_CID_TILT_RELATIVE: return "Tilt, Relative"; |
| case V4L2_CID_PAN_RESET: return "Pan, Reset"; |
| case V4L2_CID_TILT_RESET: return "Tilt, Reset"; |
| case V4L2_CID_PAN_ABSOLUTE: return "Pan, Absolute"; |
| case V4L2_CID_TILT_ABSOLUTE: return "Tilt, Absolute"; |
| case V4L2_CID_FOCUS_ABSOLUTE: return "Focus, Absolute"; |
| case V4L2_CID_FOCUS_RELATIVE: return "Focus, Relative"; |
| case V4L2_CID_FOCUS_AUTO: return "Focus, Automatic"; |
| case V4L2_CID_ZOOM_ABSOLUTE: return "Zoom, Absolute"; |
| case V4L2_CID_ZOOM_RELATIVE: return "Zoom, Relative"; |
| case V4L2_CID_ZOOM_CONTINUOUS: return "Zoom, Continuous"; |
| case V4L2_CID_PRIVACY: return "Privacy"; |
| |
| /* FM Radio Modulator control */ |
| case V4L2_CID_FM_TX_CLASS: return "FM Radio Modulator Controls"; |
| case V4L2_CID_RDS_TX_DEVIATION: return "RDS Signal Deviation"; |
| case V4L2_CID_RDS_TX_PI: return "RDS Program ID"; |
| case V4L2_CID_RDS_TX_PTY: return "RDS Program Type"; |
| case V4L2_CID_RDS_TX_PS_NAME: return "RDS PS Name"; |
| case V4L2_CID_RDS_TX_RADIO_TEXT: return "RDS Radio Text"; |
| case V4L2_CID_AUDIO_LIMITER_ENABLED: return "Audio Limiter Feature Enabled"; |
| case V4L2_CID_AUDIO_LIMITER_RELEASE_TIME: return "Audio Limiter Release Time"; |
| case V4L2_CID_AUDIO_LIMITER_DEVIATION: return "Audio Limiter Deviation"; |
| case V4L2_CID_AUDIO_COMPRESSION_ENABLED: return "Audio Compression Feature Enabled"; |
| case V4L2_CID_AUDIO_COMPRESSION_GAIN: return "Audio Compression Gain"; |
| case V4L2_CID_AUDIO_COMPRESSION_THRESHOLD: return "Audio Compression Threshold"; |
| case V4L2_CID_AUDIO_COMPRESSION_ATTACK_TIME: return "Audio Compression Attack Time"; |
| case V4L2_CID_AUDIO_COMPRESSION_RELEASE_TIME: return "Audio Compression Release Time"; |
| case V4L2_CID_PILOT_TONE_ENABLED: return "Pilot Tone Feature Enabled"; |
| case V4L2_CID_PILOT_TONE_DEVIATION: return "Pilot Tone Deviation"; |
| case V4L2_CID_PILOT_TONE_FREQUENCY: return "Pilot Tone Frequency"; |
| case V4L2_CID_TUNE_PREEMPHASIS: return "Pre-emphasis settings"; |
| case V4L2_CID_TUNE_POWER_LEVEL: return "Tune Power Level"; |
| case V4L2_CID_TUNE_ANTENNA_CAPACITOR: return "Tune Antenna Capacitor"; |
| |
| default: |
| return NULL; |
| } |
| } |
| EXPORT_SYMBOL(v4l2_ctrl_get_name); |
| |
| /* Fill in a struct v4l2_queryctrl */ |
| int v4l2_ctrl_query_fill(struct v4l2_queryctrl *qctrl, s32 min, s32 max, s32 step, s32 def) |
| { |
| const char *name = v4l2_ctrl_get_name(qctrl->id); |
| |
| qctrl->flags = 0; |
| if (name == NULL) |
| return -EINVAL; |
| |
| switch (qctrl->id) { |
| case V4L2_CID_AUDIO_MUTE: |
| case V4L2_CID_AUDIO_LOUDNESS: |
| case V4L2_CID_AUTO_WHITE_BALANCE: |
| case V4L2_CID_AUTOGAIN: |
| case V4L2_CID_HFLIP: |
| case V4L2_CID_VFLIP: |
| case V4L2_CID_HUE_AUTO: |
| case V4L2_CID_CHROMA_AGC: |
| case V4L2_CID_COLOR_KILLER: |
| case V4L2_CID_MPEG_AUDIO_MUTE: |
| case V4L2_CID_MPEG_VIDEO_MUTE: |
| case V4L2_CID_MPEG_VIDEO_GOP_CLOSURE: |
| case V4L2_CID_MPEG_VIDEO_PULLDOWN: |
| case V4L2_CID_EXPOSURE_AUTO_PRIORITY: |
| case V4L2_CID_FOCUS_AUTO: |
| case V4L2_CID_PRIVACY: |
| case V4L2_CID_AUDIO_LIMITER_ENABLED: |
| case V4L2_CID_AUDIO_COMPRESSION_ENABLED: |
| case V4L2_CID_PILOT_TONE_ENABLED: |
| qctrl->type = V4L2_CTRL_TYPE_BOOLEAN; |
| min = 0; |
| max = step = 1; |
| break; |
| case V4L2_CID_PAN_RESET: |
| case V4L2_CID_TILT_RESET: |
| qctrl->type = V4L2_CTRL_TYPE_BUTTON; |
| qctrl->flags |= V4L2_CTRL_FLAG_WRITE_ONLY; |
| min = max = step = def = 0; |
| break; |
| case V4L2_CID_POWER_LINE_FREQUENCY: |
| case V4L2_CID_MPEG_AUDIO_SAMPLING_FREQ: |
| case V4L2_CID_MPEG_AUDIO_ENCODING: |
| case V4L2_CID_MPEG_AUDIO_L1_BITRATE: |
| case V4L2_CID_MPEG_AUDIO_L2_BITRATE: |
| case V4L2_CID_MPEG_AUDIO_L3_BITRATE: |
| case V4L2_CID_MPEG_AUDIO_AC3_BITRATE: |
| case V4L2_CID_MPEG_AUDIO_MODE: |
| case V4L2_CID_MPEG_AUDIO_MODE_EXTENSION: |
| case V4L2_CID_MPEG_AUDIO_EMPHASIS: |
| case V4L2_CID_MPEG_AUDIO_CRC: |
| case V4L2_CID_MPEG_VIDEO_ENCODING: |
| case V4L2_CID_MPEG_VIDEO_ASPECT: |
| case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: |
| case V4L2_CID_MPEG_STREAM_TYPE: |
| case V4L2_CID_MPEG_STREAM_VBI_FMT: |
| case V4L2_CID_EXPOSURE_AUTO: |
| case V4L2_CID_COLORFX: |
| case V4L2_CID_TUNE_PREEMPHASIS: |
| qctrl->type = V4L2_CTRL_TYPE_MENU; |
| step = 1; |
| break; |
| case V4L2_CID_RDS_TX_PS_NAME: |
| case V4L2_CID_RDS_TX_RADIO_TEXT: |
| qctrl->type = V4L2_CTRL_TYPE_STRING; |
| break; |
| case V4L2_CID_USER_CLASS: |
| case V4L2_CID_CAMERA_CLASS: |
| case V4L2_CID_MPEG_CLASS: |
| case V4L2_CID_FM_TX_CLASS: |
| qctrl->type = V4L2_CTRL_TYPE_CTRL_CLASS; |
| qctrl->flags |= V4L2_CTRL_FLAG_READ_ONLY; |
| min = max = step = def = 0; |
| break; |
| default: |
| qctrl->type = V4L2_CTRL_TYPE_INTEGER; |
| break; |
| } |
| switch (qctrl->id) { |
| case V4L2_CID_MPEG_AUDIO_ENCODING: |
| case V4L2_CID_MPEG_AUDIO_MODE: |
| case V4L2_CID_MPEG_VIDEO_BITRATE_MODE: |
| case V4L2_CID_MPEG_VIDEO_B_FRAMES: |
| case V4L2_CID_MPEG_STREAM_TYPE: |
| qctrl->flags |= V4L2_CTRL_FLAG_UPDATE; |
| break; |
| case V4L2_CID_AUDIO_VOLUME: |
| case V4L2_CID_AUDIO_BALANCE: |
| case V4L2_CID_AUDIO_BASS: |
| case V4L2_CID_AUDIO_TREBLE: |
| case V4L2_CID_BRIGHTNESS: |
| case V4L2_CID_CONTRAST: |
| case V4L2_CID_SATURATION: |
| case V4L2_CID_HUE: |
| case V4L2_CID_RED_BALANCE: |
| case V4L2_CID_BLUE_BALANCE: |
| case V4L2_CID_GAMMA: |
| case V4L2_CID_SHARPNESS: |
| case V4L2_CID_RDS_TX_DEVIATION: |
| case V4L2_CID_AUDIO_LIMITER_RELEASE_TIME: |
| case V4L2_CID_AUDIO_LIMITER_DEVIATION: |
| case V4L2_CID_AUDIO_COMPRESSION_GAIN: |
| case V4L2_CID_AUDIO_COMPRESSION_THRESHOLD: |
| case V4L2_CID_AUDIO_COMPRESSION_ATTACK_TIME: |
| case V4L2_CID_AUDIO_COMPRESSION_RELEASE_TIME: |
| case V4L2_CID_PILOT_TONE_DEVIATION: |
| case V4L2_CID_PILOT_TONE_FREQUENCY: |
| case V4L2_CID_TUNE_POWER_LEVEL: |
| case V4L2_CID_TUNE_ANTENNA_CAPACITOR: |
| qctrl->flags |= V4L2_CTRL_FLAG_SLIDER; |
| break; |
| case V4L2_CID_PAN_RELATIVE: |
| case V4L2_CID_TILT_RELATIVE: |
| case V4L2_CID_FOCUS_RELATIVE: |
| case V4L2_CID_ZOOM_RELATIVE: |
| qctrl->flags |= V4L2_CTRL_FLAG_WRITE_ONLY; |
| break; |
| } |
| qctrl->minimum = min; |
| qctrl->maximum = max; |
| qctrl->step = step; |
| qctrl->default_value = def; |
| qctrl->reserved[0] = qctrl->reserved[1] = 0; |
| strlcpy(qctrl->name, name, sizeof(qctrl->name)); |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_ctrl_query_fill); |
| |
| /* Fill in a struct v4l2_querymenu based on the struct v4l2_queryctrl and |
| the menu. The qctrl pointer may be NULL, in which case it is ignored. |
| If menu_items is NULL, then the menu items are retrieved using |
| v4l2_ctrl_get_menu. */ |
| int v4l2_ctrl_query_menu(struct v4l2_querymenu *qmenu, struct v4l2_queryctrl *qctrl, |
| const char **menu_items) |
| { |
| int i; |
| |
| qmenu->reserved = 0; |
| if (menu_items == NULL) |
| menu_items = v4l2_ctrl_get_menu(qmenu->id); |
| if (menu_items == NULL || |
| (qctrl && (qmenu->index < qctrl->minimum || qmenu->index > qctrl->maximum))) |
| return -EINVAL; |
| for (i = 0; i < qmenu->index && menu_items[i]; i++) ; |
| if (menu_items[i] == NULL || menu_items[i][0] == '\0') |
| return -EINVAL; |
| strlcpy(qmenu->name, menu_items[qmenu->index], sizeof(qmenu->name)); |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_ctrl_query_menu); |
| |
| /* Fill in a struct v4l2_querymenu based on the specified array of valid |
| menu items (terminated by V4L2_CTRL_MENU_IDS_END). |
| Use this if there are 'holes' in the list of valid menu items. */ |
| int v4l2_ctrl_query_menu_valid_items(struct v4l2_querymenu *qmenu, const u32 *ids) |
| { |
| const char **menu_items = v4l2_ctrl_get_menu(qmenu->id); |
| |
| qmenu->reserved = 0; |
| if (menu_items == NULL || ids == NULL) |
| return -EINVAL; |
| while (*ids != V4L2_CTRL_MENU_IDS_END) { |
| if (*ids++ == qmenu->index) { |
| strlcpy(qmenu->name, menu_items[qmenu->index], |
| sizeof(qmenu->name)); |
| return 0; |
| } |
| } |
| return -EINVAL; |
| } |
| EXPORT_SYMBOL(v4l2_ctrl_query_menu_valid_items); |
| |
| /* ctrl_classes points to an array of u32 pointers, the last element is |
| a NULL pointer. Each u32 array is a 0-terminated array of control IDs. |
| Each array must be sorted low to high and belong to the same control |
| class. The array of u32 pointers must also be sorted, from low class IDs |
| to high class IDs. |
| |
| This function returns the first ID that follows after the given ID. |
| When no more controls are available 0 is returned. */ |
| u32 v4l2_ctrl_next(const u32 * const * ctrl_classes, u32 id) |
| { |
| u32 ctrl_class = V4L2_CTRL_ID2CLASS(id); |
| const u32 *pctrl; |
| |
| if (ctrl_classes == NULL) |
| return 0; |
| |
| /* if no query is desired, then check if the ID is part of ctrl_classes */ |
| if ((id & V4L2_CTRL_FLAG_NEXT_CTRL) == 0) { |
| /* find class */ |
| while (*ctrl_classes && V4L2_CTRL_ID2CLASS(**ctrl_classes) != ctrl_class) |
| ctrl_classes++; |
| if (*ctrl_classes == NULL) |
| return 0; |
| pctrl = *ctrl_classes; |
| /* find control ID */ |
| while (*pctrl && *pctrl != id) pctrl++; |
| return *pctrl ? id : 0; |
| } |
| id &= V4L2_CTRL_ID_MASK; |
| id++; /* select next control */ |
| /* find first class that matches (or is greater than) the class of |
| the ID */ |
| while (*ctrl_classes && V4L2_CTRL_ID2CLASS(**ctrl_classes) < ctrl_class) |
| ctrl_classes++; |
| /* no more classes */ |
| if (*ctrl_classes == NULL) |
| return 0; |
| pctrl = *ctrl_classes; |
| /* find first ctrl within the class that is >= ID */ |
| while (*pctrl && *pctrl < id) pctrl++; |
| if (*pctrl) |
| return *pctrl; |
| /* we are at the end of the controls of the current class. */ |
| /* continue with next class if available */ |
| ctrl_classes++; |
| if (*ctrl_classes == NULL) |
| return 0; |
| return **ctrl_classes; |
| } |
| EXPORT_SYMBOL(v4l2_ctrl_next); |
| |
| int v4l2_chip_match_host(const struct v4l2_dbg_match *match) |
| { |
| switch (match->type) { |
| case V4L2_CHIP_MATCH_HOST: |
| return match->addr == 0; |
| default: |
| return 0; |
| } |
| } |
| EXPORT_SYMBOL(v4l2_chip_match_host); |
| |
| #if defined(CONFIG_I2C) || (defined(CONFIG_I2C_MODULE) && defined(MODULE)) |
| int v4l2_chip_match_i2c_client(struct i2c_client *c, const struct v4l2_dbg_match *match) |
| { |
| int len; |
| |
| if (c == NULL || match == NULL) |
| return 0; |
| |
| switch (match->type) { |
| case V4L2_CHIP_MATCH_I2C_DRIVER: |
| if (c->driver == NULL || c->driver->driver.name == NULL) |
| return 0; |
| len = strlen(c->driver->driver.name); |
| /* legacy drivers have a ' suffix, don't try to match that */ |
| if (len && c->driver->driver.name[len - 1] == '\'') |
| len--; |
| return len && !strncmp(c->driver->driver.name, match->name, len); |
| case V4L2_CHIP_MATCH_I2C_ADDR: |
| return c->addr == match->addr; |
| default: |
| return 0; |
| } |
| } |
| EXPORT_SYMBOL(v4l2_chip_match_i2c_client); |
| |
| int v4l2_chip_ident_i2c_client(struct i2c_client *c, struct v4l2_dbg_chip_ident *chip, |
| u32 ident, u32 revision) |
| { |
| if (!v4l2_chip_match_i2c_client(c, &chip->match)) |
| return 0; |
| if (chip->ident == V4L2_IDENT_NONE) { |
| chip->ident = ident; |
| chip->revision = revision; |
| } |
| else { |
| chip->ident = V4L2_IDENT_AMBIGUOUS; |
| chip->revision = 0; |
| } |
| return 0; |
| } |
| EXPORT_SYMBOL(v4l2_chip_ident_i2c_client); |
| |
| /* ----------------------------------------------------------------- */ |
| |
| /* I2C Helper functions */ |
| |
| |
| void v4l2_i2c_subdev_init(struct v4l2_subdev *sd, struct i2c_client *client, |
| const struct v4l2_subdev_ops *ops) |
| { |
| v4l2_subdev_init(sd, ops); |
| sd->flags |= V4L2_SUBDEV_FL_IS_I2C; |
| /* the owner is the same as the i2c_client's driver owner */ |
| sd->owner = client->driver->driver.owner; |
| /* i2c_client and v4l2_subdev point to one another */ |
| v4l2_set_subdevdata(sd, client); |
| i2c_set_clientdata(client, sd); |
| /* initialize name */ |
| snprintf(sd->name, sizeof(sd->name), "%s %d-%04x", |
| client->driver->driver.name, i2c_adapter_id(client->adapter), |
| client->addr); |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_subdev_init); |
| |
| |
| |
| /* Load an i2c sub-device. */ |
| struct v4l2_subdev *v4l2_i2c_new_subdev(struct v4l2_device *v4l2_dev, |
| struct i2c_adapter *adapter, |
| const char *module_name, const char *client_type, u8 addr) |
| { |
| struct v4l2_subdev *sd = NULL; |
| struct i2c_client *client; |
| struct i2c_board_info info; |
| |
| BUG_ON(!v4l2_dev); |
| |
| if (module_name) |
| request_module(module_name); |
| |
| /* Setup the i2c board info with the device type and |
| the device address. */ |
| memset(&info, 0, sizeof(info)); |
| strlcpy(info.type, client_type, sizeof(info.type)); |
| info.addr = addr; |
| |
| /* Create the i2c client */ |
| client = i2c_new_device(adapter, &info); |
| /* Note: it is possible in the future that |
| c->driver is NULL if the driver is still being loaded. |
| We need better support from the kernel so that we |
| can easily wait for the load to finish. */ |
| if (client == NULL || client->driver == NULL) |
| goto error; |
| |
| /* Lock the module so we can safely get the v4l2_subdev pointer */ |
| if (!try_module_get(client->driver->driver.owner)) |
| goto error; |
| sd = i2c_get_clientdata(client); |
| |
| /* Register with the v4l2_device which increases the module's |
| use count as well. */ |
| if (v4l2_device_register_subdev(v4l2_dev, sd)) |
| sd = NULL; |
| /* Decrease the module use count to match the first try_module_get. */ |
| module_put(client->driver->driver.owner); |
| |
| if (sd) { |
| /* We return errors from v4l2_subdev_call only if we have the |
| callback as the .s_config is not mandatory */ |
| int err = v4l2_subdev_call(sd, core, s_config, 0, NULL); |
| |
| if (err && err != -ENOIOCTLCMD) { |
| v4l2_device_unregister_subdev(sd); |
| sd = NULL; |
| } |
| } |
| |
| error: |
| /* If we have a client but no subdev, then something went wrong and |
| we must unregister the client. */ |
| if (client && sd == NULL) |
| i2c_unregister_device(client); |
| return sd; |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_new_subdev); |
| |
| /* Probe and load an i2c sub-device. */ |
| struct v4l2_subdev *v4l2_i2c_new_probed_subdev(struct v4l2_device *v4l2_dev, |
| struct i2c_adapter *adapter, |
| const char *module_name, const char *client_type, |
| const unsigned short *addrs) |
| { |
| struct v4l2_subdev *sd = NULL; |
| struct i2c_client *client = NULL; |
| struct i2c_board_info info; |
| |
| BUG_ON(!v4l2_dev); |
| |
| if (module_name) |
| request_module(module_name); |
| |
| /* Setup the i2c board info with the device type and |
| the device address. */ |
| memset(&info, 0, sizeof(info)); |
| strlcpy(info.type, client_type, sizeof(info.type)); |
| |
| /* Probe and create the i2c client */ |
| client = i2c_new_probed_device(adapter, &info, addrs); |
| /* Note: it is possible in the future that |
| c->driver is NULL if the driver is still being loaded. |
| We need better support from the kernel so that we |
| can easily wait for the load to finish. */ |
| if (client == NULL || client->driver == NULL) |
| goto error; |
| |
| /* Lock the module so we can safely get the v4l2_subdev pointer */ |
| if (!try_module_get(client->driver->driver.owner)) |
| goto error; |
| sd = i2c_get_clientdata(client); |
| |
| /* Register with the v4l2_device which increases the module's |
| use count as well. */ |
| if (v4l2_device_register_subdev(v4l2_dev, sd)) |
| sd = NULL; |
| /* Decrease the module use count to match the first try_module_get. */ |
| module_put(client->driver->driver.owner); |
| |
| if (sd) { |
| /* We return errors from v4l2_subdev_call only if we have the |
| callback as the .s_config is not mandatory */ |
| int err = v4l2_subdev_call(sd, core, s_config, 0, NULL); |
| |
| if (err && err != -ENOIOCTLCMD) { |
| v4l2_device_unregister_subdev(sd); |
| sd = NULL; |
| } |
| } |
| |
| error: |
| /* If we have a client but no subdev, then something went wrong and |
| we must unregister the client. */ |
| if (client && sd == NULL) |
| i2c_unregister_device(client); |
| return sd; |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_new_probed_subdev); |
| |
| struct v4l2_subdev *v4l2_i2c_new_probed_subdev_addr(struct v4l2_device *v4l2_dev, |
| struct i2c_adapter *adapter, |
| const char *module_name, const char *client_type, u8 addr) |
| { |
| unsigned short addrs[2] = { addr, I2C_CLIENT_END }; |
| |
| return v4l2_i2c_new_probed_subdev(v4l2_dev, adapter, |
| module_name, client_type, addrs); |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_new_probed_subdev_addr); |
| |
| /* Load an i2c sub-device. */ |
| struct v4l2_subdev *v4l2_i2c_new_subdev_board(struct v4l2_device *v4l2_dev, |
| struct i2c_adapter *adapter, const char *module_name, |
| struct i2c_board_info *info, const unsigned short *probe_addrs) |
| { |
| struct v4l2_subdev *sd = NULL; |
| struct i2c_client *client; |
| |
| BUG_ON(!v4l2_dev); |
| |
| if (module_name) |
| request_module(module_name); |
| |
| /* Create the i2c client */ |
| if (info->addr == 0 && probe_addrs) |
| client = i2c_new_probed_device(adapter, info, probe_addrs); |
| else |
| client = i2c_new_device(adapter, info); |
| |
| /* Note: by loading the module first we are certain that c->driver |
| will be set if the driver was found. If the module was not loaded |
| first, then the i2c core tries to delay-load the module for us, |
| and then c->driver is still NULL until the module is finally |
| loaded. This delay-load mechanism doesn't work if other drivers |
| want to use the i2c device, so explicitly loading the module |
| is the best alternative. */ |
| if (client == NULL || client->driver == NULL) |
| goto error; |
| |
| /* Lock the module so we can safely get the v4l2_subdev pointer */ |
| if (!try_module_get(client->driver->driver.owner)) |
| goto error; |
| sd = i2c_get_clientdata(client); |
| |
| /* Register with the v4l2_device which increases the module's |
| use count as well. */ |
| if (v4l2_device_register_subdev(v4l2_dev, sd)) |
| sd = NULL; |
| /* Decrease the module use count to match the first try_module_get. */ |
| module_put(client->driver->driver.owner); |
| |
| if (sd) { |
| /* We return errors from v4l2_subdev_call only if we have the |
| callback as the .s_config is not mandatory */ |
| int err = v4l2_subdev_call(sd, core, s_config, |
| info->irq, info->platform_data); |
| |
| if (err && err != -ENOIOCTLCMD) { |
| v4l2_device_unregister_subdev(sd); |
| sd = NULL; |
| } |
| } |
| |
| error: |
| /* If we have a client but no subdev, then something went wrong and |
| we must unregister the client. */ |
| if (client && sd == NULL) |
| i2c_unregister_device(client); |
| return sd; |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_new_subdev_board); |
| |
| struct v4l2_subdev *v4l2_i2c_new_subdev_cfg(struct v4l2_device *v4l2_dev, |
| struct i2c_adapter *adapter, |
| const char *module_name, const char *client_type, |
| int irq, void *platform_data, |
| u8 addr, const unsigned short *probe_addrs) |
| { |
| struct i2c_board_info info; |
| |
| /* Setup the i2c board info with the device type and |
| the device address. */ |
| memset(&info, 0, sizeof(info)); |
| strlcpy(info.type, client_type, sizeof(info.type)); |
| info.addr = addr; |
| info.irq = irq; |
| info.platform_data = platform_data; |
| |
| return v4l2_i2c_new_subdev_board(v4l2_dev, adapter, module_name, |
| &info, probe_addrs); |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_new_subdev_cfg); |
| |
| /* Return i2c client address of v4l2_subdev. */ |
| unsigned short v4l2_i2c_subdev_addr(struct v4l2_subdev *sd) |
| { |
| struct i2c_client *client = v4l2_get_subdevdata(sd); |
| |
| return client ? client->addr : I2C_CLIENT_END; |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_subdev_addr); |
| |
| /* Return a list of I2C tuner addresses to probe. Use only if the tuner |
| addresses are unknown. */ |
| const unsigned short *v4l2_i2c_tuner_addrs(enum v4l2_i2c_tuner_type type) |
| { |
| static const unsigned short radio_addrs[] = { |
| #if defined(CONFIG_MEDIA_TUNER_TEA5761) || defined(CONFIG_MEDIA_TUNER_TEA5761_MODULE) |
| 0x10, |
| #endif |
| 0x60, |
| I2C_CLIENT_END |
| }; |
| static const unsigned short demod_addrs[] = { |
| 0x42, 0x43, 0x4a, 0x4b, |
| I2C_CLIENT_END |
| }; |
| static const unsigned short tv_addrs[] = { |
| 0x42, 0x43, 0x4a, 0x4b, /* tda8290 */ |
| 0x60, 0x61, 0x62, 0x63, 0x64, |
| I2C_CLIENT_END |
| }; |
| |
| switch (type) { |
| case ADDRS_RADIO: |
| return radio_addrs; |
| case ADDRS_DEMOD: |
| return demod_addrs; |
| case ADDRS_TV: |
| return tv_addrs; |
| case ADDRS_TV_WITH_DEMOD: |
| return tv_addrs + 4; |
| } |
| return NULL; |
| } |
| EXPORT_SYMBOL_GPL(v4l2_i2c_tuner_addrs); |
| |
| #endif /* defined(CONFIG_I2C) */ |
| |
| /* Clamp x to be between min and max, aligned to a multiple of 2^align. min |
| * and max don't have to be aligned, but there must be at least one valid |
| * value. E.g., min=17,max=31,align=4 is not allowed as there are no multiples |
| * of 16 between 17 and 31. */ |
| static unsigned int clamp_align(unsigned int x, unsigned int min, |
| unsigned int max, unsigned int align) |
| { |
| /* Bits that must be zero to be aligned */ |
| unsigned int mask = ~((1 << align) - 1); |
| |
| /* Round to nearest aligned value */ |
| if (align) |
| x = (x + (1 << (align - 1))) & mask; |
| |
| /* Clamp to aligned value of min and max */ |
| if (x < min) |
| x = (min + ~mask) & mask; |
| else if (x > max) |
| x = max & mask; |
| |
| return x; |
| } |
| |
| /* Bound an image to have a width between wmin and wmax, and height between |
| * hmin and hmax, inclusive. Additionally, the width will be a multiple of |
| * 2^walign, the height will be a multiple of 2^halign, and the overall size |
| * (width*height) will be a multiple of 2^salign. The image may be shrunk |
| * or enlarged to fit the alignment constraints. |
| * |
| * The width or height maximum must not be smaller than the corresponding |
| * minimum. The alignments must not be so high there are no possible image |
| * sizes within the allowed bounds. wmin and hmin must be at least 1 |
| * (don't use 0). If you don't care about a certain alignment, specify 0, |
| * as 2^0 is 1 and one byte alignment is equivalent to no alignment. If |
| * you only want to adjust downward, specify a maximum that's the same as |
| * the initial value. |
| */ |
| void v4l_bound_align_image(u32 *w, unsigned int wmin, unsigned int wmax, |
| unsigned int walign, |
| u32 *h, unsigned int hmin, unsigned int hmax, |
| unsigned int halign, unsigned int salign) |
| { |
| *w = clamp_align(*w, wmin, wmax, walign); |
| *h = clamp_align(*h, hmin, hmax, halign); |
| |
| /* Usually we don't need to align the size and are done now. */ |
| if (!salign) |
| return; |
| |
| /* How much alignment do we have? */ |
| walign = __ffs(*w); |
| halign = __ffs(*h); |
| /* Enough to satisfy the image alignment? */ |
| if (walign + halign < salign) { |
| /* Max walign where there is still a valid width */ |
| unsigned int wmaxa = __fls(wmax ^ (wmin - 1)); |
| /* Max halign where there is still a valid height */ |
| unsigned int hmaxa = __fls(hmax ^ (hmin - 1)); |
| |
| /* up the smaller alignment until we have enough */ |
| do { |
| if (halign >= hmaxa || |
| (walign <= halign && walign < wmaxa)) { |
| *w = clamp_align(*w, wmin, wmax, walign + 1); |
| walign = __ffs(*w); |
| } else { |
| *h = clamp_align(*h, hmin, hmax, halign + 1); |
| halign = __ffs(*h); |
| } |
| } while (halign + walign < salign); |
| } |
| } |
| EXPORT_SYMBOL_GPL(v4l_bound_align_image); |