Beispiel #1
0
        public double  Dijkstra(TriMesh.Vertex source, TriMesh.Vertex destination)
        {
            List<TriMesh.Vertex> S = new List<TriMesh.Vertex>();//以求出最短路径的点的集合
            List<TriMesh.Vertex> T = new List<TriMesh.Vertex>();//未求出最短路径的点的集合


            double minDistance=0;
            PathD[] minPath = new PathD[mesh.Vertices.Count];//每个点的最短路径过程
            for (int i = 0; i < mesh.Vertices.Count; i++)
            {
                minPath[i] = new PathD();
            }

            #region STEP1 初始化两组点的集合
            S.Add(source);
            minPath[source.Index].path=0;
            minPath[source.Index].vertex = source;
            minPath[source.Index].pathNumber.Add(source.Index);
            for (int i = 0; i < mesh.Vertices.Count; i++)
            {
                if (mesh.Vertices[i] != source)
                {
                    T.Add(mesh.Vertices[i]);
                    minPath[mesh.Vertices[i].Index].path = double.MaxValue;
                    minPath[mesh.Vertices[i].Index].vertex = mesh.Vertices[i]; 
                }
            }
            int count = 0;
            foreach (TriMesh.Vertex vertex in source.Vertices)
            {
                if (vertex == destination)
                { 
                    return minDistance =TriMeshUtil.ComputeEdgeLength(source.FindEdgeTo(vertex));
                }
                count++;
                if (count == source.VertexCount)
                {
                    minDistance = double.MaxValue;
                }
                
            }
            #endregion

            #region STEP2 遍历所有点,计算source到destination的最短路径的点的集合
            while (true)
            {
                for (int i = 0; i < S.Count; i++)
                {
                    foreach (TriMesh.Vertex v in S[i].Vertices)
                    {
                        for (int j = 0; j < T.Count; j++)
                        {
                            if (T[j] == v)
                            {
                                if (S.Contains(T[j]) == true)
                                    continue;
                                if (TriMeshUtil.ComputeEdgeLength(S[i].FindEdgeTo(T[j])) < minPath[T[j].Index].path)
                                {
                                    minPath[T[j].Index].path = TriMeshUtil.ComputeEdgeLength(S[i].FindEdgeTo(T[j]));
                                    
                                    minPath[T[j].Index].pathNumber.Clear();
                                    for (int k = 0; k < minPath[S[i].Index].pathNumber.Count; k++)
                                    {
                                        minPath[T[j].Index].pathNumber.Add(minPath[S[i].Index].pathNumber[k]);
                                    }
                                    minPath[T[j].Index].pathNumber.Add(T[j].Index);
                                    S.Add(T[j]);
                                   
                                }
                            }
                        }
                    }
                }


                if (S.Count == mesh.Vertices.Count)
                    break;
            }
            #endregion

            #region 计算出最短路径以及为最短路径染色
            minDistance = 0;
            for (int i = 0; i < minPath[destination.Index].pathNumber.Count-1; i++)
            {
                minDistance += TriMeshUtil.ComputeEdgeLength(mesh.Vertices[minPath[destination.Index].pathNumber[i]].FindEdgeTo(
                    mesh.Vertices[minPath[destination.Index].pathNumber[i + 1]]));
            }
            for (int i = 0; i < minPath[destination.Index].pathNumber.Count-1; i++)
            {
              
                mesh.Vertices[minPath[destination.Index].pathNumber[i]].FindEdgeTo(mesh.Vertices[minPath[destination.Index].pathNumber[i + 1]]).Traits.SelectedFlag = 1;
            }
            #endregion

            return minDistance;
        }
Beispiel #2
0
        public double  Dijkstra(TriMesh.Vertex source, TriMesh.Vertex destination)
        {
            List <TriMesh.Vertex> S = new List <TriMesh.Vertex>(); //以求出最短路径的点的集合
            List <TriMesh.Vertex> T = new List <TriMesh.Vertex>(); //未求出最短路径的点的集合


            double minDistance = 0;

            PathD[] minPath = new PathD[mesh.Vertices.Count];//每个点的最短路径过程
            for (int i = 0; i < mesh.Vertices.Count; i++)
            {
                minPath[i] = new PathD();
            }

            #region STEP1 初始化两组点的集合
            S.Add(source);
            minPath[source.Index].path   = 0;
            minPath[source.Index].vertex = source;
            minPath[source.Index].pathNumber.Add(source.Index);
            for (int i = 0; i < mesh.Vertices.Count; i++)
            {
                if (mesh.Vertices[i] != source)
                {
                    T.Add(mesh.Vertices[i]);
                    minPath[mesh.Vertices[i].Index].path   = double.MaxValue;
                    minPath[mesh.Vertices[i].Index].vertex = mesh.Vertices[i];
                }
            }
            int count = 0;
            foreach (TriMesh.Vertex vertex in source.Vertices)
            {
                if (vertex == destination)
                {
                    return(minDistance = TriMeshUtil.ComputeEdgeLength(source.FindEdgeTo(vertex)));
                }
                count++;
                if (count == source.VertexCount)
                {
                    minDistance = double.MaxValue;
                }
            }
            #endregion

            #region STEP2 遍历所有点,计算source到destination的最短路径的点的集合
            while (true)
            {
                for (int i = 0; i < S.Count; i++)
                {
                    foreach (TriMesh.Vertex v in S[i].Vertices)
                    {
                        for (int j = 0; j < T.Count; j++)
                        {
                            if (T[j] == v)
                            {
                                if (S.Contains(T[j]) == true)
                                {
                                    continue;
                                }
                                if (TriMeshUtil.ComputeEdgeLength(S[i].FindEdgeTo(T[j])) < minPath[T[j].Index].path)
                                {
                                    minPath[T[j].Index].path = TriMeshUtil.ComputeEdgeLength(S[i].FindEdgeTo(T[j]));

                                    minPath[T[j].Index].pathNumber.Clear();
                                    for (int k = 0; k < minPath[S[i].Index].pathNumber.Count; k++)
                                    {
                                        minPath[T[j].Index].pathNumber.Add(minPath[S[i].Index].pathNumber[k]);
                                    }
                                    minPath[T[j].Index].pathNumber.Add(T[j].Index);
                                    S.Add(T[j]);
                                }
                            }
                        }
                    }
                }


                if (S.Count == mesh.Vertices.Count)
                {
                    break;
                }
            }
            #endregion

            #region 计算出最短路径以及为最短路径染色
            minDistance = 0;
            for (int i = 0; i < minPath[destination.Index].pathNumber.Count - 1; i++)
            {
                minDistance += TriMeshUtil.ComputeEdgeLength(mesh.Vertices[minPath[destination.Index].pathNumber[i]].FindEdgeTo(
                                                                 mesh.Vertices[minPath[destination.Index].pathNumber[i + 1]]));
            }
            for (int i = 0; i < minPath[destination.Index].pathNumber.Count - 1; i++)
            {
                mesh.Vertices[minPath[destination.Index].pathNumber[i]].FindEdgeTo(mesh.Vertices[minPath[destination.Index].pathNumber[i + 1]]).Traits.SelectedFlag = 1;
            }
            #endregion

            return(minDistance);
        }