added navigation psudocode. point-to-point navigation