【技术实现步骤摘要】
一种低精度惯组参数估计方法、装置、设备和存储介质
[0001]本专利技术涉及导航
，尤其涉及一种低精度惯组参数估计方法、装置、设备和存储介质。
技术介绍
[0002]由于运载火箭、飞机、舰船等运动体的可靠性要求越来越高，任务越来越复杂，需要导航系统在运载火箭任务中，在提供可靠，高精度的导航信息的同时具备成本低，重量轻，功耗低的优点。
[0003]冗余设计是提高导航系统可靠性的技术途径之一。而随着运载火箭等对体积、重量、功耗等的要求越来越高，多个同样激光惯组的冗余模式，势必会存在体积重量大，成本高的影响。因此传统冗余方案一般只用在大型运载火箭中，小型商业运载火箭一般只采用一套高性能的光学惯组。MEMS惯组作为一种微型惯组器件，虽然精度不如光学惯组高，但在体积重量和成本上有很大优势，可以作为冗余惯组设计的一部分。但由于MEMS惯组的精度不足，而且需要进行射前标定，带来了额外的工作量，因此对作为冗余的MEMS惯组的参数进行在线估计成为需要。
技术实现思路
[0004]鉴于上述的分析，本专利技术旨在提供...
【技术保护点】
【技术特征摘要】
1.一种低精度惯组参数估计方法，其特征在于，包括以下步骤：步骤S1、构建激光惯组和MEMS惯组的测量模型；步骤S2、根据激光惯组的输出和标定参数计算载体坐标系下的三轴角增量值和视速度增量值；步骤S3、将n个时间点的所述三轴角增量值和视速度增量值作为MEMS惯组测量模型的输入，基于最小二乘法，建立MEMS惯组量测方程；所述量测方程包括陀螺量测方程和加速度计量测方程；步骤S4、按时间顺序获取历史数据，进行自适应滑窗；将滑窗取得历史数据带入所述量测方程得到对应的量测矩阵；计算量测矩阵的线性度；当线性度满足阈值后，通过最小二乘法，利用滑窗取得历史数据估计MEMS惯组的参数；所述历史数据为按时间顺序排列的根据激光惯组的输出和标定参数计算载体坐标系下的三轴角增量值和视速度增量值。2.根据权利要求1所述的低精度惯组参数估计方法，其特征在于，所述激光惯组的测量模型包括激光陀螺测量模型和石英加速度计测量模型；所述激光陀螺测量模型为：其中，为载体坐标系下各轴角增量的真实值；为激光陀螺输出的各轴角增量；D
h1x
、D
h1y
、D
h1z
、D
h2x
、D
h2y
、D
h2z
、D
h3x
、D
h3y
和D
h3z
为激光陀螺实际的各轴的安装矩阵系数；D
h10
、D
h20
、D
h30
为激光陀螺各轴的实际零次项参数；T为采样周期；为激光陀螺各轴噪声；所述石英加速度计测量模型为：其中，为载体坐标系下各轴视速度增量的真实值；ΔW
1h
、ΔW
3h
为石英加速度计输出的各轴视速度增量；E
h1x
、E
h1y
、E
h1z
、E
h2x
、E
h2y
、E
h2z
、E
h3x
、E
h3y
、E
h3z
为石英加速度计实际的各轴的安装矩阵系数，E
h10
、E
h20
、E
h30
为石英加速度计各轴的实际零次项参数；T为采样周期；为石英加速度计各轴的噪声。3.根据权利要求2所述的低精度惯组参数估计方法，其特征在于，所述MEMS惯组的测量模型包括陀螺测量模型和加速度计测量模型；所述陀螺测量模型为：
其中，为载体坐标系下各轴角增量的真实值；为MEMS惯组各轴陀螺输出的角增量；D
l1x
、D
l1y
、D
l1z
、D
l2x
、D
l2y
、D
l2z
、D
l3x
、D
l3y
、D
l3z
为MEMS惯组各轴陀螺实际的安装矩阵系数，D
l10
、D
l20
、D
l30
为MEMS惯组各轴陀螺实际的零次项参数；T为采样周期；为MEMS惯组各轴陀螺的噪声；所述加速度计测量模型为：其中，ΔW
xb
、ΔW
zb
为载体坐标系下各轴视速度增量的真实值；ΔW
1l
为MEMS惯组各轴加速度计输出的视速度增量；E
l1x
、E
l1y
、E
l1z<...
【专利技术属性】
技术研发人员：高晓颖，刘继忠，赵欣艺，踪华，李冰，魏小丹，王森，王伟，唐海红，丑金玲，郑卓，禹春梅，司文杰，裴圣旺，马骉，王秀春，
申请(专利权)人：北京航天自动控制研究所，
类型：发明
国别省市：
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。