Estimates a 3D projective transformation from two point sets. More...
#include <EstimateProjectiveTransformation3D.hpp>
Public Types | |
typedef super::ArrayXT | ArrayXT |
General-purpose array of arbitrary size with value type T. | |
typedef super::MatrixXT | MatrixXT |
Matrix of arbitrary size with value type T. | |
typedef super::VectorXT | VectorXT |
Column vector of arbitrary size with value type T. | |
typedef super::Vector2T | Vector2T |
2D column vector with value type T. | |
typedef super::Vector3T | Vector3T |
3D column vector with value type T. | |
typedef super::Vector4T | Vector4T |
4D column vector with value type T. | |
typedef super::RowVector2T | RowVector2T |
2D row vector with value type T. | |
typedef super::RowVector3T | RowVector3T |
3D row vector with value type T. | |
typedef super::Matrix2T | Matrix2T |
2 x 2 matrix with value type T. | |
typedef super::Matrix3T | Matrix3T |
3 x 3 matrix with value type T. | |
typedef super::Matrix4T | Matrix4T |
4 x 4 matrix with value type T. | |
enum | Error { NOT_ENOUGH_POINTS, UNEQUAL_NUMBER_OF_POINTS, UNKNOWN_ERROR, WRONG_POINT_SIZE } |
Public Member Functions | |
EstimateProjectiveTransformation3D () | |
Constructs a new instance of this class. | |
EstimateProjectiveTransformation3D (const std::vector< Coordinate< T > > &source_points, const std::vector< Coordinate< T > > &target_points) | |
Constructs a new instance of this class. | |
EstimateProjectiveTransformation3D (const std::vector< Vector3T > &source_points, const std::vector< Vector3T > &target_points) | |
Constructs a new instance of this class. | |
EstimateProjectiveTransformation3D (const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > &source_points, const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > &target_points) | |
Constructs a new instance of this class. | |
virtual | ~EstimateProjectiveTransformation3D () |
Deletes the instance. | |
virtual void | compute () |
Computes the transformation estimation. | |
void | setMaxIterations (int value) |
Sets the maximum number of iterations within Newton's method. | |
void | setMaxRMS (value_type value) |
Sets the maximum root mean square (RMS) error value. | |
virtual value_type | getRMS () const |
Returns the root mean square (RMS) error of the estimated transformation. | |
virtual const Matrix4T & | getTransformationMatrix () const |
void | setSourcePoints (const std::vector< Coordinate< T > > &) |
Sets the source points. | |
void | setSourcePoints (const std::vector< Vector3T > &) |
Sets the source points. | |
void | setSourcePoints (const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > &) |
Sets the source points. | |
void | setTargetPoints (const std::vector< Coordinate< T > > &) |
Sets the target points. | |
void | setTargetPoints (const std::vector< Vector3T > &) |
Sets the target points. | |
void | setTargetPoints (const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > &) |
Sets the target points. | |
Public Attributes | |
EIGEN_MAKE_ALIGNED_OPERATOR_NEW typedef T | value_type |
Internally used value type (should be a floating point type). | |
Protected Attributes | |
MatrixXT | m_source_points |
MatrixXT | m_target_points |
Matrix4T | m_transformation_matrix |
Estimates a 3D projective transformation from two point sets.
This class estimates a 3D projective transformation between two point sets by using Newton's method. The point sets must have the same cardinality, and the points must correspond to each other. There must be at least five corresponding point pairs.
The algorithm estimates a transformation matrix as shown below:
\[ \begin{pmatrix} y_1 \\ y_2 \\ y_3 \end{pmatrix} = \frac{1}{y'_4} \begin{pmatrix} y'_1 \\ y'_2 \\ y'_3 \end{pmatrix} \quad \wedge \quad \begin{pmatrix} y'_1 \\ y'_2 \\ y'_3 \\ y'_4 \end{pmatrix} = \begin{pmatrix} a_{11} & a_{12} & a_{13} & a_{14} \\ a_{21} & a_{22} & a_{23} & a_{24} \\ a_{31} & a_{32} & a_{33} & a_{34} \\ a_{41} & a_{42} & a_{43} & a_{44} \end{pmatrix} \begin{pmatrix} x_1 \\ x_2 \\ x_3 \\ 1 \end{pmatrix} \]
The source points are the set of all \( x \) and the target points are the set of all \( y \).
Here is an more elaborate example to see, how to use the class:
#include <cstdlib> #include <iostream> #include <vector> #include <TRTK/Coordinate.hpp> #include <TRTK/Transform3D.hpp> #include <TRTK/EstimateProjectiveTransformation3D.hpp> using std::cout; using std::endl; using std::vector; using namespace TRTK; int main() { // Construct a projective transformation. Transform3D<double> transform; transform.a12() = 1; transform.a14() = 3; transform.a21() = 2; transform.a32() = 3; transform.a34() = 2; transform.a42() = 1; transform.a43() = 1; // Construct two sets with source and target points, respectively. vector<Coordinate<double> > source_points; vector<Coordinate<double> > target_points; for (unsigned i = 0; i < 6; ++i) { double x = std::rand() % 100; double y = std::rand() % 100; double z = std::rand() % 100; Coordinate<double> source_point(x, y, z); Coordinate<double> target_point = transform * source_point; source_points.push_back(source_point); target_points.push_back(target_point); } // Perform the transformation estimation. EstimateProjectiveTransformation3D<double> estimateProjectiveTransformation3D(source_points, target_points); estimateProjectiveTransformation3D.setMaxIterations(20); estimateProjectiveTransformation3D.compute(); // Display the results. cout.precision(4); cout << std::fixed; cout << "Original transformation matrix:" << endl << endl << transform.getTransformationMatrix() << endl << endl; cout << "Estimated transformation matrix:" << endl << endl << estimateProjectiveTransformation3D.getTransformationMatrix() << endl << endl; // Example of how to use the result. Transform3D<double> transform2 = estimateProjectiveTransformation3D.getTransformationMatrix(); cout << "Source point 1: " << source_points[0] << endl << "Target point 1 (original): " << target_points[0] << endl << "Target point 1 (transformed): " << transform2 * source_points[0] << endl << endl; cout << "RMS: " << estimateProjectiveTransformation3D.getRMS() << endl; return 0; }
Output:
Original transformation matrix: 1.0000 1.0000 0.0000 3.0000 2.0000 1.0000 0.0000 0.0000 0.0000 3.0000 1.0000 2.0000 0.0000 1.0000 1.0000 1.0000 Estimated transformation matrix: 0.0929 0.0689 -0.0043 2.7760 0.1954 0.0466 0.0066 3.4745 -0.0280 0.2753 0.1490 1.3863 -0.0096 0.0830 0.1229 1.0000 Source point 1: (41.0000, 67.0000, 34.0000) Target point 1 (original): (1.0882, 1.4608, 2.3235) Target point 1 (transformed): (1.0688, 1.4343, 2.2961) RMS: 0.0557
Definition at line 213 of file EstimateProjectiveTransformation3D.hpp.
enum TRTK::EstimateTransformation::Error [inherited] |
Definition at line 62 of file EstimateTransformation.hpp.
TRTK::EstimateProjectiveTransformation3D< T >::EstimateProjectiveTransformation3D | ( | ) |
Constructs a new instance of this class.
T | scalar type of the coordinates |
Definition at line 280 of file EstimateProjectiveTransformation3D.hpp.
TRTK::EstimateProjectiveTransformation3D< T >::EstimateProjectiveTransformation3D | ( | const std::vector< Coordinate< T > > & | source_points, |
const std::vector< Coordinate< T > > & | target_points | ||
) |
Constructs a new instance of this class.
T | scalar type of the coordinates |
[in] | source_points | The points can either be plain 3D or 4D homogeneous coordinates. |
[in] | target_points | The points can either be plain 3D or 4D homogeneous coordinates. |
No transformation estimation is done. To do so, please call compute().
ErrorObj | If there are any coordinates other than 3D or 4D coordinates, an error object is thrown and its error code is set to WRONG_POINT_SIZE . |
Definition at line 309 of file EstimateProjectiveTransformation3D.hpp.
TRTK::EstimateProjectiveTransformation3D< T >::EstimateProjectiveTransformation3D | ( | const std::vector< Vector3T > & | source_points, |
const std::vector< Vector3T > & | target_points | ||
) |
Constructs a new instance of this class.
T | scalar type of the coordinates |
[in] | source_points | 3D coordinates. |
[in] | target_points | 3D coordinates. |
No transformation estimation is done. To do so, please call compute().
Definition at line 333 of file EstimateProjectiveTransformation3D.hpp.
TRTK::EstimateProjectiveTransformation3D< T >::EstimateProjectiveTransformation3D | ( | const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > & | source_points, |
const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > & | target_points | ||
) |
Constructs a new instance of this class.
T | scalar type of the coordinates |
[in] | source_points | 4D homogeneous coordinates. |
[in] | target_points | 4D homogeneous coordinates. |
No transformation estimation is done. To do so, please call compute().
Definition at line 357 of file EstimateProjectiveTransformation3D.hpp.
TRTK::EstimateProjectiveTransformation3D< T >::~EstimateProjectiveTransformation3D | ( | ) | [virtual] |
Deletes the instance.
T | scalar type of the coordinates |
Definition at line 373 of file EstimateProjectiveTransformation3D.hpp.
void TRTK::EstimateProjectiveTransformation3D< T >::compute | ( | ) | [virtual] |
Computes the transformation estimation.
T | scalar type of the coordinates |
This function uses Newton's method (after Simpson) to estimate the sought transformation matrix entries. For a more detailed explanation of the algorithm, please have a look at the source code. (A link should be below.)
The direction of the transformation is from the source points to the target points: \( p_{target} = \cal{T} \; \{ p_{source} \} \).
ErrorObj | If the point sets do not have the same cardinality, an error object is thrown and its error code is set to UNEQUAL_NUMBER_OF_POINTS . |
ErrorObj | If there are not enough points (at least four) to perform the transformation estimation, an error object is thrown and its error code is set to NOT_ENOUGH_POINTS . |
Implements TRTK::EstimateTransformation3D< T >.
Definition at line 399 of file EstimateProjectiveTransformation3D.hpp.
EstimateTransformation3D< T >::value_type TRTK::EstimateTransformation3D< T >::getRMS | ( | ) | const [virtual, inherited] |
Returns the root mean square (RMS) error of the estimated transformation.
T | scalar type of the coordinates |
It is assumed, that the computation was done before.
The value type T
must provide a function T sqrt(T value)
which yields the square root of value
.
ErrorObj | If the point sets do not have the same cardinality, an error object is thrown and its error code is set to UNEQUAL_NUMBER_OF_POINTS . |
Implements TRTK::EstimateTransformation< T >.
Definition at line 149 of file EstimateTransformation3D.hpp.
const EstimateTransformation3D< T >::Matrix4T & TRTK::EstimateTransformation3D< T >::getTransformationMatrix | ( | ) | const [virtual, inherited] |
T | scalar type of the coordinates |
Definition at line 195 of file EstimateTransformation3D.hpp.
void TRTK::EstimateProjectiveTransformation3D< T >::setMaxIterations | ( | int | value ) |
Sets the maximum number of iterations within Newton's method.
T | scalar type of the coordinates |
Sets the maximum number of iterations within Newton's method which is used to compute the transformation matrix.
The default value is 0.1.
Definition at line 615 of file EstimateProjectiveTransformation3D.hpp.
void TRTK::EstimateProjectiveTransformation3D< T >::setMaxRMS | ( | value_type | value ) |
Sets the maximum root mean square (RMS) error value.
T | scalar type of the coordinates |
Sets the maximum root mean square (RMS) error value within Newton's method which is used to compute the transformation matrix. That is, the iteration is stopped, if the RMS is below value
.
The default value is 10.
Definition at line 635 of file EstimateProjectiveTransformation3D.hpp.
void TRTK::EstimateTransformation3D< T >::setSourcePoints | ( | const std::vector< Vector3T > & | source_points ) | [inherited] |
Sets the source points.
T | scalar type of the coordinates |
[in] | source_points | 3D coordinates. |
Definition at line 247 of file EstimateTransformation3D.hpp.
void TRTK::EstimateTransformation3D< T >::setSourcePoints | ( | const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > & | source_points ) | [inherited] |
Sets the source points.
T | scalar type of the coordinates |
[in] | source_points | 4D homogeneous coordinates. |
Definition at line 265 of file EstimateTransformation3D.hpp.
void TRTK::EstimateTransformation3D< T >::setSourcePoints | ( | const std::vector< Coordinate< T > > & | source_points ) | [inherited] |
Sets the source points.
T | scalar type of the coordinates |
[in] | source_points | The points can either be plain 3D or 4D homogeneous coordinates. |
ErrorObj | If there are any coordinates other than 3D or 4D coordinates, an error object is thrown and its error code is set to WRONG_POINT_SIZE . |
Definition at line 215 of file EstimateTransformation3D.hpp.
void TRTK::EstimateTransformation3D< T >::setTargetPoints | ( | const std::vector< Coordinate< T > > & | target_points ) | [inherited] |
Sets the target points.
T | scalar type of the coordinates |
[in] | target_points | The points can either be plain 3D or 4D homogeneous coordinates. |
ErrorObj | If there are any coordinates other than 3D or 4D coordinates, an error object is thrown and its error code is set to WRONG_POINT_SIZE . |
Definition at line 293 of file EstimateTransformation3D.hpp.
void TRTK::EstimateTransformation3D< T >::setTargetPoints | ( | const std::vector< Vector4T, Eigen::aligned_allocator< Vector4T > > & | target_points ) | [inherited] |
Sets the target points.
T | scalar type of the coordinates |
[in] | target_points | 4D homogeneous coordinates. |
Definition at line 343 of file EstimateTransformation3D.hpp.
void TRTK::EstimateTransformation3D< T >::setTargetPoints | ( | const std::vector< Vector3T > & | target_points ) | [inherited] |
Sets the target points.
T | scalar type of the coordinates |
[in] | target_points | 3D coordinates. |
Definition at line 325 of file EstimateTransformation3D.hpp.
Documentation generated by Doxygen