Cholesky分解法

原文链接: https://blog.csdn.net/ACdreamers/article/details/44656847

Cholesky分解法又叫平方根法,是求解对称正定线性方程组最常用的方法之一。对于一般矩阵,为了消除LU分解的局限性和误差的过分积累,采用了选主元的方法,但对于对称正定矩阵而言,选主元是不必要的。

定理:若 A ∈ R n × n A\in R^{n \times n} ARn×n对称正定,则存在一个对角元为正数的下三角矩阵 L ∈ R n × n L\in R^{n \times n} LRn×n,使得 A = L L T A=LL^{T} A=LLT成立。

假设现在要求解线性方程组 A X = B AX=B AX=B,其中 A A A为对称正定矩阵,那么 X X X可通过下面步骤求解:

  1. A A A C h o l e s k y Cholesky Cholesky分解,得到 A = L L T A=LL^{T} A=LLT
  2. 求解 L Y = B LY=B LY=B,得到 Y Y Y
  3. 求解 L T X = Y L^{T}X=Y LTX=Y,得到 X X X

现在的关键问题是对进行Cholesky分解。假设
Cholesky分解法_第1张图片
通过 A = L L T A=LL^{T} A=LLT比较两边的关系,首先有在这里插入图片描述,再有在这里插入图片描述
这样便得到了矩阵 L L L的第一列元素,假定已经算出了 L L L的前 k − 1 k-1 k1列元素,通过
在这里插入图片描述
可以得到:
在这里插入图片描述
进一步再有:
在这里插入图片描述
最终得到:
在这里插入图片描述
这样便通过 L L L的前 k − 1 k-1 k1列求出了第 k k k列,一直递推下去即可求出 L L L,这种方法称为平方根法。

#include 
#include 
#include 
#include 
#include 
 
using namespace std;
const int N = 1005;
typedef double Type;
 
Type A[N][N], L[N][N];
 
/** 分解A得到A = L * L^T */
void Cholesky(Type A[][N], Type L[][N], int n)
{
    for(int k = 0; k < n; k++)
    {
        Type sum = 0;
        for(int i = 0; i < k; i++)
            sum += L[k][i] * L[k][i];
        sum = A[k][k] - sum;
        L[k][k] = sqrt(sum > 0 ? sum : 0);
        for(int i = k + 1; i < n; i++)
        {
            sum = 0;
            for(int j = 0; j < k; j++)
                sum += L[i][j] * L[k][j];
            L[i][k] = (A[i][k] - sum) / L[k][k];
        }
        for(int j = 0; j < k; j++)
            L[j][k] = 0;
    }
}
 
/** 回带过程 */
vector<Type> Solve(Type L[][N], vector<Type> X, int n)
{
    /** LY = B  => Y */
    for(int k = 0; k < n; k++)
    {
        for(int i = 0; i < k; i++)
            X[k] -= X[i] * L[k][i];
        X[k] /= L[k][k];
    }
    /** L^TX = Y => X */
    for(int k = n - 1; k >= 0; k--)
    {
        for(int i = k + 1; i < n; i++)
            X[k] -= X[i] * L[i][k];
        X[k] /= L[k][k];
    }
    return X;
}
 
void Print(Type L[][N], const vector<Type> B, int n)
{
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < n; j++)
            cout<<L[i][j]<<" ";
        cout<<endl;
    }
    cout<<endl;
    vector<Type> X = Solve(L, B, n);
    vector<Type>::iterator it;
    for(it = X.begin(); it != X.end(); it++)
        cout<<*it<<" ";
    cout<<endl;
}
 
int main()
{
    int n;
    cin>>n;
    memset(L, 0, sizeof(L));
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < n; j++)
            cin>>A[i][j];
    }
    vector<Type> B;
    for(int i = 0; i < n; i++)
    {
        Type y;
        cin>>y;
        B.push_back(y);
    }
    Cholesky(A, L, n);
    Print(L, B, n);
    return 0;
}
 
/**data**
4
4 -2 4 2
-2 10 -2 -7
4 -2 8 4
2 -7 4 7
8 2 16 6
*/

用上述的方法需要进行开方,这有可能损失精度和增加运算量,为了避免开方, C h o l e s k y Cholesky Cholesky分解有个改进的版本。

将对称正定矩阵 A A A通过分解成 A = L D L T A=LDL^{T} A=LDLT,其中 L L L是单位下三角矩阵, D D D是对角均为正数的对角矩阵。把这一分解叫做 L D L T LDL^{T} LDLT分解,是 C h o l e s k y Cholesky Cholesky分解的变形。对应两边的元素,很容易得到
在这里插入图片描述
由此可以确定计算 l i j l_{ij} lij d j d_{j} dj的公式如下
Cholesky分解法_第2张图片
在实际计算时,是将 L L L的严格下三角元素存储在 A A A的对应位置上,而将 D D D的对角元存储在 A A A的对应的对角位置上。类似地求解线性方程组 A X = B AX=B AX=B的解步骤如下
1.对矩阵 A A A进行分解得到 L D L T LDL^{T} LDLT
2.求解 L Y = B LY=B LY=B,得到 Y Y Y
3.求解 D L T X = Y DL^{T}X=Y DLTX=Y,得到 X X X

#include 
#include 
#include 
#include 
#include 
 
using namespace std;
const int N = 1005;
typedef double Type;
 
Type A[N][N], L[N][N], D[N][N];
 
/** 分解A得到A = LDL^T */
void Cholesky(Type A[][N], Type L[][N], Type D[][N], int n)
{
    for(int k = 0; k < n; k++)
    {
        for(int i = 0; i < k; i++)
            A[k][k] -= A[i][i] * A[k][i] * A[k][i];
        for(int j = k + 1; j < n; j++)
        {
            for(int i = 0; i < k; i++)
                A[j][k] -= A[j][i] * A[i][i] * A[k][i];
            A[j][k] /= A[k][k];
        }
    }
    memset(L, 0, sizeof(L));
    memset(D, 0, sizeof(D));
    for(int i = 0; i < n; i++)
    {
        D[i][i] = A[i][i];
        L[i][i] = 1;
    }
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < i; j++)
            L[i][j] = A[i][j];
    }
}
 
void Transposition(Type L[][N], int n)
{
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < i; j++)
            swap(L[i][j], L[j][i]);
    }
}
 
void Multi(Type A[][N], Type B[][N], int n)
{
    Type **C = new Type*[n];
    for(int i = 0; i < n; i++)
        C[i] = new Type[n];
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < n; j++)
        {
            C[i][j] = 0;
            for(int k = 0; k < n; k++)
                C[i][j] += A[i][k] * B[k][j];
        }
    }
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < n; j++)
            B[i][j] = C[i][j];
    }
    for(int i = 0; i < n; i++)
    {
        delete[] C[i];
        C[i] = NULL;
    }
    delete C;
    C = NULL;
}
 
/** 回带过程 */
vector<Type> Solve(Type L[][N], Type D[][N], vector<Type> X, int n)
{
    /** LY = B  => Y */
    for(int k = 0; k < n; k++)
    {
        for(int i = 0; i < k; i++)
            X[k] -= X[i] * L[k][i];
        X[k] /= L[k][k];
    }
    /** DL^TX = Y => X */
    Transposition(L, n);
    Multi(D, L, n);
    for(int k = n - 1; k >= 0; k--)
    {
        for(int i = k + 1; i < n; i++)
            X[k] -= X[i] * L[k][i];
        X[k] /= L[k][k];
    }
    return X;
}
 
void Print(Type L[][N], Type D[][N], const vector<Type> B, int n)
{
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < n; j++)
            cout<<L[i][j]<<" ";
        cout<<endl;
    }
    cout<<endl;
    vector<Type> X = Solve(L, D, B, n);
    vector<Type>::iterator it;
    for(it = X.begin(); it != X.end(); it++)
        cout<<*it<<" ";
    cout<<endl;
}
 
int main()
{
    int n;
    cin>>n;
    memset(L, 0, sizeof(L));
    for(int i = 0; i < n; i++)
    {
        for(int j = 0; j < n; j++)
            cin>>A[i][j];
    }
    vector<Type> B;
    for(int i = 0; i < n; i++)
    {
        Type y;
        cin>>y;
        B.push_back(y);
    }
    Cholesky(A, L, D, n);
    Print(L, D, B, n);
    return 0;
}
 
/**data**
4
4 -2 4 2
-2 10 -2 -7
4 -2 8 4
2 -7 4 7
8 2 16 6
*/

你可能感兴趣的:(SLAM)