CN107607977A - 一种基于最小偏度单形采样的自适应ukf组合导航方法 - Google Patents
一种基于最小偏度单形采样的自适应ukf组合导航方法 Download PDFInfo
- Publication number
- CN107607977A CN107607977A CN201710722301.9A CN201710722301A CN107607977A CN 107607977 A CN107607977 A CN 107607977A CN 201710722301 A CN201710722301 A CN 201710722301A CN 107607977 A CN107607977 A CN 107607977A
- Authority
- CN
- China
- Prior art keywords
- sampling
- error
- simple form
- state
- sigma
- 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
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于最小偏度单形采样的自适应UKF组合导航方法,属于导航技术领域。以SINS为主导航系统,GPS作为辅助导航系统的紧组合模型基础上,采用无迹卡尔曼滤波算法对系统进行滤波估计;以基于高斯分布理论的UT变换为核心,对系统的状态预测可达到三阶截断精度。本发明采用最小偏度单形采样策略替换传统UKF的对称采样策略,提高滤波的实时性,减小计算量;并且针对采样点的非局部效应,引入比例因子自适应地平衡状态方程预报信息与观测信息的权值,提高滤波精度。实验结果表明,本发明方法在不损失滤波精度的条件下,能够减少滤波时间,提高系统的实时性;且本发明方法简单,易于实现,具有较强的应用价值和推广前景。
Description
技术领域
本发明属于导航技术领域,具体涉及一种基于最小偏度单形采样的自适应UKF组合 导航方法。
背景技术
组合导航系统通过对两种或多种导航系统测量或输出信息进行综合处理从而使总系 统的性能指标优于任一子导航系统。惯性导航和卫星导航都有各自的优缺点,如果采用 某种手段将它们结合构成组合导航系统,那么既可以克服惯性导航误差积累的问题,又可以弥补GPS导航信号受遮蔽的问题,其精度和可靠性将得到极大的提高。在组合导航 中,最关键的就是数据融合,而卡尔曼滤波器是一种基于最小均方误差准则的使用最为 广泛的滤波器。在实际应用中,导航系统一般都是非线性的,因此研究组合导航系统也 就集中在研究非线性卡尔曼滤波在组合导航系统中的应用。
为解决非线性系统的估值问题,目前为止使用最广泛的滤波方法就是扩展卡尔曼滤 波(Extend Kalman Filter,EKF),它是在Kalman滤波的基础上对非线性的状态方程和观 测方程进行Taylor展开,只保留一阶项,舍去二阶及以上项,得到的一种近似非线性滤波方法。但当系统的非线性程度较高时,高阶项较大,这种简单的线性化处理会引入较 大的高阶误差,甚至使系统发散。EKF最关键的就是Jacobian矩阵的求取,这使它只能 应用于具有显式表达且连续的系统。目前国内外学者针对也EKF提出了许多改进策略如: 高阶截断EKF、迭代EKF等,但都没有从本质上克服这些缺点,虽然提高了EKF估计 的精度,但这也增加了计算量,得不偿失。为避免以上提到的问题,学者Julier和Uhlmann 于2002年基于“近似概率密度要比近似非线性函数容易的多”的观点,提出了一种新的 基于确定性采样点计算的滤波方法,由于该算法是建立在Unscented变换(Unscented Transformation,UT)的基础上的,所以称之为无迹卡尔曼滤波器(Unscented Kalman Filter, UKF)。相较于EKF,它不需要计算非线性函数的Jacobian或者Hessians矩阵。在UT变 换中,最关键的就是确定Sigma点的采样策略。Sigma点的采样策略与算法的计算量和 精度息息相关,一般来说,采样点个数越多,算法计算量越大。目前应用最广泛的采样 策略是对称采样,但其采样点的个数会随着系统状态的维数比例增大,计算量也随之增 加,较大的计算量会使系统无法满足实时性的要求。此外,随着系统维数的增大,部分 Sigma采样点会距中心点较远,致使相应Sigma点的参考价值较小,这便是采样的非局 部效应,它会导致滤波精度下降。
发明内容
本发明目的在于提供设计合理、精度高且实时性好的基于无迹卡尔曼滤波组合的一 种基于最小偏度单形采样的自适应UKF组合导航方法。
本发明的目的通过如下技术方案来实现:
一种基于最小偏度单形采样的自适应UKF组合导航方法,包括以下步骤:
(1)根据SINS和GPS的误差特性,建立起SINS/GPS紧组合误差模型,即状态方程和
量测方程。
步骤(1)具体包括:
(1.1)建立状态方程:
(1.1.1)选取SINS系统的误差量为:东北天向的平台误差角速度误差 δvE,δvN,δvU,经度、纬度、高度的位置误差δL,δλ,δh,沿载体坐标系x,y,z轴的陀螺仪漂移εbx,εby,εbz、陀螺仪的一阶马氏过程εrx,εry,εrz,加速度计零偏
(1.1.2)选取GPS系统的误差量为:与时钟频率误差等效的速度误差量δtru以及与时钟误 差等效的距离误差量δtu;
(1.1.3)SINS系统的误差量和GPS系统的误差量为状态量列写状态方程得:
即
式中的状态向量X(t)为20维,是分别由XI(t)的18维,和XG(t)的2维合并成的,下标I表示SINS,下标G表示GPS,
其中,FI(t)、FG(t)分别为XI(t),XG(t)的系统矩阵,BI(t)、BG(t)分别为WI(t),WG(t)的 噪声驱动阵,
其中,ωgx,ωgy,ωgz,ωrx,ωry,ωrz,ωax,ωay,ωaz分别为陀螺仪漂移、陀螺仪的一阶马氏过程以及加 速度计在载体坐标系下的白噪声。
(1.2)建立量测方程:
(1.2.1)紧组合系统的伪距量测方程为:
Zρ(t)=Hρ(t)X(t)+vρ(t)
式中,Zp(t)为伪距量测量,Zρ(t)=[δρ1 δρ2 … δρn]T,
(1.2.2)紧组合系统的伪距率量测方程为:
式中,
(1.2.3)合并伪距量测方程和伪距率量测方程并进行维数扩展,得到SINS/GPS导航系 统紧组合模型的量测方程:
(2)选取初始滤波值并设置初始比例因子α。
步骤(2)具体包括:
滤波器的初值取为:
其中,x0为状态变量的初值,为x0的均值,P0为状态变量的初始误差协方差矩阵;
根据量测噪声(m维)和系统噪声(q维),对n维的系统状态矩阵和协方差矩阵进行扩维, 并分别设初始状态向量和初始协方差矩阵为:
其中,Q是系统噪声的协方差阵,R是观测噪声的协方差阵;
比例因子α用来控制Sigma点到中心点的距离,在[10-4,1]区间上取值。
(3)采用最小偏度单形采样的方法计算Sigma样本点和相应的权值并更新比例因子 α=αk|k-1。
步骤(3)具体包括:
(3.1)最小偏度单形采样:
Sigma点集为:
其中,设为j维空间采样点集的第i个Sigma点,不失一般性,假设Pxx=I,选择 0≤W0≤1;
Sigma采样点一阶、二阶权系数分别为:
其中α为比例因子,参数β用来描述x的先验分布信息,β≥0是一个非负的权函数,上 标m为均值,c为协方差,下标为第几个采样点,表示Pxx的平方根矩阵,可用Cholesky分解取下三角计算得到;
(3.2)更新比例因子:
具体算法为:
(3.2.1)由xk|k和Pkk按预先确定的最小偏度单形采样策略生成Sigma点集和权值{χi,Wj};
(3.2.2)计算
(3.2.3)令
其中,di为比例修正后第i个Sigma点到中心点x的距离,即L为最小 偏度单形采样点的个数。
(4)将计算得到的Sigma采样点通过状态函数求取Sigma点集的一步预测并计算 系统状态量的一步预测和协方差矩阵P(k|k-1)。
步骤(4)具体包括:
计算得到的Sigma采样点通过状态函数求取Sigma点集的一步预测
预测k时刻的系统状态变量及协方差:
根据一步预测值再次进行UT变换,生成新的Sigma点集,代入观测方程得:
预测系统的量测均值及协方差:
计算卡尔曼增益阵:
(5)计算系统的状态更新和协方差更新P(k|k)。
步骤(5)具体包括:
计算系统的状态更新和协方差更新:
本发明的有益效果在于:
一、本发明技术相比对称采样的UKF能够缩短滤波时间,提高系统的实时性;
二、本发明相比最小偏度单形采样的UKF滤波精度高;
三、本发明的技术可以适用于任何非线性系统的滤波模型。
附图说明
图1为本发明SINS/GPS紧组合结构框图;
图2为本发明ASUKF方法流程图;
图3为本发明方法与其他方法的定位误差对比图;
图4为本发明方法与其他方法的速度误差对比图。
具体实施方式
下面结合附图对本发明的具体实施方式作进一步说明:
基于单形采样的自适应UKF组合导航新方法,其具体步骤如下:
步骤一、根据SINS和GPS的误差特性,建立起SINS/GPS紧组合误差模型,即状态方程和量测方程。
所述步骤一中,紧组合是一种SINS系统和GPS系统相互辅助的组合模式,组合水平较 松组合高,实现也更复杂。其结构如附图1。紧组合是在伪距、伪距率级别上的耦合,状态方程是由SINS和GPS的误差状态方程合并而成。我们选取东北天地理坐标系(E,N,U分 别表示东、北、天向)作为导航坐标系,并在此坐标系下推导SINS系统的误差方程。
(1)状态方程的建立
选取SINS系统的误差量为:东北天向的平台误差角速度误差δvE,δvN,δvU, 经度、纬度、高度的位置误差δL,δλ,δh,沿载体坐标系x,y,z轴的陀螺仪漂移εbx,εby,εbz、陀 螺仪的一阶马氏过程εrx,εry,εrz,加速度计零偏而GPS系统的误差状态选取了与 GPS系统的时钟误差相关的两个误差量:与时钟频率误差等效的速度误差量δtru以及与时钟误 差等效的距离误差量δtu。将SINS系统的误差量和GPS系统的误差量为状态量列写状态方程 得:
即
式中的状态向量X(t)为20维,是分别由XI(t)的18维,和XG(t)的2维合并成的。下标I表示SINS,下标G表示GPS。
其中,FI(t)、FG(t)分别为XI(t),XG(t)的系统矩阵。BI(t)、BG(t)分别为WI(t),WG(t)的 噪声驱动阵。
其中,ωgx,ωgy,ωgz,ωrx,ωry,ωrz,ωax,ωay,ωaz分别为陀螺仪漂移、陀螺仪的一阶马氏过程以及加 速度计在载体坐标系下的白噪声。
(2)量测方程的建立
紧组合的量测量并不是各子导航系统的输出信息简单的整合,它是将SINS系统输出的位 置和速度等信息结合得到的卫星星历信息,计算得到运载体相对于各卫星的伪距和伪距率信 息,再减去GPS接收设备输出的伪距和伪距率等原始信息,并把这个差值作为紧组合系统的 量测值。与松组合相比,因为使用了GPS系统的原始信息,增大了系统的能控能观性,使系 统的可靠性更高。
紧组合系统的伪距量测方程为:
Zρ(t)=Hρ(t)X(t)+vρ(t) (3)
式(3)中,Zp(t)为伪距量测量,Zρ(t)=[δρ1 δρ2 … δρn]T,
紧组合系统的伪距率量测方程为:
式(4)中
合并式(3)和式(4)并进行维数扩展,至此便得到了SINS/GPS导航系统紧组合模型的量测 方程:
以上建立的SINS/GPS组合导航系统紧组合模型是连续模型,考虑到计算机的实现方式, 必须先对连续系统做离散化处理才能应用卡尔曼滤波器对其进行估计虑波。
步骤二、选取初始滤波值并设置初始比例因子α。令和其中,x0为状态变量的初值,为x0的均值。P0为状态变量的初 始误差协方差矩阵。
所述步骤二滤波器的初值取为:再根据量测噪声 (m维)和系统噪声(q维),对n维的系统状态矩阵和协方差矩阵进行扩维,并分别设初始状态 向量和初始协方差矩阵为:
其中,Q是系统噪声的协方差阵,R是观测噪声的协方差阵。
比例因子α用来控制Sigma点到中心点的距离,它是一个较小的正数,可在[10-4,1]区 间上取值。
步骤三、采用最小偏度单形采样的方法计算Sigma样本点和相应的权值并更新比例因子 α=αk|k-1。
所述步骤三中,UKF以无迹变换(Unscented transformation,UT变换)为基础,利用确定 性的Sigma采样点去逼近原非线性函数的状态分布。传统UKF的UT变换采用对称采样,需 要计算2n+1(n为系统的维数)个Sigma点。而最小偏度单形采样只需计算n+1(考虑中心点 为n+2)个采样点,可以减小计算量,减少滤波时间。又Sigma点到中心点x的距离会随系统 状态维数的增加而增大,这样会使高维系统在UT变换过程中产生采样的非局部效应,致使 高阶误差项增大。为此,采用自适应比例因子修正算法,可有效降低采样的非局部效应问题, 而且还能减小高阶误差项的影响,此方法还满足协方差矩阵的半正定性,适用于多种基本的 采样策略。本发明方法流程图如附图2所示。
(1)最小偏度单形采样:
设为j维空间采样点集的第i个Sigma点,不失一般性,假设Pxx=I,选择0≤W0≤1。 Sigma点集为:
Sigma采样点一阶、二阶权系数分别为:
其中α为比例因子,系统的非线性越强α值越小。通过改变α的值调节Sigma采样点到 的距离,以减小UT变换的非局部效应造成的影响。参数β用来描述x的先验分布信息,β≥0 是一个非负的权函数。对于高斯分布的系统,β=2时为最优。式中上标m为均值,c为协方 差,下标为第几个采样点。表示Pxx的平方根矩阵,可用Cholesky分解取下三角计算得 到。如果Pxx=UUT,则显然Pxx必须是正定的。
(2)更新比例因子:
设di为比例修正后第i个Sigma点到中心点x的距离,即L为最小偏度 单形采样点的个数。具体算法为:
a)由xk|k和Pk|k按预先确定的最小偏度单形采样策略生成Sigma点集和权值{χi,Wj};
b)计算
c)令
在每次UT变换的过程中,用上面计算得到的自适应比例因子α取代常规的固定参数的 比例因子对采样策略进行修正,便得到了自适应的比例修正UT变换。
步骤四、预测。将计算得到的Sigma采样点通过状态函数求取Sigma点集的一步预测并计算系统状态量的一步预测和协方差矩阵P(k|k-1)。返回步骤三,用和 P(k|k-1)重新生成采样点集及权值。将得到的预测的Sigma点集带入观测方程,得到观测量。 计算自协方差矩阵Pzz(k|k-1)和互协方差矩阵Pxz(k|k-1)。
步骤四中将计算得到的Sigma采样点通过状态函数求取Sigma点集的一步预测
预测k时刻的系统状态变量及协方差:
根据一步预测值再次进行UT变换,生成新的Sigma点集,代入观测方程得:
预测系统的量测均值及协方差:
计算卡尔曼增益阵:
步骤五、更新。计算系统的状态更新和协方差更新P(k|k)。
步骤五计算系统的状态更新和协方差更新。
实施例:
仿真所使用的轨迹是利用MATLAB系统导航信息的输出频率为100Hz,GPS的输出频率为10Hz,组合导航系统的数据输出频率与SINS系统同步。设陀螺仪常值漂移0.1°/h,白噪声均方差0.01°/h;加速度计常值零偏1×10-4g,白噪声均方差5×10-5g;GPS伪距白噪声10m, 伪距率白噪声0.5m/s。
分别采用对称采样UKF、单形采样UKF(SUKF)和本发明ASUKF方法对SINS/GPS导 航系统的紧组合模型进行MATLAB仿真,并对实验结果进行对比分析。实验结果如附图3 和图4所示,图中黑色“—”表示UKF滤波估计误差,红色“--”表示UKF滤波估计误差, 蓝色“-.”表示UKF滤波估计误差。
重复进行50次MC仿真实验,并计算三种UKF算法各类误差信息的RMSE,统计这三种UKF算法的平均运行时间,结果如表1所示:
表1紧组合三种UKF方法仿真效果对比
由图3和图4的误差曲线图及表1的仿真效果统计信息可得:对比这三种滤波方法的误 差曲线可以得出,单形采样UKF(记为SUKF)滤波精度比对称采样UKF(记为UKF)滤波精度 稍差,但用时比对称采样UKF少了大概有30%。本发明方法虽然在UT变换的过程中,计算量较固定比例参数的单形采样UT变换策略只是略微增大,大概增大了5%,但其精度却有很大的提高,尤其是其速度精度提高了将近20%,位置精度也有10%多的提升。而本发明ASUKF 方法与常规的对称采样UKF滤波相比,在估计精度大体相同的情况下,使计算量却减小了大 约25%。综合来看,本发明方法在不损失滤波精度的条件下,能够减少滤波时间,提高系统 的实时性。且本发明方法方法简单,易于实现,具有较强的应用价值和推广前景。
以上所述仅为本发明的优选实施例而已,并不用于限制本发明,对于本领域的技术人员 来说,本发明可以有各种更改和变化。凡在本发明的精神和原则之内,所作的任何修改、等 同替换、改进等,均应包含在本发明的保护范围之内。
Claims (6)
1.一种基于最小偏度单形采样的自适应UKF组合导航方法,其特征在于,包括以下步骤:
(1)根据SINS和GPS的误差特性,建立起SINS/GPS紧组合误差模型,即状态方程和量测方程;
(2)选取初始滤波值并设置初始比例因子α;
(3)采用最小偏度单形采样的方法计算Sigma样本点和相应的权值并更新比例因子α=αk|k-1;
(4)将计算得到的Sigma采样点通过状态函数求取Sigma点集的一步预测并计算系统状态量的一步预测和协方差矩阵P(k|k-1);
(5)计算系统的状态更新和协方差更新P(k|k)。
2.根据权利要求1所述的一种基于最小偏度单形采样的自适应UKF组合导航方法,其特征在于,所述的步骤(1)具体包括:
(1.1)建立状态方程:
(1.1.1)选取SINS系统的误差量为:东北天向的平台误差角速度误差δvE,δvN,δvU,经度、纬度、高度的位置误差δL,δλ,δh,沿载体坐标系x,y,z轴的陀螺仪漂移εbx,εby,εbz、陀螺仪的一阶马氏过程εrx,εry,εrz,加速度计零偏▽x,▽y,▽z;
(1.1.2)选取GPS系统的误差量为:与时钟频率误差等效的速度误差量δtru以及与时钟误差等效的距离误差量δtu;
(1.1.3)SINS系统的误差量和GPS系统的误差量为状态量列写状态方程得:
即
式中的状态向量X(t)为20维,是分别由XI(t)的18维,和XG(t)的2维合并成的,下标I表示SINS,下标G表示GPS,
其中,FI(t)、FG(t)分别为XI(t),XG(t)的系统矩阵,BI(t)、BG(t)分别为WI(t),WG(t)的噪声驱动阵,
WG(t)=[wu,wru]T;
其中,ωgx,ωgy,ωgz,ωrx,ωry,ωrz,ωax,ωay,ωaz分别为陀螺仪漂移、陀螺仪的一阶马氏过程以及加速度计在载体坐标系下的白噪声;
(1.2)建立量测方程:
(1.2.1)紧组合系统的伪距量测方程为:
Zρ(t)=Hρ(t)X(t)+vρ(t)
式中,Zp(t)为伪距量测量,Zρ(t)=[δρ1 δρ2 …δρn]T,
Hρ(t)=[0n×6 Hρ1 0n×6 Hρ2],
(1.2.2)紧组合系统的伪距率量测方程为:
式中,
(1.2.3)合并伪距量测方程和伪距率量测方程并进行维数扩展,得到SINS/GPS导航系统紧组合模型的量测方程:
3.根据权利要求1所述的一种基于最小偏度单形采样的自适应UKF组合导航方法,其特征在于,所述的步骤(2)具体包括:
滤波器的初值取为:
其中,x0为状态变量的初值,为x0的均值,P0为状态变量的初始误差协方差矩阵;
根据量测噪声(m维)和系统噪声(q维),对n维的系统状态矩阵和协方差矩阵进行扩维,并分别设初始状态向量和初始协方差矩阵为:
其中,Q是系统噪声的协方差阵,R是观测噪声的协方差阵;
比例因子α用来控制Sigma点到中心点的距离,在[10-4,1]区间上取值。
4.根据权利要求1所述的一种基于最小偏度单形采样的自适应UKF组合导航方法,其特征在于,所述的步骤(3)具体包括:
(3.1)最小偏度单形采样:
Sigma点集为:
其中,设为j维空间采样点集的第i个Sigma点,不失一般性,假设Pxx=I,选择0≤W0≤1;
Sigma采样点一阶、二阶权系数分别为:
其中α为比例因子,参数β用来描述x的先验分布信息,β≥0是一个非负的权函数,上标m为均值,c为协方差,下标为第几个采样点,表示Pxx的平方根矩阵,可用Cholesky分解取下三角计算得到;
(3.2)更新比例因子:
具体算法为:
(3.2.1)由xk|k和Pk|k按预先确定的最小偏度单形采样策略生成Sigma点集和权值{χi,Wj};
(3.2.2)计算
(3.2.3)令
其中,di为比例修正后第i个Sigma点到中心点x的距离,即L为最小偏度单形采样点的个数。
5.根据权利要求1,4所述的一种基于最小偏度单形采样的自适应UKF组合导航方法,其特征在于,所述的步骤(4)具体包括:
计算得到的Sigma采样点通过状态函数求取Sigma点集的一步预测
预测k时刻的系统状态变量及协方差:
根据一步预测值再次进行UT变换,生成新的Sigma点集,代入观测方程得:
预测系统的量测均值及协方差:
计算卡尔曼增益阵:
6.根据权利要求1,所述的一种基于最小偏度单形采样的自适应UKF组合导航方法,其特征在于,所述的步骤(5)具体包括:
计算系统的状态更新和协方差更新:
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710722301.9A CN107607977B (zh) | 2017-08-22 | 2017-08-22 | 一种基于最小偏度单形采样的自适应ukf组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710722301.9A CN107607977B (zh) | 2017-08-22 | 2017-08-22 | 一种基于最小偏度单形采样的自适应ukf组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107607977A true CN107607977A (zh) | 2018-01-19 |
CN107607977B CN107607977B (zh) | 2020-12-08 |
Family
ID=61065321
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710722301.9A Active CN107607977B (zh) | 2017-08-22 | 2017-08-22 | 一种基于最小偏度单形采样的自适应ukf组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107607977B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000642A (zh) * | 2018-05-25 | 2018-12-14 | 哈尔滨工程大学 | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 |
CN109754013A (zh) * | 2018-12-31 | 2019-05-14 | 浙江大学 | 一种基于无迹卡尔曼滤波的电力系统混合量测融合方法 |
CN110514203A (zh) * | 2019-08-30 | 2019-11-29 | 东南大学 | 一种基于isr-ukf的水下组合导航方法 |
CN114777745A (zh) * | 2022-04-08 | 2022-07-22 | 南京信息工程大学 | 一种基于无迹卡尔曼滤波的倾斜取证建模方法 |
CN116182949A (zh) * | 2023-02-23 | 2023-05-30 | 中国人民解放军91977部队 | 一种海洋环境水质监测系统及方法 |
Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187562A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 船用光纤陀螺捷联系统初始姿态确定方法 |
CN104374405A (zh) * | 2014-11-06 | 2015-02-25 | 哈尔滨工程大学 | 一种基于自适应中心差分卡尔曼滤波的mems捷联惯导初始对准方法 |
CN104392136A (zh) * | 2014-11-28 | 2015-03-04 | 东南大学 | 一种面向高动态非高斯模型鲁棒测量的高精度数据融合方法 |
CN105300384A (zh) * | 2015-04-03 | 2016-02-03 | 东南大学 | 一种用于卫星姿态确定的交互式滤波方法 |
CN106291645A (zh) * | 2016-07-19 | 2017-01-04 | 东南大学 | 适于高维gnss/ins深耦合的容积卡尔曼滤波方法 |
CN106793060A (zh) * | 2017-03-08 | 2017-05-31 | 哈尔滨工程大学 | 一种超宽带室内定位方法 |
CN106885569A (zh) * | 2017-02-24 | 2017-06-23 | 南京理工大学 | 一种强机动条件下的弹载深组合arckf滤波方法 |
-
2017
- 2017-08-22 CN CN201710722301.9A patent/CN107607977B/zh active Active
Patent Citations (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101187562A (zh) * | 2007-12-18 | 2008-05-28 | 哈尔滨工程大学 | 船用光纤陀螺捷联系统初始姿态确定方法 |
CN104374405A (zh) * | 2014-11-06 | 2015-02-25 | 哈尔滨工程大学 | 一种基于自适应中心差分卡尔曼滤波的mems捷联惯导初始对准方法 |
CN104392136A (zh) * | 2014-11-28 | 2015-03-04 | 东南大学 | 一种面向高动态非高斯模型鲁棒测量的高精度数据融合方法 |
CN105300384A (zh) * | 2015-04-03 | 2016-02-03 | 东南大学 | 一种用于卫星姿态确定的交互式滤波方法 |
CN106291645A (zh) * | 2016-07-19 | 2017-01-04 | 东南大学 | 适于高维gnss/ins深耦合的容积卡尔曼滤波方法 |
CN106885569A (zh) * | 2017-02-24 | 2017-06-23 | 南京理工大学 | 一种强机动条件下的弹载深组合arckf滤波方法 |
CN106793060A (zh) * | 2017-03-08 | 2017-05-31 | 哈尔滨工程大学 | 一种超宽带室内定位方法 |
Non-Patent Citations (2)
Title |
---|
姜伟南 等: "《比例UT变换的一种比例因子自适应选取方法》", 《中国空间科学技术》 * |
陈翔铭: "《高性能弹载INS/GPS组合导航滤波方法研究》", 《中国优秀硕士学位论文全文数据库 信息科技辑》 * |
Cited By (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109000642A (zh) * | 2018-05-25 | 2018-12-14 | 哈尔滨工程大学 | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 |
CN109754013A (zh) * | 2018-12-31 | 2019-05-14 | 浙江大学 | 一种基于无迹卡尔曼滤波的电力系统混合量测融合方法 |
CN110514203A (zh) * | 2019-08-30 | 2019-11-29 | 东南大学 | 一种基于isr-ukf的水下组合导航方法 |
CN114777745A (zh) * | 2022-04-08 | 2022-07-22 | 南京信息工程大学 | 一种基于无迹卡尔曼滤波的倾斜取证建模方法 |
CN116182949A (zh) * | 2023-02-23 | 2023-05-30 | 中国人民解放军91977部队 | 一种海洋环境水质监测系统及方法 |
CN116182949B (zh) * | 2023-02-23 | 2024-03-19 | 中国人民解放军91977部队 | 一种海洋环境水质监测系统及方法 |
Also Published As
Publication number | Publication date |
---|---|
CN107607977B (zh) | 2020-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN107607977A (zh) | 一种基于最小偏度单形采样的自适应ukf组合导航方法 | |
Georgy et al. | Modeling the stochastic drift of a MEMS-based gyroscope in gyro/odometer/GPS integrated navigation | |
Nassar | Improving the inertial navigation system (INS) error model for INS and INS/DGPS applications | |
CN109000642A (zh) | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 | |
CN102928858B (zh) | 基于改进扩展卡尔曼滤波的gnss单点动态定位方法 | |
CN110514203B (zh) | 一种基于isr-ukf的水下组合导航方法 | |
RU2487419C1 (ru) | Система комплексной обработки информации радионавигационных и автономных средств навигации для определения действительных значений параметров самолетовождения | |
CN109883426A (zh) | 基于因子图的动态分配与校正多源信息融合方法 | |
CN107193028A (zh) | 基于GNSS的Kalman相对定位方法 | |
CN106772524A (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN108761512A (zh) | 一种弹载bds/sins深组合自适应ckf滤波方法 | |
Atia et al. | Real-time implementation of mixture particle filter for 3D RISS/GPS integrated navigation solution | |
CN103776449B (zh) | 一种提高鲁棒性的动基座初始对准方法 | |
Sun et al. | In-motion attitude and position alignment for odometer-aided SINS based on backtracking scheme | |
CN106597507A (zh) | Gnss/sins紧组合滤波平滑的高精度快速算法 | |
CN108508463B (zh) | 基于Fourier-Hermite正交多项式扩展椭球集员滤波方法 | |
CN110779519A (zh) | 一种具有全局收敛性的水下航行器单信标定位方法 | |
CN112526569A (zh) | 一种惯导辅助卫导相对定位多历元逐级模糊度求解方法 | |
CN112902989A (zh) | 数据误差标定方法、装置、电子设备和存储介质 | |
CN111290008A (zh) | 一种动态自适应扩展卡尔曼滤波容错算法 | |
He et al. | A reduced-order model for integrated GPS/INS | |
CN112683265B (zh) | 一种基于快速iss集员滤波的mimu/gps组合导航方法 | |
Brekke et al. | Suboptimal Kalman filters for target tracking with navigation uncertainty in one dimension | |
RU2594631C1 (ru) | Способ определения углов пространственной ориентации летательного аппарата и устройство для его осуществления | |
Xu et al. | Dual‐Model Reverse CKF Algorithm in Cooperative Navigation for USV |
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 |