diff --git a/src/landmark/landmark_base.cpp b/src/landmark/landmark_base.cpp index 3da95fb8d36b218b1f91d10ce409638f256ab1ae..7f360a1962c480ac1565c44fb6378222360f09d7 100644 --- a/src/landmark/landmark_base.cpp +++ b/src/landmark/landmark_base.cpp @@ -3,6 +3,7 @@ #include "core/factor/factor_base.h" #include "core/map/map_base.h" #include "core/state_block/state_block.h" +#include "core/state_block/state_angle.h" #include "core/state_block/state_quaternion.h" #include "core/common/factory.h" #include "core/yaml/yaml_conversion.h" @@ -216,7 +217,7 @@ LandmarkBasePtr LandmarkBase::create(const YAML::Node& _node) if (ori.size() == 4) ori_sb = std::make_shared<StateQuaternion>(ori, ori_fixed); else - ori_sb = std::make_shared<StateBlock>(ori, ori_fixed); + ori_sb = std::make_shared<StateAngle>(ori(0), ori_fixed); } LandmarkBasePtr lmk = std::make_shared<LandmarkBase>("BASE", pos_sb, ori_sb); @@ -228,7 +229,7 @@ LandmarkBasePtr LandmarkBase::create(const YAML::Node& _node) // Register landmark creator namespace { -const bool WOLF_UNUSED registered_lmk_ahp = LandmarkFactory::get().registerCreator("BASE", LandmarkBase::create); +const bool WOLF_UNUSED registered_lmk_base = LandmarkFactory::get().registerCreator("BASE", LandmarkBase::create); } } // namespace wolf