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

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