mirror of
				https://github.com/nyanmisaka/ffmpeg-rockchip.git
				synced 2025-10-31 12:36:41 +08:00 
			
		
		
		
	 98663a0bb8
			
		
	
	98663a0bb8
	
	
	
		
			
			ff_filter_get_nb_threads() respect AVFilterContext.nb_threads and graph->nb_threads both, in most case, we perfer this API than using ctx->graph->nb_threads directly. Reviewed-by: Steven Liu <lq@onvideo.cn> Reviewed-by: Paul B Mahol <onemda@gmail.com> Signed-off-by: Jun Zhao <barryjzhao@tencent.com>
		
			
				
	
	
		
			549 lines
		
	
	
		
			26 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			549 lines
		
	
	
		
			26 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| /*
 | |
|  * Copyright (C) 2007 by Andrew Zabolotny (author of lensfun, from which this filter derives from)
 | |
|  * Copyright (C) 2018 Stephen Seo
 | |
|  *
 | |
|  * This file is part of FFmpeg.
 | |
|  *
 | |
|  * 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 3 of the License, or
 | |
|  * (at your option) any later version.
 | |
|  *
 | |
|  * This program is distributed in the hope that it will be useful,
 | |
|  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 | |
|  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | |
|  * GNU General Public License for more details.
 | |
|  *
 | |
|  * You should have received a copy of the GNU General Public License
 | |
|  * along with this program.  If not, see <https://www.gnu.org/licenses/>.
 | |
|  */
 | |
| 
 | |
| /**
 | |
|  * @file
 | |
|  * Lensfun filter, applies lens correction with parameters from the lensfun database
 | |
|  *
 | |
|  * @see https://lensfun.sourceforge.net/
 | |
|  */
 | |
| 
 | |
| #include <float.h>
 | |
| #include <math.h>
 | |
| 
 | |
| #include "libavutil/avassert.h"
 | |
| #include "libavutil/imgutils.h"
 | |
| #include "libavutil/opt.h"
 | |
| #include "libswscale/swscale.h"
 | |
| #include "avfilter.h"
 | |
| #include "formats.h"
 | |
| #include "internal.h"
 | |
| #include "video.h"
 | |
| 
 | |
| #include <lensfun.h>
 | |
| 
 | |
| #define LANCZOS_RESOLUTION 256
 | |
| 
 | |
| enum Mode {
 | |
|     VIGNETTING = 0x1,
 | |
|     GEOMETRY_DISTORTION = 0x2,
 | |
|     SUBPIXEL_DISTORTION = 0x4
 | |
| };
 | |
| 
 | |
| enum InterpolationType {
 | |
|     NEAREST,
 | |
|     LINEAR,
 | |
|     LANCZOS
 | |
| };
 | |
| 
 | |
| typedef struct VignettingThreadData {
 | |
|     int width, height;
 | |
|     uint8_t *data_in;
 | |
|     int linesize_in;
 | |
|     int pixel_composition;
 | |
|     lfModifier *modifier;
 | |
| } VignettingThreadData;
 | |
| 
 | |
| typedef struct DistortionCorrectionThreadData {
 | |
|     int width, height;
 | |
|     const float *distortion_coords;
 | |
|     const uint8_t *data_in;
 | |
|     uint8_t *data_out;
 | |
|     int linesize_in, linesize_out;
 | |
|     const float *interpolation;
 | |
|     int mode;
 | |
|     int interpolation_type;
 | |
| } DistortionCorrectionThreadData;
 | |
| 
 | |
| typedef struct LensfunContext {
 | |
|     const AVClass *class;
 | |
|     const char *make, *model, *lens_model;
 | |
|     int mode;
 | |
|     float focal_length;
 | |
|     float aperture;
 | |
|     float focus_distance;
 | |
|     float scale;
 | |
|     int target_geometry;
 | |
|     int reverse;
 | |
|     int interpolation_type;
 | |
| 
 | |
|     float *distortion_coords;
 | |
|     float *interpolation;
 | |
| 
 | |
|     lfLens *lens;
 | |
|     lfCamera *camera;
 | |
|     lfModifier *modifier;
 | |
| } LensfunContext;
 | |
| 
 | |
| #define OFFSET(x) offsetof(LensfunContext, x)
 | |
| #define FLAGS AV_OPT_FLAG_FILTERING_PARAM|AV_OPT_FLAG_VIDEO_PARAM
 | |
| static const AVOption lensfun_options[] = {
 | |
|     { "make", "set camera maker", OFFSET(make), AV_OPT_TYPE_STRING, {.str=NULL}, 0, 0, FLAGS },
 | |
|     { "model", "set camera model", OFFSET(model), AV_OPT_TYPE_STRING, {.str=NULL}, 0, 0, FLAGS },
 | |
|     { "lens_model", "set lens model", OFFSET(lens_model), AV_OPT_TYPE_STRING, {.str=NULL}, 0, 0, FLAGS },
 | |
|     { "mode", "set mode", OFFSET(mode), AV_OPT_TYPE_INT, {.i64=GEOMETRY_DISTORTION}, 0, VIGNETTING | GEOMETRY_DISTORTION | SUBPIXEL_DISTORTION, FLAGS, "mode" },
 | |
|         { "vignetting", "fix lens vignetting", 0, AV_OPT_TYPE_CONST, {.i64=VIGNETTING}, 0, 0, FLAGS, "mode" },
 | |
|         { "geometry", "correct geometry distortion", 0, AV_OPT_TYPE_CONST, {.i64=GEOMETRY_DISTORTION}, 0, 0, FLAGS, "mode" },
 | |
|         { "subpixel", "fix chromatic aberrations", 0, AV_OPT_TYPE_CONST, {.i64=SUBPIXEL_DISTORTION}, 0, 0, FLAGS, "mode" },
 | |
|         { "vig_geo", "fix lens vignetting and correct geometry distortion", 0, AV_OPT_TYPE_CONST, {.i64=VIGNETTING | GEOMETRY_DISTORTION}, 0, 0, FLAGS, "mode" },
 | |
|         { "vig_subpixel", "fix lens vignetting and chromatic aberrations", 0, AV_OPT_TYPE_CONST, {.i64=VIGNETTING | SUBPIXEL_DISTORTION}, 0, 0, FLAGS, "mode" },
 | |
|         { "distortion", "correct geometry distortion and chromatic aberrations", 0, AV_OPT_TYPE_CONST, {.i64=GEOMETRY_DISTORTION | SUBPIXEL_DISTORTION}, 0, 0, FLAGS, "mode" },
 | |
|         { "all", NULL, 0, AV_OPT_TYPE_CONST, {.i64=VIGNETTING | GEOMETRY_DISTORTION | SUBPIXEL_DISTORTION}, 0, 0, FLAGS, "mode" },
 | |
|     { "focal_length", "focal length of video (zoom; constant for the duration of the use of this filter)", OFFSET(focal_length), AV_OPT_TYPE_FLOAT, {.dbl=18}, 0.0, DBL_MAX, FLAGS },
 | |
|     { "aperture", "aperture (constant for the duration of the use of this filter)", OFFSET(aperture), AV_OPT_TYPE_FLOAT, {.dbl=3.5}, 0.0, DBL_MAX, FLAGS },
 | |
|     { "focus_distance", "focus distance (constant for the duration of the use of this filter)", OFFSET(focus_distance), AV_OPT_TYPE_FLOAT, {.dbl=1000.0f}, 0.0, DBL_MAX, FLAGS },
 | |
|     { "scale", "scale factor applied after corrections (0.0 means automatic scaling)", OFFSET(scale), AV_OPT_TYPE_FLOAT, {.dbl=0.0}, 0.0, DBL_MAX, FLAGS },
 | |
|     { "target_geometry", "target geometry of the lens correction (only when geometry correction is enabled)", OFFSET(target_geometry), AV_OPT_TYPE_INT, {.i64=LF_RECTILINEAR}, 0, INT_MAX, FLAGS, "lens_geometry" },
 | |
|         { "rectilinear", "rectilinear lens (default)", 0, AV_OPT_TYPE_CONST, {.i64=LF_RECTILINEAR}, 0, 0, FLAGS, "lens_geometry" },
 | |
|         { "fisheye", "fisheye lens", 0, AV_OPT_TYPE_CONST, {.i64=LF_FISHEYE}, 0, 0, FLAGS, "lens_geometry" },
 | |
|         { "panoramic", "panoramic (cylindrical)", 0, AV_OPT_TYPE_CONST, {.i64=LF_PANORAMIC}, 0, 0, FLAGS, "lens_geometry" },
 | |
|         { "equirectangular", "equirectangular", 0, AV_OPT_TYPE_CONST, {.i64=LF_EQUIRECTANGULAR}, 0, 0, FLAGS, "lens_geometry" },
 | |
|         { "fisheye_orthographic", "orthographic fisheye", 0, AV_OPT_TYPE_CONST, {.i64=LF_FISHEYE_ORTHOGRAPHIC}, 0, 0, FLAGS, "lens_geometry" },
 | |
|         { "fisheye_stereographic", "stereographic fisheye", 0, AV_OPT_TYPE_CONST, {.i64=LF_FISHEYE_STEREOGRAPHIC}, 0, 0, FLAGS, "lens_geometry" },
 | |
|         { "fisheye_equisolid", "equisolid fisheye", 0, AV_OPT_TYPE_CONST, {.i64=LF_FISHEYE_EQUISOLID}, 0, 0, FLAGS, "lens_geometry" },
 | |
|         { "fisheye_thoby", "fisheye as measured by thoby", 0, AV_OPT_TYPE_CONST, {.i64=LF_FISHEYE_THOBY}, 0, 0, FLAGS, "lens_geometry" },
 | |
|     { "reverse", "Does reverse correction (regular image to lens distorted)", OFFSET(reverse), AV_OPT_TYPE_BOOL, {.i64=0}, 0, 1, FLAGS },
 | |
|     { "interpolation", "Type of interpolation", OFFSET(interpolation_type), AV_OPT_TYPE_INT, {.i64=LINEAR}, 0, LANCZOS, FLAGS, "interpolation" },
 | |
|         { "nearest", NULL, 0, AV_OPT_TYPE_CONST, {.i64=NEAREST}, 0, 0, FLAGS, "interpolation" },
 | |
|         { "linear", NULL, 0, AV_OPT_TYPE_CONST, {.i64=LINEAR}, 0, 0, FLAGS, "interpolation" },
 | |
|         { "lanczos", NULL, 0, AV_OPT_TYPE_CONST, {.i64=LANCZOS}, 0, 0, FLAGS, "interpolation" },
 | |
|     { NULL }
 | |
| };
 | |
| 
 | |
| AVFILTER_DEFINE_CLASS(lensfun);
 | |
| 
 | |
| static av_cold int init(AVFilterContext *ctx)
 | |
| {
 | |
|     LensfunContext *lensfun = ctx->priv;
 | |
|     lfDatabase *db;
 | |
|     const lfCamera **cameras;
 | |
|     const lfLens **lenses;
 | |
| 
 | |
|     if (!lensfun->make) {
 | |
|         av_log(ctx, AV_LOG_FATAL, "Option \"make\" not specified\n");
 | |
|         return AVERROR(EINVAL);
 | |
|     } else if (!lensfun->model) {
 | |
|         av_log(ctx, AV_LOG_FATAL, "Option \"model\" not specified\n");
 | |
|         return AVERROR(EINVAL);
 | |
|     } else if (!lensfun->lens_model) {
 | |
|         av_log(ctx, AV_LOG_FATAL, "Option \"lens_model\" not specified\n");
 | |
|         return AVERROR(EINVAL);
 | |
|     }
 | |
| 
 | |
|     lensfun->lens = lf_lens_new();
 | |
|     lensfun->camera = lf_camera_new();
 | |
| 
 | |
|     db = lf_db_new();
 | |
|     if (lf_db_load(db) != LF_NO_ERROR) {
 | |
|         lf_db_destroy(db);
 | |
|         av_log(ctx, AV_LOG_FATAL, "Failed to load lensfun database\n");
 | |
|         return AVERROR_INVALIDDATA;
 | |
|     }
 | |
| 
 | |
|     cameras = lf_db_find_cameras(db, lensfun->make, lensfun->model);
 | |
|     if (cameras && *cameras) {
 | |
|         lf_camera_copy(lensfun->camera, *cameras);
 | |
|         av_log(ctx, AV_LOG_INFO, "Using camera %s\n", lensfun->camera->Model);
 | |
|     } else {
 | |
|         lf_free(cameras);
 | |
|         lf_db_destroy(db);
 | |
|         av_log(ctx, AV_LOG_FATAL, "Failed to find camera in lensfun database\n");
 | |
|         return AVERROR_INVALIDDATA;
 | |
|     }
 | |
|     lf_free(cameras);
 | |
| 
 | |
|     lenses = lf_db_find_lenses_hd(db, lensfun->camera, NULL, lensfun->lens_model, 0);
 | |
|     if (lenses && *lenses) {
 | |
|         lf_lens_copy(lensfun->lens, *lenses);
 | |
|         av_log(ctx, AV_LOG_INFO, "Using lens %s\n", lensfun->lens->Model);
 | |
|     } else {
 | |
|         lf_free(lenses);
 | |
|         lf_db_destroy(db);
 | |
|         av_log(ctx, AV_LOG_FATAL, "Failed to find lens in lensfun database\n");
 | |
|         return AVERROR_INVALIDDATA;
 | |
|     }
 | |
|     lf_free(lenses);
 | |
| 
 | |
|     lf_db_destroy(db);
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static int query_formats(AVFilterContext *ctx)
 | |
| {
 | |
|     // Some of the functions provided by lensfun require pixels in RGB format
 | |
|     static const enum AVPixelFormat fmts[] = {AV_PIX_FMT_RGB24, AV_PIX_FMT_NONE};
 | |
|     AVFilterFormats *fmts_list = ff_make_format_list(fmts);
 | |
|     return ff_set_common_formats(ctx, fmts_list);
 | |
| }
 | |
| 
 | |
| static float lanczos_kernel(float x)
 | |
| {
 | |
|     if (x == 0.0f) {
 | |
|         return 1.0f;
 | |
|     } else if (x > -2.0f && x < 2.0f) {
 | |
|         return (2.0f * sin(M_PI * x) * sin(M_PI / 2.0f * x)) / (M_PI * M_PI * x * x);
 | |
|     } else {
 | |
|         return 0.0f;
 | |
|     }
 | |
| }
 | |
| 
 | |
| static int config_props(AVFilterLink *inlink)
 | |
| {
 | |
|     AVFilterContext *ctx = inlink->dst;
 | |
|     LensfunContext *lensfun = ctx->priv;
 | |
|     int index;
 | |
|     float a;
 | |
|     int lensfun_mode = 0;
 | |
| 
 | |
|     if (!lensfun->modifier) {
 | |
|         if (lensfun->camera && lensfun->lens) {
 | |
|             lensfun->modifier = lf_modifier_new(lensfun->lens,
 | |
|                                                 lensfun->camera->CropFactor,
 | |
|                                                 inlink->w,
 | |
|                                                 inlink->h);
 | |
|             if (lensfun->mode & VIGNETTING)
 | |
|                 lensfun_mode |= LF_MODIFY_VIGNETTING;
 | |
|             if (lensfun->mode & GEOMETRY_DISTORTION)
 | |
|                 lensfun_mode |= LF_MODIFY_DISTORTION | LF_MODIFY_GEOMETRY | LF_MODIFY_SCALE;
 | |
|             if (lensfun->mode & SUBPIXEL_DISTORTION)
 | |
|                 lensfun_mode |= LF_MODIFY_TCA;
 | |
|             lf_modifier_initialize(lensfun->modifier,
 | |
|                                    lensfun->lens,
 | |
|                                    LF_PF_U8,
 | |
|                                    lensfun->focal_length,
 | |
|                                    lensfun->aperture,
 | |
|                                    lensfun->focus_distance,
 | |
|                                    lensfun->scale,
 | |
|                                    lensfun->target_geometry,
 | |
|                                    lensfun_mode,
 | |
|                                    lensfun->reverse);
 | |
|         } else {
 | |
|             // lensfun->camera and lensfun->lens should have been initialized
 | |
|             return AVERROR_BUG;
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     if (!lensfun->distortion_coords) {
 | |
|         if (lensfun->mode & SUBPIXEL_DISTORTION) {
 | |
|             lensfun->distortion_coords = av_malloc_array(inlink->w * inlink->h, sizeof(float) * 2 * 3);
 | |
|             if (!lensfun->distortion_coords)
 | |
|                 return AVERROR(ENOMEM);
 | |
|             if (lensfun->mode & GEOMETRY_DISTORTION) {
 | |
|                 // apply both geometry and subpixel distortion
 | |
|                 lf_modifier_apply_subpixel_geometry_distortion(lensfun->modifier,
 | |
|                                                                0, 0,
 | |
|                                                                inlink->w, inlink->h,
 | |
|                                                                lensfun->distortion_coords);
 | |
|             } else {
 | |
|                 // apply only subpixel distortion
 | |
|                 lf_modifier_apply_subpixel_distortion(lensfun->modifier,
 | |
|                                                       0, 0,
 | |
|                                                       inlink->w, inlink->h,
 | |
|                                                       lensfun->distortion_coords);
 | |
|             }
 | |
|         } else if (lensfun->mode & GEOMETRY_DISTORTION) {
 | |
|             lensfun->distortion_coords = av_malloc_array(inlink->w * inlink->h, sizeof(float) * 2);
 | |
|             if (!lensfun->distortion_coords)
 | |
|                 return AVERROR(ENOMEM);
 | |
|             // apply only geometry distortion
 | |
|             lf_modifier_apply_geometry_distortion(lensfun->modifier,
 | |
|                                                   0, 0,
 | |
|                                                   inlink->w, inlink->h,
 | |
|                                                   lensfun->distortion_coords);
 | |
|         }
 | |
|     }
 | |
| 
 | |
|     if (!lensfun->interpolation)
 | |
|         if (lensfun->interpolation_type == LANCZOS) {
 | |
|             lensfun->interpolation = av_malloc_array(LANCZOS_RESOLUTION, sizeof(float) * 4);
 | |
|             if (!lensfun->interpolation)
 | |
|                 return AVERROR(ENOMEM);
 | |
|             for (index = 0; index < 4 * LANCZOS_RESOLUTION; ++index) {
 | |
|                 if (index == 0) {
 | |
|                     lensfun->interpolation[index] = 1.0f;
 | |
|                 } else {
 | |
|                     a = sqrtf((float)index / LANCZOS_RESOLUTION);
 | |
|                     lensfun->interpolation[index] = lanczos_kernel(a);
 | |
|                 }
 | |
|             }
 | |
|         }
 | |
| 
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static int vignetting_filter_slice(AVFilterContext *ctx, void *arg, int jobnr, int nb_jobs)
 | |
| {
 | |
|     const VignettingThreadData *thread_data = arg;
 | |
|     const int slice_start = thread_data->height *  jobnr      / nb_jobs;
 | |
|     const int slice_end   = thread_data->height * (jobnr + 1) / nb_jobs;
 | |
| 
 | |
|     lf_modifier_apply_color_modification(thread_data->modifier,
 | |
|                                          thread_data->data_in + slice_start * thread_data->linesize_in,
 | |
|                                          0,
 | |
|                                          slice_start,
 | |
|                                          thread_data->width,
 | |
|                                          slice_end - slice_start,
 | |
|                                          thread_data->pixel_composition,
 | |
|                                          thread_data->linesize_in);
 | |
| 
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static float square(float x)
 | |
| {
 | |
|     return x * x;
 | |
| }
 | |
| 
 | |
| static int distortion_correction_filter_slice(AVFilterContext *ctx, void *arg, int jobnr, int nb_jobs)
 | |
| {
 | |
|     const DistortionCorrectionThreadData *thread_data = arg;
 | |
|     const int slice_start = thread_data->height *  jobnr      / nb_jobs;
 | |
|     const int slice_end   = thread_data->height * (jobnr + 1) / nb_jobs;
 | |
| 
 | |
|     int x, y, i, j, rgb_index;
 | |
|     float interpolated, new_x, new_y, d, norm;
 | |
|     int new_x_int, new_y_int;
 | |
|     for (y = slice_start; y < slice_end; ++y)
 | |
|         for (x = 0; x < thread_data->width; ++x)
 | |
|             for (rgb_index = 0; rgb_index < 3; ++rgb_index) {
 | |
|                 if (thread_data->mode & SUBPIXEL_DISTORTION) {
 | |
|                     // subpixel (and possibly geometry) distortion correction was applied, correct distortion
 | |
|                     switch(thread_data->interpolation_type) {
 | |
|                     case NEAREST:
 | |
|                         new_x_int = thread_data->distortion_coords[x * 2 * 3 + y * thread_data->width * 2 * 3 + rgb_index * 2]     + 0.5f;
 | |
|                         new_y_int = thread_data->distortion_coords[x * 2 * 3 + y * thread_data->width * 2 * 3 + rgb_index * 2 + 1] + 0.5f;
 | |
|                         if (new_x_int < 0 || new_x_int >= thread_data->width || new_y_int < 0 || new_y_int >= thread_data->height) {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = 0;
 | |
|                         } else {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = thread_data->data_in[new_x_int * 3 + rgb_index + new_y_int * thread_data->linesize_in];
 | |
|                         }
 | |
|                         break;
 | |
|                     case LINEAR:
 | |
|                         interpolated = 0.0f;
 | |
|                         new_x = thread_data->distortion_coords[x * 2 * 3 + y * thread_data->width * 2 * 3 + rgb_index * 2];
 | |
|                         new_x_int = new_x;
 | |
|                         new_y = thread_data->distortion_coords[x * 2 * 3 + y * thread_data->width * 2 * 3 + rgb_index * 2 + 1];
 | |
|                         new_y_int = new_y;
 | |
|                         if (new_x_int < 0 || new_x_int + 1 >= thread_data->width || new_y_int < 0 || new_y_int + 1 >= thread_data->height) {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = 0;
 | |
|                         } else {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] =
 | |
|                                   thread_data->data_in[ new_x_int      * 3 + rgb_index +  new_y_int      * thread_data->linesize_in] * (new_x_int + 1 - new_x) * (new_y_int + 1 - new_y)
 | |
|                                 + thread_data->data_in[(new_x_int + 1) * 3 + rgb_index +  new_y_int      * thread_data->linesize_in] * (new_x - new_x_int) * (new_y_int + 1 - new_y)
 | |
|                                 + thread_data->data_in[ new_x_int      * 3 + rgb_index + (new_y_int + 1) * thread_data->linesize_in] * (new_x_int + 1 - new_x) * (new_y - new_y_int)
 | |
|                                 + thread_data->data_in[(new_x_int + 1) * 3 + rgb_index + (new_y_int + 1) * thread_data->linesize_in] * (new_x - new_x_int) * (new_y - new_y_int);
 | |
|                         }
 | |
|                         break;
 | |
|                     case LANCZOS:
 | |
|                         interpolated = 0.0f;
 | |
|                         norm = 0.0f;
 | |
|                         new_x = thread_data->distortion_coords[x * 2 * 3 + y * thread_data->width * 2 * 3 + rgb_index * 2];
 | |
|                         new_x_int = new_x;
 | |
|                         new_y = thread_data->distortion_coords[x * 2 * 3 + y * thread_data->width * 2 * 3 + rgb_index * 2 + 1];
 | |
|                         new_y_int = new_y;
 | |
|                         for (j = 0; j < 4; ++j)
 | |
|                             for (i = 0; i < 4; ++i) {
 | |
|                                 if (new_x_int + i - 2 < 0 || new_x_int + i - 2 >= thread_data->width || new_y_int + j - 2 < 0 || new_y_int + j - 2 >= thread_data->height)
 | |
|                                     continue;
 | |
|                                 d = square(new_x - (new_x_int + i - 2)) * square(new_y - (new_y_int + j - 2));
 | |
|                                 if (d >= 4.0f)
 | |
|                                     continue;
 | |
|                                 d = thread_data->interpolation[(int)(d * LANCZOS_RESOLUTION)];
 | |
|                                 norm += d;
 | |
|                                 interpolated += thread_data->data_in[(new_x_int + i - 2) * 3 + rgb_index + (new_y_int + j - 2) * thread_data->linesize_in] * d;
 | |
|                             }
 | |
|                         if (norm == 0.0f) {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = 0;
 | |
|                         } else {
 | |
|                             interpolated /= norm;
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = interpolated < 0.0f ? 0.0f : interpolated > 255.0f ? 255.0f : interpolated;
 | |
|                         }
 | |
|                         break;
 | |
|                     }
 | |
|                 } else if (thread_data->mode & GEOMETRY_DISTORTION) {
 | |
|                     // geometry distortion correction was applied, correct distortion
 | |
|                     switch(thread_data->interpolation_type) {
 | |
|                     case NEAREST:
 | |
|                         new_x_int = thread_data->distortion_coords[x * 2 + y * thread_data->width * 2]     + 0.5f;
 | |
|                         new_y_int = thread_data->distortion_coords[x * 2 + y * thread_data->width * 2 + 1] + 0.5f;
 | |
|                         if (new_x_int < 0 || new_x_int >= thread_data->width || new_y_int < 0 || new_y_int >= thread_data->height) {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = 0;
 | |
|                         } else {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = thread_data->data_in[new_x_int * 3 + rgb_index + new_y_int * thread_data->linesize_in];
 | |
|                         }
 | |
|                         break;
 | |
|                     case LINEAR:
 | |
|                         interpolated = 0.0f;
 | |
|                         new_x = thread_data->distortion_coords[x * 2 + y * thread_data->width * 2];
 | |
|                         new_x_int = new_x;
 | |
|                         new_y = thread_data->distortion_coords[x * 2 + y * thread_data->width * 2 + 1];
 | |
|                         new_y_int = new_y;
 | |
|                         if (new_x_int < 0 || new_x_int + 1 >= thread_data->width || new_y_int < 0 || new_y_int + 1 >= thread_data->height) {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = 0;
 | |
|                         } else {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] =
 | |
|                                   thread_data->data_in[ new_x_int      * 3 + rgb_index +  new_y_int      * thread_data->linesize_in] * (new_x_int + 1 - new_x) * (new_y_int + 1 - new_y)
 | |
|                                 + thread_data->data_in[(new_x_int + 1) * 3 + rgb_index +  new_y_int      * thread_data->linesize_in] * (new_x - new_x_int) * (new_y_int + 1 - new_y)
 | |
|                                 + thread_data->data_in[ new_x_int      * 3 + rgb_index + (new_y_int + 1) * thread_data->linesize_in] * (new_x_int + 1 - new_x) * (new_y - new_y_int)
 | |
|                                 + thread_data->data_in[(new_x_int + 1) * 3 + rgb_index + (new_y_int + 1) * thread_data->linesize_in] * (new_x - new_x_int) * (new_y - new_y_int);
 | |
|                         }
 | |
|                         break;
 | |
|                     case LANCZOS:
 | |
|                         interpolated = 0.0f;
 | |
|                         norm = 0.0f;
 | |
|                         new_x = thread_data->distortion_coords[x * 2     + y * thread_data->width * 2];
 | |
|                         new_x_int = new_x;
 | |
|                         new_y = thread_data->distortion_coords[x * 2 + 1 + y * thread_data->width * 2];
 | |
|                         new_y_int = new_y;
 | |
|                         for (j = 0; j < 4; ++j)
 | |
|                             for (i = 0; i < 4; ++i) {
 | |
|                                 if (new_x_int + i - 2 < 0 || new_x_int + i - 2 >= thread_data->width || new_y_int + j - 2 < 0 || new_y_int + j - 2 >= thread_data->height)
 | |
|                                     continue;
 | |
|                                 d = square(new_x - (new_x_int + i - 2)) * square(new_y - (new_y_int + j - 2));
 | |
|                                 if (d >= 4.0f)
 | |
|                                     continue;
 | |
|                                 d = thread_data->interpolation[(int)(d * LANCZOS_RESOLUTION)];
 | |
|                                 norm += d;
 | |
|                                 interpolated += thread_data->data_in[(new_x_int + i - 2) * 3 + rgb_index + (new_y_int + j - 2) * thread_data->linesize_in] * d;
 | |
|                             }
 | |
|                         if (norm == 0.0f) {
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = 0;
 | |
|                         } else {
 | |
|                             interpolated /= norm;
 | |
|                             thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = interpolated < 0.0f ? 0.0f : interpolated > 255.0f ? 255.0f : interpolated;
 | |
|                         }
 | |
|                         break;
 | |
|                     }
 | |
|                 } else {
 | |
|                     // no distortion correction was applied
 | |
|                     thread_data->data_out[x * 3 + rgb_index + y * thread_data->linesize_out] = thread_data->data_in[x * 3 + rgb_index + y * thread_data->linesize_in];
 | |
|                 }
 | |
|             }
 | |
| 
 | |
|     return 0;
 | |
| }
 | |
| 
 | |
| static int filter_frame(AVFilterLink *inlink, AVFrame *in)
 | |
| {
 | |
|     AVFilterContext *ctx = inlink->dst;
 | |
|     LensfunContext *lensfun = ctx->priv;
 | |
|     AVFilterLink *outlink = ctx->outputs[0];
 | |
|     AVFrame *out;
 | |
|     VignettingThreadData vignetting_thread_data;
 | |
|     DistortionCorrectionThreadData distortion_correction_thread_data;
 | |
| 
 | |
|     if (lensfun->mode & VIGNETTING) {
 | |
|         av_frame_make_writable(in);
 | |
| 
 | |
|         vignetting_thread_data = (VignettingThreadData) {
 | |
|             .width = inlink->w,
 | |
|             .height = inlink->h,
 | |
|             .data_in = in->data[0],
 | |
|             .linesize_in = in->linesize[0],
 | |
|             .pixel_composition = LF_CR_3(RED, GREEN, BLUE),
 | |
|             .modifier = lensfun->modifier
 | |
|         };
 | |
| 
 | |
|         ctx->internal->execute(ctx,
 | |
|                                vignetting_filter_slice,
 | |
|                                &vignetting_thread_data,
 | |
|                                NULL,
 | |
|                                FFMIN(outlink->h, ff_filter_get_nb_threads(ctx)));
 | |
|     }
 | |
| 
 | |
|     if (lensfun->mode & (GEOMETRY_DISTORTION | SUBPIXEL_DISTORTION)) {
 | |
|         out = ff_get_video_buffer(outlink, outlink->w, outlink->h);
 | |
|         if (!out) {
 | |
|             av_frame_free(&in);
 | |
|             return AVERROR(ENOMEM);
 | |
|         }
 | |
|         av_frame_copy_props(out, in);
 | |
| 
 | |
|         distortion_correction_thread_data = (DistortionCorrectionThreadData) {
 | |
|             .width = inlink->w,
 | |
|             .height = inlink->h,
 | |
|             .distortion_coords = lensfun->distortion_coords,
 | |
|             .data_in = in->data[0],
 | |
|             .data_out = out->data[0],
 | |
|             .linesize_in = in->linesize[0],
 | |
|             .linesize_out = out->linesize[0],
 | |
|             .interpolation = lensfun->interpolation,
 | |
|             .mode = lensfun->mode,
 | |
|             .interpolation_type = lensfun->interpolation_type
 | |
|         };
 | |
| 
 | |
|         ctx->internal->execute(ctx,
 | |
|                                distortion_correction_filter_slice,
 | |
|                                &distortion_correction_thread_data,
 | |
|                                NULL,
 | |
|                                FFMIN(outlink->h, ff_filter_get_nb_threads(ctx)));
 | |
| 
 | |
|         av_frame_free(&in);
 | |
|         return ff_filter_frame(outlink, out);
 | |
|     } else {
 | |
|         return ff_filter_frame(outlink, in);
 | |
|     }
 | |
| }
 | |
| 
 | |
| static av_cold void uninit(AVFilterContext *ctx)
 | |
| {
 | |
|     LensfunContext *lensfun = ctx->priv;
 | |
| 
 | |
|     if (lensfun->camera)
 | |
|         lf_camera_destroy(lensfun->camera);
 | |
|     if (lensfun->lens)
 | |
|         lf_lens_destroy(lensfun->lens);
 | |
|     if (lensfun->modifier)
 | |
|         lf_modifier_destroy(lensfun->modifier);
 | |
|     av_freep(&lensfun->distortion_coords);
 | |
|     av_freep(&lensfun->interpolation);
 | |
| }
 | |
| 
 | |
| static const AVFilterPad lensfun_inputs[] = {
 | |
|     {
 | |
|         .name         = "default",
 | |
|         .type         = AVMEDIA_TYPE_VIDEO,
 | |
|         .config_props = config_props,
 | |
|         .filter_frame = filter_frame,
 | |
|     },
 | |
|     { NULL }
 | |
| };
 | |
| 
 | |
| static const AVFilterPad lensfun_outputs[] = {
 | |
|     {
 | |
|         .name = "default",
 | |
|         .type = AVMEDIA_TYPE_VIDEO,
 | |
|     },
 | |
|     { NULL }
 | |
| };
 | |
| 
 | |
| AVFilter ff_vf_lensfun = {
 | |
|     .name          = "lensfun",
 | |
|     .description   = NULL_IF_CONFIG_SMALL("Apply correction to an image based on info derived from the lensfun database."),
 | |
|     .priv_size     = sizeof(LensfunContext),
 | |
|     .init          = init,
 | |
|     .uninit        = uninit,
 | |
|     .query_formats = query_formats,
 | |
|     .inputs        = lensfun_inputs,
 | |
|     .outputs       = lensfun_outputs,
 | |
|     .priv_class    = &lensfun_class,
 | |
|     .flags         = AVFILTER_FLAG_SUPPORT_TIMELINE_GENERIC | AVFILTER_FLAG_SLICE_THREADS,
 | |
| };
 |