严恭敏, 徐德民. 逆向导航算法及其在捷联罗经动基座初始对准中的应用[J]. 2007.
本文即将实现和验证的算法由严恭敏老师于2007年发表的会议论文提出(具体信息见文章开头的引用)。
1. 实现要点
论文指出,只要将正向算法中的陀螺采样和地球自转角速率符号取反,并设置逆向导航算法的初值为 C ← b 0 n = C b m n , v ← 0 n = − v m n , P ← 0 n = P m n \overleftarrow{C}^n_{b0}=C^n_{bm},\overleftarrow{v}^n_{0}=-v^n_{m},\overleftarrow{P}^n_{0}=P^n_{m} C