Comparison and fusion of vision and range measurements for robot pose estimation