[C++][CMake] Move URDF parser to the lib

CMakeLists.txt

src/CMakeLists.txt

src/parsers/urdf.hpp

src/parsers/urdf/geometry.cpp

src/parsers/urdf/model.cpp