Improve pathfinding refresh
Prevent diagonal turns around obstacles