C#使用最小二乘法對多個離散點進行圓擬合


        /// <summary>
        /// 最小二乘法擬合圓,計算擬合圓半徑和擬合圓圓心
        /// </summary>
        /// <param name="points">擬合點</param>
        /// <returns>返回擬合圓的計算結果</returns>
        public double[] FittingCircleByLeastSquare(List<Point> points)
        {
            //最小二乘法擬合圓
            ///https://blog.csdn.net/qq_31253399/article/details/107306569
            double U_i = 0, V_i = 0, U_c = 0, V_c = 0;
            double X = points.Average(p => p.X), Y = points.Average(p => p.Y);
            double S_uuu = 0, S_vvv = 0, S_uvv = 0, S_uuv = 0;
            double S_uu = 0, S_vv = 0, S_uv = 0;
            for (int i = 0; i < points.Count; i++)
            {
                U_i = points[i].X - X;
                V_i = points[i].Y - Y;
                S_uuu += Math.Pow(U_i, 3);
                S_uuv += Math.Pow(U_i, 2) * V_i;
                S_uuu += Math.Pow(U_i, 3);
                S_uvv += Math.Pow(V_i, 2) * U_i;
                S_uu += Math.Pow(U_i, 2);
                S_vv += Math.Pow(V_i, 2);
                S_uv += U_i * V_i;
            }
            U_c = (S_uuv * S_uv - S_uuu * S_vv - S_uvv * S_vv + S_uv * S_vvv) / 2 * (S_uv * S_uv - S_uu * S_vv);
            V_c = (S_uuu * S_uv - S_uuv * S_uu - S_uu * S_vvv + S_uv * S_uvv) / 2 * (S_uv * S_uv - S_uu * S_vv);
            //計算擬合圓圓心坐標
            double X_c = U_c + X;
            double Y_c = V_c + Y;
            //計算R
            double R = points.Sum(p => ((p.X - X_c) * (p.X - X_c) + (p.Y - X_c) * (p.Y - Y_c)));
            return new double[3] { X_c, Y_c, R };
        }

 


免責聲明!

本站轉載的文章為個人學習借鑒使用,本站對版權不負任何法律責任。如果侵犯了您的隱私權益,請聯系本站郵箱yoyou2525@163.com刪除。



 
粵ICP備18138465號   © 2018-2025 CODEPRJ.COM