发明授权
- 专利标题: 一种基于四元数的跨象限姿态角的计算方法
-
申请号: CN201610009264.2申请日: 2016-01-07
-
公开(公告)号: CN105651285B公开(公告)日: 2018-08-10
- 发明人: 杨兴光 , 杨凡
- 申请人: 北京电子工程总体研究所
- 申请人地址: 北京市海淀区142信箱30分箱
- 专利权人: 北京电子工程总体研究所
- 当前专利权人: 北京电子工程总体研究所
- 当前专利权人地址: 北京市海淀区142信箱30分箱
- 代理机构: 北京正理专利代理有限公司
- 代理商 李彦波; 付生辉
- 主分类号: G01C21/20
- IPC分类号: G01C21/20
摘要:
本发明公开一种基于四元数的跨象限姿态角的计算方法,包括如下步骤:分别计算获得俯仰角初值、偏航角初值和滚转角初值;分别计算获得本周期的偏航角中间值和本周期的滚转角中间值;确定偏航角的计数;确定滚转角的计数;计算得到本周期的偏航角终值;计算得到本周期的滚转角终值;计算得到本周期的偏航角的解耦矩阵;计算得到本周期的滚转角的解耦矩阵;确定本周期的四元数转换矩阵;计算得到本周期的俯仰角的转换矩阵;计算得到本周期的俯仰角对应的四元数;计算得到本周期的俯仰角中间值;确定俯仰角的计数;计算得到本周期的俯仰角终值。所述计算方法能够避免现有技术的传统的解算方法导致的奇异性和精度下降,以保证解算的精度。
公开/授权文献
- CN105651285A 一种基于四元数的跨象限姿态角的计算方法 公开/授权日:2016-06-08
IPC分类: