convert to cpp

release/4.3a0
Varun Agrawal 2022-05-28 20:44:30 -04:00
parent 78ea90bb27
commit e91a35453a
1 changed files with 7 additions and 0 deletions

View File

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