CN109211276A - 基于gpr与改进的srckf的sins初始对准方法 - Google Patents
基于gpr与改进的srckf的sins初始对准方法 Download PDFInfo
- Publication number
- CN109211276A CN109211276A CN201811281092.XA CN201811281092A CN109211276A CN 109211276 A CN109211276 A CN 109211276A CN 201811281092 A CN201811281092 A CN 201811281092A CN 109211276 A CN109211276 A CN 109211276A
- Authority
- CN
- China
- Prior art keywords
- error
- srckf
- state
- gpr
- sins
- 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
本发明提供了一种基于GPR与改进的SRCKF的SINS初始对准方法,首先获取各传感器数据,并对数据预处理;建立载体系统的状态方程和量测方程;采用SSR规则选取SRCKF的容积点,建立改进的SRCKF递推方程;利用改进SRCKF递推方程递推,最终递推获取载体的初始对准姿态误差角。在需要快速对准环境下,建立GPR模型;利用系统当前的量测数据,估计系统当前对准过程的姿态误差角,求解姿态矩阵以完成初始对准任务。本发明提高SRCKF的鲁棒性,增强滤波算法的数值稳定性,并能降低高阶SRCKF的计算量,加快初始对准速度且能获得与改进的SRCKF精度相当的初始对准结果。
Description
技术领域
本发明属于导航系统初始对准技术领域,一种基于高斯过程回归(Gauss ProcessRegression,GPR)与改进的平方根容积卡尔曼滤波(Square-Root Cubature KalmanFilter,SRCKF)的捷联惯性导航系统(SINS)初始对准方法。
背景技术
惯性导航系统在开始进行导航解算之前,需要进行初始对准。初始对准是惯性导航的关键技术。初始对准精度的高低很大程度上决定了导航的精度,初始对准的速度快慢一定程度上影响着导航系统的应用范围。惯性导航系统初始对准可分为粗对准和精对准,通常采用解析法、非线性滤波方法等进行粗对准,采用罗经法、非线性滤波方法等方法进行精对准。通过初始对准,获得初始姿态角,从而确定导航解算所需要的初始姿态矩阵。
在实际的应用环境中,特别是导航系统存在大失准角和剧烈晃动的环境,如行驶过程中的舰船初始对准中,工程上常使用非线性滤波方法进行初始对准。常见的非线性滤波方法有扩展卡尔曼滤波(ExtendedKalmanFilter,EKF)、无迹卡尔曼滤波(UnscentedKalmanFilter,UKF)和容积卡尔曼滤波(Cubuture Kalman Filter,CKF)以及平方根容积卡尔曼滤波(Square-Root Cubuture KalmanFilter,SRCKF)等。传统的EKF、UKF等非线性滤波方法存在对高度非线性的系统对准精度低和数值不稳定问题,CKF同样存在数值不稳定的情况,SRCKF能够改善数值不稳定的情况,但是对于模型发生变化,或者模型不准确时,SRCKF不能正确跟踪模型,且SRCKF收敛过程较慢,影响了其应用。
发明内容
为改善SRCKF应对不确定因素能力差和收敛过程较慢的缺点,本发明提供了一种基于GPR与改进的SRCKF的SINS初始对准方法,能够提高SINS适应能力,并在需要快速对准的环境下进行快速初始对准。
为了达到上述目的,本发明提供如下技术方案:
基于GPR与改进的SRCKF的SINS初始对准方法,包括如下步骤:
步骤1:建立导航系统的初始对准模型,所述对准模型包括捷联惯性导航系统的非线性误差模型、滤波模状态模型以及量测模型;
步骤2:将步骤所得的状态方程和量测方程离散化;
步骤3:在不需要快速对准的情况下,以状态方程和量测方程执行改进的SRCKF的时间更新过程,获取状态的预测估计值和预测误差协方差的平方根;
步骤4:以改进SRCKF时间更新的预测估计值和预测误差协方差的平方根为初始值进行迭代,迭代至最大次数,完成量测更新;
步骤5:由步骤4获取的状态量中提取欧拉角平台估计值和速度估计值修正SINS解算的姿态矩阵和速度,将修正后的值作为下一次SINS解算的初始值,并利用当前获得的陀螺仪和加速度计常值误差估计值修正下一时刻的陀螺仪输出和加速度计输出;
步骤6:当改进SRCKF运行一定时间后,每隔一个固定的时间间隔保存系统测量数据,构建以后需要快速对准环境下采用GPR模型算法需要的训练数据集,共保存N组数据;
步骤7:在需要快速对准的环境下,根据上一个初始对准过程中保存的训练数据集D采用GPR模型算法进行学习;同时将当前SINS实时解算的量测数据作为输入将姿态误差角作为输出,更新GPR的训练数据集进行学习,获得系统的状态转移GPR模型和量测GPR模型;再利用获得系统的状态转移GPR模型和量测GPR模型,获取系统当前对准过程的姿态误差角以及误差方差,完成系统的初始对准。
进一步的,所述步骤1具体包括如下子步骤:
步骤1.1:建立捷联惯性导航系统的非线性误差模型:
选择东-北-天坐标系地理坐标系为理想导航坐标系,以载体右前上方向构建载体坐标系,记SINS模拟解算的数学平台坐标系为n’系;记b系与n系之间的真实姿态角为b系为载体坐标系,n系为理想导航坐标系,载体相对于导航坐标系的真实速度为载体所在的真实地理坐标为p=[L λ H]T,SINS实际解算出的姿态为速度为地理坐标为记SINS解算的姿态角误差为其中φe,φn,φu分别为,纵摇角误差、横摇角误差和航向角误差;速度误差其中δve,δvn,δvu分别为东向、北向和天向速度误差,则:
n系到n’系依次旋转φu,φe,φn的坐标系转换矩阵为:
欧拉角微分方程的系数矩阵Cω为:
姿态误差微分方程为:
其中为b系下的三轴陀螺常值误差,为b系下三轴陀螺随机误差,为计算出的n系相对惯性坐标系的旋转角速度,为b系到n’系状态转移矩阵,也即SINS解算的姿态矩阵;
速度误差方程为:
其中为b系下测得的加速度计实际输出,为b系下三轴加速度计的常值误差,为b系下三轴加速度计随机误差,分别为对应的计算误差,g为重力加速度,T表示转置;
步骤1.2:建立SINS状态方程模型如下:
取状态向量为其中由于整个对准过程中近似为零,则状态方程可化为如下形式:
其中根据选取的状态量,上式速度相关的分量为设过程噪声向量为零均值高斯白噪声;地球相对惯性系的角速度ωie在n系下的投影L为载体所在的纬度,上述状态方程可记为:
其中f(x,t)为根据前面状态方程所得的函数,g(t)为根据上述系统过程噪声向量确定的系数矩阵;
步骤1.3:建立量测方程如下:
其中vb为b系下的真实速度,为b系下计算用的实际速度,SINS将转换为wz为零均值高斯白噪声过程,仅以和中的东向和北向速度误差分量作为匹配信息源;上述量测方程简记为:
z(t)=h(x,t)+wz(t)。
其中h(x,t)为根据前面量测方程所得的函数。
进一步的,所述步骤2中采样周期与滤波周期均取为Ts,本步骤将步骤1中的状态方程和量测方程离散化为:
其中xk为k时刻系统的状态量,zk为k时刻的系统状态的量测值,wx;k-1~N(0,Qk-1)为系统过程噪声,wz;k~N(0,Rk)为系统观测噪声,F(xk-1),Gk-1,H(xk-1)为将步骤1对应的方程离散化后所得的函数。
进一步的,所述步骤3中改进的SRCKF框架下时间更新的具体步骤如下:
步骤3.1:设置系统状态初始值初始误差协方差阵
P0=diag{(1°)2(1°)2(10°)2(0.1m/s)2(0.1m/s)2(0.01°/h)2
(0.01°/h)2(0.01°/h)2(100μg/h)2(100μg/h)2}
上式中°为角度单位,m/s为速度单位,h为时间单位,μg=10-6g。对上述初始误差协方差阵P0进行Cholesky分解得初始误差协方差矩阵的特征平方根S0=Chol(P0),其中Chol(·)表示矩阵的Cholesky分解;
步骤3.2:按照球面最简规则径向(SSR)容积规则选取改进SRCKF的采样点,如下:
取向量aj=[aj,1 aj,1 … aj,n]T,j=1,2,...,n+1,其中n=10为状态量的个数,有
记ξi为第i个容积点,则得到m=2(n+1)个容积点为:
步骤3.3:计算状态的一步预测值和一步预测误差协方差矩阵的平方根因子:
当前状态容积点与预测状态容积点为:
k时刻状态的一步预测值和一步预测误差协方差的平方根为:
其中S=Tria(A)表示由AT进行QR分解得到的上三角阵R'=QR(AT)的转置S=R'T,SQ,k-1为矩阵的Cholesky分解。即上式中Sk|k-1的平方根因子由
及
给出。此处Qk-1为如前面所述的系统过程噪声方差阵。
进一步的,所述步骤4中改进SRCKF框架下量测更新的过程采用迭代算法,具体步骤如下:
步骤4.1:以步骤3中得到的状态预测值和预测误差协方差Sk|k-1为迭代的初始值,记k时刻第j次迭代的状态估计值和误差协方差分别为第0次迭代的状态估计值和误差协方差,即迭代的初始值
步骤4.2:对于j=0,1,...,Nmax执行以下过程:
计算新的容积点:
按如下步骤计算k时刻第j次迭代的状态和误差协方差平方根:
计算k时刻第j次迭代的第i个预测量测容积点:
计算预测量测值:
计算新息协方差矩阵的平方根:
其中上式中的平方根因子由
及
给出;
计算估计互协方差矩阵:
其中加权中心矩阵:
估计CKF增益:
估计更新状态:
估计更新后的状态误差协方差平方根因子:
步骤4.3:迭代的终止条件为其中Δ为预先设定的迭代阈值;或迭代次数达到最大值Nmax,若未满足上述两个条件之一,则重复权利要求4的步骤;
步骤4.4:终止迭代时假设迭代次数j=N,则设置k时刻的状态估计值和状态估计误差的协方差平方根分别为:
进一步的,所述步骤4.3中当迭代方法由于不能加速新息的反馈效率而失效时,取Nmax=1,即不进行迭代。
进一步的,所述步骤5中修正公式如下:
其中,和分别为SINS解算的姿态矩阵和速度,为当前获得的陀螺仪和加速度计常值误差估计值,为下一时刻的陀螺仪输出和加速度计输出。
进一步的,所述步骤6中系统测量数据包括东向和北向速度误差,以及SINS解算的姿态误差角。
进一步的,当对准精度没有达到预定要求则循环执行执行步骤3-6直至SINS初始对准结束。
进一步的,所述步骤7中GPR模型算法具体步骤如下:
步骤7.1:在需要快速对准的环境下,根据上一个初始对准过程中保存的N组输入输出数据构成的数据训练集D进行GPR模型学习,获取系统的状态转移GPR模型和量测GPR模型,更具体的步骤为:
步骤7.1.1:其中数据训练集D={De,Dn,Du}有下述数据训练子集De={ΔV,Φe};De={ΔV,Φe}为用于估计建立东向误差角φe的GPR模型采用的数据训练集,其中ΔV=[Δv1Δv2 … ΔvN]T,Δvκ=(δveκ,δvnκ)T∈R2(κ=1,...,N)为保存的所有N组量测(δve,δvn)中的第κ组;Φe=[φe1 φe2 … φeN]T,φeκ∈R(κ=1,...,N)为保存的N个东向误差角中的第κ组;针对东北天三个方向的姿态误差角φe,φn,φu相应有输出向量Φe,Φn,Φu共保存了3N个姿态误差角数据,共有三个数据训练子集De,Dn,Du;
步骤7.1.2:根据步骤7.1.1的数据集进行GPR模型学习,初始化GPR模型:采用高斯核函数作为GPR模型的初始化核函数:
式中Δvp,Δvq为数据训练集量测ΔV中的任意元素,为信号方差,l1,l2为信号方差;上述未知参数集记为超参数其中为数据训练集的样本噪声方差;
步骤7.1.3:建立东向姿态误差角的GPR模型:以量测ΔV和东向姿态误差角Φe=[φe1 φe2 … φeN]构成的数据训练集De=(ΔV,Φe)作为GPR模型的输入输出对建立训练样本条件函数p(Θe|ΔVκ,Θκ)的对数似然函数:
式中K=K(ΔV,ΔV)={k(Δvp,Δvq)|p,q=1,...,N}为N×N阶对称正定协方差矩阵,K(p,q)=k(Δvp,Δvq)度量了Δvp,Δvq的相关性;
通过最大化似然函数求取超参数超参数,即对似然函数求偏导:
其中α=E-1Φe,tr(·)为求矩阵迹运算,Θi表示中的第i=1,2,3个元素,K(ΔV,ΔV)为前面定义的协方差矩阵;
采用共轭梯度法对上述偏导数进行最小化,从而得到超参数的最优解;
步骤7.1.4:针对三个姿态误差角,重复以上步骤分别获得相应参数;
步骤7.2:在当前对准过程中,利用改进的SRCKF获取当前时刻的量测值Δv*,对系统实时的量测与截止至前一时刻的姿态误差角输出更新训练数据集D,根据GPR模型获取当前量测Δv*下的姿态误差角及其误差方差,进行SINS初始对准,获取系统当前对准过程的姿态误差角以及相应的误差方差;具体的步骤如下:
步骤7.2.1:由高斯过程回归模型中数据训练集的输出矢量Φe和预测值φe *之间满足:
其中
K(Δv*,ΔV)=K(ΔV,Δv*)T=(k(Δv*,Δv1),...,k(Δv*,ΔvN))T,k(Δv*,Δvi)(i=1,...,N)为当前量测值Δv*与训练数据集中的量测值Δvi的协方差,k(Δv*,Δv*)为实时量测值的自协方差;由此得出在当前时刻量测值Δv*下的预测估计输出值φe *的均值和协方差如下:
由此可以完成当前对准过程姿态误差角φe的估计;
步骤7.2.2:对于其他两个姿态误差角φn,φu,通过上述步骤,获取其当前对准过程中的估计均值和相应的误差方差从而完成SINS初始对准过程。
与现有技术相比,本发明具有如下优点和有益效果:
1.本发明将球面最简径向容积规则SSR融入平方根容积卡尔曼滤波算法,提高SRCKF的鲁棒性,增强滤波算法的数值稳定性,并能降低高阶SRCKF的计算量。
2.本发明在SRCKF的量测更新阶段采用迭代算法,当量测方程为非线性方程时,能够提高新息的反馈效率,加快SRCKF的收敛过程。
3.本发明依据对准环境的不同,在需要以对准精度作为绝对的考虑因素的情况下采用改进的SRCKF算法,着重降低初始对准结果误差;而在需要提高初始对准速度的环境下,采用高斯过程回归与改进的SRCKF相融合的方式,加快初始对准速度且能获得与改进的SRCKF精度相当的初始对准结果。
附图说明
图1为本发明提供的基于GPR与改进的SRCKF的SINS初始对准方法整体流程图。
图2为图1中改进的SRCKF模型算法流程图。
图3为图1中GPR融入改进的SRCKF模型算法流程图。
具体实施方式
以下将结合具体实施例对本发明提供的技术方案进行详细说明,应理解下述具体实施方式仅用于说明本发明而不用于限制本发明的范围。
本发明提供的基于GPR与改进的SRCKF的SINS初始对准方法,首先获取各传感器数据,并对数据预处理;建立载体系统的状态方程和量测方程;采用SSR规则选取SRCKF的容积点,建立改进的SRCKF递推方程;利用改进SRCKF递推方程递推,最终递推获取载体的初始对准姿态误差角。在需要快速对准环境下,建立GPR模型;利用系统当前的量测数据,估计系统当前对准过程的姿态误差角,求解姿态矩阵以完成初始对准任务。
由于获取数据及预处理过程较为常规,不属于本发明重点,因此本实施例着重对后续步骤进行详细描述,具体的说,本发明整体流程如图1所示,包括以下步骤:
步骤1:建立导航系统的初始对准模型,所述对准模型包括捷联惯性导航系统(SINS)的非线性误差模型、滤波模状态模型以及量测模型。
步骤1.1:其中捷联惯性导航系统的非线性误差模型通过如下过程建立:
选择东-北-天坐标系地理坐标系(g系)为理想导航坐标系(n系),以载体右前上方向构建载体坐标系(b系),记SINS模拟解算的数学平台坐标系为n’系;记b系与n系之间的真实姿态角为载体相对于导航坐标系的真实速度为载体所在的真实地理坐标为p=[L λ H]T,SINS实际解算出的姿态为速度为地理坐标为由于受到各种误差源的影响,SINS的解算值与真实值之间存在误差,记SINS解算的姿态角误差为其中φe,φn,φu分别为,纵摇角误差(东向水平失准角)、横摇角误差(北向水平失准角)和航向角误差(方位失准角);速度误差其中δve,δvn,δvu分别为东向、北向和天向速度误差,则:
n系到n’系依次旋转φe,φn,φu的坐标系转换矩阵为:
欧拉角微分方程的系数矩阵Cω为:
姿态误差微分方程为:
其中为b系下的三轴陀螺常值误差,为b系下三轴陀螺随机误差,为计算出的n系相对惯性坐标系的旋转角速度,为b系到n’系状态转移矩阵,也即SINS解算的姿态矩阵。
速度误差方程为:
其中为b系下测得的加速度计实际输出,为b系下三轴加速度计的常值误差,为b系下三轴加速度计随机误差,分别为对应的计算误差,g为重力加速度,T表示转置。
步骤1.2:所述SINS状态方程模型如下:
取状态向量为其中由于整个对准过程中近似为零,则状态方程可化为如下形式:
其中根据选取的状态量,上式速度相关的分量为设过程噪声向量为零均值高斯白噪声;地球相对惯性系的角速度ωie在n系下的投影L为载体所在的纬度,上述状态方程可记为:
其中f(x,t)为根据前面状态方程所得的函数,g(t)为根据上述系统过程噪声向量确定的系数矩阵。
步骤1.3:所述量测方程如下:
其中vb为b系下的真实速度,为b系下计算用的实际速度,SINS将转换为wz为零均值高斯白噪声过程,仅以和中的东向和北向速度误差分量作为匹配信息源。上述量测方程简记为:
z(t)=h(x,t)+wz(t)
其中h(x,t)为根据前面量测方程所得的函数。
步骤2:将步骤所得的状态方程和量测方程离散化。其中采样周期与滤波周期均取为Ts,步骤1中的状态方程和量测方程离散化为
其中xk为k时刻系统的状态量,zk为k时刻的系统状态的量测值,wx;k-1~N(0,Qk-1)为系统过程噪声,wz;k~N(0,Rk)为系统观测噪声,F(xk-1),Gk-1,H(xk-1)为将步骤1对应的方程离散化后所得的函数。
步骤3:在不需要快速对准的情况下,以状态方程和量测方程执行改进的SRCKF的时间更新过程,获取状态的预测估计值和预测误差协方差的平方根Sk|k-1。
改进的SRCKF框架下时间更新的具体步骤如下:
步骤3.1:设置系统状态初始值初始误差协方差阵
P0=diag{(1°)2(1°)2(10°)2(0.1m/s)2(0.1m/s)2(0.01°/h)2
(0.01°/h)2(0.01°/h)2(100μg/h)2(100μg/h)2}
上式中°为角度单位,m/s为速度单位,h为时间单位,μg=10-6g。对上述初始误差协方差阵P0进行Cholesky分解得初始误差协方差矩阵的特征平方根S0=Chol(P0),其中Chol(·)表示矩阵的Cholesky分解。
步骤3.2:按照球面最简规则径向(SSR)容积规则选取改进SRCKF的采样点,如下:
取向量aj=[aj,1 aj,1 … aj,n]T,j=1,2,...,n+1,其中n=10为状态量的个数,有
记ξi为第i个容积点,则得到m=2(n+1)个容积点为:
步骤3.3:计算状态的一步预测值和一步预测误差协方差矩阵的平方根因子:
当前状态容积点与预测状态容积点为:
k时刻状态的一步预测值和一步预测误差协方差的平方根为:
其中S=Tria(A)表示由AT进行QR分解得到的上三角阵R'=QR(AT)的转置S=R'T,SQ,k-1为矩阵的Cholesky分解。即上式中Sk|k-1的平方根因子由
及
给出,其中Qk-1为系统过程噪声方差阵。
步骤4:以改进SRCKF时间更新的预测估计值和预测误差协方差的平方根Sk|k-1为初始值进行迭代,迭代至最大次数Nmax,完成量测更新。
改进SRCKF框架下量测更新的过程采用迭代算法,具体步骤如下:
步骤4.1:以步骤3中得到的状态预测值和预测误差协方差Sk|k-1为迭代的初始值,记k时刻第j次迭代的状态估计值和误差协方差分别为第0次迭代的状态估计值和误差协方差,即迭代的初始值
步骤4.2:对于j=0,1,...,Nmax执行以下过程:
计算新的容积点:
按如下步骤计算k时刻第j次迭代的状态和误差协方差平方根:
计算k时刻第j次迭代的第i个预测量测容积点:
计算预测量测值:
计算新息协方差矩阵的平方根:
其中上式中的平方根因子由
及
给出。
计算估计互协方差矩阵:
其中加权中心矩阵:
估计CKF增益:
估计更新状态:
估计更新后的状态误差协方差平方根因子:
步骤4.3:迭代的终止条件为其中Δ为预先设定的迭代阈值;或迭代次数达到最大值Nmax,若未满足上述两个条件之一,则重复权利要求4的步骤。在具体应用中,可能因初始对准量测采用速率误差、位置误差为观测量时量测方程为线性方程,使上述迭代方法由于不能加速新息的反馈效率而失效,可取Nmax=1,即不进行迭代。
步骤4.4:终止迭代时假设迭代次数j=N,则设置k时刻的状态估计值和状态估计误差的协方差平方根分别为:
步骤5:由前面步骤4获取的状态量中提取欧拉角平台估计值和速度估计值修正SINS解算的姿态矩阵和速度将修正后的值作为下一次SINS解算的初始值,并利用当前获得的陀螺仪和加速度计常值误差估计值修正下一时刻的陀螺仪输出和加速度计输出修正公式如下:
步骤6:当改进SRCKF运行一定时间后,每隔一个固定的时间间隔保存系统测量数据,即东向和北向速度误差等,以及SINS解算的姿态误差角,构建以后需要快速对准环境下采用GPR模型算法需要的训练数据集,共保存N组数据。根据步骤4过程,如果对准精度没有达到预定要求则循环执行执行步骤3-6直至SINS初始对准结束。
步骤7:在需要快速对准的环境下,根据上一个初始对准过程中保存的训练数据集D采用GPR模型算法进行学习;同时将当前SINS实时解算的量测数据作为输入将姿态误差角作为输出,更新GPR的训练数据集进行学习,获得系统的状态转移GPR模型和量测GPR模型;再利用获得系统的状态转移GPR模型和量测GPR模型,获取系统当前对准过程的姿态误差角以及误差方差,完成系统的初始对准。
其中,GPR模型算法具体步骤如下:
步骤7.1:在需要快速对准的环境下,根据上一个初始对准过程中保存的N组输入输出数据构成的数据训练集D进行GPR模型学习,获取系统的状态转移GPR模型和量测GPR模型。更具体的步骤为:
步骤7.1.1:其中数据训练集D={De,Dn,Du}有下述数据训练子集De={ΔV,Φe};De={ΔV,Φe}为用于估计建立东向误差角φe的GPR模型采用的数据训练集,其中ΔV=[Δv1Δv2 … ΔvN]T,Δvκ=(δveκ,δvnκ)T∈R2(κ=1,...,N)为保存的所有N组量测(δve,δvn)中的第κ组;Φe=[φe1 φe2 … φeN]T,φeκ∈R(κ=1,...,N)为保存的N个东向误差角中的第κ组。针对东北天三个方向的姿态误差角φe,φn,φu相应有输出向量Φe,Φn,Φu共保存了3N个姿态误差角数据,共有三个数据训练子集De,Dn,Du。
步骤7.1.2:根据步骤7.1.1的数据集进行GPR模型学习,初始化GPR模型:采用高斯核函数作为GPR模型的初始化核函数:
式中Δvp,Δvq为数据训练集量测ΔV中的任意元素,为信号方差,l1,l2为信号方差;上述未知参数集记为超参数其中为数据训练集的样本噪声方差。
步骤7.1.3:以下以建立东向姿态误差角的GPR模型进行说明。以量测ΔV和东向姿态误差角Φe=[φe1 φe2 … φeN]构成的数据训练集De=(ΔV,Φe)作为GPR模型的输入输出对建立训练样本条件函数p(Θe|ΔVκ,Θκ)的对数似然函数:
式中K=K(ΔV,ΔV)={k(Δvp,Δvq)|p,q=1,...,N}为N×N阶对称正定协方差矩阵,K(p,q)=k(Δvp,Δvq)度量了Δvp,Δvq的相关性。
通过最大化似然函数求取超参数超参数,即对似然函数求偏导:
其中α=E-1Φe,tr(·)为求矩阵迹运算,Θi表示中的第i=1,2,3个元素,K(ΔV,ΔV)为前面定义的协方差矩阵。
采用共轭梯度法对上述偏导数进行最小化,从而得到超参数的最优解。
步骤7.1.4:针对三个姿态误差角,重复以上步骤可以分别获得相应参数。以上步骤可以在当前初始对准过程之前完成。
步骤7.2:在当前对准过程中,利用改进的SRCKF获取当前时刻的量测值Δv*,对系统实时的量测与截止至前一时刻的姿态误差角输出更新训练数据集D,根据GPR模型获取当前量测Δv*下的姿态误差角及其误差方差,进行SINS初始对准,获取系统当前对准过程的姿态误差角以及相应的误差方差。具体的步骤如下:
步骤7.2.1:由高斯过程回归模型中数据训练集的输出矢量Φe和预测值φe *之间满足:
其中
K(Δv*,ΔV)=K(ΔV,Δv*)T=(k(Δv*,Δv1),...,k(Δv*,ΔvN))T,k(Δv*,Δvi)(i=1,...,N)为当前量测值Δv*与训练数据集中的量测值Δvi的协方差,k(Δv*,Δv*)为实时量测值的自协方差。由此可以得出在当前时刻量测值Δv*下的预测估计输出值φe *的均值和协方差如下:
由此可以完成当前对准过程姿态误差角φe的估计。
步骤7.2.2:对于其他两个姿态误差角φn,φu,可以类似上述步骤,获取其当前对准过程中的估计均值和相应的误差方差从而完成SINS初始对准过程。
通过以上方法,本发明能够增强SRCKF的鲁棒性,并减少高阶SSRCKF的计算量,在需要快速对准的环境下能快速获取较准确的初始对准姿态误差角。
本发明方案所公开的技术手段不仅限于上述实施方式所公开的技术手段,还包括由以上技术特征任意组合所组成的技术方案。应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下,还可以做出若干改进和润饰,这些改进和润饰也视为本发明的保护范围。
Claims (10)
1.基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,包括如下步骤:
步骤1:建立导航系统的初始对准模型,所述对准模型包括捷联惯性导航系统的非线性误差模型、滤波模状态模型以及量测模型;
步骤2:将步骤所得的状态方程和量测方程离散化;
步骤3:在不需要快速对准的情况下,以状态方程和量测方程执行改进的SRCKF的时间更新过程,获取状态的预测估计值和预测误差协方差的平方根;
步骤4:以改进SRCKF时间更新的预测估计值和预测误差协方差的平方根为初始值进行迭代,迭代至最大次数,完成量测更新;
步骤5:由步骤4获取的状态量中提取欧拉角平台估计值和速度估计值修正SINS解算的姿态矩阵和速度,将修正后的值作为下一次SINS解算的初始值,并利用当前获得的陀螺仪和加速度计常值误差估计值修正下一时刻的陀螺仪输出和加速度计输出;
步骤6:当改进SRCKF运行一定时间后,每隔一个固定的时间间隔保存系统测量数据,构建以后需要快速对准环境下采用GPR模型算法需要的训练数据集,共保存N组数据;
步骤7:在需要快速对准的环境下,根据上一个初始对准过程中保存的训练数据集D采用GPR模型算法进行学习;同时将当前SINS实时解算的量测数据作为输入将姿态误差角作为输出,更新GPR的训练数据集进行学习,获得系统的状态转移GPR模型和量测GPR模型;再利用获得系统的状态转移GPR模型和量测GPR模型,获取系统当前对准过程的姿态误差角以及误差方差,完成系统的初始对准。
2.根据权利要求1所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤1具体包括如下子步骤:
步骤1.1:建立捷联惯性导航系统的非线性误差模型:
选择东-北-天坐标系地理坐标系为理想导航坐标系,以载体右前上方向构建载体坐标系,记SINS模拟解算的数学平台坐标系为n’系;记b系与n系之间的真实姿态角为b系为载体坐标系,n系为理想导航坐标系,载体相对于导航坐标系的真实速度为载体所在的真实地理坐标为p=[L λ H]T,SINS实际解算出的姿态为速度为地理坐标为记SINS解算的姿态角误差为其中φe,φn,φu分别为,纵摇角误差、横摇角误差和航向角误差;速度误差其中δve,δvn,δvu分别为东向、北向和天向速度误差,则:
n系到n’系依次旋转φu,φe,φn的坐标系转换矩阵为:
欧拉角微分方程的系数矩阵Cω为:
姿态误差微分方程为:
其中为b系下的三轴陀螺常值误差,为b系下三轴陀螺随机误差,为计算出的n系相对惯性坐标系的旋转角速度,为b系到n’系状态转移矩阵,也即SINS解算的姿态矩阵;
速度误差方程为:
其中为b系下测得的加速度计实际输出,为b系下三轴加速度计的常值误差,为b系下三轴加速度计随机误差,分别为对应的计算误差,g为重力加速度,T表示转置;
步骤1.2:建立SINS状态方程模型如下:
取状态向量为其中由于整个对准过程中近似为零,则状态方程可化为如下形式:
其中根据选取的状态量,上式速度相关的分量为设过程噪声向量为零均值高斯白噪声;地球相对惯性系的角速度ωie在n系下的投影L为载体所在的纬度,上述状态方程可记为:
其中f(x,t)为根据前面状态方程所得的函数,g(t)为根据上述系统过程噪声向量确定的系数矩阵;
步骤1.3:建立量测方程如下:
其中vb为b系下的真实速度,为b系下计算用的实际速度,SINS将转换为wz为零均值高斯白噪声过程,仅以和中的东向和北向速度误差分量作为匹配信息源;上述量测方程简记为:
z(t)=h(x,t)+wz(t)
其中h(x,t)为根据前面量测方程所得的函数。
3.根据权利要求2所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤2中采样周期与滤波周期均取为Ts,本步骤将步骤1中的状态方程和量测方程离散化为:
其中xk为k时刻系统的状态量,zk为k时刻的系统状态的量测值,wx;k-1~N(0,Qk-1)为系统过程噪声,wz;k~N(0,Rk)为系统观测噪声,F(xk-1),Gk-1,H(xk-1)为将步骤1对应的方程离散化后所得的函数。
4.根据权利要求3所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤3中改进的SRCKF框架下时间更新的具体步骤如下:
步骤3.1:设置系统状态初始值初始误差协方差阵
P0=diag{(1°)2(1°)2(10°)2(0.1m/s)2(0.1m/s)2(0.01°/h)2
(0.01°/h)2(0.01°/h)2(100μg/h)2(100μg/h)2}
上式中°为角度单位,m/s为速度单位,h为时间单位,μg=10-6g;对上述初始误差协方差阵P0进行Cholesky分解得初始误差协方差矩阵的特征平方根S0=Chol(P0),其中Chol(·)表示矩阵的Cholesky分解;
步骤3.2:按照球面最简规则径向(SSR)容积规则选取改进SRCKF的采样点,如下:
取向量aj=[aj,1 aj,1 … aj,n]T,j=1,2,...,n+1,其中n=10为状态量的个数,有
记ξi为第i个容积点,则得到m=2(n+1)个容积点为:
步骤3.3:计算状态的一步预测值和一步预测误差协方差矩阵的平方根因子:
当前状态容积点与预测状态容积点为:
k时刻状态的一步预测值和一步预测误差协方差的平方根为:
其中S=Tria(A)表示由AT进行QR分解得到的上三角阵R'=QR(AT)的转置S=R'T,SQ,k-1为矩阵的Cholesky分解;即上式中Sk|k-1的平方根因子由
及
给出,其中Qk-1为系统过程噪声方差阵。
5.根据权利要求4所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤4中改进SRCKF框架下量测更新的过程采用迭代算法,具体步骤如下:
步骤4.1:以步骤3中得到的状态预测值和预测误差协方差Sk|k-1为迭代的初始值,记k时刻第j次迭代的状态估计值和误差协方差分别为第0次迭代的状态估计值和误差协方差,即迭代的初始值
步骤4.2:对于j=0,1,...,Nmax执行以下过程:
计算新的容积点:
按如下步骤计算k时刻第j次迭代的状态和误差协方差平方根:
计算k时刻第j次迭代的第i个预测量测容积点:
计算预测量测值:
计算新息协方差矩阵的平方根:
其中上式中的平方根因子由
及
给出;
计算估计互协方差矩阵:
其中加权中心矩阵:
估计CKF增益:
估计更新状态:
估计更新后的状态误差协方差平方根因子:
步骤4.3:迭代的终止条件为其中Δ为预先设定的迭代阈值;或迭代次数达到最大值Nmax,若未满足上述两个条件之一,则重复权利要求4的步骤;
步骤4.4:终止迭代时假设迭代次数j=N,则设置k时刻的状态估计值和状态估计误差的协方差平方根分别为:
6.根据权利要求5所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤4.3中当迭代方法由于不能加速新息的反馈效率而失效时,取Nmax=1,即不进行迭代。
7.根据权利要求5所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤5中修正公式如下:
其中,和分别为SINS解算的姿态矩阵和速度,为当前获得的陀螺仪和加速度计常值误差估计值,为下一时刻的陀螺仪输出和加速度计输出。
8.根据权利要求1所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤6中系统测量数据包括东向和北向速度误差,以及SINS解算的姿态误差角。
9.根据权利要求1所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,当对准精度没有达到预定要求则循环执行执行步骤3-6直至SINS初始对准结束。
10.根据权利要求7所述的基于GPR与改进的SRCKF的SINS初始对准方法,其特征在于,所述步骤7中GPR模型算法具体步骤如下:
步骤7.1:在需要快速对准的环境下,根据上一个初始对准过程中保存的N组输入输出数据构成的数据训练集D进行GPR模型学习,获取系统的状态转移GPR模型和量测GPR模型,更具体的步骤为:
步骤7.1.1:其中数据训练集D={De,Dn,Du}有下述数据训练子集De={ΔV,Φe};De={ΔV,Φe}为用于估计建立东向误差角φe的GPR模型采用的数据训练集,其中ΔV=[Δv1Δv2 … ΔvN]T,Δvκ=(δveκ,δvnκ)T∈R2(κ=1,...,N)为保存的所有N组量测(δve,δvn)中的第κ组;Φe=[φe1 φe2 … φeN]T,φeκ∈R(κ=1,...,N)为保存的N个东向误差角中的第κ组;针对东北天三个方向的姿态误差角φe,φn,φu相应有输出向量Φe,Φn,Φu共保存了3N个姿态误差角数据,共有三个数据训练子集De,Dn,Du;
步骤7.1.2:根据步骤7.1.1的数据集进行GPR模型学习,初始化GPR模型:采用高斯核函数作为GPR模型的初始化核函数:
式中Δvp,Δvq为数据训练集量测ΔV中的任意元素,为信号方差,l1,l2为信号方差;上述未知参数集记为超参数其中为数据训练集的样本噪声方差;
步骤7.1.3:建立东向姿态误差角的GPR模型:以量测ΔV和东向姿态误差角Φe=[φe1φe2 … φeN]构成的数据训练集De=(ΔV,Φe)作为GPR模型的输入输出对建立训练样本条件函数p(Θe|ΔVκ,Θκ)的对数似然函数:
式中K=K(ΔV,ΔV)={k(Δvp,Δvq)|p,q=1,...,N}为N×N阶对称正定协方差矩阵,K(p,q)=k(Δvp,Δvq)度量了Δvp,Δvq的相关性;
通过最大化似然函数求取超参数超参数,即对似然函数求偏导:
其中α=E-1Φe,tr(·)为求矩阵迹运算,Θi表示中的第i=1,2,3个元素,K(ΔV,ΔV)为前面定义的协方差矩阵;
采用共轭梯度法对上述偏导数进行最小化,从而得到超参数的最优解;
步骤7.1.4:针对三个姿态误差角,重复以上步骤分别获得相应参数;
步骤7.2:在当前对准过程中,利用改进的SRCKF获取当前时刻的量测值Δv*,对系统实时的量测与截止至前一时刻的姿态误差角输出更新训练数据集D,根据GPR模型获取当前量测Δv*下的姿态误差角及其误差方差,进行SINS初始对准,获取系统当前对准过程的姿态误差角以及相应的误差方差;具体的步骤如下:
步骤7.2.1:由高斯过程回归模型中数据训练集的输出矢量Φe和预测值φe *之间满足:
其中
K(Δv*,ΔV)=K(ΔV,Δv*)T=(k(Δv*,Δv1),...,k(Δv*,ΔvN))T,k(Δv*,Δvi)(i=1,...,N)为当前量测值Δv*与训练数据集中的量测值Δvi的协方差,k(Δv*,Δv*)为实时量测值的自协方差;由此得出在当前时刻量测值Δv*下的预测估计输出值φe *的均值和协方差如下:
由此可以完成当前对准过程姿态误差角φe的估计;
步骤7.2.2:对于其他两个姿态误差角φn,φu,通过上述步骤,获取其当前对准过程中的估计均值和相应的误差方差从而完成SINS初始对准过程。
Priority Applications (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811281092.XA CN109211276B (zh) | 2018-10-30 | 2018-10-30 | 基于gpr与改进的srckf的sins初始对准方法 |
PCT/CN2019/079137 WO2020087845A1 (zh) | 2018-10-30 | 2019-03-21 | 基于gpr与改进的srckf的sins初始对准方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201811281092.XA CN109211276B (zh) | 2018-10-30 | 2018-10-30 | 基于gpr与改进的srckf的sins初始对准方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109211276A true CN109211276A (zh) | 2019-01-15 |
CN109211276B CN109211276B (zh) | 2022-06-03 |
Family
ID=64998177
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201811281092.XA Active CN109211276B (zh) | 2018-10-30 | 2018-10-30 | 基于gpr与改进的srckf的sins初始对准方法 |
Country Status (2)
Country | Link |
---|---|
CN (1) | CN109211276B (zh) |
WO (1) | WO2020087845A1 (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109974698A (zh) * | 2019-04-10 | 2019-07-05 | 清华大学深圳研究生院 | 一种室内物流小车定位方法和终端设备 |
CN110186480A (zh) * | 2019-05-30 | 2019-08-30 | 北京航天控制仪器研究所 | 一种惯性器件线性系统误差系数确定方法 |
WO2020087845A1 (zh) * | 2018-10-30 | 2020-05-07 | 东南大学 | 基于gpr与改进的srckf的sins初始对准方法 |
CN114370867A (zh) * | 2022-01-11 | 2022-04-19 | 中国科学院长春光学精密机械与物理研究所 | 一种高动态星敏感器的姿态优化方法 |
CN117235540A (zh) * | 2023-08-21 | 2023-12-15 | 江西农业大学 | 基于特征匹配融合的传感器动态信息联动分析方法 |
Families Citing this family (45)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113836480B (zh) * | 2020-06-23 | 2024-01-12 | 中核武汉核电运行技术股份有限公司 | 一种基于高斯过程回归的换热器效率预测方法 |
CN111709192B (zh) * | 2020-07-07 | 2024-03-01 | 江苏科技大学 | 一种基于半监督学习的平面倒f型天线谐振频率预测方法 |
CN111767658A (zh) * | 2020-07-10 | 2020-10-13 | 南通大学 | 一种用于组合导航系统的快速故障检测方法 |
CN112199814B (zh) * | 2020-08-18 | 2023-03-10 | 同济大学 | 测量系统的系统误差自检校方法、装置、设备和介质 |
CN112346104B (zh) * | 2020-09-11 | 2023-08-08 | 中国人民解放军国防科技大学 | 一种无人机信息融合定位方法 |
CN112462405B (zh) * | 2020-10-20 | 2024-05-14 | 和芯星通科技(北京)有限公司 | 一种导航系统初始化方法和导航系统 |
CN112611378B (zh) * | 2020-10-26 | 2022-12-20 | 西安航天精密机电研究所 | 一种基于四环惯导平台的载体姿态角速度测量方法 |
CN112344964B (zh) * | 2020-11-13 | 2023-03-07 | 中国船舶重工集团公司第七0七研究所 | 一种捷联惯导系统载体航迹仿真设计方法 |
CN112733284B (zh) * | 2020-12-22 | 2022-12-27 | 长春工程学院 | 一种汽车线束波纹管波峰切割定位信息融合方法 |
CN112729348B (zh) * | 2021-01-10 | 2023-11-28 | 河南理工大学 | 一种用于imu系统的姿态自适应校正方法 |
CN112902967A (zh) * | 2021-01-31 | 2021-06-04 | 南京理工大学 | 一种基于残差卡方-改进序贯概率比的抗欺骗导航方法 |
CN113031645B (zh) * | 2021-02-09 | 2022-12-09 | 陕西中天火箭技术股份有限公司 | 一种基于ukf滤波的弹体角速率增稳捷联制导方法 |
CN113074753A (zh) * | 2021-03-19 | 2021-07-06 | 南京天巡遥感技术研究院有限公司 | 一种星敏感器陀螺联合定姿方法、联合定姿系统及应用 |
CN113252041B (zh) * | 2021-05-11 | 2022-10-14 | 大连理工大学 | 一种适用于小型水下机器人的组合导航方法 |
CN113466848B (zh) * | 2021-05-22 | 2023-09-19 | 中国人民解放军空军工程大学 | 一种面向角闪烁噪声场景的共址mimo雷达多目标跟踪资源优化分配方法 |
CN113720320B (zh) * | 2021-08-03 | 2022-11-18 | 哈尔滨工程大学 | 一种基于高斯过程回归的信息更新频率提升方法 |
CN113670335B (zh) * | 2021-08-18 | 2023-10-24 | 河海大学 | 基于dvl辅助和向量截断化k矩阵的水下载体初始对准方法 |
CN113916220B (zh) * | 2021-08-30 | 2023-06-23 | 西北工业大学 | 一种具有协方差反馈控制的动态自适应导航定位方法 |
CN113850425B (zh) * | 2021-09-18 | 2024-07-09 | 三峡大学 | 基于改进的广义极大似然估计的配电网状态估计方法 |
CN114216463B (zh) * | 2021-11-04 | 2024-05-28 | 国家电网有限公司 | 一种路径优化目标定位方法及装置、存储介质、无人设备 |
CN114166203B (zh) * | 2021-11-16 | 2024-02-09 | 哈尔滨工程大学 | 一种基于改进的s-h自适应联邦滤波的智能水下机器人多源组合导航方法 |
CN114061575B (zh) * | 2021-11-26 | 2024-06-14 | 上海机电工程研究所 | 大失准角条件下的导弹姿态角精对准方法及系统 |
CN114200959B (zh) * | 2021-11-30 | 2024-02-27 | 稞米科技(深圳)有限公司 | 一种融合高斯过程的飞行器轨迹控制方法 |
CN114462682B (zh) * | 2022-01-11 | 2024-04-30 | 东南大学 | 一种顾及数据时效的沉降预测模型建模方法 |
CN114462684B (zh) * | 2022-01-12 | 2024-06-07 | 东南大学 | 耦合数值天气预报与实测数据的风速多点同步预测方法 |
CN114445459B (zh) * | 2022-01-16 | 2024-04-09 | 中国人民解放军空军工程大学 | 基于变分贝叶斯理论的连续-离散最大相关熵目标跟踪方法 |
CN114492030B (zh) * | 2022-01-25 | 2023-03-24 | 哈尔滨工业大学 | 基于实测数据回放的水下无人机导航算法调试系统 |
CN114577204B (zh) * | 2022-02-09 | 2024-01-02 | 中科禾华(扬州)光电科技有限公司 | 基于神经网络的捷联惯导系统抗干扰自对准方法和装置 |
CN114812569A (zh) * | 2022-04-19 | 2022-07-29 | 中国人民解放军国防科技大学 | 一种追逃博弈机动航天器相对状态估计方法、装置和设备 |
CN115033844A (zh) * | 2022-05-12 | 2022-09-09 | 合肥赛为智能有限公司 | 一种无人机状态估计方法、系统、设备及可读存储介质 |
CN114896801B (zh) * | 2022-05-24 | 2024-07-09 | 河南科技大学 | 一种考虑状态增量的关节轴承剩余寿命预测方法 |
CN114705177B (zh) * | 2022-06-07 | 2022-08-30 | 西安晟昕科技发展有限公司 | 一种基于误差分析的光纤陀螺测姿数据处理方法 |
CN115099599B (zh) * | 2022-06-17 | 2024-04-30 | 东南大学 | 一种面向公交信号优先控制的测试评价方法 |
CN115096332B (zh) * | 2022-06-17 | 2024-06-14 | 西安微电子技术研究所 | 一种大角度范围的高精度垂直发射对准方法、设备及介质 |
CN115096321A (zh) * | 2022-06-23 | 2022-09-23 | 中国人民解放军63921部队 | 一种车载捷联惯导系统鲁棒无迹信息滤波对准方法及系统 |
CN115077566B (zh) * | 2022-07-27 | 2022-11-18 | 中国船舶重工集团公司第七0七研究所 | 惯性导航系统解算方法 |
CN115077520B (zh) * | 2022-08-22 | 2022-11-01 | 中国船舶重工集团公司第七0七研究所 | 一种基于谐振惯导系统的姿态补偿方法 |
CN115358319B (zh) * | 2022-08-23 | 2023-06-16 | 天津大学 | 基于双阈值检测的自适应容错滤波方法及系统 |
CN115436980B (zh) * | 2022-09-01 | 2024-06-25 | 广东电网有限责任公司 | 一种基于软件定义的bd3一体化集成装置及定位方法 |
CN115727842B (zh) * | 2022-11-04 | 2024-07-05 | 中山大学 | 一种无人机快速对准方法、系统、计算机设备及存储介质 |
CN115574817B (zh) * | 2022-12-08 | 2023-03-31 | 中国人民解放军国防科技大学 | 一种基于三轴旋转式惯导系统的导航方法及导航系统 |
CN116147624B (zh) * | 2022-12-21 | 2023-08-01 | 广东智能无人系统研究院(南沙) | 一种基于低成本mems航姿参考系统的船舶运动姿态解算方法 |
CN115773751B (zh) * | 2023-02-13 | 2023-07-18 | 中国航空工业集团公司西安飞行自动控制研究所 | 一种修正等效天向加计零位造成对准误差的方法 |
CN117073719B (zh) * | 2023-08-02 | 2024-01-30 | 南京理工大学 | 一种接力式快速空中对准方法 |
CN117889868B (zh) * | 2024-03-18 | 2024-06-14 | 西安现代控制技术研究所 | 一种融合红外导引头信息的导弹位置精确估计方法 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103759742A (zh) * | 2014-01-22 | 2014-04-30 | 东南大学 | 基于模糊自适应控制技术的捷联惯导非线性对准方法 |
CN104655131A (zh) * | 2015-02-06 | 2015-05-27 | 东南大学 | 基于istssrckf的惯性导航初始对准方法 |
CN105424036A (zh) * | 2015-11-09 | 2016-03-23 | 东南大学 | 一种低成本水下潜器地形辅助惯性组合导航定位方法 |
CN106840211A (zh) * | 2017-03-24 | 2017-06-13 | 东南大学 | 一种基于kf和stupf组合滤波的sins大方位失准角初始对准方法 |
US20180274940A1 (en) * | 2015-10-13 | 2018-09-27 | Shanghai Huace Navigation Technology Ltd | A method for initial alignment of an inertial navigation apparatus |
Family Cites Families (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103217175B (zh) * | 2013-04-10 | 2015-09-30 | 哈尔滨工程大学 | 一种自适应容积卡尔曼滤波方法 |
CN105842732B (zh) * | 2016-03-16 | 2018-03-23 | 中国石油大学(北京) | 多道稀疏反射系数的反演方法及系统 |
FR3058229B1 (fr) * | 2016-10-27 | 2020-02-28 | Airbus Helicopters | Estimation, independante d'une mesure magnetique, de la vitesse et du cap d'un aeronef |
CN109211276B (zh) * | 2018-10-30 | 2022-06-03 | 东南大学 | 基于gpr与改进的srckf的sins初始对准方法 |
-
2018
- 2018-10-30 CN CN201811281092.XA patent/CN109211276B/zh active Active
-
2019
- 2019-03-21 WO PCT/CN2019/079137 patent/WO2020087845A1/zh active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103759742A (zh) * | 2014-01-22 | 2014-04-30 | 东南大学 | 基于模糊自适应控制技术的捷联惯导非线性对准方法 |
CN104655131A (zh) * | 2015-02-06 | 2015-05-27 | 东南大学 | 基于istssrckf的惯性导航初始对准方法 |
US20180274940A1 (en) * | 2015-10-13 | 2018-09-27 | Shanghai Huace Navigation Technology Ltd | A method for initial alignment of an inertial navigation apparatus |
CN105424036A (zh) * | 2015-11-09 | 2016-03-23 | 东南大学 | 一种低成本水下潜器地形辅助惯性组合导航定位方法 |
CN106840211A (zh) * | 2017-03-24 | 2017-06-13 | 东南大学 | 一种基于kf和stupf组合滤波的sins大方位失准角初始对准方法 |
Non-Patent Citations (3)
Title |
---|
ZHIQIANG WU 等: ""Application of Nonlinear H∞ Filtering Algorithm for Initial Alignment of the Missile-borne SINS"", 《AASRI PROCEDIA》 * |
徐晓苏等: "基于改进型CKF的SINS初始对准方法", 《华中科技大学学报(自然科学版)》 * |
赵曦晶 等: ""捷联惯导系统大失准角高斯过程回归初始对准"", 《第26届中国控制与决策会议论文集》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020087845A1 (zh) * | 2018-10-30 | 2020-05-07 | 东南大学 | 基于gpr与改进的srckf的sins初始对准方法 |
CN109974698A (zh) * | 2019-04-10 | 2019-07-05 | 清华大学深圳研究生院 | 一种室内物流小车定位方法和终端设备 |
CN109974698B (zh) * | 2019-04-10 | 2020-11-17 | 清华大学深圳研究生院 | 一种室内物流小车定位方法和终端设备 |
CN110186480A (zh) * | 2019-05-30 | 2019-08-30 | 北京航天控制仪器研究所 | 一种惯性器件线性系统误差系数确定方法 |
CN110186480B (zh) * | 2019-05-30 | 2021-03-26 | 北京航天控制仪器研究所 | 一种惯性器件线性系统误差系数确定方法 |
CN114370867A (zh) * | 2022-01-11 | 2022-04-19 | 中国科学院长春光学精密机械与物理研究所 | 一种高动态星敏感器的姿态优化方法 |
CN117235540A (zh) * | 2023-08-21 | 2023-12-15 | 江西农业大学 | 基于特征匹配融合的传感器动态信息联动分析方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109211276B (zh) | 2022-06-03 |
WO2020087845A1 (zh) | 2020-05-07 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109211276A (zh) | 基于gpr与改进的srckf的sins初始对准方法 | |
CN104655131B (zh) | 基于istssrckf的惯性导航初始对准方法 | |
CN108225337B (zh) | 基于sr-ukf滤波的星敏感器和陀螺组合定姿方法 | |
CN104567871B (zh) | 一种基于地磁梯度张量的四元数卡尔曼滤波姿态估计方法 | |
CN107525503B (zh) | 基于双天线gps和mimu组合的自适应级联卡尔曼滤波方法 | |
CN105737823B (zh) | 一种基于五阶ckf的gps/sins/cns组合导航方法 | |
CN109000642A (zh) | 一种改进的强跟踪容积卡尔曼滤波组合导航方法 | |
CN106772524B (zh) | 一种基于秩滤波的农业机器人组合导航信息融合方法 | |
CN106885570A (zh) | 一种基于鲁棒sckf滤波的紧组合导航方法 | |
Gong et al. | A modified nonlinear two-filter smoothing for high-precision airborne integrated GPS and inertial navigation | |
CN103759742A (zh) | 基于模糊自适应控制技术的捷联惯导非线性对准方法 | |
CN103575299A (zh) | 利用外观测信息的双轴旋转惯导系统对准及误差修正方法 | |
CN103776449B (zh) | 一种提高鲁棒性的动基座初始对准方法 | |
CN110567455B (zh) | 一种求积更新容积卡尔曼滤波的紧组合导航方法 | |
CN103776453A (zh) | 一种多模型水下航行器组合导航滤波方法 | |
CN111783307A (zh) | 一种高超声速飞行器状态估计方法 | |
CN108592943B (zh) | 一种基于opreq方法的惯性系粗对准计算方法 | |
CN111156986B (zh) | 一种基于抗差自适应ukf的光谱红移自主组合导航方法 | |
Zhao et al. | A filtering approach based on MMAE for a SINS/CNS integrated navigation system | |
CN114777812B (zh) | 一种水下组合导航系统行进间对准与姿态估计方法 | |
Liu et al. | Strong tracking UKF-based hybrid algorithm and its application to initial alignment of rotating SINS with large misalignment angles | |
Lou et al. | Robust partially strong tracking extended consider Kalman filtering for INS/GNSS integrated navigation | |
CN110926499A (zh) | 基于李群最优估计的sins捷联惯性导航系统晃动基座自对准方法 | |
CN109211232A (zh) | 一种基于最小二乘滤波的炮弹姿态估计方法 | |
CN116907503A (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 |