private int manhattanDistance(MyAbstractGraph <INode, IEdge> i_Graph, MyUnityNode i_currentNode, MyUnityNode i_TargetNode) { UnityEngine.Vector3 n1 = i_currentNode.Position; UnityEngine.Vector3 n2 = i_TargetNode.Position; return((int)(Math.Abs(n1.x - n2.x) + Math.Abs(n1.y - n2.y) + Math.Abs(n1.z - n2.z))); }
private int aStartHeuristic(MyAbstractGraph <INode, IEdge> i_Graph, MyUnityNode i_currentNode, MyUnityNode i_TargetNode) { return((int)UnityEngine.Vector3.Distance(i_currentNode.Position, i_TargetNode.Position)); }