Ternary factor representing a visual measurement using an inverse-depth parameterization.
|
| InvDepthFactorVariant3b () |
| Default constructor.
|
|
| InvDepthFactorVariant3b (const Key poseKey1, const Key poseKey2, const Key landmarkKey, const Point2 &measured, const Cal3_S2::shared_ptr &K, const SharedNoiseModel &model) |
| Constructor TODO: Mark argument order standard (keys, measurement, parameters) More...
|
|
virtual | ~InvDepthFactorVariant3b () |
| Virtual destructor.
|
|
void | print (const std::string &s="InvDepthFactorVariant3", const KeyFormatter &keyFormatter=DefaultKeyFormatter) const |
| print More...
|
|
virtual bool | equals (const NonlinearFactor &p, double tol=1e-9) const |
| equals
|
|
Vector | inverseDepthError (const Pose3 &pose1, const Pose3 &pose2, const Vector3 &landmark) const |
|
Vector | evaluateError (const Pose3 &pose1, const Pose3 &pose2, const Vector3 &landmark, boost::optional< Matrix & > H1=boost::none, boost::optional< Matrix & > H2=boost::none, boost::optional< Matrix & > H3=boost::none) const |
| Evaluate error h(x)-z and optionally derivatives.
|
|
const Point2 & | imagePoint () const |
| return the measurement
|
|
const Cal3_S2::shared_ptr | calibration () const |
| return the calibration object
|
|
| NoiseModelFactor3 () |
| Default Constructor for I/O.
|
|
| NoiseModelFactor3 (const SharedNoiseModel &noiseModel, Key j1, Key j2, Key j3) |
| Constructor. More...
|
|
Key | key1 () const |
| methods to retrieve keys
|
|
Key | key2 () const |
|
Key | key3 () const |
|
virtual Vector | unwhitenedError (const Values &x, boost::optional< std::vector< Matrix > & > H=boost::none) const |
| Calls the 3-key specific version of evaluateError, which is pure virtual so must be implemented in the derived class. More...
|
|