CN105021212A - 一种初始方位信息辅助下潜航器快速传递对准方法 - Google Patents
一种初始方位信息辅助下潜航器快速传递对准方法 Download PDFInfo
- Publication number
- CN105021212A CN105021212A CN201510390727.XA CN201510390727A CN105021212A CN 105021212 A CN105021212 A CN 105021212A CN 201510390727 A CN201510390727 A CN 201510390727A CN 105021212 A CN105021212 A CN 105021212A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mtd
- msubsup
- mtr
- 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
- 238000000034 method Methods 0.000 title claims abstract description 30
- 238000012546 transfer Methods 0.000 title claims abstract description 26
- 238000001914 filtration Methods 0.000 claims abstract description 19
- 239000011159 matrix material Substances 0.000 claims description 55
- 238000005259 measurement Methods 0.000 claims description 10
- 238000005096 rolling process Methods 0.000 claims description 6
- 230000007704 transition Effects 0.000 claims description 6
- 230000005540 biological transmission Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 3
- 238000000354 decomposition reaction Methods 0.000 claims description 2
- 238000005295 random walk Methods 0.000 claims description 2
- 241000135164 Timea Species 0.000 claims 1
- 238000000926 separation method Methods 0.000 abstract description 5
- 238000002474 experimental method Methods 0.000 description 2
- 230000006978 adaptation Effects 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
- 230000035899 viability Effects 0.000 description 1
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 1
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)
- Pharmaceuticals Containing Other Organic And Inorganic Compounds (AREA)
Abstract
本发明针对现有传递对准方法在保证潜航器惯导对准精度的条件下,不能实现移动基准与潜航器快速分离和一次性多潜航器布放的问题,公开了一种初始方位信息辅助下潜航器快速传递对准方法。本发明包括以下四步:1、初始信息装订,信息装订完毕后潜航器与移动基准即分离;2、潜航器姿态更新方程、速度更新方程、位置更新方程确定;3、卡尔曼滤波状态方程与观测方程确定;4、卡尔曼滤波并对潜航器姿态、速度误差修正,完成传递对准。本发明实现了移动基准与潜航器的快速分离,同时能够保证潜航器惯导对准精度,且能实现一次性多潜航器布放。
Description
技术领域
本发明涉及一种传递对准方法,特别是一种初始方位信息辅助下潜航器快速传递对准方法。
背景技术
潜航器遂行作战任务之前,由舰船将其带入指定地点,然后将其投放;之后,潜航器利用其自身惯性导航设备在多普勒测速仪辅助下进行自主导航。潜航器布放前其惯性导航***的初始对准,可以选择采用组合导航初始对准的方式进行自对准,也可以以舰船惯导***或移动基准惯导***为主惯导***进行传递对准。
采用组合导航自对准方式时不需要舰船惯导***提供数据,但动基座环境下自对准通常需要较长时间才能完成初始对准过程,难以达到快速对准的要求。为了满足快速对准的需求,目前国内外多采取了利用主惯导或移动基准惯导***(MINS)为信息源辅助子惯导***(SINS)进行传递对准,这就需要主惯导***实时与子惯导***进行一段时间的测量参数匹配或者导航参数匹配,这种传递对准方法存在的问题是:不能实现主惯导或移动基准惯导与潜航器的快速分离,影响潜航器的快速布放,战场环境下,不仅影响潜航器作战效能的发挥,还会对携带潜航器进入战场环境的移动基准载体的生存能力构成威胁,并且按传统传递对准方式逐一进行传递对准,难以实现短时间同时布放多个潜航器的任务。因此,寻找一种能实现移动基准惯导与潜航器惯导快速分离,同时能够保证潜航器惯导对准精度,且能实现一次性多潜航器布放的传递对准方式具有重要意义。
发明内容
本发明针对现有传递对准方法在保证潜航器惯导对准精度的条件下,不能实现移动基准惯导与潜航器惯导的快速分离,且不能实现一次性多潜航器布放的问题,提出了一种初始方位信息辅助下潜航器快速传递对准方法。
该方法只需移动基准惯导在初始对准开始时刻提供潜航器惯导***方位信息及概略的水平姿态信息后,潜航器随即布放入水,其惯导***在多普勒测速仪的速度信息辅助下估计惯性系下的初始水平姿态误差和当前的速度误差,进行组合导航自对准。由于水平姿态误差和速度误差可通过卡尔曼滤波快速收敛,可实现移动基准惯导与潜航器惯导快速分离,且能满足短时间投放较多数量潜航器的快速对准要求。
为实现本发明所采取的技术解决方案是:
一种初始方位信息辅助下潜航器快速传递对准方法,包含以下步骤:
步骤一:移动基准惯导(MINS)对每一个潜航器惯导(SINS)装订初始位置(包括初始经度λ0、初始纬度L0)、初始速度初始姿态信息(包括准确的方位角存在误差的俯仰角与横滚角),装订完成后,潜航器与移动基准分离;
其中,t0表示对准初始时刻,表示潜航器相对于地球的速度在地理坐标系n系下的投影,地理坐标系n系定义为北向-东向-地向(N-E-D),地球坐标系e系的原点位于地心,ez轴沿地球自转轴方向,ex轴在赤道平面内指向格林威治子午线,ey轴与另外两轴构成右手正交坐标系;
表示惯性坐标系系到惯性坐标系系的方向余弦矩阵,系由对准初始时刻载体坐标系b系与惯性空间固联得到(相对惯性空间固定不动),系由对准初始时刻n系与惯性空间固联得到(相对惯性空间固定不动),载体坐标系b系轴向沿载体横滚轴-俯仰轴-偏航轴(前-右-下);
步骤二:潜航器惯导(SINS)建立姿态更新方程、速度更新方程、位置更新方程分别如下:
姿态更新方程:
其中,
n0系定义为对准初始时刻的地理坐标系,相对地球表面固定不动,不随导航***在地球表面运动而运动;
为对准初始时刻导航系n0系到当前时刻导航系n系的方向余弦矩阵;
为惯性坐标系系到对准初始时刻导航系n0系的方向余弦矩阵;
为惯性坐标系系到惯性坐标系系的方向余弦矩阵;
为载体坐标系b系到惯性坐标系系的方向余弦矩阵;
速度更新方程:
其中,
tk-1、tk分别表示第k-1、k个潜航器速度更新时刻,为对应的速度,fb为加表比力输出,为tk-1时刻相应的方向余弦矩阵,Δt=tk-tk-1为惯导更新时间间隔,为地理系下的地球自转角速度,为地理系下的转移角速度,为地理系下的重力;
位置更新方程:
潜航器经纬度通过航迹推算进行更新,其中,
Lk-1、Lk分别表示k-1、k时刻潜航器的纬度,λk-1、λk分别表示k-1、k时刻潜航器的经度,vn、ve表示潜航器的北向、东向速度,RN表示子午面曲率半径,h表示高度;
步骤三:构建卡尔曼滤波状态方程与观测方程如下:
选取横滚角误差δθ0、俯仰角误差δγ0、北向速度误差δvn、东向速度误差δve为***状态,即
x=[δθ0 δγ0 δvn δve]T (4)
构建***状态方程如下,
其中,
上标T表示矩阵或向量的转置,x表示***状态,表示状态微分,F表示状态转移矩阵,G表示***噪声矩阵; 为陀螺输出噪声,δfb为加表输出噪声;
取1s更新一次的多普勒速度为观测量,构建观测方程如下,
z=Hx+v (6)
其中,
多普勒坐标系d系轴向沿多普勒测速仪的横滚轴-俯仰轴-偏航轴(前-右-下);
z为观测向量,H为观测矩阵,v为测量噪声;
步骤四:根据卡尔曼滤波状态方程和观测方程进行滤波,对横滚角误差、俯仰角误差、北向速度误差、东向速度误差进行估计,对潜航器的姿态、速度进行修正,完成传递对准;
其中,在步骤二中所述的姿态更新方程按如下方法更新:
其中,I3×3表示三维单位矩阵,ωie为地球自转角速度,t为初始时刻到当前时刻的解算时间,λ0、L0为潜航器装订的初始经度、纬度,λ、L为当前时刻经度、纬度;
可由潜航器初始经纬度和t确定,将按如下分解,
其中,
ie0系由对准初始时刻e系与惯性空间固联得到(相对惯性空间固定不动);
为地球坐标系e系到对准初始时刻导航系n0系的方向余弦矩阵;
为惯性坐标系系到地球坐标系e系的方向余弦矩阵;
为惯性坐标系系到惯性坐标系系的方向余弦矩阵;
利用陀螺输出数据求解,传递对准完成时间内,忽略陀螺的零偏、随机游走等误差,按如下微分方程和初值进行姿态更新求解,即
其中,为载体角速度,为的初值;
在步骤三中所述的卡尔曼滤波状态方程按如下方法构建:
1)水平欧拉角误差微分方程构建如下
水平欧拉角误差为常值,其微分为零,即
2)速度误差微分方程构建如下
①构建估算的姿态矩阵失准角与水平欧拉角误差δθ0、δγ0间的关系
其中,φ为估算的姿态矩阵失准角,
进一步,将(13)代入的表达式(12)并化简可得,
②构建包含水平欧拉角误差δθ0、δγ0的速度误差微分方程
潜航器相对于地球真实速度在n系下的速度微分方程为,
估算速度微分方程为,
(16)式与(15)式相减得速度误差微分方程,
其中,为有误差的比力输出,为估算速度,为速度误差,为估算的转移角速度;
将(14)式代入(17)式,得到包含水平欧拉角误差δθ0、δγ0的北向速度误差δvn、东向速度误差δve微分方程如下,
其中,δvn为北向速度误差、δve为东向速度误差,为估算的北向速度,为估算的东向速度,vn为真实北向速度,ve为真实东向速度;
M4=[I2×2 02×1]M1M,M5=[I2×2 02×1]M2[I2×2 02×1]T,M6=[I2×2 02×1]M3;
3)由1)、2)步中水平欧拉角误差微分方程、速度误差微分方程得到卡尔曼滤波状态方程中状态转移矩阵及***噪声矩阵相应为
在步骤三中所述的卡尔曼滤波观测方程按如下方法构建:
1)构建地理系n系下含有误差的多普勒测速输出与姿态矩阵失准角φ的关系
其中,为多普勒测速仪测得的潜航器速度在n系下投影,为多普勒测速仪测得的潜航器速度在d系下的投影,多普勒测速仪测速误差在d系下的投影;
2)构建速度误差观测量z
潜航器惯导解算速度将潜航器惯导解算速度的北向速度东向速度与多普勒测速仪输出中的北向速度东向速度作差得到速度误差观测量,
其中,
3)确定观测方程z=Hx+v中观测矩阵为
H=[M7 I2×2]。
与现有技术相比,本发明的有益效果是:
1)移动基准惯导(MINS)对每一个潜航器惯导(SINS)装订完成初始位置、初始速度、初始姿态信息后,潜航器与移动基准即可分离,不需要主/子惯导继续传送信息,传送信息少,改变了目前传递对准需要主/子惯导实时传送一段时间的信息才能完成对准的现状,实现了分离的快速性。
2)移动基准惯导(MINS)可同时对多个潜航器惯导(SINS)进行信息装订,同时布放多个潜航器,改变了目前传递对准只能实现主惯导与每一个子惯导一一进行传递对准的现状。
3)该传递对准方法对惯性坐标系下的常值水平欧拉角误差进行估计,估计精度高,缩短了对准时间。
附图说明
图1为本发明方法的流程示意图;
图2为无初始方位角信息辅助下传统对准过程中方位角误差曲线;
图3为初始方位角信息辅助下传递对准过程中方位角误差曲线。
具体实施方式
下面结合附图对本发明中的方法作进一步详细说明。
步骤一:移动基准惯导(MINS)对每一个潜航器惯导(SINS)装订初始位置(包括初始经度λ0、初始纬度L0)、初始速度初始姿态信息(包括准确的方位角存在误差的俯仰角与横滚角),装订完成后,潜航器与移动基准分离;
其中,t0表示对准初始时刻,表示潜航器相对于地球的速度在地理坐标系n系下的投影,地理坐标系n系定义为北向-东向-地向(N-E-D),地球坐标系e系的原点位于地心,ez轴沿地球自转轴方向,ex轴在赤道平面内指向格林威治子午线,ey轴与另外两轴构成右手正交坐标系;
表示惯性坐标系系到惯性坐标系系的方向余弦矩阵,系由对准初始时刻载体坐标系b系与惯性空间固联得到(相对惯性空间固定不动),系由对准初始时刻n系与惯性空间固联得到(相对惯性空间固定不动),载体坐标系b系轴向沿载体横滚轴-俯仰轴-偏航轴(前-右-下);
步骤二:潜航器惯导(SINS)建立姿态更新方程、速度更新方程、位置更新方程分别如下:
姿态更新方程:
其中,
n0系定义为对准初始时刻的地理坐标系,相对地球表面固定不动,不随导航***在地球表面运动而运动;
为对准初始时刻导航系n0系到当前时刻导航系n系的方向余弦矩阵;
为惯性坐标系系到对准初始时刻导航系n0系的方向余弦矩阵;
为惯性坐标系系到惯性坐标系系的方向余弦矩阵;
为载体坐标系b系到惯性坐标系系的方向余弦矩阵;
速度更新方程:
其中,
tk-1、tk分别表示第k-1、k个潜航器速度更新时刻,为对应的速度,fb为加表比力输出,为tk-1时刻相应的方向余弦矩阵,Δt=tk-tk-1为惯导更新时间间隔,为地理系下的地球自转角速度,为地理系下的转移角速度,为地理系下的重力;
位置更新方程:
潜航器经纬度通过航迹推算进行更新,其中,
Lk-1、Lk分别表示k-1、k时刻潜航器的纬度,λk-1、λk分别表示k-1、k时刻潜航器的经度,vn、ve表示潜航器的北向、东向速度,RN表示子午面曲率半径,h表示高度;
步骤三:构建卡尔曼滤波状态方程与观测方程如下:
选取横滚角误差δθ0、俯仰角误差δγ0、北向速度误差δvn、东向速度误差δve为***状态,即
x=[δθ0 δγ0 δvn δve]T (24)
构建***状态方程如下,
其中,上标T表示矩阵或向量的转置,x表示***状态,表示状态微分,F表示状态转移矩阵,G表示***噪声矩阵; 为陀螺输出噪声,δfb为加表输出噪声;
***状态方程包括水平欧拉角误差微分方程和速度误差微分方程,分别构建如下:
1)水平欧拉角误差微分方程
水平欧拉角误差为常值,其微分为零,即
2)速度误差微分方程
①构建估算的姿态矩阵失准角与水平欧拉角误差δθ0、δγ0间的关系
其中,φ为估算的姿态矩阵失准角,
进一步,将(28)代入的表达式(27)并化简可得,
②构建包含水平欧拉角误差δθ0、δγ0的速度误差微分方程
潜航器相对于地球真实速度在n系下的速度微分方程为,
估算速度微分方程为,
(31)式与(30)式相减得速度误差微分方程,
其中,为有误差的比力输出,为估算速度,为速度误差,为估算的转移角速度;
将(29)式代入(32)式,得到包含水平欧拉角误差δθ0、δγ0的北向速度误差δvn、东向速度误差δve微分方程如下,
其中,δvn为北向速度误差、δve为东向速度误差,为估算的北向速度,为估算的东向速度,vn为真实北向速度,ve为真实东向速度;
M4=[I2×2 02×1]M1M,M5=[I2×2 02×1]M2[I2×2 02×1]T,M6=[I2×2 02×1]M3;
3)由1)、2)步中水平欧拉角误差微分方程、速度误差微分方程得到卡尔曼滤波状态方程中状态转移矩阵及***噪声矩阵相应为
取1s更新一次的多普勒速度为观测量,构建观测方程如下,
z=Hx+v (34)
其中,
多普勒坐标系d系轴向沿多普勒测速仪的横滚轴-俯仰轴-偏航轴(前-右-下);
z为观测向量,H为观测矩阵,v为测量噪声;
观测方程包括观测量与观测矩阵的确定,分别确定如下:
1)构建地理系n系下含有误差的多普勒测速输出与姿态矩阵失准角φ的关系
其中,为多普勒测速仪测得的潜航器速度在n系下投影,为多普勒测速仪测得的潜航器速度在d系下的投影,多普勒测速仪测速误差在d系下的投影;
2)构建速度误差观测量z
潜航器惯导解算速度将潜航器惯导解算速度的北向速度东向速度与多普勒测速仪输出中的北向速度东向速度作差得到速度误差观测量,
其中,
3)确定观测方程z=Hx+v中观测矩阵为
H=[M7 I2×2];
步骤四:根据卡尔曼滤波状态方程和观测方程进行滤波,对横滚角误差、俯仰角误差、北向速度误差、东向速度误差进行估计,对潜航器的姿态、速度进行修正,完成传递对准。
下面对本发明方法的效果进行检验。
使用水下潜航器数据对本发明中的方法进行验证,实验中主惯导***传递给子惯导的姿态信息为初始基准值为潜航器姿态基准值为利用原始数据进行10min的INS/GPS组合导航解算得到。潜航器惯导***为激光陀螺捷联惯导***,陀螺精度为0.01°/h,加表精度为5×10-5g。实验截取潜航器运行前10min数据进行方法验证。
对比图2对应的无初始方位角信息辅助下传统对准过程中方位角误差曲线(以多普勒测速仪速度输出值为观测量,潜航器在无初始方位信息下自对准)、图3对应的初始方位角信息辅助下传递对准过程中方位角误差曲线,可以发现图2中方位角误差在600s时才收敛,图3中采用初始方位角信息辅助下的传递对准方案,方位角误差到50s时就收敛到1密位,对准时间与精度都得到明显改善。
本方法利用移动基准惯导的方位角信息确定子惯导***的方位角信息,缩短了与子惯导***信息传输时间,使得子惯导***可以实现与主惯导***分离的快速性,在此基础上,可以实现短时间投放大量潜航器的实际需求,同时可以保证子惯导***在短时间内实现对准。
以上仅是本发明的优选实施方式,本发明的保护范围并不仅限于上述实施例,凡属于本发明思路下的技术方案均属于本发明的保护范围。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理前提下的若干改进和润饰,应当视为落入本发明的保护范围。
Claims (2)
1.一种初始方位信息辅助下潜航器快速传递对准方法,其特征在于包含以下步骤:
步骤一:移动基准惯导(MINS)对每一个潜航器惯导(SINS)装订初始位置(包括初始经度λ0、初始纬度L0)、初始速度初始姿态信息(包括准确的方位角存在误差的俯仰角与横滚角),装订完成后,潜航器与移动基准分离;
其中,t0表示对准初始时刻,表示潜航器相对于地球的速度在地理坐标系n系下的投影,地理坐标系n系定义为北向-东向-地向(N-E-D),地球坐标系e系的原点位于地心,ez轴沿地球自转轴方向,ex轴在赤道平面内指向格林威治子午线,ey轴与另外两轴构成右手正交坐标系;
表示惯性坐标系系到惯性坐标系系的方向余弦矩阵,系由对准初始时刻载体坐标系b系与惯性空间固联得到(相对惯性空间固定不动),系由对准初始时刻n系与惯性空间固联得到(相对惯性空间固定不动),载体坐标系b系轴向沿载体横滚轴-俯仰轴-偏航轴(前-右-下);
步骤二:潜航器惯导(SINS)建立姿态更新方程、速度更新方程、位置更新方程分别如下:
姿态更新方程:
其中,
n0系定义为对准初始时刻的地理坐标系,相对地球表面固定不动,不随导航***在地球表面运动而运动;
为对准初始时刻导航系n0系到当前时刻导航系n系的方向余弦矩阵;
为惯性坐标系系到对准初始时刻导航系n0系的方向余弦矩阵;
为惯性坐标系系到惯性坐标系系的方向余弦矩阵;
为载体坐标系b系到惯性坐标系系的方向余弦矩阵;
速度更新方程:
其中,
tk-1、tk分别表示第k-1、k个潜航器速度更新时刻,为对应的速度,fb为加表比力输出,为tk-1时刻相应的方向余弦矩阵,Δt=tk-tk-1为惯导更新时间间隔,为地理系下的地球自转角速度,为地理系下的转移角速度,为地理系下的重力;
位置更新方程:
潜航器经纬度通过航迹推算进行更新,其中,
Lk-1、Lk分别表示k-1、k时刻潜航器的纬度,λk-1、λk分别表示k-1、k时刻潜航器的经度,vn、ve表示潜航器的北向、东向速度,RN表示子午面曲率半径,h表示高度;
步骤三:构建卡尔曼滤波状态方程与观测方程如下:
选取横滚角误差δθ0、俯仰角误差δγ0、北向速度误差δvn、东向速度误差δve为***状态,即
x=[δθ0 δγ0 δvn δve]T (4)
构建***状态方程如下,
其中,
上标T表示矩阵或向量的转置,x表示***状态,表示状态微分,F表示状态转移矩阵,G表示***噪声矩阵; 为陀螺输出噪声,δfb为加表输出噪声;
取1s更新一次的多普勒速度为观测量,构建观测方程如下,
z=Hx+v (6)
其中,
多普勒坐标系d系轴向沿多普勒测速仪的横滚轴-俯仰轴-偏航轴(前-右-下);
z为观测向量,H为观测矩阵,v为测量噪声;
步骤四:根据卡尔曼滤波状态方程和观测方程进行滤波,对横滚角误差、俯仰角误差、北向速度误差、东向速度误差进行估计,对潜航器的姿态、速度进行修正,完成传递对准。
2.根据权利要求1所述的一种初始方位信息辅助下潜航器快速传递对准方法,其特征在于:
在步骤二中所述的姿态更新方程按如下方法更新:
其中,I3×3表示三维单位矩阵,ωie为地球自转角速度,t为初始时刻到当前时刻的解算时间,λ0、L0为潜航器装订的初始经度、纬度,λ、L为当前时刻经度、纬度;
可由潜航器初始经纬度和t确定,将按如下分解,
其中,
系由对准初始时刻e系与惯性空间固联得到(相对惯性空间固定不动);
为地球坐标系e系到对准初始时刻导航系n0系的方向余弦矩阵;
为惯性坐标系系到地球坐标系e系的方向余弦矩阵;
为惯性坐标系系到惯性坐标系系的方向余弦矩阵;
利用陀螺输出数据求解,传递对准完成时间内,忽略陀螺的零偏、随机游走等误差,按如下微分方程和初值进行姿态更新求解,即
其中,为载体角速度,为的初值;
在步骤三中所述的卡尔曼滤波状态方程按如下方法构建:
1)水平欧拉角误差微分方程构建如下
水平欧拉角误差为常值,其微分为零,即
2)速度误差微分方程构建如下
其中,为估算的北向速度,为估算的东向速度,vn为真实北向速度,ve为真实东向速度,
3)由1)、2)步中水平欧拉角误差微分方程、速度误差微分方程得到卡尔曼滤波状态方程中状态转移矩阵及***噪声矩阵相应为
在步骤三中所述的卡尔曼滤波观测方程按如下方法构建:
1)构建地理系n系下含有误差的多普勒测速输出与姿态矩阵失准角φ的关系
其中,为多普勒测速仪测得的潜航器速度在n系下投影,为多普勒测速仪测得的潜航器速度在d系下的投影,δve d d多普勒测速仪测速误差在d系下的投影;
2)构建速度误差观测量z
潜航器惯导解算速度为将潜航器惯导解算速度的北向速度东向速度与多普勒测速仪输出中的北向速度东向速度作差得到速度误差观测量,
其中,
3)确定观测方程z=Hx+v中观测矩阵为
H=[M7 I2×2]。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510390727.XA CN105021212B (zh) | 2015-07-06 | 2015-07-06 | 一种初始方位信息辅助下潜航器快速传递对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510390727.XA CN105021212B (zh) | 2015-07-06 | 2015-07-06 | 一种初始方位信息辅助下潜航器快速传递对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN105021212A true CN105021212A (zh) | 2015-11-04 |
CN105021212B CN105021212B (zh) | 2017-09-26 |
Family
ID=54411359
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510390727.XA Expired - Fee Related CN105021212B (zh) | 2015-07-06 | 2015-07-06 | 一种初始方位信息辅助下潜航器快速传递对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN105021212B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108351420A (zh) * | 2015-11-10 | 2018-07-31 | 赛峰电子与防务公司 | 用于在惯性测量单元的静态对准期间检测寄生移动的方法、以及相关的检测设备 |
CN109460075A (zh) * | 2018-11-01 | 2019-03-12 | 湖北航天技术研究院总体设计所 | 一种快速方位角对准的方法及*** |
CN109764752A (zh) * | 2018-12-20 | 2019-05-17 | 北京恒星箭翔科技有限公司 | 一种单兵制导火箭降低加工精度要求的快速初始对准方法 |
CN111912405A (zh) * | 2019-05-10 | 2020-11-10 | 中国人民解放***箭军工程大学 | 一种基于车载惯组与多普勒雷达的组合导航方法及*** |
CN116295511A (zh) * | 2022-12-16 | 2023-06-23 | 南京安透可智能***有限公司 | 一种用于管道潜航机器人的鲁棒初始对准方法及*** |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航***阻尼方法 |
CN103047999A (zh) * | 2012-12-18 | 2013-04-17 | 东南大学 | 一种舰载主/子惯导传递对准过程中的陀螺误差快速估计方法 |
WO2013059989A1 (zh) * | 2011-10-25 | 2013-05-02 | 国防科学技术大学 | 一种惯性导航***的运动对准方法 |
CN103245360A (zh) * | 2013-04-24 | 2013-08-14 | 北京工业大学 | 晃动基座下的舰载机旋转式捷联惯导***自对准方法 |
CN103644913A (zh) * | 2013-12-25 | 2014-03-19 | 东南大学 | 基于直接导航模型的无迹卡尔曼非线性初始对准方法 |
CN104655131A (zh) * | 2015-02-06 | 2015-05-27 | 东南大学 | 基于istssrckf的惯性导航初始对准方法 |
-
2015
- 2015-07-06 CN CN201510390727.XA patent/CN105021212B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101696883A (zh) * | 2009-10-29 | 2010-04-21 | 哈尔滨工程大学 | 光纤陀螺捷联惯性导航***阻尼方法 |
WO2013059989A1 (zh) * | 2011-10-25 | 2013-05-02 | 国防科学技术大学 | 一种惯性导航***的运动对准方法 |
CN103047999A (zh) * | 2012-12-18 | 2013-04-17 | 东南大学 | 一种舰载主/子惯导传递对准过程中的陀螺误差快速估计方法 |
CN103245360A (zh) * | 2013-04-24 | 2013-08-14 | 北京工业大学 | 晃动基座下的舰载机旋转式捷联惯导***自对准方法 |
CN103644913A (zh) * | 2013-12-25 | 2014-03-19 | 东南大学 | 基于直接导航模型的无迹卡尔曼非线性初始对准方法 |
CN104655131A (zh) * | 2015-02-06 | 2015-05-27 | 东南大学 | 基于istssrckf的惯性导航初始对准方法 |
Non-Patent Citations (5)
Title |
---|
JINGSHOU XU等: "Rapid transfer alignment for SINS of carrier craft", 《JOURNAL OF SYSTEMS ENGINEERING AND ELECTRONICS》 * |
WANLI LI等: "A Fast SINS Initial Alignment Scheme for Underwate", 《THE JOURNAL OF NAVIGATION》 * |
严恭敏等: "基于惯性参考系的动基座初始对准与定位导航", 《***工程与电子技术》 * |
王勇军等: "一种改进的舰载机快速传递对准方法", 《中国惯性技术学报》 * |
高伟等: "水下潜器捷联惯导***初始对准技术研究", 《中国航海》 * |
Cited By (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108351420A (zh) * | 2015-11-10 | 2018-07-31 | 赛峰电子与防务公司 | 用于在惯性测量单元的静态对准期间检测寄生移动的方法、以及相关的检测设备 |
CN108351420B (zh) * | 2015-11-10 | 2021-12-10 | 赛峰电子与防务公司 | 用于在惯性测量单元的静态对准期间检测寄生移动的方法、以及相关的检测设备 |
CN109460075A (zh) * | 2018-11-01 | 2019-03-12 | 湖北航天技术研究院总体设计所 | 一种快速方位角对准的方法及*** |
CN109460075B (zh) * | 2018-11-01 | 2021-10-01 | 湖北航天技术研究院总体设计所 | 一种快速方位角对准的方法及*** |
CN109764752A (zh) * | 2018-12-20 | 2019-05-17 | 北京恒星箭翔科技有限公司 | 一种单兵制导火箭降低加工精度要求的快速初始对准方法 |
CN109764752B (zh) * | 2018-12-20 | 2021-07-13 | 北京恒星箭翔科技有限公司 | 一种单兵制导火箭降低加工精度要求的快速初始对准方法 |
CN111912405A (zh) * | 2019-05-10 | 2020-11-10 | 中国人民解放***箭军工程大学 | 一种基于车载惯组与多普勒雷达的组合导航方法及*** |
CN116295511A (zh) * | 2022-12-16 | 2023-06-23 | 南京安透可智能***有限公司 | 一种用于管道潜航机器人的鲁棒初始对准方法及*** |
CN116295511B (zh) * | 2022-12-16 | 2024-04-02 | 南京安透可智能***有限公司 | 一种用于管道潜航机器人的鲁棒初始对准方法及*** |
Also Published As
Publication number | Publication date |
---|---|
CN105021212B (zh) | 2017-09-26 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109099912B (zh) | 室外精确定位导航方法、装置、电子设备及存储介质 | |
CN105021212B (zh) | 一种初始方位信息辅助下潜航器快速传递对准方法 | |
CN104457754B (zh) | 一种基于sins/lbl紧组合的auv水下导航定位方法 | |
CN104181572B (zh) | 一种弹载惯性/卫星紧组合导航方法 | |
CN110487301A (zh) | 一种雷达辅助机载捷联惯性导航***初始对准方法 | |
CN105242285B (zh) | 一种基于卫星通信的无人机导航数据被欺骗识别方法 | |
CN104729497A (zh) | 超小型双涵道无人机组合导航***及双模式导航方法 | |
CN104236586B (zh) | 基于量测失准角的动基座传递对准方法 | |
CN103047999B (zh) | 一种舰载主/子惯导传递对准过程中的陀螺误差快速估计方法 | |
CN103471616A (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN105486313A (zh) | 一种基于usbl辅助低成本sins***的定位方法 | |
CN102628691A (zh) | 一种完全自主的相对惯性导航方法 | |
CN103148868B (zh) | 匀速直航下基于多普勒计程仪地理系测速误差估计的组合对准方法 | |
CN104457748A (zh) | 一种嵌入式瞄准吊舱测姿***及其传递对准方法 | |
CN107806874A (zh) | 一种视觉辅助的捷联惯导极区初始对准方法 | |
CN103604428A (zh) | 基于高精度水平基准的星敏感器定位方法 | |
CN102707080B (zh) | 一种星敏感器模拟捷联惯导陀螺的方法 | |
CN103335654A (zh) | 一种行星动力下降段的自主导航方法 | |
CN103471614A (zh) | 一种基于逆坐标系的极区传递对准方法 | |
CN103575297B (zh) | 基于卫星导航接收机的gnss和mimu组合导航航向角估计方法 | |
CN105043418A (zh) | 一种适用于船载动中通的惯导***快速初始粗对准方法 | |
CN105116430A (zh) | 用于动中通的伪航向的基于卡尔曼滤波的海泊态搜星方法 | |
CN109506662B (zh) | 一种小天体着陆初始对准方法、其相对导航基准确定方法及装置 | |
CN105300407A (zh) | 一种用于单轴调制激光陀螺惯导***的海上动态启动方法 | |
CN103616026A (zh) | 一种基于h∞滤波的auv操纵模型辅助捷联惯导组合导航方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20170926 |
|
CF01 | Termination of patent right due to non-payment of annual fee |