Class for representing a simple fundamental matrix. More...
#include <FundamentalMatrix.h>
Public Member Functions | |
Vector3 | epipolarLine (const Point2 &p, OptionalJacobian< 3, 7 > H={}) |
Computes the epipolar line in a (left) for a given point in b (right) More... | |
Matrix3 | matrix () const |
SimpleFundamentalMatrix () | |
Default constructor. More... | |
SimpleFundamentalMatrix (const EssentialMatrix &E, double fa, double fb, const Point2 &ca, const Point2 &cb) | |
Construct from essential matrix and focal lengths. More... | |
Testable | |
Print the SimpleFundamentalMatrix | |
void | print (const std::string &s="") const |
bool | equals (const SimpleFundamentalMatrix &other, double tol=1e-9) const |
Check equality within a tolerance. More... | |
Private Member Functions | |
Matrix3 | Ka () const |
Return the left calibration matrix. More... | |
Matrix3 | Kb () const |
Return the right calibration matrix. More... | |
Private Attributes | |
Point2 | ca_ |
Principal point for left camera. More... | |
Point2 | cb_ |
Principal point for right camera. More... | |
EssentialMatrix | E_ |
Essential matrix. More... | |
double | fa_ |
Focal length for left camera. More... | |
double | fb_ |
Focal length for right camera. More... | |
Manifold | |
constexpr static auto | dimension = 7 |
size_t | dim () const |
Vector | localCoordinates (const SimpleFundamentalMatrix &F) const |
Return local coordinates with respect to another SimpleFundamentalMatrix. More... | |
SimpleFundamentalMatrix | retract (const Vector &delta) const |
Retract the given vector to get a new SimpleFundamentalMatrix. More... | |
static size_t | Dim () |
Class for representing a simple fundamental matrix.
This class represents a simple fundamental matrix, which is a parameterization of the essential matrix and focal lengths for left and right cameras. Principal points are not part of the manifold but a convenience.
Definition at line 132 of file FundamentalMatrix.h.
|
inline |
Default constructor.
Definition at line 148 of file FundamentalMatrix.h.
|
inline |
Construct from essential matrix and focal lengths.
E | Essential matrix |
fa | Focal length for left camera |
fb | Focal length for right camera |
ca | Principal point for left camera |
cb | Principal point for right camera |
Definition at line 159 of file FundamentalMatrix.h.
|
inlinestatic |
Definition at line 183 of file FundamentalMatrix.h.
|
inline |
Definition at line 184 of file FundamentalMatrix.h.
Vector3 gtsam::SimpleFundamentalMatrix::epipolarLine | ( | const Point2 & | p, |
OptionalJacobian< 3, 7 > | H = {} |
||
) |
Computes the epipolar line in a (left) for a given point in b (right)
Definition at line 133 of file FundamentalMatrix.cpp.
bool gtsam::SimpleFundamentalMatrix::equals | ( | const SimpleFundamentalMatrix & | other, |
double | tol = 1e-9 |
||
) | const |
Check equality within a tolerance.
Definition at line 154 of file FundamentalMatrix.cpp.
|
private |
Return the left calibration matrix.
Definition at line 117 of file FundamentalMatrix.cpp.
|
private |
Return the right calibration matrix.
Definition at line 123 of file FundamentalMatrix.cpp.
Vector gtsam::SimpleFundamentalMatrix::localCoordinates | ( | const SimpleFundamentalMatrix & | F | ) | const |
Return local coordinates with respect to another SimpleFundamentalMatrix.
Definition at line 161 of file FundamentalMatrix.cpp.
Matrix3 gtsam::SimpleFundamentalMatrix::matrix | ( | ) | const |
Return the fundamental matrix representation F = Ka^(-T) * E * Kb^(-1)
Definition at line 129 of file FundamentalMatrix.cpp.
void gtsam::SimpleFundamentalMatrix::print | ( | const std::string & | s = "" | ) | const |
Definition at line 147 of file FundamentalMatrix.cpp.
SimpleFundamentalMatrix gtsam::SimpleFundamentalMatrix::retract | ( | const Vector & | delta | ) | const |
Retract the given vector to get a new SimpleFundamentalMatrix.
Definition at line 170 of file FundamentalMatrix.cpp.
|
private |
Principal point for left camera.
Definition at line 137 of file FundamentalMatrix.h.
|
private |
Principal point for right camera.
Definition at line 138 of file FundamentalMatrix.h.
|
inlinestaticconstexpr |
Definition at line 182 of file FundamentalMatrix.h.
|
private |
Essential matrix.
Definition at line 134 of file FundamentalMatrix.h.
|
private |
Focal length for left camera.
Definition at line 135 of file FundamentalMatrix.h.
|
private |
Focal length for right camera.
Definition at line 136 of file FundamentalMatrix.h.