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

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