NASA Astrobee Robot Software
0.19.1
Flight software for the Astrobee robots operating inside the International Space Station.
|
#include <inverse_depth_projection_factor.h>
Public Types | |
typedef NoiseModelFactor3< Pose3, vision_common::InverseDepthMeasurement, Pose3 > | Base |
typedef boost::shared_ptr< InverseDepthProjectionFactor > | shared_ptr |
typedef InverseDepthProjectionFactor | This |
Public Member Functions | |
InverseDepthProjectionFactor () | |
InverseDepthProjectionFactor (const Point2 &measured, const SharedNoiseModel &model, Key sourcePoseKey, Key inverseDepthMeasurementKey, Key targetPoseKey) | |
InverseDepthProjectionFactor (const Point2 &measured, const SharedNoiseModel &model, Key sourcePoseKey, Key inverseDepthCameraPoseKey, Key targetPoseKey, bool verboseCheirality) | |
virtual | ~InverseDepthProjectionFactor () |
virtual NonlinearFactor::shared_ptr | clone () const |
void | print (const std::string &s="", const KeyFormatter &keyFormatter=DefaultKeyFormatter) const override |
bool | equals (const NonlinearFactor &p, double tol=1e-9) const override |
Vector | evaluateError (const Pose3 &world_T_source, const vision_common::InverseDepthMeasurement &inverseDepthMeasurement, const Pose3 &world_T_target, boost::optional< Matrix & > d_projected_point_d_world_T_source=boost::none, boost::optional< Matrix & > d_projected_point_d_inverse_depth=boost::none, boost::optional< Matrix & > d_projected_point_d_world_T_target=boost::none) const override |
Evaluate error h(x)-z and optionally derivatives. More... | |
const Point2 & | measured () const |
bool | verboseCheirality () const |
Protected Attributes | |
Point2 | measured_ |
bool | verboseCheirality_ |
Friends | |
class | boost::serialization::access |
Serialization function. More... | |
Non-linear factor for a constraint derived from a 2D measurement. The calibration is known and the landmark point is represented using the inverse depth parameterization.
typedef NoiseModelFactor3<Pose3, vision_common::InverseDepthMeasurement, Pose3> gtsam::InverseDepthProjectionFactor::Base |
typedef boost::shared_ptr<InverseDepthProjectionFactor> gtsam::InverseDepthProjectionFactor::shared_ptr |
|
inline |
|
inline |
Constructor
measured | is the 2 dimensional location of point in image (the measurement) |
model | is the standard deviation |
sourcePoseKey | is the index of the source camera |
inverseDepthMeasurementKey | is the index of the inverse depth measurement |
targetPoseKey | is the index of the target camera |
|
inline |
Constructor with exception-handling flags
measured | is the 2 dimensional location of point in image (the measurement) |
model | is the standard deviation |
sourcePoseKey | is the index of the source camera |
inverseDepthMeasurementKey | is the index of the inverse depth measurement |
targetPoseKey | is the index of the target camera |
verboseCheirality | determines whether exceptions are printed for Cheirality |
|
inlinevirtual |
|
inlinevirtual |
|
inlineoverride |
|
inlineoverride |
Evaluate error h(x)-z and optionally derivatives.
|
inline |
|
inlineoverride |
s | optional string naming the factor |
keyFormatter | optional formatter useful for printing Symbols |
|
inline |
|
friend |
Serialization function.
|
protected |
|
protected |