Book a Demo!
CoCalc Logo Icon
StoreFeaturesDocsShareSupportNewsAboutPoliciesSign UpSign In
Tetragramm
GitHub Repository: Tetragramm/opencv
Path: blob/master/modules/calib3d/include/opencv2/calib3d.hpp
16348 views
1
/*M///////////////////////////////////////////////////////////////////////////////////////
2
//
3
// IMPORTANT: READ BEFORE DOWNLOADING, COPYING, INSTALLING OR USING.
4
//
5
// By downloading, copying, installing or using the software you agree to this license.
6
// If you do not agree to this license, do not download, install,
7
// copy or use the software.
8
//
9
//
10
// License Agreement
11
// For Open Source Computer Vision Library
12
//
13
// Copyright (C) 2000-2008, Intel Corporation, all rights reserved.
14
// Copyright (C) 2009, Willow Garage Inc., all rights reserved.
15
// Copyright (C) 2013, OpenCV Foundation, all rights reserved.
16
// Third party copyrights are property of their respective owners.
17
//
18
// Redistribution and use in source and binary forms, with or without modification,
19
// are permitted provided that the following conditions are met:
20
//
21
// * Redistribution's of source code must retain the above copyright notice,
22
// this list of conditions and the following disclaimer.
23
//
24
// * Redistribution's in binary form must reproduce the above copyright notice,
25
// this list of conditions and the following disclaimer in the documentation
26
// and/or other materials provided with the distribution.
27
//
28
// * The name of the copyright holders may not be used to endorse or promote products
29
// derived from this software without specific prior written permission.
30
//
31
// This software is provided by the copyright holders and contributors "as is" and
32
// any express or implied warranties, including, but not limited to, the implied
33
// warranties of merchantability and fitness for a particular purpose are disclaimed.
34
// In no event shall the Intel Corporation or contributors be liable for any direct,
35
// indirect, incidental, special, exemplary, or consequential damages
36
// (including, but not limited to, procurement of substitute goods or services;
37
// loss of use, data, or profits; or business interruption) however caused
38
// and on any theory of liability, whether in contract, strict liability,
39
// or tort (including negligence or otherwise) arising in any way out of
40
// the use of this software, even if advised of the possibility of such damage.
41
//
42
//M*/
43
44
#ifndef OPENCV_CALIB3D_HPP
45
#define OPENCV_CALIB3D_HPP
46
47
#include "opencv2/core.hpp"
48
#include "opencv2/features2d.hpp"
49
#include "opencv2/core/affine.hpp"
50
51
/**
52
@defgroup calib3d Camera Calibration and 3D Reconstruction
53
54
The functions in this section use a so-called pinhole camera model. In this model, a scene view is
55
formed by projecting 3D points into the image plane using a perspective transformation.
56
57
\f[s \; m' = A [R|t] M'\f]
58
59
or
60
61
\f[s \vecthree{u}{v}{1} = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}
62
\begin{bmatrix}
63
r_{11} & r_{12} & r_{13} & t_1 \\
64
r_{21} & r_{22} & r_{23} & t_2 \\
65
r_{31} & r_{32} & r_{33} & t_3
66
\end{bmatrix}
67
\begin{bmatrix}
68
X \\
69
Y \\
70
Z \\
71
1
72
\end{bmatrix}\f]
73
74
where:
75
76
- \f$(X, Y, Z)\f$ are the coordinates of a 3D point in the world coordinate space
77
- \f$(u, v)\f$ are the coordinates of the projection point in pixels
78
- \f$A\f$ is a camera matrix, or a matrix of intrinsic parameters
79
- \f$(cx, cy)\f$ is a principal point that is usually at the image center
80
- \f$fx, fy\f$ are the focal lengths expressed in pixel units.
81
82
Thus, if an image from the camera is scaled by a factor, all of these parameters should be scaled
83
(multiplied/divided, respectively) by the same factor. The matrix of intrinsic parameters does not
84
depend on the scene viewed. So, once estimated, it can be re-used as long as the focal length is
85
fixed (in case of zoom lens). The joint rotation-translation matrix \f$[R|t]\f$ is called a matrix of
86
extrinsic parameters. It is used to describe the camera motion around a static scene, or vice versa,
87
rigid motion of an object in front of a still camera. That is, \f$[R|t]\f$ translates coordinates of a
88
point \f$(X, Y, Z)\f$ to a coordinate system, fixed with respect to the camera. The transformation above
89
is equivalent to the following (when \f$z \ne 0\f$ ):
90
91
\f[\begin{array}{l}
92
\vecthree{x}{y}{z} = R \vecthree{X}{Y}{Z} + t \\
93
x' = x/z \\
94
y' = y/z \\
95
u = f_x*x' + c_x \\
96
v = f_y*y' + c_y
97
\end{array}\f]
98
99
The following figure illustrates the pinhole camera model.
100
101
![Pinhole camera model](pics/pinhole_camera_model.png)
102
103
Real lenses usually have some distortion, mostly radial distortion and slight tangential distortion.
104
So, the above model is extended as:
105
106
\f[\begin{array}{l}
107
\vecthree{x}{y}{z} = R \vecthree{X}{Y}{Z} + t \\
108
x' = x/z \\
109
y' = y/z \\
110
x'' = x' \frac{1 + k_1 r^2 + k_2 r^4 + k_3 r^6}{1 + k_4 r^2 + k_5 r^4 + k_6 r^6} + 2 p_1 x' y' + p_2(r^2 + 2 x'^2) + s_1 r^2 + s_2 r^4 \\
111
y'' = y' \frac{1 + k_1 r^2 + k_2 r^4 + k_3 r^6}{1 + k_4 r^2 + k_5 r^4 + k_6 r^6} + p_1 (r^2 + 2 y'^2) + 2 p_2 x' y' + s_3 r^2 + s_4 r^4 \\
112
\text{where} \quad r^2 = x'^2 + y'^2 \\
113
u = f_x*x'' + c_x \\
114
v = f_y*y'' + c_y
115
\end{array}\f]
116
117
\f$k_1\f$, \f$k_2\f$, \f$k_3\f$, \f$k_4\f$, \f$k_5\f$, and \f$k_6\f$ are radial distortion coefficients. \f$p_1\f$ and \f$p_2\f$ are
118
tangential distortion coefficients. \f$s_1\f$, \f$s_2\f$, \f$s_3\f$, and \f$s_4\f$, are the thin prism distortion
119
coefficients. Higher-order coefficients are not considered in OpenCV.
120
121
The next figure shows two common types of radial distortion: barrel distortion (typically \f$ k_1 > 0 \f$) and pincushion distortion (typically \f$ k_1 < 0 \f$).
122
123
![](pics/distortion_examples.png)
124
125
In some cases the image sensor may be tilted in order to focus an oblique plane in front of the
126
camera (Scheimpfug condition). This can be useful for particle image velocimetry (PIV) or
127
triangulation with a laser fan. The tilt causes a perspective distortion of \f$x''\f$ and
128
\f$y''\f$. This distortion can be modelled in the following way, see e.g. @cite Louhichi07.
129
130
\f[\begin{array}{l}
131
s\vecthree{x'''}{y'''}{1} =
132
\vecthreethree{R_{33}(\tau_x, \tau_y)}{0}{-R_{13}(\tau_x, \tau_y)}
133
{0}{R_{33}(\tau_x, \tau_y)}{-R_{23}(\tau_x, \tau_y)}
134
{0}{0}{1} R(\tau_x, \tau_y) \vecthree{x''}{y''}{1}\\
135
u = f_x*x''' + c_x \\
136
v = f_y*y''' + c_y
137
\end{array}\f]
138
139
where the matrix \f$R(\tau_x, \tau_y)\f$ is defined by two rotations with angular parameter \f$\tau_x\f$
140
and \f$\tau_y\f$, respectively,
141
142
\f[
143
R(\tau_x, \tau_y) =
144
\vecthreethree{\cos(\tau_y)}{0}{-\sin(\tau_y)}{0}{1}{0}{\sin(\tau_y)}{0}{\cos(\tau_y)}
145
\vecthreethree{1}{0}{0}{0}{\cos(\tau_x)}{\sin(\tau_x)}{0}{-\sin(\tau_x)}{\cos(\tau_x)} =
146
\vecthreethree{\cos(\tau_y)}{\sin(\tau_y)\sin(\tau_x)}{-\sin(\tau_y)\cos(\tau_x)}
147
{0}{\cos(\tau_x)}{\sin(\tau_x)}
148
{\sin(\tau_y)}{-\cos(\tau_y)\sin(\tau_x)}{\cos(\tau_y)\cos(\tau_x)}.
149
\f]
150
151
In the functions below the coefficients are passed or returned as
152
153
\f[(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f]
154
155
vector. That is, if the vector contains four elements, it means that \f$k_3=0\f$ . The distortion
156
coefficients do not depend on the scene viewed. Thus, they also belong to the intrinsic camera
157
parameters. And they remain the same regardless of the captured image resolution. If, for example, a
158
camera has been calibrated on images of 320 x 240 resolution, absolutely the same distortion
159
coefficients can be used for 640 x 480 images from the same camera while \f$f_x\f$, \f$f_y\f$, \f$c_x\f$, and
160
\f$c_y\f$ need to be scaled appropriately.
161
162
The functions below use the above model to do the following:
163
164
- Project 3D points to the image plane given intrinsic and extrinsic parameters.
165
- Compute extrinsic parameters given intrinsic parameters, a few 3D points, and their
166
projections.
167
- Estimate intrinsic and extrinsic camera parameters from several views of a known calibration
168
pattern (every view is described by several 3D-2D point correspondences).
169
- Estimate the relative position and orientation of the stereo camera "heads" and compute the
170
*rectification* transformation that makes the camera optical axes parallel.
171
172
@note
173
- A calibration sample for 3 cameras in horizontal position can be found at
174
opencv_source_code/samples/cpp/3calibration.cpp
175
- A calibration sample based on a sequence of images can be found at
176
opencv_source_code/samples/cpp/calibration.cpp
177
- A calibration sample in order to do 3D reconstruction can be found at
178
opencv_source_code/samples/cpp/build3dmodel.cpp
179
- A calibration sample of an artificially generated camera and chessboard patterns can be
180
found at opencv_source_code/samples/cpp/calibration_artificial.cpp
181
- A calibration example on stereo calibration can be found at
182
opencv_source_code/samples/cpp/stereo_calib.cpp
183
- A calibration example on stereo matching can be found at
184
opencv_source_code/samples/cpp/stereo_match.cpp
185
- (Python) A camera calibration sample can be found at
186
opencv_source_code/samples/python/calibrate.py
187
188
@{
189
@defgroup calib3d_fisheye Fisheye camera model
190
191
Definitions: Let P be a point in 3D of coordinates X in the world reference frame (stored in the
192
matrix X) The coordinate vector of P in the camera reference frame is:
193
194
\f[Xc = R X + T\f]
195
196
where R is the rotation matrix corresponding to the rotation vector om: R = rodrigues(om); call x, y
197
and z the 3 coordinates of Xc:
198
199
\f[x = Xc_1 \\ y = Xc_2 \\ z = Xc_3\f]
200
201
The pinhole projection coordinates of P is [a; b] where
202
203
\f[a = x / z \ and \ b = y / z \\ r^2 = a^2 + b^2 \\ \theta = atan(r)\f]
204
205
Fisheye distortion:
206
207
\f[\theta_d = \theta (1 + k_1 \theta^2 + k_2 \theta^4 + k_3 \theta^6 + k_4 \theta^8)\f]
208
209
The distorted point coordinates are [x'; y'] where
210
211
\f[x' = (\theta_d / r) a \\ y' = (\theta_d / r) b \f]
212
213
Finally, conversion into pixel coordinates: The final pixel coordinates vector [u; v] where:
214
215
\f[u = f_x (x' + \alpha y') + c_x \\
216
v = f_y y' + c_y\f]
217
218
@defgroup calib3d_c C API
219
220
@}
221
*/
222
223
namespace cv
224
{
225
226
//! @addtogroup calib3d
227
//! @{
228
229
//! type of the robust estimation algorithm
230
enum { LMEDS = 4, //!< least-median of squares algorithm
231
RANSAC = 8, //!< RANSAC algorithm
232
RHO = 16 //!< RHO algorithm
233
};
234
235
enum { SOLVEPNP_ITERATIVE = 0,
236
SOLVEPNP_EPNP = 1, //!< EPnP: Efficient Perspective-n-Point Camera Pose Estimation @cite lepetit2009epnp
237
SOLVEPNP_P3P = 2, //!< Complete Solution Classification for the Perspective-Three-Point Problem @cite gao2003complete
238
SOLVEPNP_DLS = 3, //!< A Direct Least-Squares (DLS) Method for PnP @cite hesch2011direct
239
SOLVEPNP_UPNP = 4, //!< Exhaustive Linearization for Robust Camera Pose and Focal Length Estimation @cite penate2013exhaustive
240
SOLVEPNP_AP3P = 5, //!< An Efficient Algebraic Solution to the Perspective-Three-Point Problem @cite Ke17
241
SOLVEPNP_MAX_COUNT //!< Used for count
242
};
243
244
enum { CALIB_CB_ADAPTIVE_THRESH = 1,
245
CALIB_CB_NORMALIZE_IMAGE = 2,
246
CALIB_CB_FILTER_QUADS = 4,
247
CALIB_CB_FAST_CHECK = 8,
248
CALIB_CB_EXHAUSTIVE = 16,
249
CALIB_CB_ACCURACY = 32
250
};
251
252
enum { CALIB_CB_SYMMETRIC_GRID = 1,
253
CALIB_CB_ASYMMETRIC_GRID = 2,
254
CALIB_CB_CLUSTERING = 4
255
};
256
257
enum { CALIB_USE_INTRINSIC_GUESS = 0x00001,
258
CALIB_FIX_ASPECT_RATIO = 0x00002,
259
CALIB_FIX_PRINCIPAL_POINT = 0x00004,
260
CALIB_ZERO_TANGENT_DIST = 0x00008,
261
CALIB_FIX_FOCAL_LENGTH = 0x00010,
262
CALIB_FIX_K1 = 0x00020,
263
CALIB_FIX_K2 = 0x00040,
264
CALIB_FIX_K3 = 0x00080,
265
CALIB_FIX_K4 = 0x00800,
266
CALIB_FIX_K5 = 0x01000,
267
CALIB_FIX_K6 = 0x02000,
268
CALIB_RATIONAL_MODEL = 0x04000,
269
CALIB_THIN_PRISM_MODEL = 0x08000,
270
CALIB_FIX_S1_S2_S3_S4 = 0x10000,
271
CALIB_TILTED_MODEL = 0x40000,
272
CALIB_FIX_TAUX_TAUY = 0x80000,
273
CALIB_USE_QR = 0x100000, //!< use QR instead of SVD decomposition for solving. Faster but potentially less precise
274
CALIB_FIX_TANGENT_DIST = 0x200000,
275
// only for stereo
276
CALIB_FIX_INTRINSIC = 0x00100,
277
CALIB_SAME_FOCAL_LENGTH = 0x00200,
278
// for stereo rectification
279
CALIB_ZERO_DISPARITY = 0x00400,
280
CALIB_USE_LU = (1 << 17), //!< use LU instead of SVD decomposition for solving. much faster but potentially less precise
281
CALIB_USE_EXTRINSIC_GUESS = (1 << 22), //!< for stereoCalibrate
282
};
283
284
//! the algorithm for finding fundamental matrix
285
enum { FM_7POINT = 1, //!< 7-point algorithm
286
FM_8POINT = 2, //!< 8-point algorithm
287
FM_LMEDS = 4, //!< least-median algorithm. 7-point algorithm is used.
288
FM_RANSAC = 8 //!< RANSAC algorithm. It needs at least 15 points. 7-point algorithm is used.
289
};
290
291
292
293
/** @brief Converts a rotation matrix to a rotation vector or vice versa.
294
295
@param src Input rotation vector (3x1 or 1x3) or rotation matrix (3x3).
296
@param dst Output rotation matrix (3x3) or rotation vector (3x1 or 1x3), respectively.
297
@param jacobian Optional output Jacobian matrix, 3x9 or 9x3, which is a matrix of partial
298
derivatives of the output array components with respect to the input array components.
299
300
\f[\begin{array}{l} \theta \leftarrow norm(r) \\ r \leftarrow r/ \theta \\ R = \cos{\theta} I + (1- \cos{\theta} ) r r^T + \sin{\theta} \vecthreethree{0}{-r_z}{r_y}{r_z}{0}{-r_x}{-r_y}{r_x}{0} \end{array}\f]
301
302
Inverse transformation can be also done easily, since
303
304
\f[\sin ( \theta ) \vecthreethree{0}{-r_z}{r_y}{r_z}{0}{-r_x}{-r_y}{r_x}{0} = \frac{R - R^T}{2}\f]
305
306
A rotation vector is a convenient and most compact representation of a rotation matrix (since any
307
rotation matrix has just 3 degrees of freedom). The representation is used in the global 3D geometry
308
optimization procedures like calibrateCamera, stereoCalibrate, or solvePnP .
309
*/
310
CV_EXPORTS_W void Rodrigues( InputArray src, OutputArray dst, OutputArray jacobian = noArray() );
311
312
/** @example samples/cpp/tutorial_code/features2D/Homography/pose_from_homography.cpp
313
An example program about pose estimation from coplanar points
314
315
Check @ref tutorial_homography "the corresponding tutorial" for more details
316
*/
317
318
/** @brief Finds a perspective transformation between two planes.
319
320
@param srcPoints Coordinates of the points in the original plane, a matrix of the type CV_32FC2
321
or vector\<Point2f\> .
322
@param dstPoints Coordinates of the points in the target plane, a matrix of the type CV_32FC2 or
323
a vector\<Point2f\> .
324
@param method Method used to compute a homography matrix. The following methods are possible:
325
- **0** - a regular method using all the points, i.e., the least squares method
326
- **RANSAC** - RANSAC-based robust method
327
- **LMEDS** - Least-Median robust method
328
- **RHO** - PROSAC-based robust method
329
@param ransacReprojThreshold Maximum allowed reprojection error to treat a point pair as an inlier
330
(used in the RANSAC and RHO methods only). That is, if
331
\f[\| \texttt{dstPoints} _i - \texttt{convertPointsHomogeneous} ( \texttt{H} * \texttt{srcPoints} _i) \|_2 > \texttt{ransacReprojThreshold}\f]
332
then the point \f$i\f$ is considered as an outlier. If srcPoints and dstPoints are measured in pixels,
333
it usually makes sense to set this parameter somewhere in the range of 1 to 10.
334
@param mask Optional output mask set by a robust method ( RANSAC or LMEDS ). Note that the input
335
mask values are ignored.
336
@param maxIters The maximum number of RANSAC iterations.
337
@param confidence Confidence level, between 0 and 1.
338
339
The function finds and returns the perspective transformation \f$H\f$ between the source and the
340
destination planes:
341
342
\f[s_i \vecthree{x'_i}{y'_i}{1} \sim H \vecthree{x_i}{y_i}{1}\f]
343
344
so that the back-projection error
345
346
\f[\sum _i \left ( x'_i- \frac{h_{11} x_i + h_{12} y_i + h_{13}}{h_{31} x_i + h_{32} y_i + h_{33}} \right )^2+ \left ( y'_i- \frac{h_{21} x_i + h_{22} y_i + h_{23}}{h_{31} x_i + h_{32} y_i + h_{33}} \right )^2\f]
347
348
is minimized. If the parameter method is set to the default value 0, the function uses all the point
349
pairs to compute an initial homography estimate with a simple least-squares scheme.
350
351
However, if not all of the point pairs ( \f$srcPoints_i\f$, \f$dstPoints_i\f$ ) fit the rigid perspective
352
transformation (that is, there are some outliers), this initial estimate will be poor. In this case,
353
you can use one of the three robust methods. The methods RANSAC, LMeDS and RHO try many different
354
random subsets of the corresponding point pairs (of four pairs each, collinear pairs are discarded), estimate the homography matrix
355
using this subset and a simple least-squares algorithm, and then compute the quality/goodness of the
356
computed homography (which is the number of inliers for RANSAC or the least median re-projection error for
357
LMeDS). The best subset is then used to produce the initial estimate of the homography matrix and
358
the mask of inliers/outliers.
359
360
Regardless of the method, robust or not, the computed homography matrix is refined further (using
361
inliers only in case of a robust method) with the Levenberg-Marquardt method to reduce the
362
re-projection error even more.
363
364
The methods RANSAC and RHO can handle practically any ratio of outliers but need a threshold to
365
distinguish inliers from outliers. The method LMeDS does not need any threshold but it works
366
correctly only when there are more than 50% of inliers. Finally, if there are no outliers and the
367
noise is rather small, use the default method (method=0).
368
369
The function is used to find initial intrinsic and extrinsic matrices. Homography matrix is
370
determined up to a scale. Thus, it is normalized so that \f$h_{33}=1\f$. Note that whenever an \f$H\f$ matrix
371
cannot be estimated, an empty one will be returned.
372
373
@sa
374
getAffineTransform, estimateAffine2D, estimateAffinePartial2D, getPerspectiveTransform, warpPerspective,
375
perspectiveTransform
376
*/
377
CV_EXPORTS_W Mat findHomography( InputArray srcPoints, InputArray dstPoints,
378
int method = 0, double ransacReprojThreshold = 3,
379
OutputArray mask=noArray(), const int maxIters = 2000,
380
const double confidence = 0.995);
381
382
/** @overload */
383
CV_EXPORTS Mat findHomography( InputArray srcPoints, InputArray dstPoints,
384
OutputArray mask, int method = 0, double ransacReprojThreshold = 3 );
385
386
/** @brief Computes an RQ decomposition of 3x3 matrices.
387
388
@param src 3x3 input matrix.
389
@param mtxR Output 3x3 upper-triangular matrix.
390
@param mtxQ Output 3x3 orthogonal matrix.
391
@param Qx Optional output 3x3 rotation matrix around x-axis.
392
@param Qy Optional output 3x3 rotation matrix around y-axis.
393
@param Qz Optional output 3x3 rotation matrix around z-axis.
394
395
The function computes a RQ decomposition using the given rotations. This function is used in
396
decomposeProjectionMatrix to decompose the left 3x3 submatrix of a projection matrix into a camera
397
and a rotation matrix.
398
399
It optionally returns three rotation matrices, one for each axis, and the three Euler angles in
400
degrees (as the return value) that could be used in OpenGL. Note, there is always more than one
401
sequence of rotations about the three principal axes that results in the same orientation of an
402
object, e.g. see @cite Slabaugh . Returned tree rotation matrices and corresponding three Euler angles
403
are only one of the possible solutions.
404
*/
405
CV_EXPORTS_W Vec3d RQDecomp3x3( InputArray src, OutputArray mtxR, OutputArray mtxQ,
406
OutputArray Qx = noArray(),
407
OutputArray Qy = noArray(),
408
OutputArray Qz = noArray());
409
410
/** @brief Decomposes a projection matrix into a rotation matrix and a camera matrix.
411
412
@param projMatrix 3x4 input projection matrix P.
413
@param cameraMatrix Output 3x3 camera matrix K.
414
@param rotMatrix Output 3x3 external rotation matrix R.
415
@param transVect Output 4x1 translation vector T.
416
@param rotMatrixX Optional 3x3 rotation matrix around x-axis.
417
@param rotMatrixY Optional 3x3 rotation matrix around y-axis.
418
@param rotMatrixZ Optional 3x3 rotation matrix around z-axis.
419
@param eulerAngles Optional three-element vector containing three Euler angles of rotation in
420
degrees.
421
422
The function computes a decomposition of a projection matrix into a calibration and a rotation
423
matrix and the position of a camera.
424
425
It optionally returns three rotation matrices, one for each axis, and three Euler angles that could
426
be used in OpenGL. Note, there is always more than one sequence of rotations about the three
427
principal axes that results in the same orientation of an object, e.g. see @cite Slabaugh . Returned
428
tree rotation matrices and corresponding three Euler angles are only one of the possible solutions.
429
430
The function is based on RQDecomp3x3 .
431
*/
432
CV_EXPORTS_W void decomposeProjectionMatrix( InputArray projMatrix, OutputArray cameraMatrix,
433
OutputArray rotMatrix, OutputArray transVect,
434
OutputArray rotMatrixX = noArray(),
435
OutputArray rotMatrixY = noArray(),
436
OutputArray rotMatrixZ = noArray(),
437
OutputArray eulerAngles =noArray() );
438
439
/** @brief Computes partial derivatives of the matrix product for each multiplied matrix.
440
441
@param A First multiplied matrix.
442
@param B Second multiplied matrix.
443
@param dABdA First output derivative matrix d(A\*B)/dA of size
444
\f$\texttt{A.rows*B.cols} \times {A.rows*A.cols}\f$ .
445
@param dABdB Second output derivative matrix d(A\*B)/dB of size
446
\f$\texttt{A.rows*B.cols} \times {B.rows*B.cols}\f$ .
447
448
The function computes partial derivatives of the elements of the matrix product \f$A*B\f$ with regard to
449
the elements of each of the two input matrices. The function is used to compute the Jacobian
450
matrices in stereoCalibrate but can also be used in any other similar optimization function.
451
*/
452
CV_EXPORTS_W void matMulDeriv( InputArray A, InputArray B, OutputArray dABdA, OutputArray dABdB );
453
454
/** @brief Combines two rotation-and-shift transformations.
455
456
@param rvec1 First rotation vector.
457
@param tvec1 First translation vector.
458
@param rvec2 Second rotation vector.
459
@param tvec2 Second translation vector.
460
@param rvec3 Output rotation vector of the superposition.
461
@param tvec3 Output translation vector of the superposition.
462
@param dr3dr1
463
@param dr3dt1
464
@param dr3dr2
465
@param dr3dt2
466
@param dt3dr1
467
@param dt3dt1
468
@param dt3dr2
469
@param dt3dt2 Optional output derivatives of rvec3 or tvec3 with regard to rvec1, rvec2, tvec1 and
470
tvec2, respectively.
471
472
The functions compute:
473
474
\f[\begin{array}{l} \texttt{rvec3} = \mathrm{rodrigues} ^{-1} \left ( \mathrm{rodrigues} ( \texttt{rvec2} ) \cdot \mathrm{rodrigues} ( \texttt{rvec1} ) \right ) \\ \texttt{tvec3} = \mathrm{rodrigues} ( \texttt{rvec2} ) \cdot \texttt{tvec1} + \texttt{tvec2} \end{array} ,\f]
475
476
where \f$\mathrm{rodrigues}\f$ denotes a rotation vector to a rotation matrix transformation, and
477
\f$\mathrm{rodrigues}^{-1}\f$ denotes the inverse transformation. See Rodrigues for details.
478
479
Also, the functions can compute the derivatives of the output vectors with regards to the input
480
vectors (see matMulDeriv ). The functions are used inside stereoCalibrate but can also be used in
481
your own code where Levenberg-Marquardt or another gradient-based solver is used to optimize a
482
function that contains a matrix multiplication.
483
*/
484
CV_EXPORTS_W void composeRT( InputArray rvec1, InputArray tvec1,
485
InputArray rvec2, InputArray tvec2,
486
OutputArray rvec3, OutputArray tvec3,
487
OutputArray dr3dr1 = noArray(), OutputArray dr3dt1 = noArray(),
488
OutputArray dr3dr2 = noArray(), OutputArray dr3dt2 = noArray(),
489
OutputArray dt3dr1 = noArray(), OutputArray dt3dt1 = noArray(),
490
OutputArray dt3dr2 = noArray(), OutputArray dt3dt2 = noArray() );
491
492
/** @brief Projects 3D points to an image plane.
493
494
@param objectPoints Array of object points, 3xN/Nx3 1-channel or 1xN/Nx1 3-channel (or
495
vector\<Point3f\> ), where N is the number of points in the view.
496
@param rvec Rotation vector. See Rodrigues for details.
497
@param tvec Translation vector.
498
@param cameraMatrix Camera matrix \f$A = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{_1}\f$ .
499
@param distCoeffs Input vector of distortion coefficients
500
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$ of
501
4, 5, 8, 12 or 14 elements. If the vector is empty, the zero distortion coefficients are assumed.
502
@param imagePoints Output array of image points, 2xN/Nx2 1-channel or 1xN/Nx1 2-channel, or
503
vector\<Point2f\> .
504
@param jacobian Optional output 2Nx(10+\<numDistCoeffs\>) jacobian matrix of derivatives of image
505
points with respect to components of the rotation vector, translation vector, focal lengths,
506
coordinates of the principal point and the distortion coefficients. In the old interface different
507
components of the jacobian are returned via different output parameters.
508
@param aspectRatio Optional "fixed aspect ratio" parameter. If the parameter is not 0, the
509
function assumes that the aspect ratio (*fx/fy*) is fixed and correspondingly adjusts the jacobian
510
matrix.
511
512
The function computes projections of 3D points to the image plane given intrinsic and extrinsic
513
camera parameters. Optionally, the function computes Jacobians - matrices of partial derivatives of
514
image points coordinates (as functions of all the input parameters) with respect to the particular
515
parameters, intrinsic and/or extrinsic. The Jacobians are used during the global optimization in
516
calibrateCamera, solvePnP, and stereoCalibrate . The function itself can also be used to compute a
517
re-projection error given the current intrinsic and extrinsic parameters.
518
519
@note By setting rvec=tvec=(0,0,0) or by setting cameraMatrix to a 3x3 identity matrix, or by
520
passing zero distortion coefficients, you can get various useful partial cases of the function. This
521
means that you can compute the distorted coordinates for a sparse set of points or apply a
522
perspective transformation (and also compute the derivatives) in the ideal zero-distortion setup.
523
*/
524
CV_EXPORTS_W void projectPoints( InputArray objectPoints,
525
InputArray rvec, InputArray tvec,
526
InputArray cameraMatrix, InputArray distCoeffs,
527
OutputArray imagePoints,
528
OutputArray jacobian = noArray(),
529
double aspectRatio = 0 );
530
531
/** @example samples/cpp/tutorial_code/features2D/Homography/homography_from_camera_displacement.cpp
532
An example program about homography from the camera displacement
533
534
Check @ref tutorial_homography "the corresponding tutorial" for more details
535
*/
536
537
/** @brief Finds an object pose from 3D-2D point correspondences.
538
539
@param objectPoints Array of object points in the object coordinate space, Nx3 1-channel or
540
1xN/Nx1 3-channel, where N is the number of points. vector\<Point3f\> can be also passed here.
541
@param imagePoints Array of corresponding image points, Nx2 1-channel or 1xN/Nx1 2-channel,
542
where N is the number of points. vector\<Point2f\> can be also passed here.
543
@param cameraMatrix Input camera matrix \f$A = \vecthreethree{fx}{0}{cx}{0}{fy}{cy}{0}{0}{1}\f$ .
544
@param distCoeffs Input vector of distortion coefficients
545
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$ of
546
4, 5, 8, 12 or 14 elements. If the vector is NULL/empty, the zero distortion coefficients are
547
assumed.
548
@param rvec Output rotation vector (see @ref Rodrigues ) that, together with tvec , brings points from
549
the model coordinate system to the camera coordinate system.
550
@param tvec Output translation vector.
551
@param useExtrinsicGuess Parameter used for #SOLVEPNP_ITERATIVE. If true (1), the function uses
552
the provided rvec and tvec values as initial approximations of the rotation and translation
553
vectors, respectively, and further optimizes them.
554
@param flags Method for solving a PnP problem:
555
- **SOLVEPNP_ITERATIVE** Iterative method is based on Levenberg-Marquardt optimization. In
556
this case the function finds such a pose that minimizes reprojection error, that is the sum
557
of squared distances between the observed projections imagePoints and the projected (using
558
projectPoints ) objectPoints .
559
- **SOLVEPNP_P3P** Method is based on the paper of X.S. Gao, X.-R. Hou, J. Tang, H.-F. Chang
560
"Complete Solution Classification for the Perspective-Three-Point Problem" (@cite gao2003complete).
561
In this case the function requires exactly four object and image points.
562
- **SOLVEPNP_AP3P** Method is based on the paper of T. Ke, S. Roumeliotis
563
"An Efficient Algebraic Solution to the Perspective-Three-Point Problem" (@cite Ke17).
564
In this case the function requires exactly four object and image points.
565
- **SOLVEPNP_EPNP** Method has been introduced by F.Moreno-Noguer, V.Lepetit and P.Fua in the
566
paper "EPnP: Efficient Perspective-n-Point Camera Pose Estimation" (@cite lepetit2009epnp).
567
- **SOLVEPNP_DLS** Method is based on the paper of Joel A. Hesch and Stergios I. Roumeliotis.
568
"A Direct Least-Squares (DLS) Method for PnP" (@cite hesch2011direct).
569
- **SOLVEPNP_UPNP** Method is based on the paper of A.Penate-Sanchez, J.Andrade-Cetto,
570
F.Moreno-Noguer. "Exhaustive Linearization for Robust Camera Pose and Focal Length
571
Estimation" (@cite penate2013exhaustive). In this case the function also estimates the parameters \f$f_x\f$ and \f$f_y\f$
572
assuming that both have the same value. Then the cameraMatrix is updated with the estimated
573
focal length.
574
- **SOLVEPNP_AP3P** Method is based on the paper of Tong Ke and Stergios I. Roumeliotis.
575
"An Efficient Algebraic Solution to the Perspective-Three-Point Problem" (@cite Ke17). In this case the
576
function requires exactly four object and image points.
577
578
The function estimates the object pose given a set of object points, their corresponding image
579
projections, as well as the camera matrix and the distortion coefficients, see the figure below
580
(more precisely, the X-axis of the camera frame is pointing to the right, the Y-axis downward
581
and the Z-axis forward).
582
583
![](pnp.jpg)
584
585
Points expressed in the world frame \f$ \bf{X}_w \f$ are projected into the image plane \f$ \left[ u, v \right] \f$
586
using the perspective projection model \f$ \Pi \f$ and the camera intrinsic parameters matrix \f$ \bf{A} \f$:
587
588
\f[
589
\begin{align*}
590
\begin{bmatrix}
591
u \\
592
v \\
593
1
594
\end{bmatrix} &=
595
\bf{A} \hspace{0.1em} \Pi \hspace{0.2em} ^{c}\bf{M}_w
596
\begin{bmatrix}
597
X_{w} \\
598
Y_{w} \\
599
Z_{w} \\
600
1
601
\end{bmatrix} \\
602
\begin{bmatrix}
603
u \\
604
v \\
605
1
606
\end{bmatrix} &=
607
\begin{bmatrix}
608
f_x & 0 & c_x \\
609
0 & f_y & c_y \\
610
0 & 0 & 1
611
\end{bmatrix}
612
\begin{bmatrix}
613
1 & 0 & 0 & 0 \\
614
0 & 1 & 0 & 0 \\
615
0 & 0 & 1 & 0
616
\end{bmatrix}
617
\begin{bmatrix}
618
r_{11} & r_{12} & r_{13} & t_x \\
619
r_{21} & r_{22} & r_{23} & t_y \\
620
r_{31} & r_{32} & r_{33} & t_z \\
621
0 & 0 & 0 & 1
622
\end{bmatrix}
623
\begin{bmatrix}
624
X_{w} \\
625
Y_{w} \\
626
Z_{w} \\
627
1
628
\end{bmatrix}
629
\end{align*}
630
\f]
631
632
The estimated pose is thus the rotation (`rvec`) and the translation (`tvec`) vectors that allow to transform
633
a 3D point expressed in the world frame into the camera frame:
634
635
\f[
636
\begin{align*}
637
\begin{bmatrix}
638
X_c \\
639
Y_c \\
640
Z_c \\
641
1
642
\end{bmatrix} &=
643
\hspace{0.2em} ^{c}\bf{M}_w
644
\begin{bmatrix}
645
X_{w} \\
646
Y_{w} \\
647
Z_{w} \\
648
1
649
\end{bmatrix} \\
650
\begin{bmatrix}
651
X_c \\
652
Y_c \\
653
Z_c \\
654
1
655
\end{bmatrix} &=
656
\begin{bmatrix}
657
r_{11} & r_{12} & r_{13} & t_x \\
658
r_{21} & r_{22} & r_{23} & t_y \\
659
r_{31} & r_{32} & r_{33} & t_z \\
660
0 & 0 & 0 & 1
661
\end{bmatrix}
662
\begin{bmatrix}
663
X_{w} \\
664
Y_{w} \\
665
Z_{w} \\
666
1
667
\end{bmatrix}
668
\end{align*}
669
\f]
670
671
@note
672
- An example of how to use solvePnP for planar augmented reality can be found at
673
opencv_source_code/samples/python/plane_ar.py
674
- If you are using Python:
675
- Numpy array slices won't work as input because solvePnP requires contiguous
676
arrays (enforced by the assertion using cv::Mat::checkVector() around line 55 of
677
modules/calib3d/src/solvepnp.cpp version 2.4.9)
678
- The P3P algorithm requires image points to be in an array of shape (N,1,2) due
679
to its calling of cv::undistortPoints (around line 75 of modules/calib3d/src/solvepnp.cpp version 2.4.9)
680
which requires 2-channel information.
681
- Thus, given some data D = np.array(...) where D.shape = (N,M), in order to use a subset of
682
it as, e.g., imagePoints, one must effectively copy it into a new array: imagePoints =
683
np.ascontiguousarray(D[:,:2]).reshape((N,1,2))
684
- The methods **SOLVEPNP_DLS** and **SOLVEPNP_UPNP** cannot be used as the current implementations are
685
unstable and sometimes give completely wrong results. If you pass one of these two
686
flags, **SOLVEPNP_EPNP** method will be used instead.
687
- The minimum number of points is 4 in the general case. In the case of **SOLVEPNP_P3P** and **SOLVEPNP_AP3P**
688
methods, it is required to use exactly 4 points (the first 3 points are used to estimate all the solutions
689
of the P3P problem, the last one is used to retain the best solution that minimizes the reprojection error).
690
- With **SOLVEPNP_ITERATIVE** method and `useExtrinsicGuess=true`, the minimum number of points is 3 (3 points
691
are sufficient to compute a pose but there are up to 4 solutions). The initial solution should be close to the
692
global solution to converge.
693
*/
694
CV_EXPORTS_W bool solvePnP( InputArray objectPoints, InputArray imagePoints,
695
InputArray cameraMatrix, InputArray distCoeffs,
696
OutputArray rvec, OutputArray tvec,
697
bool useExtrinsicGuess = false, int flags = SOLVEPNP_ITERATIVE );
698
699
/** @brief Finds an object pose from 3D-2D point correspondences using the RANSAC scheme.
700
701
@param objectPoints Array of object points in the object coordinate space, Nx3 1-channel or
702
1xN/Nx1 3-channel, where N is the number of points. vector\<Point3f\> can be also passed here.
703
@param imagePoints Array of corresponding image points, Nx2 1-channel or 1xN/Nx1 2-channel,
704
where N is the number of points. vector\<Point2f\> can be also passed here.
705
@param cameraMatrix Input camera matrix \f$A = \vecthreethree{fx}{0}{cx}{0}{fy}{cy}{0}{0}{1}\f$ .
706
@param distCoeffs Input vector of distortion coefficients
707
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$ of
708
4, 5, 8, 12 or 14 elements. If the vector is NULL/empty, the zero distortion coefficients are
709
assumed.
710
@param rvec Output rotation vector (see Rodrigues ) that, together with tvec , brings points from
711
the model coordinate system to the camera coordinate system.
712
@param tvec Output translation vector.
713
@param useExtrinsicGuess Parameter used for SOLVEPNP_ITERATIVE. If true (1), the function uses
714
the provided rvec and tvec values as initial approximations of the rotation and translation
715
vectors, respectively, and further optimizes them.
716
@param iterationsCount Number of iterations.
717
@param reprojectionError Inlier threshold value used by the RANSAC procedure. The parameter value
718
is the maximum allowed distance between the observed and computed point projections to consider it
719
an inlier.
720
@param confidence The probability that the algorithm produces a useful result.
721
@param inliers Output vector that contains indices of inliers in objectPoints and imagePoints .
722
@param flags Method for solving a PnP problem (see solvePnP ).
723
724
The function estimates an object pose given a set of object points, their corresponding image
725
projections, as well as the camera matrix and the distortion coefficients. This function finds such
726
a pose that minimizes reprojection error, that is, the sum of squared distances between the observed
727
projections imagePoints and the projected (using projectPoints ) objectPoints. The use of RANSAC
728
makes the function resistant to outliers.
729
730
@note
731
- An example of how to use solvePNPRansac for object detection can be found at
732
opencv_source_code/samples/cpp/tutorial_code/calib3d/real_time_pose_estimation/
733
- The default method used to estimate the camera pose for the Minimal Sample Sets step
734
is #SOLVEPNP_EPNP. Exceptions are:
735
- if you choose #SOLVEPNP_P3P or #SOLVEPNP_AP3P, these methods will be used.
736
- if the number of input points is equal to 4, #SOLVEPNP_P3P is used.
737
- The method used to estimate the camera pose using all the inliers is defined by the
738
flags parameters unless it is equal to #SOLVEPNP_P3P or #SOLVEPNP_AP3P. In this case,
739
the method #SOLVEPNP_EPNP will be used instead.
740
*/
741
CV_EXPORTS_W bool solvePnPRansac( InputArray objectPoints, InputArray imagePoints,
742
InputArray cameraMatrix, InputArray distCoeffs,
743
OutputArray rvec, OutputArray tvec,
744
bool useExtrinsicGuess = false, int iterationsCount = 100,
745
float reprojectionError = 8.0, double confidence = 0.99,
746
OutputArray inliers = noArray(), int flags = SOLVEPNP_ITERATIVE );
747
/** @brief Finds an object pose from 3 3D-2D point correspondences.
748
749
@param objectPoints Array of object points in the object coordinate space, 3x3 1-channel or
750
1x3/3x1 3-channel. vector\<Point3f\> can be also passed here.
751
@param imagePoints Array of corresponding image points, 3x2 1-channel or 1x3/3x1 2-channel.
752
vector\<Point2f\> can be also passed here.
753
@param cameraMatrix Input camera matrix \f$A = \vecthreethree{fx}{0}{cx}{0}{fy}{cy}{0}{0}{1}\f$ .
754
@param distCoeffs Input vector of distortion coefficients
755
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$ of
756
4, 5, 8, 12 or 14 elements. If the vector is NULL/empty, the zero distortion coefficients are
757
assumed.
758
@param rvecs Output rotation vectors (see Rodrigues ) that, together with tvecs , brings points from
759
the model coordinate system to the camera coordinate system. A P3P problem has up to 4 solutions.
760
@param tvecs Output translation vectors.
761
@param flags Method for solving a P3P problem:
762
- **SOLVEPNP_P3P** Method is based on the paper of X.S. Gao, X.-R. Hou, J. Tang, H.-F. Chang
763
"Complete Solution Classification for the Perspective-Three-Point Problem" (@cite gao2003complete).
764
- **SOLVEPNP_AP3P** Method is based on the paper of Tong Ke and Stergios I. Roumeliotis.
765
"An Efficient Algebraic Solution to the Perspective-Three-Point Problem" (@cite Ke17).
766
767
The function estimates the object pose given 3 object points, their corresponding image
768
projections, as well as the camera matrix and the distortion coefficients.
769
*/
770
CV_EXPORTS_W int solveP3P( InputArray objectPoints, InputArray imagePoints,
771
InputArray cameraMatrix, InputArray distCoeffs,
772
OutputArrayOfArrays rvecs, OutputArrayOfArrays tvecs,
773
int flags );
774
775
/** @brief Finds an initial camera matrix from 3D-2D point correspondences.
776
777
@param objectPoints Vector of vectors of the calibration pattern points in the calibration pattern
778
coordinate space. In the old interface all the per-view vectors are concatenated. See
779
calibrateCamera for details.
780
@param imagePoints Vector of vectors of the projections of the calibration pattern points. In the
781
old interface all the per-view vectors are concatenated.
782
@param imageSize Image size in pixels used to initialize the principal point.
783
@param aspectRatio If it is zero or negative, both \f$f_x\f$ and \f$f_y\f$ are estimated independently.
784
Otherwise, \f$f_x = f_y * \texttt{aspectRatio}\f$ .
785
786
The function estimates and returns an initial camera matrix for the camera calibration process.
787
Currently, the function only supports planar calibration patterns, which are patterns where each
788
object point has z-coordinate =0.
789
*/
790
CV_EXPORTS_W Mat initCameraMatrix2D( InputArrayOfArrays objectPoints,
791
InputArrayOfArrays imagePoints,
792
Size imageSize, double aspectRatio = 1.0 );
793
794
/** @brief Finds the positions of internal corners of the chessboard.
795
796
@param image Source chessboard view. It must be an 8-bit grayscale or color image.
797
@param patternSize Number of inner corners per a chessboard row and column
798
( patternSize = cv::Size(points_per_row,points_per_colum) = cv::Size(columns,rows) ).
799
@param corners Output array of detected corners.
800
@param flags Various operation flags that can be zero or a combination of the following values:
801
- **CALIB_CB_ADAPTIVE_THRESH** Use adaptive thresholding to convert the image to black
802
and white, rather than a fixed threshold level (computed from the average image brightness).
803
- **CALIB_CB_NORMALIZE_IMAGE** Normalize the image gamma with equalizeHist before
804
applying fixed or adaptive thresholding.
805
- **CALIB_CB_FILTER_QUADS** Use additional criteria (like contour area, perimeter,
806
square-like shape) to filter out false quads extracted at the contour retrieval stage.
807
- **CALIB_CB_FAST_CHECK** Run a fast check on the image that looks for chessboard corners,
808
and shortcut the call if none is found. This can drastically speed up the call in the
809
degenerate condition when no chessboard is observed.
810
811
The function attempts to determine whether the input image is a view of the chessboard pattern and
812
locate the internal chessboard corners. The function returns a non-zero value if all of the corners
813
are found and they are placed in a certain order (row by row, left to right in every row).
814
Otherwise, if the function fails to find all the corners or reorder them, it returns 0. For example,
815
a regular chessboard has 8 x 8 squares and 7 x 7 internal corners, that is, points where the black
816
squares touch each other. The detected coordinates are approximate, and to determine their positions
817
more accurately, the function calls cornerSubPix. You also may use the function cornerSubPix with
818
different parameters if returned coordinates are not accurate enough.
819
820
Sample usage of detecting and drawing chessboard corners: :
821
@code
822
Size patternsize(8,6); //interior number of corners
823
Mat gray = ....; //source image
824
vector<Point2f> corners; //this will be filled by the detected corners
825
826
//CALIB_CB_FAST_CHECK saves a lot of time on images
827
//that do not contain any chessboard corners
828
bool patternfound = findChessboardCorners(gray, patternsize, corners,
829
CALIB_CB_ADAPTIVE_THRESH + CALIB_CB_NORMALIZE_IMAGE
830
+ CALIB_CB_FAST_CHECK);
831
832
if(patternfound)
833
cornerSubPix(gray, corners, Size(11, 11), Size(-1, -1),
834
TermCriteria(CV_TERMCRIT_EPS + CV_TERMCRIT_ITER, 30, 0.1));
835
836
drawChessboardCorners(img, patternsize, Mat(corners), patternfound);
837
@endcode
838
@note The function requires white space (like a square-thick border, the wider the better) around
839
the board to make the detection more robust in various environments. Otherwise, if there is no
840
border and the background is dark, the outer black squares cannot be segmented properly and so the
841
square grouping and ordering algorithm fails.
842
*/
843
CV_EXPORTS_W bool findChessboardCorners( InputArray image, Size patternSize, OutputArray corners,
844
int flags = CALIB_CB_ADAPTIVE_THRESH + CALIB_CB_NORMALIZE_IMAGE );
845
846
/** @brief Finds the positions of internal corners of the chessboard using a sector based approach.
847
848
@param image Source chessboard view. It must be an 8-bit grayscale or color image.
849
@param patternSize Number of inner corners per a chessboard row and column
850
( patternSize = cv::Size(points_per_row,points_per_colum) = cv::Size(columns,rows) ).
851
@param corners Output array of detected corners.
852
@param flags Various operation flags that can be zero or a combination of the following values:
853
- **CALIB_CB_NORMALIZE_IMAGE** Normalize the image gamma with equalizeHist before detection.
854
- **CALIB_CB_EXHAUSTIVE ** Run an exhaustive search to improve detection rate.
855
- **CALIB_CB_ACCURACY ** Up sample input image to improve sub-pixel accuracy due to aliasing effects.
856
This should be used if an accurate camera calibration is required.
857
858
The function is analog to findchessboardCorners but uses a localized radon
859
transformation approximated by box filters being more robust to all sort of
860
noise, faster on larger images and is able to directly return the sub-pixel
861
position of the internal chessboard corners. The Method is based on the paper
862
@cite duda2018 "Accurate Detection and Localization of Checkerboard Corners for
863
Calibration" demonstrating that the returned sub-pixel positions are more
864
accurate than the one returned by cornerSubPix allowing a precise camera
865
calibration for demanding applications.
866
867
@note The function requires a white boarder with roughly the same width as one
868
of the checkerboard fields around the whole board to improve the detection in
869
various environments. In addition, because of the localized radon
870
transformation it is beneficial to use round corners for the field corners
871
which are located on the outside of the board. The following figure illustrates
872
a sample checkerboard optimized for the detection. However, any other checkerboard
873
can be used as well.
874
![Checkerboard](pics/checkerboard_radon.png)
875
*/
876
CV_EXPORTS_W bool findChessboardCornersSB(InputArray image,Size patternSize, OutputArray corners,int flags=0);
877
878
//! finds subpixel-accurate positions of the chessboard corners
879
CV_EXPORTS bool find4QuadCornerSubpix( InputArray img, InputOutputArray corners, Size region_size );
880
881
/** @brief Renders the detected chessboard corners.
882
883
@param image Destination image. It must be an 8-bit color image.
884
@param patternSize Number of inner corners per a chessboard row and column
885
(patternSize = cv::Size(points_per_row,points_per_column)).
886
@param corners Array of detected corners, the output of findChessboardCorners.
887
@param patternWasFound Parameter indicating whether the complete board was found or not. The
888
return value of findChessboardCorners should be passed here.
889
890
The function draws individual chessboard corners detected either as red circles if the board was not
891
found, or as colored corners connected with lines if the board was found.
892
*/
893
CV_EXPORTS_W void drawChessboardCorners( InputOutputArray image, Size patternSize,
894
InputArray corners, bool patternWasFound );
895
896
struct CV_EXPORTS_W_SIMPLE CirclesGridFinderParameters
897
{
898
CV_WRAP CirclesGridFinderParameters();
899
CV_PROP_RW cv::Size2f densityNeighborhoodSize;
900
CV_PROP_RW float minDensity;
901
CV_PROP_RW int kmeansAttempts;
902
CV_PROP_RW int minDistanceToAddKeypoint;
903
CV_PROP_RW int keypointScale;
904
CV_PROP_RW float minGraphConfidence;
905
CV_PROP_RW float vertexGain;
906
CV_PROP_RW float vertexPenalty;
907
CV_PROP_RW float existingVertexGain;
908
CV_PROP_RW float edgeGain;
909
CV_PROP_RW float edgePenalty;
910
CV_PROP_RW float convexHullFactor;
911
CV_PROP_RW float minRNGEdgeSwitchDist;
912
913
enum GridType
914
{
915
SYMMETRIC_GRID, ASYMMETRIC_GRID
916
};
917
GridType gridType;
918
919
CV_PROP_RW float squareSize; //!< Distance between two adjacent points. Used by CALIB_CB_CLUSTERING.
920
CV_PROP_RW float maxRectifiedDistance; //!< Max deviation from predicion. Used by CALIB_CB_CLUSTERING.
921
};
922
923
#ifndef DISABLE_OPENCV_3_COMPATIBILITY
924
typedef CirclesGridFinderParameters CirclesGridFinderParameters2;
925
#endif
926
927
/** @brief Finds centers in the grid of circles.
928
929
@param image grid view of input circles; it must be an 8-bit grayscale or color image.
930
@param patternSize number of circles per row and column
931
( patternSize = Size(points_per_row, points_per_colum) ).
932
@param centers output array of detected centers.
933
@param flags various operation flags that can be one of the following values:
934
- **CALIB_CB_SYMMETRIC_GRID** uses symmetric pattern of circles.
935
- **CALIB_CB_ASYMMETRIC_GRID** uses asymmetric pattern of circles.
936
- **CALIB_CB_CLUSTERING** uses a special algorithm for grid detection. It is more robust to
937
perspective distortions but much more sensitive to background clutter.
938
@param blobDetector feature detector that finds blobs like dark circles on light background.
939
@param parameters struct for finding circles in a grid pattern.
940
941
The function attempts to determine whether the input image contains a grid of circles. If it is, the
942
function locates centers of the circles. The function returns a non-zero value if all of the centers
943
have been found and they have been placed in a certain order (row by row, left to right in every
944
row). Otherwise, if the function fails to find all the corners or reorder them, it returns 0.
945
946
Sample usage of detecting and drawing the centers of circles: :
947
@code
948
Size patternsize(7,7); //number of centers
949
Mat gray = ....; //source image
950
vector<Point2f> centers; //this will be filled by the detected centers
951
952
bool patternfound = findCirclesGrid(gray, patternsize, centers);
953
954
drawChessboardCorners(img, patternsize, Mat(centers), patternfound);
955
@endcode
956
@note The function requires white space (like a square-thick border, the wider the better) around
957
the board to make the detection more robust in various environments.
958
*/
959
CV_EXPORTS_W bool findCirclesGrid( InputArray image, Size patternSize,
960
OutputArray centers, int flags,
961
const Ptr<FeatureDetector> &blobDetector,
962
const CirclesGridFinderParameters& parameters);
963
964
/** @overload */
965
CV_EXPORTS_W bool findCirclesGrid( InputArray image, Size patternSize,
966
OutputArray centers, int flags = CALIB_CB_SYMMETRIC_GRID,
967
const Ptr<FeatureDetector> &blobDetector = SimpleBlobDetector::create());
968
969
/** @brief Finds the camera intrinsic and extrinsic parameters from several views of a calibration pattern.
970
971
@param objectPoints In the new interface it is a vector of vectors of calibration pattern points in
972
the calibration pattern coordinate space (e.g. std::vector<std::vector<cv::Vec3f>>). The outer
973
vector contains as many elements as the number of the pattern views. If the same calibration pattern
974
is shown in each view and it is fully visible, all the vectors will be the same. Although, it is
975
possible to use partially occluded patterns, or even different patterns in different views. Then,
976
the vectors will be different. The points are 3D, but since they are in a pattern coordinate system,
977
then, if the rig is planar, it may make sense to put the model to a XY coordinate plane so that
978
Z-coordinate of each input object point is 0.
979
In the old interface all the vectors of object points from different views are concatenated
980
together.
981
@param imagePoints In the new interface it is a vector of vectors of the projections of calibration
982
pattern points (e.g. std::vector<std::vector<cv::Vec2f>>). imagePoints.size() and
983
objectPoints.size() and imagePoints[i].size() must be equal to objectPoints[i].size() for each i.
984
In the old interface all the vectors of object points from different views are concatenated
985
together.
986
@param imageSize Size of the image used only to initialize the intrinsic camera matrix.
987
@param cameraMatrix Output 3x3 floating-point camera matrix
988
\f$A = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ . If CV\_CALIB\_USE\_INTRINSIC\_GUESS
989
and/or CALIB_FIX_ASPECT_RATIO are specified, some or all of fx, fy, cx, cy must be
990
initialized before calling the function.
991
@param distCoeffs Output vector of distortion coefficients
992
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$ of
993
4, 5, 8, 12 or 14 elements.
994
@param rvecs Output vector of rotation vectors (see Rodrigues ) estimated for each pattern view
995
(e.g. std::vector<cv::Mat>>). That is, each k-th rotation vector together with the corresponding
996
k-th translation vector (see the next output parameter description) brings the calibration pattern
997
from the model coordinate space (in which object points are specified) to the world coordinate
998
space, that is, a real position of the calibration pattern in the k-th pattern view (k=0.. *M* -1).
999
@param tvecs Output vector of translation vectors estimated for each pattern view.
1000
@param stdDeviationsIntrinsics Output vector of standard deviations estimated for intrinsic parameters.
1001
Order of deviations values:
1002
\f$(f_x, f_y, c_x, c_y, k_1, k_2, p_1, p_2, k_3, k_4, k_5, k_6 , s_1, s_2, s_3,
1003
s_4, \tau_x, \tau_y)\f$ If one of parameters is not estimated, it's deviation is equals to zero.
1004
@param stdDeviationsExtrinsics Output vector of standard deviations estimated for extrinsic parameters.
1005
Order of deviations values: \f$(R_1, T_1, \dotsc , R_M, T_M)\f$ where M is number of pattern views,
1006
\f$R_i, T_i\f$ are concatenated 1x3 vectors.
1007
@param perViewErrors Output vector of the RMS re-projection error estimated for each pattern view.
1008
@param flags Different flags that may be zero or a combination of the following values:
1009
- **CALIB_USE_INTRINSIC_GUESS** cameraMatrix contains valid initial values of
1010
fx, fy, cx, cy that are optimized further. Otherwise, (cx, cy) is initially set to the image
1011
center ( imageSize is used), and focal distances are computed in a least-squares fashion.
1012
Note, that if intrinsic parameters are known, there is no need to use this function just to
1013
estimate extrinsic parameters. Use solvePnP instead.
1014
- **CALIB_FIX_PRINCIPAL_POINT** The principal point is not changed during the global
1015
optimization. It stays at the center or at a different location specified when
1016
CALIB_USE_INTRINSIC_GUESS is set too.
1017
- **CALIB_FIX_ASPECT_RATIO** The functions considers only fy as a free parameter. The
1018
ratio fx/fy stays the same as in the input cameraMatrix . When
1019
CALIB_USE_INTRINSIC_GUESS is not set, the actual input values of fx and fy are
1020
ignored, only their ratio is computed and used further.
1021
- **CALIB_ZERO_TANGENT_DIST** Tangential distortion coefficients \f$(p_1, p_2)\f$ are set
1022
to zeros and stay zero.
1023
- **CALIB_FIX_K1,...,CALIB_FIX_K6** The corresponding radial distortion
1024
coefficient is not changed during the optimization. If CALIB_USE_INTRINSIC_GUESS is
1025
set, the coefficient from the supplied distCoeffs matrix is used. Otherwise, it is set to 0.
1026
- **CALIB_RATIONAL_MODEL** Coefficients k4, k5, and k6 are enabled. To provide the
1027
backward compatibility, this extra flag should be explicitly specified to make the
1028
calibration function use the rational model and return 8 coefficients. If the flag is not
1029
set, the function computes and returns only 5 distortion coefficients.
1030
- **CALIB_THIN_PRISM_MODEL** Coefficients s1, s2, s3 and s4 are enabled. To provide the
1031
backward compatibility, this extra flag should be explicitly specified to make the
1032
calibration function use the thin prism model and return 12 coefficients. If the flag is not
1033
set, the function computes and returns only 5 distortion coefficients.
1034
- **CALIB_FIX_S1_S2_S3_S4** The thin prism distortion coefficients are not changed during
1035
the optimization. If CALIB_USE_INTRINSIC_GUESS is set, the coefficient from the
1036
supplied distCoeffs matrix is used. Otherwise, it is set to 0.
1037
- **CALIB_TILTED_MODEL** Coefficients tauX and tauY are enabled. To provide the
1038
backward compatibility, this extra flag should be explicitly specified to make the
1039
calibration function use the tilted sensor model and return 14 coefficients. If the flag is not
1040
set, the function computes and returns only 5 distortion coefficients.
1041
- **CALIB_FIX_TAUX_TAUY** The coefficients of the tilted sensor model are not changed during
1042
the optimization. If CALIB_USE_INTRINSIC_GUESS is set, the coefficient from the
1043
supplied distCoeffs matrix is used. Otherwise, it is set to 0.
1044
@param criteria Termination criteria for the iterative optimization algorithm.
1045
1046
@return the overall RMS re-projection error.
1047
1048
The function estimates the intrinsic camera parameters and extrinsic parameters for each of the
1049
views. The algorithm is based on @cite Zhang2000 and @cite BouguetMCT . The coordinates of 3D object
1050
points and their corresponding 2D projections in each view must be specified. That may be achieved
1051
by using an object with a known geometry and easily detectable feature points. Such an object is
1052
called a calibration rig or calibration pattern, and OpenCV has built-in support for a chessboard as
1053
a calibration rig (see findChessboardCorners ). Currently, initialization of intrinsic parameters
1054
(when CALIB_USE_INTRINSIC_GUESS is not set) is only implemented for planar calibration
1055
patterns (where Z-coordinates of the object points must be all zeros). 3D calibration rigs can also
1056
be used as long as initial cameraMatrix is provided.
1057
1058
The algorithm performs the following steps:
1059
1060
- Compute the initial intrinsic parameters (the option only available for planar calibration
1061
patterns) or read them from the input parameters. The distortion coefficients are all set to
1062
zeros initially unless some of CALIB_FIX_K? are specified.
1063
1064
- Estimate the initial camera pose as if the intrinsic parameters have been already known. This is
1065
done using solvePnP .
1066
1067
- Run the global Levenberg-Marquardt optimization algorithm to minimize the reprojection error,
1068
that is, the total sum of squared distances between the observed feature points imagePoints and
1069
the projected (using the current estimates for camera parameters and the poses) object points
1070
objectPoints. See projectPoints for details.
1071
1072
@note
1073
If you use a non-square (=non-NxN) grid and findChessboardCorners for calibration, and
1074
calibrateCamera returns bad values (zero distortion coefficients, an image center very far from
1075
(w/2-0.5,h/2-0.5), and/or large differences between \f$f_x\f$ and \f$f_y\f$ (ratios of 10:1 or more)),
1076
then you have probably used patternSize=cvSize(rows,cols) instead of using
1077
patternSize=cvSize(cols,rows) in findChessboardCorners .
1078
1079
@sa
1080
calibrateCameraRO, findChessboardCorners, solvePnP, initCameraMatrix2D, stereoCalibrate, undistort
1081
*/
1082
CV_EXPORTS_AS(calibrateCameraExtended) double calibrateCamera( InputArrayOfArrays objectPoints,
1083
InputArrayOfArrays imagePoints, Size imageSize,
1084
InputOutputArray cameraMatrix, InputOutputArray distCoeffs,
1085
OutputArrayOfArrays rvecs, OutputArrayOfArrays tvecs,
1086
OutputArray stdDeviationsIntrinsics,
1087
OutputArray stdDeviationsExtrinsics,
1088
OutputArray perViewErrors,
1089
int flags = 0, TermCriteria criteria = TermCriteria(
1090
TermCriteria::COUNT + TermCriteria::EPS, 30, DBL_EPSILON) );
1091
1092
/** @overload */
1093
CV_EXPORTS_W double calibrateCamera( InputArrayOfArrays objectPoints,
1094
InputArrayOfArrays imagePoints, Size imageSize,
1095
InputOutputArray cameraMatrix, InputOutputArray distCoeffs,
1096
OutputArrayOfArrays rvecs, OutputArrayOfArrays tvecs,
1097
int flags = 0, TermCriteria criteria = TermCriteria(
1098
TermCriteria::COUNT + TermCriteria::EPS, 30, DBL_EPSILON) );
1099
1100
/** @brief Finds the camera intrinsic and extrinsic parameters from several views of a calibration pattern.
1101
1102
This function is an extension of calibrateCamera() with the method of releasing object which was
1103
proposed in @cite strobl2011iccv. In many common cases with inaccurate, unmeasured, roughly planar
1104
targets (calibration plates), this method can dramatically improve the precision of the estimated
1105
camera parameters. Both the object-releasing method and standard method are supported by this
1106
function. Use the parameter **iFixedPoint** for method selection. In the internal implementation,
1107
calibrateCamera() is a wrapper for this function.
1108
1109
@param objectPoints Vector of vectors of calibration pattern points in the calibration pattern
1110
coordinate space. See calibrateCamera() for details. If the method of releasing object to be used,
1111
the identical calibration board must be used in each view and it must be fully visible, and all
1112
objectPoints[i] must be the same and all points should be roughly close to a plane. **The calibration
1113
target has to be rigid, or at least static if the camera (rather than the calibration target) is
1114
shifted for grabbing images.**
1115
@param imagePoints Vector of vectors of the projections of calibration pattern points. See
1116
calibrateCamera() for details.
1117
@param imageSize Size of the image used only to initialize the intrinsic camera matrix.
1118
@param iFixedPoint The index of the 3D object point in objectPoints[0] to be fixed. It also acts as
1119
a switch for calibration method selection. If object-releasing method to be used, pass in the
1120
parameter in the range of [1, objectPoints[0].size()-2], otherwise a value out of this range will
1121
make standard calibration method selected. Usually the top-right corner point of the calibration
1122
board grid is recommended to be fixed when object-releasing method being utilized. According to
1123
\cite strobl2011iccv, two other points are also fixed. In this implementation, objectPoints[0].front
1124
and objectPoints[0].back.z are used. With object-releasing method, accurate rvecs, tvecs and
1125
newObjPoints are only possible if coordinates of these three fixed points are accurate enough.
1126
@param cameraMatrix Output 3x3 floating-point camera matrix. See calibrateCamera() for details.
1127
@param distCoeffs Output vector of distortion coefficients. See calibrateCamera() for details.
1128
@param rvecs Output vector of rotation vectors estimated for each pattern view. See calibrateCamera()
1129
for details.
1130
@param tvecs Output vector of translation vectors estimated for each pattern view.
1131
@param newObjPoints The updated output vector of calibration pattern points. The coordinates might
1132
be scaled based on three fixed points. The returned coordinates are accurate only if the above
1133
mentioned three fixed points are accurate. If not needed, noArray() can be passed in. This parameter
1134
is ignored with standard calibration method.
1135
@param stdDeviationsIntrinsics Output vector of standard deviations estimated for intrinsic parameters.
1136
See calibrateCamera() for details.
1137
@param stdDeviationsExtrinsics Output vector of standard deviations estimated for extrinsic parameters.
1138
See calibrateCamera() for details.
1139
@param stdDeviationsObjPoints Output vector of standard deviations estimated for refined coordinates
1140
of calibration pattern points. It has the same size and order as objectPoints[0] vector. This
1141
parameter is ignored with standard calibration method.
1142
@param perViewErrors Output vector of the RMS re-projection error estimated for each pattern view.
1143
@param flags Different flags that may be zero or a combination of some predefined values. See
1144
calibrateCamera() for details. If the method of releasing object is used, the calibration time may
1145
be much longer. CALIB_USE_QR or CALIB_USE_LU could be used for faster calibration with potentially
1146
less precise and less stable in some rare cases.
1147
@param criteria Termination criteria for the iterative optimization algorithm.
1148
1149
@return the overall RMS re-projection error.
1150
1151
The function estimates the intrinsic camera parameters and extrinsic parameters for each of the
1152
views. The algorithm is based on @cite Zhang2000, @cite BouguetMCT and @cite strobl2011iccv. See
1153
calibrateCamera() for other detailed explanations.
1154
@sa
1155
calibrateCamera, findChessboardCorners, solvePnP, initCameraMatrix2D, stereoCalibrate, undistort
1156
*/
1157
CV_EXPORTS_AS(calibrateCameraROExtended) double calibrateCameraRO( InputArrayOfArrays objectPoints,
1158
InputArrayOfArrays imagePoints, Size imageSize, int iFixedPoint,
1159
InputOutputArray cameraMatrix, InputOutputArray distCoeffs,
1160
OutputArrayOfArrays rvecs, OutputArrayOfArrays tvecs,
1161
OutputArray newObjPoints,
1162
OutputArray stdDeviationsIntrinsics,
1163
OutputArray stdDeviationsExtrinsics,
1164
OutputArray stdDeviationsObjPoints,
1165
OutputArray perViewErrors,
1166
int flags = 0, TermCriteria criteria = TermCriteria(
1167
TermCriteria::COUNT + TermCriteria::EPS, 30, DBL_EPSILON) );
1168
1169
/** @overload */
1170
CV_EXPORTS_W double calibrateCameraRO( InputArrayOfArrays objectPoints,
1171
InputArrayOfArrays imagePoints, Size imageSize, int iFixedPoint,
1172
InputOutputArray cameraMatrix, InputOutputArray distCoeffs,
1173
OutputArrayOfArrays rvecs, OutputArrayOfArrays tvecs,
1174
OutputArray newObjPoints,
1175
int flags = 0, TermCriteria criteria = TermCriteria(
1176
TermCriteria::COUNT + TermCriteria::EPS, 30, DBL_EPSILON) );
1177
1178
/** @brief Computes useful camera characteristics from the camera matrix.
1179
1180
@param cameraMatrix Input camera matrix that can be estimated by calibrateCamera or
1181
stereoCalibrate .
1182
@param imageSize Input image size in pixels.
1183
@param apertureWidth Physical width in mm of the sensor.
1184
@param apertureHeight Physical height in mm of the sensor.
1185
@param fovx Output field of view in degrees along the horizontal sensor axis.
1186
@param fovy Output field of view in degrees along the vertical sensor axis.
1187
@param focalLength Focal length of the lens in mm.
1188
@param principalPoint Principal point in mm.
1189
@param aspectRatio \f$f_y/f_x\f$
1190
1191
The function computes various useful camera characteristics from the previously estimated camera
1192
matrix.
1193
1194
@note
1195
Do keep in mind that the unity measure 'mm' stands for whatever unit of measure one chooses for
1196
the chessboard pitch (it can thus be any value).
1197
*/
1198
CV_EXPORTS_W void calibrationMatrixValues( InputArray cameraMatrix, Size imageSize,
1199
double apertureWidth, double apertureHeight,
1200
CV_OUT double& fovx, CV_OUT double& fovy,
1201
CV_OUT double& focalLength, CV_OUT Point2d& principalPoint,
1202
CV_OUT double& aspectRatio );
1203
1204
/** @brief Calibrates the stereo camera.
1205
1206
@param objectPoints Vector of vectors of the calibration pattern points.
1207
@param imagePoints1 Vector of vectors of the projections of the calibration pattern points,
1208
observed by the first camera.
1209
@param imagePoints2 Vector of vectors of the projections of the calibration pattern points,
1210
observed by the second camera.
1211
@param cameraMatrix1 Input/output first camera matrix:
1212
\f$\vecthreethree{f_x^{(j)}}{0}{c_x^{(j)}}{0}{f_y^{(j)}}{c_y^{(j)}}{0}{0}{1}\f$ , \f$j = 0,\, 1\f$ . If
1213
any of CALIB_USE_INTRINSIC_GUESS , CALIB_FIX_ASPECT_RATIO ,
1214
CALIB_FIX_INTRINSIC , or CALIB_FIX_FOCAL_LENGTH are specified, some or all of the
1215
matrix components must be initialized. See the flags description for details.
1216
@param distCoeffs1 Input/output vector of distortion coefficients
1217
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$ of
1218
4, 5, 8, 12 or 14 elements. The output vector length depends on the flags.
1219
@param cameraMatrix2 Input/output second camera matrix. The parameter is similar to cameraMatrix1
1220
@param distCoeffs2 Input/output lens distortion coefficients for the second camera. The parameter
1221
is similar to distCoeffs1 .
1222
@param imageSize Size of the image used only to initialize intrinsic camera matrix.
1223
@param R Output rotation matrix between the 1st and the 2nd camera coordinate systems.
1224
@param T Output translation vector between the coordinate systems of the cameras.
1225
@param E Output essential matrix.
1226
@param F Output fundamental matrix.
1227
@param perViewErrors Output vector of the RMS re-projection error estimated for each pattern view.
1228
@param flags Different flags that may be zero or a combination of the following values:
1229
- **CALIB_FIX_INTRINSIC** Fix cameraMatrix? and distCoeffs? so that only R, T, E , and F
1230
matrices are estimated.
1231
- **CALIB_USE_INTRINSIC_GUESS** Optimize some or all of the intrinsic parameters
1232
according to the specified flags. Initial values are provided by the user.
1233
- **CALIB_USE_EXTRINSIC_GUESS** R, T contain valid initial values that are optimized further.
1234
Otherwise R, T are initialized to the median value of the pattern views (each dimension separately).
1235
- **CALIB_FIX_PRINCIPAL_POINT** Fix the principal points during the optimization.
1236
- **CALIB_FIX_FOCAL_LENGTH** Fix \f$f^{(j)}_x\f$ and \f$f^{(j)}_y\f$ .
1237
- **CALIB_FIX_ASPECT_RATIO** Optimize \f$f^{(j)}_y\f$ . Fix the ratio \f$f^{(j)}_x/f^{(j)}_y\f$
1238
.
1239
- **CALIB_SAME_FOCAL_LENGTH** Enforce \f$f^{(0)}_x=f^{(1)}_x\f$ and \f$f^{(0)}_y=f^{(1)}_y\f$ .
1240
- **CALIB_ZERO_TANGENT_DIST** Set tangential distortion coefficients for each camera to
1241
zeros and fix there.
1242
- **CALIB_FIX_K1,...,CALIB_FIX_K6** Do not change the corresponding radial
1243
distortion coefficient during the optimization. If CALIB_USE_INTRINSIC_GUESS is set,
1244
the coefficient from the supplied distCoeffs matrix is used. Otherwise, it is set to 0.
1245
- **CALIB_RATIONAL_MODEL** Enable coefficients k4, k5, and k6. To provide the backward
1246
compatibility, this extra flag should be explicitly specified to make the calibration
1247
function use the rational model and return 8 coefficients. If the flag is not set, the
1248
function computes and returns only 5 distortion coefficients.
1249
- **CALIB_THIN_PRISM_MODEL** Coefficients s1, s2, s3 and s4 are enabled. To provide the
1250
backward compatibility, this extra flag should be explicitly specified to make the
1251
calibration function use the thin prism model and return 12 coefficients. If the flag is not
1252
set, the function computes and returns only 5 distortion coefficients.
1253
- **CALIB_FIX_S1_S2_S3_S4** The thin prism distortion coefficients are not changed during
1254
the optimization. If CALIB_USE_INTRINSIC_GUESS is set, the coefficient from the
1255
supplied distCoeffs matrix is used. Otherwise, it is set to 0.
1256
- **CALIB_TILTED_MODEL** Coefficients tauX and tauY are enabled. To provide the
1257
backward compatibility, this extra flag should be explicitly specified to make the
1258
calibration function use the tilted sensor model and return 14 coefficients. If the flag is not
1259
set, the function computes and returns only 5 distortion coefficients.
1260
- **CALIB_FIX_TAUX_TAUY** The coefficients of the tilted sensor model are not changed during
1261
the optimization. If CALIB_USE_INTRINSIC_GUESS is set, the coefficient from the
1262
supplied distCoeffs matrix is used. Otherwise, it is set to 0.
1263
@param criteria Termination criteria for the iterative optimization algorithm.
1264
1265
The function estimates transformation between two cameras making a stereo pair. If you have a stereo
1266
camera where the relative position and orientation of two cameras is fixed, and if you computed
1267
poses of an object relative to the first camera and to the second camera, (R1, T1) and (R2, T2),
1268
respectively (this can be done with solvePnP ), then those poses definitely relate to each other.
1269
This means that, given ( \f$R_1\f$,\f$T_1\f$ ), it should be possible to compute ( \f$R_2\f$,\f$T_2\f$ ). You only
1270
need to know the position and orientation of the second camera relative to the first camera. This is
1271
what the described function does. It computes ( \f$R\f$,\f$T\f$ ) so that:
1272
1273
\f[R_2=R*R_1\f]
1274
\f[T_2=R*T_1 + T,\f]
1275
1276
Optionally, it computes the essential matrix E:
1277
1278
\f[E= \vecthreethree{0}{-T_2}{T_1}{T_2}{0}{-T_0}{-T_1}{T_0}{0} *R\f]
1279
1280
where \f$T_i\f$ are components of the translation vector \f$T\f$ : \f$T=[T_0, T_1, T_2]^T\f$ . And the function
1281
can also compute the fundamental matrix F:
1282
1283
\f[F = cameraMatrix2^{-T} E cameraMatrix1^{-1}\f]
1284
1285
Besides the stereo-related information, the function can also perform a full calibration of each of
1286
two cameras. However, due to the high dimensionality of the parameter space and noise in the input
1287
data, the function can diverge from the correct solution. If the intrinsic parameters can be
1288
estimated with high accuracy for each of the cameras individually (for example, using
1289
calibrateCamera ), you are recommended to do so and then pass CALIB_FIX_INTRINSIC flag to the
1290
function along with the computed intrinsic parameters. Otherwise, if all the parameters are
1291
estimated at once, it makes sense to restrict some parameters, for example, pass
1292
CALIB_SAME_FOCAL_LENGTH and CALIB_ZERO_TANGENT_DIST flags, which is usually a
1293
reasonable assumption.
1294
1295
Similarly to calibrateCamera , the function minimizes the total re-projection error for all the
1296
points in all the available views from both cameras. The function returns the final value of the
1297
re-projection error.
1298
*/
1299
CV_EXPORTS_AS(stereoCalibrateExtended) double stereoCalibrate( InputArrayOfArrays objectPoints,
1300
InputArrayOfArrays imagePoints1, InputArrayOfArrays imagePoints2,
1301
InputOutputArray cameraMatrix1, InputOutputArray distCoeffs1,
1302
InputOutputArray cameraMatrix2, InputOutputArray distCoeffs2,
1303
Size imageSize, InputOutputArray R,InputOutputArray T, OutputArray E, OutputArray F,
1304
OutputArray perViewErrors, int flags = CALIB_FIX_INTRINSIC,
1305
TermCriteria criteria = TermCriteria(TermCriteria::COUNT+TermCriteria::EPS, 30, 1e-6) );
1306
1307
/// @overload
1308
CV_EXPORTS_W double stereoCalibrate( InputArrayOfArrays objectPoints,
1309
InputArrayOfArrays imagePoints1, InputArrayOfArrays imagePoints2,
1310
InputOutputArray cameraMatrix1, InputOutputArray distCoeffs1,
1311
InputOutputArray cameraMatrix2, InputOutputArray distCoeffs2,
1312
Size imageSize, OutputArray R,OutputArray T, OutputArray E, OutputArray F,
1313
int flags = CALIB_FIX_INTRINSIC,
1314
TermCriteria criteria = TermCriteria(TermCriteria::COUNT+TermCriteria::EPS, 30, 1e-6) );
1315
1316
/** @brief Computes rectification transforms for each head of a calibrated stereo camera.
1317
1318
@param cameraMatrix1 First camera matrix.
1319
@param distCoeffs1 First camera distortion parameters.
1320
@param cameraMatrix2 Second camera matrix.
1321
@param distCoeffs2 Second camera distortion parameters.
1322
@param imageSize Size of the image used for stereo calibration.
1323
@param R Rotation matrix between the coordinate systems of the first and the second cameras.
1324
@param T Translation vector between coordinate systems of the cameras.
1325
@param R1 Output 3x3 rectification transform (rotation matrix) for the first camera.
1326
@param R2 Output 3x3 rectification transform (rotation matrix) for the second camera.
1327
@param P1 Output 3x4 projection matrix in the new (rectified) coordinate systems for the first
1328
camera.
1329
@param P2 Output 3x4 projection matrix in the new (rectified) coordinate systems for the second
1330
camera.
1331
@param Q Output \f$4 \times 4\f$ disparity-to-depth mapping matrix (see reprojectImageTo3D ).
1332
@param flags Operation flags that may be zero or CALIB_ZERO_DISPARITY . If the flag is set,
1333
the function makes the principal points of each camera have the same pixel coordinates in the
1334
rectified views. And if the flag is not set, the function may still shift the images in the
1335
horizontal or vertical direction (depending on the orientation of epipolar lines) to maximize the
1336
useful image area.
1337
@param alpha Free scaling parameter. If it is -1 or absent, the function performs the default
1338
scaling. Otherwise, the parameter should be between 0 and 1. alpha=0 means that the rectified
1339
images are zoomed and shifted so that only valid pixels are visible (no black areas after
1340
rectification). alpha=1 means that the rectified image is decimated and shifted so that all the
1341
pixels from the original images from the cameras are retained in the rectified images (no source
1342
image pixels are lost). Obviously, any intermediate value yields an intermediate result between
1343
those two extreme cases.
1344
@param newImageSize New image resolution after rectification. The same size should be passed to
1345
initUndistortRectifyMap (see the stereo_calib.cpp sample in OpenCV samples directory). When (0,0)
1346
is passed (default), it is set to the original imageSize . Setting it to larger value can help you
1347
preserve details in the original image, especially when there is a big radial distortion.
1348
@param validPixROI1 Optional output rectangles inside the rectified images where all the pixels
1349
are valid. If alpha=0 , the ROIs cover the whole images. Otherwise, they are likely to be smaller
1350
(see the picture below).
1351
@param validPixROI2 Optional output rectangles inside the rectified images where all the pixels
1352
are valid. If alpha=0 , the ROIs cover the whole images. Otherwise, they are likely to be smaller
1353
(see the picture below).
1354
1355
The function computes the rotation matrices for each camera that (virtually) make both camera image
1356
planes the same plane. Consequently, this makes all the epipolar lines parallel and thus simplifies
1357
the dense stereo correspondence problem. The function takes the matrices computed by stereoCalibrate
1358
as input. As output, it provides two rotation matrices and also two projection matrices in the new
1359
coordinates. The function distinguishes the following two cases:
1360
1361
- **Horizontal stereo**: the first and the second camera views are shifted relative to each other
1362
mainly along the x axis (with possible small vertical shift). In the rectified images, the
1363
corresponding epipolar lines in the left and right cameras are horizontal and have the same
1364
y-coordinate. P1 and P2 look like:
1365
1366
\f[\texttt{P1} = \begin{bmatrix} f & 0 & cx_1 & 0 \\ 0 & f & cy & 0 \\ 0 & 0 & 1 & 0 \end{bmatrix}\f]
1367
1368
\f[\texttt{P2} = \begin{bmatrix} f & 0 & cx_2 & T_x*f \\ 0 & f & cy & 0 \\ 0 & 0 & 1 & 0 \end{bmatrix} ,\f]
1369
1370
where \f$T_x\f$ is a horizontal shift between the cameras and \f$cx_1=cx_2\f$ if
1371
CALIB_ZERO_DISPARITY is set.
1372
1373
- **Vertical stereo**: the first and the second camera views are shifted relative to each other
1374
mainly in vertical direction (and probably a bit in the horizontal direction too). The epipolar
1375
lines in the rectified images are vertical and have the same x-coordinate. P1 and P2 look like:
1376
1377
\f[\texttt{P1} = \begin{bmatrix} f & 0 & cx & 0 \\ 0 & f & cy_1 & 0 \\ 0 & 0 & 1 & 0 \end{bmatrix}\f]
1378
1379
\f[\texttt{P2} = \begin{bmatrix} f & 0 & cx & 0 \\ 0 & f & cy_2 & T_y*f \\ 0 & 0 & 1 & 0 \end{bmatrix} ,\f]
1380
1381
where \f$T_y\f$ is a vertical shift between the cameras and \f$cy_1=cy_2\f$ if CALIB_ZERO_DISPARITY is
1382
set.
1383
1384
As you can see, the first three columns of P1 and P2 will effectively be the new "rectified" camera
1385
matrices. The matrices, together with R1 and R2 , can then be passed to initUndistortRectifyMap to
1386
initialize the rectification map for each camera.
1387
1388
See below the screenshot from the stereo_calib.cpp sample. Some red horizontal lines pass through
1389
the corresponding image regions. This means that the images are well rectified, which is what most
1390
stereo correspondence algorithms rely on. The green rectangles are roi1 and roi2 . You see that
1391
their interiors are all valid pixels.
1392
1393
![image](pics/stereo_undistort.jpg)
1394
*/
1395
CV_EXPORTS_W void stereoRectify( InputArray cameraMatrix1, InputArray distCoeffs1,
1396
InputArray cameraMatrix2, InputArray distCoeffs2,
1397
Size imageSize, InputArray R, InputArray T,
1398
OutputArray R1, OutputArray R2,
1399
OutputArray P1, OutputArray P2,
1400
OutputArray Q, int flags = CALIB_ZERO_DISPARITY,
1401
double alpha = -1, Size newImageSize = Size(),
1402
CV_OUT Rect* validPixROI1 = 0, CV_OUT Rect* validPixROI2 = 0 );
1403
1404
/** @brief Computes a rectification transform for an uncalibrated stereo camera.
1405
1406
@param points1 Array of feature points in the first image.
1407
@param points2 The corresponding points in the second image. The same formats as in
1408
findFundamentalMat are supported.
1409
@param F Input fundamental matrix. It can be computed from the same set of point pairs using
1410
findFundamentalMat .
1411
@param imgSize Size of the image.
1412
@param H1 Output rectification homography matrix for the first image.
1413
@param H2 Output rectification homography matrix for the second image.
1414
@param threshold Optional threshold used to filter out the outliers. If the parameter is greater
1415
than zero, all the point pairs that do not comply with the epipolar geometry (that is, the points
1416
for which \f$|\texttt{points2[i]}^T*\texttt{F}*\texttt{points1[i]}|>\texttt{threshold}\f$ ) are
1417
rejected prior to computing the homographies. Otherwise, all the points are considered inliers.
1418
1419
The function computes the rectification transformations without knowing intrinsic parameters of the
1420
cameras and their relative position in the space, which explains the suffix "uncalibrated". Another
1421
related difference from stereoRectify is that the function outputs not the rectification
1422
transformations in the object (3D) space, but the planar perspective transformations encoded by the
1423
homography matrices H1 and H2 . The function implements the algorithm @cite Hartley99 .
1424
1425
@note
1426
While the algorithm does not need to know the intrinsic parameters of the cameras, it heavily
1427
depends on the epipolar geometry. Therefore, if the camera lenses have a significant distortion,
1428
it would be better to correct it before computing the fundamental matrix and calling this
1429
function. For example, distortion coefficients can be estimated for each head of stereo camera
1430
separately by using calibrateCamera . Then, the images can be corrected using undistort , or
1431
just the point coordinates can be corrected with undistortPoints .
1432
*/
1433
CV_EXPORTS_W bool stereoRectifyUncalibrated( InputArray points1, InputArray points2,
1434
InputArray F, Size imgSize,
1435
OutputArray H1, OutputArray H2,
1436
double threshold = 5 );
1437
1438
//! computes the rectification transformations for 3-head camera, where all the heads are on the same line.
1439
CV_EXPORTS_W float rectify3Collinear( InputArray cameraMatrix1, InputArray distCoeffs1,
1440
InputArray cameraMatrix2, InputArray distCoeffs2,
1441
InputArray cameraMatrix3, InputArray distCoeffs3,
1442
InputArrayOfArrays imgpt1, InputArrayOfArrays imgpt3,
1443
Size imageSize, InputArray R12, InputArray T12,
1444
InputArray R13, InputArray T13,
1445
OutputArray R1, OutputArray R2, OutputArray R3,
1446
OutputArray P1, OutputArray P2, OutputArray P3,
1447
OutputArray Q, double alpha, Size newImgSize,
1448
CV_OUT Rect* roi1, CV_OUT Rect* roi2, int flags );
1449
1450
/** @brief Returns the new camera matrix based on the free scaling parameter.
1451
1452
@param cameraMatrix Input camera matrix.
1453
@param distCoeffs Input vector of distortion coefficients
1454
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6 [, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$ of
1455
4, 5, 8, 12 or 14 elements. If the vector is NULL/empty, the zero distortion coefficients are
1456
assumed.
1457
@param imageSize Original image size.
1458
@param alpha Free scaling parameter between 0 (when all the pixels in the undistorted image are
1459
valid) and 1 (when all the source image pixels are retained in the undistorted image). See
1460
stereoRectify for details.
1461
@param newImgSize Image size after rectification. By default, it is set to imageSize .
1462
@param validPixROI Optional output rectangle that outlines all-good-pixels region in the
1463
undistorted image. See roi1, roi2 description in stereoRectify .
1464
@param centerPrincipalPoint Optional flag that indicates whether in the new camera matrix the
1465
principal point should be at the image center or not. By default, the principal point is chosen to
1466
best fit a subset of the source image (determined by alpha) to the corrected image.
1467
@return new_camera_matrix Output new camera matrix.
1468
1469
The function computes and returns the optimal new camera matrix based on the free scaling parameter.
1470
By varying this parameter, you may retrieve only sensible pixels alpha=0 , keep all the original
1471
image pixels if there is valuable information in the corners alpha=1 , or get something in between.
1472
When alpha\>0 , the undistorted result is likely to have some black pixels corresponding to
1473
"virtual" pixels outside of the captured distorted image. The original camera matrix, distortion
1474
coefficients, the computed new camera matrix, and newImageSize should be passed to
1475
initUndistortRectifyMap to produce the maps for remap .
1476
*/
1477
CV_EXPORTS_W Mat getOptimalNewCameraMatrix( InputArray cameraMatrix, InputArray distCoeffs,
1478
Size imageSize, double alpha, Size newImgSize = Size(),
1479
CV_OUT Rect* validPixROI = 0,
1480
bool centerPrincipalPoint = false);
1481
1482
/** @brief Converts points from Euclidean to homogeneous space.
1483
1484
@param src Input vector of N-dimensional points.
1485
@param dst Output vector of N+1-dimensional points.
1486
1487
The function converts points from Euclidean to homogeneous space by appending 1's to the tuple of
1488
point coordinates. That is, each point (x1, x2, ..., xn) is converted to (x1, x2, ..., xn, 1).
1489
*/
1490
CV_EXPORTS_W void convertPointsToHomogeneous( InputArray src, OutputArray dst );
1491
1492
/** @brief Converts points from homogeneous to Euclidean space.
1493
1494
@param src Input vector of N-dimensional points.
1495
@param dst Output vector of N-1-dimensional points.
1496
1497
The function converts points homogeneous to Euclidean space using perspective projection. That is,
1498
each point (x1, x2, ... x(n-1), xn) is converted to (x1/xn, x2/xn, ..., x(n-1)/xn). When xn=0, the
1499
output point coordinates will be (0,0,0,...).
1500
*/
1501
CV_EXPORTS_W void convertPointsFromHomogeneous( InputArray src, OutputArray dst );
1502
1503
/** @brief Converts points to/from homogeneous coordinates.
1504
1505
@param src Input array or vector of 2D, 3D, or 4D points.
1506
@param dst Output vector of 2D, 3D, or 4D points.
1507
1508
The function converts 2D or 3D points from/to homogeneous coordinates by calling either
1509
convertPointsToHomogeneous or convertPointsFromHomogeneous.
1510
1511
@note The function is obsolete. Use one of the previous two functions instead.
1512
*/
1513
CV_EXPORTS void convertPointsHomogeneous( InputArray src, OutputArray dst );
1514
1515
/** @brief Calculates a fundamental matrix from the corresponding points in two images.
1516
1517
@param points1 Array of N points from the first image. The point coordinates should be
1518
floating-point (single or double precision).
1519
@param points2 Array of the second image points of the same size and format as points1 .
1520
@param method Method for computing a fundamental matrix.
1521
- **CV_FM_7POINT** for a 7-point algorithm. \f$N = 7\f$
1522
- **CV_FM_8POINT** for an 8-point algorithm. \f$N \ge 8\f$
1523
- **CV_FM_RANSAC** for the RANSAC algorithm. \f$N \ge 8\f$
1524
- **CV_FM_LMEDS** for the LMedS algorithm. \f$N \ge 8\f$
1525
@param ransacReprojThreshold Parameter used only for RANSAC. It is the maximum distance from a point to an epipolar
1526
line in pixels, beyond which the point is considered an outlier and is not used for computing the
1527
final fundamental matrix. It can be set to something like 1-3, depending on the accuracy of the
1528
point localization, image resolution, and the image noise.
1529
@param confidence Parameter used for the RANSAC and LMedS methods only. It specifies a desirable level
1530
of confidence (probability) that the estimated matrix is correct.
1531
@param mask
1532
1533
The epipolar geometry is described by the following equation:
1534
1535
\f[[p_2; 1]^T F [p_1; 1] = 0\f]
1536
1537
where \f$F\f$ is a fundamental matrix, \f$p_1\f$ and \f$p_2\f$ are corresponding points in the first and the
1538
second images, respectively.
1539
1540
The function calculates the fundamental matrix using one of four methods listed above and returns
1541
the found fundamental matrix. Normally just one matrix is found. But in case of the 7-point
1542
algorithm, the function may return up to 3 solutions ( \f$9 \times 3\f$ matrix that stores all 3
1543
matrices sequentially).
1544
1545
The calculated fundamental matrix may be passed further to computeCorrespondEpilines that finds the
1546
epipolar lines corresponding to the specified points. It can also be passed to
1547
stereoRectifyUncalibrated to compute the rectification transformation. :
1548
@code
1549
// Example. Estimation of fundamental matrix using the RANSAC algorithm
1550
int point_count = 100;
1551
vector<Point2f> points1(point_count);
1552
vector<Point2f> points2(point_count);
1553
1554
// initialize the points here ...
1555
for( int i = 0; i < point_count; i++ )
1556
{
1557
points1[i] = ...;
1558
points2[i] = ...;
1559
}
1560
1561
Mat fundamental_matrix =
1562
findFundamentalMat(points1, points2, FM_RANSAC, 3, 0.99);
1563
@endcode
1564
*/
1565
CV_EXPORTS_W Mat findFundamentalMat( InputArray points1, InputArray points2,
1566
int method = FM_RANSAC,
1567
double ransacReprojThreshold = 3., double confidence = 0.99,
1568
OutputArray mask = noArray() );
1569
1570
/** @overload */
1571
CV_EXPORTS Mat findFundamentalMat( InputArray points1, InputArray points2,
1572
OutputArray mask, int method = FM_RANSAC,
1573
double ransacReprojThreshold = 3., double confidence = 0.99 );
1574
1575
/** @brief Calculates an essential matrix from the corresponding points in two images.
1576
1577
@param points1 Array of N (N \>= 5) 2D points from the first image. The point coordinates should
1578
be floating-point (single or double precision).
1579
@param points2 Array of the second image points of the same size and format as points1 .
1580
@param cameraMatrix Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ .
1581
Note that this function assumes that points1 and points2 are feature points from cameras with the
1582
same camera matrix.
1583
@param method Method for computing an essential matrix.
1584
- **RANSAC** for the RANSAC algorithm.
1585
- **LMEDS** for the LMedS algorithm.
1586
@param prob Parameter used for the RANSAC or LMedS methods only. It specifies a desirable level of
1587
confidence (probability) that the estimated matrix is correct.
1588
@param threshold Parameter used for RANSAC. It is the maximum distance from a point to an epipolar
1589
line in pixels, beyond which the point is considered an outlier and is not used for computing the
1590
final fundamental matrix. It can be set to something like 1-3, depending on the accuracy of the
1591
point localization, image resolution, and the image noise.
1592
@param mask Output array of N elements, every element of which is set to 0 for outliers and to 1
1593
for the other points. The array is computed only in the RANSAC and LMedS methods.
1594
1595
This function estimates essential matrix based on the five-point algorithm solver in @cite Nister03 .
1596
@cite SteweniusCFS is also a related. The epipolar geometry is described by the following equation:
1597
1598
\f[[p_2; 1]^T K^{-T} E K^{-1} [p_1; 1] = 0\f]
1599
1600
where \f$E\f$ is an essential matrix, \f$p_1\f$ and \f$p_2\f$ are corresponding points in the first and the
1601
second images, respectively. The result of this function may be passed further to
1602
decomposeEssentialMat or recoverPose to recover the relative pose between cameras.
1603
*/
1604
CV_EXPORTS_W Mat findEssentialMat( InputArray points1, InputArray points2,
1605
InputArray cameraMatrix, int method = RANSAC,
1606
double prob = 0.999, double threshold = 1.0,
1607
OutputArray mask = noArray() );
1608
1609
/** @overload
1610
@param points1 Array of N (N \>= 5) 2D points from the first image. The point coordinates should
1611
be floating-point (single or double precision).
1612
@param points2 Array of the second image points of the same size and format as points1 .
1613
@param focal focal length of the camera. Note that this function assumes that points1 and points2
1614
are feature points from cameras with same focal length and principal point.
1615
@param pp principal point of the camera.
1616
@param method Method for computing a fundamental matrix.
1617
- **RANSAC** for the RANSAC algorithm.
1618
- **LMEDS** for the LMedS algorithm.
1619
@param threshold Parameter used for RANSAC. It is the maximum distance from a point to an epipolar
1620
line in pixels, beyond which the point is considered an outlier and is not used for computing the
1621
final fundamental matrix. It can be set to something like 1-3, depending on the accuracy of the
1622
point localization, image resolution, and the image noise.
1623
@param prob Parameter used for the RANSAC or LMedS methods only. It specifies a desirable level of
1624
confidence (probability) that the estimated matrix is correct.
1625
@param mask Output array of N elements, every element of which is set to 0 for outliers and to 1
1626
for the other points. The array is computed only in the RANSAC and LMedS methods.
1627
1628
This function differs from the one above that it computes camera matrix from focal length and
1629
principal point:
1630
1631
\f[K =
1632
\begin{bmatrix}
1633
f & 0 & x_{pp} \\
1634
0 & f & y_{pp} \\
1635
0 & 0 & 1
1636
\end{bmatrix}\f]
1637
*/
1638
CV_EXPORTS_W Mat findEssentialMat( InputArray points1, InputArray points2,
1639
double focal = 1.0, Point2d pp = Point2d(0, 0),
1640
int method = RANSAC, double prob = 0.999,
1641
double threshold = 1.0, OutputArray mask = noArray() );
1642
1643
/** @brief Decompose an essential matrix to possible rotations and translation.
1644
1645
@param E The input essential matrix.
1646
@param R1 One possible rotation matrix.
1647
@param R2 Another possible rotation matrix.
1648
@param t One possible translation.
1649
1650
This function decompose an essential matrix E using svd decomposition @cite HartleyZ00 . Generally 4
1651
possible poses exists for a given E. They are \f$[R_1, t]\f$, \f$[R_1, -t]\f$, \f$[R_2, t]\f$, \f$[R_2, -t]\f$. By
1652
decomposing E, you can only get the direction of the translation, so the function returns unit t.
1653
*/
1654
CV_EXPORTS_W void decomposeEssentialMat( InputArray E, OutputArray R1, OutputArray R2, OutputArray t );
1655
1656
/** @brief Recover relative camera rotation and translation from an estimated essential matrix and the
1657
corresponding points in two images, using cheirality check. Returns the number of inliers which pass
1658
the check.
1659
1660
@param E The input essential matrix.
1661
@param points1 Array of N 2D points from the first image. The point coordinates should be
1662
floating-point (single or double precision).
1663
@param points2 Array of the second image points of the same size and format as points1 .
1664
@param cameraMatrix Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ .
1665
Note that this function assumes that points1 and points2 are feature points from cameras with the
1666
same camera matrix.
1667
@param R Recovered relative rotation.
1668
@param t Recovered relative translation.
1669
@param mask Input/output mask for inliers in points1 and points2.
1670
: If it is not empty, then it marks inliers in points1 and points2 for then given essential
1671
matrix E. Only these inliers will be used to recover pose. In the output mask only inliers
1672
which pass the cheirality check.
1673
This function decomposes an essential matrix using decomposeEssentialMat and then verifies possible
1674
pose hypotheses by doing cheirality check. The cheirality check basically means that the
1675
triangulated 3D points should have positive depth. Some details can be found in @cite Nister03 .
1676
1677
This function can be used to process output E and mask from findEssentialMat. In this scenario,
1678
points1 and points2 are the same input for findEssentialMat. :
1679
@code
1680
// Example. Estimation of fundamental matrix using the RANSAC algorithm
1681
int point_count = 100;
1682
vector<Point2f> points1(point_count);
1683
vector<Point2f> points2(point_count);
1684
1685
// initialize the points here ...
1686
for( int i = 0; i < point_count; i++ )
1687
{
1688
points1[i] = ...;
1689
points2[i] = ...;
1690
}
1691
1692
// cametra matrix with both focal lengths = 1, and principal point = (0, 0)
1693
Mat cameraMatrix = Mat::eye(3, 3, CV_64F);
1694
1695
Mat E, R, t, mask;
1696
1697
E = findEssentialMat(points1, points2, cameraMatrix, RANSAC, 0.999, 1.0, mask);
1698
recoverPose(E, points1, points2, cameraMatrix, R, t, mask);
1699
@endcode
1700
*/
1701
CV_EXPORTS_W int recoverPose( InputArray E, InputArray points1, InputArray points2,
1702
InputArray cameraMatrix, OutputArray R, OutputArray t,
1703
InputOutputArray mask = noArray() );
1704
1705
/** @overload
1706
@param E The input essential matrix.
1707
@param points1 Array of N 2D points from the first image. The point coordinates should be
1708
floating-point (single or double precision).
1709
@param points2 Array of the second image points of the same size and format as points1 .
1710
@param R Recovered relative rotation.
1711
@param t Recovered relative translation.
1712
@param focal Focal length of the camera. Note that this function assumes that points1 and points2
1713
are feature points from cameras with same focal length and principal point.
1714
@param pp principal point of the camera.
1715
@param mask Input/output mask for inliers in points1 and points2.
1716
: If it is not empty, then it marks inliers in points1 and points2 for then given essential
1717
matrix E. Only these inliers will be used to recover pose. In the output mask only inliers
1718
which pass the cheirality check.
1719
1720
This function differs from the one above that it computes camera matrix from focal length and
1721
principal point:
1722
1723
\f[K =
1724
\begin{bmatrix}
1725
f & 0 & x_{pp} \\
1726
0 & f & y_{pp} \\
1727
0 & 0 & 1
1728
\end{bmatrix}\f]
1729
*/
1730
CV_EXPORTS_W int recoverPose( InputArray E, InputArray points1, InputArray points2,
1731
OutputArray R, OutputArray t,
1732
double focal = 1.0, Point2d pp = Point2d(0, 0),
1733
InputOutputArray mask = noArray() );
1734
1735
/** @overload
1736
@param E The input essential matrix.
1737
@param points1 Array of N 2D points from the first image. The point coordinates should be
1738
floating-point (single or double precision).
1739
@param points2 Array of the second image points of the same size and format as points1.
1740
@param cameraMatrix Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ .
1741
Note that this function assumes that points1 and points2 are feature points from cameras with the
1742
same camera matrix.
1743
@param R Recovered relative rotation.
1744
@param t Recovered relative translation.
1745
@param distanceThresh threshold distance which is used to filter out far away points (i.e. infinite points).
1746
@param mask Input/output mask for inliers in points1 and points2.
1747
: If it is not empty, then it marks inliers in points1 and points2 for then given essential
1748
matrix E. Only these inliers will be used to recover pose. In the output mask only inliers
1749
which pass the cheirality check.
1750
@param triangulatedPoints 3d points which were reconstructed by triangulation.
1751
*/
1752
1753
CV_EXPORTS_W int recoverPose( InputArray E, InputArray points1, InputArray points2,
1754
InputArray cameraMatrix, OutputArray R, OutputArray t, double distanceThresh, InputOutputArray mask = noArray(),
1755
OutputArray triangulatedPoints = noArray());
1756
1757
/** @brief For points in an image of a stereo pair, computes the corresponding epilines in the other image.
1758
1759
@param points Input points. \f$N \times 1\f$ or \f$1 \times N\f$ matrix of type CV_32FC2 or
1760
vector\<Point2f\> .
1761
@param whichImage Index of the image (1 or 2) that contains the points .
1762
@param F Fundamental matrix that can be estimated using findFundamentalMat or stereoRectify .
1763
@param lines Output vector of the epipolar lines corresponding to the points in the other image.
1764
Each line \f$ax + by + c=0\f$ is encoded by 3 numbers \f$(a, b, c)\f$ .
1765
1766
For every point in one of the two images of a stereo pair, the function finds the equation of the
1767
corresponding epipolar line in the other image.
1768
1769
From the fundamental matrix definition (see findFundamentalMat ), line \f$l^{(2)}_i\f$ in the second
1770
image for the point \f$p^{(1)}_i\f$ in the first image (when whichImage=1 ) is computed as:
1771
1772
\f[l^{(2)}_i = F p^{(1)}_i\f]
1773
1774
And vice versa, when whichImage=2, \f$l^{(1)}_i\f$ is computed from \f$p^{(2)}_i\f$ as:
1775
1776
\f[l^{(1)}_i = F^T p^{(2)}_i\f]
1777
1778
Line coefficients are defined up to a scale. They are normalized so that \f$a_i^2+b_i^2=1\f$ .
1779
*/
1780
CV_EXPORTS_W void computeCorrespondEpilines( InputArray points, int whichImage,
1781
InputArray F, OutputArray lines );
1782
1783
/** @brief Reconstructs points by triangulation.
1784
1785
@param projMatr1 3x4 projection matrix of the first camera.
1786
@param projMatr2 3x4 projection matrix of the second camera.
1787
@param projPoints1 2xN array of feature points in the first image. In case of c++ version it can
1788
be also a vector of feature points or two-channel matrix of size 1xN or Nx1.
1789
@param projPoints2 2xN array of corresponding points in the second image. In case of c++ version
1790
it can be also a vector of feature points or two-channel matrix of size 1xN or Nx1.
1791
@param points4D 4xN array of reconstructed points in homogeneous coordinates.
1792
1793
The function reconstructs 3-dimensional points (in homogeneous coordinates) by using their
1794
observations with a stereo camera. Projections matrices can be obtained from stereoRectify.
1795
1796
@note
1797
Keep in mind that all input data should be of float type in order for this function to work.
1798
1799
@sa
1800
reprojectImageTo3D
1801
*/
1802
CV_EXPORTS_W void triangulatePoints( InputArray projMatr1, InputArray projMatr2,
1803
InputArray projPoints1, InputArray projPoints2,
1804
OutputArray points4D );
1805
1806
/** @brief Refines coordinates of corresponding points.
1807
1808
@param F 3x3 fundamental matrix.
1809
@param points1 1xN array containing the first set of points.
1810
@param points2 1xN array containing the second set of points.
1811
@param newPoints1 The optimized points1.
1812
@param newPoints2 The optimized points2.
1813
1814
The function implements the Optimal Triangulation Method (see Multiple View Geometry for details).
1815
For each given point correspondence points1[i] \<-\> points2[i], and a fundamental matrix F, it
1816
computes the corrected correspondences newPoints1[i] \<-\> newPoints2[i] that minimize the geometric
1817
error \f$d(points1[i], newPoints1[i])^2 + d(points2[i],newPoints2[i])^2\f$ (where \f$d(a,b)\f$ is the
1818
geometric distance between points \f$a\f$ and \f$b\f$ ) subject to the epipolar constraint
1819
\f$newPoints2^T * F * newPoints1 = 0\f$ .
1820
*/
1821
CV_EXPORTS_W void correctMatches( InputArray F, InputArray points1, InputArray points2,
1822
OutputArray newPoints1, OutputArray newPoints2 );
1823
1824
/** @brief Filters off small noise blobs (speckles) in the disparity map
1825
1826
@param img The input 16-bit signed disparity image
1827
@param newVal The disparity value used to paint-off the speckles
1828
@param maxSpeckleSize The maximum speckle size to consider it a speckle. Larger blobs are not
1829
affected by the algorithm
1830
@param maxDiff Maximum difference between neighbor disparity pixels to put them into the same
1831
blob. Note that since StereoBM, StereoSGBM and may be other algorithms return a fixed-point
1832
disparity map, where disparity values are multiplied by 16, this scale factor should be taken into
1833
account when specifying this parameter value.
1834
@param buf The optional temporary buffer to avoid memory allocation within the function.
1835
*/
1836
CV_EXPORTS_W void filterSpeckles( InputOutputArray img, double newVal,
1837
int maxSpeckleSize, double maxDiff,
1838
InputOutputArray buf = noArray() );
1839
1840
//! computes valid disparity ROI from the valid ROIs of the rectified images (that are returned by cv::stereoRectify())
1841
CV_EXPORTS_W Rect getValidDisparityROI( Rect roi1, Rect roi2,
1842
int minDisparity, int numberOfDisparities,
1843
int SADWindowSize );
1844
1845
//! validates disparity using the left-right check. The matrix "cost" should be computed by the stereo correspondence algorithm
1846
CV_EXPORTS_W void validateDisparity( InputOutputArray disparity, InputArray cost,
1847
int minDisparity, int numberOfDisparities,
1848
int disp12MaxDisp = 1 );
1849
1850
/** @brief Reprojects a disparity image to 3D space.
1851
1852
@param disparity Input single-channel 8-bit unsigned, 16-bit signed, 32-bit signed or 32-bit
1853
floating-point disparity image. If 16-bit signed format is used, the values are assumed to have no
1854
fractional bits.
1855
@param _3dImage Output 3-channel floating-point image of the same size as disparity . Each
1856
element of _3dImage(x,y) contains 3D coordinates of the point (x,y) computed from the disparity
1857
map.
1858
@param Q \f$4 \times 4\f$ perspective transformation matrix that can be obtained with stereoRectify.
1859
@param handleMissingValues Indicates, whether the function should handle missing values (i.e.
1860
points where the disparity was not computed). If handleMissingValues=true, then pixels with the
1861
minimal disparity that corresponds to the outliers (see StereoMatcher::compute ) are transformed
1862
to 3D points with a very large Z value (currently set to 10000).
1863
@param ddepth The optional output array depth. If it is -1, the output image will have CV_32F
1864
depth. ddepth can also be set to CV_16S, CV_32S or CV_32F.
1865
1866
The function transforms a single-channel disparity map to a 3-channel image representing a 3D
1867
surface. That is, for each pixel (x,y) and the corresponding disparity d=disparity(x,y) , it
1868
computes:
1869
1870
\f[\begin{array}{l} [X \; Y \; Z \; W]^T = \texttt{Q} *[x \; y \; \texttt{disparity} (x,y) \; 1]^T \\ \texttt{\_3dImage} (x,y) = (X/W, \; Y/W, \; Z/W) \end{array}\f]
1871
1872
The matrix Q can be an arbitrary \f$4 \times 4\f$ matrix (for example, the one computed by
1873
stereoRectify). To reproject a sparse set of points {(x,y,d),...} to 3D space, use
1874
perspectiveTransform .
1875
*/
1876
CV_EXPORTS_W void reprojectImageTo3D( InputArray disparity,
1877
OutputArray _3dImage, InputArray Q,
1878
bool handleMissingValues = false,
1879
int ddepth = -1 );
1880
1881
/** @brief Calculates the Sampson Distance between two points.
1882
1883
The function cv::sampsonDistance calculates and returns the first order approximation of the geometric error as:
1884
\f[
1885
sd( \texttt{pt1} , \texttt{pt2} )=
1886
\frac{(\texttt{pt2}^t \cdot \texttt{F} \cdot \texttt{pt1})^2}
1887
{((\texttt{F} \cdot \texttt{pt1})(0))^2 +
1888
((\texttt{F} \cdot \texttt{pt1})(1))^2 +
1889
((\texttt{F}^t \cdot \texttt{pt2})(0))^2 +
1890
((\texttt{F}^t \cdot \texttt{pt2})(1))^2}
1891
\f]
1892
The fundamental matrix may be calculated using the cv::findFundamentalMat function. See @cite HartleyZ00 11.4.3 for details.
1893
@param pt1 first homogeneous 2d point
1894
@param pt2 second homogeneous 2d point
1895
@param F fundamental matrix
1896
@return The computed Sampson distance.
1897
*/
1898
CV_EXPORTS_W double sampsonDistance(InputArray pt1, InputArray pt2, InputArray F);
1899
1900
/** @brief Computes an optimal affine transformation between two 3D point sets.
1901
1902
It computes
1903
\f[
1904
\begin{bmatrix}
1905
x\\
1906
y\\
1907
z\\
1908
\end{bmatrix}
1909
=
1910
\begin{bmatrix}
1911
a_{11} & a_{12} & a_{13}\\
1912
a_{21} & a_{22} & a_{23}\\
1913
a_{31} & a_{32} & a_{33}\\
1914
\end{bmatrix}
1915
\begin{bmatrix}
1916
X\\
1917
Y\\
1918
Z\\
1919
\end{bmatrix}
1920
+
1921
\begin{bmatrix}
1922
b_1\\
1923
b_2\\
1924
b_3\\
1925
\end{bmatrix}
1926
\f]
1927
1928
@param src First input 3D point set containing \f$(X,Y,Z)\f$.
1929
@param dst Second input 3D point set containing \f$(x,y,z)\f$.
1930
@param out Output 3D affine transformation matrix \f$3 \times 4\f$ of the form
1931
\f[
1932
\begin{bmatrix}
1933
a_{11} & a_{12} & a_{13} & b_1\\
1934
a_{21} & a_{22} & a_{23} & b_2\\
1935
a_{31} & a_{32} & a_{33} & b_3\\
1936
\end{bmatrix}
1937
\f]
1938
@param inliers Output vector indicating which points are inliers (1-inlier, 0-outlier).
1939
@param ransacThreshold Maximum reprojection error in the RANSAC algorithm to consider a point as
1940
an inlier.
1941
@param confidence Confidence level, between 0 and 1, for the estimated transformation. Anything
1942
between 0.95 and 0.99 is usually good enough. Values too close to 1 can slow down the estimation
1943
significantly. Values lower than 0.8-0.9 can result in an incorrectly estimated transformation.
1944
1945
The function estimates an optimal 3D affine transformation between two 3D point sets using the
1946
RANSAC algorithm.
1947
*/
1948
CV_EXPORTS_W int estimateAffine3D(InputArray src, InputArray dst,
1949
OutputArray out, OutputArray inliers,
1950
double ransacThreshold = 3, double confidence = 0.99);
1951
1952
/** @brief Computes an optimal affine transformation between two 2D point sets.
1953
1954
It computes
1955
\f[
1956
\begin{bmatrix}
1957
x\\
1958
y\\
1959
\end{bmatrix}
1960
=
1961
\begin{bmatrix}
1962
a_{11} & a_{12}\\
1963
a_{21} & a_{22}\\
1964
\end{bmatrix}
1965
\begin{bmatrix}
1966
X\\
1967
Y\\
1968
\end{bmatrix}
1969
+
1970
\begin{bmatrix}
1971
b_1\\
1972
b_2\\
1973
\end{bmatrix}
1974
\f]
1975
1976
@param from First input 2D point set containing \f$(X,Y)\f$.
1977
@param to Second input 2D point set containing \f$(x,y)\f$.
1978
@param inliers Output vector indicating which points are inliers (1-inlier, 0-outlier).
1979
@param method Robust method used to compute transformation. The following methods are possible:
1980
- cv::RANSAC - RANSAC-based robust method
1981
- cv::LMEDS - Least-Median robust method
1982
RANSAC is the default method.
1983
@param ransacReprojThreshold Maximum reprojection error in the RANSAC algorithm to consider
1984
a point as an inlier. Applies only to RANSAC.
1985
@param maxIters The maximum number of robust method iterations.
1986
@param confidence Confidence level, between 0 and 1, for the estimated transformation. Anything
1987
between 0.95 and 0.99 is usually good enough. Values too close to 1 can slow down the estimation
1988
significantly. Values lower than 0.8-0.9 can result in an incorrectly estimated transformation.
1989
@param refineIters Maximum number of iterations of refining algorithm (Levenberg-Marquardt).
1990
Passing 0 will disable refining, so the output matrix will be output of robust method.
1991
1992
@return Output 2D affine transformation matrix \f$2 \times 3\f$ or empty matrix if transformation
1993
could not be estimated. The returned matrix has the following form:
1994
\f[
1995
\begin{bmatrix}
1996
a_{11} & a_{12} & b_1\\
1997
a_{21} & a_{22} & b_2\\
1998
\end{bmatrix}
1999
\f]
2000
2001
The function estimates an optimal 2D affine transformation between two 2D point sets using the
2002
selected robust algorithm.
2003
2004
The computed transformation is then refined further (using only inliers) with the
2005
Levenberg-Marquardt method to reduce the re-projection error even more.
2006
2007
@note
2008
The RANSAC method can handle practically any ratio of outliers but needs a threshold to
2009
distinguish inliers from outliers. The method LMeDS does not need any threshold but it works
2010
correctly only when there are more than 50% of inliers.
2011
2012
@sa estimateAffinePartial2D, getAffineTransform
2013
*/
2014
CV_EXPORTS_W cv::Mat estimateAffine2D(InputArray from, InputArray to, OutputArray inliers = noArray(),
2015
int method = RANSAC, double ransacReprojThreshold = 3,
2016
size_t maxIters = 2000, double confidence = 0.99,
2017
size_t refineIters = 10);
2018
2019
/** @brief Computes an optimal limited affine transformation with 4 degrees of freedom between
2020
two 2D point sets.
2021
2022
@param from First input 2D point set.
2023
@param to Second input 2D point set.
2024
@param inliers Output vector indicating which points are inliers.
2025
@param method Robust method used to compute transformation. The following methods are possible:
2026
- cv::RANSAC - RANSAC-based robust method
2027
- cv::LMEDS - Least-Median robust method
2028
RANSAC is the default method.
2029
@param ransacReprojThreshold Maximum reprojection error in the RANSAC algorithm to consider
2030
a point as an inlier. Applies only to RANSAC.
2031
@param maxIters The maximum number of robust method iterations.
2032
@param confidence Confidence level, between 0 and 1, for the estimated transformation. Anything
2033
between 0.95 and 0.99 is usually good enough. Values too close to 1 can slow down the estimation
2034
significantly. Values lower than 0.8-0.9 can result in an incorrectly estimated transformation.
2035
@param refineIters Maximum number of iterations of refining algorithm (Levenberg-Marquardt).
2036
Passing 0 will disable refining, so the output matrix will be output of robust method.
2037
2038
@return Output 2D affine transformation (4 degrees of freedom) matrix \f$2 \times 3\f$ or
2039
empty matrix if transformation could not be estimated.
2040
2041
The function estimates an optimal 2D affine transformation with 4 degrees of freedom limited to
2042
combinations of translation, rotation, and uniform scaling. Uses the selected algorithm for robust
2043
estimation.
2044
2045
The computed transformation is then refined further (using only inliers) with the
2046
Levenberg-Marquardt method to reduce the re-projection error even more.
2047
2048
Estimated transformation matrix is:
2049
\f[ \begin{bmatrix} \cos(\theta) \cdot s & -\sin(\theta) \cdot s & t_x \\
2050
\sin(\theta) \cdot s & \cos(\theta) \cdot s & t_y
2051
\end{bmatrix} \f]
2052
Where \f$ \theta \f$ is the rotation angle, \f$ s \f$ the scaling factor and \f$ t_x, t_y \f$ are
2053
translations in \f$ x, y \f$ axes respectively.
2054
2055
@note
2056
The RANSAC method can handle practically any ratio of outliers but need a threshold to
2057
distinguish inliers from outliers. The method LMeDS does not need any threshold but it works
2058
correctly only when there are more than 50% of inliers.
2059
2060
@sa estimateAffine2D, getAffineTransform
2061
*/
2062
CV_EXPORTS_W cv::Mat estimateAffinePartial2D(InputArray from, InputArray to, OutputArray inliers = noArray(),
2063
int method = RANSAC, double ransacReprojThreshold = 3,
2064
size_t maxIters = 2000, double confidence = 0.99,
2065
size_t refineIters = 10);
2066
2067
/** @example samples/cpp/tutorial_code/features2D/Homography/decompose_homography.cpp
2068
An example program with homography decomposition.
2069
2070
Check @ref tutorial_homography "the corresponding tutorial" for more details.
2071
*/
2072
2073
/** @brief Decompose a homography matrix to rotation(s), translation(s) and plane normal(s).
2074
2075
@param H The input homography matrix between two images.
2076
@param K The input intrinsic camera calibration matrix.
2077
@param rotations Array of rotation matrices.
2078
@param translations Array of translation matrices.
2079
@param normals Array of plane normal matrices.
2080
2081
This function extracts relative camera motion between two views observing a planar object from the
2082
homography H induced by the plane. The intrinsic camera matrix K must also be provided. The function
2083
may return up to four mathematical solution sets. At least two of the solutions may further be
2084
invalidated if point correspondences are available by applying positive depth constraint (all points
2085
must be in front of the camera). The decomposition method is described in detail in @cite Malis .
2086
*/
2087
CV_EXPORTS_W int decomposeHomographyMat(InputArray H,
2088
InputArray K,
2089
OutputArrayOfArrays rotations,
2090
OutputArrayOfArrays translations,
2091
OutputArrayOfArrays normals);
2092
2093
/** @brief Filters homography decompositions based on additional information.
2094
2095
@param rotations Vector of rotation matrices.
2096
@param normals Vector of plane normal matrices.
2097
@param beforePoints Vector of (rectified) visible reference points before the homography is applied
2098
@param afterPoints Vector of (rectified) visible reference points after the homography is applied
2099
@param possibleSolutions Vector of int indices representing the viable solution set after filtering
2100
@param pointsMask optional Mat/Vector of 8u type representing the mask for the inliers as given by the findHomography function
2101
2102
This function is intended to filter the output of the decomposeHomographyMat based on additional
2103
information as described in @cite Malis . The summary of the method: the decomposeHomographyMat function
2104
returns 2 unique solutions and their "opposites" for a total of 4 solutions. If we have access to the
2105
sets of points visible in the camera frame before and after the homography transformation is applied,
2106
we can determine which are the true potential solutions and which are the opposites by verifying which
2107
homographies are consistent with all visible reference points being in front of the camera. The inputs
2108
are left unchanged; the filtered solution set is returned as indices into the existing one.
2109
2110
*/
2111
CV_EXPORTS_W void filterHomographyDecompByVisibleRefpoints(InputArrayOfArrays rotations,
2112
InputArrayOfArrays normals,
2113
InputArray beforePoints,
2114
InputArray afterPoints,
2115
OutputArray possibleSolutions,
2116
InputArray pointsMask = noArray());
2117
2118
/** @brief The base class for stereo correspondence algorithms.
2119
*/
2120
class CV_EXPORTS_W StereoMatcher : public Algorithm
2121
{
2122
public:
2123
enum { DISP_SHIFT = 4,
2124
DISP_SCALE = (1 << DISP_SHIFT)
2125
};
2126
2127
/** @brief Computes disparity map for the specified stereo pair
2128
2129
@param left Left 8-bit single-channel image.
2130
@param right Right image of the same size and the same type as the left one.
2131
@param disparity Output disparity map. It has the same size as the input images. Some algorithms,
2132
like StereoBM or StereoSGBM compute 16-bit fixed-point disparity map (where each disparity value
2133
has 4 fractional bits), whereas other algorithms output 32-bit floating-point disparity map.
2134
*/
2135
CV_WRAP virtual void compute( InputArray left, InputArray right,
2136
OutputArray disparity ) = 0;
2137
2138
CV_WRAP virtual int getMinDisparity() const = 0;
2139
CV_WRAP virtual void setMinDisparity(int minDisparity) = 0;
2140
2141
CV_WRAP virtual int getNumDisparities() const = 0;
2142
CV_WRAP virtual void setNumDisparities(int numDisparities) = 0;
2143
2144
CV_WRAP virtual int getBlockSize() const = 0;
2145
CV_WRAP virtual void setBlockSize(int blockSize) = 0;
2146
2147
CV_WRAP virtual int getSpeckleWindowSize() const = 0;
2148
CV_WRAP virtual void setSpeckleWindowSize(int speckleWindowSize) = 0;
2149
2150
CV_WRAP virtual int getSpeckleRange() const = 0;
2151
CV_WRAP virtual void setSpeckleRange(int speckleRange) = 0;
2152
2153
CV_WRAP virtual int getDisp12MaxDiff() const = 0;
2154
CV_WRAP virtual void setDisp12MaxDiff(int disp12MaxDiff) = 0;
2155
};
2156
2157
2158
/** @brief Class for computing stereo correspondence using the block matching algorithm, introduced and
2159
contributed to OpenCV by K. Konolige.
2160
*/
2161
class CV_EXPORTS_W StereoBM : public StereoMatcher
2162
{
2163
public:
2164
enum { PREFILTER_NORMALIZED_RESPONSE = 0,
2165
PREFILTER_XSOBEL = 1
2166
};
2167
2168
CV_WRAP virtual int getPreFilterType() const = 0;
2169
CV_WRAP virtual void setPreFilterType(int preFilterType) = 0;
2170
2171
CV_WRAP virtual int getPreFilterSize() const = 0;
2172
CV_WRAP virtual void setPreFilterSize(int preFilterSize) = 0;
2173
2174
CV_WRAP virtual int getPreFilterCap() const = 0;
2175
CV_WRAP virtual void setPreFilterCap(int preFilterCap) = 0;
2176
2177
CV_WRAP virtual int getTextureThreshold() const = 0;
2178
CV_WRAP virtual void setTextureThreshold(int textureThreshold) = 0;
2179
2180
CV_WRAP virtual int getUniquenessRatio() const = 0;
2181
CV_WRAP virtual void setUniquenessRatio(int uniquenessRatio) = 0;
2182
2183
CV_WRAP virtual int getSmallerBlockSize() const = 0;
2184
CV_WRAP virtual void setSmallerBlockSize(int blockSize) = 0;
2185
2186
CV_WRAP virtual Rect getROI1() const = 0;
2187
CV_WRAP virtual void setROI1(Rect roi1) = 0;
2188
2189
CV_WRAP virtual Rect getROI2() const = 0;
2190
CV_WRAP virtual void setROI2(Rect roi2) = 0;
2191
2192
/** @brief Creates StereoBM object
2193
2194
@param numDisparities the disparity search range. For each pixel algorithm will find the best
2195
disparity from 0 (default minimum disparity) to numDisparities. The search range can then be
2196
shifted by changing the minimum disparity.
2197
@param blockSize the linear size of the blocks compared by the algorithm. The size should be odd
2198
(as the block is centered at the current pixel). Larger block size implies smoother, though less
2199
accurate disparity map. Smaller block size gives more detailed disparity map, but there is higher
2200
chance for algorithm to find a wrong correspondence.
2201
2202
The function create StereoBM object. You can then call StereoBM::compute() to compute disparity for
2203
a specific stereo pair.
2204
*/
2205
CV_WRAP static Ptr<StereoBM> create(int numDisparities = 0, int blockSize = 21);
2206
};
2207
2208
/** @brief The class implements the modified H. Hirschmuller algorithm @cite HH08 that differs from the original
2209
one as follows:
2210
2211
- By default, the algorithm is single-pass, which means that you consider only 5 directions
2212
instead of 8. Set mode=StereoSGBM::MODE_HH in createStereoSGBM to run the full variant of the
2213
algorithm but beware that it may consume a lot of memory.
2214
- The algorithm matches blocks, not individual pixels. Though, setting blockSize=1 reduces the
2215
blocks to single pixels.
2216
- Mutual information cost function is not implemented. Instead, a simpler Birchfield-Tomasi
2217
sub-pixel metric from @cite BT98 is used. Though, the color images are supported as well.
2218
- Some pre- and post- processing steps from K. Konolige algorithm StereoBM are included, for
2219
example: pre-filtering (StereoBM::PREFILTER_XSOBEL type) and post-filtering (uniqueness
2220
check, quadratic interpolation and speckle filtering).
2221
2222
@note
2223
- (Python) An example illustrating the use of the StereoSGBM matching algorithm can be found
2224
at opencv_source_code/samples/python/stereo_match.py
2225
*/
2226
class CV_EXPORTS_W StereoSGBM : public StereoMatcher
2227
{
2228
public:
2229
enum
2230
{
2231
MODE_SGBM = 0,
2232
MODE_HH = 1,
2233
MODE_SGBM_3WAY = 2,
2234
MODE_HH4 = 3
2235
};
2236
2237
CV_WRAP virtual int getPreFilterCap() const = 0;
2238
CV_WRAP virtual void setPreFilterCap(int preFilterCap) = 0;
2239
2240
CV_WRAP virtual int getUniquenessRatio() const = 0;
2241
CV_WRAP virtual void setUniquenessRatio(int uniquenessRatio) = 0;
2242
2243
CV_WRAP virtual int getP1() const = 0;
2244
CV_WRAP virtual void setP1(int P1) = 0;
2245
2246
CV_WRAP virtual int getP2() const = 0;
2247
CV_WRAP virtual void setP2(int P2) = 0;
2248
2249
CV_WRAP virtual int getMode() const = 0;
2250
CV_WRAP virtual void setMode(int mode) = 0;
2251
2252
/** @brief Creates StereoSGBM object
2253
2254
@param minDisparity Minimum possible disparity value. Normally, it is zero but sometimes
2255
rectification algorithms can shift images, so this parameter needs to be adjusted accordingly.
2256
@param numDisparities Maximum disparity minus minimum disparity. The value is always greater than
2257
zero. In the current implementation, this parameter must be divisible by 16.
2258
@param blockSize Matched block size. It must be an odd number \>=1 . Normally, it should be
2259
somewhere in the 3..11 range.
2260
@param P1 The first parameter controlling the disparity smoothness. See below.
2261
@param P2 The second parameter controlling the disparity smoothness. The larger the values are,
2262
the smoother the disparity is. P1 is the penalty on the disparity change by plus or minus 1
2263
between neighbor pixels. P2 is the penalty on the disparity change by more than 1 between neighbor
2264
pixels. The algorithm requires P2 \> P1 . See stereo_match.cpp sample where some reasonably good
2265
P1 and P2 values are shown (like 8\*number_of_image_channels\*SADWindowSize\*SADWindowSize and
2266
32\*number_of_image_channels\*SADWindowSize\*SADWindowSize , respectively).
2267
@param disp12MaxDiff Maximum allowed difference (in integer pixel units) in the left-right
2268
disparity check. Set it to a non-positive value to disable the check.
2269
@param preFilterCap Truncation value for the prefiltered image pixels. The algorithm first
2270
computes x-derivative at each pixel and clips its value by [-preFilterCap, preFilterCap] interval.
2271
The result values are passed to the Birchfield-Tomasi pixel cost function.
2272
@param uniquenessRatio Margin in percentage by which the best (minimum) computed cost function
2273
value should "win" the second best value to consider the found match correct. Normally, a value
2274
within the 5-15 range is good enough.
2275
@param speckleWindowSize Maximum size of smooth disparity regions to consider their noise speckles
2276
and invalidate. Set it to 0 to disable speckle filtering. Otherwise, set it somewhere in the
2277
50-200 range.
2278
@param speckleRange Maximum disparity variation within each connected component. If you do speckle
2279
filtering, set the parameter to a positive value, it will be implicitly multiplied by 16.
2280
Normally, 1 or 2 is good enough.
2281
@param mode Set it to StereoSGBM::MODE_HH to run the full-scale two-pass dynamic programming
2282
algorithm. It will consume O(W\*H\*numDisparities) bytes, which is large for 640x480 stereo and
2283
huge for HD-size pictures. By default, it is set to false .
2284
2285
The first constructor initializes StereoSGBM with all the default parameters. So, you only have to
2286
set StereoSGBM::numDisparities at minimum. The second constructor enables you to set each parameter
2287
to a custom value.
2288
*/
2289
CV_WRAP static Ptr<StereoSGBM> create(int minDisparity = 0, int numDisparities = 16, int blockSize = 3,
2290
int P1 = 0, int P2 = 0, int disp12MaxDiff = 0,
2291
int preFilterCap = 0, int uniquenessRatio = 0,
2292
int speckleWindowSize = 0, int speckleRange = 0,
2293
int mode = StereoSGBM::MODE_SGBM);
2294
};
2295
2296
2297
//! cv::undistort mode
2298
enum UndistortTypes
2299
{
2300
PROJ_SPHERICAL_ORTHO = 0,
2301
PROJ_SPHERICAL_EQRECT = 1
2302
};
2303
2304
/** @brief Transforms an image to compensate for lens distortion.
2305
2306
The function transforms an image to compensate radial and tangential lens distortion.
2307
2308
The function is simply a combination of #initUndistortRectifyMap (with unity R ) and #remap
2309
(with bilinear interpolation). See the former function for details of the transformation being
2310
performed.
2311
2312
Those pixels in the destination image, for which there is no correspondent pixels in the source
2313
image, are filled with zeros (black color).
2314
2315
A particular subset of the source image that will be visible in the corrected image can be regulated
2316
by newCameraMatrix. You can use #getOptimalNewCameraMatrix to compute the appropriate
2317
newCameraMatrix depending on your requirements.
2318
2319
The camera matrix and the distortion parameters can be determined using #calibrateCamera. If
2320
the resolution of images is different from the resolution used at the calibration stage, \f$f_x,
2321
f_y, c_x\f$ and \f$c_y\f$ need to be scaled accordingly, while the distortion coefficients remain
2322
the same.
2323
2324
@param src Input (distorted) image.
2325
@param dst Output (corrected) image that has the same size and type as src .
2326
@param cameraMatrix Input camera matrix \f$A = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ .
2327
@param distCoeffs Input vector of distortion coefficients
2328
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6[, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$
2329
of 4, 5, 8, 12 or 14 elements. If the vector is NULL/empty, the zero distortion coefficients are assumed.
2330
@param newCameraMatrix Camera matrix of the distorted image. By default, it is the same as
2331
cameraMatrix but you may additionally scale and shift the result by using a different matrix.
2332
*/
2333
CV_EXPORTS_W void undistort( InputArray src, OutputArray dst,
2334
InputArray cameraMatrix,
2335
InputArray distCoeffs,
2336
InputArray newCameraMatrix = noArray() );
2337
2338
/** @brief Computes the undistortion and rectification transformation map.
2339
2340
The function computes the joint undistortion and rectification transformation and represents the
2341
result in the form of maps for remap. The undistorted image looks like original, as if it is
2342
captured with a camera using the camera matrix =newCameraMatrix and zero distortion. In case of a
2343
monocular camera, newCameraMatrix is usually equal to cameraMatrix, or it can be computed by
2344
#getOptimalNewCameraMatrix for a better control over scaling. In case of a stereo camera,
2345
newCameraMatrix is normally set to P1 or P2 computed by #stereoRectify .
2346
2347
Also, this new camera is oriented differently in the coordinate space, according to R. That, for
2348
example, helps to align two heads of a stereo camera so that the epipolar lines on both images
2349
become horizontal and have the same y- coordinate (in case of a horizontally aligned stereo camera).
2350
2351
The function actually builds the maps for the inverse mapping algorithm that is used by remap. That
2352
is, for each pixel \f$(u, v)\f$ in the destination (corrected and rectified) image, the function
2353
computes the corresponding coordinates in the source image (that is, in the original image from
2354
camera). The following process is applied:
2355
\f[
2356
\begin{array}{l}
2357
x \leftarrow (u - {c'}_x)/{f'}_x \\
2358
y \leftarrow (v - {c'}_y)/{f'}_y \\
2359
{[X\,Y\,W]} ^T \leftarrow R^{-1}*[x \, y \, 1]^T \\
2360
x' \leftarrow X/W \\
2361
y' \leftarrow Y/W \\
2362
r^2 \leftarrow x'^2 + y'^2 \\
2363
x'' \leftarrow x' \frac{1 + k_1 r^2 + k_2 r^4 + k_3 r^6}{1 + k_4 r^2 + k_5 r^4 + k_6 r^6}
2364
+ 2p_1 x' y' + p_2(r^2 + 2 x'^2) + s_1 r^2 + s_2 r^4\\
2365
y'' \leftarrow y' \frac{1 + k_1 r^2 + k_2 r^4 + k_3 r^6}{1 + k_4 r^2 + k_5 r^4 + k_6 r^6}
2366
+ p_1 (r^2 + 2 y'^2) + 2 p_2 x' y' + s_3 r^2 + s_4 r^4 \\
2367
s\vecthree{x'''}{y'''}{1} =
2368
\vecthreethree{R_{33}(\tau_x, \tau_y)}{0}{-R_{13}((\tau_x, \tau_y)}
2369
{0}{R_{33}(\tau_x, \tau_y)}{-R_{23}(\tau_x, \tau_y)}
2370
{0}{0}{1} R(\tau_x, \tau_y) \vecthree{x''}{y''}{1}\\
2371
map_x(u,v) \leftarrow x''' f_x + c_x \\
2372
map_y(u,v) \leftarrow y''' f_y + c_y
2373
\end{array}
2374
\f]
2375
where \f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6[, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$
2376
are the distortion coefficients.
2377
2378
In case of a stereo camera, this function is called twice: once for each camera head, after
2379
stereoRectify, which in its turn is called after #stereoCalibrate. But if the stereo camera
2380
was not calibrated, it is still possible to compute the rectification transformations directly from
2381
the fundamental matrix using #stereoRectifyUncalibrated. For each camera, the function computes
2382
homography H as the rectification transformation in a pixel domain, not a rotation matrix R in 3D
2383
space. R can be computed from H as
2384
\f[\texttt{R} = \texttt{cameraMatrix} ^{-1} \cdot \texttt{H} \cdot \texttt{cameraMatrix}\f]
2385
where cameraMatrix can be chosen arbitrarily.
2386
2387
@param cameraMatrix Input camera matrix \f$A=\vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ .
2388
@param distCoeffs Input vector of distortion coefficients
2389
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6[, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$
2390
of 4, 5, 8, 12 or 14 elements. If the vector is NULL/empty, the zero distortion coefficients are assumed.
2391
@param R Optional rectification transformation in the object space (3x3 matrix). R1 or R2 ,
2392
computed by #stereoRectify can be passed here. If the matrix is empty, the identity transformation
2393
is assumed. In cvInitUndistortMap R assumed to be an identity matrix.
2394
@param newCameraMatrix New camera matrix \f$A'=\vecthreethree{f_x'}{0}{c_x'}{0}{f_y'}{c_y'}{0}{0}{1}\f$.
2395
@param size Undistorted image size.
2396
@param m1type Type of the first output map that can be CV_32FC1, CV_32FC2 or CV_16SC2, see #convertMaps
2397
@param map1 The first output map.
2398
@param map2 The second output map.
2399
*/
2400
CV_EXPORTS_W
2401
void initUndistortRectifyMap(InputArray cameraMatrix, InputArray distCoeffs,
2402
InputArray R, InputArray newCameraMatrix,
2403
Size size, int m1type, OutputArray map1, OutputArray map2);
2404
2405
//! initializes maps for #remap for wide-angle
2406
CV_EXPORTS
2407
float initWideAngleProjMap(InputArray cameraMatrix, InputArray distCoeffs,
2408
Size imageSize, int destImageWidth,
2409
int m1type, OutputArray map1, OutputArray map2,
2410
enum UndistortTypes projType = PROJ_SPHERICAL_EQRECT, double alpha = 0);
2411
static inline
2412
float initWideAngleProjMap(InputArray cameraMatrix, InputArray distCoeffs,
2413
Size imageSize, int destImageWidth,
2414
int m1type, OutputArray map1, OutputArray map2,
2415
int projType, double alpha = 0)
2416
{
2417
return initWideAngleProjMap(cameraMatrix, distCoeffs, imageSize, destImageWidth,
2418
m1type, map1, map2, (UndistortTypes)projType, alpha);
2419
}
2420
2421
/** @brief Returns the default new camera matrix.
2422
2423
The function returns the camera matrix that is either an exact copy of the input cameraMatrix (when
2424
centerPrinicipalPoint=false ), or the modified one (when centerPrincipalPoint=true).
2425
2426
In the latter case, the new camera matrix will be:
2427
2428
\f[\begin{bmatrix} f_x && 0 && ( \texttt{imgSize.width} -1)*0.5 \\ 0 && f_y && ( \texttt{imgSize.height} -1)*0.5 \\ 0 && 0 && 1 \end{bmatrix} ,\f]
2429
2430
where \f$f_x\f$ and \f$f_y\f$ are \f$(0,0)\f$ and \f$(1,1)\f$ elements of cameraMatrix, respectively.
2431
2432
By default, the undistortion functions in OpenCV (see #initUndistortRectifyMap, #undistort) do not
2433
move the principal point. However, when you work with stereo, it is important to move the principal
2434
points in both views to the same y-coordinate (which is required by most of stereo correspondence
2435
algorithms), and may be to the same x-coordinate too. So, you can form the new camera matrix for
2436
each view where the principal points are located at the center.
2437
2438
@param cameraMatrix Input camera matrix.
2439
@param imgsize Camera view image size in pixels.
2440
@param centerPrincipalPoint Location of the principal point in the new camera matrix. The
2441
parameter indicates whether this location should be at the image center or not.
2442
*/
2443
CV_EXPORTS_W
2444
Mat getDefaultNewCameraMatrix(InputArray cameraMatrix, Size imgsize = Size(),
2445
bool centerPrincipalPoint = false);
2446
2447
/** @brief Computes the ideal point coordinates from the observed point coordinates.
2448
2449
The function is similar to #undistort and #initUndistortRectifyMap but it operates on a
2450
sparse set of points instead of a raster image. Also the function performs a reverse transformation
2451
to projectPoints. In case of a 3D object, it does not reconstruct its 3D coordinates, but for a
2452
planar object, it does, up to a translation vector, if the proper R is specified.
2453
2454
For each observed point coordinate \f$(u, v)\f$ the function computes:
2455
\f[
2456
\begin{array}{l}
2457
x^{"} \leftarrow (u - c_x)/f_x \\
2458
y^{"} \leftarrow (v - c_y)/f_y \\
2459
(x',y') = undistort(x^{"},y^{"}, \texttt{distCoeffs}) \\
2460
{[X\,Y\,W]} ^T \leftarrow R*[x' \, y' \, 1]^T \\
2461
x \leftarrow X/W \\
2462
y \leftarrow Y/W \\
2463
\text{only performed if P is specified:} \\
2464
u' \leftarrow x {f'}_x + {c'}_x \\
2465
v' \leftarrow y {f'}_y + {c'}_y
2466
\end{array}
2467
\f]
2468
2469
where *undistort* is an approximate iterative algorithm that estimates the normalized original
2470
point coordinates out of the normalized distorted point coordinates ("normalized" means that the
2471
coordinates do not depend on the camera matrix).
2472
2473
The function can be used for both a stereo camera head or a monocular camera (when R is empty).
2474
2475
@param src Observed point coordinates, 1xN or Nx1 2-channel (CV_32FC2 or CV_64FC2).
2476
@param dst Output ideal point coordinates after undistortion and reverse perspective
2477
transformation. If matrix P is identity or omitted, dst will contain normalized point coordinates.
2478
@param cameraMatrix Camera matrix \f$\vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ .
2479
@param distCoeffs Input vector of distortion coefficients
2480
\f$(k_1, k_2, p_1, p_2[, k_3[, k_4, k_5, k_6[, s_1, s_2, s_3, s_4[, \tau_x, \tau_y]]]])\f$
2481
of 4, 5, 8, 12 or 14 elements. If the vector is NULL/empty, the zero distortion coefficients are assumed.
2482
@param R Rectification transformation in the object space (3x3 matrix). R1 or R2 computed by
2483
#stereoRectify can be passed here. If the matrix is empty, the identity transformation is used.
2484
@param P New camera matrix (3x3) or new projection matrix (3x4) \f$\begin{bmatrix} {f'}_x & 0 & {c'}_x & t_x \\ 0 & {f'}_y & {c'}_y & t_y \\ 0 & 0 & 1 & t_z \end{bmatrix}\f$. P1 or P2 computed by
2485
#stereoRectify can be passed here. If the matrix is empty, the identity new camera matrix is used.
2486
*/
2487
CV_EXPORTS_W
2488
void undistortPoints(InputArray src, OutputArray dst,
2489
InputArray cameraMatrix, InputArray distCoeffs,
2490
InputArray R = noArray(), InputArray P = noArray());
2491
/** @overload
2492
@note Default version of #undistortPoints does 5 iterations to compute undistorted points.
2493
*/
2494
CV_EXPORTS_AS(undistortPointsIter)
2495
void undistortPoints(InputArray src, OutputArray dst,
2496
InputArray cameraMatrix, InputArray distCoeffs,
2497
InputArray R, InputArray P, TermCriteria criteria);
2498
2499
//! @} calib3d
2500
2501
/** @brief The methods in this namespace use a so-called fisheye camera model.
2502
@ingroup calib3d_fisheye
2503
*/
2504
namespace fisheye
2505
{
2506
//! @addtogroup calib3d_fisheye
2507
//! @{
2508
2509
enum{
2510
CALIB_USE_INTRINSIC_GUESS = 1 << 0,
2511
CALIB_RECOMPUTE_EXTRINSIC = 1 << 1,
2512
CALIB_CHECK_COND = 1 << 2,
2513
CALIB_FIX_SKEW = 1 << 3,
2514
CALIB_FIX_K1 = 1 << 4,
2515
CALIB_FIX_K2 = 1 << 5,
2516
CALIB_FIX_K3 = 1 << 6,
2517
CALIB_FIX_K4 = 1 << 7,
2518
CALIB_FIX_INTRINSIC = 1 << 8,
2519
CALIB_FIX_PRINCIPAL_POINT = 1 << 9
2520
};
2521
2522
/** @brief Projects points using fisheye model
2523
2524
@param objectPoints Array of object points, 1xN/Nx1 3-channel (or vector\<Point3f\> ), where N is
2525
the number of points in the view.
2526
@param imagePoints Output array of image points, 2xN/Nx2 1-channel or 1xN/Nx1 2-channel, or
2527
vector\<Point2f\>.
2528
@param affine
2529
@param K Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{_1}\f$.
2530
@param D Input vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$.
2531
@param alpha The skew coefficient.
2532
@param jacobian Optional output 2Nx15 jacobian matrix of derivatives of image points with respect
2533
to components of the focal lengths, coordinates of the principal point, distortion coefficients,
2534
rotation vector, translation vector, and the skew. In the old interface different components of
2535
the jacobian are returned via different output parameters.
2536
2537
The function computes projections of 3D points to the image plane given intrinsic and extrinsic
2538
camera parameters. Optionally, the function computes Jacobians - matrices of partial derivatives of
2539
image points coordinates (as functions of all the input parameters) with respect to the particular
2540
parameters, intrinsic and/or extrinsic.
2541
*/
2542
CV_EXPORTS void projectPoints(InputArray objectPoints, OutputArray imagePoints, const Affine3d& affine,
2543
InputArray K, InputArray D, double alpha = 0, OutputArray jacobian = noArray());
2544
2545
/** @overload */
2546
CV_EXPORTS_W void projectPoints(InputArray objectPoints, OutputArray imagePoints, InputArray rvec, InputArray tvec,
2547
InputArray K, InputArray D, double alpha = 0, OutputArray jacobian = noArray());
2548
2549
/** @brief Distorts 2D points using fisheye model.
2550
2551
@param undistorted Array of object points, 1xN/Nx1 2-channel (or vector\<Point2f\> ), where N is
2552
the number of points in the view.
2553
@param K Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{_1}\f$.
2554
@param D Input vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$.
2555
@param alpha The skew coefficient.
2556
@param distorted Output array of image points, 1xN/Nx1 2-channel, or vector\<Point2f\> .
2557
2558
Note that the function assumes the camera matrix of the undistorted points to be identity.
2559
This means if you want to transform back points undistorted with undistortPoints() you have to
2560
multiply them with \f$P^{-1}\f$.
2561
*/
2562
CV_EXPORTS_W void distortPoints(InputArray undistorted, OutputArray distorted, InputArray K, InputArray D, double alpha = 0);
2563
2564
/** @brief Undistorts 2D points using fisheye model
2565
2566
@param distorted Array of object points, 1xN/Nx1 2-channel (or vector\<Point2f\> ), where N is the
2567
number of points in the view.
2568
@param K Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{_1}\f$.
2569
@param D Input vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$.
2570
@param R Rectification transformation in the object space: 3x3 1-channel, or vector: 3x1/1x3
2571
1-channel or 1x1 3-channel
2572
@param P New camera matrix (3x3) or new projection matrix (3x4)
2573
@param undistorted Output array of image points, 1xN/Nx1 2-channel, or vector\<Point2f\> .
2574
*/
2575
CV_EXPORTS_W void undistortPoints(InputArray distorted, OutputArray undistorted,
2576
InputArray K, InputArray D, InputArray R = noArray(), InputArray P = noArray());
2577
2578
/** @brief Computes undistortion and rectification maps for image transform by cv::remap(). If D is empty zero
2579
distortion is used, if R or P is empty identity matrixes are used.
2580
2581
@param K Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{_1}\f$.
2582
@param D Input vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$.
2583
@param R Rectification transformation in the object space: 3x3 1-channel, or vector: 3x1/1x3
2584
1-channel or 1x1 3-channel
2585
@param P New camera matrix (3x3) or new projection matrix (3x4)
2586
@param size Undistorted image size.
2587
@param m1type Type of the first output map that can be CV_32FC1 or CV_16SC2 . See convertMaps()
2588
for details.
2589
@param map1 The first output map.
2590
@param map2 The second output map.
2591
*/
2592
CV_EXPORTS_W void initUndistortRectifyMap(InputArray K, InputArray D, InputArray R, InputArray P,
2593
const cv::Size& size, int m1type, OutputArray map1, OutputArray map2);
2594
2595
/** @brief Transforms an image to compensate for fisheye lens distortion.
2596
2597
@param distorted image with fisheye lens distortion.
2598
@param undistorted Output image with compensated fisheye lens distortion.
2599
@param K Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{_1}\f$.
2600
@param D Input vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$.
2601
@param Knew Camera matrix of the distorted image. By default, it is the identity matrix but you
2602
may additionally scale and shift the result by using a different matrix.
2603
@param new_size
2604
2605
The function transforms an image to compensate radial and tangential lens distortion.
2606
2607
The function is simply a combination of fisheye::initUndistortRectifyMap (with unity R ) and remap
2608
(with bilinear interpolation). See the former function for details of the transformation being
2609
performed.
2610
2611
See below the results of undistortImage.
2612
- a\) result of undistort of perspective camera model (all possible coefficients (k_1, k_2, k_3,
2613
k_4, k_5, k_6) of distortion were optimized under calibration)
2614
- b\) result of fisheye::undistortImage of fisheye camera model (all possible coefficients (k_1, k_2,
2615
k_3, k_4) of fisheye distortion were optimized under calibration)
2616
- c\) original image was captured with fisheye lens
2617
2618
Pictures a) and b) almost the same. But if we consider points of image located far from the center
2619
of image, we can notice that on image a) these points are distorted.
2620
2621
![image](pics/fisheye_undistorted.jpg)
2622
*/
2623
CV_EXPORTS_W void undistortImage(InputArray distorted, OutputArray undistorted,
2624
InputArray K, InputArray D, InputArray Knew = cv::noArray(), const Size& new_size = Size());
2625
2626
/** @brief Estimates new camera matrix for undistortion or rectification.
2627
2628
@param K Camera matrix \f$K = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{_1}\f$.
2629
@param image_size
2630
@param D Input vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$.
2631
@param R Rectification transformation in the object space: 3x3 1-channel, or vector: 3x1/1x3
2632
1-channel or 1x1 3-channel
2633
@param P New camera matrix (3x3) or new projection matrix (3x4)
2634
@param balance Sets the new focal length in range between the min focal length and the max focal
2635
length. Balance is in range of [0, 1].
2636
@param new_size
2637
@param fov_scale Divisor for new focal length.
2638
*/
2639
CV_EXPORTS_W void estimateNewCameraMatrixForUndistortRectify(InputArray K, InputArray D, const Size &image_size, InputArray R,
2640
OutputArray P, double balance = 0.0, const Size& new_size = Size(), double fov_scale = 1.0);
2641
2642
/** @brief Performs camera calibaration
2643
2644
@param objectPoints vector of vectors of calibration pattern points in the calibration pattern
2645
coordinate space.
2646
@param imagePoints vector of vectors of the projections of calibration pattern points.
2647
imagePoints.size() and objectPoints.size() and imagePoints[i].size() must be equal to
2648
objectPoints[i].size() for each i.
2649
@param image_size Size of the image used only to initialize the intrinsic camera matrix.
2650
@param K Output 3x3 floating-point camera matrix
2651
\f$A = \vecthreethree{f_x}{0}{c_x}{0}{f_y}{c_y}{0}{0}{1}\f$ . If
2652
fisheye::CALIB_USE_INTRINSIC_GUESS/ is specified, some or all of fx, fy, cx, cy must be
2653
initialized before calling the function.
2654
@param D Output vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$.
2655
@param rvecs Output vector of rotation vectors (see Rodrigues ) estimated for each pattern view.
2656
That is, each k-th rotation vector together with the corresponding k-th translation vector (see
2657
the next output parameter description) brings the calibration pattern from the model coordinate
2658
space (in which object points are specified) to the world coordinate space, that is, a real
2659
position of the calibration pattern in the k-th pattern view (k=0.. *M* -1).
2660
@param tvecs Output vector of translation vectors estimated for each pattern view.
2661
@param flags Different flags that may be zero or a combination of the following values:
2662
- **fisheye::CALIB_USE_INTRINSIC_GUESS** cameraMatrix contains valid initial values of
2663
fx, fy, cx, cy that are optimized further. Otherwise, (cx, cy) is initially set to the image
2664
center ( imageSize is used), and focal distances are computed in a least-squares fashion.
2665
- **fisheye::CALIB_RECOMPUTE_EXTRINSIC** Extrinsic will be recomputed after each iteration
2666
of intrinsic optimization.
2667
- **fisheye::CALIB_CHECK_COND** The functions will check validity of condition number.
2668
- **fisheye::CALIB_FIX_SKEW** Skew coefficient (alpha) is set to zero and stay zero.
2669
- **fisheye::CALIB_FIX_K1..fisheye::CALIB_FIX_K4** Selected distortion coefficients
2670
are set to zeros and stay zero.
2671
- **fisheye::CALIB_FIX_PRINCIPAL_POINT** The principal point is not changed during the global
2672
optimization. It stays at the center or at a different location specified when CALIB_USE_INTRINSIC_GUESS is set too.
2673
@param criteria Termination criteria for the iterative optimization algorithm.
2674
*/
2675
CV_EXPORTS_W double calibrate(InputArrayOfArrays objectPoints, InputArrayOfArrays imagePoints, const Size& image_size,
2676
InputOutputArray K, InputOutputArray D, OutputArrayOfArrays rvecs, OutputArrayOfArrays tvecs, int flags = 0,
2677
TermCriteria criteria = TermCriteria(TermCriteria::COUNT + TermCriteria::EPS, 100, DBL_EPSILON));
2678
2679
/** @brief Stereo rectification for fisheye camera model
2680
2681
@param K1 First camera matrix.
2682
@param D1 First camera distortion parameters.
2683
@param K2 Second camera matrix.
2684
@param D2 Second camera distortion parameters.
2685
@param imageSize Size of the image used for stereo calibration.
2686
@param R Rotation matrix between the coordinate systems of the first and the second
2687
cameras.
2688
@param tvec Translation vector between coordinate systems of the cameras.
2689
@param R1 Output 3x3 rectification transform (rotation matrix) for the first camera.
2690
@param R2 Output 3x3 rectification transform (rotation matrix) for the second camera.
2691
@param P1 Output 3x4 projection matrix in the new (rectified) coordinate systems for the first
2692
camera.
2693
@param P2 Output 3x4 projection matrix in the new (rectified) coordinate systems for the second
2694
camera.
2695
@param Q Output \f$4 \times 4\f$ disparity-to-depth mapping matrix (see reprojectImageTo3D ).
2696
@param flags Operation flags that may be zero or CALIB_ZERO_DISPARITY . If the flag is set,
2697
the function makes the principal points of each camera have the same pixel coordinates in the
2698
rectified views. And if the flag is not set, the function may still shift the images in the
2699
horizontal or vertical direction (depending on the orientation of epipolar lines) to maximize the
2700
useful image area.
2701
@param newImageSize New image resolution after rectification. The same size should be passed to
2702
initUndistortRectifyMap (see the stereo_calib.cpp sample in OpenCV samples directory). When (0,0)
2703
is passed (default), it is set to the original imageSize . Setting it to larger value can help you
2704
preserve details in the original image, especially when there is a big radial distortion.
2705
@param balance Sets the new focal length in range between the min focal length and the max focal
2706
length. Balance is in range of [0, 1].
2707
@param fov_scale Divisor for new focal length.
2708
*/
2709
CV_EXPORTS_W void stereoRectify(InputArray K1, InputArray D1, InputArray K2, InputArray D2, const Size &imageSize, InputArray R, InputArray tvec,
2710
OutputArray R1, OutputArray R2, OutputArray P1, OutputArray P2, OutputArray Q, int flags, const Size &newImageSize = Size(),
2711
double balance = 0.0, double fov_scale = 1.0);
2712
2713
/** @brief Performs stereo calibration
2714
2715
@param objectPoints Vector of vectors of the calibration pattern points.
2716
@param imagePoints1 Vector of vectors of the projections of the calibration pattern points,
2717
observed by the first camera.
2718
@param imagePoints2 Vector of vectors of the projections of the calibration pattern points,
2719
observed by the second camera.
2720
@param K1 Input/output first camera matrix:
2721
\f$\vecthreethree{f_x^{(j)}}{0}{c_x^{(j)}}{0}{f_y^{(j)}}{c_y^{(j)}}{0}{0}{1}\f$ , \f$j = 0,\, 1\f$ . If
2722
any of fisheye::CALIB_USE_INTRINSIC_GUESS , fisheye::CALIB_FIX_INTRINSIC are specified,
2723
some or all of the matrix components must be initialized.
2724
@param D1 Input/output vector of distortion coefficients \f$(k_1, k_2, k_3, k_4)\f$ of 4 elements.
2725
@param K2 Input/output second camera matrix. The parameter is similar to K1 .
2726
@param D2 Input/output lens distortion coefficients for the second camera. The parameter is
2727
similar to D1 .
2728
@param imageSize Size of the image used only to initialize intrinsic camera matrix.
2729
@param R Output rotation matrix between the 1st and the 2nd camera coordinate systems.
2730
@param T Output translation vector between the coordinate systems of the cameras.
2731
@param flags Different flags that may be zero or a combination of the following values:
2732
- **fisheye::CALIB_FIX_INTRINSIC** Fix K1, K2? and D1, D2? so that only R, T matrices
2733
are estimated.
2734
- **fisheye::CALIB_USE_INTRINSIC_GUESS** K1, K2 contains valid initial values of
2735
fx, fy, cx, cy that are optimized further. Otherwise, (cx, cy) is initially set to the image
2736
center (imageSize is used), and focal distances are computed in a least-squares fashion.
2737
- **fisheye::CALIB_RECOMPUTE_EXTRINSIC** Extrinsic will be recomputed after each iteration
2738
of intrinsic optimization.
2739
- **fisheye::CALIB_CHECK_COND** The functions will check validity of condition number.
2740
- **fisheye::CALIB_FIX_SKEW** Skew coefficient (alpha) is set to zero and stay zero.
2741
- **fisheye::CALIB_FIX_K1..4** Selected distortion coefficients are set to zeros and stay
2742
zero.
2743
@param criteria Termination criteria for the iterative optimization algorithm.
2744
*/
2745
CV_EXPORTS_W double stereoCalibrate(InputArrayOfArrays objectPoints, InputArrayOfArrays imagePoints1, InputArrayOfArrays imagePoints2,
2746
InputOutputArray K1, InputOutputArray D1, InputOutputArray K2, InputOutputArray D2, Size imageSize,
2747
OutputArray R, OutputArray T, int flags = fisheye::CALIB_FIX_INTRINSIC,
2748
TermCriteria criteria = TermCriteria(TermCriteria::COUNT + TermCriteria::EPS, 100, DBL_EPSILON));
2749
2750
//! @} calib3d_fisheye
2751
} // end namespace fisheye
2752
2753
} //end namespace cv
2754
2755
#endif
2756
2757