Implementation of Refactored Navigator
The Navigator can now be refactored after the intersection method has been updated, this should make an easier starting ground to move it into an FSM as described in #573 (closed)
The Navigator can now be refactored after the intersection method has been updated, this should make an easier starting ground to move it into an FSM as described in #573 (closed)