发明名称 |
一种磁-惯性组合捷联测量方法 |
摘要 |
一种磁-惯性组合捷联测量方法,其包括在导航坐标系下建立载体基于地磁测量的滚转角解算方程和基于惯性测量的角运动方程;将上一时刻的俯仰角和偏航角近似为当时刻的俯仰角和偏航角;将当时刻的弹体坐标系<i>y</i>轴、<i>z</i>轴地磁测量值、俯仰角和偏航角作为基于地磁测量的滚转角解算方程的输入,解算当时刻的滚转角;将当时刻陀螺对弹体坐标系<i>y</i>轴、<i>z</i>轴角速度的测量信息,及俯仰角和滚转角作为角运动方程的输入,解算下一时刻的俯仰角速率和偏航角速率,然后通过对当时刻的俯仰角速率和偏航角速率积分,计算出载体下一时刻的俯仰角和偏航角;将下一时刻作为当时刻,重复上述过程,完成载体姿态的实时解算。该方法较好地解决了具有高角速度特征的载体的姿态解算问题。 |
申请公布号 |
CN103940425A |
申请公布日期 |
2014.07.23 |
申请号 |
CN201410162204.5 |
申请日期 |
2014.04.22 |
申请人 |
北京信息科技大学;北京理工大学;北京德维创盈科技有限公司 |
发明人 |
苏中;张双彪;李兴城;李擎 |
分类号 |
G01C21/08(2006.01)I;G01C21/16(2006.01)I |
主分类号 |
G01C21/08(2006.01)I |
代理机构 |
北京市合德专利事务所 11244 |
代理人 |
王文会;刘榜美 |
主权项 |
一种磁‑惯性组合捷联测量方法,其特征在于,该方法包括如下步骤:(1)在导航坐标系下建立载体基于地磁测量的滚转角解算方程和基于惯性测量的角运动方程;(2)将上一时刻的俯仰角和偏航角近似为当时刻的俯仰角和偏航角;(3)将当时刻的弹体坐标系<i>y</i>轴、<i>z</i>轴地磁测量值、俯仰角、偏航角作为基于地磁测量的滚转角解算方程的输入,解算当时刻的滚转角;(4)将当时刻陀螺对弹体坐标系<i>y</i>轴、<i>z</i>轴角速度的测量信息,以及俯仰角、滚转角作为角运动方程的输入,解算下一时刻的俯仰角速率和偏航角速率,然后通过对当时刻的俯仰角速率和偏航角速率积分,计算出载体下一时刻的俯仰角和偏航角;(5)将下一时刻作为当时刻,重复(1)‑(4)过程,完成载体姿态的实时解算。 |
地址 |
100101 北京市朝阳区北四环中路35号 |