Blender V5.3
intern/camera_intrinsics.cc
Go to the documentation of this file.
1/* SPDX-FileCopyrightText: 2011 Blender Authors
2 *
3 * SPDX-License-Identifier: GPL-2.0-or-later */
4
8
14
16 const libmv_CameraIntrinsicsOptions* libmv_camera_intrinsics_options) {
17 CameraIntrinsics* camera_intrinsics =
18 libmv_cameraIntrinsicsCreateFromOptions(libmv_camera_intrinsics_options);
19 return (libmv_CameraIntrinsics*)camera_intrinsics;
20}
21
23 const libmv_CameraIntrinsics* libmv_intrinsics) {
24 const CameraIntrinsics* orig_intrinsics =
25 (const CameraIntrinsics*)libmv_intrinsics;
26
27 CameraIntrinsics* new_intrinsics = NULL;
28 switch (orig_intrinsics->GetDistortionModelType()) {
30 const PolynomialCameraIntrinsics* polynomial_intrinsics =
31 static_cast<const PolynomialCameraIntrinsics*>(orig_intrinsics);
32 new_intrinsics =
33 LIBMV_OBJECT_NEW(PolynomialCameraIntrinsics, *polynomial_intrinsics);
34 break;
35 }
37 const DivisionCameraIntrinsics* division_intrinsics =
38 static_cast<const DivisionCameraIntrinsics*>(orig_intrinsics);
39 new_intrinsics =
40 LIBMV_OBJECT_NEW(DivisionCameraIntrinsics, *division_intrinsics);
41 break;
42 }
44 const NukeCameraIntrinsics* nuke_intrinsics =
45 static_cast<const NukeCameraIntrinsics*>(orig_intrinsics);
46 new_intrinsics = LIBMV_OBJECT_NEW(NukeCameraIntrinsics, *nuke_intrinsics);
47 break;
48 }
50 const BrownCameraIntrinsics* brown_intrinsics =
51 static_cast<const BrownCameraIntrinsics*>(orig_intrinsics);
52 new_intrinsics =
53 LIBMV_OBJECT_NEW(BrownCameraIntrinsics, *brown_intrinsics);
54 break;
55 }
56 default: assert(!"Unknown distortion model");
57 }
58 return (libmv_CameraIntrinsics*)new_intrinsics;
59}
60
64
66 const libmv_CameraIntrinsicsOptions* libmv_camera_intrinsics_options,
67 libmv_CameraIntrinsics* libmv_intrinsics) {
68 CameraIntrinsics* camera_intrinsics = (CameraIntrinsics*)libmv_intrinsics;
69
70 double focal_length = libmv_camera_intrinsics_options->focal_length;
71 double principal_x = libmv_camera_intrinsics_options->principal_point_x;
72 double principal_y = libmv_camera_intrinsics_options->principal_point_y;
73 int image_width = libmv_camera_intrinsics_options->image_width;
74 int image_height = libmv_camera_intrinsics_options->image_height;
75
76 /* Try avoid unnecessary updates, so pre-computed distortion grids
77 * are not freed. */
78
79 if (camera_intrinsics->focal_length() != focal_length) {
80 camera_intrinsics->SetFocalLength(focal_length, focal_length);
81 }
82
83 if (camera_intrinsics->principal_point_x() != principal_x ||
84 camera_intrinsics->principal_point_y() != principal_y) {
85 camera_intrinsics->SetPrincipalPoint(principal_x, principal_y);
86 }
87
88 if (camera_intrinsics->image_width() != image_width ||
89 camera_intrinsics->image_height() != image_height) {
90 camera_intrinsics->SetImageSize(image_width, image_height);
91 }
92
93 switch (libmv_camera_intrinsics_options->distortion_model) {
95 assert(camera_intrinsics->GetDistortionModelType() ==
97
98 PolynomialCameraIntrinsics* polynomial_intrinsics =
99 (PolynomialCameraIntrinsics*)camera_intrinsics;
100
101 double k1 = libmv_camera_intrinsics_options->polynomial_k1;
102 double k2 = libmv_camera_intrinsics_options->polynomial_k2;
103 double k3 = libmv_camera_intrinsics_options->polynomial_k3;
104
105 if (polynomial_intrinsics->k1() != k1 ||
106 polynomial_intrinsics->k2() != k2 ||
107 polynomial_intrinsics->k3() != k3) {
108 polynomial_intrinsics->SetRadialDistortion(k1, k2, k3);
109 }
110 break;
111 }
112
114 assert(camera_intrinsics->GetDistortionModelType() ==
116
117 DivisionCameraIntrinsics* division_intrinsics =
118 (DivisionCameraIntrinsics*)camera_intrinsics;
119
120 double k1 = libmv_camera_intrinsics_options->division_k1;
121 double k2 = libmv_camera_intrinsics_options->division_k2;
122
123 if (division_intrinsics->k1() != k1 || division_intrinsics->k2() != k2) {
124 division_intrinsics->SetDistortion(k1, k2);
125 }
126
127 break;
128 }
129
131 assert(camera_intrinsics->GetDistortionModelType() ==
133
134 NukeCameraIntrinsics* nuke_intrinsics =
135 (NukeCameraIntrinsics*)camera_intrinsics;
136
137 double k1 = libmv_camera_intrinsics_options->nuke_k1;
138 double k2 = libmv_camera_intrinsics_options->nuke_k2;
139
140 if (nuke_intrinsics->k1() != k1 || nuke_intrinsics->k2() != k2) {
141 nuke_intrinsics->SetRadialDistortion(k1, k2);
142 }
143
144 double p1 = libmv_camera_intrinsics_options->nuke_p1;
145 double p2 = libmv_camera_intrinsics_options->nuke_p2;
146
147 if (nuke_intrinsics->p1() != p1 || nuke_intrinsics->p2() != p2) {
148 nuke_intrinsics->SetTangentialDistortion(p1, p2);
149 }
150 break;
151 }
152
154 assert(camera_intrinsics->GetDistortionModelType() ==
156
157 BrownCameraIntrinsics* brown_intrinsics =
158 (BrownCameraIntrinsics*)camera_intrinsics;
159
160 double k1 = libmv_camera_intrinsics_options->brown_k1;
161 double k2 = libmv_camera_intrinsics_options->brown_k2;
162 double k3 = libmv_camera_intrinsics_options->brown_k3;
163 double k4 = libmv_camera_intrinsics_options->brown_k4;
164
165 if (brown_intrinsics->k1() != k1 || brown_intrinsics->k2() != k2 ||
166 brown_intrinsics->k3() != k3 || brown_intrinsics->k4() != k4) {
167 brown_intrinsics->SetRadialDistortion(k1, k2, k3, k4);
168 }
169
170 double p1 = libmv_camera_intrinsics_options->brown_p1;
171 double p2 = libmv_camera_intrinsics_options->brown_p2;
172
173 if (brown_intrinsics->p1() != p1 || brown_intrinsics->p2() != p2) {
174 brown_intrinsics->SetTangentialDistortion(p1, p2);
175 }
176 break;
177 }
178
179 default: assert(!"Unknown distortion model");
180 }
181}
182
184 const libmv_CameraIntrinsics* libmv_intrinsics,
185 libmv_CameraIntrinsicsOptions* camera_intrinsics_options) {
186 const CameraIntrinsics* camera_intrinsics =
187 (const CameraIntrinsics*)libmv_intrinsics;
188
189 // Fill in options which are common for all distortion models.
190 camera_intrinsics_options->focal_length = camera_intrinsics->focal_length();
191 camera_intrinsics_options->principal_point_x =
192 camera_intrinsics->principal_point_x();
193 camera_intrinsics_options->principal_point_y =
194 camera_intrinsics->principal_point_y();
195
196 camera_intrinsics_options->image_width = camera_intrinsics->image_width();
197 camera_intrinsics_options->image_height = camera_intrinsics->image_height();
198
199 switch (camera_intrinsics->GetDistortionModelType()) {
201 const PolynomialCameraIntrinsics* polynomial_intrinsics =
202 static_cast<const PolynomialCameraIntrinsics*>(camera_intrinsics);
203 camera_intrinsics_options->distortion_model =
205 camera_intrinsics_options->polynomial_k1 = polynomial_intrinsics->k1();
206 camera_intrinsics_options->polynomial_k2 = polynomial_intrinsics->k2();
207 camera_intrinsics_options->polynomial_k3 = polynomial_intrinsics->k3();
208 camera_intrinsics_options->polynomial_p1 = polynomial_intrinsics->p1();
209 camera_intrinsics_options->polynomial_p2 = polynomial_intrinsics->p2();
210 break;
211 }
212
214 const DivisionCameraIntrinsics* division_intrinsics =
215 static_cast<const DivisionCameraIntrinsics*>(camera_intrinsics);
216 camera_intrinsics_options->distortion_model =
218 camera_intrinsics_options->division_k1 = division_intrinsics->k1();
219 camera_intrinsics_options->division_k2 = division_intrinsics->k2();
220 break;
221 }
222
224 const NukeCameraIntrinsics* nuke_intrinsics =
225 static_cast<const NukeCameraIntrinsics*>(camera_intrinsics);
226 camera_intrinsics_options->distortion_model = LIBMV_DISTORTION_MODEL_NUKE;
227 camera_intrinsics_options->nuke_k1 = nuke_intrinsics->k1();
228 camera_intrinsics_options->nuke_k2 = nuke_intrinsics->k2();
229 camera_intrinsics_options->nuke_p1 = nuke_intrinsics->p1();
230 camera_intrinsics_options->nuke_p2 = nuke_intrinsics->p2();
231 break;
232 }
233
235 const BrownCameraIntrinsics* brown_intrinsics =
236 static_cast<const BrownCameraIntrinsics*>(camera_intrinsics);
237 camera_intrinsics_options->distortion_model =
239 camera_intrinsics_options->brown_k1 = brown_intrinsics->k1();
240 camera_intrinsics_options->brown_k2 = brown_intrinsics->k2();
241 camera_intrinsics_options->brown_k3 = brown_intrinsics->k3();
242 camera_intrinsics_options->brown_k4 = brown_intrinsics->k4();
243 camera_intrinsics_options->brown_p1 = brown_intrinsics->p1();
244 camera_intrinsics_options->brown_p2 = brown_intrinsics->p2();
245 break;
246 }
247
248 default: assert(!"Unknown distortion model");
249 }
250}
251
253 const libmv_CameraIntrinsics* libmv_intrinsics,
254 const unsigned char* source_image,
255 int width,
256 int height,
257 float overscan,
258 int channels,
259 unsigned char* destination_image) {
260 CameraIntrinsics* camera_intrinsics = (CameraIntrinsics*)libmv_intrinsics;
261 camera_intrinsics->UndistortBuffer(
262 source_image, width, height, overscan, channels, destination_image);
263}
264
266 const libmv_CameraIntrinsics* libmv_intrinsics,
267 const float* source_image,
268 int width,
269 int height,
270 float overscan,
271 int channels,
272 float* destination_image) {
273 CameraIntrinsics* intrinsics = (CameraIntrinsics*)libmv_intrinsics;
274 intrinsics->UndistortBuffer(
275 source_image, width, height, overscan, channels, destination_image);
276}
277
279 const struct libmv_CameraIntrinsics* libmv_intrinsics,
280 const unsigned char* source_image,
281 int width,
282 int height,
283 float overscan,
284 int channels,
285 unsigned char* destination_image) {
286 CameraIntrinsics* intrinsics = (CameraIntrinsics*)libmv_intrinsics;
287 intrinsics->DistortBuffer(
288 source_image, width, height, overscan, channels, destination_image);
289}
290
292 const libmv_CameraIntrinsics* libmv_intrinsics,
293 float* source_image,
294 int width,
295 int height,
296 float overscan,
297 int channels,
298 float* destination_image) {
299 CameraIntrinsics* intrinsics = (CameraIntrinsics*)libmv_intrinsics;
300 intrinsics->DistortBuffer(
301 source_image, width, height, overscan, channels, destination_image);
302}
303
305 const struct libmv_CameraIntrinsics* libmv_intrinsics,
306 double x,
307 double y,
308 double* x1,
309 double* y1) {
310 CameraIntrinsics* intrinsics = (CameraIntrinsics*)libmv_intrinsics;
311 intrinsics->ApplyIntrinsics(x, y, x1, y1);
312}
313
315 const struct libmv_CameraIntrinsics* libmv_intrinsics,
316 double x,
317 double y,
318 double* x1,
319 double* y1) {
320 CameraIntrinsics* intrinsics = (CameraIntrinsics*)libmv_intrinsics;
321 intrinsics->InvertIntrinsics(x, y, x1, y1);
322}
323
325 const libmv_CameraIntrinsicsOptions* camera_intrinsics_options,
326 CameraIntrinsics* camera_intrinsics) {
327 camera_intrinsics->SetFocalLength(camera_intrinsics_options->focal_length,
328 camera_intrinsics_options->focal_length);
329
330 camera_intrinsics->SetPrincipalPoint(
331 camera_intrinsics_options->principal_point_x,
332 camera_intrinsics_options->principal_point_y);
333
334 camera_intrinsics->SetImageSize(camera_intrinsics_options->image_width,
335 camera_intrinsics_options->image_height);
336
337 switch (camera_intrinsics_options->distortion_model) {
339 PolynomialCameraIntrinsics* polynomial_intrinsics =
340 static_cast<PolynomialCameraIntrinsics*>(camera_intrinsics);
341
342 polynomial_intrinsics->SetRadialDistortion(
343 camera_intrinsics_options->polynomial_k1,
344 camera_intrinsics_options->polynomial_k2,
345 camera_intrinsics_options->polynomial_k3);
346
347 break;
348 }
349
351 DivisionCameraIntrinsics* division_intrinsics =
352 static_cast<DivisionCameraIntrinsics*>(camera_intrinsics);
353
354 division_intrinsics->SetDistortion(
355 camera_intrinsics_options->division_k1,
356 camera_intrinsics_options->division_k2);
357 break;
358 }
359
361 NukeCameraIntrinsics* nuke_intrinsics =
362 static_cast<NukeCameraIntrinsics*>(camera_intrinsics);
363
364 nuke_intrinsics->SetRadialDistortion(camera_intrinsics_options->nuke_k1,
365 camera_intrinsics_options->nuke_k2);
366 nuke_intrinsics->SetTangentialDistortion(
367 camera_intrinsics_options->nuke_p1,
368 camera_intrinsics_options->nuke_p2);
369 break;
370 }
371
373 BrownCameraIntrinsics* brown_intrinsics =
374 static_cast<BrownCameraIntrinsics*>(camera_intrinsics);
375
376 brown_intrinsics->SetRadialDistortion(
377 camera_intrinsics_options->brown_k1,
378 camera_intrinsics_options->brown_k2,
379 camera_intrinsics_options->brown_k3,
380 camera_intrinsics_options->brown_k4);
381 brown_intrinsics->SetTangentialDistortion(
382 camera_intrinsics_options->brown_p1,
383 camera_intrinsics_options->brown_p2);
384
385 break;
386 }
387
388 default: assert(!"Unknown distortion model");
389 }
390}
391
393 const libmv_CameraIntrinsicsOptions* camera_intrinsics_options) {
394 CameraIntrinsics* camera_intrinsics = NULL;
395 switch (camera_intrinsics_options->distortion_model) {
397 camera_intrinsics = LIBMV_OBJECT_NEW(PolynomialCameraIntrinsics);
398 break;
400 camera_intrinsics = LIBMV_OBJECT_NEW(DivisionCameraIntrinsics);
401 break;
403 camera_intrinsics = LIBMV_OBJECT_NEW(NukeCameraIntrinsics);
404 break;
406 camera_intrinsics = LIBMV_OBJECT_NEW(BrownCameraIntrinsics);
407 break;
408 default: assert(!"Unknown distortion model");
409 }
410 libmv_cameraIntrinsicsFillFromOptions(camera_intrinsics_options,
411 camera_intrinsics);
412 return camera_intrinsics;
413}
void SetRadialDistortion(double k1, double k2, double k3, double k4)
virtual void ApplyIntrinsics(double normalized_x, double normalized_y, double *image_x, double *image_y) const =0
void DistortBuffer(const PixelType *input_buffer, int width, int height, double overscan, int channels, PixelType *output_buffer)
void SetFocalLength(double focal_x, double focal_y)
virtual void InvertIntrinsics(double image_x, double image_y, double *normalized_x, double *normalized_y) const =0
void UndistortBuffer(const PixelType *input_buffer, int width, int height, double overscan, int channels, PixelType *output_buffer)
virtual DistortionModelType GetDistortionModelType() const =0
void SetRadialDistortion(double k1, double k2, double k3)
#define assert(assertion)
void libmv_cameraIntrinsicsUndistortFloat(const libmv_CameraIntrinsics *libmv_intrinsics, const float *source_image, int width, int height, float overscan, int channels, float *destination_image)
void libmv_cameraIntrinsicsDestroy(libmv_CameraIntrinsics *libmv_intrinsics)
libmv_CameraIntrinsics * libmv_cameraIntrinsicsCopy(const libmv_CameraIntrinsics *libmv_intrinsics)
CameraIntrinsics * libmv_cameraIntrinsicsCreateFromOptions(const libmv_CameraIntrinsicsOptions *camera_intrinsics_options)
void libmv_cameraIntrinsicsUndistortByte(const libmv_CameraIntrinsics *libmv_intrinsics, const unsigned char *source_image, int width, int height, float overscan, int channels, unsigned char *destination_image)
void libmv_cameraIntrinsicsDistortByte(const struct libmv_CameraIntrinsics *libmv_intrinsics, const unsigned char *source_image, int width, int height, float overscan, int channels, unsigned char *destination_image)
void libmv_cameraIntrinsicsApply(const struct libmv_CameraIntrinsics *libmv_intrinsics, double x, double y, double *x1, double *y1)
void libmv_cameraIntrinsicsDistortFloat(const libmv_CameraIntrinsics *libmv_intrinsics, float *source_image, int width, int height, float overscan, int channels, float *destination_image)
static void libmv_cameraIntrinsicsFillFromOptions(const libmv_CameraIntrinsicsOptions *camera_intrinsics_options, CameraIntrinsics *camera_intrinsics)
void libmv_cameraIntrinsicsUpdate(const libmv_CameraIntrinsicsOptions *libmv_camera_intrinsics_options, libmv_CameraIntrinsics *libmv_intrinsics)
void libmv_cameraIntrinsicsInvert(const struct libmv_CameraIntrinsics *libmv_intrinsics, double x, double y, double *x1, double *y1)
void libmv_cameraIntrinsicsExtractOptions(const libmv_CameraIntrinsics *libmv_intrinsics, libmv_CameraIntrinsicsOptions *camera_intrinsics_options)
libmv_CameraIntrinsics * libmv_cameraIntrinsicsNew(const libmv_CameraIntrinsicsOptions *libmv_camera_intrinsics_options)
struct libmv_CameraIntrinsics libmv_CameraIntrinsics
@ LIBMV_DISTORTION_MODEL_POLYNOMIAL
@ LIBMV_DISTORTION_MODEL_NUKE
@ LIBMV_DISTORTION_MODEL_BROWN
@ LIBMV_DISTORTION_MODEL_DIVISION
@ DISTORTION_MODEL_POLYNOMIAL
@ DISTORTION_MODEL_DIVISION
@ DISTORTION_MODEL_BROWN
@ DISTORTION_MODEL_NUKE
#define LIBMV_OBJECT_NEW(type,...)
Definition utildefines.h:40
#define LIBMV_OBJECT_DELETE(what, type)
Definition utildefines.h:43