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

This reverts commit a03f2b4dc46e62ad2fd3ff2c1f2fce100a2c4387.
Rebase from 'upstream' @ version '0.3.5'
Trimmed the branch to only the tf2_kdl sub directory