System for tracking relative robot's position in environment and planning paths to navigate around obstacles.