C#最小二乘法拟合圆获取圆心坐标、圆半径

  1. NuGet->安装MathNet.Numerics ;
  2. 引用“System.Drawing”;
  3. Using指令:
using System.Drawing;
using MathNet.Numerics.LinearAlgebra;
  1. 代码块(转)
/// <summary>
/// 最小二乘法拟合圆获取圆心坐标、圆半径
/// </summary>
/// <param name="pointFs">输入的List<PointF>类型的变量</param>
/// <param name="CenterX">圆心x坐标</param>
/// <param name="CenterY">圆心y坐标</param>
/// <param name="CenterR">圆半径</param>
/// <returns></returns>
public static int FitCircle(List<PointF> pointFs, out float CenterX, out float CenterY, out float CenterR)
{
    Matrix<float> YMat;
    Matrix<float> RMat;
    Matrix<float> AMat;
    List<float> YLit = new List<float>();
    List<float[]> RLit = new List<float[]>();

    foreach (var pointF in pointFs)
        YLit.Add(pointF.X * pointF.X + pointF.Y * pointF.Y);

    float[,] Yarray = new float[YLit.Count, 1];
    for (int i = 0; i < YLit.Count; i++)
        Yarray[i, 0] = YLit[i];

    YMat = CreateMatrix.DenseOfArray<float>(Yarray);

    foreach (var pointF in pointFs)
        RLit.Add(new float[] { -pointF.X, -pointF.Y, -1 });

    float[,] Rarray = new float[RLit.Count, 3];
    for (int i = 0; i < RLit.Count; i++)
    {
        for (int j = 0; j < 3; j++)
        {
            Rarray[i, j] = RLit[i][j];
        }
    }

    RMat = CreateMatrix.DenseOfArray<float>(Rarray);
    Matrix<float> RTMat = RMat.Transpose();
    Matrix<float> RRTInvMat = (RTMat.Multiply(RMat)).Inverse();
    AMat = RRTInvMat.Multiply(RTMat.Multiply(YMat));

    float[,] Array = AMat.ToArray();
    float A = Array[0, 0];
    float B = Array[1, 0];
    float C = Array[2, 0];
    CenterX = A / -2.0f;
    CenterY = B / -2.0f;
    CenterR = (float)(Math.Sqrt(A * A + B * B - 4 * C) / 2.0f);
    return 0x0000;
}
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值