|
#include "KinematicSelfLocalization.h"
#include <Eigen/Geometry>
#include <SimoxUtility/math/convert/rpy_to_mat3f.h>
#include "RobotAPI/libraries/core/FramedPose.h"
#include <RobotAPI/interface/core/GeometryBase.h>
#include <MemoryX/libraries/memorytypes/entity/AgentInstance.h>
#include <MemoryX/core/MemoryXCoreObjectFactories.h>