[发明专利]一种基于牛顿迭代法的炮弹姿态估计方法有效
申请号: | 201811047725.0 | 申请日: | 2018-09-07 |
公开(公告)号: | CN109211231B | 公开(公告)日: | 2022-02-15 |
发明(设计)人: | 刘锡祥;杨文强;许广富;郭小乐;马晓爽 | 申请(专利权)人: | 东南大学 |
主分类号: | G01C21/16 | 分类号: | G01C21/16;G01S19/47 |
代理公司: | 南京经纬专利商标代理有限公司 32200 | 代理人: | 许方 |
地址: | 210000 *** | 国省代码: | 江苏;32 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: |
本发明公开一种基于牛顿迭代法的炮弹姿态估计方法,该方法包括以下步骤:(1)根据陀螺仪和GPS提供的炮弹速度和位置,计算t时刻载体惯性系i |
||
搜索关键词: | 一种 基于 牛顿 迭代法 炮弹 姿态 估计 方法 | ||
【主权项】:
1.一种基于牛顿迭代法的炮弹姿态估计方法,其特征在于,该方法包括以下步骤:(1)根据陀螺仪和GPS提供的炮弹速度和位置,计算t时刻载体惯性系ib系相对于载体系b的炮弹姿态矩阵
导航系n相对于导航惯性系in的炮弹姿态矩阵
(2)由陀螺仪和加速度计测量值计算ib系和in系下的炮弹速度v1(t)和v2(t);(3)定义变量X=[qT u]T,并构建非线性函数F(X)=0;其中,q是4维列向量,代表in系至ib系的变化四元数,u为待定系数;(4)通过函数F(X)一阶偏导数和二阶偏导数,求Jacobian矩阵和Hessian矩阵;(5)利用牛顿法迭代解出四元数q,根据
计算出姿态角。
下载完整专利技术内容需要扣除积分,VIP会员可以免费下载。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于东南大学,未经东南大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/patent/201811047725.0/,转载请声明来源钻瓜专利网。