12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

HybridNonlinearFactor linearize method

release/4.3a0
Varun Agrawal 2022-05-29 13:33:04 -04:00
parent cdd030b88b
commit 08fab8a936
1 changed files with 6 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

6
gtsam/hybrid/HybridNonlinearFactor.h
View File

@ -18,6 +18,7 @@
#pragma once #pragma once
#include <gtsam/hybrid/HybridFactor.h> #include <gtsam/hybrid/HybridFactor.h>
#include <gtsam/hybrid/HybridGaussianFactor.h>
#include <gtsam/nonlinear/NonlinearFactor.h> #include <gtsam/nonlinear/NonlinearFactor.h>
namespace gtsam { namespace gtsam {
@ -53,5 +54,10 @@ class HybridNonlinearFactor : public HybridFactor {
/// @} /// @}
NonlinearFactor::shared_ptr inner() const { return inner_; } NonlinearFactor::shared_ptr inner() const { return inner_; }
/// Linearize to a HybridGaussianFactor at the linearization point `c`.
boost::shared_ptr<HybridGaussianFactor> linearize(const Values &c) const {
return boost::make_shared<HybridGaussianFactor>(inner_->linearize(c));
}
}; };
} // namespace gtsam } // namespace gtsam