CN102506857B - 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 - Google Patents
一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 Download PDFInfo
- Publication number
- CN102506857B CN102506857B CN201110385043.2A CN201110385043A CN102506857B CN 102506857 B CN102506857 B CN 102506857B CN 201110385043 A CN201110385043 A CN 201110385043A CN 102506857 B CN102506857 B CN 102506857B
- Authority
- CN
- China
- Prior art keywords
- inertial navigation
- navigation system
- error
- information
- dgps
- 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.)
- Expired - Fee Related
Links
Images
Landscapes
- Navigation (AREA)
Abstract
本发明公开基于双IMU/DGPS组合的相对姿态测量实时动态滤波方法,采用双光纤捷联惯导***,通过捷联惯导实时解算,得到主惯导与从惯导***的导航信息;判断DGPS信息是否更新,产生两种情况:当更新时,主惯导与从惯导***进行滤波修正,建立组合导航滤波器的量测方程;当没有更新时,使用主惯导***对从惯导***进行滤波修正,建立组合导航滤波器的量测方程;两种情况得到的组合滤波方程通过离散化,建立离散型卡尔曼滤波器的递推方程,解算得到主惯导与从惯导***的俯仰、横滚和航向角;随后进行相对姿态矩阵解算,得到主惯导与从惯导相对姿态角的主值。本发明提高了导航***的稳定性,且可实时输出导航***在测量过程中的速度、位置、姿态信息,测量范围广。
Description
技术领域
本发明涉及惯性导航领域,具体来说,是一种基于双IMU/DGPS组合的相对姿态测量实时动态滤波方法。
背景技术
具有弹性变形的载体在受到外力、外力矩、湍流的作用时会产生结构振动变形。载体在运动过程中的形变测量,对测量设备的精度、数据更新频率、动态环境下的可靠性均有较高要求,但传统的测量方法难以满足。特别在高精度实时测量中,由于载体的不同部位所处的环境状况、所受的外力矩都是有差别的,因而分别安装在载体不同位置间的主从惯导安装位置间的相对形变会影响其正常工作。这就需要一种可以满足要求的实时动态相对姿态测量***。
捷联惯导是一种完全自主的导航方式,它具有不依赖外界信息,隐蔽性强,机动灵活等优点,但是存在误差随时间迅速积累的问题,导航精度随时间而发散,在精度要求较高的情况下,捷联惯导***不能单独长时间工作,必须不断以其他信息加以修正。
GPS(Global Positioning System)是一种适用于测距的空间交会定点导航***,它不仅具有全球性、全天候和连续的精密三维定位能力,而且能实时的对运载体的速度、姿态进行测定以及精确授时,但其存在着信号易受干扰、输出数据更新频率低等缺点,且难以独立提供姿态信息。DGPS即差分GPS,是改善GPS定位或授时性能的一种方法。在GPS精确定位中占据重要角色。其原理为:在一个或若干个已知精确坐标的位置设置GPS接收机作为基准站,连续跟踪观测视野内所有可见的GPS卫星的伪距,通过与已知距离的对比,求出差分修正参数,并发送给用户。用户在观测GPS卫星伪距的同时,接受基准站发送的伪距修正参数,对观测的伪距结果进行修正,并利用修正后的伪距进行定位解算。
在现有技术中,传递对准的方法在目前的工程实践中应用较多。传递对准法是指载体上需要对准的子惯导利用已对准好的主惯导的信息进行对准的一种方法。传递对准也是动基座对准中的一种方法。由于子惯导未对准以前,平台失准角对惯导性能产生很大误差影响。而主、子惯导之间性能参数的差值能不同程度地反映了失准角的大小。因此,利用这些差值运用卡尔曼滤波方法可进行传递对准。传递对准匹配方法可以归纳为两大类,一类是计算参数匹配法,它包括速度匹配和位置匹配,一类为测量参数匹配法,包括加速度匹配、姿态匹配和角速度匹配。计算参数匹配法利用主、子惯导各自计算的导航参数(速度或位置)各分量的差值作为测量值。由于速度或位置信息不是直接从测量元件得到,不能在量测方程中直接反映出相对失准角与这些差值的关系,故必须将相对失准角和速度差都列为状态,它们之间的关系在状态方程中描述。测量参数匹配法依靠物理矢量在主、子惯导各自测量轴上分量的差异来进行对准。方法直接,对准时间短,但其精度因受载体挠性变形的影响而受限,对准时载体需作小量的机动动作。(《基于测量矢量匹配的传递对准方法研究》,夏家和、秦永元、赵长山,***工程与电子技术,2009,31(12),《基于惯性传感器输出匹配的舰船变形估计方法》,柳爱利、戴洪德,传感技术学报,2011,24(1))。
现有的传递对准法在应用中有着如下不足之处:
1、载体上的各器件存在误差,且传递对准的方法动态变形建模复杂;
2、传递对准的方法一般对准时间要求较短,需快速收敛;
3、传递对准的方法和动态环境、***精度相关,需针对不同的应用背景专门设计。
发明内容
为了解决上述问题,本发明给出了一种基于双IMU/DGPS组合的相对测姿***滤波方法,采用两个具有耐冲击、耐加速、高动态范围、高灵敏度等优点的光纤陀螺和石英挠性加速度计构成光纤捷联惯导***,将其作为基本导航方式,并引入DGPS信号辅助惯导,可以充分利用惯导与DGPS的互补特性,发挥各自的优点,弥补各自的不足。高精度的DGPS信息可用来补偿捷联惯导***随时间快速发散的高度通道以及随积分计算不断积累的速度、位置误差等;且在DGPS卫星信号不理想或是卫星失锁的情况下,光纤捷联惯导可以暂时独立的提供导航信息,并用所处环境条件较好的惯导数据去修正所处条件相对较差的惯导数据。因而,组合导航***的误差要比单独的DGPS导航或单独的捷联惯导***可能达到的误差都小;在满足同样的精度要求的情况下,加入DGPS导航信息可以降低对惯导***的精度要求,大大降低***成本,并且能够实现在高动态环境下实时的、高精度的导航定位和姿态计算。
一种基于双IMU/DGPS组合的相对姿态测量实时动态滤波方法,其特征在于:采用主惯导***与从惯导***两个光纤捷联惯导***与一个DGPS进行组合,具体滤波方法由下述步骤来完成:
步骤1:主惯导***和从惯导***根据各自的惯性测量单元测得的载体加速度数据和角速度数据,分别通过捷联惯导实时解算,得到主惯导***和从惯导***的导航信息;
步骤2:判断DGPS信息是否有更新;
当DGPS信息更新时,进入步骤3;当DGPS信息丢失或未更新时,则进入步骤4。
步骤3:根据由DGPS获取的载体的位置、速度等信息,与步骤一中得到的主惯导***与从惯导***的导航信息,分别对主惯导***与从惯导***进行滤波修正,建立组合导航滤波器的量测方程,随后进入步骤5;
步骤4:使用主惯导***的速度、位置信息对从惯导***进行滤波修正,建立双惯导组合滤波器方程,随后进入步骤5;
步骤5:将惯导***组合滤波器量测方程和状态方程离散化,建立离散型卡尔曼滤波器的递推方程;
步骤6:通过步骤5中建立的离散型卡尔曼滤波器的递推方程,进行Kalman滤波解算,得到主惯导***与从惯导***的俯仰、横滚和航向角;
步骤7:根据步骤6得到的主惯导***的俯仰、横滚和航向角ψAE、ψAN和ψAU,与从惯导***的俯仰、横滚和航向角ψBE、ψBN和ψBU,建立由地理坐标系到主惯导***载体坐标系的转换矩阵为由地理坐标系到从惯导***载体坐标系的转换矩阵为则:
则主惯导***与从惯导相对姿态角的主值为:
步骤8:主惯导***与从惯导***间的相对姿态置信度估计。
本发明的优点在于:
1、本发明方法提出了对具有DGPS和无DGPS两种不同情况下的滤波方法,有效解决了在DGPS信号缺失这种可能性下的解算问题,提高了导航***的稳定性,且可实时输出导航***在测量过程中的速度、位置、姿态信息,测量范围广;
2、本发明方法采用双IMU/DGPS组合导航***对动载体姿态变形误差进行测量,得出主惯导***安装点与从惯导安装点之间相对姿态,同时采用了高精度的DGPS信息作为外部信息源,实现组合测量;
3、本发明方法实现了导航信息的优化,提高了导航***精度,而且导航输出具有实时性,能满足高精度实时测量要求;
4、本发明方法适用于所有的动载体形变测量,具有通用性。
附图说明
图1是本发明的方法流程图。
具体实施方式
下面将结合附图和实施例对本发明作进一步的详细说明。
本发明一种基于双IMU/DGPS组合的相对姿态测量实时动态滤波方法,采用两个光纤捷联惯导***(主惯导***与从惯导***)分别与一个DGPS进行组合,对两个光纤捷联惯导***的误差进行校正,其中主惯导***安装于载体环境条件变化较小的部分,从惯导***安装于载体温度和振动环境相对比较恶劣的部位。其滤波方法由以下步骤来完成:
步骤1:主惯导***和从惯导***根据各自的惯性测量单元测得的载体加速度数据和角速度数据,分别通过捷联惯导实时解算,得到主惯导***和从惯导***的导航信息,包括位置信息、速度信息和姿态信息;
设惯导***的导航坐标系为当地地理坐标系,水平位置误差为δL,δλ,δh,δL为惯导***经度误差,δλ为惯导***纬度误差,δh为惯导***高度误差,水平速度误差为δVE,δVN,δVU,姿态误差为ψE,ψN,ψU,陀螺漂移项εE,εN,εU,加速度计零偏则捷联惯导误差方程为:
状态矢量:
姿态误差方程:
速度误差方程:
水平位置误差方程:
上述式(1)~(4)中,ωie为地球自转角速度,ωie=7.29×10-5rad/s;RE为参考椭球体的长半径,RE=6378137m;f为地球扁率,f=1/298.257;RM为子午圈主曲率半径RM=RE(1-2f+3fsin2L);RN为卯酉圈主曲率半径RN=RE(1+fsin2L);
根据主惯导***和从惯导***根据各自的惯性测量单元测得的载体加速度数据和角速度数据,通过上述捷联惯导误差方程,可分别得到主惯导***与从惯导***的水平位置误差δLA,δλA,δhA与δLB,δλB,δhB,水平速度误差δVAE,δVAN,δVAU与δVBE,δVBN,δVBU,姿态误差ψAE,ψAN,ψAU与ψBE,ψBN,ψBU,并分别对主惯导***与从惯导***的水平位置误差,水平速度误差,姿态误差进行迭代运算,从而得到主惯导***与从惯导***的位置、速度和姿态值。
步骤2:判断DGPS信息是否有更新;
当DGPS信息更新时,进入步骤3;当DGPS信息丢失或未更新时,则进入步骤4。
步骤:3:根据由DGPS获取的载体的位置、速度等信息,与步骤一中得到的主惯导***与从惯导***的导航信息,分别对主惯导***与从惯导***进行滤波修正,建立组合导航滤波器的量测方程,采用位置/速度组合模式,随后进入步骤5;
惯导***的位置信息可表示为:
DGPS测得的载***置信息可表示为:
式(5)、式(6)中:Lt,λt,ht为惯导***的真实位置信息,NE,NN,NU分别为DGPS测量得到的载体沿东、北、天方向的位置误差。
则惯导***的位置量测矢量为:
式(7)中,Hp(t)=(diag(R RcosL 1)03×12)3×15,Vp(t)=(NN NE NU)T。设DGPS接收机伪距测量误差为σρ,平面位置精度因子为HDOP,高程精度因子为VDOP,将DGPS量测噪声矢量V(t)作为白噪声处理,则DGPS位置噪声方差为为:
惯导***的速度信息可表示为:
DGPS测得的载体速度信息可表示为:
式中,VN,VE,VU为惯导***的真实速度信息,ME,MN,MU分别为DGPS沿东、北、天方向的载体速度误差。
则惯导***的速度量测矢量为:
式中,HV(t)=(03×3diag(111)03×9)3×15。
综上可得在DGPS信号正常时惯导***组合滤波器量测方程如下:
步骤4:当DGPS信息丢失或未更新时,无法使用DGPS信息对主惯导***与从惯导***进行滤波修正,此时主惯导***工作在纯惯导模式下,而从惯导***工作在主惯导***与从惯导***组合模式下,由于从惯导***位于温度和振动环境比较恶劣的部位,为避免其精度随时间过快发散,因此使用主惯导***的速度、位置信息对从惯导***进行滤波修正,建立双惯导组合滤波器方程,随后进入步骤5。
从惯导***的位置量测信息可表示为:
式(14)中,δLB、δλR、δhB分别为从惯导***经度、纬度、高度上的位置误差。主惯导***的位置量测信息可表示为:
式(15)中,LBt,λBt,hBt为从惯导***的真实位置信息。
则惯导***位置量测矢量定义为:
式(16)中,H′p(t)=(diag(RRcosL1)03×12)3×15,V′p(t)=(RδLA RδλA cosLδhA)T
主惯导***与从惯导***组合滤波器的位置噪声的最优估计由主惯导***估计误差的协方差阵PA(t)为:
从惯导***的速度信息可表示为:
主惯导***的速度量测信息可表示为:
式(19)中,VBNt,VBEt,VBUt为从惯导***真实速度信息。
则惯导***位置量测速度量测矢量为:
式中,HV(t)=(03×3 diag(111)03×9)3×15。
主惯导***与从惯导***组合滤波器的速度量测噪声的最优估计由主惯导***估计误差的协方差阵PA(t)给出:
综上可得在无DGPS信号时惯导***组合滤波器量测方程如下:
步骤5:将惯导***组合滤波器量测方程与步骤1中的状态方程离散化,建立离散型卡尔曼滤波器的递推方程;
离散型卡尔曼滤波器的递推方程建立过程如下:
首先,给定惯导***的一阶线性状态方程和量测方程为:
Z(t)=H(t)X(t)+V(t)(24)
进而将状态方程(23)和量测方程(24)离散化可得:
Xk=Фk,k-1Xk-1+Γk-1Wk-1(25)
Zk=HkXk+Vk(26)
其中,Xk为状态向量,Фk,k-1为状态转移矩阵,Zk为量测向量,Hk为量测矩阵,Γk-1为***噪声矩阵,Wk-1为***噪声向量,Vk为量测噪声向量。Wk-1、Vk是不相关高斯白噪声列。
状态预测估计方程为:
方差预测方程为:
状态预测估计方程为:
方差迭代方程:
滤波增益方程为:
初始条件为:
验前统计量为:
E[Wk]=0,Cov[Wk,Wj]=E[WkWj T]=Qkδkj(33)
E[VK]=0,Cov[Vk,Vj]=E[VkVj T]=Rkδkj(34)
Cov[Wk,Vj]=E[WkVj T]=0(35)
步骤6:通过步骤5中建立的离散型卡尔曼滤波器的递推方程,进行Kalman滤波解算,得到主惯导***的俯仰、横滚和航向角分别为ψAE、ψAN和ψAU,从惯导***的俯仰、横滚和航向角分别为ψBE、ψBN和ψBU。
步骤7:相对姿态矩阵解算;
则主惯导***与从惯导相对姿态角的主值为:
步骤7:主惯导***与从惯导***间的相对姿态置信度估计;
在主惯导***与从惯导***精度近似不相关的情况下,相对姿态的置信度估计值为:
在动态载体上的高精度相对姿态测量中,通过上述方法有效解决了在DGPS信号缺失这种可能性下的解算问题,提高了导航***的稳定性,可实时输出导航***在测量过程中的速度、位置、姿态信息,测量范围广,且实现了导航信息的优化,提高了导航***精度,能满足高精度实时测量要求。
Claims (1)
1.一种基于双IMU/DGPS组合的相对姿态测量实时动态滤波方法,其特征在于:采用主惯导***与从惯导***两个光纤捷联惯导***与一个DGPS进行组合,具体滤波方法由下述步骤来完成:
步骤1:主惯导***和从惯导***根据各自的惯性测量单元测得的载体加速度数据和角速度数据,分别通过捷联惯导实时解算,得到主惯导***和从惯导***的导航信息;
设惯导***的导航坐标系为当地地理坐标系,水平位置误差为δL,δλ,δh,δL为惯导***经度误差,δλ为惯导***纬度误差,δh为惯导***高度误差,水平速度误差为δVE,δVN,δVU,姿态误差为ψE,ψN,ψU,陀螺漂移项εE,εN,εU,加速度计零偏▽E,▽N,▽U,则捷联惯导误差方程为:
状态矢量:
X(t)=[δL,δλ,δh,δVE,δVN,δVU,ψE,ψN,ψU,εE,εN,εU,▽E,▽N,▽U]T (1)
姿态误差方程:
速度误差方程:
水平位置误差方程:
其中,ωie为地球自转角速度,ωie=7.29×10-5rad/s;RE=6378137m,RE为参考椭球体的长半径;f为地球扁率,f=1/298.257;RM=RE(1-2f+3fsin2L),RM为子午圈主曲率半径;RN为卯酉圈主曲率半径RN=RE(1+fsin2L);L为惯导***测量到的位置经度数据;h为惯导***测量到的高度数据;
根据主惯导***和从惯导***根据各自的惯性测量单元测得的载体加速度数据和角速度数据,通过上述捷联惯导误差方程,可分别得到主惯导***与从惯导***的水平位置误差δLA,δλA,δhA与δLB,δλB,δhB,水平速度误差δVAE,δVAN,δVAU与δVBE,δVBN,δVBU,姿态误差ψAE,ψAN,ψAU与ψBE,ψBN,ψBU,并分别对主惯导***与从惯导***的水平位置误差,水平速度误差,姿态误差进行迭代运算,从而得到主惯导***与从惯导***的位置、速度和姿态值 ;
步骤2:判断DGPS信息是否有更新;
当DGPS信息更新时,进入步骤3;当DGPS信息丢失或未更新时,则进入步骤4;
步骤3:根据由DGPS获取的载体的位置、速度等信息,与步骤1中得到的主惯导***与从惯导***的导航信息,分别对主惯导***与从惯导***进行滤波修正,建立组合导航滤波器的量测方程,随后进入步骤5;
上述组合导航滤波器的量测方程的建立方法为:
惯导***的位置信息可表示为:
其中,惯导***水平位置误差为δL,δλ,δh,Lt,λt,ht为惯导***的真实位置信息;
DGPS测得的载***置信息可表示为:
其中,NE,NN,NU分别为DGPS测量得到的载体沿东、北、天方向的位置误差;
则惯导***的位置量测矢量为:
惯导***的速度信息可表示为:
其中,惯导***的水平速度误差为δVE,δVN,δVU,VN,VE,VU为惯导***的真实速度信息;
DGPS测得的载体速度信息可表示为:
其中,ME,MN,MU分别为DGPS沿东、北、天方向的载体速度误差;
则惯导***的速度量测矢量为:
综上可得在DGPS信号正常时惯导***组合滤波器量测方程如下:
步骤4:使用主惯导***的速度、位置信息对从惯导***进行滤波修正,建立双惯导组合滤波器方程,随后进入步骤5;
上述使用主惯导***的速度、位置信息对从惯导***进行滤波修正方法为:
从惯导***的位置量测信息表示为:
其中,δLB、δλB、δhB分别为从惯导***经度、纬度、高度上的位置误差;LBt,λBt,hBt为从惯导***的真实位置信息;
主惯导***的位置量测信息可表示为:
其中,δLA,δλA,δhA为主惯导***与从惯导***的水平位置误差;
则惯导***位置量测矢量定义为:
主惯导***与从惯导***组合滤波器的位置噪声的最优估计由主惯导***估计误差的协方差阵PA(t)为:
从惯导***的速度信息可表示为:
其中,δVBE,δVBN,δVBU为主惯导***水平速度误差;VBNt,VBEt,VBUt为从惯导***真实速度信息;主惯导***的速度量测信息可表示为:
其中,δVAE,δVAN,δVAU为主惯导***水平速度误差;
则惯导***位置量测速度量测矢量为:
主惯导***与从惯导***组合滤波器的速度量测噪声的最优估计由主惯导***估计误差的协方差阵PA(t)给出:
综上可得在无DGPS信号时惯导***组合滤波器量测方程如下:
步骤5:将惯导***组合滤波器量测方程和状态方程离散化,建立离散型卡尔曼滤波器的递推方程;
所述离散型卡尔曼滤波器的递推方程建立过程如下:
首先,给定惯导***的一阶线性状态方程和量测方程为:
Z(t)=H(t)X(t)+V(t) (24)
进而将状态方程(5)和量测方程(6)离散化可得:
Xk=Φk,k-1Xk-1+Γk-1Wk-1 (25)
Zk=HkXk+Vk (26)
其中,Xk为状态向量,Φk,k-1为状态转移矩阵,Zk为量测向量,Hk为量测矩阵,Γk-1为***噪声矩阵,Wk-1为***噪声向量,Vk为量测噪声向量;Wk-1、Vk是不相关高斯白噪声列;
状态预测估计方程为:
方差预测方程为:
状态预测估计方程为:
方差迭代方程:
=(I-KkHk)Pk/k-1 (30)
滤波增益方程为:
初始条件为:
验前统计量为:
E[Wk]=0,Cov[Wk,Wj]=E[WkWj T]=Qkδkj (33)
E[Vk]=0,Cov[Vk,Vj]=E[VkVj T]=Rkδkj (34)
Cov[Wk,Vj]=E[WkVj T]=0 (35)
步骤6:通过步骤5中建立的离散型卡尔曼滤波器的递推方程,进行Kalman滤波解算,得到主惯导***与从惯导***的俯仰、横滚和航向角;
步骤7:根据步骤6得到的主惯导***的俯仰、横滚和航向角ψAE、ψAN和ψAU,与从惯导***的俯仰、横滚和航向角ψBE、ψBN和ψBU,建立由地理坐标系到主惯导***载体坐标系的转换矩阵为由地理坐标系到从惯导***载体坐标系的转换矩阵为则:
则主惯导***与从惯导相对姿态角的主值为:
步骤8:主惯导***与从惯导***间的相对姿态置信度估计,具体为:
在主惯导***与从惯导***精度近似不相关的情况下,相对姿态的置信度估计值为:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110385043.2A CN102506857B (zh) | 2011-11-28 | 2011-11-28 | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201110385043.2A CN102506857B (zh) | 2011-11-28 | 2011-11-28 | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102506857A CN102506857A (zh) | 2012-06-20 |
CN102506857B true CN102506857B (zh) | 2014-01-22 |
Family
ID=46218964
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201110385043.2A Expired - Fee Related CN102506857B (zh) | 2011-11-28 | 2011-11-28 | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102506857B (zh) |
Families Citing this family (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103389115A (zh) * | 2013-07-26 | 2013-11-13 | 哈尔滨工程大学 | Sins/dvl组合导航***一体化误差标定方法 |
CN103529482B (zh) * | 2013-10-25 | 2016-05-11 | 中国人民解放军国防科学技术大学 | 一种高精度确定载体动态加速度的方法 |
CN103776446B (zh) * | 2013-10-29 | 2017-01-04 | 哈尔滨工程大学 | 一种基于双mems-imu的行人自主导航解算算法 |
CN104655115B (zh) * | 2013-11-22 | 2017-12-05 | 中国航空工业集团公司西安飞机设计研究所 | 一种角速率测量方法 |
CN103929716A (zh) * | 2014-04-24 | 2014-07-16 | 黄卿 | 一种定位方法、定位信息发送方法及装置 |
CN104408315B (zh) * | 2014-11-28 | 2017-07-28 | 北京航空航天大学 | 一种基于sins/gps组合导航的卡尔曼滤波数值优化方法 |
CN104807479A (zh) * | 2015-05-20 | 2015-07-29 | 江苏华豪航海电器有限公司 | 一种基于主惯导姿态变化量辅助的惯导对准性能评估方法 |
CN104864868B (zh) * | 2015-05-29 | 2017-08-25 | 湖北航天技术研究院总体设计所 | 一种基于近距离地标测距的组合导航方法 |
CN104897178B (zh) * | 2015-07-06 | 2017-07-07 | 中国人民解放军国防科学技术大学 | 一种双惯导联合旋转调制导航与在线相对性能评估方法 |
CN105806338B (zh) * | 2016-03-17 | 2018-10-19 | 武汉际上导航科技有限公司 | 基于三向卡尔曼滤波平滑器的gnss/ins组合定位定向算法 |
CN105841697B (zh) * | 2016-03-25 | 2018-12-21 | 北京航天自动控制研究所 | 一种多源惯性导航信息合理性判别方法 |
CN105973271B (zh) * | 2016-07-25 | 2019-10-11 | 北京航空航天大学 | 一种混合式惯导***自标定方法 |
CN106595640A (zh) * | 2016-12-27 | 2017-04-26 | 天津大学 | 基于双imu和视觉融合的动基座上物体相对姿态测量方法及*** |
CN107917699B (zh) * | 2017-11-13 | 2020-01-17 | 中国科学院遥感与数字地球研究所 | 一种用于提高山区地貌倾斜摄影测量空三质量的方法 |
CN108253965A (zh) * | 2018-01-17 | 2018-07-06 | 中国海洋石油集团有限公司 | 一种tlp平台姿态方位测量*** |
CN108592946B (zh) * | 2018-04-26 | 2022-02-08 | 北京航空航天大学 | 一种基于两套旋转惯导冗余配置下的惯性器件漂移在线监控方法 |
CN109471102B (zh) * | 2018-10-23 | 2021-05-04 | 湖北航天技术研究院总体设计所 | 一种惯组误差修正方法 |
CN111189471A (zh) * | 2018-11-14 | 2020-05-22 | 中移物联网有限公司 | 一种校正方法、装置和计算机存储介质 |
CN109357674A (zh) * | 2018-12-07 | 2019-02-19 | 上海机电工程研究所 | 一种gnss和ins组合导航观测量引入方法 |
CN109931926B (zh) * | 2019-04-04 | 2023-04-25 | 山东智翼航空科技有限公司 | 一种基于站心坐标系的小型无人机无缝自主式导航方法 |
CN112051595A (zh) * | 2019-06-05 | 2020-12-08 | 北京自动化控制设备研究所 | 利用dgps位置信息求解载体运动加速度的后向差分滤波方法 |
CN111007553B (zh) * | 2019-11-20 | 2022-01-04 | 广东博智林机器人有限公司 | 被测对象的导航方法、装置、计算机设备和存储介质 |
CN111879279B (zh) * | 2020-08-11 | 2021-06-08 | 武汉大学 | 高堆石坝的心墙变形监测方法 |
CN112146655B (zh) * | 2020-08-31 | 2023-03-31 | 郑州轻工业大学 | 一种BeiDou/SINS紧组合导航***弹性模型设计方法 |
CN112097728B (zh) * | 2020-09-17 | 2021-07-30 | 中国人民解放军国防科技大学 | 基于反向解算组合惯性导航***的惯性双矢量匹配形变测量方法 |
CN114217628A (zh) * | 2021-12-24 | 2022-03-22 | 北京理工大学重庆创新中心 | 基于5g通讯的双路imu单元无人机控制器及控制方法 |
CN114323011B (zh) * | 2022-01-05 | 2024-04-23 | 中国兵器工业计算机应用技术研究所 | 一种适用于相对位姿测量的卡尔曼滤波方法 |
CN114383612B (zh) * | 2022-01-05 | 2024-04-12 | 中国兵器工业计算机应用技术研究所 | 一种视觉辅助惯性差分位姿测量*** |
CN116817927B (zh) * | 2023-08-24 | 2023-12-22 | 北京李龚导航科技有限公司 | 双滤波器组合导航定位与测姿方法、电子设备及介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1361430A (zh) * | 2000-12-23 | 2002-07-31 | 林清芳 | 增强的运动体定位和导航方法与*** |
CN1869630A (zh) * | 2006-04-19 | 2006-11-29 | 吉林大学 | 完备汽车运动状态测量*** |
CN101000244A (zh) * | 2007-01-05 | 2007-07-18 | 北京航空航天大学 | 一种高集成度mimu/gps/微磁罗盘/气压高度计组合导航*** |
CN101105401A (zh) * | 2007-08-06 | 2008-01-16 | 北京航空航天大学 | 一种sdins/gps组合导航***时间同步及同步数据提取方法 |
CN201497509U (zh) * | 2009-06-12 | 2010-06-02 | 西安星展测控科技有限公司 | 一种双天线gps/ins组合导航仪 |
CN102072725A (zh) * | 2010-12-16 | 2011-05-25 | 唐粮 | 一种基于激光点云和实景影像进行空间三维测量的方法 |
-
2011
- 2011-11-28 CN CN201110385043.2A patent/CN102506857B/zh not_active Expired - Fee Related
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN1361430A (zh) * | 2000-12-23 | 2002-07-31 | 林清芳 | 增强的运动体定位和导航方法与*** |
CN1869630A (zh) * | 2006-04-19 | 2006-11-29 | 吉林大学 | 完备汽车运动状态测量*** |
CN101000244A (zh) * | 2007-01-05 | 2007-07-18 | 北京航空航天大学 | 一种高集成度mimu/gps/微磁罗盘/气压高度计组合导航*** |
CN101105401A (zh) * | 2007-08-06 | 2008-01-16 | 北京航空航天大学 | 一种sdins/gps组合导航***时间同步及同步数据提取方法 |
CN201497509U (zh) * | 2009-06-12 | 2010-06-02 | 西安星展测控科技有限公司 | 一种双天线gps/ins组合导航仪 |
CN102072725A (zh) * | 2010-12-16 | 2011-05-25 | 唐粮 | 一种基于激光点云和实景影像进行空间三维测量的方法 |
Non-Patent Citations (4)
Title |
---|
双IMU/DGPS组合相对测姿***同步方法研究;张春熹等;《弹箭与制导学报》;20100630;第30卷(第3期);全文 * |
应用卡尔曼滤波的线性***可观测度实时估计方法;芦佳振等;《宇航学报》;20090531;第30卷(第3期);全文 * |
张春熹等.双IMU/DGPS组合相对测姿***同步方法研究.《弹箭与制导学报》.2010,第30卷(第3期),全文. |
芦佳振等.应用卡尔曼滤波的线性***可观测度实时估计方法.《宇航学报》.2009,第30卷(第3期),全文. |
Also Published As
Publication number | Publication date |
---|---|
CN102506857A (zh) | 2012-06-20 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102506857B (zh) | 一种基于双imu/dgps组合的相对姿态测量实时动态滤波方法 | |
US9423509B2 (en) | Moving platform INS range corrector (MPIRC) | |
US9784582B2 (en) | Method and apparatus for navigation with nonlinear models | |
CN104457754B (zh) | 一种基于sins/lbl紧组合的auv水下导航定位方法 | |
CN110779521A (zh) | 一种多源融合的高精度定位方法与装置 | |
CN101382431B (zh) | 定位***及其方法 | |
US6553322B1 (en) | Apparatus and method for accurate pipeline surveying | |
US6459990B1 (en) | Self-contained positioning method and system thereof for water and land vehicles | |
CN102176041B (zh) | 一种基于gnss/sins组合的车辆导航监控*** | |
CN107121141A (zh) | 一种适用于定位导航授时微***的数据融合方法 | |
US20070282565A1 (en) | Object locating in restricted environments using personal navigation | |
CN102879779B (zh) | 一种基于sar遥感成像的杆臂测量及补偿方法 | |
CN102829777A (zh) | 自主式水下机器人组合导航***及方法 | |
EP3460398A1 (en) | Methods, apparatuses, and computer programs for estimating the heading of an axis of a rigid body | |
CN108594272A (zh) | 一种基于鲁棒卡尔曼滤波的抗欺骗干扰组合导航方法 | |
CN107015259A (zh) | 采用多普勒测速仪计算伪距/伪距率的紧组合方法 | |
CN106840154A (zh) | 地下空间惯性测量与无线传感器组合定位***与方法 | |
CN102095424A (zh) | 一种适合车载光纤航姿***的姿态测量方法 | |
Lan et al. | Integrated RTK/INS navigation for precision agriculture | |
CN104049269A (zh) | 一种基于激光测距和mems/gps组合导航***的目标导航测绘方法 | |
CN103278165A (zh) | 基于剩磁标定的磁测及星光备份的自主导航方法 | |
Meguro et al. | Low-cost lane-level positioning in urban area using optimized long time series GNSS and IMU data | |
CN103712621A (zh) | 偏振光及红外传感器辅助惯导***定姿方法 | |
CN101793529B (zh) | 一种双伪卫星辅助惯性导航***位置校准方法 | |
CN106323226B (zh) | 一种利用北斗测定惯性导航***与测速仪安装夹角的方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20140122 Termination date: 20201128 |
|
CF01 | Termination of patent right due to non-payment of annual fee |