AStar fixed, it will now pick diagonal ways correctly.