CN101915578A - 基于光纤捷联惯性系统测量船上任意两位置间距离的方法 - Google Patents
基于光纤捷联惯性系统测量船上任意两位置间距离的方法 Download PDFInfo
- Publication number
- CN101915578A CN101915578A CN2010102221439A CN201010222143A CN101915578A CN 101915578 A CN101915578 A CN 101915578A CN 2010102221439 A CN2010102221439 A CN 2010102221439A CN 201010222143 A CN201010222143 A CN 201010222143A CN 101915578 A CN101915578 A CN 101915578A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- navigation system
- sub
- positions
- omega
- 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
Landscapes
- Navigation (AREA)
Abstract
本发明的目的在于提供基于光纤捷联惯性系统测量船上任意两位置间距离的方法。将两套子惯导系统分别放置在船的两个待测位置上,主惯导系统对准并处于导航状态,采集子惯导系统光纤陀螺仪和石英挠性加速度计输出的数据,分别建立以主惯导系统与两个子惯导系统的速度误差、姿态误差及杆臂长度作为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程,分别估计出两个子惯导系统和主惯导系统之间的距离,并矢量做差,得到两个待测位置的距离。本发明具有对准时间短、对准精度高、对器件的要求宽松等优点。
Description
技术领域
本发明涉及的是一种用于导航领域的船舶上两位置间距离的测量方法。
背景技术
捷联惯性导航系统是将惯性传感器固联在载体上,直接测量载体的加速度和角速度等运动信息,通过导航计算机对惯性传感器采集的信息进行处理,得到载体的姿态,速度及位置等导航信息的完全自主导航设备。船上一般有两套或多套惯导系统,船本身有一套精度较高的惯导系统,称为主惯导系统。船上的附属装备自身有一套惯导系统,称为子惯导系统。捷联惯性导航系统在进入导航状态前,需要确定导航的初始条件,包括初始速度、位置和姿态等,这个过程就是初始对准。根据载体在初始对准时的运动状态可以将初始对准分为两类:静基座对准和动基座对准。传递对准技术就是在动基座条件下,利用载体上已对准的高精度主惯导的信息,采用惯性信息匹配方法确定子惯导的导航初始信息及坐标系的指向。
传递对准具有对准时间短、对准精度高、对器件的要求宽松等优点。传递对准的方法可分为两类:一类是计算参数匹配,包括速度匹配和位置匹配;另一类是测量参数匹配,包括加速度匹配、角速度匹配和姿态匹配。其中速度匹配传递对准是目前为止较为成熟的匹配方法之一,它利用主惯导和子惯导之间的速度差作为观测量。
发明内容
本发明的目的在于提供对准时间短、对准精度高、对器件要求宽松的基于光纤捷联惯性系统测量船上任意两位置间距离的方法。
本发明的目的是这样实现的:
本发明基于光纤捷联惯性系统测量船上任意两位置间距离的方法,其特征是:
(1)将两套光纤陀螺捷联惯系统s1和s2作为子惯导系统分别放置在船的两个待测位置上;
(2)将船上的高精度主惯导系统n对准并处于导航状态;
(3)将子惯导系统s1和s2预热后,分别采集光纤陀螺仪和石英挠性加速度计输出的数据;
(4)建立以主惯导系统n和s1子惯导系统s1的速度误差、姿态误差及杆臂长度作为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程;
(5)利用卡尔曼滤波技术进行状态估计,实时的估计出子惯导系统s1和主惯导系统n之间的距离r1p;
(6)建立以主惯导系统n和s2子惯导系统的速度误差、姿态误差及杆臂长度作为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程;
(7)利用卡尔曼滤波技术进行状态估计,实时的估计出子惯导系统s2和主惯导系统n之间的距离r2p;
(8)将得到的两套子惯导系统s1和s2和主惯导系统n之间的距离r1p、r2p矢量做差,得到两个子惯导系统s1和s2和之间的距离、即两个待测位置的距离。
本发明的优势在于:由于船上的环境复杂,一般很难测算船体上两个位置间的距离。本发明利用速度匹配传递对准,建立以速度误差、姿态误差及杆臂长度作为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程,利用卡尔曼滤波方法实时的估计出子惯导和主惯导之间的距离。传递对准具有对准时间短、对准精度高、对器件的要求宽松等优点。
附图说明
图1为本发明的光纤捷联惯性系统在船上的位置示意图;
图2为本发明的流程图;
图3为仿真得到的子惯导s1与主惯导n之间的距离的估计曲线图;
图4为仿真得到的子惯导s2与主惯导n之间的距离的估计曲线图;
图5为仿真得到的子惯导s1与子惯导s2之间的距离的估计曲线图;
图6为仿真得到的子惯导s1与子惯导s2之间的距离的误差曲线图。
具体实施方式
下面结合附图举例对本发明做更详细地描述:
结合图1~2,本发明基于光纤捷联惯性系统测量船上任意两位置间距离的方法分以下步骤:
(1)为了测量船上某两个位置之间的距离,首先在船上待测的两个位置上各放置一套光纤捷联惯导系统,用s1、s2分别表示两套子惯导系统。
(2)将两套光纤陀螺捷联惯导系统预热后,分别采集光纤陀螺仪和石英挠性加速度计输出的数据。
(3)船上的高精度主惯导系统已经对准并处于导航状态,利用船上主惯导系统输出的惯性信息,同时对s1子惯导系统和s2子惯导系统进行速度匹配传递对准。坐标系n代表主惯导的导航坐标系。利用惯导基本方程,对于主惯导有:
(4)对于s1子惯导系统,建立主惯导系统和s1子惯导系统的速度匹配误差方程,由于子捷联惯导系统s1和主惯导系统安装的位置不同,主子惯导系统会敏感到不同的加速度,用r1p表示主惯导和子惯导s1之间的距离,则杆臂效应产生的加速度计误差为:
其中ωib为陀螺仪的输出
主惯导和子惯导s1之间的速度误差方程:
主子惯导间的失准角为φ1=[φx φy φz]T,则失准角微分方程:
其中εn为主惯导的陀螺漂移,μn为噪声项。
一般将陀螺仪和加速度计的误差表述为随机常值和白噪声误差,则有:
(5)建立以主惯导系统和s1子惯导系统速度误差和姿态误差为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程:
根据式(3)、(4)、(5)及(6)可以得到速度匹配传递对准的状态方程
速度匹配传递对准以主子惯导间的速度误差作为观测量,因此的速度匹配卡尔曼滤波方程如下:
状态方程:
量测方程:Z(t)=H(t)X(t)+v(t) (9)
其中X(t)为t时刻系统的状态向量;A(t)和B(t)分别为系统的状态矩阵和噪声矩阵;W(t)为系统噪声向量;Z(t)表示t时刻系统的量测向量;H(t)表示系统的量测矩阵;v(t)表示系统的量测噪声;
系统的状态向量为:
系统的白噪声向量为:
W=[wax way wεx wεy wεz 0 0 0 0 0 0 0 0]T
其中δVx、δVy分别表示东向、北向的速度误差;φx、φy、φz分别为东向、北向、天向失准角;分别为X、Y、Z轴加速度计零偏;εx、εy、εz分别为X、Y、Z轴陀螺的常值漂移;wax、way分别为X、Y轴加速度计的白噪声误差;wεx、wεy、wεz分别为X、Y、Z轴陀螺的白噪声误差;
系统的状态转移矩阵和观测矩阵为:
其中:
速度匹配传递对准取主惯导和子惯导间的速度差作为观测量,因此量测矩阵为:
利用卡尔曼滤波技术估计出主惯导和子惯导s1之间的距离r1p,r1p是以船摇摆中心为原点的向量。
(6)按照步骤(4)中的方法,建立主惯导系统和s2子惯导系统的速度匹配误差方程,用r2p表示主惯导和子惯导s2之间的距离,主惯导和子惯导s2之间的速度误差方程:
失准角微分方程:
(7)建立以主惯导系统和s2子惯导系统速度误差和姿态误差为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程:
根据式(10)及(11)可以得到速度匹配传递对准的状态方程
速度匹配传递对准以主子惯导间的速度误差作为观测量,因此的速度匹配卡尔曼滤波方程如下:
状态方程:
量测方程:Z(t)=H(t)X(t)+v(t) (14)
系统的状态向量为:
其中
(8)利用卡尔曼滤波技术估计出主惯导和子惯导s2之间的距离r2p,r2p是以船摇摆中心为原点的向量,用步骤(5)中得到的r1p与r2p进行矢量相减,既得到子惯导s1和子惯导s2之间的距离R,从而测得了船上安装两套子惯导位置之间的距离。
在以下的仿真条件下,对该方法进行仿真实验:
载体以正弦规律绕航向角、纵摇角和横摇角摇摆,其数学模型为:
其中:ψ,θ,γ分别表示绕航向角、纵摇角和横摇角的摇摆角度变量;ψm,θm,γm分别表示相应的摇摆角度幅值;ωψ,ωθ,ωγ分别表示相应的摇摆角频率;ψ0,θ0,γ0分别表示相应的初相位;而ωi=2π/Ti,i=ψ,θ,γ,Ti表示相应的摇摆周期;K为初始航向。仿真时取ψm=5°,θm=4°,γm=5°,Tψ=8s,Tθ=8s,Tγ=6s,K=0,初相位ψ0,θ0,γ0取值为0°。
船的初始位置:北纬45.7796°,东经126.6705°;
初始姿态误差角:横摇误差角0.1°,纵摇误差角0.1°,方位误差角0.5°;
赤道半径:Re=6378393.0m;
椭圆度:e=3.367e-3;
由万有引力可得的地球表面重力加速度:g0=9.78049;
地球自转角速度(弧度/秒):7.2921158e-5;
陀螺仪常值漂移:0.01度/小时;
陀螺仪白噪声误差:0.005度/小时;
加速度计零位偏移:10-4g0;
加速度计白噪声误差:10-5g0;
主惯导和子惯导s1之间的距离:r1px=10m,r1py=10m,r1pz=5m;
主惯导和子惯导s2之间的距离:r2px=35m,r2py=35m,r2pz=10m;
采样时间和滤波周期:T=0.1秒;
常数:π=3.1415926;
利用本发明所述方法得到子惯导s1、s2与主惯导n之间的距离的估计曲线分别如图3、图4所示;子惯导s1与子惯导s2之间的距离的估计曲线如图5所示,子惯导s1与子惯导s2之间的距离的误差曲线图如图6所示。
Claims (1)
1.基于光纤捷联惯性系统测量船上任意两位置间距离的方法,其特征是:
(1)将两套光纤陀螺捷联惯系统s1和s2作为子惯导系统分别放置在船的两个待测位置上;
(2)将船上的高精度主惯导系统n对准并处于导航状态;
(3)将子惯导系统s1和s2预热后,分别采集光纤陀螺仪和石英挠性加速度计输出的数据;
(4)建立以主惯导系统n和s1子惯导系统s1的速度误差、姿态误差及杆臂长度作为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程;
(5)利用卡尔曼滤波技术进行状态估计,实时的估计出子惯导系统s1和主惯导系统n之间的距离r1p;
(6)建立以主惯导系统n和s2子惯导系统的速度误差、姿态误差及杆臂长度作为状态变量的卡尔曼滤波状态方程及速度误差为量测量的量测方程;
(7)利用卡尔曼滤波技术进行状态估计,实时的估计出子惯导系统s2和主惯导系统n之间的距离r2p;
(8)将得到的两套子惯导系统s1和s2和主惯导系统n之间的距离r1p、r2p矢量做差,得到两个子惯导系统s1和s2和之间的距离、即两个待测位置的距离。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102221439A CN101915578A (zh) | 2010-07-09 | 2010-07-09 | 基于光纤捷联惯性系统测量船上任意两位置间距离的方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN2010102221439A CN101915578A (zh) | 2010-07-09 | 2010-07-09 | 基于光纤捷联惯性系统测量船上任意两位置间距离的方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN101915578A true CN101915578A (zh) | 2010-12-15 |
Family
ID=43323142
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN2010102221439A Pending CN101915578A (zh) | 2010-07-09 | 2010-07-09 | 基于光纤捷联惯性系统测量船上任意两位置间距离的方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN101915578A (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103256942A (zh) * | 2013-04-26 | 2013-08-21 | 哈尔滨工程大学 | 传递对准中考虑杆臂补偿的变形角测量方法 |
CN103363989A (zh) * | 2012-04-09 | 2013-10-23 | 北京自动化控制设备研究所 | 一种捷联惯导系统内杆臂的估计与误差补偿方法 |
CN107990912A (zh) * | 2017-11-08 | 2018-05-04 | 江西洪都航空工业集团有限责任公司 | 一种抗差自适应滤波动基座传递对准方法 |
CN108981696A (zh) * | 2018-08-01 | 2018-12-11 | 西北工业大学 | 一种sins任意失准角无奇异快速传递对准方法 |
-
2010
- 2010-07-09 CN CN2010102221439A patent/CN101915578A/zh active Pending
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103363989A (zh) * | 2012-04-09 | 2013-10-23 | 北京自动化控制设备研究所 | 一种捷联惯导系统内杆臂的估计与误差补偿方法 |
CN103363989B (zh) * | 2012-04-09 | 2017-01-18 | 北京自动化控制设备研究所 | 一种捷联惯导系统内杆臂的估计与误差补偿方法 |
CN103256942A (zh) * | 2013-04-26 | 2013-08-21 | 哈尔滨工程大学 | 传递对准中考虑杆臂补偿的变形角测量方法 |
CN107990912A (zh) * | 2017-11-08 | 2018-05-04 | 江西洪都航空工业集团有限责任公司 | 一种抗差自适应滤波动基座传递对准方法 |
CN108981696A (zh) * | 2018-08-01 | 2018-12-11 | 西北工业大学 | 一种sins任意失准角无奇异快速传递对准方法 |
CN108981696B (zh) * | 2018-08-01 | 2022-02-18 | 西北工业大学 | 一种sins任意失准角无奇异快速传递对准方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN101514900B (zh) | 一种单轴旋转的捷联惯导系统初始对准方法 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
CN101893445B (zh) | 摇摆状态下低精度捷联惯导系统快速初始对准方法 | |
CN100541132C (zh) | 大失准角下船用光纤陀螺捷联航姿系统系泊精对准方法 | |
CN101963513B (zh) | 消除水下运载体捷联惯导系统杆臂效应误差的对准方法 | |
CN101881619B (zh) | 基于姿态测量的船用捷联惯导与天文定位方法 | |
CN101566477B (zh) | 舰船局部捷联惯导系统初始姿态快速测量方法 | |
CN103245360B (zh) | 晃动基座下的舰载机旋转式捷联惯导系统自对准方法 | |
CN100587641C (zh) | 一种适用于任意运动微小型系统的定姿系统 | |
CN104374388B (zh) | 一种基于偏振光传感器的航姿测定方法 | |
CN106767793A (zh) | 一种基于sins/usbl紧组合的auv水下导航定位方法 | |
CN101915579A (zh) | 一种基于ckf的sins大失准角初始对准新方法 | |
CN101963512A (zh) | 船用旋转式光纤陀螺捷联惯导系统初始对准方法 | |
CN103542816B (zh) | 基于时间延迟补偿的船体变形测量方法 | |
CN101571394A (zh) | 基于旋转机构的光纤捷联惯性导航系统初始姿态确定方法 | |
CN101713666B (zh) | 一种基于单轴转停方案的系泊估漂方法 | |
CN103471616A (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN101629826A (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航系统粗对准方法 | |
CN101706284A (zh) | 提高船用光纤陀螺捷联惯导系统定位精度的方法 | |
CN103900611A (zh) | 一种惯导天文高精度复合两位置对准及误差标定方法 | |
CN103900608A (zh) | 一种基于四元数ckf的低精度惯导初始对准方法 | |
CN102116634A (zh) | 一种着陆深空天体探测器的降维自主导航方法 | |
CN103245357A (zh) | 一种船用捷联惯导系统二次快速对准方法 | |
CN102768043A (zh) | 一种无外观测量的调制型捷联系统组合姿态确定方法 | |
CN101650186A (zh) | 一种对舰船甲板静态变形角进行测量的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C02 | Deemed withdrawal of patent application after publication (patent law 2001) | ||
WD01 | Invention patent application deemed withdrawn after publication |
Open date: 20101215 |