private void CalcTotalF(PathNode thisNode, Vector2 PreVector2, Vector2 goalPos) { if (thisNode.ParentNode != null) { thisNode.StartG = getNodeByPostion(PreVector2).StartG + PathNode.CalcEndH(thisNode.Position, PreVector2); } thisNode.EndH = PathNode.CalcEndH(thisNode.Position, goalPos); }