Tweaking the Planner
Began modifying the Navigator so that it can meet real time constraints