严恭敏, 徐德民. 逆向导航算法及其在捷联罗经动基座初始对准中的应用[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} Cb0n=Cbmn,v0n=−vmn,P0n=Pmn。
2.实验
2.1 实验设置
仿真产生一段轨迹的数据,首先运行正向导航解算;然后对数据做取反处理,并以正向导航解算的最后结果“作为”逆向导航解算的初值,运行逆向导航解算。