用vbnet写一个函数根据若干个点坐标XYZ运用最小二乘法计算平面度的函数

以下是用VB.NET写的根据若干个点坐标XYZ运用最小二乘法计算平面度的函数：

Public Function CalculateFlatness(points As List(Of Point3D)) As Double
    '计算平面度
    Dim n As Integer = points.Count
    Dim sumX As Double = 0
    Dim sumY As Double = 0
    Dim sumZ As Double = 0
    Dim sumX2 As Double = 0
    Dim sumY2 As Double = 0
    Dim sumXY As Double = 0
    Dim sumXZ As Double = 0
    Dim sumYZ As Double = 0

    For i = 0 To n - 1
        Dim point As Point3D = points(i)
        sumX += point.X
        sumY += point.Y
        sumZ += point.Z
        sumX2 += point.X ^ 2
        sumY2 += point.Y ^ 2
        sumXY += point.X * point.Y
        sumXZ += point.X * point.Z
        sumYZ += point.Y * point.Z
    Next

    Dim matrix(,) As Double = {{n, sumX, sumY},
                               {sumX, sumX2, sumXY},
                               {sumY, sumXY, sumY2}}
    Dim b() As Double = {sumZ, sumXZ, sumYZ}

    Dim coefficients() As Double = Solve(matrix, b)

    Dim a As Double = coefficients(0)
    Dim b1 As Double = coefficients(1)
    Dim b2 As Double = coefficients(2)

    Dim flatness As Double = Math.Sqrt(b1 ^ 2 + b2 ^ 2 + 1)

    Return flatness
End Function

Private Function Solve(A As Double(,), B As Double()) As Double()
    Dim n As Integer = B.Length
    Dim X(n - 1) As Double

    For i = 0 To n - 2
        For j = i + 1 To n - 1
            Dim factor As Double = A(j, i) / A(i, i)
            For k = i To n - 1
                A(j, k) -= factor * A(i, k)
            Next
            B(j) -= factor * B(i)
        Next
    Next

    For i = n - 1 To 0 Step -1
        For j = i + 1 To n - 1
            B(i) -= A(i, j) * X(j)
        Next
        X(i) = B(i) / A(i, i)
    Next

    Return X
End Function

该函数接受一个List(Of Point3D)类型参数，表示若干个点的坐标，其中Point3D类型包含X、Y、Z三个属性，分别表示点的x、y、z坐标。

函数通过最小二乘法计算出平面的方程，即Z = a + b1 * X + b2 * Y，然后计算出平面度，即sqrt(b1 ^ 2 + b2 ^ 2 + 1)，最后返回平面度