Robust 3D Vision for Autonomous Robots