[C++] Added geometry structure through fcl

CMakeLists.txt

src/CMakeLists.txt

src/algorithm/kinematics.hpp

src/multibody/geometry.hpp

src/spatial/fcl-pinocchio-conversions.hpp

src/spatial/se3.hpp