コード例 #1
0
        /// <summary>
        /// Calculates the best path from a list of <see cref="Vector3"/>.
        /// </summary>
        /// <param name="input"><see cref="Vector3"/> list that contains the vectors to calculate the best path.</param>
        /// <param name="start">Index of the start vector of the path.</param>
        /// <param name="cost">Returns the cost of the path.</param>
        /// <returns>Returns a <see cref="List{T}"/> of <see cref="int"/> with the sorted indexes.</returns>
        public static List <int> CalculatePath(IEnumerable <Vector3> input, int start, out float cost)
        {
            NNVector[] vectors = input.Select((e, i) => new NNVector(i, e)).ToArray();
            int        current = start;
            var        path    = new List <int>();
            int        visited = 0;

            Action setCurrentVisited = () =>
            {
                vectors[current].isVisited = true;
                visited++;
            };

            Func <float> findNext = () =>
            {
                int   local    = current;
                float distance = float.NaN;

                for (int i = 0; i < vectors.Length; i++)
                {
                    if (!vectors[i].isVisited)
                    {
                        float d = NNVector.Distance(vectors[current], vectors[i]);
                        if (float.IsNaN(distance) || d < distance)
                        {
                            local    = i;
                            distance = d;
                        }
                    }
                }

                current = local;
                path.Add(current);
                setCurrentVisited();

                return(distance);
            };

            cost = 0f;
            path.Add(current);
            setCurrentVisited();

            do
            {
                cost += findNext();
            } while (visited < vectors.Length);

            return(path);
        }
コード例 #2
0
 public static float Distance(NNVector a, NNVector b)
 {
     return(Vector3.Distance(a.vector, b.vector));
 }