この部分のコア コードは主に、統合ナビゲーションのコア アルゴリズム、つまりカルマン フィルターを実現することです。カルマン フィルターのパラメーターのkfinit
初期化を示し、estm
連続状態遷移行列の作成を示し、kftm
離散時間状態遷移行列の作成を示します。 、kfupdate
Sage-Husa 適応フィルタリング、ロバスト カルマン フィルタリングなどを含むカルマン フィルタ部分の時間更新と測定更新を示します。
/*------------------------------------------------------------------------------
* 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
-----------------------------------------------------------------------------*/