在组合导航中,由于量测噪声阵的对角线元素很小,有时会导致矩阵求逆的时候出现奇异值,导致求逆失败,因此参考RTKLIB和PSINS程序,综合起来,实现了这个求逆函数,现公布如下:
/* LU decomposition ----------------------------------------------------------*/
static int ludcmp(double* A, int n, int* indx, double* d)
{
在组合导航中,由于量测噪声阵的对角线元素很小,有时会导致矩阵求逆的时候出现奇异值,导致求逆失败,因此参考RTKLIB和PSINS程序,综合起来,实现了这个求逆函数,现公布如下:
/* LU decomposition ----------------------------------------------------------*/
static int ludcmp(double* A, int n, int* indx, double* d)
{