pathfinding 100% accurate, now needs small fixes