Fixed error in pathfinding, added moving on WSAD