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

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