Fix infinite recursion if pathing from same poly
Make initial _nav_data generation code more readable and use None instead of -1 to indicate no next step (this caused bugs)
Return None if path is not solvable
Merge branch 'master' into cython