diff --git a/gtsam/linear/tests/testHessianFactorUnordered.cpp b/gtsam/linear/tests/testHessianFactorUnordered.cpp index 0df621688..9cd18c974 100644 --- a/gtsam/linear/tests/testHessianFactorUnordered.cpp +++ b/gtsam/linear/tests/testHessianFactorUnordered.cpp @@ -467,10 +467,10 @@ TEST(HessianFactor, hessianDiagonal) EXPECT(assert_equal(expected, factor.hessianDiagonal())); // hessianBlockDiagonal - map expectedBD; - expected.insert(make_pair(0,G11)); - expected.insert(make_pair(1,G22)); - //EXPECT(assert_equal(expectedBD, factor.hessianBlockDiagonal())); + map actualBD = factor.hessianBlockDiagonal(); + LONGS_EQUAL(2,actualBD.size()); + EXPECT(assert_equal(G11,actualBD[0])); + EXPECT(assert_equal(G22,actualBD[1])); } /* ************************************************************************* */