CN102830414A - 一种基于sins/gps的组合导航方法 - Google Patents
一种基于sins/gps的组合导航方法 Download PDFInfo
- Publication number
- CN102830414A CN102830414A CN2012102433569A CN201210243356A CN102830414A CN 102830414 A CN102830414 A CN 102830414A CN 2012102433569 A CN2012102433569 A CN 2012102433569A CN 201210243356 A CN201210243356 A CN 201210243356A CN 102830414 A CN102830414 A CN 102830414A
- Authority
- CN
- China
- Prior art keywords
- msub
- mrow
- mtd
- msubsup
- mfrac
- 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
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000001914 filtration Methods 0.000 claims description 27
- 239000011159 matrix material Substances 0.000 claims description 24
- 230000001133 acceleration Effects 0.000 claims description 16
- 238000005070 sampling Methods 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 4
- 238000012886 linear function Methods 0.000 claims description 3
- 238000012986 modification Methods 0.000 abstract 1
- 230000004048 modification Effects 0.000 abstract 1
- 238000004364 calculation method Methods 0.000 description 10
- 238000009825 accumulation Methods 0.000 description 3
- 230000007547 defect Effects 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 1
- 230000004927 fusion Effects 0.000 description 1
- XEBWQGVWTUSTLN-UHFFFAOYSA-M phenylmercury acetate Chemical compound CC(=O)O[Hg]C1=CC=CC=C1 XEBWQGVWTUSTLN-UHFFFAOYSA-M 0.000 description 1
- 230000026676 system process Effects 0.000 description 1
- 230000009466 transformation Effects 0.000 description 1
Images
Landscapes
- Navigation (AREA)
Abstract
本发明涉及一种新型的捷联惯性导航系统(SINS)和全球定位系统(GPS)的组合导航方法。此部分属于航空应用领域中无人机自驾仪上的导航计算模块,可应用于各种无人机导航系统中。本发明首先在方位误差角为大失准角的情况下推导了多阶SINS/GPS组合导航系统的非线性模型,在SINS解算之前引入PI控制器保证每一时刻进行姿态计算的角速率都是当前最优值。在SINS/GPS组合时刻,角速率的修正是在扩展卡尔曼滤波算法对陀螺进行了一定的误差补偿的基础上加入PI控制器对角速率进行再次精确补偿;而在非组合时刻,陀螺输出的角速率值仍可以由PI控制器进行修正,得到组合导航参数的最优估计。
Description
技术领域
本发明涉及一种新型的捷联惯性导航系统(SINS)和全球定位系统(GPS)的组合导航方法。此部分属于航空应用领域中无人机自驾仪上的导航计算模块,可应用于各种无人机导航系统中。
背景技术
捷联惯导系统(SINS)能够连续实时地提供位置、速度、姿态等导航信息,且不受任何外界信息的干扰,是一种完全自主式的导航系统。但导航误差随时间积累的缺点使捷联惯导系统不能够单独完成长时间高精度的导航任务,需要其他辅助系统从旁协助。全球定位系统(GPS)则具有定位精度高,导航误差不随时间积累等优点,但是数据更新频率低、易受外界环境的干扰。因而SINS/GPS组合导航系统应运而生,目前已广泛应用于军事民用等的航空领域中。
组合导航系统中,实际系统总是存在不同程度的非线性,虽然有些系统可以近似看作线性系统,但是大部分系统难以用线性微分或差分方程描述。此外,实际系统中通常还存在高斯或非高斯随机噪声干扰。非线性随机动态系统广泛存在于工程实践,如飞机和舰船的惯性导航系统、组合导航系统等都属于这类系统。在这类非线性随机动态系统中,如何进行有效甚至最优状态估计尤为重要,这就需要采用非线性滤波技术。然而,每种非线性滤波方法都有其各自的局限性,因此仅依靠滤波技术在恶劣的飞行条件下不能得到准确的导航参数估计。
对于惯性导航系统,建立准确的误差方程是采用滤波技术进行对准和状态误差估计的基础,若系统模型存在误差,则会影响滤波精度,甚至使滤波发散。通常采用的线性误差方程都是在假定平台失准角(即姿态误差角)为小量的条件下导出的,当失准角较大时,系统误差呈现较严重的非线性特性,这些线性方程已不能准确描述捷联惯导系统的误差传播特性,如果继续使用可能致使滤波误差较大甚至发散,因此,需要寻找更为精确的非线性误差方程来代替。
发明内容
在方位误差角为大失准角时,组合导航系统的线性模型已经无法描述实际系统的特性,不能满足导航精度的要求。扩展卡尔曼滤波在运用过程中往往采用对非线性模型进行泰勒级数展开近似真实系统,这样做不可避免地会产生截断误差,加之计算过程中积分误差的积累,很容易造成扩展卡尔曼滤波的不稳定甚至发散。基于以上考虑,本发明首先在方位误差角为大失准角的情况下推导了SINS/GPS组合导航系统的非线性模型,然后应用PI控制器和扩展卡尔曼滤波相结合的方法进行数据融合,得到组合导航参数的最优估计。
本发明的目的是通过下述技术方案实现的。
步骤一、使用PI(比例积分)控制器补偿角速率ω。
将飞行器的姿态矩阵记为
第一种情况:
飞行器的航向角误差为:
yawerror=yaw_SINS×yaw_GPS
其中,yaw_SINS=[C11 C21 0]T;yaw_GPS=[cog_x cog_y0]T,cog为GPS给出的航向角。
重力加速度:g=acc-ω×V_GPS
其中,VGPS为GPS给出的飞行器速度;ω为角速率,acc为加速度。
飞行器的横滚角和俯仰角误差为:
rollpitcherror=g_SINS×g
其中,g_SINS=[C31 C32 C33]T
总误差:totalerror=ωYyawerror+ωRProllpitcherror
其中,ωY和ωRP分别为航向角误差,横滚俯仰角误差的权重系数。
第二种情况:
当GPS数据没有给出的时刻,yawerror=0
则总误差totalerror=ωRProllpitcherror
比例(P)补偿:ωProportion=KPtotalerror
积分(I)补偿:ωIntegral=ωIntegral+KItotalerrorΔt
其中,KP为比例系数;KI为积分系数;Δt为采样间隔。
对角速率ω进行PI补偿,得到补偿后的角速率为
ωcorrection=ωProportion+ωIntegral
将补偿后的角速率ωcorrection作为SINS的输入进行运算,得到姿态角(航向角ψ,俯仰角θ和横滚角γ),速度(东向Vx,北向Vt,天向Vz),位置(纬度L,经度λ,高度h)。
步骤二、在方位误差角为大失准角时,推导出姿态非线性误差方程、速度非线性误差方程以及位置误差方程。从中选取状态变量,建立组合导航系统的非线性误差模型。
姿态非线性误差方程为:
速度非线性误差方程为:
位置误差方程为:
陀螺、加速度计误差方程为:
其中, 为位置速率,为地球自转速率;φx,φy,φz为东向,北向,方位失准角;Vx,Vy,Vz为东向,北向,天向的速度;δVx,δVy,δVz为东向、北向、天向速度误差;L,λ,h为纬度,经度,高度;δL,δλ,δh为纬度、经度、高度误差;fx,fy,fz为东向,北向,天向的比力;为东向,北向,天向的陀螺常值漂移;为东向,北向,天向的加速度计零偏;Rm为地球子午圈上的曲率半径,Rn为地球卯酉圈上的曲率半径;陀螺常值漂移为 加速度计零偏为
从以上的误差方程中,选取以下15个状态变量:
建立连续多阶的状态方程和观测方程,形式如下:
Z(t)=HX(t)+V(t)
以上即为SINS/GPS组合导航系统的非线性误差模型。
其中,f(·)为X(t)的非线性函数;H(t)为观测矩阵;W(t)为过程噪声序列;V(t)为观测噪声序列。Z(t)的形式如下:
Vx_GPS,Vy_GPS,Vz_GPS为GPS给出的东向,北向,天向的速度;L_GPS,λ_GPS,h_GPS为GPS给出的纬度,经度,高度信息。
步骤三、使用二阶泰勒级数展开对步骤二得到的非线性误差模型进行线性化并离散化。
记X(k)=X(t),X(k+1)=X(t+Δt),则离散化后的状态方程和观测方程为:
Z(k)=HX(k)+V(k)
其中,Δt为采样间隔。
步骤四、对步骤三离散化后的模型使用扩展卡尔曼滤波。
步骤五、使用步骤四得出的扩展卡尔曼滤波结果修正步骤一中SINS输出的姿态矩阵速度(Vx,Vy,Vz)、位置(L,λ,h)以及陀螺的输出值ω′、加速度计的输出值acc′,最后得到导航参数的最优估计即飞行器的姿态角、速度、位置的信息。
修正过程如下:
速度修正
其中,V′x,V′y,V′z为修正后的东向,北向和天向的速度。
位置修正
其中,L′,λ′,h′为修正后的纬度,经度和高度。
陀螺角速率补偿
ω=ω′-ε
其中,ω′为陀螺输出的角速率,ω为修正后的陀螺角速率, 为陀螺常值漂移。
加速度补偿
其中,acc′为加速度计输出的加速度,acc为修正后的加速度, 为加速度计零偏。
步骤六、整个导航解算过程中,PI控制器对角速率的补偿频率与SINS的更新频率是一样的,并且要大于扩展卡尔曼滤波对角速率的修正频率。在GPS与SINS的组合时刻,按照上述步骤一至步骤五的方法,对飞行器的姿态角、速度和位置进行更新;在非组合时刻,姿态角、位置和速度按照步骤一中的情况二由SINS直接给出。
有益效果
在假定方位误差角为大失准角的情况下,建立了多阶的SINS/GPS组合导航系统的非线性模型。
本发明克服了传统组合导航方法只有在组合时刻进行陀螺和加速度计的误差补偿,而在非组合时刻不对陀螺和加速度计的误差进行修正的缺陷。本发明在捷联惯导系统(SINS)解算之前引入PI控制器保证了每一时刻进行姿态计算的角速率都是当前最优值。在SINS/GPS组合时刻,角速率的修正是在扩展卡尔曼滤波算法对陀螺进行了一定的误差补偿的基础上加入PI控制器对角速率进行再次精确补偿;而在非组合时刻,陀螺输出的角速率值仍可以由PI控制器进行修正。算法计算量没有明显增加,却大大改进了传统非线性滤波的精度。
附图说明
图1为本发明的SINS/GPS组合导航系统方法原理示意图;
图2为具体实施方式中理想导航坐标系oxnynzn与实际导航坐标系oxn′yn′zn′之间的关系示意图;
图3为本发明的SINS/GPS组合导航系统方法流程图。
具体实施方式
下面结合实例及附图,对本发明作进一步详细说明。
本实例坐标及符号说明:
坐标系符号:理想导航坐标系n,实际导航坐标系n′,机体坐标系b坐标系选取:选取地理坐标系(东北天)作为导航坐标系
第一步:设计PI(比例积分)控制器补偿角速率。
第一种情况:
飞行器的航向角误差:
yawerror=yaw_SINS×yaw_GPS
其中,yaw_SINS=[C11 C21 0]T;yaw_GPS=[cog_x cog_y0]T,cog为GPS给出的航向角。
重力加速度:g=acc-ω×V_GPS
其中,VGPS为GPS给出的速度;acc为从加速度计读出的加速度值;g为重力加速度。
飞行器的横滚角和俯仰角误差:
rollpitcherror=g_SINS×g
其中,g_SINS=[C31 C32 C33]T
总误差:totalerror=ωYyawerror+ωRProllpitcherror
其中,ωY和ωRP分别为航向角误差,横滚俯仰角误差的权重系数。
第二种情况:
当GPS数据没有给出的时刻,yawerror=0
则总误差totalerror=ωRProllpitcherror
比例(P)补偿:ωProportion=KPtotalerror
积分(I)补偿:ωIntegral=ωIntegral+KItotalerrorΔt
其中,KP为比例系数;KI为积分系数;Δt为采样间隔。
对角速率ω进行PI补偿,得到补偿后的角速率为:
ωcorrection=ωProportion+ωIntegral
将补偿后的角速率ωcorrection作为SINS的输入进行运算,得到姿态角(航向角ψ,俯仰角θ和横滚角γ),速度(东向Vx,北向Vy,天向Vz),位置(纬度L,经度λ,高度h)。
第二步:考虑水平方向上的姿态误差角基本不会出现大角度,而方位误差角在实际过程中往往会出现大角度的情况,从而假定水平误差角φx和φy为小角度,φz为大失准角。基于此,推导SINS/GPS组合导航的非线性模型。
①实际导航坐标系n′偏离理想导航坐标系n的失准角在东北天三个方向上分别为φx,φy,φz,则
当方位误差为大失准角时,φz不能看作小角度进行近似计算。而水平方向上基本不会出现大角度偏差的情况,所以水平失准角φx和φy可看作小角度,即sinφx=φx,cosφx=1,sinφy=φy,cosφy=1,则
②姿态非线性误差方程为:
可得:
③速度非线性误差方程为:
可得:
④位置误差方程为:
⑤陀螺、加速度计误差方程为:
其中, 为位置速率,为地球自转速率;φx,φy,φz为东向,北向,方位失准角;Vx,Vy,Vz为东向,北向,天向的速度;δVx,δVy,δVz为东向、北向、天向速度误差;L,λ,h为纬度,经度,高度;δL,δλ,δh为纬度、经度、高度误差;fx,fy,fz为东向,北向,天向的比力;为东向,北向,天向的陀螺常值漂移;为东向,北向,天向的加速度计零偏;Rm为地球子午圈上的曲率半径,Rn为地球卯酉圈上的曲率半径;陀螺常值漂移为 加速度计零偏为
⑥基于以上的误差方程,本实施例中选取15个状态变量如下:
建立连续多阶的状态方程和观测方程,即SINS/GPS组合导航系统的非线性模型:
Z(t)=HX(t)+V(t)
其中,f(·)为X(t)的非线性函数;H(t)为观测矩阵;W(t)为过程噪声序列;V(t)为观测噪声序列。Z(t)的形式如下:
Vx_GPS,Vy_GPS,Vz_GPS为GPS给出的东向,北向,天向的速度;L_GPS,λ_GPS,h_GPS为GPS给出的纬度,经度,高度信息。
第三步:使用二阶泰勒级数展开对第二步得到的非线性误差模型进行线性化并离散化。
设采样间隔为Δt
记X(k)=X(t),X(k+1)=X(t+Δt),则离散化后的系统方程为:
Z(k)=HX(k)+V(k)
其中,
第四步:对第三步离散化后的模型进行扩展卡尔曼滤波:
状态一步预测:
一步预测误差方差矩阵:P(k+1,k)=Φ(k)P(k)ΦT(k)+Γ(k)Q(k)ΓT(k)
滤波增益矩阵:K(k+1)=P(k+1,k)HT[HP(k+1,k)HT+R(k)]-1
状态估计:
估计误差方差矩阵:P(k+1)=[I-K(k+1)H]P(k+1,k)
其中,
即Q(k)是系统过程噪声W(k)的方差矩阵;R(k)是系统观测噪声V(k)的方差矩阵;δkj是Kronecker-δ函数。
第五步:使用第四步得出的扩展卡尔曼滤波结果修正第一步中SINS输出的姿态矩阵速度(Vx,Vy,Vz)、位置(L,λ,h)以及陀螺的输出值ω′、加速度计的输出值acc′,最后得到导航参数的最优估计即飞行器的姿态角、速度、位置的信息。
修正过程如下:
①姿态矩阵修正
θ主=arcsin(C32)
θ=θ主
其中,ψ,γ,θ为经过修正后的航向角,横滚角和俯仰角。
②速度修正
其中,V′x,V′v,V′z为修正后的东向,北向和天向的速度。
③位置修正
其中,L′,λ′,h′为修正后的纬度,经度和高度。
④陀螺角速率补偿
ω=ω′-ε
其中,ω′为陀螺输出的角速率,ω为修正后的陀螺角速率, 为陀螺常值漂移。
⑤加速度补偿
其中,acc′为加速度计输出的加速度,acc为修正后的加速度, 为加速度计零偏。
第六步:整个导航解算过程中,PI控制器对角速率的补偿频率与SINS的更新频率是一样的,并且要大于扩展卡尔曼滤波对角速率的修正频率。在GPS与SINS的组合时刻,按照上述第一步至第五步的方法,对飞行器的姿态角、速度和位置进行更新;在非组合时刻,姿态角、位置和速度按照第一步中的情况二由SINS直接给出。
基于方位误差角为大失准角的情况,建立SINS/GPS组合导航的非线性误差模型,使模型更加逼近真实系统反映实际组合系统的特性。每种非线性滤波方法都有自身的局限性,不能仅仅依靠滤波技术完成组合导航的导航参数的最优估计,因而构造一种基于PI控制器和扩展卡尔曼滤波相结合的方法进行导航参数的误差估计来获得更加精确的导航参数。既解决了扩展卡尔曼滤波在模型线性化时产生的截断误差和固定步长的积分运算造成的误差积累问题,又解决了陀螺漂移导致数学平台漂移直接影响导航参数计算不准确的问题。本发明克服了传统组合导航方法只有在组合时刻进行陀螺和加速度计的误差补偿,而在非组合时刻不对陀螺和加速度计的误差进行修正的缺陷。本发明在捷联惯导系统(SINS)解算之前引入PI控制器保证了每一时刻进行姿态计算的角速率都是当前最优值。在SINS/GPS组合时刻,角速率的修正是在扩展卡尔曼滤波算法对陀螺进行了一定的误差补偿的基础上加入PI控制器对角速率进行再次精确补偿;而在非组合时刻,陀螺输出的角速率值仍可以由PI控制器进行修正。算法计算量没有明显增加,却大大改进了传统非线性滤波的精度。
Claims (4)
1.一种基于SINS/GPS的组合导航方法,其特征在于:包括如下步骤:
步骤一、使用PI控制器补偿角速率ω;
将飞行器的姿态矩阵记为
飞行器的航向角误差为:
yawerror=yaw_SINS×yaw_GPS
其中,yaw_SINS=[C11 C21 0]T;yaw_GPS=[cog_x cog_y0]T,cog为GPS给出的航向角;
重力加速度:g=acc-ω×V_GPS
其中,VGPS为GPS给出的飞行器速度;ω为角速率,acc为加速度;
飞行器的横滚角和俯仰角误差为:
rollpitcherror=g_SINS×g
其中,g_SINS=[C31 C32 C33]T
总误差:totalerror=ωYyawerror+ωRProllpitcherror
其中,ωY和ωRP分别为航向角误差,横滚俯仰角误差的权重系数;
比例(P)补偿:ωProportion=KPtotalerror
积分(I)补偿:ωIntegral=ωIntegral+KItotalerrorΔt
其中,KP为比例系数;KI为积分系数;Δt为采样间隔;
对角速率ω进行PI补偿,得到补偿后的角速率为
ωcorrection=ωPr oportion+ωIntegral
将补偿后的角速率ωcorrection作为SINS的输入进行运算,得到三个姿态角:航向角ψ,俯仰角θ和横滚角γ;东向速度Vx,北向速度Vy,天向速度Vz;纬度L,经度λ,高度h;
步骤二、在方位误差角为大失准角时,推导出姿态非线性误差方程、速度非线性误差方程以及位置误差方程;从中选取状态变量,建立组合导航系统的非线性误差模型;
姿态非线性误差方程为:
速度非线性误差方程为:
位置误差方程为:
陀螺、加速度计误差方程为:
其中, 为位置速率,为地球自转速率;φx,φy,φz为东向,北向,方位失准角;δVx,δVy,δVz为东向、北向、天向速度误差;δL,δλ,δh为纬度、经度、高度误差;fx,fy,fz为东向,北向,天向的比力; 为东向,北向,天向的陀螺常值漂移;为东向,北向,天向的加速度计零偏;Rm为地球子午圈上的曲率半径,Rn为地球卯酉圈上的曲率半径;陀螺常值漂移为 加速度计零偏为
从以上的误差方程中,选取以下15个状态变量:
建立连续多阶的状态方程和观测方程,形式如下:
Z(t)=HX(t)+V(t)
得到SINS/GPS组合导航系统的非线性误差模型;
其中,f(·)为X(t)的非线性函数;H(t)为观测矩阵;W(t)为过程噪声序列;V(t)为观测噪声序列;Z(t)的形式如下:
Vx_GPS,Vy_GPS,Vz_GPS为GPS给出的东向,北向,天向的速度;L_GPS,λ_GPS,h_GPS为GPS给出的纬度,经度,高度信息;
步骤三、使用二阶泰勒级数展开对步骤二得到的非线性误差模型进行线性化并离散化;
记X(k)=X(t),X(k+1)=X(t+Δt),则离散化后的状态方程和观测方程为:
Z(k)=HX(k)+V(k)
其中,Δt为采样间隔;
步骤四、对步骤三离散化后的模型使用扩展卡尔曼滤波;
步骤五、使用步骤四得出的扩展卡尔曼滤波结果修正步骤一中SINS输出的姿态矩阵、速度Vx,Vy,Vz、位置L,λ,h以及陀螺的输出值ω′、加速度计的输出值acc′,最后得到导航参数的最优估计即飞行器的姿态角、速度、位置的信息;
修正过程如下:
姿态矩阵修正:
速度修正
其中,V′x,V′y,V′z为修正后的东向,北向和天向的速度;
位置修正
其中,L′,λ′,h′为修正后的纬度,经度和高度;
陀螺角速率补偿
ω=ω′-ε
其中,ω′为陀螺输出的角速率,ω为修正后的陀螺角速率, 为陀螺常值漂移;
加速度补偿
其中,acc′为加速度计输出的加速度,acc为修正后的加速度, 为加速度计零偏;
步骤六、在GPS与SINS的组合时刻,按照上述步骤一至步骤五的方法,对飞行器的姿态角、速度和位置进行更新;在非组合时刻,姿态角、位置和速度由SINS直接给出。
2.根据权利要求1所述的一种基于SINS/GPS的组合导航方法,其特征在于:在步骤1中,当GPS数据没有给出的非组合时刻,yawerror=0,总误差totalerror=ωRProllpitcherror。
3.根据权利要求1所述的一种基于SINS/GPS的组合导航方法,其特征在于:整个导航解算过程中,PI控制器对角速率的补偿频率与SINS的更新频率相同,且大于扩展卡尔曼滤波对角速率的修正频率。
4.根据权利要求1所述的一种基于SINS/GPS的组合导航方法,其特征在于:在SINS/GPS组合时刻,角速率的修正在扩展卡尔曼滤波方法对陀螺进行误差补偿的基础上加入PI控制器对角速率再次进行补偿;而在非组合时刻,陀螺输出的角速率值由PI控制器进行修正。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210243356.9A CN102830414B (zh) | 2012-07-13 | 2012-07-13 | 一种基于sins/gps的组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201210243356.9A CN102830414B (zh) | 2012-07-13 | 2012-07-13 | 一种基于sins/gps的组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102830414A true CN102830414A (zh) | 2012-12-19 |
CN102830414B CN102830414B (zh) | 2014-12-24 |
Family
ID=47333609
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201210243356.9A Expired - Fee Related CN102830414B (zh) | 2012-07-13 | 2012-07-13 | 一种基于sins/gps的组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102830414B (zh) |
Cited By (18)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103438892A (zh) * | 2013-09-16 | 2013-12-11 | 哈尔滨工业大学 | 一种改进的基于ekf的天文自主定轨算法 |
CN103728981A (zh) * | 2014-01-28 | 2014-04-16 | 重庆大学 | 一种无人机的非线性导航寻迹控制方法 |
CN104570033A (zh) * | 2015-01-06 | 2015-04-29 | 中电科航空电子有限公司 | 一种飞机机载gps与惯性导航系统组合定位方法 |
CN104634348A (zh) * | 2015-03-12 | 2015-05-20 | 北京华力创通科技股份有限公司 | 组合导航中的姿态角计算方法 |
CN104850130A (zh) * | 2015-04-14 | 2015-08-19 | 深圳市华信天线技术有限公司 | 飞行参数的计算方法和系统 |
CN104880189A (zh) * | 2015-05-12 | 2015-09-02 | 西安克拉克通信科技有限公司 | 一种动中通天线低成本跟踪抗干扰方法 |
CN105258698A (zh) * | 2015-10-13 | 2016-01-20 | 北京航天控制仪器研究所 | 一种高动态自旋制导炮弹空中组合导航方法 |
CN105300380A (zh) * | 2015-11-21 | 2016-02-03 | 广西南宁至简至凡科技咨询有限公司 | 一种基于gps或ins组合的导航系统 |
CN105737823A (zh) * | 2016-02-01 | 2016-07-06 | 东南大学 | 基于五阶ckf的gps/sins/cns组合导航方法 |
CN106990426A (zh) * | 2017-03-16 | 2017-07-28 | 北京无线电计量测试研究所 | 一种导航方法和导航装置 |
CN108692727A (zh) * | 2017-12-25 | 2018-10-23 | 北京航空航天大学 | 一种带有非线性补偿滤波器的捷联惯导系统 |
CN108759845A (zh) * | 2018-07-05 | 2018-11-06 | 华南理工大学 | 一种基于低成本多传感器组合导航的优化方法 |
CN109612435A (zh) * | 2019-01-14 | 2019-04-12 | 武汉博感空间科技有限公司 | 基于无人机的生态环境辅助监管系统 |
CN110017849A (zh) * | 2019-04-18 | 2019-07-16 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN111221347A (zh) * | 2020-04-21 | 2020-06-02 | 广东英诺威盛科技有限公司 | 垂直起降固定翼无人机姿态估计中加速度补偿方法及系统 |
CN111398522A (zh) * | 2020-03-24 | 2020-07-10 | 山东智翼航空科技有限公司 | 基于微型无人机的室内空气质量检测系统及检测方法 |
CN111896031A (zh) * | 2020-08-06 | 2020-11-06 | 中国人民解放军火箭军工程大学 | 一种黑障情况下惯性基组合导航系统误差补偿方法及系统 |
CN113155156A (zh) * | 2021-04-27 | 2021-07-23 | 北京信息科技大学 | 运行信息的确定方法及装置、存储介质、电子装置 |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002303533A (ja) * | 2001-01-08 | 2002-10-18 | Motorola Inc | 車両ナビゲーション・システムの位置およびヘッディング・エラーを修正する方法および装置 |
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航系统的快速精对准方法 |
CN102169184A (zh) * | 2011-01-04 | 2011-08-31 | 北京航空航天大学 | 组合导航系统中测量双天线gps安装失准角的方法和装置 |
CN202209953U (zh) * | 2011-08-11 | 2012-05-02 | 东北林业大学 | 用于水下载体的地磁辅助惯性导航系统 |
-
2012
- 2012-07-13 CN CN201210243356.9A patent/CN102830414B/zh not_active Expired - Fee Related
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2002303533A (ja) * | 2001-01-08 | 2002-10-18 | Motorola Inc | 車両ナビゲーション・システムの位置およびヘッディング・エラーを修正する方法および装置 |
CN101216321A (zh) * | 2008-01-04 | 2008-07-09 | 南京航空航天大学 | 捷联惯性导航系统的快速精对准方法 |
CN102169184A (zh) * | 2011-01-04 | 2011-08-31 | 北京航空航天大学 | 组合导航系统中测量双天线gps安装失准角的方法和装置 |
CN202209953U (zh) * | 2011-08-11 | 2012-05-02 | 东北林业大学 | 用于水下载体的地磁辅助惯性导航系统 |
Non-Patent Citations (2)
Title |
---|
石静等: "鲁棒容错滤波算法及在MEMS_SINS/GPS中的应用", 《北京理工大学学报》, vol. 32, no. 2, 29 February 2012 (2012-02-29) * |
马媛等: "SINS/GPS组合导航系统仿真研究", 《弹箭与制导学报》, vol. 29, no. 6, 30 December 2009 (2009-12-30) * |
Cited By (29)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103438892B (zh) * | 2013-09-16 | 2015-09-30 | 哈尔滨工业大学 | 一种改进的基于ekf的天文自主定轨算法 |
CN103438892A (zh) * | 2013-09-16 | 2013-12-11 | 哈尔滨工业大学 | 一种改进的基于ekf的天文自主定轨算法 |
CN103728981B (zh) * | 2014-01-28 | 2016-04-20 | 重庆大学 | 一种无人机的非线性导航寻迹控制方法 |
CN103728981A (zh) * | 2014-01-28 | 2014-04-16 | 重庆大学 | 一种无人机的非线性导航寻迹控制方法 |
CN104570033A (zh) * | 2015-01-06 | 2015-04-29 | 中电科航空电子有限公司 | 一种飞机机载gps与惯性导航系统组合定位方法 |
CN104634348A (zh) * | 2015-03-12 | 2015-05-20 | 北京华力创通科技股份有限公司 | 组合导航中的姿态角计算方法 |
CN104634348B (zh) * | 2015-03-12 | 2017-09-15 | 北京华力创通科技股份有限公司 | 组合导航中的姿态角计算方法 |
CN104850130A (zh) * | 2015-04-14 | 2015-08-19 | 深圳市华信天线技术有限公司 | 飞行参数的计算方法和系统 |
CN104880189A (zh) * | 2015-05-12 | 2015-09-02 | 西安克拉克通信科技有限公司 | 一种动中通天线低成本跟踪抗干扰方法 |
CN104880189B (zh) * | 2015-05-12 | 2019-01-29 | 西安克拉克通信科技有限公司 | 一种动中通天线低成本跟踪抗干扰方法 |
CN105258698A (zh) * | 2015-10-13 | 2016-01-20 | 北京航天控制仪器研究所 | 一种高动态自旋制导炮弹空中组合导航方法 |
CN105258698B (zh) * | 2015-10-13 | 2017-12-19 | 北京航天控制仪器研究所 | 一种高动态自旋制导炮弹空中组合导航方法 |
CN105300380A (zh) * | 2015-11-21 | 2016-02-03 | 广西南宁至简至凡科技咨询有限公司 | 一种基于gps或ins组合的导航系统 |
CN105737823B (zh) * | 2016-02-01 | 2018-09-21 | 东南大学 | 一种基于五阶ckf的gps/sins/cns组合导航方法 |
CN105737823A (zh) * | 2016-02-01 | 2016-07-06 | 东南大学 | 基于五阶ckf的gps/sins/cns组合导航方法 |
CN106990426B (zh) * | 2017-03-16 | 2020-04-10 | 北京无线电计量测试研究所 | 一种导航方法和导航装置 |
CN106990426A (zh) * | 2017-03-16 | 2017-07-28 | 北京无线电计量测试研究所 | 一种导航方法和导航装置 |
CN108692727B (zh) * | 2017-12-25 | 2021-06-29 | 北京航空航天大学 | 一种带有非线性补偿滤波器的捷联惯导系统 |
CN108692727A (zh) * | 2017-12-25 | 2018-10-23 | 北京航空航天大学 | 一种带有非线性补偿滤波器的捷联惯导系统 |
CN108759845A (zh) * | 2018-07-05 | 2018-11-06 | 华南理工大学 | 一种基于低成本多传感器组合导航的优化方法 |
CN108759845B (zh) * | 2018-07-05 | 2021-08-10 | 华南理工大学 | 一种基于低成本多传感器组合导航的优化方法 |
CN109612435A (zh) * | 2019-01-14 | 2019-04-12 | 武汉博感空间科技有限公司 | 基于无人机的生态环境辅助监管系统 |
CN110017849A (zh) * | 2019-04-18 | 2019-07-16 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN110017849B (zh) * | 2019-04-18 | 2020-12-22 | 菲曼(北京)科技有限公司 | 一种基于gnss接收机和imu传感器的测绘一体机的倾斜测量方法 |
CN111398522A (zh) * | 2020-03-24 | 2020-07-10 | 山东智翼航空科技有限公司 | 基于微型无人机的室内空气质量检测系统及检测方法 |
CN111398522B (zh) * | 2020-03-24 | 2022-02-22 | 山东智翼航空科技有限公司 | 基于微型无人机的室内空气质量检测系统及检测方法 |
CN111221347A (zh) * | 2020-04-21 | 2020-06-02 | 广东英诺威盛科技有限公司 | 垂直起降固定翼无人机姿态估计中加速度补偿方法及系统 |
CN111896031A (zh) * | 2020-08-06 | 2020-11-06 | 中国人民解放军火箭军工程大学 | 一种黑障情况下惯性基组合导航系统误差补偿方法及系统 |
CN113155156A (zh) * | 2021-04-27 | 2021-07-23 | 北京信息科技大学 | 运行信息的确定方法及装置、存储介质、电子装置 |
Also Published As
Publication number | Publication date |
---|---|
CN102830414B (zh) | 2014-12-24 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102830414B (zh) | 一种基于sins/gps的组合导航方法 | |
CN102608596B (zh) | 一种用于机载惯性/多普勒雷达组合导航系统的信息融合方法 | |
CN101949703B (zh) | 一种捷联惯性/卫星组合导航滤波方法 | |
CN106443746B (zh) | 一种低成本双天线gnss/ahrs组合测姿方法 | |
CN103471616B (zh) | 一种动基座sins大方位失准角条件下初始对准方法 | |
CN104977004B (zh) | 一种激光惯组与里程计组合导航方法及系统 | |
CN100516775C (zh) | 一种捷联惯性导航系统初始姿态确定方法 | |
CN102519470B (zh) | 多级嵌入式组合导航系统及导航方法 | |
CN101825467B (zh) | 捷联惯性导航系统与天文导航系统实现组合导航的方法 | |
CN104713555A (zh) | 应用全天域中性点辅助定向的车辆自主导航方法 | |
CN104697526A (zh) | 用于农业机械的捷联惯导系统以及控制方法 | |
CN104764467A (zh) | 空天飞行器惯性传感器误差在线自适应标定方法 | |
CN104655131A (zh) | 基于istssrckf的惯性导航初始对准方法 | |
Xue et al. | In-motion alignment algorithm for vehicle carried SINS based on odometer aiding | |
CN103674059A (zh) | 一种基于外测速度信息的sins水平姿态误差修正方法 | |
CN109708663B (zh) | 基于空天飞机sins辅助的星敏感器在线标定方法 | |
CN103076026B (zh) | 一种捷联惯导系统中确定多普勒计程仪测速误差的方法 | |
CN106767797A (zh) | 一种基于对偶四元数的惯性/gps组合导航方法 | |
CN104215262A (zh) | 一种惯性导航系统惯性传感器误差在线动态辨识方法 | |
CN109612460B (zh) | 一种基于静止修正的垂线偏差测量方法 | |
CN102353378A (zh) | 一种矢量形式信息分配系数的自适应联邦滤波方法 | |
CN105806363A (zh) | 基于srqkf的sins/dvl水下大失准角对准方法 | |
CN106441357A (zh) | 一种基于阻尼网络的单轴旋转sins轴向陀螺漂移校正方法 | |
CN105928515A (zh) | 一种无人机导航系统 | |
CN110849360B (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 | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20141224 Termination date: 20160713 |