A compact, lightweight and energy efficient system for autonomous navigation based on 3D vision