simp3.cpp

Visual C++ 常用数值算法集 源代码

void simp3(double a[],int mp,int np,int i1,int k1,int& ip,int& kp)
{
	int kk;
    double piv = 1.0 / a[ip*np+kp + 1];
    for (int ii = 1; ii<=i1 + 1; ii++)
	{
        if (ii - 1 != ip)
		{
            a[(ii-1)*np+kp + 1] = a[(ii-1)*np+kp + 1] * piv;
            for (kk = 1; kk<=k1 + 1; kk++)
			{
                if (kk - 1 != kp)
				{
                    a[(ii-1) * np + kk] = a[(ii-1) * np+kk] - 
						 a[ip * np+kk] * a[(ii-1) * np + kp + 1];
                }
            }
        }
    }
    for (kk = 1; kk<=k1 + 1; kk++)
	{
        if (kk - 1 != kp)
		{
			a[ip*np+kk] = -a[ip*np+kk] * piv;
		}
    }
    a[ip*np + kp + 1] = piv;
}