First and yet buggy pathfinding
better but yet not optimal