Autonomous Navigation Toolkit