Bug fix in urdf sensor loading