CN106895853B - 一种电磁计程仪辅助船用陀螺罗经行进间对准方法 - Google Patents
一种电磁计程仪辅助船用陀螺罗经行进间对准方法 Download PDFInfo
- Publication number
- CN106895853B CN106895853B CN201710183020.0A CN201710183020A CN106895853B CN 106895853 B CN106895853 B CN 106895853B CN 201710183020 A CN201710183020 A CN 201710183020A CN 106895853 B CN106895853 B CN 106895853B
- Authority
- CN
- China
- Prior art keywords
- north
- acceleration
- alignment
- link
- comparator
- 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)
- Navigation (AREA)
Abstract
本发明公开了一种电磁计程仪辅助船用陀螺罗经行进间对准方法,北向加速度输入与北向对准回路反馈量进入第一比较器后经积分环节进入第二比较器,第二比较器中加入初始速度并减去参考速度,再经过修正环节后分为北向对准回路和方位对准回路,在北向对准回路输出东向失准角,在方位对准回路输出方位失准角。本发明利用电磁计程仪追踪舰船的机动速度,并且通过加速度测量补偿来消除地球自转角速度转换到导航坐标系的误差,即可实现舰船用捷联惯性导航系统行进间精对准问题,大大提高了载体机动能力,是行之有效的行进间初始对准方法。
Description
技术领域
本发明主要涉及陀螺导航,尤其是一种电磁计程仪辅助船用陀螺罗经行进间对准方法。
背景技术
捷联惯性导航行进间初始对准是指载体在运动过程中完成惯性导航系统初始对准的技术,因此,它是动基座初始对准技术的一种。惯性导航行进间初始对准技术对于增强载体的机动能力和快速反应能力具有不可估量的意义和作用。
与传统的静基座初始对准环境不同,一方面在载体运动状态下,载体的位置、速度、加速度以及角速度都在不断地发生变化,因而对初始对准将产生影响;另一方面,线运动会使惯性导航基本方程中的对地加速度、哥式加速度等参量时刻变化,因此在运动状态下无法利用加速度计输出数据测得重力加速度的精确信息;运动条件下载体振动使得干扰角速度具有很宽的频带,陀螺仪输出信号信噪比较低,无法从陀螺仪输出数据中将地球自转角速度这一对准的有用信息提取出来。
因此,传统的罗经法对准不适合行进间对准,在载体运动条件下,不能单纯的依靠陀螺仪和加速度计的直接测量信息进行初始对准。并且,现有的加速度补偿方法采用电磁计程仪速度的微分。由于低采样频率,积分误差的存在,这种方法不适合于高精度的捷联惯性导航系统。
发明内容
发明目的:针对上述现有技术存在的缺陷,本发明旨在提供一种电磁计程仪辅助船用陀螺罗经行进间对准方法,引入测距、测速信息,以补偿运动过程中有害加速度对初始对准精度的影响。
技术方案:一种电磁计程仪辅助船用陀螺罗经行进间对准方法,包括如下步骤:北向加速度输入与北向对准回路反馈量进入第一比较器后经积分环节进入第二比较器,第二比较器中加入初始速度并减去参考速度,再经过修正环节后分为北向对准回路和方位对准回路,所述修正环节包括第一惯性环节和微分环节;
在北向对准回路中经过第一比例环节后进入第三比较器再经过积分环节后输出东向失准角,同时与重力加速度相乘后作为北向对准回路反馈量;
在方位对准回路中经过第二惯性环节和第二比例环节后进入第四比较器,再通过积分环节后输出方位失准角,同时与罗经项相乘后作为北向对准回路作用值;
所述第三比较器中加入陀螺漂移在导航坐标中东向上的投影并减去第一控制角速率和北向对准回路作用值;
所述第四比较器中加入第二控制角速率和陀螺漂移在导航坐标中天向上的投影。
进一步的,所述北向加速度输入包括北向加速度与加速计偏置在导航坐标系中北向的投影。
进一步的,所述参考速度为电磁计程仪通过外测速得到的参考速度VrN:
VrN=VN+δVrN
其中,VN为北向速度,δVrN为电磁计程仪的测量速度误差。
进一步的,第一惯性环节为1/(s+k1),第二惯性环节为1/(s+k2),第一比例环节为kN,第二比例环节kU;其中k1,k2,kN,kU均为罗经对准回路的系统参数,具体选择如下:
进一步的,所述导航坐标系中加速度计的输出
有益效果:本发明首先在传统静基座罗经法对准的结构中加入速度和加速度,然后再进行加速度影响的误差分析,最后利用电磁计程仪输出的参考速度对行进间罗经法对准进行加速度补偿,最终实现高精度的姿态对准和位置导航。本发明不仅适合于静态或者系泊的舰船,还能够适用于航行中的舰船进行罗经法对准,在工程中的运用具有一定得参考价值;利用电磁计程仪追踪舰船的机动速度,并且通过加速度测量补偿来消除地球自转角速度转换到导航坐标系的误差,即可实现舰船用捷联惯性导航系统行进间精对准问题,大大提高了载体机动能力,是行之有效的行进间初始对准方法。
附图说明
图1为北向四阶罗经法对准回路的结构图;
图2为加速度为常值时的仿真结果图;
图3为加速度为周期性信号时的仿真结果图;
图4为本发明的系统结构图;
图5a、5b分别为情况A时传统方法方位失准角、水平失准角的结果图;
图6a、6b分别为情况A时本发明方位失准角、水平失准角的结果图;
图7a、7b分别为情况B时传统方法方位失准角、水平失准角的结果图;
图8a、8b分别为情况B时本发明方位失准角、水平失准角的结果图。
具体实施方式
下面通过实施例并结合附图对本技术方案进行详细说明。
(1)建立捷联惯性导航系统的行进间罗经法对准结构:
为了分析航海用捷联惯性导航系统行进间罗经法对准,在传统静基座下的罗经法对准结构图中加入了速度和加速度。北向四阶罗经法对准回路的结构图如图1所示。
图1中,g是重力加速度,ωie为地球自转角速度,εE,εU分别为陀螺漂移在导航坐标系中东向和天向上的投影,AN是北向加速度,当船静止时,其值等于0,ΔAN是加速计偏置在导航坐标系中北向的投影,为当地纬度,α,γ分别为东向和方位失准角,k1,k2,kN,kU分别为罗经对准回路的系统参数,为控制角速率,其用来调节捷联姿态矩阵至适当值。
罗经法对准的关键是设计控制角速率,从图1可得角速率控制方程:
式中,fn为导航坐标系中加速度计的输出,为其在导航坐标系中北向的投影。如果是静基座下罗经法对准,fn应该是重力加速度和加速度计偏置之和。但是当在航行中的舰船中使用罗经法对准时,加速度计的输出应该如下:
式中,VE,VN分别为东向和北向速度,R为地球半径。当罗经法对准在静基座下执行时,是由初始位置决定的常值向量,An和都为0。因此当计算控制角速率时他们的影响可以忽略。当舰船在海上航行时,变成一个变量并且An和不再等于0。当用加速计输出来计算控制角速率时,他们应该被补偿掉。
从上面的两个式子可知,对于计算控制角速率,加速度、速度和纬度是必要的。速度不是包含在罗经对准回路中的,因此来自辅助传感器的外速度是必要的。通常,电磁计程仪被作为辅助传感器来提供载体坐标系中y轴的速度。当捷联姿态矩阵是从粗对准获得的,我们可以将电磁计程仪的速度从载体坐标系转到导航坐标系中,从而很容易地获得导航坐标系中的速度。然后我们对导航坐标系中的速度进行积分从而实时更新当地纬度。
(2)加速度影响误差分析
从以上分析所知,为了把静基座下罗经对准扩展到动基座下罗经对准,应该考虑舰船的加速度。这部分我们将分析舰船加速度对罗经对准的影响。
根据图1,北向加速度与东向失准角,方位失准角之间的传递函数可以表示如下:
罗经对准回路的系统参数可以选择如下:
式中,ωn,ξ分别为振荡频率和阻尼系数。把系统参数代入北向加速度与东向失准角,方位失准角之间的传递函数可得
通过观察上式,我们发现北向加速度AN(s)对东向失准角的影响可以分成两部分。第一部分是一个二阶的临界阻尼系统
另外一个是一个二阶阻尼系统
根据二阶系统的时域相应特性,我们可以得到如下的结论。当北向加速度是阶跃信号时,α(s)不但有瞬态误差,还有稳态误差。随着加速度幅度的增大,α(s)同时增大。当北向加速度是周期信号时,α(s)将会振荡,幅度与加速度成正比。
为了详细观察不同种类的加速度的时域相应特性,对其进行了仿真实验。罗经对准回路参数选择如下:ξ=0.707,ωn=0.08。北向加速度设置成恒定的形式和周期的形式,AN(t)=V0(V0分别为0.1m/s2,0.5m/s2,1.5m/s2)和AN(t)=V0sin(ωt)(V0分别为0.1m/s2,0.5m/s2,1.5m/s2,ω=π/4)。罗经对准对这些加速度的相应如图2和图3所示。
从图2和图3可以看出,当加速度为常值时,东向失准角存在瞬态误差和稳态误差,且误差与加速度的大小成正比。当加速度为1.5m/s2时,最大误差为11.45°,并且稳态误差为8.78°。当加速度是周期信号时,东向失准角按照与加速度相同的频率振荡。当加速度的幅值为1.5m/s2,最大误差大概为0.68°,并且相应的稳态误差幅值为0.13°。不管哪种形式的加速度,都对罗经对准系统有负面影响。两种形式的加速度对方位失准角的影响亦然。
基于上面的分析,我们发现舰船加速度对罗经法对准有很大的影响。为了实现动基座罗经法对准,必须考虑加速度的影响。
(3)罗经法对准的加速度补偿
目前加速度补偿方法采用电磁计程仪速度的微分。由于低采样频率,积分误差的存在,这种方法不适合于高精度的捷联惯性导航系统。
根据用电磁计程仪速度补偿的阻尼捷联惯性导航系统的原理,提出了一种对罗经对准的加速度补偿方法。将来自于电磁计程仪的参考速度引入到罗经对准回路中,同时考虑初始速度V0,经过加速度补偿的罗经对准的结构图如图4所示。
在图4中,北向加速度输入与北向对准回路反馈量进入第一比较器后经积分环节进入第二比较器,北向加速度输入包括北向加速度与加速计偏置在导航坐标系中北向的投影,第二比较器中加入初始速度并减去参考速度,再经过修正环节后分为北向对准回路和方位对准回路,修正环节包括第一惯性环节和微分环节;
在北向对准回路中经过第一比例环节后进入第三比较器再经过积分环节后输出东向失准角,同时与重力加速度相乘后作为北向对准回路反馈量;
在方位对准回路中经过第二惯性环节和第二比例环节后进入第四比较器,再通过积分环节后输出方位失准角,同时与罗经项相乘后作为北向对准回路作用值;
第三比较器中加入陀螺漂移在导航坐标中东向上的投影并减去第一控制角速率和北向对准回路作用值;
第四比较器中加入第二控制角速率和陀螺漂移在导航坐标中天向上的投影。
第一惯性环节为1/(s+k1),第二惯性环节为1/(s+k2),第一比例环节为kN,第二比例环节kU;其中k1,k2,kN,kU均为罗经对准回路的系统参数,具体选择如下:
VrN是电磁计程仪通过外测速得到的参考速度,比较图1和图4可知罗经对准回路输入后的惯性环节1/(s+k1)被一积分环节代替。除此之外,修正环节s/(s+k1)被引入到回路中从而使新系统与原系统是等价的。加速度的积分加上初始速度V0以及参考速度VrN可以减小加速度对罗经对准的负面影响。
电磁计程仪测量不可避免地存在速度误差,δVrN为电磁计程仪的测量速度误差,来自于电磁计程仪的参考速度可以写成北向速度和速度误差之和:
VrN=VN+δVrN
基于图4,东向失准角和舰船真实加速度,即北向加速度AN之间的传递函数如下
α(s)=0·AN(s)
同理,方位失准角γ(s)与AN,δVrN之间的传递函数如下
观察上面三式,我们发现α(s)和γ(s)都与北向加速度AN无关。也就是说,在这种罗经法对准中,加速度对失准角没有影响。东向失准角与北向失准角有相同的结果。尽管该方法中电磁计程仪的测量误差会对罗经法对准产生消极的影响,相比如传统方法中舰船加速度的影响其影响微乎其微。
陀螺和加速度计数据由捷联惯性导航系统仿真器产生的。为了清楚地观察加速度的影响,陀螺漂移和加速度计偏置都设置为0。罗经法对准回路参数设置如下:ξ=0.707,ωn=0.08。假设已经完成粗对准,并且失准角分别为0.1°,0.1°,0.5°。舰船的初始速度为1m/s,然后舰船分别按A、B两种情况在海上航行。
验证情况1:在t=7min时,舰船以0.5m/s2的加速度行驶10s。两种方法的性能分别如图5a、5b、6a、6b所示。基于加速度影响的误差分析可知,当舰船加速时,水平和方位失准角会产生波动,尤其是方位角,其会在120°和-210°之间波动。但是在运用本发明提出的方法之后,水平失准角小于0.002°,方位失准角小于0.12°。
验证情况2:舰船一直以周期性的加速度0.5sin(πt/4)(m/s2)在海上行驶。图7a、7b、8a、8b给出了在周期性加速度作用下水平和方位失准角的结果。与此同时,本发明所提出的方法有效地减小了失准角。
无论哪种形式的加速度,通过进一步观察发现经过速度和加速度补偿之后,失准角依然存在残留误差。从理论上讲,由于舰船机动引起的加速度完全可以通过本发明提出的方法补偿掉。因为电磁计程仪测量的参考速度是沿着载体坐标系y轴方向上的,粗对准之后,通过姿态矩阵其被转到导航坐标系中,尽管电磁计程仪输出是精确的,但是参考速度依然存在转换误差。
应理解以上实施例仅用于说明本发明而不用于限制本发明的范围,在阅读了本发明之后,本领域普通技术人员对本发明的各种等价形式的修改均落于本申请所附权利要求所限定的范围。
Claims (6)
1.一种电磁计程仪辅助船用陀螺罗经行进间对准方法,其特征在于,包括如下步骤:北向加速度输入与北向对准回路反馈量进入第一比较器后经积分环节进入第二比较器,第二比较器中加入初始速度并减去参考速度,再经过修正环节后分为北向对准回路和方位对准回路,所述修正环节包括第一惯性环节和微分环节;
在北向对准回路中经过第一比例环节后进入第三比较器再经过积分环节后输出东向失准角,同时与重力加速度相乘后作为北向对准回路反馈量;
在方位对准回路中经过第二惯性环节和第二比例环节后进入第四比较器,再通过积分环节后输出方位失准角,同时与罗经项相乘后作为北向对准回路作用值;
所述第三比较器中加入陀螺漂移在导航坐标系中东向上的投影并减去第一控制角速率和北向对准回路作用值;
所述第四比较器中加入第二控制角速率和陀螺漂移在导航坐标系中天向上的投影;
其中第一惯性环节为1/(s+k1),第二惯性环节为1/(s+k2),第一比例环节为kN,第二比例环节kU;其中k1,k2,kN,kU均为罗经对准回路的系统参数,具体选择如下:
2.根据权利要求1所述的一种电磁计程仪辅助船用陀螺罗经行进间对准方法,其特征在于,所述北向加速度输入包括北向加速度与加速计偏置在导航坐标系中北向的投影。
3.根据权利要求1所述的一种电磁计程仪辅助船用陀螺罗经行进间对准方法,其特征在于,所述参考速度为电磁计程仪通过外测速得到的参考速度VrN:
VrN=VN+δVrN
其中,VN为北向速度,δVrN为电磁计程仪的测量速度误差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710183020.0A CN106895853B (zh) | 2017-03-24 | 2017-03-24 | 一种电磁计程仪辅助船用陀螺罗经行进间对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710183020.0A CN106895853B (zh) | 2017-03-24 | 2017-03-24 | 一种电磁计程仪辅助船用陀螺罗经行进间对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN106895853A CN106895853A (zh) | 2017-06-27 |
CN106895853B true CN106895853B (zh) | 2020-04-24 |
Family
ID=59192408
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710183020.0A Active CN106895853B (zh) | 2017-03-24 | 2017-03-24 | 一种电磁计程仪辅助船用陀螺罗经行进间对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN106895853B (zh) |
Families Citing this family (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108132061B (zh) * | 2017-11-17 | 2021-05-18 | 北京计算机技术及应用研究所 | 一种罗经方位对准的参数设置方法 |
CN108803373B (zh) * | 2018-04-16 | 2021-03-26 | 上海微小卫星工程中心 | 一种三轴转台的地速消除方法 |
CN109751996A (zh) * | 2018-12-24 | 2019-05-14 | 南京邮电大学 | 一种捷联式罗经系统外水平阻尼方法 |
CN113008269B (zh) * | 2021-02-09 | 2022-07-26 | 西北工业大学 | 水下航行器捷联惯导系统发射后行进间快速初始对准方法 |
CN116499492A (zh) * | 2022-12-05 | 2023-07-28 | 华中光电技术研究所(中国船舶集团有限公司第七一七研究所) | 一种基于dvl辅助的匀速直航下捷联罗经粗对准方法 |
CN116295389B (zh) * | 2023-05-23 | 2023-08-04 | 中国船舶集团有限公司第七〇七研究所 | 一种捷联罗经系统状态平稳切换方法、装置、设备和介质 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103389113A (zh) * | 2013-07-19 | 2013-11-13 | 哈尔滨工程大学 | 基于惯性传感器输出误差补偿的动基座惯导初始对准方法 |
CN103471616A (zh) * | 2013-09-04 | 2013-12-25 | 哈尔滨工程大学 | 一种动基座sins大方位失准角条件下初始对准方法 |
CN106052682A (zh) * | 2016-05-13 | 2016-10-26 | 北京航空航天大学 | 一种混合式惯性导航系统及导航方法 |
-
2017
- 2017-03-24 CN CN201710183020.0A patent/CN106895853B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103389113A (zh) * | 2013-07-19 | 2013-11-13 | 哈尔滨工程大学 | 基于惯性传感器输出误差补偿的动基座惯导初始对准方法 |
CN103471616A (zh) * | 2013-09-04 | 2013-12-25 | 哈尔滨工程大学 | 一种动基座sins大方位失准角条件下初始对准方法 |
CN106052682A (zh) * | 2016-05-13 | 2016-10-26 | 北京航空航天大学 | 一种混合式惯性导航系统及导航方法 |
Non-Patent Citations (2)
Title |
---|
基于外参考速度辅助的行进间罗经法对准;刘义亭等;《中国惯性技术学报》;20150430;第23卷(第2期);第1-3节 * |
捷联惯导系统罗经法自对准;李瑶等;《中国惯性技术学报》;20080831;第16卷(第4期);第386-389页 * |
Also Published As
Publication number | Publication date |
---|---|
CN106895853A (zh) | 2017-06-27 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN106895853B (zh) | 一种电磁计程仪辅助船用陀螺罗经行进间对准方法 | |
Bian et al. | Inertial navigation | |
Huang et al. | A new fast in-motion coarse alignment method for GPS-aided low-cost SINS | |
WO2020062791A1 (zh) | 一种深海潜航器的sins/dvl水下抗晃动对准方法 | |
CN111102993A (zh) | 一种旋转调制型捷联惯导系统晃动基座初始对准方法 | |
US6459990B1 (en) | Self-contained positioning method and system thereof for water and land vehicles | |
CN100541135C (zh) | 基于多普勒的光纤陀螺捷联惯导系统初始姿态确定方法 | |
Wang et al. | Estimation of information sharing error by dynamic deformation between inertial navigation systems | |
Chang et al. | Gravity disturbance compensation for inertial navigation system | |
CN104501838B (zh) | 捷联惯导系统初始对准方法 | |
CN103076026B (zh) | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
Fu et al. | Autonomous in-motion alignment for land vehicle strapdown inertial navigation system without the aid of external sensors | |
CN111024074B (zh) | 一种基于递推最小二乘参数辨识的惯导速度误差确定方法 | |
Cui et al. | In-motion alignment for low-cost SINS/GPS under random misalignment angles | |
CN105910623B (zh) | 利用磁强计辅助gnss/mins紧组合系统进行航向校正的方法 | |
Bryne et al. | Attitude and heave estimation for ships using MEMS-based inertial measurements | |
CN102168978A (zh) | 一种船用惯性导航系统摇摆基座开环对准方法 | |
CN113739806B (zh) | 利用参数识别的惯导系统阻尼方法 | |
CN105300407B (zh) | 一种用于单轴调制激光陀螺惯导系统的海上动态启动方法 | |
CN110319833A (zh) | 一种无误差的光纤陀螺捷联惯导系统速度更新方法 | |
Sun et al. | A robust in-motion attitude alignment method for odometer-aided strapdown inertial navigation system | |
Nie et al. | Research on accuracy improvement of INS with continuous rotation | |
Sushchenko | Mathematical model of triaxial multimode attitude and heading reference system | |
Liu et al. | Velocity-aided in-motion alignment for SINS based on pseudo-Earth frame |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |