48 lines
1.6 KiB
C++
48 lines
1.6 KiB
C++
/* ----------------------------------------------------------------------------
|
|
|
|
* GTSAM Copyright 2010, Georgia Tech Research Corporation,
|
|
* Atlanta, Georgia 30332-0415
|
|
* All Rights Reserved
|
|
* Authors: Frank Dellaert, et al. (see THANKS for the full author list)
|
|
|
|
* See LICENSE for the license information
|
|
|
|
* -------------------------------------------------------------------------- */
|
|
|
|
/**
|
|
* @file HybridGaussianFactor.cpp
|
|
* @date Mar 11, 2022
|
|
* @author Fan Jiang
|
|
*/
|
|
|
|
#include <gtsam/hybrid/HybridGaussianFactor.h>
|
|
|
|
#include <boost/make_shared.hpp>
|
|
|
|
namespace gtsam {
|
|
|
|
/* ************************************************************************* */
|
|
HybridGaussianFactor::HybridGaussianFactor(GaussianFactor::shared_ptr other)
|
|
: Base(other->keys()), inner_(other) {}
|
|
|
|
/* ************************************************************************* */
|
|
HybridGaussianFactor::HybridGaussianFactor(JacobianFactor &&jf)
|
|
: Base(jf.keys()),
|
|
inner_(boost::make_shared<JacobianFactor>(std::move(jf))) {}
|
|
|
|
/* ************************************************************************* */
|
|
bool HybridGaussianFactor::equals(const HybridFactor &other, double tol) const {
|
|
const This *e = dynamic_cast<const This *>(&other);
|
|
// TODO(Varun) How to compare inner_ when they are abstract types?
|
|
return e != nullptr && Base::equals(*e, tol);
|
|
}
|
|
|
|
/* ************************************************************************* */
|
|
void HybridGaussianFactor::print(const std::string &s,
|
|
const KeyFormatter &formatter) const {
|
|
HybridFactor::print(s, formatter);
|
|
inner_->print("inner: ", formatter);
|
|
};
|
|
|
|
} // namespace gtsam
|