Fixed pathfinding, moves way too fast

Pathfinding now sorta works, still moves too fast and can't jump