度约束2的最小生成树算法实现

private IList<IPoint> Prim(IList<IPoint> tmp)
        {
            int[] Deg = new int[Max]; double[,] G = new double[Max, Max]; bool[,] path = new bool[Max, Max];
            int n = tmp.Count(); double MaxDis = 0.0;
            G = new double[n, n]; path = new bool[n, n];
            Deg = new int[n];
            for (int i = 0; i < n; i++)
            {
                for (int j = i; j < n; j++)
                {
                    G[i, j] = DistanceTwoPoints(tmp[i], tmp[j]); path[i, j] = false;
                    if (G[i, j] > MaxDis) MaxDis = G[i, j];
                }
            }
            for (int i = 0; i < n; i++)
                for (int j = 0; j < i; j++)
                { G[i, j] = G[j, i]; path[i, j] = false; }
            //初始化
            int bi = 2;
            //度约束最小生成树(bi<=2)=>prim最小生成树
            #region
            IList<int> U = new List<int>(); IList<int> V = new List<int>();
            U.Add(0);
            for (int i = 1; i < n; i++) V.Add(i);
            while (U.Count != n)
            {
                double mindis = MaxDis; int h = -1, k = -1;
                foreach (int i in U)
                    if (Deg[i] < bi)
                    {