Clean up one function inside of the URDF loader