07、姿态解算---四元素旋转矩阵和欧拉角旋转矩阵

1、四元素旋转矩阵

        在05、姿态解算---四元素求姿态变换矩阵2一文中,推导出来四元素旋转矩阵如下:

eq?c_%7Bb%7D%5E%7BE%7D%3D%5Cbegin%7Bbmatrix%7D%201-2%28q2%5E%7B2%7D+q3%5E%7B2%7D%29%20%262%28q1q2-q0q3%29%20%262%28q0q2+q1q3%29%20%5C%5C%202%28q0q3+q1q2%29%26%201-2%28q1%5E%7B2%7D+q3%5E%7B2%7D%29%20%26%202%28q2q3-q0q1%29%5C%5C%202%28q1q3-q0q2%29%20%262%28q0q1+q2q3%29%20%261%20-2%28q2%5E%7B2%7D+q1%5E%7B2%7D%29%20%5Cend%7Bbmatrix%7D

 

2、欧拉角旋转矩阵

        在06、姿态解算---欧拉角推导一文中个,推导出来欧拉角旋转矩阵如下:

eq?c_%7BE%7D%5E%7Bb%7D%3D%5Cbegin%7Bbmatrix%7D%20cos%5Cgamma%20cos%5Cvarphi%20%26cos%5Cgamma%20sin%5Cvarphi%20%26-sin%5Cgamma%20%5C%5C%20sin%5Ctheta%20sin%5Cgamma%20cos%5Cvarphi%20%26sin%5Ctheta%20sin%5Cgamma%20sin%5Cvarphi%20+cos%5Ctheta%20cos%5Cvarphi%20%26sin%5Ctheta%20cos%5Cgamma%20%5C%5C%20cos%5Ctheta%20sin%5Cgamma%20cos%5Cvarphi%20+sin%5Ctheta%20sin%5Cvarphi%20%26%20cos%5Ctheta%20sin%5Cgamma%20sin%5Cvarphi%20-sin%5Ctheta%20cos%5Cvarphi%20%26%20cos%5Ctheta%20cos%5Cgamma%20%5Cend%7Bbmatrix%7D

 

3、将欧拉角旋转矩阵变换

        将欧拉角旋转矩阵也变换为从物体坐标系变换为地理坐标系,根据正交矩阵的公式eq?c_%7BE%7D%5E%7Bb%7D%3D%28c_%7Bb%7D%5E%7BE%7D%29%5E%7BT%7D,得出如下公式:

eq?c_%7Bb%7D%5E%7BE%7D%3D%5Cbegin%7Bbmatrix%7D%20cos%5Cgamma%20cos%5Cvarphi%20%26%20sin%5Ctheta%20sin%5Cgamma%20cos%5Cvarphi%20-cos%5Ctheta%20sin%5Cvarphi%20%26cos%5Ctheta%20sin%5Cgamma%20cos%5Cvarphi%20+sin%5Ctheta%20sin%5Cvarphi%20%5C%5C%20cos%5Cgamma%20sin%5Cvarphi%20%26%20sin%5Ctheta%20sin%5Cgamma%20sin%5Cvarphi%20+cos%5Ctheta%20cos%5Cvarphi%20%26cos%5Ctheta%20sin%5Cgamma%20sin%5Cvarphi%20-sin%5Ctheta%20cos%5Cvarphi%20%5C%5C%20-sin%5Cgamma%20%26sin%5Ctheta%20cos%5Cgamma%20%26cos%5Ctheta%20cos%5Cgamma%20%5Cend%7Bbmatrix%7D

 

4、关系推导

①、取1公式中第3行的3个元素分别令其等于g1、g2、g3;第2行第1列元素令其为g4;第1行第1列元素令其为g5;具体如下:

        eq?g1%3D2%28q1q3-q0q2%29

        eq?g2%3D2%28q2q3+q0q1%29

        eq?g3%3D%28q0%5E%7B2%7D-q1%5E%7B2%7D-q2%5E%7B2%7D+q3%5E%7B2%7D%29

        eq?g4%3D2%28q1q2+q0q3%29

        eq?g5%3Dq0%5E%7B2%7D+q1%5E%7B2%7D-q2%5E%7B2%7D-q3%5E%7B2%7D

②、由1和3节的公式,具体位置一一对应,则有:

        eq?2%28q1q3-q0q2%29%3D-sin%5Cgamma%20%3Dg1

        eq?2%28q2q3+q0q1%29%3Dsin%5Ctheta%20cos%5Cgamma%20%3Dg2

        eq?q0%5E%7B2%7D-q1%5E%7B2%7D-q2%5E%7B2%7D+q3%5E%7B2%7D%3Dcos%5Ctheta%20cos%5Cgamma%20%3Dg3

        eq?2%28q1q2+q0q3%29%3Dcos%5Cgamma%20sin%5Cvarphi%20%3Dg4

        eq?q0%5E%7B2%7D+q1%5E%7B2%7D-q2%5E%7B2%7D-q3%5E%7B2%7D%3Dcos%5Cgamma%20cos%5Cvarphi%20%3Dg5

③、得到姿态角:

        eq?%5Cgamma%20%3D-arcsin%28g1%29

        g3%29

        g5%29

 

 

 

 

 

  • 9
    点赞
  • 3
    收藏
    觉得还不错? 一键收藏
  • 0
    评论

“相关推荐”对你有帮助么?

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论
添加红包

请填写红包祝福语或标题

红包个数最小为10个

红包金额最低5元

当前余额3.43前往充值 >
需支付:10.00
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明:

1.余额是钱包充值的虚拟货币,按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载,可以购买VIP、付费专栏及课程。

余额充值