Foundations of Autonomous Navigation and Motion Planning