/// <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 }; }
