unity c# Thomas Algorithm

发布于:2022-12-06 ⋅ 阅读:(322) ⋅ 点赞:(0)

void Start()
    {
        float[]  a = new float[3];
        for (int i = 0; i < 3; i++)
        {
            a[i] = 2;
        }
        float[] b = new float[4];
        for (int i = 0; i < 4; i++)
        {
            b[i] = 3;
        }
        float[] c = new float[3];
        for (int i = 0; i < 3; i++)
        {
            c[i] = 2;
        }
        float[] d = new float[4];
        d[0] = 12;
        d[1] = 17;
        d[2] = 14;
        d[3] = 7;

        float[] x = new float[4];

        tdma(d, 3, a, b, c, x);
        
    }

    // Update is called once per frame
    void Update()
    {
        
    }


    private void tdma(float[] d, int N, float[] a, float[] b, float[] c, float[] x)
    {
        c[0] = c[0] / b[0];
        d[0] = d[0] / b[0];
        for (int Tn = 1; Tn < N; Tn++)
        {
            float m = 1.0f / (b[Tn] - a[Tn - 1] * c[Tn - 1]);
            c[Tn] = c[Tn] * m;
            d[Tn] = (d[Tn] - a[Tn - 1] * d[Tn - 1]) * m;
        }
        d[N] = (d[N] - a[N - 1] * d[N - 1]) / (b[N] - a[N - 1] * c[N - 1]);
        x[N] = d[N];

        for (int Tn = N - 1; Tn > -1; Tn--)
        {
            x[Tn] = d[Tn] - c[Tn] * x[Tn + 1];
        }
    }

参考资料:

Thomas AlgorithmThomas求解算法Python 3 - 问答 - Python中文网


网站公告

今日签到

点亮在社区的每一天
去签到