#include <ompl/util/Exception.h>
#include <ompl/base/spaces/RealVectorStateSpace.h>
#include <or_lemur/SemiTorusStateSpace.h>