前言
本文是对姿态更新算法的理解。
一、姿态更新算法
![](https://img-blog.csdnimg.cn/570cd756af8a435b849653c00653b427.png)
地心惯性坐标系(i系)绝对不动的惯性参考坐标系,与时间无关。
个人理解:
地心惯性坐标系是绝对不动的,因此机体系到导航系的姿态矩阵可以先由机体系到地心惯性系,然后由地心惯性系到导航坐标系变化。
根据链乘原理,从m-1到m时刻,机体系到地心惯性系的变化由m-1时刻机体系到地心惯性系变化矩阵和机体系从m-1到m时刻的变化矩阵构成。地心惯性系到导航坐标系变化由m-1时刻地心惯性系到导航坐标系变化矩阵和导航系从m-1到m时刻的变化矩阵构成。
进而推导可得m时刻机体系到导航系的变换矩阵可由m-1时刻机体系到导航系的变换矩阵和m-1到m时刻导航系和机体系的变化矩阵连乘得到。因此后续重点在理解m-1到m时刻导航系和机体系的变化的姿态矩阵。
![](https://img-blog.csdnimg.cn/e56f0f8a333d4470a8658196ed63f0fd.png)
二、罗德里格旋转公式
m-1到m时刻导航系和机体系的变化的姿态矩阵都是根据罗德里格旋转公式求解
![](https://img-blog.csdnimg.cn/9b2e62f1bc0f4fdbb6f02b58d0dae5a4.png)
![](https://img-blog.csdnimg.cn/91678a8944b749f296de8b5df6bfa1b8.png)
![](https://img-blog.csdnimg.cn/3b72f03a063f4ce3a06956c4b431bd98.png)
![](https://img-blog.csdnimg.cn/7feed788a9ab4a11ac97d9a1885b2602.png)
![](https://img-blog.csdnimg.cn/c503ed1f16b84b249c94faef826109b7.png)
![](https://img-blog.csdnimg.cn/d6a6e8dfa94a438f91966b34b373a4e3.png)
补充说明:
![](https://img-blog.csdnimg.cn/9a0515e112874784b21b51edd3b080af.png)
![](https://img-blog.csdnimg.cn/0865a429044c4e0687c304e50a4c2b44.png)
![](https://img-blog.csdnimg.cn/8fa867d65564442bbd8d28eed008a955.png)
三、方向余弦阵微分方程
![](https://img-blog.csdnimg.cn/5aa4275a9327411aaab7f2e953a966c5.png)
四、导航系坐标变换矩阵
![](https://img-blog.csdnimg.cn/7ed2c0efcc0b4d858269ddd9071aa53e.png)
![](https://img-blog.csdnimg.cn/b286aa085d074f378db34285a06448bb.png)
五、机体系坐标变换矩阵
![](https://img-blog.csdnimg.cn/f734c0d0a4fb4a698f4deaf0e2573649.png)
![](https://img-blog.csdnimg.cn/8f4699fd50cc4d268bc13e3aca885d30.png)