Improved pathfinding
Merge pull request #72 from lenis0012/master

Improved pathfinding