A-Star now detects diagonal path nodes. Still to do: jumping and checking for grounding.
Update
Update
Pathfinding now fully working