My Project 1.0
Holistic Fusion: A Generic Framework for Multimodal Sensor Fusion
Loading...
Searching...
No Matches
holistic_fusion::GmsfUnaryExpressionAbsolutePose3 Class Referencefinal

#include <GmsfUnaryExpressionAbsolutePose3.h>

Inheritance diagram for holistic_fusion::GmsfUnaryExpressionAbsolutePose3:
Inheritance graph
[legend]
Collaboration diagram for holistic_fusion::GmsfUnaryExpressionAbsolutePose3:
Collaboration graph
[legend]

Public Member Functions

 GmsfUnaryExpressionAbsolutePose3 (const std::shared_ptr< GMSF_MEASUREMENT_CLASS > poseUnaryMeasurementPtr, const std::string &imuFrameName, const Eigen::Isometry3d &T_I_sensorFrame, const double createReferenceAlignmentKeyframeEveryNSeconds)
 ~GmsfUnaryExpressionAbsolutePose3 ()=default
const gtsam::Pose3 getGtsamMeasurementValue () const final
const gtsam::Vector getNoiseDensity () const final
Public Member Functions inherited from holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>
 GmsfUnaryExpressionAbsolut (const std::shared_ptr< UnaryMeasurementAbsolute > &gmsfUnaryAbsoluteMeasurementPtr, const std::string &imuFrameName, const Eigen::Isometry3d &T_I_sensorFrame, const double createReferenceAlignmentKeyframeEveryNSeconds)
 ~GmsfUnaryExpressionAbsolut ()=default
Public Member Functions inherited from holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >
 GmsfUnaryExpression (const std::shared_ptr< UnaryMeasurement > &gmsfBaseUnaryMeasurementPtr, const std::string &imuFrameName, const Eigen::Isometry3d &T_I_sensorFrame)
 ~GmsfUnaryExpression ()=default
gtsam::Expression< gtsam::Pose3 > createAndReturnExpression (const gtsam::Key &closestGeneralKey, DynamicDictionaryContainer &gtsamDynamicExpressionKeys, const gtsam::NavState &W_imuPropagatedState, const bool optimizeReferenceFramePosesWrtWorldFlag, const bool centerMeasurementsAtKeyframePositionBeforeAlignmentFlag, const bool optimizeExtrinsicSensorToSensorCorrectedOffsetFlag)
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::Pose3 > > & getNewOnlineDynamicPriorFactors () const
const std::vector< gtsam::BetweenFactor< gtsam::Pose3 > > & getNewOnlineAndOfflinePoseBetweenFactors () const
const Eigen::Isometry3d & getT_I_sensorFrameInit () const

Protected Member Functions

void generateImuStateInWorldFrameAtKey (const gtsam::Key &closestGeneralKey) final
gtsam::Pose3 computeT_W_fixedFrame_initial (const gtsam::NavState &W_currentPropagatedState) final
bool measuresPosition () const final
const Eigen::Vector3d getMeasurementPosition () final
void setMeasurementPosition (const Eigen::Vector3d &position) final
void transformStateToReferenceFrameMeasurement (const gtsam::Pose3_ &exp_T_W_fixedFrame) override
void transformImuStateToSensorFrameState () final
void applyExtrinsicCalibrationCorrection (const gtsam::Pose3_ &expt_T_sensorFrame_sensorFrameCorrect) final
gtsam::Pose3 convertToPose3 (const gtsam::Pose3 &measurement) final
gtsam::Pose3 convertFromPose3 (const gtsam::Pose3 &measurement) final
const gtsam::Expression< gtsam::Pose3 > getGtsamExpression () const final
Protected Member Functions inherited from holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>
void transformImuStateFromWorldToReferenceFrame (DynamicDictionaryContainer &gtsamDynamicExpressionKeys, const gtsam::NavState &W_currentPropagatedState, const bool centerMeasurementsAtKeyframePositionBeforeAlignmentFlag) final
void transformLandmarkInWorldToImuFrame (DynamicDictionaryContainer &gtsamDynamicExpressionKeys, const gtsam::NavState &W_currentPropagatedState) final
Protected Member Functions inherited from holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >
virtual void transformSensorFrameStateToSensorFrameCorrectedState (DynamicDictionaryContainer &gtsamDynamicExpressionKeys)
virtual void applyExtrinsicCalibrationCorrection (const gtsam::Expression< gtsam::Pose3 > &exp_C_sensorFrame_sensorFrameCorrected)=0

Private Attributes

std::shared_ptr< GMSF_MEASUREMENT_CLASS > gmsfPoseUnaryMeasurementPtr_
gtsam::Expression< gtsam::Pose3 > exp_T_fixedFrame_sensorFrame_

Additional Inherited Members

Public Types inherited from holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >
using template_type
Protected Attributes inherited from holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >
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::Pose3 > > newOnlineDynamicPriorFactors_
std::vector< gtsam::BetweenFactor< gtsam::Pose3 > > newOnlineAndOfflinePoseBetweenFactors_

Detailed Description

Definition at line 24 of file GmsfUnaryExpressionAbsolutePose3.h.

Constructor & Destructor Documentation

◆ GmsfUnaryExpressionAbsolutePose3()

holistic_fusion::GmsfUnaryExpressionAbsolutePose3::GmsfUnaryExpressionAbsolutePose3 ( const std::shared_ptr< GMSF_MEASUREMENT_CLASS > poseUnaryMeasurementPtr,
const std::string & imuFrameName,
const Eigen::Isometry3d & T_I_sensorFrame,
const double createReferenceAlignmentKeyframeEveryNSeconds )
inline

Definition at line 27 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ ~GmsfUnaryExpressionAbsolutePose3()

holistic_fusion::GmsfUnaryExpressionAbsolutePose3::~GmsfUnaryExpressionAbsolutePose3 ( )
default

Member Function Documentation

◆ applyExtrinsicCalibrationCorrection()

void holistic_fusion::GmsfUnaryExpressionAbsolutePose3::applyExtrinsicCalibrationCorrection ( const gtsam::Pose3_ & expt_T_sensorFrame_sensorFrameCorrect)
inlinefinalprotected

Definition at line 84 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ computeT_W_fixedFrame_initial()

gtsam::Pose3 holistic_fusion::GmsfUnaryExpressionAbsolutePose3::computeT_W_fixedFrame_initial ( const gtsam::NavState & W_currentPropagatedState)
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>.

Definition at line 53 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ convertFromPose3()

gtsam::Pose3 holistic_fusion::GmsfUnaryExpressionAbsolutePose3::convertFromPose3 ( const gtsam::Pose3 & measurement)
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >.

Definition at line 92 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ convertToPose3()

gtsam::Pose3 holistic_fusion::GmsfUnaryExpressionAbsolutePose3::convertToPose3 ( const gtsam::Pose3 & measurement)
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >.

Definition at line 90 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ generateImuStateInWorldFrameAtKey()

void holistic_fusion::GmsfUnaryExpressionAbsolutePose3::generateImuStateInWorldFrameAtKey ( const gtsam::Key & closestGeneralKey)
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >.

Definition at line 47 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ getGtsamExpression()

const gtsam::Expression< gtsam::Pose3 > holistic_fusion::GmsfUnaryExpressionAbsolutePose3::getGtsamExpression ( ) const
inlinenodiscardfinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >.

Definition at line 95 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ getGtsamMeasurementValue()

const gtsam::Pose3 holistic_fusion::GmsfUnaryExpressionAbsolutePose3::getGtsamMeasurementValue ( ) const
inlinenodiscardfinalvirtual

Implements holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >.

Definition at line 38 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ getMeasurementPosition()

const Eigen::Vector3d holistic_fusion::GmsfUnaryExpressionAbsolutePose3::getMeasurementPosition ( )
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>.

Definition at line 61 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ getNoiseDensity()

const gtsam::Vector holistic_fusion::GmsfUnaryExpressionAbsolutePose3::getNoiseDensity ( ) const
inlinenodiscardfinalvirtual

Implements holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >.

Definition at line 43 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ measuresPosition()

bool holistic_fusion::GmsfUnaryExpressionAbsolutePose3::measuresPosition ( ) const
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>.

Definition at line 59 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ setMeasurementPosition()

void holistic_fusion::GmsfUnaryExpressionAbsolutePose3::setMeasurementPosition ( const Eigen::Vector3d & position)
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>.

Definition at line 66 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ transformImuStateToSensorFrameState()

void holistic_fusion::GmsfUnaryExpressionAbsolutePose3::transformImuStateToSensorFrameState ( )
inlinefinalprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpression< gtsam::Pose3, UnaryExpressionType::Absolute, CALIBRATION_CHAR >.

Definition at line 78 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ transformStateToReferenceFrameMeasurement()

void holistic_fusion::GmsfUnaryExpressionAbsolutePose3::transformStateToReferenceFrameMeasurement ( const gtsam::Pose3_ & exp_T_W_fixedFrame)
inlineoverrideprotectedvirtual

Implements holistic_fusion::GmsfUnaryExpressionAbsolut< gtsam::Pose3, 'c'>.

Definition at line 71 of file GmsfUnaryExpressionAbsolutePose3.h.

Member Data Documentation

◆ exp_T_fixedFrame_sensorFrame_

gtsam::Expression<gtsam::Pose3> holistic_fusion::GmsfUnaryExpressionAbsolutePose3::exp_T_fixedFrame_sensorFrame_
private

Definition at line 102 of file GmsfUnaryExpressionAbsolutePose3.h.

◆ gmsfPoseUnaryMeasurementPtr_

std::shared_ptr<GMSF_MEASUREMENT_CLASS> holistic_fusion::GmsfUnaryExpressionAbsolutePose3::gmsfPoseUnaryMeasurementPtr_
private

Definition at line 99 of file GmsfUnaryExpressionAbsolutePose3.h.

The documentation for this class was generated from the following file: