Merge branch 'feature/geometric_planning' into 'master'

3rdParty/rbdl/CMakeLists.txt

3rdParty/rbdl/examples/simple/CMakeLists.txt

CMakeLists.txt

CMakeModules/FindEigen3.cmake

CMakeModules/SimoxConfig.cmake.in

GeometricPlanning/ArticulatedObjectDoorHelper.cpp

GeometricPlanning/ArticulatedObjectDoorHelper.h

...tricPlanning/ArticulatedObjectGeometricPlanningHelper.cpp

GeometricPlanning/ArticulatedObjectGeometricPlanningHelper.h

GeometricPlanning/CMakeLists.txt

GeometricPlanning/ParametricPath.cpp

GeometricPlanning/ParametricPath.h

GeometricPlanning/assert/assert.h

GeometricPlanning/assert/doctest/assert.h

GeometricPlanning/assert/doctest/handler.cpp

GeometricPlanning/assert/doctest/impl.cpp

GeometricPlanning/assert/virtual_robot/assert.cpp

GeometricPlanning/assert/virtual_robot/assert.h

GeometricPlanning/path_primitives/Circle.cpp

GeometricPlanning/path_primitives/Circle.h