|
My Project 1.0
Holistic Fusion: A Generic Framework for Multimodal Sensor Fusion
|
#include <GmsfUnaryExpression.h>
Public Types | |
| using | template_type = GTSAM_MEASUREMENT_TYPE |
Public Member Functions | |
| GmsfUnaryExpression (const std::shared_ptr< UnaryMeasurement > &gmsfBaseUnaryMeasurementPtr, const std::string &imuFrameName, const Eigen::Isometry3d &T_I_sensorFrame) | |
| ~GmsfUnaryExpression ()=default | |
| gtsam::Expression< GTSAM_MEASUREMENT_TYPE > | createAndReturnExpression (const gtsam::Key &closestGeneralKey, DynamicDictionaryContainer >samDynamicExpressionKeys, const gtsam::NavState &W_imuPropagatedState, const bool optimizeReferenceFramePosesWrtWorldFlag, const bool centerMeasurementsAtKeyframePositionBeforeAlignmentFlag, const bool optimizeExtrinsicSensorToSensorCorrectedOffsetFlag) |
| virtual const gtsam::Vector | getNoiseDensity () const =0 |
| virtual const GTSAM_MEASUREMENT_TYPE | getGtsamMeasurementValue () const =0 |
| virtual const std::shared_ptr< UnaryMeasurement > & | getGmsfBaseUnaryMeasurementPtr () |
| double | getTimestamp () const |
| const gtsam::Values & | getNewOnlineGraphStateValues () const |
| const gtsam::Values & | getNewOfflineGraphStateValues () const |
| const std::vector< gtsam::PriorFactor< gtsam::Pose3 > > & | getNewOnlinePosePriorFactors () const |
| const std::vector< gtsam::PriorFactor< GTSAM_MEASUREMENT_TYPE > > & | getNewOnlineDynamicPriorFactors () const |
| const std::vector< gtsam::BetweenFactor< gtsam::Pose3 > > & | getNewOnlineAndOfflinePoseBetweenFactors () const |
| const Eigen::Isometry3d & | getT_I_sensorFrameInit () const |
Protected Member Functions | |
| virtual void | generateImuStateInWorldFrameAtKey (const gtsam::Key &closestGeneralKey)=0 |
| virtual void | transformImuStateFromWorldToReferenceFrame (DynamicDictionaryContainer >samDynamicExpressionKeys, const gtsam::NavState &W_currentPropagatedState, const bool centerMeasurementsAtKeyframePositionBeforeAlignmentFlag)=0 |
| virtual void | transformLandmarkInWorldToImuFrame (DynamicDictionaryContainer >samDynamicExpressionKeys, const gtsam::NavState &W_currentPropagatedState)=0 |
| virtual void | transformImuStateToSensorFrameState ()=0 |
| virtual void | transformSensorFrameStateToSensorFrameCorrectedState (DynamicDictionaryContainer >samDynamicExpressionKeys) |
| virtual void | applyExtrinsicCalibrationCorrection (const gtsam::Expression< GTSAM_MEASUREMENT_TYPE > &exp_C_sensorFrame_sensorFrameCorrected)=0 |
| virtual gtsam::Pose3 | convertToPose3 (const GTSAM_MEASUREMENT_TYPE &measurement)=0 |
| virtual GTSAM_MEASUREMENT_TYPE | convertFromPose3 (const gtsam::Pose3 &pose)=0 |
| virtual const gtsam::Expression< GTSAM_MEASUREMENT_TYPE > | getGtsamExpression () const =0 |
Protected Attributes | |
| const std::shared_ptr< UnaryMeasurement > | gmsfBaseUnaryMeasurementPtr_ |
| const std::string | imuFrame_ |
| Eigen::Isometry3d | T_I_sensorFrameInit_ |
| gtsam::Values | newOnlineStateValues_ |
| gtsam::Values | newOfflineStateValues_ |
| std::vector< gtsam::PriorFactor< gtsam::Pose3 > > | newOnlinePosePriorFactors_ |
| std::vector< gtsam::PriorFactor< GTSAM_MEASUREMENT_TYPE > > | newOnlineDynamicPriorFactors_ |
| std::vector< gtsam::BetweenFactor< gtsam::Pose3 > > | newOnlineAndOfflinePoseBetweenFactors_ |
base class for unary expressions. Unary expressions are used to represent unary factors in the factor graph. It optionally supports the HolisticGraph paradigm to align different measurements. It optionally supports extrinsic calibration of the sensor.
| GTSAM_MEASUREMENT_TYPE | Type of the measurement (e.g. gtsam::Pose3). |
| TYPE | Type of the unary expression (e.g. UnaryExpressionType::Absolute). |
| CALIBRATION_CHAR | Character representing the calibration type (e.g. 'c'). |
Definition at line 51 of file GmsfUnaryExpression.h.
| using holistic_fusion::GmsfUnaryExpression< GTSAM_MEASUREMENT_TYPE, TYPE, CALIBRATION_CHAR >::template_type = GTSAM_MEASUREMENT_TYPE |
Definition at line 54 of file GmsfUnaryExpression.h.
|
inline |
Definition at line 57 of file GmsfUnaryExpression.h.
|
default |
|
protectedpure virtual |
Implemented in holistic_fusion::GmsfUnaryExpressionAbsoluteHeading.
|
protectedpure virtual |
|
protectedpure virtual |
|
inline |
Definition at line 65 of file GmsfUnaryExpression.h.
|
protectedpure virtual |
Implemented in holistic_fusion::GmsfUnaryExpressionAbsoluteHeading, holistic_fusion::GmsfUnaryExpressionAbsolutePose3, holistic_fusion::GmsfUnaryExpressionAbsolutePosition3, holistic_fusion::GmsfUnaryExpressionLandmark< GTSAM_MEASUREMENT_TYPE, CALIBRATION_CHAR >, holistic_fusion::GmsfUnaryExpressionLandmark< gtsam::Point3, 'd'>, and holistic_fusion::GmsfUnaryExpressionLocalVelocity3.
|
inlinevirtual |
Definition at line 110 of file GmsfUnaryExpression.h.
|
protectedpure virtual |
|
pure virtual |
|
inlinenodiscard |
Definition at line 118 of file GmsfUnaryExpression.h.
|
inline |
Definition at line 128 of file GmsfUnaryExpression.h.
|
inline |
Definition at line 123 of file GmsfUnaryExpression.h.
|
inlinenodiscard |
Definition at line 116 of file GmsfUnaryExpression.h.
|
inline |
Definition at line 121 of file GmsfUnaryExpression.h.
|
pure virtual |
|
inlinenodiscard |
Definition at line 133 of file GmsfUnaryExpression.h.
|
inlinenodiscard |
Definition at line 113 of file GmsfUnaryExpression.h.
|
protectedpure virtual |
Implemented in holistic_fusion::GmsfUnaryExpressionAbsolut< GTSAM_MEASUREMENT_TYPE, CALIBRATION_CHAR >, holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Point3, 'd'>, holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>, holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Rot2, 'c'>, holistic_fusion::GmsfUnaryExpressionLandmark< GTSAM_MEASUREMENT_TYPE, CALIBRATION_CHAR >, holistic_fusion::GmsfUnaryExpressionLandmark< gtsam::Point3, 'd'>, holistic_fusion::GmsfUnaryExpressionLocal< GTSAM_MEASUREMENT_TYPE, CALIBRATION_CHAR >, and holistic_fusion::GmsfUnaryExpressionLocal< gtsam::Point3, 'd'>.
|
protectedpure virtual |
|
protectedpure virtual |
Implemented in holistic_fusion::GmsfUnaryExpressionAbsolut< GTSAM_MEASUREMENT_TYPE, CALIBRATION_CHAR >, holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Point3, 'd'>, holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>, holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Rot2, 'c'>, holistic_fusion::GmsfUnaryExpressionLandmark< GTSAM_MEASUREMENT_TYPE, CALIBRATION_CHAR >, holistic_fusion::GmsfUnaryExpressionLandmark< gtsam::Point3, 'd'>, holistic_fusion::GmsfUnaryExpressionLocal< GTSAM_MEASUREMENT_TYPE, CALIBRATION_CHAR >, and holistic_fusion::GmsfUnaryExpressionLocal< gtsam::Point3, 'd'>.
|
inlineprotectedvirtual |
Reimplemented in holistic_fusion::GmsfUnaryExpressionAbsoluteHeading.
Definition at line 154 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 237 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 240 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 248 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 254 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 252 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 250 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 247 of file GmsfUnaryExpression.h.
|
protected |
Definition at line 243 of file GmsfUnaryExpression.h.