Функция интерполяции по входящим точкам

///<summary>
            /// Получает копию desiredPoint, но у которой вычислена последняя координата - интерполируемое значение с помощью extremePoints (крайних точек)
            /// </summary>
            /// <param name="desiredPoint">Точка, у которой и ищем последнюю координату</param>
            /// <param name="extremePoints">Крайние точки, от которых интерполируемся</param>
            decimal InterpolateY(decimal[] desiredPoint, List< decimal[]> extremePoints)
            {
                // Математические вычисления - интерполяция
                ....
                decimal result;
                // Возврат результата
                return result;
            }

using System;
 
class Interpolator
{
    // Функция для вычисления неизвестного значения через аффинную интерполяцию.
    // table – известные точки: каждая точка – массив длины d, где первые d–1 элементов – координаты,
    // последний элемент – функция (значение) в этой точке.
    // query – массив длины d–1 с координатами точки, для которой надо вычислить значение.
    public static double Interpolate(double[][] table, double[] query)
    {
        int m = table.Length;       // число известных точек
        int d = table[0].Length;    // общее число координат (d-1 вход, 1 выход)
        int n = d;                  // число коэффициентов (включая свободный член)
       
        // Построение матрицы X (m x n) и вектора Y (m)
        // Модель: f(x) = c0 + c1*x[0] + ... + c_{n-1} * x[n-2]
        double[,] X = new double[m, n];
        double[] Y = new double[m];
        for (int i = 0; i < m; i++)
        {
            X[i, 0] = 1.0;
            for (int j = 1; j < n; j++)
                X[i, j] = table[i][j - 1];
            Y[i] = table[i][d - 1];
        }
       
        // Находим коэффициенты через МНК: (XᵀX) c = XᵀY.
        double[,] A = new double[n, n];
        for (int i = 0; i < n; i++)
            for (int j = 0; j < n; j++)
            {
                double sum = 0;
                for (int k = 0; k < m; k++)
                    sum += X[k, i] * X[k, j];
                A[i, j] = sum;
            }
       
        double[] B = new double[n];
        for (int i = 0; i < n; i++)
        {
            double sum = 0;
            for (int k = 0; k < m; k++)
                sum += X[k, i] * Y[k];
            B[i] = sum;
        }
       
        double[] coeff = SolveLinearSystem(A, B);
       
        // Вычисляем значение для точки query.
        double result = coeff[0];
        for (int j = 1; j < n; j++)
            result += coeff[j] * query[j - 1];
       
        return result;
    }
   
    // Простой метод решения системы A*x = b методом Гаусса (без проверок на вырожденность).
    static double[] SolveLinearSystem(double[,] A, double[] b)
    {
        int n = b.Length;
        double[,] mat = new double[n, n + 1];
        for (int i = 0; i < n; i++)
        {
            for (int j = 0; j < n; j++)
                mat[i, j] = A[i, j];
            mat[i, n] = b[i];
        }
       
        // Прямой ход
        for (int i = 0; i < n; i++)
        {
            // Нормализация опорного элемента
            double pivot = mat[i, i];
            for (int j = i; j < n + 1; j++)
                mat[i, j] /= pivot;
           
            // Обнуление столбца i ниже и выше строки i
            for (int k = 0; k < n; k++)
            {
                if (k == i) continue;
                double factor = mat[k, i];
                for (int j = i; j < n + 1; j++)
                    mat[k, j] -= factor * mat[i, j];
            }
        }
       
        double[] x = new double[n];
        for (int i = 0; i < n; i++)
            x[i] = mat[i, n];
       
        return x;
    }
   
    // Пример использования
    static void Main()
    {
        double[][] table = new double[][]
        {
            new double[] { 1.5, 2.4, 3.2 },  // a1: x=1.5, y=2.4, z=3.2
            new double[] { 3.5, 4.0, 1.6 },  // a2: x=3.5, y=4.0, z=1.6
            new double[] { 0.0, 3.0, 5.9 }   // a3: x=0.0, y=3.0, z=5.9
        };
       
        double[] query = new double[] { 2.5, 2.5 }; // значения для x и y, ищем z
       
        double z = Interpolate(table, query);
        Console.WriteLine("Interpolated value: " + z);
    }
}