Merged developing to master
Improved pathfinding drastically.