CN108871378A - 一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法 - Google Patents
一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法 Download PDFInfo
- Publication number
- CN108871378A CN108871378A CN201810697400.0A CN201810697400A CN108871378A CN 108871378 A CN108871378 A CN 108871378A CN 201810697400 A CN201810697400 A CN 201810697400A CN 108871378 A CN108871378 A CN 108871378A
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- lever arm
- rotating inertial
- rins1
- rins2
- 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
本发明公开了一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法。首先,建立两套旋转惯导***各自的内杆臂、***间外杆臂误差与两套旋转惯导***间速度之差的量测模型;其次,基于模型分析实现两套旋转惯导***各自的内杆臂分离的原理与途径,设计两套旋转惯导的旋转策略;再次,根据预设的旋转策略分别控制RINS1与RINS2的框架旋转,并进行导航解算,实时输出两套旋转惯导的速度信息;最后,计算两套旋转惯导的速度之差,以此速度之差作为量测量,构建卡尔曼滤波器,实现对两套旋转惯导***内杆臂与外杆臂误差的在线动态标定。本发明所需标定时间短,标定过程简单,内杆臂与外杆臂的标定精度高,无需依赖其他外界参考信息,自主性强、易于实现。
Description
技术领域
本发明属于惯导***误差参数标定技术领域,具体涉及一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,可同时实现两套旋转惯导***各自内杆臂、***间外杆臂的在线动态标定。
背景技术
惯性导航***的惯性测量单元(IMU)由三个陀螺仪和三个加速度计组成,三个陀螺仪和三个加速度计可分别测量载体三个方向的角速度分量和线加速度分量,通过角速度与加速度的积分可实时获得载体的姿态、速度、位置信息。然而,在实际的惯导***中,加速度计是具有一定大小和体积的实体元件,因此三个加速度计的安装位置不可能与IMU的中心位置完全重合,且由于不可避免的安装误差,三个加速度敏感轴方向的延长线也无法相交于一点,由此造成每个加速度计的敏感测量点互不相同。由IMU的中心至各加速度计测量点的连线矢量构成一组内杆臂,当存在角速度激励时,会产生“杆臂效应”,引起加速度误差,积分解算后会分别造成速度误差、位置误差。因此,内杆臂参数的标定和补偿是提高单套惯导***导航精度的关键技术之一。
对于大型运载体而言,为确保安全性和可靠性,运载体一般会装配两套及以上的惯导***,构成冗余配置结构,实现故障情况下的应急处置。由于安装位置的不同,两套惯导***之间存在外杆臂,当载体存在角运动时,两套惯导***输出的速度信息在杆臂效应的作用下有所差异,因此,为综合利用两套***的导航信息,需进一步对两套惯导***之间的杆臂参数进行精确标定并补偿。
针对上述问题,本发明提出了一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,以两套旋转惯导的速度之差作为观测量,构建卡尔曼滤波器,实现对两套旋转惯导各自内杆臂、***间外杆臂参数的在线动态标定。
发明内容
本发明提出了一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,以两套旋转惯导***的速度之差作为量测量,构建卡尔曼滤波器,实现对两套旋转惯导***各自的内杆臂、***间外杆臂参数的在线动态标定。
本发明的技术方案为:一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,具体步骤如下:
步骤(1)建立两套旋转惯导***各自的内杆臂、***间外杆臂误差与两套旋转惯导***间速度之差的量测模型;
步骤(2)基于模型分析实现两套旋转惯导***各自的内杆臂分离的原理与途径,设计两套旋转惯导的旋转策略;
步骤(3)利用以上步骤(2)的旋转策略控制RINS1与RINS2的框架旋转,并进行导航解算,实时输出两套旋转惯导的速度信息;
步骤(4)计算以上步骤(3)中得到的两套旋转惯导的速度之差,并利用以上步骤(1)的量测模型,构建卡尔曼滤波器,实现对两套旋转惯导***内杆臂与外杆臂误差的在线动态标定。
本发明与现有技术相比的优点在于:
(1)本发明提出的两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,充分利用两套旋转惯导的速度之差,通过构建卡尔曼滤波器,可同时实现对两套旋转惯导***6个内杆臂与***间外杆臂参数的最优估计和动态标定。
(2)本发明提出的两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法所需标定时间短,标定过程简单,且内杆臂与外杆臂的标定精度高,优于2mm。
(3)本发明提出的两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,仅此两套旋转惯导的速度之差作为观测量,无需依赖其他外界参考信息,因此自主性强、易于实现。
附图说明
图1为本发明两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法的流程图;
图2为本发明具体实施例的两套旋转惯导***各自内杆臂、***间外杆臂的示意图;
图3为本发明具体实施例中载体角运动的姿态/航向角;
图4为本发明具体实施例中RINS1、RINS2的旋转策略;其中,图4(a)为RINS1的旋转策略,图4(b)为RINS2的旋转策略;
图5为本发明具体实施例中两套旋转惯导***内杆臂与外杆臂误差参数的收敛曲线;其中,图5(a)为RINS1的9个内杆臂分量的收敛曲线,图5(b)为RINS2的9个内杆臂分量的收敛曲线,图5(c)为RINS1与RINS2之间的3个外杆臂分量的收敛曲线。
具体实施方式
下面结合附图和具体实施例对本发明作进一步介绍。
如图1所示,本发明一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法的具体实施方法如下:
1、建立两套旋转惯导***各自的内杆臂、***间外杆臂误差与两套旋转惯导***间速度之差的量测模型;
如图2所示,为本发明的两套旋转惯导***各自内杆臂、***间外杆臂的示意图。其中,Ob1-Xb1Yb1Zb1、Ob2-Xb2Yb2Zb2分别为RINS1、RINS2的机体坐标系,原点Ob1、Ob2分别与RINS1、RINS2的IMU中心重合,On-XnYnZn为导航坐标系,其原点On与载体质心重合,Ob1至Ob2的矢量为RINS1与RINS2之间的外杆臂。Ox1,Oy1,Oz1分别代表RINS1的x,y,z加速度计的安装位置,为RINS1的三个内杆臂;Ox2,Oy2,Oz2分别代表RINS2的x,y,z加速度计的安装位置,为RINS2的三个内杆臂。
以RINS1的x加速度计为例推导杆臂误差模型。如图2所示,RINS1与载体质心的空间距离构成一组外杆臂同时,x加速度计与IMU中心构成一组内杆臂当存在载体角运动和RINS1绕框架的旋转运动时,x加速度计敏感的加速度等于牵连加速度、相对加速度与科氏加速度的矢量和。
牵连加速度为:
式(1)中,矢量可进一步表示为:
相对加速度为:
科氏加速度为:
因此,在内杆臂、外杆臂的作用下,x加速度计输出的加速度信息中包含的加速度误差为:
将上式展开为:
式(1)—(5)中,分别为载体角速度和RINS1的框架旋转角速度,分别为载体角速度微分和框架旋转角速度微分,为RINS1的x加速度计与IMU中心之间的内杆臂,为x加速度计与载体质心之间的杆臂,为RINS1的IMU中心与载体质心之间的外杆臂,根据矢量合成原理,有
式(5)中,杆臂矢量在空间三维坐标系中可表示为沿三个坐标轴方向的分量,即Rx1的下角标中x表示在x方向的投影,1表示1号旋转惯导***(即RINS1),rxx1的下角标中第一个x表示在x方向的投影,第二个x表示1号惯导***的x加速度计,1表示1号旋转惯导***(即RINS1)。
同理,RINS2的x加速度计的外杆臂与内杆臂造成的加速度误差为:
式(6)中,分别为载体角速度和RINS2的框架旋转角速度,分别为载体角速度微分和框架旋转角速度微分,为RINS2的x加速度计与IMU中心之间的内杆臂,为RINS2的IMU中心与载体质心之间的外杆臂。
由于两套旋转惯导***同时与载体固连,因此RINS1、RINS2敏感的相同,将式(5)与式(6)作差,可得两套旋转惯导各自内杆臂、***间外杆臂共同作用下的加速度误差为:
式(7)中,为RINS1与RINS2之间的外杆臂矢量。
进一步的,可得两套旋转惯导***各自的内杆臂、***间外杆臂误差与两套旋转惯导***间速度之差的量测模型为:
式(8)中,表示RINS1、RINS2的敏感轴坐标系至导航坐标系的旋转变换矩阵,表示RINS1内杆臂引起的加速度误差,表示RINS2内杆臂引起的加速度误差,表示RINS1与RINS2之间的外杆臂引起的加速度误差。
2、分析实现两套旋转惯导***各自的内杆臂分离的原理与途径,设计两套旋转惯导的旋转策略;
由式(7)可知,RINS1与RINS2之间的外杆臂仅由载体角运动激励,RINS1、RINS2的内杆臂同时由载体角运动和框架的旋转运动激励,因此,当载体存在角运动,即同时,RINS1、RINS2存在框架的旋转运动,并满足时,可实现外杆臂内杆臂的分离与估计。
因此,RINS1与RINS2旋转策略的设计需满足的原则。由于角速度是既有大小又有方向的矢量,因此提供不同的角速度有三种实现途径:其一,RINS1、RINS2的旋转轴方向相同,但旋转角速度大小不同;其二,RINS1、RINS2的旋转角速度大小相同,但旋转轴方向不同;其三,RINS1、RINS2的旋转轴方向与旋转角速度大小均不相同。以下分别从这三方面进行分析:
(a)RINS1、RINS2的旋转轴方向相同,但旋转角速度大小不同;
假设RINS1、RINS2均绕内框轴旋转,但旋转角速度大小不同,即满足时,RINS1、RINS2的内杆臂造成的加速度误差分别为:
此时,RINS1、RINS2的旋转矩阵分别为:
将式(9)与(10)代入式(7)并展开,可得RINS1与RINS2的内杆臂共同作用下的加速度误差为:
式(9)至式(11)中,分别为RINS1、RINS2的内框旋转角度,且旋转角度 与旋转角速度之间存在积分关系,如下:
由式(11)和式(12)可知,当大小不同时,旋转角度及旋转矩阵 的变化周期不同,根据周期的差异,可实现对RINS1、RINS2内杆臂的分离。
(b)RINS1、RINS2的旋转角速度大小相同,但旋转轴方向不同;
假设RINS1绕内框轴旋转,RINS2绕中框轴旋转,即满足 且时,RINS1、RINS2的内杆臂造成的加速度误差分别为:
此时,可分别表示为:
其中,表示RINS1的内框旋转角度、表示RINS2的中框旋转角度。
同理,将式(13)与(14)代入式(7)并展开,可得RINS1与RINS2的内杆臂共同作用下的加速度误差为:
由式(15)可知,当RINS1、RINS2的旋转轴方向不同时,RINS1的内杆臂分量与RINS2的内杆臂分量在的体现上有正弦和余弦之分,根据正弦和余弦的差异,可实现对RINS1、RINS2内杆臂的分离。
(c)RINS1、RINS2的旋转轴方向与旋转角速度大小均不相同;
当RINS1、RINS2的旋转轴方向与旋转角速度大小均不相同,即同时满足前两个实现途径时,由前述分析可知,RINS1、RINS2的内杆臂分量在加速度误差的体现上既有周期上的差异,又有正余弦之分,根据这两方面的差异,可实现对RINS1、RINS2内杆臂的分离。
3、计算两套旋转惯导的速度之差,以此速度之差作为量测量,构建卡尔曼滤波器,实现对两套旋转惯导***内杆臂与外杆臂误差的在线动态标定。
1)卡尔曼滤波器的状态模型为:
式(16)中,表示RINS1内杆臂引起的加速度误差,表示RINS2内杆臂引起的加速度误差,表示RINS1与RINS2之间的外杆臂引起的加速度误差。
根据状态模型,选取状态变量为:
其中,δφE,δφN,δφU分别为RINS1、RINS2的东向平台偏角、北向平台偏角、天向平台偏角之差;δVE,δVN分别为RINS1、RINS2的东向速度、北向速度之差;εx1,εy1,εz1、εx2,εy2,εz2分别为RINS1、RINS2的陀螺漂移;分别为RINS1、RINS2的加速度计零偏;rxx1,rxy1,rxz1、ryx1,ryy1,ryz1、rzx1,rzy1,rzz1为RINS1的9个内杆臂分量,rxx2,rxy2,rxz2、ryx2,ryy2,ryz2、rzx2,rzy2,rzz2为RINS2的9个内杆臂分量,Rx,Ry,Rz为RINS1与RINS2之间的3个外杆臂分量。
2)卡尔曼滤波器的量测模型为:
式(17)中,δVE,δVN分别为RINS1、RINS2的东向速度、北向速度之差;下角标中INS1、INS2分别表示RINS1、RINS2输出的速度信息。
由此,以两套旋转惯导***的速度之差作为量测量,以两套旋转惯导的平台偏角、速度误差、两套旋转惯导***各自的内杆臂、***间外杆臂作为状态量,构建卡尔曼滤波器,实现对RINS1的9个内杆臂分量、RINS2的9个内杆臂分量以及RINS1与RINS2之间的3个外杆臂分量的估计。
4、设计仿真实验,对本发明提出的两套旋转惯导内杆臂与外杆臂误差在线动态标定方法进行仿真验证。
仿真实例中,设置载体角运动分别符合如下规律:
载体俯仰角:
载体横滚角:
载体航向角:
其中,ai符合均值为4°,方差为2°的正态分布,Tθi符合均值为5s,方差为3s的正态分布;bi符合均值为5°,方差为2°的正态分布,Tγi符合均值为6s,方差为4s的正态分布;ci符合均值为3°,方差为2°的正态分布,Tψi符合均值为8s,方差为3s的正态分布。符合区间[02π]的均匀分布,M=20。如图3所示,为载体的航向/姿态变化曲线。
图4为本发明仿真实例中RINS1、RINS2的旋转策略,其中,图4(a)为RINS1的旋转策略、图4(b)为RINS2的旋转策略。如图所示,RINS1、RINS2的框架旋转角度遵循余弦变化规律式中T为周期。RINS1框架旋转角度的余弦周期为60s,框架旋转顺序为:内框-外框-中框;RINS2框架旋转角度的余弦周期为48s,框架旋转顺序为:内框-外框-中框。
此外,仿真实例中分别加入陀螺漂移与加速度计零偏为:陀螺随机常值漂移为0.01°/h,随机游走为加计常值零偏为50μg,随机游走为
在上述仿真条件下,验证本发明提出的两套旋转惯导内杆臂与外杆臂误差在线动态标定方法,仿真结果如图5所示:其中,图5(a)为RINS1的9个内杆臂分量的收敛曲线,图5(b)为RINS2的9个内杆臂分量的收敛曲线,图5(c)为RINS1与RINS2之间的3个外杆臂分量的收敛曲线。从各收敛曲线可以看出,两套旋转惯导***内杆臂与外杆臂各分量的收敛速度快,收敛过程平稳。为定量分析标定精度,将两套旋转惯导***内杆臂与外杆臂在线动态标定进行了6次重复性实验,得到的估计结果的平均值及标准差如表1所示。由表1可知,本发明提出的两套旋转惯导***内杆臂与外杆臂在线动态标定的标定精度优于1mm,证明了本发明的有效性。
表1两套旋转惯导***内杆臂与外杆臂误差参数在线动态标定结果
总之,本发明可实现对两套旋转惯导***内杆臂与外杆臂误差的在线动态标定,对提高两套旋转惯导***导航信息交互与传递的精度具有重要意义。
本发明未详细公开的部分属于本领域的公知技术。
尽管上面对本发明说明性的具体实施方式进行了描述,以便于本技术领域的技术人员理解本发明,但应该清楚,本发明不限于具体实施方式的范围,对本技术领域的普通技术人员来讲,只要各种变化在所附的权利要求限定和确定的本发明的精神和范围内,这些变化是显而易见的,一切利用本发明构思的发明创造均在保护之列。
Claims (4)
1.一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,其特征在于实现步骤如下:
步骤(1)建立两套旋转惯导***各自的内杆臂、***间外杆臂误差与两套旋转惯导***间速度之差的量测模型;
步骤(2)基于以上步骤(1)的模型分析实现两套旋转惯导***各自的内杆臂分离的原理与途径,设计两套旋转惯导的旋转策略;
步骤(3)利用以上步骤(2)的旋转策略分别控制1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)的框架旋转,并进行导航解算,实时输出两套旋转惯导的速度信息;
步骤(4)计算以上步骤(3)中得到的两套旋转惯导的速度之差,并利用以上步骤(1)的量测模型,构建卡尔曼滤波器,实现对两套旋转惯导***内杆臂与外杆臂误差的在线动态标定。
2.根据权利要求1所述的两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,其特征在于:所述的步骤(1)中,两套旋转惯导***各自的内杆臂、***间外杆臂误差与两套旋转惯导***间速度之差的量测模型的建立过程为:
对于1号旋转惯导***(RINS1)的x加速度计的杆臂误差模型,1号旋转惯导***(RINS1)与载体质心的空间距离构成一组外杆臂,同时,x加速度计与IMU中心构成一组内杆臂,当存在载体角运动和1号旋转惯导***(RINS1)绕框架的旋转运动时,x加速度计敏感的加速度等于牵连加速度、相对加速度与科氏加速度的矢量和;
牵连加速度为:
式(1)中,矢量可进一步表示为:
相对加速度为:
科氏加速度为:
因此,在内杆臂、外杆臂的作用下,x加速度计输出的加速度信息中包含的加速度误差为:
将上式展开为:
式(1)—(5)中,分别为载体角速度和1号旋转惯导***(RINS1)的框架旋转角速度,分别为载体角速度微分和框架旋转角速度微分,为1号旋转惯导***(RINS1)的x加速度计与IMU中心之间的内杆臂,为x加速度计与载体质心之间的杆臂,为1号旋转惯导***(RINS1)的IMU中心与载体质心之间的外杆臂,根据矢量合成原理,有同时,杆臂矢量在空间三维坐标系中可表示为沿三个坐标轴方向的分量,即Rx1的下角标中x表示在x方向的投影,1表示1号旋转惯导***(RINS1),rxx1的下角标中第一个x表示在x方向的投影,第二个x表示1号惯导***的x加速度计,1表示1号旋转惯导***(RINS1);
同理,2号旋转惯导***(RINS2)的x加速度计的杆臂误差为:
式(6)中,分别为载体角速度和2号旋转惯导***(RINS2)的框架旋转角速度,分别为载体角速度微分和框架旋转角速度微分,为2号旋转惯导***(RINS2)的x加速度计与IMU中心之间的内杆臂,为2号旋转惯导***(RINS2)的IMU中心与载体质心之间的外杆臂;同理,Rx2的下角标中x表示在x方向的投影,2表示2号旋转惯导***(RINS2),rxx2的下角标中第一个x表示在x方向的投影,第二个x表示2号惯导***的x加速度计,2表示2号旋转惯导***(RINS2);
由于两套旋转惯导***同时与载体固连,因此1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)敏感的相同,将式(5)与式(6)作差,可得两套旋转惯导的x加速度计在各自内杆臂、***间外杆臂共同作用下的加速度误差为:
式(7)中,为1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)之间的外杆臂矢量;
进一步的,可得两套旋转惯导的x加速度计的内杆臂、***间外杆臂误差与两套旋转惯导***间速度之差的量测模型为:
式(8)中,表示1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的敏感轴坐标系至导航坐标系的旋转变换矩阵,表示RINS1内杆臂引起的加速度误差,表示2号旋转惯导***(RINS2)内杆臂引起的加速度误差,表示1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)之间的外杆臂引起的加速度误差。
3.根据权利要求1所述的两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,其特征在于:所述的步骤(2)中,实现两套旋转惯导***各自的内杆臂分离的分析过程及旋转策略的设计过程如下:
1)分析实现两套旋转惯导***各自的内杆臂分离的原理与途径:由式(7)可知,1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)之间的外杆臂仅由载体角运动激励,1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的内杆臂同时由载体角运动和框架的旋转运动激励,因此,当载体存在角运动,即同时,RINS1、RINS2存在框架的旋转运动,并满足时,可实现外杆臂内杆臂的分离与估计;
2)旋转策略的设计原则与具体实现:1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)旋转策略的设计需满足的原则,由于角速度是既有大小又有方向的矢量,因此提供不同的角速度有三种实现途径:其一,RINS1、RINS2的旋转轴方向相同,但旋转角速度大小不同;其二,RINS1、RINS2的旋转角速度大小相同,但旋转轴方向不同;其三,1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的旋转轴方向与旋转角速度大小均不相同,以下分别从这三方面进行分析:
(a)1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的旋转轴方向相同,但旋转角速度大小不同;
假设1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)均绕内框轴旋转,但旋转角速度大小不同,即满足时,1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的内杆臂造成的加速度误差分别为:
式(9)中,rxx1,rxy1,rxz1、ryx1,ryy1,ryz1、rzx1,rzy1,rzz1为1号旋转惯导***(RINS1)的9个内杆臂分量,
此时,1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的旋转矩阵分别为:
将式(9)与(10)代入式(7)并展开,可得1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)的内杆臂共同作用下的加速度误差为:
式(9)至式(11)中,分别为1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的内框旋转角度,且旋转角度与旋转角速度之间存在积分关系,如下:
由式(11)和式(12)可知,当大小不同时,旋转角度及旋转矩阵 的变化周期不同,根据周期的差异,可实现对1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)内杆臂的分离;
(b)1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的旋转角速度大小相同,但旋转轴方向不同;
假设1号旋转惯导***(RINS1)绕内框轴旋转,2号旋转惯导***(RINS2)绕中框轴旋转,即满足且时,1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的内杆臂造成的加速度误差分别为:
此时,可分别表示为:
其中,表示1号旋转惯导***(RINS1)的内框旋转角度、表示2号旋转惯导***(RINS2)的中框旋转角度。
同理,将式(13)与(14)代入式(7)并展开,可得1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)的内杆臂共同作用下的加速度误差为:
由式(15)可知,当1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的旋转轴方向不同时,1号旋转惯导***(RINS1)的内杆臂分量与2号旋转惯导***(RINS2)的内杆臂分量在的体现上有正弦和余弦之分,根据正弦和余弦的差异,可实现对1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)内杆臂的分离。
(c)1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的旋转轴方向与旋转角速度大小均不相同;
当1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的旋转轴方向与旋转角速度大小均不相同,即同时满足前两个实现途径时,由前述分析可知,1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的内杆臂分量在加速度误差的体现上既有周期上的差异,又有正余弦之分,根据这两方面的差异,可实现对1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)内杆臂的分离。
4.根据权利要求1所述的两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法,其特征在于:所述的步骤(4)中,卡尔曼滤波器的构建过程如下:
1)卡尔曼滤波器的状态模型为:
式(16)中,表示1号旋转惯导***(RINS1)内杆臂引起的加速度误差,表示2号旋转惯导***(RINS2)内杆臂引起的加速度误差,表示1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)之间的外杆臂引起的加速度误差;
根据状态模型,选取状态变量为:
其中,δφE,δφN,δφU分别为1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的东向平台偏角、北向平台偏角、天向平台偏角之差;δVE,δVN分别为1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的东向速度、北向速度之差;εx1,εy1,εz1、εx2,εy2,εz2分别为1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的陀螺漂移; 分别为1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的加速度计零偏;rxx1,rxy1,rxz1、ryx1,ryy1,ryz1、rzx1,rzy1,rzz1为1号旋转惯导***(RINS1)的9个内杆臂分量,rxx2,rxy2,rxz2、ryx2,ryy2,ryz2、rzx2,rzy2,rzz2为2号旋转惯导***(RINS2)的9个内杆臂分量,Rx,Ry,Rz为1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)之间的3个外杆臂分量。
2)卡尔曼滤波器的量测模型为:
式(17)中,δVE,δVN分别为1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)的东向速度、北向速度之差;下角标中INS1、INS2分别表示1号旋转惯导***(RINS1)、2号旋转惯导***(RINS2)输出的速度信息。
由此,以两套旋转惯导***的速度之差作为量测量,以两套旋转惯导的平台偏角、速度误差、两套旋转惯导***各自的内杆臂、***间外杆臂作为状态量,构建卡尔曼滤波器,实现对1号旋转惯导***(RINS1)的9个内杆臂分量、2号旋转惯导***(RINS2)的9个内杆臂分量以及1号旋转惯导***(RINS1)与2号旋转惯导***(RINS2)之间的3个外杆臂分量的估计。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810697400.0A CN108871378B (zh) | 2018-06-29 | 2018-06-29 | 一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810697400.0A CN108871378B (zh) | 2018-06-29 | 2018-06-29 | 一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108871378A true CN108871378A (zh) | 2018-11-23 |
CN108871378B CN108871378B (zh) | 2021-07-06 |
Family
ID=64297273
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810697400.0A Active CN108871378B (zh) | 2018-06-29 | 2018-06-29 | 一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108871378B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109827571A (zh) * | 2019-03-22 | 2019-05-31 | 北京壹氢科技有限公司 | 一种无转台条件下的双加速度计标定方法 |
CN110057383A (zh) * | 2019-05-05 | 2019-07-26 | 哈尔滨工程大学 | 一种auv推位导航***杆臂误差标校方法 |
CN110361002A (zh) * | 2019-07-15 | 2019-10-22 | 哈尔滨工程大学 | 适用于路基车辆的简化惯导***姿态测量方法 |
CN110940357A (zh) * | 2019-12-20 | 2020-03-31 | 湖北航天技术研究院总体设计所 | 一种用于旋转惯导单轴自对准的内杆臂标定方法 |
CN116294851A (zh) * | 2023-02-20 | 2023-06-23 | 北京自动化控制设备研究所 | 一种高速旋转制导炮弹姿态辅助测量方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102620748A (zh) * | 2012-03-22 | 2012-08-01 | 东南大学 | 捷联惯导***晃动基座条件下杆臂效应的估计和补偿方法 |
CN103630146A (zh) * | 2013-09-15 | 2014-03-12 | 北京航空航天大学 | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 |
CN104019828A (zh) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | 高动态环境下惯性导航***杆臂效应误差在线标定方法 |
CN104897178A (zh) * | 2015-07-06 | 2015-09-09 | 中国人民解放军国防科学技术大学 | 一种双惯导联合旋转调制导航与在线相对性能评估方法 |
US9377309B2 (en) * | 2014-03-31 | 2016-06-28 | Honeywell International Inc. | Global positioning system (GPS) self-calibrating lever arm function |
-
2018
- 2018-06-29 CN CN201810697400.0A patent/CN108871378B/zh active Active
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN102620748A (zh) * | 2012-03-22 | 2012-08-01 | 东南大学 | 捷联惯导***晃动基座条件下杆臂效应的估计和补偿方法 |
CN103630146A (zh) * | 2013-09-15 | 2014-03-12 | 北京航空航天大学 | 一种离散解析与Kalman滤波结合的激光陀螺IMU标定方法 |
US9377309B2 (en) * | 2014-03-31 | 2016-06-28 | Honeywell International Inc. | Global positioning system (GPS) self-calibrating lever arm function |
CN104019828A (zh) * | 2014-05-12 | 2014-09-03 | 南京航空航天大学 | 高动态环境下惯性导航***杆臂效应误差在线标定方法 |
CN104897178A (zh) * | 2015-07-06 | 2015-09-09 | 中国人民解放军国防科学技术大学 | 一种双惯导联合旋转调制导航与在线相对性能评估方法 |
Non-Patent Citations (3)
Title |
---|
XIONG ZHI等: "Dynamic calibration method for SINS lever-arm effect for HCVs", 《IEEE TRANSACTIONS ON AEROSPACE & ELECTRONIC SYSTEMS》 * |
白焕旭 等: "惯性测量单元内杆臂标定卡尔曼滤波方法", 《现代防御技术》 * |
许伟通: "基于强跟踪CKF的光纤陀螺惯导***在线标定技术研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109827571A (zh) * | 2019-03-22 | 2019-05-31 | 北京壹氢科技有限公司 | 一种无转台条件下的双加速度计标定方法 |
CN110057383A (zh) * | 2019-05-05 | 2019-07-26 | 哈尔滨工程大学 | 一种auv推位导航***杆臂误差标校方法 |
CN110057383B (zh) * | 2019-05-05 | 2023-01-03 | 哈尔滨工程大学 | 一种auv推位导航***杆臂误差标校方法 |
CN110361002A (zh) * | 2019-07-15 | 2019-10-22 | 哈尔滨工程大学 | 适用于路基车辆的简化惯导***姿态测量方法 |
CN110940357A (zh) * | 2019-12-20 | 2020-03-31 | 湖北航天技术研究院总体设计所 | 一种用于旋转惯导单轴自对准的内杆臂标定方法 |
CN116294851A (zh) * | 2023-02-20 | 2023-06-23 | 北京自动化控制设备研究所 | 一种高速旋转制导炮弹姿态辅助测量方法 |
CN116294851B (zh) * | 2023-02-20 | 2024-04-02 | 北京自动化控制设备研究所 | 一种高速旋转制导炮弹姿态辅助测量方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108871378B (zh) | 2021-07-06 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108871378A (zh) | 一种两套旋转惯导***内杆臂与外杆臂误差在线动态标定方法 | |
CN101514899B (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航***误差抑制方法 | |
CN102980577B (zh) | 一种微型捷联航姿***及其工作方法 | |
CN103090867B (zh) | 相对地心惯性系旋转的光纤陀螺捷联惯性导航***误差抑制方法 | |
CN104501838B (zh) | 捷联惯导***初始对准方法 | |
CN103090866B (zh) | 一种单轴旋转光纤陀螺捷联惯导***速度误差抑制方法 | |
CN101419080B (zh) | 微型捷联惯性测量***的零速校正方法 | |
CN106525034B (zh) | 一种基于对偶四元数的惯导***传递对准建模方法 | |
CN112595350B (zh) | 一种惯导***自动标定方法及终端 | |
CN101629826A (zh) | 基于单轴旋转的光纤陀螺捷联惯性导航***粗对准方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导***以及控制方法 | |
CN109752000A (zh) | 一种mems双轴旋转调制型捷联罗经初始对准方法 | |
CN103900607B (zh) | 一种基于惯性系的旋转式捷联惯导***转位方法 | |
CN108195400A (zh) | 捷联式微机电惯性导航***的动基座对准方法 | |
CN106052682A (zh) | 一种混合式惯性导航***及导航方法 | |
CN105841698A (zh) | 一种无需调零的auv舵角精确实时测量*** | |
CN104697521A (zh) | 一种采用陀螺冗余斜交配置方式测量高速旋转体姿态和角速度的方法 | |
Zacchini et al. | Novel noncontinuous carouseling approaches for MEMS-based north seeking using Kalman filter: Theory, simulations, and preliminary experimental evaluation | |
CN110749338A (zh) | 一种惯性测量单元偏轴-旋转复合转位误差标定方法 | |
CN103940445A (zh) | 一种单轴旋转惯导***惯性器件误差补偿方法 | |
CN105737848A (zh) | 一种***级星敏感器观星***及观星方法 | |
CN108592918A (zh) | 摇摆基座下mems imu的全姿态解算方法 | |
RU2572403C1 (ru) | Способ инерциальной навигации и устройство для его осуществления | |
CN104834316A (zh) | 车载环境下捷联惯组长时间待机过程中的姿态保持方法 | |
WO2021012635A1 (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 |