convert to cpp
parent
78ea90bb27
commit
e91a35453a
|
|
@ -13,9 +13,14 @@
|
||||||
* @date May 2021
|
* @date May 2021
|
||||||
*/
|
*/
|
||||||
|
|
||||||
|
#include <CppUnitLite/Test.h>
|
||||||
|
#include <CppUnitLite/TestHarness.h>
|
||||||
#include <gtsam/base/TestableAssertions.h>
|
#include <gtsam/base/TestableAssertions.h>
|
||||||
#include <gtsam/base/utilities.h>
|
#include <gtsam/base/utilities.h>
|
||||||
#include <gtsam/hybrid/HybridFactorGraph.h>
|
#include <gtsam/hybrid/HybridFactorGraph.h>
|
||||||
|
#include <gtsam/nonlinear/PriorFactor.h>
|
||||||
|
|
||||||
|
using namespace gtsam;
|
||||||
|
|
||||||
/* ****************************************************************************
|
/* ****************************************************************************
|
||||||
* Test that any linearizedFactorGraph gaussian factors are appended to the
|
* Test that any linearizedFactorGraph gaussian factors are appended to the
|
||||||
|
|
@ -37,6 +42,8 @@ TEST(HybridFactorGraph, GaussianFactorGraph) {
|
||||||
|
|
||||||
GaussianHybridFactorGraph ghfg = fg.linearize(linearizationPoint);
|
GaussianHybridFactorGraph ghfg = fg.linearize(linearizationPoint);
|
||||||
|
|
||||||
|
EXPECT_LONGS_EQUAL(ghfg);
|
||||||
|
|
||||||
// ghfg.push_back(ghfg.gaussianGraph().begin(), ghfg.gaussianGraph().end());
|
// ghfg.push_back(ghfg.gaussianGraph().begin(), ghfg.gaussianGraph().end());
|
||||||
|
|
||||||
// EXPECT_LONGS_EQUAL(2, dcmfg.gaussianGraph().size());
|
// EXPECT_LONGS_EQUAL(2, dcmfg.gaussianGraph().size());
|
||||||
Loading…
Reference in New Issue