expose some iSAM2/FixedLagSmoothing functionality for the bindings

release/4.3a0
senselessDev 2022-01-22 15:35:53 +01:00
parent a2caa0caf7
commit 0814efafd7
3 changed files with 16 additions and 0 deletions

View File

@ -313,6 +313,10 @@ struct GTSAM_EXPORT ISAM2Params {
return enablePartialRelinearizationCheck;
}
bool isFindUnusedFactorSlots() const {
return findUnusedFactorSlots;
}
void setOptimizationParams(OptimizationParams optimizationParams) {
this->optimizationParams = optimizationParams;
}
@ -344,6 +348,9 @@ struct GTSAM_EXPORT ISAM2Params {
bool enablePartialRelinearizationCheck) {
this->enablePartialRelinearizationCheck = enablePartialRelinearizationCheck;
}
void setFindUnusedFactorSlots(bool findUnusedFactorSlots) {
this->findUnusedFactorSlots = findUnusedFactorSlots;
}
GaussianFactorGraph::Eliminate getEliminationFunction() const {
return factorization == CHOLESKY

View File

@ -696,6 +696,9 @@ class ISAM2Params {
bool isEnablePartialRelinearizationCheck() const;
void setEnablePartialRelinearizationCheck(
bool enablePartialRelinearizationCheck);
bool isFindUnusedFactorSlots() const;
void setFindUnusedFactorSlots(bool findUnusedFactorSlots);
};
class ISAM2Clique {

View File

@ -567,6 +567,10 @@ virtual class FixedLagSmoother {
double smootherLag() const;
gtsam::FixedLagSmootherResult update(const gtsam::NonlinearFactorGraph& newFactors, const gtsam::Values& newTheta, const gtsam::FixedLagSmootherKeyTimestampMap& timestamps);
gtsam::FixedLagSmootherResult update(const gtsam::NonlinearFactorGraph &newFactors,
const gtsam::Values &newTheta,
const gtsam::FixedLagSmootherKeyTimestampMap &timestamps,
const gtsam::FactorIndices &factorsToRemove);
gtsam::Values calculateEstimate() const;
};
@ -590,6 +594,8 @@ virtual class IncrementalFixedLagSmoother : gtsam::FixedLagSmoother {
IncrementalFixedLagSmoother(double smootherLag, const gtsam::ISAM2Params& params);
gtsam::ISAM2Params params() const;
gtsam::NonlinearFactorGraph getFactors() const;
};
#include <gtsam_unstable/nonlinear/ConcurrentFilteringAndSmoothing.h>