Enhancements for skeleton/finger tf frame publishing as well as code cleanup