fixed bug with Path navigation where certain angle (straight down and up) is
intepreted as same.
tests pass
implemented nav, save for endpoints to voice.