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

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