Try to speed up pathfinding

[ioan-chera]

Right now it can take a long while to determine a path and is especially annoying in coop mode where everyone is slowed down. Need to optimize it.