New pathfinding
Merge pull request #1 from whs/master

New pathfinding