void NotFoundNode(AStarNode tempStart, AStarNode end, AStarNode node)
{
node.ParentNode = tempStart;
node.G = CalcG(tempStart, node);
node.H = CalcH(end, node);
node.CalcF();
OpenList.Add(node);
}
void FoundNode(AStarNode tempStart, AStarNode node)
{
int G = CalcG(tempStart, node);
if (G < node.G)
{
node.ParentNode = tempStart;
node.G = G;
node.CalcF();
}
}