CN114001731A - 虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统 - Google Patents
虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统 Download PDFInfo
- Publication number
- CN114001731A CN114001731A CN202111194989.0A CN202111194989A CN114001731A CN 114001731 A CN114001731 A CN 114001731A CN 202111194989 A CN202111194989 A CN 202111194989A CN 114001731 A CN114001731 A CN 114001731A
- Authority
- CN
- China
- Prior art keywords
- transverse
- navigation system
- phase modulation
- navigation
- speed
- 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 46
- 238000013016 damping Methods 0.000 title claims abstract description 40
- 239000011159 matrix material Substances 0.000 claims description 45
- 238000013507 mapping Methods 0.000 claims description 24
- 238000005259 measurement Methods 0.000 claims description 11
- 230000005484 gravity Effects 0.000 claims description 6
- 230000009466 transformation Effects 0.000 claims description 5
- 238000006243 chemical reaction Methods 0.000 claims 1
- 230000010355 oscillation Effects 0.000 abstract description 8
- 238000004364 calculation method Methods 0.000 description 9
- 238000010586 diagram Methods 0.000 description 9
- 238000004590 computer program Methods 0.000 description 7
- 238000004422 calculation algorithm Methods 0.000 description 6
- 230000008569 process Effects 0.000 description 5
- 230000006870 function Effects 0.000 description 4
- 238000012545 processing Methods 0.000 description 4
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000005295 random walk Methods 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000001133 acceleration Effects 0.000 description 1
- 230000002349 favourable effect Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000009467 reduction Effects 0.000 description 1
- 230000035939 shock Effects 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
- 230000017105 transposition Effects 0.000 description 1
- 238000012795 verification Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/183—Compensation of inertial measurements, e.g. for temperature effects
- G01C21/188—Compensation of inertial measurements, e.g. for temperature effects for accumulated errors, e.g. by coupling inertial systems with absolute positioning systems
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明涉及虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统。本发明包括如下步骤:获取惯性传感器采集的实时数据;对横向导航系速度更新并利用虚拟圆球模型进行扩展,得到虚拟圆球模型下横向导航系速度,得到横向导航系下载体的位置;获取相位调制后的横向导航系姿态、横向导航系相位调制后的速度、相位调制后的速度、相位调制后横向导航系下载体的位置;得到惯性导航输出姿态、得到惯性导航输出速度、惯性导航输出载体位置并进行导航。本发明在对虚拟圆球模型下极区惯性导航的基础上,利用阻尼系数对惯性导航结果进行相位调制,并对双环路进行融合,减小惯性导航舒拉震荡。
Description
技术领域
本发明涉及极区惯性导航技术领域,尤其是指虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统。
背景技术
当前极区惯性导航算法多采用横向坐标系或者格网坐标系以解决导航坐标系极区解算奇异问题。由于地球的椭球特性,横向坐标系和格网坐标系在计算过程中均会产生原理性误差。为此,需要设计椭球模型下的极区惯性导航算法,这也带来了计算复杂度高的缺点。相较于横向椭球模型和格网椭球模型,虚拟圆球模型则较好的利用了圆球模型计算简便及减小原理误差的特点,有利于实现高精度极区导航。但上述方法目前使用过程中依然存在舒拉震荡等误差,使得惯性导航结果出现振荡现象,从而影响导航精度。
发明内容
为此,本发明所要解决的技术问题在于克服现有技术中利用虚拟圆球模型实现极区导航存在舒拉震荡等误差,使得惯性导航结果出现振荡现象的问题。
为解决上述问题,本发明提供一种虚拟圆球模型下极区惯性导航相位调制阻尼方法,包括如下步骤:
步骤S1:采集惯性传感器的实时数据,根据实时数据得到横向导航系姿态;
步骤S2:根据实时数据和横向导航系姿态更新横向导航系速度并利用虚拟圆球模型对横向导航系速度进行扩展,得到虚拟圆球模型下横向导航系速度,根据虚拟圆球模型下横向导航系速度,得到横向导航系下载体的第一位置;
同时,根据实时数据、设定的速度阻尼系数和横向导航系姿态得到横向导航系相位调制后的速度,利用虚拟圆球模型对横向导航系相位调制后的速度进行扩展,得到虚拟圆球模型下横向导航系相位调制后的速度,根据虚拟圆球模型下横向导航系相位调制后的速度,得到相位调制后横向导航系下载体的第二位置;
步骤S3:对横向导航系姿态进行相位调制,得到相位调制后的横向导航系姿态,根据横向导航系姿态和相位调制后的横向导航系姿态得到惯性导航输出姿态,根据虚拟圆球模型下横向导航系速度和虚拟圆球模型下横向导航系相位调制后的速度得到惯性导航输出速度,以及根据横向导航系下载体的第一位置和相位调制后横向导航系下载体的第二位置得到惯性导航输出载体的输出位置,根据所述惯性导航输出姿态、惯性导航输出速度、惯性导航输出载体的输出位置进行导航。
在本发明的一种实施方式中,步骤S2中,所述根据实时数据和横向导航系姿态更新横向导航系速度的方法包括:对横向导航系的速度进行更新,其方程为:
式中,vt表示横向导航系的速度矢量;表示载体系到横向系的方向余弦矩阵;fb表示加速度计测量比力;表示地球系相对惯性系的旋转角速度在横向系的映射;表示横向系相对于地球系的旋转角速度在横向系的映射;gt表示重力矢量在横向系的映射。
在本发明的一种实施方式中,步骤S1中,所述横向导航系姿态由下式得到:
在本发明的一种实施方式中,步骤S2中,所述利用虚拟圆球模型对横向导航系速度进行扩展,得到虚拟圆球模型下横向导航系速度的方法为:根据下式得到虚拟圆球模型下横向导航系速度:
式中,RM表示导航系子午圈曲率半径;RN表示导航系卯酉圈曲率半径;ht表示横向系高度。
在本发明的一种实施方式中,步骤S2中,所述根据虚拟圆球模型下横向导航系速度,得到横向导航系下载体的第一位置的方法为:对虚拟圆球模型下横向导航系速度利用转换矩阵获得横向导航系下载体的位置pt:
式中,pt表示载体位置矢量在横向系下的映射;vv表示虚拟圆球模型下横向导航系速度;Rc表示转换矩阵,表示为:
在本发明的一种实施方式中,步骤S2中,所述根据实时数据、设定的速度阻尼系数和横向导航系姿态得到横向导航系相位调制后的速度的方法为:利用下式得到横向导航系相位调制后的速度:
其中,表示横向导航系相位调制后的速度矢量;表示载体系到横向系的方向余弦矩阵;fb表示加速度计测量比力;表示地球系相对惯性系的旋转角速度在横向系的映射;表示横向系相对于地球系的旋转角速度在横向系的映射;gt表示重力矢量在横向系的映射;k表示速度阻尼系数。
在本发明的一种实施方式中,步骤S3中,所述根据横向导航系姿态和相位调制后的横向导航系姿态得到惯性导航输出姿态的方法为:由下式得到惯性导航输出姿态:
在本发明的一种实施方式中,步骤S3中,所述根据虚拟圆球模型下横向导航系速度和虚拟圆球模型下横向导航系相位调制后的速度得到惯性导航输出速度的方法为:由下式得到惯性导航输出速度:
在本发明的一种实施方式中,步骤S3中,所述根据横向导航系下载体的第一位置和相位调制后横向导航系下载体的第二位置得到惯性导航输出载体的输出位置的方法为:由下式得到惯性导航输出载体的最终位置:
本发明还提供一种虚拟圆球模型下极区惯性导航相位调制阻尼系统,包括:
数据采集模块,用于采集惯性传感器的实时数据,根据实时数据得到横向导航系姿态;
速度获取模块,用于根据实时数据和横向导航系姿态更新横向导航系速度并利用虚拟圆球模型对横向导航系速度进行扩展,得到虚拟圆球模型下横向导航系速度;
载体的第一位置获取模块,用于根据虚拟圆球模型下横向导航系速度,得到横向导航系下载体的第一位置;
相位调制速度获取模块,用于根据实时数据、设定的速度阻尼系数和横向导航系姿态得到横向导航系相位调制后的速度,利用虚拟圆球模型对横向导航系相位调制后的速度进行扩展,得到虚拟圆球模型下横向导航系相位调制后的速度;
载体的第二位置获取模块,用于根据虚拟圆球模型下横向导航系相位调制后的速度,得到相位调制后横向导航系下载体的第二位置;
惯性导航输出模块,用于对横向导航系姿态进行相位调制,得到相位调制后的横向导航系姿态,根据横向导航系姿态和相位调制后的横向导航系姿态得到惯性导航输出姿态,根据虚拟圆球模型下横向导航系速度和虚拟圆球模型下横向导航系相位调制后的速度得到惯性导航输出速度,以及根据横向导航系下载体的第一位置和相位调制后横向导航系下载体的第二位置得到惯性导航输出载体的输出位置,根据所述惯性导航输出姿态、惯性导航输出速度、惯性导航输出载体的输出位置进行导航。
本发明的上述技术方案相比现有技术具有以下优点:
本发明为克服传统极区惯性导航方法存在的问题,采用一种虚拟圆球模型极区惯性导航相位调制阻尼方法,在对虚拟圆球模型下极区惯性导航的基础上,利用阻尼系数对惯性导航结果进行相位调制,并对双环路进行融合,减小惯性导航舒拉震荡。
附图说明
为了使本发明的内容更容易被清楚的理解,下面根据本发明的具体实施例并结合附图,对本发明作进一步详细的说明,其中
图1是本发明的虚拟圆球模型下极区惯性导航相位调制阻尼方法流程图;
图2是本发明的惯性导航相位调制结构框图;
图3本发明惯性导航的纵摇误差图;
图4本发明惯性导航的横摇误差图;
图5本发明惯性导航的东向速度误差图;
图6本发明惯性导航的北向速度误差图。
具体实施方式
下面结合附图和具体实施例对本发明作进一步说明,以使本领域的技术人员可以更好地理解本发明并能予以实施,但所举实施例不作为对本发明的限定。
实施例一
参照图1所示,本实施例提供虚拟圆球模型下极区惯性导航相位调制阻尼方法,包括如下步骤:
步骤S1:采采集惯性传感器的实时数据,根据实时数据得到横向导航系姿态;
由惯性传感器测量模型可知:
具体地,步骤S1中,陀螺仪量测常值漂移为εb=[0.02 0.02 0.02]To/h,T表示矢量转置,°/h表示度每小时;陀螺仪量测随机游走噪声系数为加速度计量测常值漂移为μ表示微,g表示当地重力加速度;加速度计量测随机游走噪声系数为Hz表示赫兹;陀螺仪和加速度计的更新频率为200Hz。
步骤S2:根据实时数据和横向导航系姿态更新横向导航系速度并利用虚拟圆球模型对横向导航系速度进行扩展,得到虚拟圆球模型下横向导航系速度,根据虚拟圆球模型下横向导航系速度,得到横向导航系下载体的第一位置;同时,根据实时数据、设定的速度阻尼系数和横向导航系姿态得到横向导航系相位调制后的速度,利用虚拟圆球模型对横向导航系相位调制后的速度进行扩展,得到虚拟圆球模型下横向导航系相位调制后的速度,根据虚拟圆球模型下横向导航系相位调制后的速度,得到相位调制后横向导航系下载体的第二位置;
具体地,步骤S2中,由横向导航坐标系姿态更新可知:
横向导航坐标系下速度矢量更新方程可以表示为:
式中,vt表示横向坐标系下的速度矢量;表示载体系到横向系的方向余弦矩阵;fb表示加速度计测量值;表示地球系相对惯性系的旋转角速度在横向系的映射;表示横向系相对于地球系的旋转角速度在横向系的映射;gt表示重力矢量在横向系的映射。
考虑地球是一个椭球体,且基本呈现一个轻微压扁的球体,因此,直接采用圆球进行速度更新会导致北向速度误差增大的现象。为此,利用虚拟圆球方法,对横向导航坐标系的北向速度进行扩展,得到虚拟圆球模型下的扩展之后的速度:
式中,RM表示导航系子午圈曲率半径;RN表示导航系卯酉圈曲率半径;ht表示横向系高度;
利用上述虚拟圆球速度vv,则横向导航坐标系下载体的位置更新方程可以表示为:
式中,pt表示位置矢量在横向系下的映射;vv表示采用虚拟圆球进行扩展之后横向坐标系下的速度矢量;Rc表示转换矩阵,可以表示为:
相位调制姿态更新:
惯性导航算法受仪表误差及初始误差会出现舒拉震荡,利用惯性导航算法超前计算,可以有效的消除舒拉震荡影响,提高系统稳定性。在算法执行过程中,分别采用两个环路进行惯导计算,如图2所示,实际更新就是正常的导航计算,虚拟扩展更新就是利用阻尼对正常导航进行计算,分为环路1和环路2,两个环路是同时进行的,进入阻尼阶段后,两个环路将各自的导航信息融合进行导航输出。当载体处于静止状态时,设定速度阻尼系数使得惯导速度更新如下式所示:
式中,表示横向坐标系下相位调制计算的速度矢量,由迭代计算得到的,初始值与横向导航坐标系下的速度一致;表示载体系到横向系的方向余弦矩阵;fb表示加速度计量测;表示地球系相对惯性系的旋转角速度在横向系的映射;表示横向系相对于地球系的旋转角速度在横向系的映射;gt表示重力矢量在横向系的映射;k表示阻尼系数;
同理,采用虚拟圆球对相位调制速度进行转换:
相位调制位置更新可以表示为:
步骤S3:对横向导航系姿态进行相位调制,得到相位调制后的横向导航系姿态,根据横向导航系姿态和相位调制后的横向导航系姿态得到惯性导航输出姿态,根据虚拟圆球模型下横向导航系速度和虚拟圆球模型下横向导航系相位调制后的速度得到惯性导航输出速度,以及根据横向导航系下载体的第一位置和相位调制后横向导航系下载体的第二位置得到惯性导航输出载体的输出位置;
经过相位调制之后,惯性导航输出可以表示为:
式中,表示惯性导航输出姿态矩阵;表示惯性导航输出速度矢量;表示惯性导航输出位置矢量;表示载体系到横向系的方向余弦矩阵;表示相位调制之后的姿态矩阵;MA()表示姿态矩阵转姿态角;AM()表示姿态角转姿态矩阵;表示采用虚拟圆球进行扩展之后横向坐标系下相位调制的速度矢量;vv表示采用虚拟圆球进行扩展之后横向坐标系下的速度矢量;表示相位调制之后的位置矢量;pt表示位置矢量在横向系下的映射;
步骤S4:根据惯性导航输出,设定极区惯性导航定位时长为M,本实施例设定M=3小时,若导航时间k=M,完成惯性导航定位,若k<M,表示惯性导航定位未完成,则重复上述步骤一至步骤五,直至惯性导航过程结束。
本实施例将本发明提出的一种虚拟圆球模型极区惯性导航相位调制阻尼方法,通过Matlab仿真软件进行仿真验证。仿真硬件环境均为Intel(R)Core(TM)T9600 CPU2.80GHz,4G RAM,Windows 7操作系统。如图3和图4、图5和图6所示,从图中可以看出,采用虚拟圆球模型进行相位调制算法,可以减小舒拉震荡。
实施例二
基于同一发明构思,本实施例提供了虚拟圆球模型下极区惯性导航相位调制阻尼系统,其解决问题的原理与所述虚拟圆球模型下极区惯性导航相位调制阻尼方法类似,重复之处不再赘述。
本实施例提供了虚拟圆球模型下极区惯性导航相位调制阻尼系统,包括:
数据采集模块,用于采集惯性传感器的实时数据,根据实时数据得到横向导航系姿态;
速度获取模块,用于根据实时数据和横向导航系姿态更新横向导航系速度并利用虚拟圆球模型对横向导航系速度进行扩展,得到虚拟圆球模型下横向导航系速度;
载体的第一位置获取模块,用于根据虚拟圆球模型下横向导航系速度,得到横向导航系下载体的第一位置;
相位调制速度获取模块,用于根据实时数据、设定的速度阻尼系数和横向导航系姿态得到横向导航系相位调制后的速度,利用虚拟圆球模型对横向导航系相位调制后的速度进行扩展,得到虚拟圆球模型下横向导航系相位调制后的速度;
载体的第二位置获取模块,用于根据虚拟圆球模型下横向导航系相位调制后的速度,得到相位调制后横向导航系下载体的第二位置;
惯性导航输出模块,用于对横向导航系姿态进行相位调制,得到相位调制后的横向导航系姿态,根据横向导航系姿态和相位调制后的横向导航系姿态得到惯性导航输出姿态,根据虚拟圆球模型下横向导航系速度和虚拟圆球模型下横向导航系相位调制后的速度得到惯性导航输出速度,以及根据横向导航系下载体的第一位置和相位调制后横向导航系下载体的第二位置得到惯性导航输出载体的输出位置,根据所述惯性导航输出姿态、惯性导航输出速度、惯性导航输出载体的输出位置进行导航。
本领域内的技术人员应明白,本申请的实施例可提供为方法、系统、或计算机程序产品。因此,本申请可采用完全硬件实施例、完全软件实施例、或结合软件和硬件方面的实施例的形式。而且,本申请可采用在一个或多个其中包含有计算机可用程序代码的计算机可用存储介质(包括但不限于磁盘存储器、CD-ROM、光学存储器等)上实施的计算机程序产品的形式。
本申请是参照根据本申请实施例的方法、设备(系统)、和计算机程序产品的流程图和/或方框图来描述的。应理解可由计算机程序指令实现流程图和/或方框图中的每一流程和/或方框、以及流程图和/或方框图中的流程和/或方框的结合。可提供这些计算机程序指令到通用计算机、专用计算机、嵌入式处理机或其他可编程数据处理设备的处理器以产生一个机器,使得通过计算机或其他可编程数据处理设备的处理器执行的指令产生用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的装置。
这些计算机程序指令也可存储在能引导计算机或其他可编程数据处理设备以特定方式工作的计算机可读存储器中,使得存储在该计算机可读存储器中的指令产生包括指令装置的制造品,该指令装置实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能。
这些计算机程序指令也可装载到计算机或其他可编程数据处理设备上,使得在计算机或其他可编程设备上执行一系列操作步骤以产生计算机实现的处理,从而在计算机或其他可编程设备上执行的指令提供用于实现在流程图一个流程或多个流程和/或方框图一个方框或多个方框中指定的功能的步骤。
显然,上述实施例仅仅是为清楚地说明所作的举例,并非对实施方式的限定。对于所属领域的普通技术人员来说,在上述说明的基础上还可以做出其它不同形式变化或变动。这里无需也无法对所有的实施方式予以穷举。而由此所引申出的显而易见的变化或变动仍处于本发明创造的保护范围之中。
Claims (10)
1.一种虚拟圆球模型下极区惯性导航相位调制阻尼方法,其特征在于,包括如下步骤:
步骤S1:采集惯性传感器的实时数据,根据实时数据得到横向导航系姿态;
步骤S2:根据实时数据和横向导航系姿态更新横向导航系速度并利用虚拟圆球模型对横向导航系速度进行扩展,得到虚拟圆球模型下横向导航系速度,根据虚拟圆球模型下横向导航系速度,得到横向导航系下载体的第一位置;
同时,根据实时数据、设定的速度阻尼系数和横向导航系姿态得到横向导航系相位调制后的速度,利用虚拟圆球模型对横向导航系相位调制后的速度进行扩展,得到虚拟圆球模型下横向导航系相位调制后的速度,根据虚拟圆球模型下横向导航系相位调制后的速度,得到相位调制后横向导航系下载体的第二位置;
步骤S3:对横向导航系姿态进行相位调制,得到相位调制后的横向导航系姿态,根据横向导航系姿态和相位调制后的横向导航系姿态得到惯性导航输出姿态,根据虚拟圆球模型下横向导航系速度和虚拟圆球模型下横向导航系相位调制后的速度得到惯性导航输出速度,以及根据横向导航系下载体的第一位置和相位调制后横向导航系下载体的第二位置得到惯性导航输出载体的输出位置,根据所述惯性导航输出姿态、惯性导航输出速度、惯性导航输出载体的输出位置进行导航。
10.一种虚拟圆球模型下极区惯性导航相位调制阻尼系统,其特征在于,包括:
数据采集模块,用于采集惯性传感器的实时数据,根据实时数据得到横向导航系姿态;
速度获取模块,用于根据实时数据和横向导航系姿态更新横向导航系速度并利用虚拟圆球模型对横向导航系速度进行扩展,得到虚拟圆球模型下横向导航系速度;
载体的第一位置获取模块,用于根据虚拟圆球模型下横向导航系速度,得到横向导航系下载体的第一位置;
相位调制速度获取模块,用于根据实时数据、设定的速度阻尼系数和横向导航系姿态得到横向导航系相位调制后的速度,利用虚拟圆球模型对横向导航系相位调制后的速度进行扩展,得到虚拟圆球模型下横向导航系相位调制后的速度;
载体的第二位置获取模块,用于根据虚拟圆球模型下横向导航系相位调制后的速度,得到相位调制后横向导航系下载体的第二位置;
惯性导航输出模块,用于对横向导航系姿态进行相位调制,得到相位调制后的横向导航系姿态,根据横向导航系姿态和相位调制后的横向导航系姿态得到惯性导航输出姿态,根据虚拟圆球模型下横向导航系速度和虚拟圆球模型下横向导航系相位调制后的速度得到惯性导航输出速度,以及根据横向导航系下载体的第一位置和相位调制后横向导航系下载体的第二位置得到惯性导航输出载体的输出位置,根据所述惯性导航输出姿态、惯性导航输出速度、惯性导航输出载体的输出位置进行导航。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111194989.0A CN114001731B (zh) | 2021-10-12 | 2021-10-12 | 虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111194989.0A CN114001731B (zh) | 2021-10-12 | 2021-10-12 | 虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN114001731A true CN114001731A (zh) | 2022-02-01 |
CN114001731B CN114001731B (zh) | 2023-03-07 |
Family
ID=79922840
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111194989.0A Active CN114001731B (zh) | 2021-10-12 | 2021-10-12 | 虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114001731B (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117470235A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下长航时跨极区阻尼切换方法 |
CN117516520A (zh) * | 2023-11-10 | 2024-02-06 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下极区最优阻尼方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB814744A (en) * | 1955-12-29 | 1959-06-10 | Gen Precision Lab Inc | Improvements in world wide navigational system |
US3195135A (en) * | 1960-06-02 | 1965-07-13 | Messerschmitt Ag | Apparatus for guiding vtol aircraft to a restricted landing surface |
CN1639965A (zh) * | 2002-02-22 | 2005-07-13 | 鲁道夫·施瓦脱 | 用于检测和处理电信号和光信号的方法和装置 |
CN104407696A (zh) * | 2014-11-06 | 2015-03-11 | 北京京东尚科信息技术有限公司 | 移动设备的虚拟球模拟及控制的方法 |
CN105136142A (zh) * | 2015-10-16 | 2015-12-09 | 北京机械设备研究所 | 一种基于微惯性传感器的室内定位方法 |
CN106443746A (zh) * | 2016-07-19 | 2017-02-22 | 招商局重庆交通科研设计院有限公司 | 一种低成本双天线gnss/ahrs组合测姿方法 |
CN111928848A (zh) * | 2020-09-24 | 2020-11-13 | 中国人民解放军国防科技大学 | 一种基于虚拟圆球法向量模型的极区惯性导航方法 |
US20210206460A1 (en) * | 2015-12-31 | 2021-07-08 | FLIR Belgium BVBA | Navigation scene analysis systems and methods |
-
2021
- 2021-10-12 CN CN202111194989.0A patent/CN114001731B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
GB814744A (en) * | 1955-12-29 | 1959-06-10 | Gen Precision Lab Inc | Improvements in world wide navigational system |
US3195135A (en) * | 1960-06-02 | 1965-07-13 | Messerschmitt Ag | Apparatus for guiding vtol aircraft to a restricted landing surface |
CN1639965A (zh) * | 2002-02-22 | 2005-07-13 | 鲁道夫·施瓦脱 | 用于检测和处理电信号和光信号的方法和装置 |
CN104407696A (zh) * | 2014-11-06 | 2015-03-11 | 北京京东尚科信息技术有限公司 | 移动设备的虚拟球模拟及控制的方法 |
CN105136142A (zh) * | 2015-10-16 | 2015-12-09 | 北京机械设备研究所 | 一种基于微惯性传感器的室内定位方法 |
US20210206460A1 (en) * | 2015-12-31 | 2021-07-08 | FLIR Belgium BVBA | Navigation scene analysis systems and methods |
CN106443746A (zh) * | 2016-07-19 | 2017-02-22 | 招商局重庆交通科研设计院有限公司 | 一种低成本双天线gnss/ahrs组合测姿方法 |
CN111928848A (zh) * | 2020-09-24 | 2020-11-13 | 中国人民解放军国防科技大学 | 一种基于虚拟圆球法向量模型的极区惯性导航方法 |
Non-Patent Citations (5)
Title |
---|
FRANOIS MICHAUD 等: "Selective embolization with magnetized microbeads using magnetic resonance navigation in a controlled-flow liver model", 《MEDICAL PHYSICS》 * |
HUANG LING等: "Transverse SINS/DVL Integrated Polar Navigation Algorithm Based on Virtual Sphere Model.", 《MATHEMATICAL PROBLEMS IN ENGINEERING》 * |
WU F等: "Virtual Polar Region Method Based on the Earth’s Transverse Ellipsoid Model", 《MATHEMATICAL PROBLEMS IN ENGINEERING》 * |
周月: "极区惯性导航算法研究", 《中国优秀硕士学位论文全文数据库信息科技辑》 * |
王士敏 等: "减小转子能介频率时振动幅度的相位调制方法", 《力学2000学术大会》 * |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN117470235A (zh) * | 2023-11-10 | 2024-01-30 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下长航时跨极区阻尼切换方法 |
CN117516520A (zh) * | 2023-11-10 | 2024-02-06 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下极区最优阻尼方法 |
CN117470235B (zh) * | 2023-11-10 | 2024-04-26 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下长航时跨极区阻尼切换方法 |
CN117516520B (zh) * | 2023-11-10 | 2024-05-14 | 中国人民解放军国防科技大学 | 一种优化的地球椭球模型下极区最优阻尼方法 |
Also Published As
Publication number | Publication date |
---|---|
CN114001731B (zh) | 2023-03-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN114001731B (zh) | 虚拟圆球模型下极区惯性导航相位调制阻尼方法及系统 | |
CN102486377B (zh) | 一种光纤陀螺捷联惯导系统初始航向的姿态获取方法 | |
Phuong et al. | A DCM based orientation estimation algorithm with an inertial measurement unit and a magnetic compass | |
JP3848941B2 (ja) | 地磁界センサの姿勢誤差補償装置及び方法 | |
CN101672649B (zh) | 一种基于数字低通滤波的船用光纤捷联系统系泊对准方法 | |
CN103344260B (zh) | 基于rbckf的捷联惯导系统大方位失准角初始对准方法 | |
CN101290229A (zh) | 硅微航姿系统惯性/地磁组合方法 | |
CN109884680B (zh) | 基于多核dsp的北斗_sins紧组合导航系统及方法 | |
CN105300379A (zh) | 一种基于加速度的卡尔曼滤波姿态估计方法及系统 | |
US20140222369A1 (en) | Simplified method for estimating the orientation of an object, and attitude sensor implementing such a method | |
CN102519485B (zh) | 一种引入陀螺信息的二位置捷联惯性导航系统初始对准方法 | |
CN109141475A (zh) | 一种dvl辅助sins鲁棒行进间初始对准方法 | |
CN112902956A (zh) | 一种手持式gnss/mems-ins接收机航向初值获取方法、电子设备、存储介质 | |
CN108871319B (zh) | 一种基于地球重力场与地磁场序贯修正的姿态解算方法 | |
CN106370178A (zh) | 移动终端设备的姿态测量方法及装置 | |
CN112577518A (zh) | 一种惯性测量单元标定方法及装置 | |
CN109029499B (zh) | 一种基于重力视运动模型的加速度计零偏迭代寻优估计方法 | |
CN103644913B (zh) | 基于直接导航模型的无迹卡尔曼非线性初始对准方法 | |
CN109443378B (zh) | 速度辅助行进间回溯初始对准方法 | |
CN106441297A (zh) | 惯导系统的重力误差矢量获取方法和装置 | |
CN113137977A (zh) | 一种sins/偏振光组合导航初始对准滤波方法 | |
CN111780758A (zh) | 一种基于双模解算的重力稳定平台姿态确定方法及应用 | |
Zhe et al. | Adaptive complementary filtering algorithm for imu based on mems | |
CN113932803B (zh) | 适用于高动态飞行器的惯性/地磁/卫星组合导航系统 | |
Nikolaev et al. | Strapdown inertial navigation system calibration |
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 |