Updated the AStar pathing algorithm

 - Allows the weight of the path node to influence it's choices