Added proper interface to KDL::CoDyCo::Traversal class