| addFactorSafelyToRtAndBatchGraph_(const gtsam::NoiseModelFactor *noiseModelFactorPtr, double measurementTimestamp) | holistic_fusion::GraphManager | private |
| addFactorsToBatchSmootherAndOptimize(const gtsam::NonlinearFactorGraph &newBatchGraphFactors, const gtsam::Values &newBatchGraphValues, const std::map< gtsam::Key, double > &newBatchGraphKeysTimestampsMap, const std::shared_ptr< GraphConfig > &graphConfigPtr) | holistic_fusion::GraphManager | private |
| addFactorsToRtSmootherAndOptimize(const gtsam::NonlinearFactorGraph &newRtGraphFactors, const gtsam::Values &newRtGraphValues, const std::map< gtsam::Key, double > &newRtGraphKeysTimestampsMap, const std::shared_ptr< GraphConfig > &graphConfigPtr, const int additionalIterations) | holistic_fusion::GraphManager | private |
| addFactorToRtAndBatchGraph_(const gtsam::NoiseModelFactor *noiseModelFactorPtr, const bool addToOnlineSmootherFlag=true) | holistic_fusion::GraphManager | private |
| addFactorToRtAndBatchGraph_(const gtsam::NoiseModelFactor *noiseModelFactorPtr, double measurementTimestamp, const std::string &measurementName, const bool addToOnlineSmootherFlag=true) | holistic_fusion::GraphManager | private |
| addImuFactorAndGetState(SafeIntegratedNavState &returnPreIntegratedNavState, std::shared_ptr< SafeNavStateWithCovarianceAndBias > &newOptimizedNavStatePtr, const std::shared_ptr< ImuBuffer > &imuBufferPtr, double imuTimeK, bool createNewStateFlag) | holistic_fusion::GraphManager | |
| addPoseBetweenFactor(const gtsam::Pose3 &deltaPose, const Eigen::Matrix< double, 6, 1 > &poseBetweenNoiseDensity, double lidarTimeKm1, double lidarTimeK, double rate, const RobustNormEnum &robustNormEnum, const double robustNormConstant) | holistic_fusion::GraphManager | |
| addUnaryClassicFactor(const MEASUREMENT_TYPE &unaryMeasurement, const Eigen::Matrix< double, NOISE_DIM, 1 > &unaryNoiseDensity, double measurementTime, const FACTOR_ARGS &... factorArgs) | holistic_fusion::GraphManager | |
| addUnaryHolisticFactor(const std::shared_ptr< GMSF_EXPRESSION_TYPE > gmsfUnaryExpressionPtr, const bool addToOnlineSmootherFlag=true) | holistic_fusion::GraphManager | |
| batchFactorGraphBufferPtr_ | holistic_fusion::GraphManager | private |
| batchGraphKeysTimestampsMapBufferPtr_ | holistic_fusion::GraphManager | private |
| batchGraphValuesBufferPtr_ | holistic_fusion::GraphManager | private |
| batchOptimizerPtr_ | holistic_fusion::GraphManager | private |
| calculateNavStateAtGeneralKey(bool &computeSuccessfulFlag, std::shared_ptr< holistic_fusion::OptimizerBase > graphPtr, const gtsam::Key &generalKey, const char *callingFunctionName) | holistic_fusion::GraphManager | protectedstatic |
| calculatePoseCovarianceAtKeyInWorldFrame(std::shared_ptr< holistic_fusion::OptimizerBase > graphPtr, const gtsam::Key &graphKey, const char *callingFunctionName, std::optional< const gtsam::NavState > optionalNavState=std::nullopt) | holistic_fusion::GraphManager | protectedstatic |
| calculateStateAtGeneralKey(bool &computeSuccessfulFlag, const gtsam::Key &generalKey) | holistic_fusion::GraphManager | |
| extractBatchOptimizationResult_(const bool computePoseCovarianceFlag) | holistic_fusion::GraphManager | private |
| F typedef | holistic_fusion::GraphManager | |
| fileLogger_ | holistic_fusion::GraphManager | private |
| findGraphKeys_(gtsam::Key &closestKeyKm1, gtsam::Key &closestKeyK, double &keyTimeStampDistance, double maxTimestampDistance, double timeKm1, double timeK, const std::string &name) | holistic_fusion::GraphManager | private |
| getInitAccBiasReference() | holistic_fusion::GraphManager | inline |
| getInitGyrBiasReference() | holistic_fusion::GraphManager | inline |
| getOptimizedGraphState() | holistic_fusion::GraphManager | inline |
| getPropagatedStateKey() | holistic_fusion::GraphManager | inline |
| getUnaryFactorGeneralKey(gtsam::Key &returnedKey, double &returnedGraphTime, const UnaryMeasurement &unaryMeasurement) | holistic_fusion::GraphManager | |
| graphConfigPtr_ | holistic_fusion::GraphManager | private |
| GraphManager(std::shared_ptr< GraphConfig > graphConfigPtr, std::string imuFrame, std::string worldFrame) | holistic_fusion::GraphManager | |
| gtsamDynamicExpressionKeys_ | holistic_fusion::GraphManager | private |
| hasReferenceFrameKeyframe(const std::string &worldFrame, const std::string &fixedFrame) | holistic_fusion::GraphManager | |
| imuBiasPriorPtr_ | holistic_fusion::GraphManager | private |
| imuBufferPreintegratorPtr_ | holistic_fusion::GraphManager | private |
| imuFrame_ | holistic_fusion::GraphManager | private |
| imuParamsPtr_ | holistic_fusion::GraphManager | private |
| imuStepPreintegratorPtr_ | holistic_fusion::GraphManager | private |
| initImuIntegrators(double gravityValue) | holistic_fusion::GraphManager | |
| initPoseVelocityBiasGraph(double timeStamp, const gtsam::Pose3 &T_W_I0, const gtsam::Pose3 &T_O_I0, const gtsam::Vector3 &imuAngularVelocity) | holistic_fusion::GraphManager | |
| lastImuVector_ | holistic_fusion::GraphManager | private |
| lastOptimizedStateTime_ | holistic_fusion::GraphManager | private |
| latencyContainer_ | holistic_fusion::GraphManager | private |
| latencyEndTime_ | holistic_fusion::GraphManager | private |
| latencyStartTime_ | holistic_fusion::GraphManager | private |
| latestGraphStateKeyAngularVelocity_ | holistic_fusion::GraphManager | private |
| latestGraphStateKeyTime_ | holistic_fusion::GraphManager | private |
| logLatencyAndUpdateDuration(const std::string &savePath, const std::string &timeString) | holistic_fusion::GraphManager | |
| logRealTimeNavStates(const std::string &savePath, const std::string &timeString) | holistic_fusion::GraphManager | |
| logRealTimeReferenceFrameStates(const std::string &savePath, const std::string &timeString) | holistic_fusion::GraphManager | |
| newPropagatedStateKey_() | holistic_fusion::GraphManager | inlineprivate |
| O_imuPropagatedState_ | holistic_fusion::GraphManager | private |
| operateOnGraphDataMutex_ | holistic_fusion::GraphManager | private |
| optimizationRunningMutex_ | holistic_fusion::GraphManager | private |
| optimizedGraphState_ | holistic_fusion::GraphManager | private |
| optimizeSlowBatchSmoother(int maxIterations, const std::string &savePath, const bool saveCovarianceFlag) | holistic_fusion::GraphManager | |
| optimizeSlowBatchSmoother(int maxIterations, const bool computePoseCovarianceFlag) | holistic_fusion::GraphManager | |
| propagatedImuSampleTime_ | holistic_fusion::GraphManager | private |
| propagatedStateKey_ | holistic_fusion::GraphManager | private |
| realTimeOdomPoseContainer_ | holistic_fusion::GraphManager | private |
| realTimeReferenceFrameContainer_ | holistic_fusion::GraphManager | private |
| realTimeReferenceFrameNamePairs_ | holistic_fusion::GraphManager | private |
| realTimeWorldPoseContainer_ | holistic_fusion::GraphManager | private |
| rtFactorGraphBufferPtr_ | holistic_fusion::GraphManager | private |
| rtGraphKeysTimestampsMapBufferPtr_ | holistic_fusion::GraphManager | private |
| rtGraphValuesBufferPtr_ | holistic_fusion::GraphManager | private |
| rtOptimizerPtr_ | holistic_fusion::GraphManager | private |
| runSlowBatchSmootherOptimization_(int maxIterations) | holistic_fusion::GraphManager | private |
| saveOptimizedGraphToG2o(const OptimizerBase &optimizedGraph, const gtsam::Values &optimizedValues, const std::string &saveFileName) | holistic_fusion::GraphManager | static |
| saveOptimizedValuesToFile(const gtsam::Values &optimizedValues, const std::map< gtsam::Key, double > &keyTimestampMap, const std::string &savePath, const bool saveCovarianceFlag) | holistic_fusion::GraphManager | |
| setInitialWorldFrameToFixedFrameTransform(const Eigen::Isometry3d &T_W_F, const std::string &fixedFrame) | holistic_fusion::GraphManager | |
| T_W_O_ | holistic_fusion::GraphManager | private |
| timeToKeyBufferPtr_ | holistic_fusion::GraphManager | private |
| updateDurationContainer_ | holistic_fusion::GraphManager | private |
| updateDurationEndTime_ | holistic_fusion::GraphManager | private |
| updateDurationStartTime_ | holistic_fusion::GraphManager | private |
| updateGraph() | holistic_fusion::GraphManager | |
| updateImuIntegrators_(const TimeToImuMap &imuMeas) | holistic_fusion::GraphManager | private |
| W_imuPropagatedState_ | holistic_fusion::GraphManager | private |
| worldFrame_ | holistic_fusion::GraphManager | private |
| writeKeyToKeyTimeStampMap_(const gtsam::Key &key, double measurementTime, std::shared_ptr< std::map< gtsam::Key, double > > keyTimestampMapPtr) | holistic_fusion::GraphManager | inlineprivate |
| writeValueKeysToKeyTimeStampMap_(const gtsam::Values &values, double measurementTime, std::shared_ptr< std::map< gtsam::Key, double > > keyTimestampMapPtr) | holistic_fusion::GraphManager | private |
| ~GraphManager() | holistic_fusion::GraphManager | inline |