improve path finding (added build4Dirs + keep same direction in getPath)