CN103557873A - 一种快速动态对准方法 - Google Patents
一种快速动态对准方法 Download PDFInfo
- Publication number
- CN103557873A CN103557873A CN201310556839.9A CN201310556839A CN103557873A CN 103557873 A CN103557873 A CN 103557873A CN 201310556839 A CN201310556839 A CN 201310556839A CN 103557873 A CN103557873 A CN 103557873A
- Authority
- CN
- China
- Prior art keywords
- omega
- calculate
- accelerometer
- parameter
- delta
- 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
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
技术领域
本发明属于对准方法,具体涉及一种快速动态对准方法。
背景技术
平台惯导***在能对外输出导航信息前,必须进行初始对准。在静基座条件下,为了完成初始对准,需要利用重力和地球自转角速率信息,使平台惯导***中平台台体在航向上工作在一个或多个不同位置,从而得出三个陀螺的漂移和平台系相对地理系的三个失准角。然而在晃动基座条件下,由于载体的角振动,使得惯性平台测得重力和地球自转角速率都有较大干扰,严重影响了对准精度。为了消除这些干扰,需要采用新的滤波方法完成晃动基座下的平台惯导自对准。
发明内容
本发明的目的是针对现有技术的缺陷,提供一种快速动态对准方法。
本发明是这样实现的:1.一种快速动态对准方法,其特征在于,包括下述步骤:
步骤一:粗对准
步骤1.1:输入信息
需要输入的信息包括下述三类
(a)加速度计数据
上述的xyz是指加速度的方向,下标k表示k采样时刻的数据,右上角的角标(2)是指位置二,N(2)是在第二位置中总共的数据。
(b)旋变数据
j表示位置,本申请共有两个位置,位置一和位置二,右下角的角标1、2、3表示不同传感器给出的数据,即需要输入在每个位置,开始时刻的旋变数据
所有角标的意义与前相同,所述的T1是指结束时刻,T1/2是指中间时刻,即需要输入在每个位置,中间时刻和结束时刻的旋变数据。
(c)加速度计参数
n0x,n0y,n0z,Mx,My,Mz,△yx,△zx,△zy
所述的n0x,n0y,n0z为加速度计零偏,Mx,My,Mz为加速度计刻度系数,△yx,△zx,△zy为加速度计安装误差。
上述加速度计参数均是可以直接得到的。
步骤1.2:计算ax、ay、az
式中:
n0x,n0y,n0z为加速度计零偏;Mx,My,Mz为加速度计刻度系数;
Δyx,Δzx,Δzy为加速度计安装误差。
步骤1.3:计算ωx、ωz
式中:
步骤1.4:计算
式中:
c11=c22c33-c32c23
c12=c31c23-c21c33
c13=c21c32-c31c22
其中Ω为地球自转角速率。
式中
如上所述的一种快速动态对准方法,其中,在步骤一后增加下述步骤,
步骤二:导航解算
步骤2.1:输入
本步骤需要的参数除了步骤一中已经输入的参数外,还包括
(a)平台漂移和加速度计参数
ω0x,ω0y,ω0z平台与加速度无关漂移,该三个参数为平台固有参数,
ωxx,ωxz,ωyx,ωyy,ωzx,ωzz平台与加速度相关漂移,该六个参数为传感器测量得到的输入;
n0x,n0y,n0z,Mx,My,Mz加速度计零偏和刻度系数,该六个参数为加速度计固有参数;
基座的线速度该三个为传感器测量得到。
步骤2.2:计算ωxk-1、ωxk、ωyk-1、ωyk、ωzk-1、ωzk
通过下述公式进行计算
Cip0=Cgp(0)
△t为采样时间。
步骤2.3:计算ωx、ωy、ωz
ωx=(ωxk-1+ωxk)/2
ωy=(ωyk-1+ωyk)/2
ωz=(ωzk-1+ωzk)/2
步骤2.4:计算Cipk
步骤2.5:计算Cgik
Ω是地球自转角速率。
步骤2.6:计算Cgpk
Cgpk=Cgik·Cipk,
步骤2.7:计算位置rgk
如上所述的一种快速动态对准方法,其中,在步骤二后增加下述步骤,
步骤三:中间变量计算
步骤3.1:输入信息
步骤3.2:计算:
用下述公式进行计算
θy(t)=θy0+ωygt.
最小二乘
Zm×1=Hm×nXn×1
则X的最小二乘估计为:
其中
如上所述的一种快速动态对准方法,其中,在步骤三后增加下述步骤,
步骤四:对准
用下述公式进行计算:
计算得到的结果即为最终结果。
本发明的有益效果是:本发明在载体有角振动的条件下能准确估算平台系相对地理系的三个失准角以及三个未补偿的平台漂移(平台系),从而达到了高精度的自对准目的。
具体实施方式
一种快速动态对准方法,包括下述步骤:
步骤一:粗对准
步骤1.1:输入信息
需要输入的信息包括下述三类
(a)加速度计数据
上述的xyz是指加速度的方向,下标k表示k采样时刻的数据,右上角的角标(2)是指位置二,N(2)是在第二位置中总共的数据。
(b)旋变数据
j表示位置,本申请共有两个位置,位置一和位置二,右下角的角标1、2、3表示不同传感器给出的数据,即需要输入在每个位置,开始时刻的旋变数据
所有角标的意义与前相同,所述的T1是指结束时刻,T1/2是指中间时刻,即需要输入在每个位置,中间时刻和结束时刻的旋变数据。
(c)加速度计参数
n0x,n0y,n0z,Mx,My,Mz,Δyx,Δzx,Δzy
所述的n0x,n0y,n0z为加速度计零偏,Mx,My,Mz为加速度计刻度系数,Δyx,Δzx,Δzy为加速度计安装误差。
上述加速度计参数均是可以直接得到的。
步骤1.2:计算ax、ay、az
式中:
n0x,n0y,n0z为加速度计零偏;Mx,My,Mz为加速度计刻度系数;
Δyx,Δzx,Δzy为加速度计安装误差。
步骤1.3:计算ωx、ωz
式中:
步骤1.4:计算
式中:
c11=c22c33-c32c23
c12=c31c23-c21c33
c13=c21c32-c31c22
其中Ω为地球自转角速率。
式中
步骤二:导航解算
步骤2.1:输入
本步骤需要的参数除了步骤一中已经输入的参数外,还包括
(a)平台漂移和加速度计参数
ω0x,ω0y,ω0z平台与加速度无关漂移,该三个参数为平台固有参数,
ωxx,ωxz,ωyx,ωyy,ωzx,ωzz平台与加速度相关漂移,该六个参数为传感器测量得到的输入;
n0x,n0y,n0z,Mx,My,Mz加速度计零偏和刻度系数,该六个参数为加速度计固有参数;
步骤2.2:计算ωxk-1、ωxk、ωyk-1、ωyk、ωzk-1、ωzk
通过下述公式进行计算
Cip0=Cgp(0)
△t为采样时间。
步骤2.3:计算ωx、ωy、ωz
ωx=(ωxk-1+ωxk)/2
ωy=(ωyk-1+ωyk)/2
ωz=(ωzk-1+ωzk)/2
步骤2.4:计算Cipk
步骤2.5:计算Cgik
Ω是地球自转角速率。
步骤2.6:计算Cgpk
Cgpk=Cgik·Cipk,
步骤2.7:计算位置rgk
步骤2.6计算得到的和步骤2.7计算得到的
步骤三:中间变量计算
步骤3.1:输入信息
步骤3.2:计算:
用下述公式进行计算
θy(t)=θy0+ωygt.
最小二乘
Zm×1=Hm×nXn×1
则X的最小二乘估计为:
其中
步骤四:对准
用下述公式进行计算:
计算得到的结果即为最终结果。
Claims (4)
1.一种快速动态对准方法,其特征在于,包括下述步骤:
步骤一:粗对准
步骤1.1:输入信息
需要输入的信息包括下述三类
(a)加速度计数据
上述的xyz是指加速度的方向,下标k表示k采样时刻的数据,右上角的角标(2)是指位置二,N(2)是在第二位置中总共的数据。
(b)旋变数据
j表示位置,本申请共有两个位置,位置一和位置二,右下角的角标1、2、3表示不同传感器给出的数据,即需要输入在每个位置,开始时刻的旋变数据
所有角标的意义与前相同,所述的T1是指结束时刻,T1/2是指中间时刻,即需要输入在每个位置,中间时刻和结束时刻的旋变数据。
(c)加速度计参数
n0x,n0y,n0z,Mx,My,Mz,Δyx,Δzx,Δzy
所述的n0x,n0y,n0z为加速度计零偏,Mx,My,Mz为加速度计刻度系数,Δyx,Δzx,Δzy为加速度计安装误差。
上述加速度计参数均是可以直接得到的。
步骤1.2:计算ax、ay、az
式中:
n0x,n0y,n0z为加速度计零偏;Mx,My,Mz为加速度计刻度系数;
Δyx,Δzx,Δzy为加速度计安装误差。
步骤1.3:计算ωx、ωz
式中:
式中:
c11=c22c33-c32c23
c12=c31c23-c21c33
c13=c21c32-c31c22
其中Ω为地球自转角速率。
式中
2.如权利要求1所述的一种快速动态对准方法,其特征在于:在步骤一后增加下述步骤,
步骤二:导航解算
步骤2.1:输入
本步骤需要的参数除了步骤一中已经输入的参数外,还包括
(a)平台漂移和加速度计参数
ω0x,ω0y,ω0z平台与加速度无关漂移,该三个参数为平台固有参数,
ωxx,ωxz,ωyx,ωyy,ωzx,ωzz平台与加速度相关漂移,该六个参数为传感器测量得到的输入;
n0x,n0y,n0z,Mx,My,Mz加速度计零偏和刻度系数,该六个参数为加 速度计固有参数;
步骤2.2:计算ωxk-1、ωxk、ωyk-1、ωyk、ωzk-1、ωzk
通过下述公式进行计算
Cip0=Cgp(0)
Δt为采样时间。
步骤2.3:计算ωx、ωy、ωz
ωx=(ωxk-1+ωxk)/2
ωy=(ωyk-1+ωyk)/2
ωz=(ωzk-1+ωzk)/2
步骤2.4:计算Cipk
步骤2.5:计算Cgik
Ω是地球自转角速率。
步骤2.6:计算Cgpk
Cgpk=Cgik·Cipk,
步骤2.7:计算位置rgk
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310556839.9A CN103557873B (zh) | 2013-11-11 | 2013-11-11 | 一种快速动态对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201310556839.9A CN103557873B (zh) | 2013-11-11 | 2013-11-11 | 一种快速动态对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN103557873A true CN103557873A (zh) | 2014-02-05 |
CN103557873B CN103557873B (zh) | 2016-05-25 |
Family
ID=50012183
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201310556839.9A Active CN103557873B (zh) | 2013-11-11 | 2013-11-11 | 一种快速动态对准方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN103557873B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107131879A (zh) * | 2017-05-10 | 2017-09-05 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN107238386A (zh) * | 2017-05-10 | 2017-10-10 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN107289971A (zh) * | 2017-05-10 | 2017-10-24 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN107797156A (zh) * | 2016-09-06 | 2018-03-13 | 北京自动化控制设备研究所 | 一种晃动条件下重力仪的自对准方法 |
CN111121817A (zh) * | 2018-11-01 | 2020-05-08 | 北京自动化控制设备研究所 | 一种用于平台式重力仪晃动基座下精密自标定方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101514900A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 一种单轴旋转的捷联惯导***初始对准方法 |
US20110184645A1 (en) * | 2010-01-28 | 2011-07-28 | Sirf Technology Holdings, Inc. | Use of accelerometer only data to improve gnss performance |
-
2013
- 2013-11-11 CN CN201310556839.9A patent/CN103557873B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101514900A (zh) * | 2009-04-08 | 2009-08-26 | 哈尔滨工程大学 | 一种单轴旋转的捷联惯导***初始对准方法 |
US20110184645A1 (en) * | 2010-01-28 | 2011-07-28 | Sirf Technology Holdings, Inc. | Use of accelerometer only data to improve gnss performance |
Non-Patent Citations (3)
Title |
---|
CHU MINSHENG ET AL.: "Base Motion Isolation Algorithm for Rate Biased RLG North Finder with Disturbances", 《THE TENTH INTERNATIONAL CONFERENCE ON ELECTRONIC MEASUREMENT & INSTRUMENTS》 * |
曹渊等: "一种新的惯性平台快速连续旋转自对准方法", 《兵工学报》 * |
秦永元等: "摇摆基座上基于信息的捷联惯导粗对准研究", 《西北工业大学学报》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107797156A (zh) * | 2016-09-06 | 2018-03-13 | 北京自动化控制设备研究所 | 一种晃动条件下重力仪的自对准方法 |
CN107797156B (zh) * | 2016-09-06 | 2019-09-17 | 北京自动化控制设备研究所 | 一种晃动条件下重力仪的自对准方法 |
CN107131879A (zh) * | 2017-05-10 | 2017-09-05 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN107238386A (zh) * | 2017-05-10 | 2017-10-10 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN107289971A (zh) * | 2017-05-10 | 2017-10-24 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN107238386B (zh) * | 2017-05-10 | 2019-07-12 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN107131879B (zh) * | 2017-05-10 | 2019-12-20 | 北京航天控制仪器研究所 | 一种基座运动引起台体漂移的角速率计算及补偿方法 |
CN111121817A (zh) * | 2018-11-01 | 2020-05-08 | 北京自动化控制设备研究所 | 一种用于平台式重力仪晃动基座下精密自标定方法 |
Also Published As
Publication number | Publication date |
---|---|
CN103557873B (zh) | 2016-05-25 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103196448B (zh) | 一种机载分布式惯性测姿***及其传递对准方法 | |
CN103557873B (zh) | 一种快速动态对准方法 | |
CN103808331B (zh) | 一种mems三轴陀螺仪误差标定方法 | |
CN104501838B (zh) | 捷联惯导***初始对准方法 | |
CN106052716B (zh) | 惯性系下基于星光信息辅助的陀螺误差在线标定方法 | |
CN103245359B (zh) | 一种惯性导航***中惯性传感器固定误差实时标定方法 | |
CN103852086B (zh) | 一种基于卡尔曼滤波的光纤捷联惯导***现场标定方法 | |
CN109459008B (zh) | 一种小型中高精度光纤陀螺寻北装置及方法 | |
CN101246023A (zh) | 微机械陀螺惯性测量组件的闭环标定方法 | |
JP2006214993A (ja) | 移動体用航法装置 | |
CN101975872A (zh) | 石英挠性加速度计组件零位偏置的标定方法 | |
CN102052921B (zh) | 一种单轴旋转捷联惯导***初始航向的确定方法 | |
CN102680000A (zh) | 应用零速/航向修正的光纤捷联惯组在线标定方法 | |
CN107677292B (zh) | 基于重力场模型的垂线偏差补偿方法 | |
CN102003967A (zh) | 基于罗经原理的旋转式船用捷联惯导方位对准方法 | |
CN110749338A (zh) | 一种惯性测量单元偏轴-旋转复合转位误差标定方法 | |
US10310132B2 (en) | Absolute vector gravimeter and methods of measuring an absolute gravity vector | |
CN103712622A (zh) | 基于惯性测量单元旋转的陀螺漂移估计补偿方法及装置 | |
CN103175528A (zh) | 基于捷联惯导***的捷联罗经姿态测量方法 | |
CN103245357A (zh) | 一种船用捷联惯导***二次快速对准方法 | |
CN103900614A (zh) | 一种九加速度计无陀螺惯导***的重力补偿方法 | |
CN106885587A (zh) | 旋翼扰动下惯性/gps组合导航外杆臂效应误差补偿方法 | |
US11585657B2 (en) | Geoid measurement method, geoid measurement apparatus, geoid estimation device, and geoid calculation data collection device | |
CN113701747B (zh) | 一种基于离心机激励的惯性测量***姿态角误差分离方法 | |
CN106403999B (zh) | 基于gnss的惯性导航加速度计漂移实时补偿方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant |