Revert "Trimmed the branch to only the orocos_kdl sub directory"

This reverts commit 7640d03565f886a6a7c17ba5a2368ed106b63000.
Rebase from 'upstream'
Trimmed the branch to only the orocos_kdl sub directory