public void AddToConnected(MovementMeshNode c) { foreach (MovementMeshNode m in connected) { if (m.GetPosition() == c.GetPosition()) { return; } } connected.Add(c); }
private float Heuristic(MovementMeshNode s, MovementMeshNode f) { return(Vector2.Distance(s.GetPosition(), f.GetPosition())); }