C语言实现组合导航中的Kalman滤波算法

该部分的核心代码主要是实现组合导航的核心算法即Kalman滤波,其中kfinit表示Kalman滤波的参数初始化,estm表示创建连续状态转移矩阵,kftm表示创建离散时间状态转移矩阵,kfupdate表示Kalman滤波的时间更新和量测更新部分,其中包含Sage-Husa自适应滤波、抗差Kalman滤波等。

/*------------------------------------------------------------------------------
* kalman	: RTKLC compute Kalman filter related parameters functions
*          Including kalamn parameters initializa function and kalman parameters update function
*			and kalman parameters feedback function
*
*          Copyright (C) 2022-2023 by xxx, All rights reserved.
* version : 1.3
* history : 2022/08/30 1.0  kalman ver.1.0.0
*			2022/10/10 1.1  kalman ver.1.1.0
*			2022/11/30 1.2  kalman ver.1.2.0
*			2022/12/07 1.3  kalman ver.1.3.0
-----------------------------------------------------------------------------*/

猜你喜欢

转载自blog.csdn.net/absll/article/details/131331246