gtsam
4.0.0
gtsam
|
PinholeSet: triangulates point and keeps an estimate of it around.
Public Member Functions | |
virtual | ~PinholeSet () |
Virtual destructor. | |
TriangulationResult | triangulateSafe (const typename CAMERA::MeasurementVector &measured, const TriangulationParameters ¶ms) const |
triangulateSafe | |
Testable | |
virtual void | print (const std::string &s="") const |
print | |
bool | equals (const PinholeSet &p, double tol=1e-9) const |
equals | |
Public Member Functions inherited from gtsam::CameraSet< CAMERA > | |
bool | equals (const CameraSet &p, double tol=1e-9) const |
equals | |
template<class POINT > | |
ZVector | project2 (const POINT &point, boost::optional< FBlocks & > Fs=boost::none, boost::optional< Matrix & > E=boost::none) const |
Project a point (possibly Unit3 at infinity), with derivatives Note that F is a sparse block-diagonal matrix, so instead of a large dense matrix this function returns the diagonal blocks. More... | |
template<class POINT > | |
Vector | reprojectionError (const POINT &point, const ZVector &measured, boost::optional< FBlocks & > Fs=boost::none, boost::optional< Matrix & > E=boost::none) const |
Calculate vector [project2(point)-z] of re-projection errors. | |
Friends | |
class | boost::serialization::access |
Serialization function. | |
Additional Inherited Members | |
Static Public Member Functions inherited from gtsam::CameraSet< CAMERA > | |
template<int N> | |
static SymmetricBlockMatrix | SchurComplement (const FBlocks &Fs, const Matrix &E, const Eigen::Matrix< double, N, N > &P, const Vector &b) |
Do Schur complement, given Jacobian as Fs,E,P, return SymmetricBlockMatrix G = F' * F - F' * E * P * E' * F g = F' * (b - E * P * E' * b) Fixed size version. | |
template<int N> | |
static void | ComputePointCovariance (Eigen::Matrix< double, N, N > &P, const Matrix &E, double lambda, bool diagonalDamping=false) |
Computes Point Covariance P, with lambda parameter. | |
static Matrix | PointCov (const Matrix &E, const double lambda=0.0, bool diagonalDamping=false) |
Computes Point Covariance P, with lambda parameter, dynamic version. | |
static SymmetricBlockMatrix | SchurComplement (const FBlocks &Fblocks, const Matrix &E, const Vector &b, const double lambda=0.0, bool diagonalDamping=false) |
Do Schur complement, given Jacobian as Fs,E,P, return SymmetricBlockMatrix Dynamic version. | |
template<int N> | |
static void | UpdateSchurComplement (const FBlocks &Fs, const Matrix &E, const Eigen::Matrix< double, N, N > &P, const Vector &b, const KeyVector &allKeys, const KeyVector &keys, SymmetricBlockMatrix &augmentedHessian) |
Applies Schur complement (exploiting block structure) to get a smart factor on cameras, and adds the contribution of the smart factor to a pre-allocated augmented Hessian. | |
Public Types inherited from gtsam::CameraSet< CAMERA > | |
typedef Eigen::Matrix< double, ZDim, D > | MatrixZD |
Definitions for blocks of F. | |
typedef std::vector< MatrixZD, Eigen::aligned_allocator< MatrixZD > > | FBlocks |
Protected Types inherited from gtsam::CameraSet< CAMERA > | |
typedef CAMERA::Measurement | Z |
2D measurement and noise model for each of the m views The order is kept the same as the keys that we use to create the factor. | |
typedef CAMERA::MeasurementVector | ZVector |
Static Protected Member Functions inherited from gtsam::CameraSet< CAMERA > | |
static Vector | ErrorVector (const ZVector &predicted, const ZVector &measured) |
Make a vector of re-projection errors. | |
Static Protected Attributes inherited from gtsam::CameraSet< CAMERA > | |
static const int | D = traits<CAMERA>::dimension |
Camera dimension. | |
static const int | ZDim = traits<Z>::dimension |
Measurement dimension. | |