CN113418535A - 基于二维内杆臂估计的旋转惯导***多位置对准方法 - Google Patents
基于二维内杆臂估计的旋转惯导***多位置对准方法 Download PDFInfo
- Publication number
- CN113418535A CN113418535A CN202110657601.XA CN202110657601A CN113418535A CN 113418535 A CN113418535 A CN 113418535A CN 202110657601 A CN202110657601 A CN 202110657601A CN 113418535 A CN113418535 A CN 113418535A
- Authority
- CN
- China
- Prior art keywords
- lever arm
- inner lever
- measurement
- formula
- error
- 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.)
- Pending
Links
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
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于二维内杆臂估计的旋转惯导***多位置对准方法,该方法将惯性测量单元的敏感中心定义在其中一个水平加速度计的测量中心,使产生影响的内杆臂误差减少为2维,并通过精对准卡尔曼滤波器同步进行在线估计,能够在保证对准精度和快速性的基础上降低算法复杂度,提高内杆臂估计精度。
Description
技术领域
本发明属于惯性导航技术领域,具体涉及一种旋转惯导***多位置对准方法。
背景技术
旋转惯导***通过绕方位轴的连续旋转或多位置转停来抑制传感器零偏误差的影响,能够在器件精度一定的条件下提高自对准精度。受传感器尺寸和安装条件的限制,惯性测量单元(IMU)中三轴加速度计的测量中心无法重合于一点,从而形成内杆臂误差,如果不进行补偿将严重影响旋转惯导***的初始对准精度。
文献“基于尺寸效应在线补偿的旋转捷联惯性导航***初始对准,兵工学报,2020,Vol41(10),p2016-2022”公开了一种在连续旋转对准过程中实时估计内杆臂的方法。该方法将IMU敏感中心定义在转位机构的旋转中心,从而建立了4维内杆臂模型并进行在线估计,有效补偿了内杆臂误差的影响,提高了旋转对准精度。文献所述方法适用于连续旋转对准,但在应用于多位置对准时4维内杆臂不能独立观测,算法冗余度和复杂度高,杆臂分离精度下降。
发明内容
为了克服现有技术的不足,本发明提供了一种基于二维内杆臂估计的旋转惯导***多位置对准方法,该方法将惯性测量单元的敏感中心定义在其中一个水平加速度计的测量中心,使产生影响的内杆臂误差减少为2维,并通过精对准卡尔曼滤波器同步进行在线估计,能够在保证对准精度和快速性的基础上降低算法复杂度,提高内杆臂估计精度。
本发明解决其技术问题所采用的技术方案包括如下步骤:
步骤1:定义IMU坐标系为b,与惯性测量单元固联,指向右前上方向;定义导航坐标系为n,指向当地地理位置的东北天方向;将IMU敏感中心定义在Ax轴加速度计的测量中心,忽略二阶小量后建立二维内杆臂比力模型:
步骤2:建立多位置精对准的误差状态向量:
及简化误差方程
步骤3:建立多位置对准滤波器的状态方程:
及量测方程:
Z=δvn=[03×3 I3×3 03×3 03×3 03×2]X+wv (7)
步骤4:多位置对准过程中,全程根据式(6)进行滤波器时间更新,仅在转位机构停止时根据式(7)进行滤波器量测更新。
本发明的有益效果如下:
本发明方法将惯性测量单元的敏感中心定义在水平加速度计的测量中心,使内杆臂误差减少为2维,能够在保证对准精度的基础上降低滤波器算法复杂度,提高内杆臂估计精度;在转位机构停止时间段内进行滤波更新,改善了初始对准环境,有利于加快收敛速度。
附图说明
图1是本发明涉及的内杆臂示意图。
图2是本发明实施例提供的多位置对准旋转策略。
图3是本发明方法和背景方法的对准结果之差。
图4为背景方法获得的四维内杆臂估计结果。
图5为本发明方法获得的二维内杆臂估计结果。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
一种基于二维内杆臂估计的旋转惯导***多位置对准方法,包括如下步骤:
步骤1:定义IMU坐标系为b,与惯性测量单元固联,指向右前上方向;定义导航坐标系为n,指向当地地理位置的东北天方向;参照图1,将IMU敏感中心定义在Ax轴加速度计的测量中心,由于多位置对准期间IMU仅绕zb轴转停,忽略二阶小量后建立二维内杆臂比力模型:
步骤2:建立误差状态和误差方程;
增加二维内杆臂后,建立多位置精对准的误差状态向量:
及简化误差方程
步骤3:建立多位置对准滤波器的状态方程:
及量测方程:
Z=δvn=[03×3 I3×3 03×3 03×3 03×2]X+wv (7)
步骤4:多位置对准过程中,全程根据式(6)进行滤波器时间更新,仅在转位机构停止时根据式(7)进行滤波器量测更新。
具体实施例:
图2为多位置对准过程中方位框的转动角速率和角度,显示方位框转动角速率为20°/s,总对准时间为110s,在0°、180°和0°角位置均停留30s。
图3为本发明方法和背景方法获得的对准结果之差,显示俯仰角差值δθ在0.0035″以内,滚转角差值δγ在0.003″以内,航向角差值δψ在1″内。
图4为背景方法获得的4维内杆臂的估计曲线,显示8次对准试验杆臂估计的重复性在1mm(1σ)量级。
图5为本发明方法获得的2维内杆臂的估计曲线,显示8次对准试验杆臂估计的重复性在0.1mm(1σ)量级。
实施例效果表明,本发明方法能够获得与背景方法相当的对准精度,8次对准结果的最大角度差值不超过1″,且本发明方法将内杆臂维数由背景方法的4维减少为2维,降低了滤波器算法复杂度,减少了计算量。另一方面,本发明方法消除了背景方法在多位置对准中内杆臂定义的冗余度,提高了内杆臂估计精度,8次内杆臂估计的重复性由1mm(1σ)提高至0.1mm(1σ)。
Claims (1)
1.一种基于二维内杆臂估计的旋转惯导***多位置对准方法,其特征在于,包括以下步骤:
步骤1:定义IMU坐标系为b,与惯性测量单元固联,指向右前上方向;定义导航坐标系为n,指向当地地理位置的东北天方向;将IMU敏感中心定义在Ax轴加速度计的测量中心,忽略二阶小量后建立二维内杆臂比力模型:
步骤2:建立多位置精对准的误差状态向量:
及简化误差方程
步骤3:建立多位置对准滤波器的状态方程:
及量测方程:
Z=δvn=[03×3 I3×3 03×3 03×3 03×2]X+wv (7)
步骤4:多位置对准过程中,全程根据式(6)进行滤波器时间更新,仅在转位机构停止时根据式(7)进行滤波器量测更新。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110657601.XA CN113418535A (zh) | 2021-06-13 | 2021-06-13 | 基于二维内杆臂估计的旋转惯导***多位置对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110657601.XA CN113418535A (zh) | 2021-06-13 | 2021-06-13 | 基于二维内杆臂估计的旋转惯导***多位置对准方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113418535A true CN113418535A (zh) | 2021-09-21 |
Family
ID=77788468
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110657601.XA Pending CN113418535A (zh) | 2021-06-13 | 2021-06-13 | 基于二维内杆臂估计的旋转惯导***多位置对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113418535A (zh) |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB9224847D0 (en) * | 1992-11-27 | 1993-01-13 | Gec Ferranti Defence Syst | Minimised compensation for accelerometer offsets |
CN103363989A (zh) * | 2012-04-09 | 2013-10-23 | 北京自动化控制设备研究所 | 一种捷联惯导***内杆臂的估计与误差补偿方法 |
CN104019828A (zh) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | 高动态环境下惯性导航***杆臂效应误差在线标定方法 |
CN106052715A (zh) * | 2016-05-23 | 2016-10-26 | 西北工业大学 | 单轴旋转捷联惯导***回溯式自对准方法 |
CN106482746A (zh) * | 2016-11-25 | 2017-03-08 | 北京航空航天大学 | 一种用于混合式惯导***的加速度计内杆臂标定与补偿方法 |
CN110940357A (zh) * | 2019-12-20 | 2020-03-31 | 湖北航天技术研究院总体设计所 | 一种用于旋转惯导单轴自对准的内杆臂标定方法 |
CN112595350A (zh) * | 2020-12-31 | 2021-04-02 | 福建星海通信科技有限公司 | 一种惯导***自动标定方法及终端 |
-
2021
- 2021-06-13 CN CN202110657601.XA patent/CN113418535A/zh active Pending
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB9224847D0 (en) * | 1992-11-27 | 1993-01-13 | Gec Ferranti Defence Syst | Minimised compensation for accelerometer offsets |
CN103363989A (zh) * | 2012-04-09 | 2013-10-23 | 北京自动化控制设备研究所 | 一种捷联惯导***内杆臂的估计与误差补偿方法 |
CN104019828A (zh) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | 高动态环境下惯性导航***杆臂效应误差在线标定方法 |
CN106052715A (zh) * | 2016-05-23 | 2016-10-26 | 西北工业大学 | 单轴旋转捷联惯导***回溯式自对准方法 |
CN106482746A (zh) * | 2016-11-25 | 2017-03-08 | 北京航空航天大学 | 一种用于混合式惯导***的加速度计内杆臂标定与补偿方法 |
CN110940357A (zh) * | 2019-12-20 | 2020-03-31 | 湖北航天技术研究院总体设计所 | 一种用于旋转惯导单轴自对准的内杆臂标定方法 |
CN112595350A (zh) * | 2020-12-31 | 2021-04-02 | 福建星海通信科技有限公司 | 一种惯导***自动标定方法及终端 |
Non-Patent Citations (3)
Title |
---|
QIANGWEN FU ET.AL: "Automatic Estimation of Dynamic Lever Arms for a Position and Orientation System", 《SENSORS》, vol. 18, no. 12, 31 December 2018 (2018-12-31), pages 1 - 19 * |
常振军等: "基于尺寸效应在线补偿的旋转捷联惯性导航***初始对准", 《兵工学报》, vol. 41, no. 10, 31 October 2020 (2020-10-31), pages 2019 - 2022 * |
胡华峰等: "一种用于旋转式惯导自对准的内杆臂标定方法", 《电光与控制》, vol. 27, no. 2, 29 February 2020 (2020-02-29), pages 1314 - 1321 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN105203129B (zh) | 一种惯导装置初始对准方法 | |
EP3933166B1 (en) | Attitude measurement method | |
CN109596018B (zh) | 基于磁测滚转角速率信息的旋转弹飞行姿态高精度估计方法 | |
CN112629538A (zh) | 基于融合互补滤波和卡尔曼滤波的舰船水平姿态测量方法 | |
CN111121766B (zh) | 一种基于星光矢量的天文与惯性组合导航方法 | |
CN106989761B (zh) | 一种基于自适应滤波的空间飞行器制导工具在轨标定方法 | |
CN103630146B (zh) | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 | |
CN109596144B (zh) | Gnss位置辅助sins行进间初始对准方法 | |
CN111024074B (zh) | 一种基于递推最小二乘参数辨识的惯导速度误差确定方法 | |
CN113340298B (zh) | 一种惯导和双天线gnss外参标定方法 | |
CN106153069B (zh) | 自主导航***中的姿态修正装置和方法 | |
CN110702113B (zh) | 基于mems传感器的捷联惯导***数据预处理和姿态解算的方法 | |
CN111207745A (zh) | 一种适用于大机动无人机垂直陀螺仪的惯性测量方法 | |
CN111307114B (zh) | 基于运动参考单元的水面舰船水平姿态测量方法 | |
CN112880669A (zh) | 一种航天器星光折射和单轴旋转调制惯性组合导航方法 | |
CN114526731A (zh) | 一种基于助力车的惯性组合导航方向定位方法 | |
CN109506674B (zh) | 一种加速度的校正方法及装置 | |
CN113008229A (zh) | 一种基于低成本车载传感器的分布式自主组合导航方法 | |
JP4527171B2 (ja) | 単一gpsと慣性データ(加速度,角速度)によるビークル姿勢角の計測方法 | |
CN111141285B (zh) | 一种航空重力测量装置 | |
CN110940357B (zh) | 一种用于旋转惯导单轴自对准的内杆臂标定方法 | |
CN109916399B (zh) | 一种阴影下的载体姿态估计方法 | |
CN113418535A (zh) | 基于二维内杆臂估计的旋转惯导***多位置对准方法 | |
CN114111792A (zh) | 一种车载gnss/ins/里程计组合导航方法 | |
CN113029197A (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 | ||
WD01 | Invention patent application deemed withdrawn after publication |
Application publication date: 20210921 |
|
WD01 | Invention patent application deemed withdrawn after publication |