diff --git a/test/gtest_factory_state_block.cpp b/test/gtest_factory_state_block.cpp index 009db5910d48b280cb34ac9b78ed772f3ce46ea7..a915b061e96fd8f57bdea029981967cd3f3b28a0 100644 --- a/test/gtest_factory_state_block.cpp +++ b/test/gtest_factory_state_block.cpp @@ -68,13 +68,17 @@ TEST(FactoryStateBlock, creator_default) TEST(FactoryStateBlock, creator_StateBlock) { auto sbp = FactoryStateBlock::get().create("StateBlock", Eigen::Vector3d(1,2,3), false); - auto sbv = FactoryStateBlock::get().create("StateBlock", Eigen::Vector2d(4,5), false); + auto sbv = FactoryStateBlock::get().create("StateBlock", Eigen::Vector2d(4,5), true); auto sbw = FactoryStateBlock::get().create("StateBlock", Eigen::Vector1d(6), false); ASSERT_MATRIX_APPROX(Eigen::Vector3d(1,2,3) , sbp->getState(), 1e-20); ASSERT_MATRIX_APPROX(Eigen::Vector2d(4,5) , sbv->getState(), 1e-20); ASSERT_MATRIX_APPROX(Eigen::Vector1d(6) , sbw->getState(), 1e-20); + ASSERT_FALSE(sbp->isFixed()); + ASSERT_TRUE (sbv->isFixed()); + ASSERT_FALSE(sbw->isFixed()); + ASSERT_FALSE(sbp->hasLocalParametrization()); ASSERT_FALSE(sbv->hasLocalParametrization()); ASSERT_FALSE(sbw->hasLocalParametrization());