[发明专利]一种基于多级温度预测的陀螺惯导自适应对准方法有效
申请号: | 202310349355.0 | 申请日: | 2023-04-04 |
公开(公告)号: | CN116124180B | 公开(公告)日: | 2023-06-16 |
发明(设计)人: | 李德春;张永宾;马林;刘伯晗;胡小毛 | 申请(专利权)人: | 中国船舶集团有限公司第七〇七研究所 |
主分类号: | G01C25/00 | 分类号: | G01C25/00 |
代理公司: | 天津展誉专利代理有限公司 12221 | 代理人: | 刘永会 |
地址: | 300130 天*** | 国省代码: | 天津;12 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 基于 多级 温度 预测 陀螺 自适应 对准 方法 | ||
1.一种基于多级温度预测的陀螺惯导自适应对准方法,其特征在于:包括如下步骤:
S1:获取陀螺惯导多个封闭空间各采样时刻、、...、的温度分别为、、…、,其中为采样时刻的序号,为封闭空间的层号;
S2:根据步骤S1各采样时刻的温度基于非均匀有理B样条曲线及各层封闭空间的实际温度变化率进行温度拟合,得到非均匀有理B样条曲线方程;
S3:计算出非均匀有理B样条曲线方程的所有控制点,从而得到各层封闭空间温度拟合的非均匀有理B样条曲线:
S4:基于各层封闭空间温度拟合的非均匀有理B样条曲线获得各层封闭空间不考虑其他封闭空间影响时的温度变化率预测值,并将代入被外层封闭空间包裹的内层封闭空间的温度变化率与外层封闭空间的温度变化率关系式(1)中,对各层封闭空间的温度变化率进行拟合,求解出各层外层封闭空间对内层封闭空间温度变化率的贡献系数;
(1)
其中:为第个采样时刻内层封闭空间的实际温度变化率;
S5:重复步骤S1-步骤S3,更新各层封闭空间温度拟合的非均匀有理B样条曲线,并基于更新的各层封闭空间温度拟合的非均匀有理B样条曲线获得各层封闭空间不考虑其他封闭空间影响时的预测值,并与步骤S4求解出的一起代入式(2),得到陀螺惯导所在封闭空间考虑其他封闭空间影响时的预测值;
(2)
其中:为更新的第个采样时刻内层封闭空间的实际温度变化率;
S6:将代入角速度调节经验公式(3)求解出陀螺惯导旋转角速度,使陀螺惯导以求解出的陀螺惯导旋转角速度值旋转进行自适应对准;
(3)
其中:为对准过程中每个调制次序对应的角度,为恒温下调制角速度,为温度差时标度因子的变化量。
2.根据权利要求1所述的一种基于多级温度预测的陀螺惯导自适应对准方法,其特征在于:步骤S2中非均匀有理B样条曲线的表达式为式(4),各层封闭空间的实际温度变化率方程式为式(5),拟合后得到的非均匀有理B样条曲线方程为式(6);
(4)
(5)
(6)
其中:为相关符号的最高次幂,为采样时间,为时刻层封闭空间的温度,为曲线方程控制点, 为曲线方程控制点对应的权重,为曲线方程基函数,为层封闭空间第个采样时刻对应的实际温度变化率,为时刻层封闭空间温度的导数,为曲线方程基函数的导数,为对应的曲线方程基函数,为的导数,为对应的曲线方程基函数,为的导数,为对应的曲线控制点,为对应的曲线控制点,为控制点的权重,为控制点的权重。
3.根据权利要求2所述的一种基于多级温度预测的陀螺惯导自适应对准方法,其特征在于:计算非均匀有理B样条曲线方程的所有控制点时,将式(6)变换为矩阵形式,得到方程式(7),再对方程式(7)求解计算出非均匀有理B样条曲线方程的所有控制点;
(7)。
4.根据权利要求1所述的一种基于多级温度预测的陀螺惯导自适应对准方法,其特征在于:封闭空间的层数为四层,陀螺惯导安装于最内层封闭空间内。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于中国船舶集团有限公司第七〇七研究所,未经中国船舶集团有限公司第七〇七研究所许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/202310349355.0/1.html,转载请声明来源钻瓜专利网。
- 上一篇:一种高铁巡检机器人的路径规划方法及系统
- 下一篇:刷卡器刷卡数据的发送方法