Increase algoritm speed and threading fix#13

Ceeeeed wants to merge 1 commit intoSebLague:masterSebLague/Pathfinding:masterfrom

Ceeeeed:increase-algorithm-speedCeeeeed/Pathfinding:increase-algorithm-speedCopy head branch name to clipboard