admin 管理员组

文章数量: 887007

姿态解算公式

最近在学习姿态分解，总结出下面的公式：
这里对于什么是姿态分解不做分析，只总结公式：
1.右手坐标系，左乘矩阵，ZXY顺规
绕Z轴旋转 φ

绕X轴旋转 θ

绕Y轴旋转γ

由于矩阵为左乘矩阵，则整体旋转矩阵为
R = RyRxRz =

四元数法姿态解算 ：
1.初始化四元数;
ZXY顺规
由四元数表示空间中一个向量绕某轴旋转一定的角度
绕Z轴旋转φ角
绕X轴旋转θ角

绕Y轴旋转γ角

则该向量在空间中的旋转可以表示为：

化简得到：

利用四元数表示旋转矩阵：

本文标签： 姿态解算公式

版权声明：本文标题：姿态解算公式 内容由网友自发贡献，该文观点仅代表作者本人， 转载请联系作者并注明出处：http://www.freenas.com.cn/jishu/1732354011h1533916.html， 本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如发现本站有涉嫌抄袭侵权/违法违规的内容，一经查实，本站将立刻删除。