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

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