CN110823255B - 一种基于比力观测无需调平引北的系统级自标定方法 - Google Patents
一种基于比力观测无需调平引北的系统级自标定方法 Download PDFInfo
- Publication number
- CN110823255B CN110823255B CN201911162938.2A CN201911162938A CN110823255B CN 110823255 B CN110823255 B CN 110823255B CN 201911162938 A CN201911162938 A CN 201911162938A CN 110823255 B CN110823255 B CN 110823255B
- Authority
- CN
- China
- Prior art keywords
- data
- imu
- calibration
- alignment
- rotation
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 31
- 230000003068 static effect Effects 0.000 claims abstract description 15
- 239000011159 matrix material Substances 0.000 claims description 25
- 230000001133 acceleration Effects 0.000 claims description 16
- 230000005484 gravity Effects 0.000 claims description 10
- 238000012937 correction Methods 0.000 claims description 6
- 238000012935 Averaging Methods 0.000 claims 2
- 239000003550 marker Substances 0.000 claims 1
- 230000017105 transposition Effects 0.000 abstract description 7
- 238000005259 measurement Methods 0.000 abstract description 4
- 238000004364 calculation method Methods 0.000 description 8
- 238000004422 calculation algorithm Methods 0.000 description 7
- 238000009434 installation Methods 0.000 description 4
- 238000012360 testing method Methods 0.000 description 4
- 238000005516 engineering process Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 2
- 230000002159 abnormal effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000009795 derivation Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000003104 tissue culture media Substances 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C25/00—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass
- G01C25/005—Manufacturing, calibrating, cleaning, or repairing instruments or devices referred to in the other groups of this subclass initial alignment, calibration or starting-up of inertial devices
Landscapes
- Engineering & Computer Science (AREA)
- Manufacturing & Machinery (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Navigation (AREA)
Abstract
本发明涉及一种基于比力观测无需调平引北的系统级自标定方法,利用IMU转动静止过程中测量的数据,构建比力观测统一模型,可以适应任意单次转动为单轴旋转情况,根据任意可行转位方案可将各项待估计参数标定出来。本发明的方法可以在任意初始指向、任意水平度情况下进行标定,具有一定的实际意义。
Description
技术领域
本发明属于导航技术领域,具体为一种基于比力观测无需调平引北的系统级自标定方法。
背景技术
标定技术是捷联惯性导航系统能够正常运行的重要保障,主要基于惯性组件三轴加速度计和三轴陀螺构建正交坐标系,并使得正交坐标系下的物理输出准确化。捷联惯性导航系统采用惯性器件与惯导底座直接固联的安装方式,通过惯性器件测量信息建立导航坐标系,进行导航解算实现导航功能。捷联惯性导航系统的导航实现方式,决定了其在开始工作前,必须完成惯性器件的标定,以保证惯性器件能够提供准确的测量信息。
本发明解决的是转台没有调平引北或者没有转台情况下的捷联惯性导航系统自标定的问题。目前,西北工业大学的谢波、国防科技大学的张红良也进行了相关方面的研究,谢波在《中国惯性技术学报》上发表的文章《激光陀螺捷联惯导系统多位置标定方法》中,提出了一种多位置标定的算法,该算法原理是利用观测速度误差估计各项标定参数。实际运算中存在计算量大,运算复杂的特点。算法的推导过程基于初始指向天东北的假设,因而不能适应任意初始指向的情况,算法没有建立统一的计算模型,仅适应设计转位,实际操作中若转台转位次序异常则需重新进行标定。张红良在博士论文《陆用高精度激光陀螺捷联惯导系统误差参数估计方法研究》中,提出利用捷联惯导转动前后静态位置比力投影的差值,构建观测量与待标定参数的关系,实现捷联惯导系统的标定。该方法限定了捷联惯导系统的初始指向,不能适应任意初始指向的情况,计算方法依赖转位方案,不能适应任意可行转位方案。不同转位方案,需根据原理公式重新设计计算方法。
发明内容
要解决的技术问题
为了避免现有技术的不足之处,本发明提出一种
技术方案
一种基于比力观测无需调平引北的系统级自标定方法,其特征在于步骤如下:
步骤1:将捷联惯性导航设备安装在双轴转位机构上,转位机构基座处于静止状态;
步骤5:调整双轴转位机构使其按给定的转位方案进行角位置转动,按步骤2~4的方式进行数据采集;
步骤6:将相邻静止位置及二者之间翻转过程中的数据组成1组有效数据,即0位置数据、0位置至1位置的转动数据、1位置数据为1组有效数据,1位置数据、1位置至2位置的转动数据、2位置数据为1组有效数据,其它依次类推,可组成多组有效数据;
步骤7:每组有效数据的第1个静止位置进行水平对准,水平对准在0位置进行粗对准+水平精对准+方位修正,其它位置水平对准的粗对准值采用姿态跟踪值,在此基础上进行精对准;0位置的粗对准采用基于地球自转矢量和重力矢量的双矢量解析式对准,精对准利用粗对准值及该位置加速度信息fb(l),公式如下:
式中,gn为重力矢量,X为除陀螺零偏外的陀螺标定参数和加计标定参数组成的向量,H=[B-B′l(-gn×)C],B′l为Bl的第3行元素全部置零得到,C的取值分三种情况,绕IMU的XYZ轴旋转,分别取值如下:
步骤10:根据多个参数辨识方程,可通过最小二乘的方法对各标定误差参数进行辨识,得到各标定误差参数;
步骤11:将辨识的误差参数修入IMU采集的数据中,重复步骤6~10,重复多次即可,将多次得到的标定误差参数进行求和平均或者加权求和平均即可得到准确的标定误差参数。
步骤5中所述的给定的转位方案:
有益效果
本发明提出的一种基于比力观测无需调平引北的系统级自标定方法。比力观测是利用加速度计测量信息直接对各项待标定误差参数关系进行估计的方法。本发明是利用IMU转动静止过程中测量的数据,构建比力观测统一模型,可以适应任意单次转动为单轴旋转情况,根据任意可行转位方案可将各项待估计参数标定出来。本发明的方法可以在任意初始指向、任意水平度情况下进行标定,具有一定的实际意义。
附图说明
图1本发明的系统级标定算法流程图
图2三轴加速度计标度因数误差图
图3三轴陀螺标度因数误差图
图4设备及转位机构安装关系示意图
具体实施方式
现结合实施例、附图对本发明作进一步描述:
(1)将设备安装在双轴转位机构上,转位机构基座处于静止状态,设备及转位机构安装关系示意图如下:
(6)调整转位机构使其按下表所示的转位方案进行角位置转动,按步骤(3)~(5)的方式进行数据采集;
(7)将相邻静止位置及二者之间翻转过程中的数据组成1组有效数据,即0位置数据、0位置至1位置的转动数据、1位置数据为1组有效数据,1位置数据、1位置至2位置的转动数据、2位置数据为1组有效数据,其它依次类推,可组成18组有效数据;
(8)每组有效数据的第1个静止位置进行水平对准,水平对准仅在0位置进行粗对准(经典的基于地球自转矢量和重力矢量的双矢量解析式对准)+水平精对准+方位修正,其它位置水平对准的粗对准值采用姿态跟踪值,在此基础上进行精对准,精对准利用粗对准值及该位置加速度信息fb(l),公式如下:
式中,gn为重力矢量,X为除陀螺零偏外的陀螺标定参数和加计标定参数组成的向量,H=[B-B′l(-gn×)C],B′l为Bl的第3行元素全部置零得到,C的取值分三种情况,绕IMU的XYZ轴旋转,分别取值如下(θ为转动角度):
其中,max(·)为取3×1向量中最大值元素,由该式可确定旋转轴向。
(11)根据18个参数辨识方程,可通过最小二乘的方法对各标定误差参数进行辨识,得到各标定误差参数;
(12)将辨识的误差参数修入IMU采集的数据中,重复步骤7~11,重复5次即可,将每次得到的标定误差参数想加即可得到准确的标定误差参数。
通过如下方法得以验证:
采用速率型光纤陀螺捷联惯导系统(三轴加速度计零偏稳定性5×10-5g;三轴陀螺零偏稳定性0.01°/h,其中Y轴陀螺性能稍差)和双轴转台进行试验。试验中在双轴转台上采用所设计的系统级标定方法进行了15次试验。
按照发明中所描述的形式建立起参数辨识方程组。统一的辨识方程如下:
式中,gn为重力矢量,X为除陀螺零偏外的陀螺标定参数和加计标定参数组成的向量,H=[B-B′l(-gn×)C],B′l为Bl的第3行元素全部置零得到,C的取值分三种情况,绕IMU的XYZ轴旋转,分别取值如下(θ为转动角度):
试验结果:图2~图3、表1~表4为系统级标定结果。从结果可以看出,惯性器件的安装误差角标定结果均较为稳定。其中,安装误差角的均方差均小于1.3″。而惯性器件零偏标定结果的稳定性则次之。其中,加速度计零偏的均方差依次为0.6×10-5g、1.3×10-5g、0.8×10-5g;陀螺零偏的均方差依次为0.004°/h、0.014°/h、0.001°/h。二者中,加速度计零偏的稳定性均较好,而陀螺零偏中y轴零偏的稳定性较差,与器件性能相符。15次试验中惯性器件各轴标度因数误差的变化规律相近。由于捷联惯导系统未进行温度控制和补偿,温度变化是该现象产生的主要原因。其中,加速度计标度因数误差的均方差均小于17.4ppm,陀螺标度因数误差的均方差均小于5.1ppm。各标定误差参数收敛结果一致性较好,所设计算法解算结果稳定。
表1
表2
表3
表4
Claims (2)
1.一种基于比力观测无需调平引北的系统级自标定方法,其特征在于步骤如下:
步骤1:将捷联惯性导航设备安装在双轴转位机构上,转位机构基座处于静止状态;
步骤5:调整双轴转位机构使其按给定的转位方案进行角位置转动,按步骤2~4的方式进行数据采集;
步骤6:将相邻静止位置及二者之间翻转过程中的数据组成1组有效数据,即0位置数据、0位置至1位置的转动数据、1位置数据为1组有效数据,1位置数据、1位置至2位置的转动数据、2位置数据为1组有效数据,组成多组有效数据;
步骤7:每组有效数据的第1个静止位置进行水平对准,水平对准在0位置进行粗对准+水平精对准+方位修正,其它位置水平对准的粗对准值采用姿态跟踪值,在此基础上进行精对准;0位置的粗对准采用基于地球自转矢量和重力矢量的双矢量解析式对准,精对准利用粗对准值及该位置加速度信息fb(l),公式如下:
式中,gn为重力矢量,X为除陀螺零偏外的陀螺标定参数和加计标定参数组成的向量,H=[B-Bl′(-gn×)C],Bl′为Bl的第3行元素全部置零得到,C的取值分三种情况,绕IMU的XYZ轴旋转,分别取值如下:
步骤10:根据多个参数辨识方程,通过最小二乘的方法对各标定误差参数进行辨识,得到各标定误差参数;
步骤11:将辨识的误差参数修入IMU采集的数据中,重复步骤6~10,重复多次,将多次得到的标定误差参数进行求和平均或者加权求和平均得到准确的标定误差参数。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911162938.2A CN110823255B (zh) | 2019-11-25 | 2019-11-25 | 一种基于比力观测无需调平引北的系统级自标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911162938.2A CN110823255B (zh) | 2019-11-25 | 2019-11-25 | 一种基于比力观测无需调平引北的系统级自标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN110823255A CN110823255A (zh) | 2020-02-21 |
CN110823255B true CN110823255B (zh) | 2023-04-14 |
Family
ID=69559054
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911162938.2A Active CN110823255B (zh) | 2019-11-25 | 2019-11-25 | 一种基于比力观测无需调平引北的系统级自标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN110823255B (zh) |
Families Citing this family (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111537002B (zh) * | 2020-06-16 | 2022-05-24 | 北京航天发射技术研究所 | 一种激光捷联惯组安装误差的标定方法和定向方法 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104121928A (zh) * | 2014-05-29 | 2014-10-29 | 湖北航天技术研究院总体设计所 | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 |
RU2594631C1 (ru) * | 2015-05-08 | 2016-08-20 | Открытое акционерное общество Московский научно-производственный комплекс "Авионика" имени О.В. Успенского (ОАО МНПК "Авионика") | Способ определения углов пространственной ориентации летательного аппарата и устройство для его осуществления |
CN106441357A (zh) * | 2016-09-12 | 2017-02-22 | 东南大学 | 一种基于阻尼网络的单轴旋转sins轴向陀螺漂移校正方法 |
CN107490809A (zh) * | 2017-09-29 | 2017-12-19 | 中国船舶重工集团公司第七0七研究所 | 一种重力敏感器的惯组级标定方法 |
CN108458725A (zh) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | 捷联惯导系统晃动基座上的系统级标定方法 |
CN109740418A (zh) * | 2018-11-21 | 2019-05-10 | 中山大学 | 一种基于多加速度传感器的瑜伽动作识别方法 |
-
2019
- 2019-11-25 CN CN201911162938.2A patent/CN110823255B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104121928A (zh) * | 2014-05-29 | 2014-10-29 | 湖北航天技术研究院总体设计所 | 一种适用于低精度有方位基准单轴转位设备的惯性测量单元标定方法 |
RU2594631C1 (ru) * | 2015-05-08 | 2016-08-20 | Открытое акционерное общество Московский научно-производственный комплекс "Авионика" имени О.В. Успенского (ОАО МНПК "Авионика") | Способ определения углов пространственной ориентации летательного аппарата и устройство для его осуществления |
CN106441357A (zh) * | 2016-09-12 | 2017-02-22 | 东南大学 | 一种基于阻尼网络的单轴旋转sins轴向陀螺漂移校正方法 |
CN107490809A (zh) * | 2017-09-29 | 2017-12-19 | 中国船舶重工集团公司第七0七研究所 | 一种重力敏感器的惯组级标定方法 |
CN108458725A (zh) * | 2017-11-17 | 2018-08-28 | 北京计算机技术及应用研究所 | 捷联惯导系统晃动基座上的系统级标定方法 |
CN109740418A (zh) * | 2018-11-21 | 2019-05-10 | 中山大学 | 一种基于多加速度传感器的瑜伽动作识别方法 |
Non-Patent Citations (3)
Title |
---|
Automatic Identification and Calibration of Stochastic Parameters in Inertial Sensors;Guerrier, S等;《Navigation》;20151123;第62卷(第04期);第265-272页 * |
基于最小二乘辨识的单轴陀螺参数标定方法;李小平 等;《探测与控制学报》;20190630;第41卷(第03期);第104-107页 * |
无依托状态加速度计的新型标定方法;毛友泽 等;《北京航空航天大学学报》;20110131;第37卷(第01期);第123-126页 * |
Also Published As
Publication number | Publication date |
---|---|
CN110823255A (zh) | 2020-02-21 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106525073B (zh) | 一种基于三轴转台的惯性空间陀螺标定试验方法 | |
CN110006450B (zh) | 一种激光捷联惯导系统在卧式三轴转台上的标定方法 | |
CN110160554B (zh) | 一种基于寻优法的单轴旋转捷联惯导系统标定方法 | |
CN102564455B (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
CN105910626B (zh) | 挠性陀螺测斜仪寻北全温标定补偿方法 | |
CN112595350B (zh) | 一种惯导系统自动标定方法及终端 | |
CN113008227B (zh) | 一种基于三轴加速度计测姿的地磁二分量测量方法 | |
CN101246023A (zh) | 微机械陀螺惯性测量组件的闭环标定方法 | |
CN103076025B (zh) | 一种基于双解算程序的光纤陀螺常值误差标定方法 | |
CN105509769B (zh) | 一种运载火箭捷联惯导全自主对准方法 | |
CN113916256B (zh) | 三轴mems陀螺组合惯性测量单元标定方法 | |
CN106017452B (zh) | 双陀螺抗扰动寻北方法 | |
CN102679999A (zh) | 星敏感器安装误差四位置标定与补偿方法 | |
WO2020164206A1 (zh) | 一种旋转加速度计重力梯度仪标定方法 | |
CN101907638B (zh) | 一种无依托状态下加速度计的标定方法 | |
CN112129322B (zh) | 一种捷联惯组与三轴转台的安装误差检测方法及校正方法 | |
CN108132060A (zh) | 一种捷联惯导系统无基准的系统级标定方法 | |
CN110006454B (zh) | 一种imu标定三轴转台垂直度和初始姿态的方法 | |
CN110749338A (zh) | 一种惯性测量单元偏轴-旋转复合转位误差标定方法 | |
CN113503894A (zh) | 基于陀螺基准坐标系的惯导系统误差标定方法 | |
CN110823255B (zh) | 一种基于比力观测无需调平引北的系统级自标定方法 | |
CN109029499B (zh) | 一种基于重力视运动模型的加速度计零偏迭代寻优估计方法 | |
CN113790737A (zh) | 一种阵列式传感器的现场快速标定方法 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN108917789B (zh) | 一种基于俯仰轴和横滚轴相对夹角的倾角仪正交性评估方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |