CN112729290A - 一种惯性导航设备的航姿数据同步误差补偿方法 - Google Patents
一种惯性导航设备的航姿数据同步误差补偿方法 Download PDFInfo
- Publication number
- CN112729290A CN112729290A CN202011556099.5A CN202011556099A CN112729290A CN 112729290 A CN112729290 A CN 112729290A CN 202011556099 A CN202011556099 A CN 202011556099A CN 112729290 A CN112729290 A CN 112729290A
- Authority
- CN
- China
- Prior art keywords
- time
- attitude
- navigation
- carrier
- heading
- 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
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
-
- 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
-
- 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)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manufacturing & Machinery (AREA)
- Navigation (AREA)
Abstract
本发明具体涉及一种惯性导航设备的航姿数据同步误差补偿方法,其根据最近时段的导航解算周期载体航姿角速率以及同步时刻与当前导航解算时刻之间的时差,对当前导航解算时刻的载体航姿信息进行补偿。具体包括:计算最近时段的导航解算周期载体航姿角速率;在同步时刻,计算同步时刻与当前导航解算时刻之间的时差;根据当前导航解算时刻的载体航姿信息,最近时段的导航解算周期载体航姿角速率,以及同步时刻与当前导航解算时刻之间的时差,计算得到同步时刻载体航姿信息。本发明中的航姿数据同步误差补偿方法能够实现同步时刻与导航解算时刻实时性同步,从而能够提升惯性导航设备的航姿信息输出实时性和可靠性。
Description
技术领域
本发明涉及惯性导航技术领域,具体涉及一种惯性导航设备的航姿数据同步误差补偿方法。
背景技术
惯性导航产品具有测量动态范围宽、线性度好、性能稳定、全天候导航等优点,在舰船导航领域具有不可替代性。惯性导航产品的实质是利用核心敏感器件对载体的角运动信息和视加速度信息进行采集,通过一定的数学模型获得载体相对于当地地理坐标系下的角速度和加速度信息,采用积分的方式计算出载体的航姿信息、速度信息、位置信息等。
惯性导航产品惯性传感器误差的激励效果直接影响到其在线标定与补偿后的导航精度和可靠性等综合性能,是惯性导航产品惯性传感器误差参数辨识的前提。为此,在研究惯性传感器误差参数动态辨识方法的同时,需要分析并确定引起惯性导航产品惯性传感器误差的因素。为此,公开号为CN104215262A的中国专利就公开了《一种惯性导航系统惯性传感器误差在线动态辨识方法》其包括以下步骤:首先建立惯性传感器的误差模型,据此建立包含惯性传感器误差状态量的卡尔曼滤波模型;随后给出了惯性传感器误差的动态激励方法;最后根据误差动态激励方法设计误差辨识动态航迹,利用卡尔曼滤波对惯性传感器误差进行在线动态辨识。该方案能够有效激励惯性传感器误差。
惯性导航产品作为为舰船导航提供导航定位数据信息的设备,其数据输出时刻受系统外部时统信号触发输出,在积分计算过程中,需要建立内部时间片,从而计算出载体在不同计算时刻的航姿信息。然而,由于系统时钟源和惯性导航设备内部时钟源精度差异、以及系统同步设备和惯性导航设备上电先后顺序等原因,系统外部时统信号与导航设备内部时统信号不能完全同步,即惯性导航设备导航解算时刻与同步时刻(外部系统通过外时统获取航姿数据时刻)不一致,导致导航设备输出数据存在时差。此外,在不做同步时差补偿情况下,惯性导航设备输出航姿数据为同步时刻前一导航解算时刻的数据,则产生数据时刻与输出时刻存在上述时差,并且该时差受惯性导航解算频率和外部时统信号稳定性影响,存在动态变化的情况,不能准确反映外时统要求时刻载体实时航向姿态信息。因此,申请人想到设计一种能够实现同步时刻与导航解算时刻实时性同步的航姿数据同步误差补偿方法。
发明内容
针对上述现有技术的不足,本发明所要解决的技术问题是:如何提供一种能够实现同步时刻与导航解算时刻实时性同步的航姿数据同步误差补偿方法,从而提升惯性导航设备的航姿信息输出实时性和可靠性。
为了解决上述技术问题,本发明采用了如下的技术方案:
一种惯性导航设备的航姿数据同步误差补偿方法,根据最近时段的导航解算周期载体航姿角速率以及同步时刻与当前导航解算时刻之间的时差,对当前导航解算时刻的载体航姿信息进行补偿。
优选的,具体包括如下步骤:
S2:在同步时刻tout,计算同步时刻与当前导航解算时刻之间的时差▽t;
优选的,步骤S2中,首先设置缓存计数器Counter,其在每个导航解算时刻进行清零,并以计时频率Fc进行累加计数完成时间测量。
优选的,在同步时刻tout,锁存缓存计数器Counter的数据和性能,并计算同步时刻与当前导航解算时刻之间的时差▽t。
优选的,同步时刻与当前导航解算时刻之间的时差▽t通过如下公式计算:
▽t=Counter/Fc,式中,表示▽t同步时刻与当前导航解算时刻之间的时差,Counter表示缓存计数器的锁存数据,Fc表示计时频率。
优选的,步骤S3中,同步时刻载体航姿信息通过如下公式计算:
优选的,工作频率Fa为100MHz,导航解算频率Fb为100Hz,计时频率Fc为100KHz。
本发明中的航姿数据同步误差补偿方法与现有技术相比,具有如下优点:
1、本发明中,利用了惯性导航设备的内部时钟、并通过惯性导航设备处理器对设备内部的同步时刻(外部同步时统时刻)与当前导航解算时刻之间的时差进行了精确测量,然后利用设备最近时段的导航解算周期载体航姿角速率,对两者时差导致的姿态误差进行实时性补偿得到了同步时刻载体航姿信息,从而提高了惯性导航设备航姿信息输出的实时性。
2、本发明中,采用动态测量的方式计算同步时刻与当前导航解算时刻之间的时差,这能够解决设备与系统同步时统设备上电先后顺序以及时钟源误差等导致的时差动态变化问题,从而能够提升惯性导航设备航姿信息输出的可靠性。
3、本发明中,通过当前导航解算时刻的载体航姿信息和上一导航解算时刻的载体航姿数据计算最近时段的导航解算周期载体航姿角速率,使得最近时段的导航解算周期载体航姿角速率能够很好地反映载体航姿数据的变化趋势,从而能够保证航姿数据同步误差补偿的补偿效果。
附图说明
为了使发明的目的、技术方案和优点更加清楚,下面将结合附图对本发明作进一步的详细描述,其中:
图1为实施例中航姿数据同步误差补偿方法的逻辑框图;
图2为实施例中航姿数据同步误差补偿的流程图;
图3为实施例中惯性导航设备工作时的时序图。
具体实施方式
下面通过具体实施方式进一步详细的说明:
实施例:
本实施例中公开了一种惯性导航设备的航姿数据同步误差补偿方法。
一种惯性导航设备的航姿数据同步误差补偿方法,其根据最近时段的导航解算周期载体航姿角速率以及同步时刻与当前导航解算时刻之间的时差,对当前导航解算时刻的载体航姿信息进行补偿。
如图1所示,航姿数据同步误差补偿方法具体包括如下步骤:
S2:在同步时刻tout,计算同步时刻与当前导航解算时刻之间的时差▽t;
结合图2和图3所示,本发明利用了惯性导航设备的内部时钟、并通过惯性导航设备处理器对设备内部的同步时刻(外部同步时统时刻)与当前导航解算时刻之间的时差进行了精确测量,然后利用设备最近时段的导航解算周期载体航姿角速率,对两者时差导致的姿态误差进行实时性补偿得到了同步时刻载体航姿信息,从而提高了惯性导航设备航姿信息输出的实时性。其次,本发明采用动态测量的方式计算同步时刻与当前导航解算时刻之间的时差,这能够解决设备与系统同步时统设备上电先后顺序以及时钟源误差等导致的时差动态变化问题,从而能够提升惯性导航设备航姿信息输出的可靠性。此外,本发明中通过当前导航解算时刻的载体航姿信息和上一导航解算时刻的载体航姿数据计算最近时段的导航解算周期载体航姿角速率,使得最近时段的导航解算周期载体航姿角速率能够很好地反映载体航姿数据的变化趋势,从而能够保证航姿数据同步误差补偿的补偿效果。
具体实施过程中,步骤S1之前,先将惯性导航设备处理器的工作频率Fa分频成导航解算频率Fb和计时频率Fc,分别用于计算最近时段的导航解算周期载体航姿角速率和同步时刻与当前导航解算时刻之间的时差▽t。本实施例中,惯性导航设备的处理器选用FGPA、ARM或DSP等对晶振输入基准频率进行倍频,从而使处理器工作在较高的工作频率;工作频率Fa为100MHz,导航解算频率Fb为100Hz,计时频率Fc为100KHz。
本发明中,将惯性导航设备处理器的工作频率分频成导航解算频率和计时频率,目的是能够尽可能的兼顾航姿角速率和时差的计算速率,从而保证航姿数据同步误差补偿的补偿效果。
具体实施过程中,步骤S1中,先获取载体角运动和视加速度信息,再进行导航解算以计算得到当前导航解算时刻t2及其对应的载体航姿信息本实施例中,利用现有技术中成熟使用的陀螺计和加速度计获取载体角运动和视加速度信息。
本发明中,通过载体角运动和视加速度信息导航解算得到当前导航解算时刻及其对应的载体航姿信息,有利于后续导航解算周期载体航姿角速率的计算,从而能够保证航姿数据同步误差补偿的补偿效果。
具体实施过程中,步骤S2中,首先设置缓存计数器Counter,其在每个导航解算时刻进行清零,并以计时频率Fc进行累加计数完成时间测量。在同步时刻tout,锁存缓存计数器Counter的数据和性能,并计算同步时刻与当前导航解算时刻之间的时差▽t。
本发明中,通过上述方式计算时差,即实现了同步时刻与当前导航解算时刻之间时差的动态测量,这能够解决设备与系统同步时统设备上电先后顺序以及时钟源误差等导致的时差动态变化问题,从而能够提升惯性导航设备航姿信息输出的可靠性。
具体实施过程中,同步时刻与当前导航解算时刻之间的时差▽t通过如下公式计算:
▽t=Counter/Fc,式中,表示▽t同步时刻与当前导航解算时刻之间的时差,Counter表示缓存计数器的锁存数据,Fc表示计时频率。
本发明中,通过上述公式能够很好地计算得到同步时刻与当前导航解算时刻之间的时差,有利于保证航姿数据同步误差补偿的补偿效果。
具体实施过程中,步骤S3中,同步时刻载体航姿信息通过如下公式计算:
本发明中,通过上述公式能够很好地计算得到同步时刻载体航姿信息,其利用了惯性导航设备的内部时钟、并通过惯性导航设备处理器对设备内部的同步时刻(外部同步时统时刻)与当前导航解算时刻之间的时差进行了精确测量,然后利用设备最近时段的导航解算周期载体航姿角速率,对两者时差导致的姿态误差进行实时性补偿得到了同步时刻载体航姿信息,从而提高了惯性导航设备航姿信息输出的实时性。
以上所述的仅是本发明的实施例,方案中公知的具体结构及特性等常识在此未作过多描述,所属领域普通技术人员知晓申请日或者优先权日之前发明所属技术领域所有的普通技术知识,能够获知该领域中所有的现有技术,并且具有应用该日期之前常规实验手段的能力,所属领域普通技术人员可以在本申请给出的启示下,结合自身能力完善并实施本方案,一些典型的公知结构或者公知方法不应当成为所属领域普通技术人员实施本申请的障碍。应当指出,对于本领域的技术人员来说,在不脱离本发明结构的前提下,还可以作出若干变形和改进,这些也应该视为本发明的保护范围,这些都不会影响本发明实施的效果和专利的实用性。本申请要求的保护范围应当以其权利要求的内容为准,说明书中的具体实施方式等记载可以用于解释权利要求的内容。
Claims (10)
1.一种惯性导航设备的航姿数据同步误差补偿方法,其特征在于:根据最近时段的导航解算周期载体航姿角速率以及同步时刻与当前导航解算时刻之间的时差,对当前导航解算时刻的载体航姿信息进行补偿。
6.如权利要求3所述的惯性导航设备的航姿数据同步误差补偿方法,其特征在于:步骤S2中,首先设置缓存计数器Counter,在每个导航解算时刻对Counter进行清零,并以计时频率Fc进行累加计数,从而进行时差测量。
7.如权利要求6所述的惯性导航设备的航姿数据同步误差补偿方法,其特征在于:在同步时刻tout,锁存缓存计数器Counter累加值,计算同步时刻与当前导航解算时刻之间的时差▽t。
8.如权利要求6所述的惯性导航设备的航姿数据同步误差补偿方法,其特征在于,同步时刻与当前导航解算时刻之间的时差▽t通过如下公式计算:
▽t=Counter/Fc,式中,表示▽t同步时刻与当前导航解算时刻之间的时差,Counter表示外同步中断产生时对Counter缓存计数器累加值的锁存数据,Fc表示计时频率。
10.如权利要求3所述的惯性导航设备的航姿数据同步误差补偿方法,其特征在于,工作频率Fa为100MHz,导航解算频率Fb为100Hz,计时频率Fc为100KHz。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011556099.5A CN112729290B (zh) | 2020-12-23 | 2020-12-23 | 一种惯性导航设备的航姿数据同步误差补偿方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202011556099.5A CN112729290B (zh) | 2020-12-23 | 2020-12-23 | 一种惯性导航设备的航姿数据同步误差补偿方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN112729290A true CN112729290A (zh) | 2021-04-30 |
CN112729290B CN112729290B (zh) | 2023-06-02 |
Family
ID=75615566
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202011556099.5A Active CN112729290B (zh) | 2020-12-23 | 2020-12-23 | 一种惯性导航设备的航姿数据同步误差补偿方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN112729290B (zh) |
Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102183253A (zh) * | 2010-12-31 | 2011-09-14 | 北京航空航天大学 | 一种位置和姿态测量系统的软件时间同步方法 |
US20120232792A1 (en) * | 2011-03-08 | 2012-09-13 | Seiko Epson Corporation | Positioning apparatus and positioning method |
CN103398713A (zh) * | 2013-04-26 | 2013-11-20 | 哈尔滨工程大学 | 一种星敏感器/光纤惯性设备量测数据同步方法 |
CN103913179A (zh) * | 2014-03-19 | 2014-07-09 | 中国人民解放军63680部队 | 舰载单轴旋转调制捷联惯导姿态角修正方法 |
CN107525524A (zh) * | 2017-09-11 | 2017-12-29 | 哈尔滨工程大学 | 一种基于三轴同步转台的惯性导航系统时延确定方法 |
CN107747953A (zh) * | 2017-10-25 | 2018-03-02 | 上海航天控制技术研究所 | 一种多敏感器数据与轨道信息时间同步方法 |
CN108413981A (zh) * | 2017-12-15 | 2018-08-17 | 中国船舶重工集团公司第七0七研究所 | 一种高精度惯性导航设备时序测量方法 |
US20190277655A1 (en) * | 2016-11-17 | 2019-09-12 | Elbit Systems Ltd. | Self-calibrating inertial measurement system and method |
CN110426033A (zh) * | 2019-07-30 | 2019-11-08 | 上海理工大学 | 基于松耦合imu阵列导航系统的时间同步算法 |
CN110657800A (zh) * | 2018-06-29 | 2020-01-07 | 北京自动化控制设备研究所 | 一种位置测量组合导航系统的时间同步方法 |
CN110849359A (zh) * | 2019-11-21 | 2020-02-28 | 中国船舶重工集团公司第七0七研究所 | 一种捷联式光纤陀螺惯导系统及内部时序和对外同步设计方法 |
-
2020
- 2020-12-23 CN CN202011556099.5A patent/CN112729290B/zh active Active
Patent Citations (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102183253A (zh) * | 2010-12-31 | 2011-09-14 | 北京航空航天大学 | 一种位置和姿态测量系统的软件时间同步方法 |
US20120232792A1 (en) * | 2011-03-08 | 2012-09-13 | Seiko Epson Corporation | Positioning apparatus and positioning method |
CN103398713A (zh) * | 2013-04-26 | 2013-11-20 | 哈尔滨工程大学 | 一种星敏感器/光纤惯性设备量测数据同步方法 |
CN103913179A (zh) * | 2014-03-19 | 2014-07-09 | 中国人民解放军63680部队 | 舰载单轴旋转调制捷联惯导姿态角修正方法 |
US20190277655A1 (en) * | 2016-11-17 | 2019-09-12 | Elbit Systems Ltd. | Self-calibrating inertial measurement system and method |
CN107525524A (zh) * | 2017-09-11 | 2017-12-29 | 哈尔滨工程大学 | 一种基于三轴同步转台的惯性导航系统时延确定方法 |
CN107747953A (zh) * | 2017-10-25 | 2018-03-02 | 上海航天控制技术研究所 | 一种多敏感器数据与轨道信息时间同步方法 |
CN108413981A (zh) * | 2017-12-15 | 2018-08-17 | 中国船舶重工集团公司第七0七研究所 | 一种高精度惯性导航设备时序测量方法 |
CN110657800A (zh) * | 2018-06-29 | 2020-01-07 | 北京自动化控制设备研究所 | 一种位置测量组合导航系统的时间同步方法 |
CN110426033A (zh) * | 2019-07-30 | 2019-11-08 | 上海理工大学 | 基于松耦合imu阵列导航系统的时间同步算法 |
CN110849359A (zh) * | 2019-11-21 | 2020-02-28 | 中国船舶重工集团公司第七0七研究所 | 一种捷联式光纤陀螺惯导系统及内部时序和对外同步设计方法 |
Non-Patent Citations (2)
Title |
---|
严恭敏等: "捷联惯导系统中加速度计的时延补偿研究", 宇航学报 * |
吴志华: "基于星敏感器/陀螺组合定姿系统研究", 《中国优秀硕士学位论文全文数据库 (工程科技Ⅱ辑)》 * |
Also Published As
Publication number | Publication date |
---|---|
CN112729290B (zh) | 2023-06-02 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN110133999B (zh) | 一种基于星云激光点云数采平台的时间同步方法及系统 | |
US11385359B2 (en) | Point cloud data acquisition method and device under situation of no GNSS signal | |
US10721696B2 (en) | Data synchronization across multiple sensors | |
CN108168918B (zh) | 用于轨道自动测量车同步测量的同步自动控制系统及方法 | |
CN106154299A (zh) | 一种gps/sins组合导航系统时间同步方法 | |
JP2009505062A (ja) | リアルタイムバイアス推定器に基づく慣性機器のための自己較正 | |
RU2007137197A (ru) | Навигационный комплекс, устройство вычисления скорости и координат, бесплатформенная инерциальная курсовертикаль, способ коррекции инерциальных датчиков и устройство для его осуществления | |
CN113783652B (zh) | 一种组合导航系统的数据同步方法和装置 | |
CN110044377B (zh) | 一种基于Vicon的IMU离线标定方法 | |
JP2019191093A (ja) | 変位分析装置、gnss測位分析装置及び変位分析方法 | |
Li et al. | Multisensor time synchronization error modeling and compensation method for distributed POS | |
CN108107233B (zh) | 加速度计标度因数的连续温度校正方法及系统 | |
CN113218435A (zh) | 一种多传感器时间同步方法 | |
CN103364842B (zh) | 一种捷联式航空重力仪误差分离方法 | |
JP2001174275A (ja) | ハイブリッド航法およびその装置 | |
RU2683144C1 (ru) | Способ определения ошибок ориентации измерительных осей лазерных гироскопов и маятниковых акселерометров в бесплатформенной инерциальной навигационной системе | |
CN102901517B (zh) | 一种基于时间同步的火箭橇试验测量系统 | |
CN112729290A (zh) | 一种惯性导航设备的航姿数据同步误差补偿方法 | |
CN209821607U (zh) | 时码测量分析仪 | |
CN111399022A (zh) | 一种卫星导航与惯性导航超紧组合仿真定位的方法及终端 | |
CN103868527A (zh) | 一种标定捷联惯性组合加速度计组合的方法 | |
CN113341679B (zh) | 基于北斗空间铷原子钟的高精度信号频率控制方法及系统 | |
CN105910617A (zh) | 一种车载导航系统中采样点时间同步的方法及装置 | |
Gojcic et al. | Synchronization routine for real-time synchronization of robotic total stations | |
CN105589328B (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 |