I think we should pass a PlanningScenePtr to the semantic world instead of the Transforms object. Then we can remove this version of the function.