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

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