Updated pathfinding algorithm for improve the performance. TODO: Fix deadlock when an Mob goes in contrary sense to another one