CN115773751A - 一种修正等效天向加计零位造成对准误差的方法 - Google Patents
一种修正等效天向加计零位造成对准误差的方法 Download PDFInfo
- Publication number
- CN115773751A CN115773751A CN202310101150.0A CN202310101150A CN115773751A CN 115773751 A CN115773751 A CN 115773751A CN 202310101150 A CN202310101150 A CN 202310101150A CN 115773751 A CN115773751 A CN 115773751A
- Authority
- CN
- China
- Prior art keywords
- error
- alignment
- inertial navigation
- navigation system
- gyro drift
- 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.)
- Granted
Links
Images
Classifications
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T90/00—Enabling technologies or technologies with a potential or indirect contribution to GHG emissions mitigation
Landscapes
- Navigation (AREA)
Abstract
本发明属于惯性导航系统误差补偿技术领域,具体涉及一种修正等效天向加计零位造成对准误差的方法,包括:建立机载惯导对准卡尔曼滤波器,对准估计滤波修正量;利用对准结束时的天向速度计算等效天向加计零位;计算等效天向加计零位引起的耦合平台偏角误差和漂移误差;计算最终的平台失准角和陀螺漂移修正值并修正,完成惯导对准误差估计修正环节。本发明在不增加额外设备的前提下,通过现有对准滤波器和对准输出,计算并补偿耦合误差,提升惯导系统对准和导航精度。
Description
技术领域
本发明属于惯性导航系统误差补偿技术领域,具体涉及一种修正等效天向加计零位造成对准误差的方法。
背景技术
惯导系统现有自对准方式主要是采用卡尔曼滤波方法,以其自身惯性解算的速度位置误差作为滤波器的量测变量,结合惯导系统的误差传播方程,对惯导系统的姿态误差、速度误差、位置误差和器件误差进行估计与补偿,建立惯导系统的初始状态。其中法向轴加计零位会引起姿态误差,但是现有的卡尔曼滤波估计过程中,法向加计零位的可观测性较弱,其结果一般无法准确估计,因此加计零位耦合的姿态误差无法被常规滤波过程估计与修正,这会影响惯导系统对准精度,进而造成导航定位精度下降。尤其是当载机处于非严格的水平姿态下进行对准,如载机在位于稍有倾斜的机场平面对准,该误差项影响会更加显著。
发明内容
本发明的目的:提出一种修正等效天向加计零位造成对准误差的方法,通过对准结束时刻的天向速度计算等效天向加计零位,结合对准结束时的惯导系统姿态,计算等效天向加计零位引起的耦合平台失准角误差与陀螺漂移误差,将其补偿与修正,提升惯导系统对准与导航精度。
本发明的技术方案:
本发明实施例提供一种修正等效天向加计零位造成对准误差的方法,应用于载机或其他运载体上装备的惯性导航系统,简称惯导系统,可以在惯导系统导航前的自对准阶段,修正因等效天向加计零位造成的耦合平台偏角误差和耦合陀螺漂移误差。
具体包括如下步骤:
步骤1:建立惯导系统对准卡尔曼滤波器,滤波估计惯导系统对准误差,所述惯导系统对准误差包括平台失准角误差、速度误差、位置误差、陀螺漂移、加计零位;
步骤2:利用惯导系统对准结束时的天向速度,计算该时刻的等效天向加计零位;
步骤3:利用对准结束时刻的惯导姿态角,计算该时刻姿态矩阵;
步骤4:利用所述步骤3得到的姿态矩阵与所述步骤2得到等效天向加计零位计算耦合平台偏角误差;利用对准结束时刻姿态矩阵与耦合平台偏角误差计算陀螺漂移耦合项;所述耦合平台偏角误差是指等效天向加计零位项在惯导系统误差传播过程中引起的平台失准角误差项;所述陀螺漂移耦合项是指耦合平台偏角误差在惯导系统误差传播过程中引起的陀螺漂移量;
步骤5:计算惯导系统对准过程平台偏角误差修正量与陀螺漂移修正量;所述平台偏角误差修正量包括所述步骤1中的平台失准角误差、所述步骤4中的耦合平台偏角误差;所述陀螺漂移修正量包括所述步骤1中的陀螺漂移、所述步骤4中的陀螺漂移耦合项;
步骤6:利用所述步骤5计算得到的平台偏角误差修正量修正平台失准角误差;利用所述步骤5计算得到的陀螺漂移修正量修正陀螺漂移。
其中:
状态变量:
表示时刻对应的纬度误差、表示时刻对应的经度误差,表示时刻对应的东向速度误差、表示时刻对应的北向速度误差,表示东向平台失准角、表示北向平台失准角、表示天向平台失准角,表示载体X轴陀螺漂移、表示载体Y轴陀螺漂移、表示载体Z轴陀螺漂移,表示载体X轴加计零位、表示载体Y轴加计零位、表示载体Z轴加计零位,共13维;
矩阵中分别为地球子午圈和卯酉圈半径,分别为地球自转角速度的北向和天向分量,为地球自转角速度,为惯导系统对准时的当地纬度值,为对准期间实时姿态角对应的姿态矩阵各元素,为当地重力加速度,为惯导系统计算高度值;为惯导系统实时计算的东向、北向速度;
以对准期间惯导系统的位置误差和速度为量测信息,估计系统的姿态、速度、位置以及器件误差,对准结束时可以估计出各项对准误差,分别为:
在一个可能的实施例中,在所述步骤2中,所述等效天向加计零位根据下式计算:
其中:
在一个可能的实施例中,在所述步骤3中,所述对准结束时刻姿态矩阵的计算方法为:
在一个可能的实施例中,在所述步骤4中,所述耦合平台偏角误差的计算过程如下:
其中:
正常罗经对准结束时需要修正陀螺漂移,则计算陀螺漂移耦合项:
其中:
在一个可能的实施例中,在所述步骤5中,所述平台偏角误差修正量根据下式计算:
所述陀螺漂移修正量根据下式计算:
其中:
为最终需要修正的东向平台偏角误差修正量,为最终需要修正的北向平台偏角误差修正量,为最终需要修正的天向平台偏角误差修正量;为最终需要修正的X轴陀螺漂移修正量,为最终需要修正的Y轴陀螺漂移修正量,为最终需要修正的Z轴陀螺漂移修正量;
在一个可能的实施例中,在所述步骤6中,具体包括如下步骤:
其中:
其中:
步骤6.3:如果对准结束时需要修正陀螺漂移(如正常罗经对准),则修正陀螺漂移:
其中:
在一个可能的实施例中,对于快速对准、存储航向对准方式不需要进行陀螺漂移耦合项的计算,以及陀螺漂移修正。
本发明的优点:本发明通过对准结束时的天向速度估算等效天向加计零位,结合惯导系统对准结束时刻姿态,计算天向加计零位引起的耦合平台偏角误差与陀螺漂移误差,将其补偿与修正,在不增加额外设备的前提下提升惯导系统对准与导航精度。解决传统对准卡尔曼滤波过程天向加计零位可观测性差造成的对准精度下降问题,尤其是在载机处于非严格水平的场地条件下对准,改善效果更为显著。
附图说明
图1为本发明的流程图;
图2为本发明优选实施例的俯仰角对准误差与加计零位关系图;
图3为本发明优选实施例的横滚角对准误差与加计零位关系图;
图4为本发明优选实施例的航向角对准误差与加计零位关系图;
图5为本发明优选实施例的北向陀螺漂移估计误差与加计零位关系图。
具体实施方式
下面结合附图对本发明做进一步详细描述。
如图1所示,一种修正等效天向加计零位造成对准误差的方法,包括:
步骤1:建立惯导系统对准卡尔曼滤波器,滤波估计惯导系统对准误差;
其中:
状态变量:
矩阵中分别为地球子午圈和卯酉圈半径,分别为地球自转角速度的北向和天向分量,为地球自转角速度,为惯导系统对准时的当地纬度值,为对准期间实时姿态角对应的姿态矩阵各元素,为当地重力加速度,为惯导系统计算高度值;为惯导系统实时计算的东向、北向速度;
以对准期间惯导系统的位置误差和速度为量测信息,估计系统的姿态、速度、位置以及器件误差,对准结束时可以估计出各项对准误差,分别为:
步骤2:利用对准结束时的天向速度,计算该时刻的等效天向加计零位;
其中:
步骤3:利用对准结束时刻的惯导姿态角,计算该时刻姿态矩阵;
步骤4:利用姿态矩阵与等效加计零位计算耦合平台偏角误差;
其中:
如果对准结束时需要修正陀螺漂移(如正常罗经对准),则计算陀螺漂移耦合项:
其中:
步骤5:计算惯导系统对准平台偏角误差修正量与陀螺漂移修正量;
平台偏角误差修正量:
陀螺漂移修正量:
其中:
步骤6:修正步骤5中各项对准误差:
其中:
其中:
步骤6.3:如果对准结束时需要修正陀螺漂移(如正常罗经对准),则修正陀螺漂移:
其中:
实施例1
当在经纬度为【34.0°N,108.0°E】,高度为100m的位置进行地面自对准,惯导对准所处平面的俯仰角和横滚角都为5.0度,航向角为0.0度时,假设惯导天向加计零位水平为5mg,Y轴陀螺漂移为0.01度/小时,则经过粗对准,进入精对准前惯导系统的姿态角(俯仰、横滚、航向)分别为【4.9753;4.9752;0.0146】度,当5min精对准结束时,按照步骤1的常规滤波器估计出的三轴平台失准角分别为度,基本无法估计出相对于5度真实水平姿态角的剩余误差。
随后使用步骤3计算出对准结束时刻的姿态矩阵为:
步骤4计算出耦合平台偏角误差值为:
步骤5计算出的平台偏角误差修正量为
则经过步骤6修正后,最终对准结束的姿态角(俯仰、横滚、航向)分别为:【5.0010;5.0010;-0.0004】度,Y轴陀螺漂移估计值为0.0096度/小时,相比真实姿态角(5度;5度;0度)和添加的器件误差(0.01度/小时),有效估计和补偿了天向加计零位引起的耦合平台偏角误差和与陀螺漂移误差,在不增加额外设备的前提下提升惯导系统对准与导航精度。
当天向加计零位水平为其他值时,常规地面自对准方法和使用本发明方法后的姿态对准误差与天向加计零位的关系如图2~图4所示;北向陀螺漂移估计误差百分比与天向加计零位的关系如图5所示。当天向加计存在1mg零位误差,利用本发明的误差补偿方法,天向加计零位项造成的耦合姿态和航向误差补偿精度可以达到1角秒以内。
Claims (8)
1.一种修正等效天向加计零位造成对准误差的方法,其特征在于,具体包括如下步骤:
步骤1:建立惯导系统对准卡尔曼滤波器,滤波估计惯导系统对准误差;所述惯导系统对准误差包括平台失准角误差、速度误差、位置误差、陀螺漂移、加计零位;
步骤2:利用惯导系统对准结束时的天向速度,计算该时刻的等效天向加计零位;
步骤3:利用惯导系统对准结束时刻的惯导姿态角,计算该时刻姿态矩阵;
步骤4:利用所述步骤3得到的姿态矩阵与所述步骤2得到等效天向加计零位计算耦合平台偏角误差;利用对准结束时刻姿态矩阵与耦合平台偏角误差计算陀螺漂移耦合项;所述耦合平台偏角误差是指等效天向加计零位项在惯导系统误差传播过程中引起的平台失准角误差项;所述陀螺漂移耦合项是指耦合平台偏角误差在惯导系统误差传播过程中引起的陀螺漂移量;
步骤5:计算惯导系统对准过程平台偏角误差修正量与陀螺漂移修正量;所述平台偏角误差修正量包括所述步骤1中的平台失准角误差、所述步骤4中的耦合平台偏角误差;所述陀螺漂移修正量包括所述步骤1中的陀螺漂移、所述步骤4中的陀螺漂移耦合项;
步骤6:利用所述步骤5计算得到的平台偏角误差修正量修正平台失准角误差;利用所述步骤5计算得到的陀螺漂移修正量修正陀螺漂移。
其中:
状态变量:
表示时刻对应的纬度误差、表示时刻对应的经度误差,表示时刻对应的东向速度误差、表示时刻对应的北向速度误差,表示东向平台失准角、表示北向平台失准角、表示天向平台失准角,表示载体X轴陀螺漂移、表示载体Y轴陀螺漂移、表示载体Z轴陀螺漂移,表示载体X轴加计零位、表示载体Y轴加计零位、表示载体Z轴加计零位,共13维;
矩阵中分别为地球子午圈和卯酉圈半径,分别为地球自转角速度的北向和天向分量,为地球自转角速度,为惯导系统对准时的当地纬度值,为对准期间实时姿态角对应的姿态矩阵各元素,为当地重力加速度,为惯导系统计算高度值;为惯导系统实时计算的东向、北向速度;
以对准期间惯导系统的位置误差和速度为量测信息,估计系统的姿态、速度、位置以及器件误差,对准结束时可以估计出各项对准误差,分别为:
8.根据权利要求7所述的一种修正等效天向加计零位造成对准误差的方法,其特征在于,在所述步骤6中,具体包括如下步骤:
其中:
其中:
步骤6.3:如果对准结束时需要修正陀螺漂移(如正常罗经对准),则修正陀螺漂移:
其中:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310101150.0A CN115773751B (zh) | 2023-02-13 | 2023-02-13 | 一种修正等效天向加计零位造成对准误差的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202310101150.0A CN115773751B (zh) | 2023-02-13 | 2023-02-13 | 一种修正等效天向加计零位造成对准误差的方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN115773751A true CN115773751A (zh) | 2023-03-10 |
CN115773751B CN115773751B (zh) | 2023-07-18 |
Family
ID=85393694
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202310101150.0A Active CN115773751B (zh) | 2023-02-13 | 2023-02-13 | 一种修正等效天向加计零位造成对准误差的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN115773751B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116046027A (zh) * | 2023-03-31 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 三轴旋转式惯导位置误差无源自主校准方法及系统 |
CN116222560A (zh) * | 2023-05-09 | 2023-06-06 | 北京航空航天大学 | 基于偏振时间差分的陀螺漂移与姿态失准角解耦估计方法 |
CN116625361A (zh) * | 2023-07-20 | 2023-08-22 | 中国船舶集团有限公司第七〇七研究所 | 基于误差温度补偿的惯性陀螺误差修正方法及系统 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103557876A (zh) * | 2013-11-15 | 2014-02-05 | 山东理工大学 | 一种用于天线跟踪稳定平台的捷联惯导初始对准方法 |
CN108088443A (zh) * | 2016-11-23 | 2018-05-29 | 北京自动化控制设备研究所 | 一种定位定向设备速度补偿方法 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 |
CN109443386A (zh) * | 2018-11-21 | 2019-03-08 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种实时高精度重力补偿方法 |
CN110514201A (zh) * | 2019-08-16 | 2019-11-29 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统及适用于高转速旋转体的导航方法 |
WO2020087845A1 (zh) * | 2018-10-30 | 2020-05-07 | 东南大学 | 基于gpr与改进的srckf的sins初始对准方法 |
CN114858189A (zh) * | 2022-05-09 | 2022-08-05 | 北京自动化控制设备研究所 | 捷联惯导系统陀螺漂移等效补偿方法 |
-
2023
- 2023-02-13 CN CN202310101150.0A patent/CN115773751B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103557876A (zh) * | 2013-11-15 | 2014-02-05 | 山东理工大学 | 一种用于天线跟踪稳定平台的捷联惯导初始对准方法 |
CN108088443A (zh) * | 2016-11-23 | 2018-05-29 | 北京自动化控制设备研究所 | 一种定位定向设备速度补偿方法 |
CN108318052A (zh) * | 2018-01-24 | 2018-07-24 | 北京航天控制仪器研究所 | 一种基于双轴连续旋转的混合式平台惯导系统标定方法 |
WO2020087845A1 (zh) * | 2018-10-30 | 2020-05-07 | 东南大学 | 基于gpr与改进的srckf的sins初始对准方法 |
CN109443386A (zh) * | 2018-11-21 | 2019-03-08 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种实时高精度重力补偿方法 |
CN110514201A (zh) * | 2019-08-16 | 2019-11-29 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种惯性导航系统及适用于高转速旋转体的导航方法 |
CN114858189A (zh) * | 2022-05-09 | 2022-08-05 | 北京自动化控制设备研究所 | 捷联惯导系统陀螺漂移等效补偿方法 |
Non-Patent Citations (1)
Title |
---|
薛庆全;王玮;张京娟;: "船用单轴旋转光纤陀螺惯导系统海上对准研究" * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN116046027A (zh) * | 2023-03-31 | 2023-05-02 | 中国船舶集团有限公司第七〇七研究所 | 三轴旋转式惯导位置误差无源自主校准方法及系统 |
CN116222560A (zh) * | 2023-05-09 | 2023-06-06 | 北京航空航天大学 | 基于偏振时间差分的陀螺漂移与姿态失准角解耦估计方法 |
CN116222560B (zh) * | 2023-05-09 | 2023-06-30 | 北京航空航天大学 | 基于偏振时间差分的陀螺漂移与姿态失准角解耦估计方法 |
CN116625361A (zh) * | 2023-07-20 | 2023-08-22 | 中国船舶集团有限公司第七〇七研究所 | 基于误差温度补偿的惯性陀螺误差修正方法及系统 |
CN116625361B (zh) * | 2023-07-20 | 2023-10-13 | 中国船舶集团有限公司第七〇七研究所 | 基于误差温度补偿的惯性陀螺误差修正方法及系统 |
Also Published As
Publication number | Publication date |
---|---|
CN115773751B (zh) | 2023-07-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN115773751B (zh) | 一种修正等效天向加计零位造成对准误差的方法 | |
CN111156994B (zh) | 一种基于mems惯性组件的ins/dr&gnss松组合导航方法 | |
CN108594283B (zh) | Gnss/mems惯性组合导航系统的自由安装方法 | |
US9488480B2 (en) | Method and apparatus for improved navigation of a moving platform | |
CN107270893B (zh) | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
CN109974697A (zh) | 一种基于惯性系统的高精度测绘方法 | |
CN112505737B (zh) | 一种gnss/ins组合导航方法 | |
CN102679978B (zh) | 一种旋转式捷联惯性导航系统静基座初始对准方法 | |
JPS63109320A (ja) | 飛行機の航路決定法 | |
CN110133692B (zh) | 惯导技术辅助的高精度gnss动态倾斜测量系统及方法 | |
CN115900770B (zh) | 一种机载环境下磁传感器的在线校正方法和系统 | |
CN111220151B (zh) | 载体系下考虑温度模型的惯性和里程计组合导航方法 | |
CN107179084B (zh) | Gnss兼容机伪距与加表组合导航及漂移估计方法 | |
CN112325841B (zh) | 一种动中通天线安装误差角的估计方法 | |
CN112798014A (zh) | 一种基于重力场球谐模型补偿垂线偏差的惯导自对准方法 | |
CN113236363A (zh) | 开采设备导航定位方法、系统、设备及可读存储介质 | |
CN106886037A (zh) | 适用于弱gnss信号条件的pos数据纠偏方法 | |
CN114674313B (zh) | 一种基于ckf算法的gps/bds和sins融合的无人配送车导航定位方法 | |
CN114264304B (zh) | 复杂动态环境高精度水平姿态测量方法与系统 | |
CN111007542B (zh) | 一种车载星基增强多模gnss/mimu组合导航中mimu安装误差角的计算方法 | |
CN108088463A (zh) | 一种高度传感器辅助伪卫星定位的惯导初始对准方法 | |
CN112393741A (zh) | 基于有限时间滑模的sins/bds组合导航系统空中对准方法 | |
CN110779551A (zh) | 一种基于加性四元数的两阶段线性对准在线切换方法 | |
TWI564546B (zh) | On - board Vehicle Navigation System Calibration Method |
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 |