Minor non-functional changes to KDL

This PR does not change any functionality and does not depend on any other commits. 

* Removes direct dependency on tip_frame_ from KDL since it is deprecated, instead uses getTipFrame()
* Namespaces a lot of debug output