CN108413982B - 一种舰船动态对准位置杆臂补偿方法 - Google Patents
一种舰船动态对准位置杆臂补偿方法 Download PDFInfo
- Publication number
- CN108413982B CN108413982B CN201711390290.5A CN201711390290A CN108413982B CN 108413982 B CN108413982 B CN 108413982B CN 201711390290 A CN201711390290 A CN 201711390290A CN 108413982 B CN108413982 B CN 108413982B
- Authority
- CN
- China
- Prior art keywords
- lever arm
- position lever
- inertial navigation
- navigation
- dynamic
- 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
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)
- Position Fixing By Use Of Radio Waves (AREA)
- Details Of Aerials (AREA)
Abstract
本发明涉及一种舰船动态对准位置杆臂补偿方法,其技术特点是包括以下步骤:以惯导***为中心,测得卫导接收天线所处位置与惯导的三维空间距离;根据姿态矩阵计算位置杆臂投影;位置杆臂在卡尔曼滤波观测矩阵的补偿。本发明基于位置杆臂在载体坐标系和导航坐标系投影值的关系进行位置杆臂补偿,较好地解决了惯性导航***动态初始对准这一实际工程应用问题,使得***初始对准动态适应性有了保证,提高动态对准精度;同时,本发明在补偿位置杆臂误差时,计算方法简单,能够有效补偿位置杆臂引起的动态初始对准误差,提高初始对准载体机动适应性,可广泛用于舰船导航领域。
Description
技术领域
本发明属于惯性导航技术领域,尤其是一种舰船动态对准位置杆臂补偿方法。
背景技术
在大型舰船上,惯导与卫导接收天线的安装位置通常相距很远,两个***之间安装位置的三维空间差称之为杆臂。由于杆臂的存在,当载体摇摆时,惯性导航***的加速度计会产生离心加速度和切向加速度,导致加速度计产生测量误差,进而产生额外的速度误差。现有对杆臂效应的研究大都集中在杆臂效应对速度匹配方法的影响,很少涉及到位置匹配初始对准影响。
实际上,由于舰船的运动,尤其是航向的变化,会导致位置杆臂投影到导航坐标系后是变化的,会在位置匹配观测模式下引入较大的观测误差,进而引起初始对准效果变差,因此有必要对位置匹配模式下的位置杆臂进行补偿。
发明内容
本发明的目地在于克服现有技术的不足,提出一种舰船动态对准位置杆臂补偿方法,解决位置杆臂对舰船动态对准影响大的问题。
本发明解决其技术问题是采取以下技术方案实现的:
一种舰船动态对准位置杆臂补偿方法,包括以下步骤:
步骤1:以惯导***为中心,测得卫导接收天线所处位置与惯导的三维空间距离;
步骤2、根据姿态矩阵计算位置杆臂投影;
步骤3、位置杆臂在卡尔曼滤波观测矩阵的补偿。
所述步骤2计算位置杆臂投影采用如下公式:
xb,yb,zb为卫导接收天线所处坐标在惯导***所定义的坐标,xn,yn,zn为卫导接收天线在导航坐标系的投影。
所述步骤3采用如下公式进行补偿:
δL为纬度误差;δλ为经度误差;δh为高程误差;Lins为惯导纬度;Lgnss为卫导纬度;π为圆周率,取为3.141592653589793;λins为惯导经度;λgnss为卫导经度;hins为惯导高程;hgnss为卫导高程。
本发明的优点和积极效果是:
本发明基于位置杆臂在载体坐标系和导航坐标系投影值的关系进行位置杆臂补偿,较好地解决了惯性导航***动态初始对准这一实际工程应用问题,使得***初始对准动态适应性有了保证,提高动态对准精度;同时,本发明在补偿位置杆臂误差时,计算方法简单,能够有效补偿位置杆臂引起的动态初始对准误差,提高初始对准载体机动适应性。
附图说明
图1是本发明的处理流程图;
图2是本发明的卫导接收天线与惯导位置示意图。
具体实施方式
以下结合附图对本发明实施例做进一步详述。
一种舰船动态对准位置杆臂补偿方法,如图1所示,包括以下步骤:
步骤1、以惯导***为中心,测得卫导接收天线所处位置与惯导的三维空间距离(卫导与惯导距离)。
如图2所示,以惯导***所在位置为原点,指向右舷为x轴正向,指向舰艏为y轴正向,垂直舰面指向天为z轴正向,按照定义的坐标系,测得卫导接收天线所处位置与惯导的三维空间距离,则卫导接收天线所处坐标在惯导***所定义的坐标为(xb,yb,zb)。
步骤2、根据姿态矩阵计算位置杆臂投影。
在载体坐标系中,卫导接收天线相对惯性导航***的位置是不变的,其在导航坐标系的投影(xn,yn,zn),随着载体姿态、航向的变化而变化。卫导接收天线坐标在导航坐标系投影与在载体坐标系投影关系如下:
步骤3、位置杆臂在卡尔曼滤波观测矩阵的补偿。
本发明是通过补偿卡尔曼滤波观测矩阵实现的。卫导相对惯导的位置杆臂投影到导航坐标系后,xn指南北向,影响纬度误差,yn指东西向,影响经度误差,zn指天向,影响垂向误差。根据观测方程,可以得到位置杆臂补偿方法。由于卫导位置坐标单位为m,需要转换成与经纬度相同的单位rad,则观测方程位置杆臂具体补偿公式如下:
δL为纬度误差;δλ为经度误差;δh为高程误差;Lins为惯导纬度;Lgnss为卫导纬度;π为圆周率,取为3.141592653589793;λins为惯导经度;λgnss为卫导经度;hins为惯导高程;hgnss为卫导高程。
通过以上步骤,可实现惯性导航***动态对准位置杆臂补偿的功能,有效地提高动态对准精度。
需要强调的是,本发明所述的实施例是说明性的,而不是限定性的,因此本发明包括并不限于具体实施方式中所述的实施例,凡是由本领域技术人员根据本发明的技术方案得出的其他实施方式,同样属于本发明保护的范围。
Claims (1)
1.一种舰船动态对准位置杆臂补偿方法,其特征在于包括以下步骤:
步骤1:以惯导***为中心,测得卫导接收天线所处位置与惯导的三维空间距离;
步骤2、根据姿态矩阵计算位置杆臂投影;
步骤3、位置杆臂在卡尔曼滤波观测矩阵的补偿;
所述步骤2计算位置杆臂投影采用如下公式:
xb,yb,zb为卫导接收天线所处坐标在惯导***所定义的坐标,xn,yn,zn为卫导接收天线在导航坐标系的投影;
所述步骤3采用如下公式进行补偿:
δL为纬度误差;δλ为经度误差;δh为高程误差;Lins为惯导纬度;Lgnss为卫导纬度;π为圆周率,取为3.141592653589793;λins为惯导经度;λgnss为卫导经度;hins为惯导高程;hgnss为卫导高程。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711390290.5A CN108413982B (zh) | 2017-12-21 | 2017-12-21 | 一种舰船动态对准位置杆臂补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201711390290.5A CN108413982B (zh) | 2017-12-21 | 2017-12-21 | 一种舰船动态对准位置杆臂补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108413982A CN108413982A (zh) | 2018-08-17 |
CN108413982B true CN108413982B (zh) | 2021-07-23 |
Family
ID=63125608
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201711390290.5A Active CN108413982B (zh) | 2017-12-21 | 2017-12-21 | 一种舰船动态对准位置杆臂补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108413982B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110887508B (zh) * | 2019-11-30 | 2023-04-28 | 航天科技控股集团股份有限公司 | 一种车载导航产品动态定位功能检测方法 |
CN114353792A (zh) * | 2022-03-16 | 2022-04-15 | 长沙金维信息技术有限公司 | 车载组合导航***中惯导***的杆臂测量方法及导航方法 |
CN115201866B (zh) * | 2022-09-16 | 2022-12-09 | 中国船舶重工集团公司第七0七研究所 | 一种大型水面舰船惯导及北斗紧耦合方案空间修正方法 |
CN117928395B (zh) * | 2024-03-25 | 2024-06-04 | 华北电力大学(保定) | 一种用于舰机传递对准中多杆臂矢量的实时测量方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103090867A (zh) * | 2012-11-02 | 2013-05-08 | 哈尔滨工程大学 | 相对地心惯性系旋转的光纤陀螺捷联惯性导航***误差抑制方法 |
CN103235327A (zh) * | 2013-04-07 | 2013-08-07 | 清华大学 | 一种gnss/mins超深组合导航方法、***及装置 |
CN103557876A (zh) * | 2013-11-15 | 2014-02-05 | 山东理工大学 | 一种用于天线跟踪稳定平台的捷联惯导初始对准方法 |
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN107270893A (zh) * | 2017-05-27 | 2017-10-20 | 东南大学 | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 |
-
2017
- 2017-12-21 CN CN201711390290.5A patent/CN108413982B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103090867A (zh) * | 2012-11-02 | 2013-05-08 | 哈尔滨工程大学 | 相对地心惯性系旋转的光纤陀螺捷联惯性导航***误差抑制方法 |
CN103235327A (zh) * | 2013-04-07 | 2013-08-07 | 清华大学 | 一种gnss/mins超深组合导航方法、***及装置 |
CN103557876A (zh) * | 2013-11-15 | 2014-02-05 | 山东理工大学 | 一种用于天线跟踪稳定平台的捷联惯导初始对准方法 |
CN104181572A (zh) * | 2014-05-22 | 2014-12-03 | 南京理工大学 | 一种弹载惯性/卫星紧组合导航方法 |
CN107270893A (zh) * | 2017-05-27 | 2017-10-20 | 东南大学 | 面向不动产测量的杆臂、时间不同步误差估计与补偿方法 |
Non-Patent Citations (3)
Title |
---|
IMU calibration on a low grade turntable Embedded estimation of the instrument displacement from the axis of rotation;Alexander K等;《Advances in Space Research》;20141231;第48卷(第5期);1-4 * |
杆臂效应对捷联惯性导航***初始对准精度的影响及其在线补偿方法研究;徐晓苏等;《中国惯性技术学报》;19941231;第2卷(第2期);22-27 * |
激光陀螺惯组***级标定方法;孙伟强等;《中国惯性技术学报》;20160228;第24卷(第1期);9-13,25 * |
Also Published As
Publication number | Publication date |
---|---|
CN108413982A (zh) | 2018-08-17 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108413982B (zh) | 一种舰船动态对准位置杆臂补偿方法 | |
CN110764119B (zh) | 不依赖于卫星导航信息的卫星天线自主测控方法及*** | |
CN108535755B (zh) | 基于mems的gnss/imu车载实时组合导航方法 | |
CN104121905B (zh) | 一种基于惯性传感器的航向角获取方法 | |
CN107315345B (zh) | 基于双天线gnss和预瞄追踪模型的农机自动导航控制方法 | |
CN108594283B (zh) | Gnss/mems惯性组合导航***的自由安装方法 | |
CN110926468B (zh) | 基于传递对准的动中通天线多平台航姿确定方法 | |
KR102360465B1 (ko) | 항법용 관성센서 캘리브레이션 방법 | |
CN104880189B (zh) | 一种动中通天线低成本跟踪抗干扰方法 | |
CN105973268B (zh) | 一种基于共基座安装的传递对准精度定量评估方法 | |
CN108303079B (zh) | 一种水下usbl反向应用的数据平滑方法 | |
CN108931244A (zh) | 基于列车运动约束的惯导误差抑制方法及*** | |
CN103528536B (zh) | 一种基于光纤陀螺惯导***的船体变形测量方法 | |
CN108627152B (zh) | 一种微型无人机基于多传感器数据融合的导航方法 | |
CN107219542B (zh) | 基于gnss/odo的机器人双轮差速定位方法 | |
CN104776847B (zh) | 一种适用于水下导航***单点估计陀螺漂移的方法 | |
CN113220013A (zh) | 一种多旋翼无人机隧洞悬停方法及*** | |
CN112050807B (zh) | 一种基于时间同步补偿的sins_gnss组合导航方法 | |
CN110133695A (zh) | 一种双天线gnss位置延迟时间动态估计***及方法 | |
CN111307114B (zh) | 基于运动参考单元的水面舰船水平姿态测量方法 | |
CN115388884A (zh) | 一种智能***姿估计器联合初始化方法 | |
JP2013228318A (ja) | キャリブレーション良否判定装置及び方法 | |
CN104634348B (zh) | 组合导航中的姿态角计算方法 | |
CN106403999A (zh) | 基于gnss的惯性导航加速度计漂移实时补偿方法 | |
CN115542363B (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 |