Inverse Depth Factor based on Civera09tro, Montiel06rss. Landmarks are parameterized as (x,y,z,theta,phi,rho). The factor involves a single pose and a landmark. The landmark parameterization contains the reference point internally (and will thus be updated as well during optimization). More...
#include <gtsam/nonlinear/NonlinearFactor.h>#include <gtsam/geometry/PinholeCamera.h>#include <gtsam/geometry/Cal3_S2.h>#include <gtsam/geometry/Pose3.h>#include <gtsam/geometry/Point2.h>#include <gtsam/base/numericalDerivative.h>

Go to the source code of this file.
Classes | |
| class | gtsam::InvDepthFactorVariant1 |
Namespaces | |
| gtsam | |
| traits | |
Inverse Depth Factor based on Civera09tro, Montiel06rss. Landmarks are parameterized as (x,y,z,theta,phi,rho). The factor involves a single pose and a landmark. The landmark parameterization contains the reference point internally (and will thus be updated as well during optimization).
Definition in file InvDepthFactorVariant1.h.