Motion planning and geometric reasoning C++ library based on libmove3d