Add pathfinding cache

Removes game freezes due to pathfinding loops
by autonomous AI