CN111190207A - 基于pstcsdref算法的无人机ins bds组合导航方法 - Google Patents
基于pstcsdref算法的无人机ins bds组合导航方法 Download PDFInfo
- Publication number
- CN111190207A CN111190207A CN202010020948.9A CN202010020948A CN111190207A CN 111190207 A CN111190207 A CN 111190207A CN 202010020948 A CN202010020948 A CN 202010020948A CN 111190207 A CN111190207 A CN 111190207A
- Authority
- CN
- China
- Prior art keywords
- aerial vehicle
- unmanned aerial
- state
- east
- bds
- 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
Images
Classifications
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01S—RADIO DIRECTION-FINDING; RADIO NAVIGATION; DETERMINING DISTANCE OR VELOCITY BY USE OF RADIO WAVES; LOCATING OR PRESENCE-DETECTING BY USE OF THE REFLECTION OR RERADIATION OF RADIO WAVES; ANALOGOUS ARRANGEMENTS USING OTHER WAVES
- G01S19/00—Satellite radio beacon positioning systems; Determining position, velocity or attitude using signals transmitted by such systems
- G01S19/38—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system
- G01S19/39—Determining a navigation solution using signals transmitted by a satellite radio beacon positioning system the satellite radio beacon positioning system transmitting time-stamped messages, e.g. GPS [Global Positioning System], GLONASS [Global Orbiting Navigation Satellite System] or GALILEO
- G01S19/42—Determining position
- G01S19/45—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement
- G01S19/47—Determining position by combining measurements of signals from the satellite radio beacon positioning system with a supplementary measurement the supplementary measurement being an inertial measurement, e.g. tightly coupled inertial
-
- G—PHYSICS
- G01—MEASURING; TESTING
- G01C—MEASURING DISTANCES, LEVELS OR BEARINGS; SURVEYING; NAVIGATION; GYROSCOPIC INSTRUMENTS; PHOTOGRAMMETRY OR VIDEOGRAMMETRY
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/10—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration
- G01C21/12—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning
- G01C21/16—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation
- G01C21/165—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00 by using measurements of speed or acceleration executed aboard the object being navigated; Dead reckoning by integrating acceleration or speed, i.e. inertial navigation combined with non-inertial navigation instruments
-
- Y—GENERAL TAGGING OF NEW TECHNOLOGICAL DEVELOPMENTS; GENERAL TAGGING OF CROSS-SECTIONAL TECHNOLOGIES SPANNING OVER SEVERAL SECTIONS OF THE IPC; TECHNICAL SUBJECTS COVERED BY FORMER USPC CROSS-REFERENCE ART COLLECTIONS [XRACs] AND DIGESTS
- Y02—TECHNOLOGIES OR APPLICATIONS FOR MITIGATION OR ADAPTATION AGAINST CLIMATE CHANGE
- Y02T—CLIMATE CHANGE MITIGATION TECHNOLOGIES RELATED TO TRANSPORTATION
- Y02T10/00—Road transport of goods or passengers
- Y02T10/10—Internal combustion engine [ICE] based vehicles
- Y02T10/40—Engine management systems
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Computer Networks & Wireless Communication (AREA)
- Automation & Control Theory (AREA)
- Navigation (AREA)
Abstract
本发明公开了一种基于PSTCSDREF算法的无人机INS BDS组合导航方法,旨在解决现有的导航系统滤波精度低,滤波稳定性差的技术问题。本发明首先建立INS/BDS组合导航系统的直接法状态方程和量测方程,然后对组合导航系统方程进行离散化,最后利用PSTCSDREF算法降低测量信息中的偏差对组合导航系统的不利影响;PSRCSDREF首先使用“consider”方法将偏差的统计信息合并到状态估计方程中,同时将自适应渐消因子引入到PSTCSDREF中。本发明的有益技术效果在于:提高导航的精度和稳定性,使得组合导航系统能够高效实时地估计无人机状态。
Description
技术领域
本发明涉及无人机导航技术领域,具体涉及一种基于PSTCSDREF算法的无人机INSBDS组合导航方法。
背景技术
无人机主要是通过旋翼的高速旋转得到升力并实现操控,可以在高低起伏的复杂地形下作业,在智能化发展的当代得到了广泛的应用。导航系统是无人机能够实现自主飞行、完成机动任务的必要条件,采用多种传感器对同一信息源进行测量,通过不同传感器量测特性的互补,获得更高精度的导航信息,以此来控制飞行器的飞行姿态。其中,INS/BDS组合导航系统就是一种优势互补的组合导航系统。该组合导航系统以具有较高自主性的惯性导航系统(Inertial Navigation System,缩写为INS)为主,并用通过BDS(BeiDou System,缩写为BDS)得到的定位数据进行修正,来保证INS/BDS组合导航系统具有较高的测量精度。由于无人机体积、载重、成本有限,无人机上通常都使用低成本小型化的低精度机载导航传感器来提供导航信息,为了使用上述低精度的传感器数据得到高精度的导航信息,就需要在对传感器获取的信息进行融合时作滤波处理。
对于INS/BDS组合导航系统,通常采用扩展卡尔曼滤波(Extended KalmanFilter,缩写为EKF)或无迹卡尔曼滤波(Unscented Kalman Filter,缩写为UKF)来进行数据信息融合。由于EKF是利用雅克比矩阵将非线性函数展开成Taylor级数并略去二阶及以上项,线性化所产生的截断误差会降低滤波精度和稳定性,因此在实际工程中,EKF处理弱非线性系统时效果比较好。而UKF的估计精度相对于EKF较高,但UKF的计算量比较大,不利于实时滤波导航。状态相关Riccati方程滤波器(Sate-Dependent Riccati EquationFilter,缩写为SDREF)通过对非线性状态方程进行分解,得到每一步的Riccati方程和状态估计。SDREF保留了系统的非线性,具有更高的精度且计算量也较小。上述滤波方法的一个前提是该非线性系统是能精确建模的,但是实际应用中,系统模型会受到干扰,具有不确定性(比如INS的漂移、传感器的测量偏差、系统的未知扰动等)。这些不确定性会严重影响组合导航系统的估计精度,甚至会导致组合导航系统的精度发散。
发明内容
本发明提供一种基于PSTCSDREF(PartlyStrong Tracking Consider State-Dependent Riccati Equation Filter,缩写为PSTCSDREF)算法的无人机INS BDS组合导航方法以解决现有的导航系统滤波精度低,滤波稳定性差的技术问题。
为解决上述技术问题,本发明采用如下技术方案:
设计一种基于PSTCSDREF算法的无人机INS BDS组合导航方法,包括:
步骤1:测量无人机组合导航系统的初始参数;
步骤2:将初始参数带入无人机的状态方程和量测方程,量测方程包括量测偏差;
步骤3:获取无人机状态的一步预测、一步预测的协方差、滤波增益矩阵;
步骤4:利用一步预测、协方差和滤波增益矩阵,根据卡尔曼滤波算法,获得下一时刻的无人机状态更新;
步骤5:结合无人机的当前时刻状态与下一时刻的预测状态,获取协方差更新;
步骤6:将下一时刻的预测状态作为基础带入步骤3中,依次执行步骤3-步骤5,得出更下一时刻的无人机预测状态,如此循环迭代,得出无人机的运行状态。
进一步的,上述初始参数包括:无人机的东方向误差角、北方向误差角、天方向误差角;载体的东方向的速度、北方向的速度、天方向的速度;无人机所在的纬度、经度、高度;陀螺仪的东方向常值漂移、北方向常值漂移、天方向常值漂移;加速度计的东方向常值漂移、北方向常值漂移、天方向常值漂移;初始状态估计误差方差矩阵、初始误差角方差矩阵、初始速度方差矩阵、初始位置方差矩阵;陀螺仪的常值漂移方差矩阵、加速度计的常值漂移方差矩阵。
进一步的,无人机的状态方程表达式为:
式中,φe、φn和φu分别为东方向误差角、北方向误差角和天方向误差角,ve、vn和vu是无人机在东、北和天方向的速度分量,λ和h是无人机在纬度、经度和高度的位置分量,陀螺仪分别有东方向常值漂移εe、北方向常值漂移εn、天方向常值漂移εu,加速度计分别有东方向常值漂移Δe、北方向常值漂移Δn、天方向常值漂移是陀螺仪和加速度计随机误差,δve、δvn、和δh是INS和BDS在东方向的速度差、北方向的速度差、纬度差和高度差,fe、fn和fu是加速度计在东方向、北方向和天方向测量值的分量。
进一步的,导航系统中BDS的量测信息为:
z=[vge,vgn,vgu,pge,pgn,pgu]T (2)
INS/BDS组合导航系统的量测方程为:
z=h(x)+θ+v (3)
式中,θ=[bvge,bvgn,bvgu,bpge,bpgn,bpgu]T是量测偏差,bvge、bvgn和bvgu分别为在导航坐标系东方向、北方向、天方向的速度量测偏差,bpge、bpgn和bpgu分别为在导航坐标系东方向、北方向、天方向的位置量测偏差,量测噪声为v=[vvge,vvgn,vvgu,vpge,vpgn,vpgu]T,vvge、vvgn和vvgu分别为在导航坐标系东方向、北方向、天方向的BDS速度量测值的随机误差,vpge、vpgn和vpgu分别为在导航坐标系东方向、北方向、天方向BDS位置量测值的随机误差。
进一步的,对状态方程进行离散化处理,方便计算机运行,离散化后的状态方程为:
式中,dt为采样时间间隔,xk-1是tk-1时刻的状态向量,xk是tk时刻的状态向量。
进一步的,步骤2中无人机的初始状态表示为:
进一步的,步骤3中无人机状态的一步预测为:
一步预测的协方差为:
式中,λk为自适应渐消因子,自适应渐消因子的计算方法为:
式中,Ok和Uk的表达式为:
滤波增益矩阵为:
进一步的,步骤4中无人机的状态更新为:
进一步的,在步骤5中所述协方差更新为
与现有技术相比,本发明的有益技术效果在于:
1、本发明采用PSTCSDREF通过对非线性状态方程进行分解,转换为SDC形式,得到线性化的状态方程,避免了雅可比矩阵的计算,得到相应的Riccati方程,以此来得到状态估计。
2、本发明使用“consider”方法将偏差的统计信息合并到状态估计方程中,而不直接估计它们,以此来减少偏差的负面影响并获得较好滤波效果;如果参数数量很大,该方法可以节省计算和处理成本。
3、本发明将自适应渐消因子引入到PSTCSDREF中,能够降低模型不确定性的负面影响,提高了本发明的滤波精度。
4、本发明使用PSTCSDREF算法鲁棒性强,信息融合结果更接近于真实状态,提高集成导航系统的准确性。
附图说明
图1为本发明一种实施例的方法流程示意图;
图2为本发明一种实施例的无人机东向位置误差仿真图;
图3为本发明一种实施例的无人机北向位置误差仿真图;
图4为本发明一种实施例的无人机天向位置误差仿真图;
图5为本发明一种实施例的无人机东向速度误差仿真图;
图6为本发明一种实施例的无人机北向速度误差仿真图;
图7为本发明一种实施例的无人机天向速度误差仿真图。
具体实施方式
下面结合附图和实施例来说明本发明的具体实施方式,但以下实施例只是用来详细说明本发明,并不以任何方式限制本发明的范围。
以下实施例中所涉及或依赖的程序均为本技术领域的常规程序或简单程序,本领域技术人员均能根据具体应用场景做出常规选择或者适应性调整。
实施例1:一种基于PSTCSDREF算法的无人机INS BDS组合导航方法,参见图1,包括以下三个步骤:
步骤一、建立无人机INS/BDS组合导航系统的直接法状态方程和量测方程
组合导航系统的直接法即为直接以导航系统输出的导航参数作为状态值,并使用卡尔曼滤波进行估计。采用直接法对导航系统参数进行估计,选取东-北-天坐标系作为导航坐标系,将加速度计和陀螺仪产生的漂移扩维进系统的状态,定义系统状态向量为组合导航系统的状态方程如下:
式中,φe、φn和φu分别为东方向误差角、北方向误差角和天方向误差角,ve、vn和vu是载体在东、北和天方向的速度分量,λ和h是载体在纬度、经度和高度的位置分量,陀螺仪分别有东方向常值漂移εe、北方向常值漂移εn、天方向常值漂移εu,加速度计分别有东方向常值漂移Δe、北方向常值漂移Δn、天方向常值漂移Δu,是组合导航系统中的陀螺仪和加速度计随机误差,δve、δvn、和δh是INS和BDS在东方向的速度差、北方向的速度差、纬度差和高度差,fe、fn和fu是加速度计在东方向、北方向和天方向测量值的分量。
BDS测量无人机的速度和位置,其量测信息为z=[vge,vgn,vgu,pge,pgn,pgu]T,组合导航系统的量测方程如下所示:
z=h(x)+θ+v (2)
式中,θ=[bvge,bvgn,bvgu,bpge,bpgn,bpgu]T是量测偏差,bvge、bvgn和bvgu分别为在导航坐标系东方向、北方向、天方向的速度量测偏差,bpge、bpgn和bpgu分别为在导航坐标系东方向、北方向、天方向的位置量测偏差,量测噪声为v=[vvge,vvgn,vvgu,vpge,vpgn,vpgu]T,其中,vvge、vvgn和vvgu分别为在导航坐标系东方向、北方向、天方向BDS速度量测值的随机误差,vpge、vpgn和vpgu分别为在导航坐标系东方向、北方向、天方向BDS位置量测值的随机误差。
随后将非线性系统的方程等式(1)和等式(2)转换为状态相关系数(statedependent coefficient,SDC)的形式:
其中,f(x)=F(x)x,h(x)=H(x)x。
步骤二、离散化组合导航系统方程
对INS/BDS组合导航系统的状态方程转换为时间离散的形式,以便于在计算机上进行计算,离散状态方程:
式中,dt为采样时间间隔,xk-1是tk-1时刻的状态向量,xk是tk时刻的状态向量。
由于量测方程本身是时间离散的,故无需再离散化处理。
将离散化后的状态方程和测量方程抽象化得到带有偏差的非线性离散状态方程和量测方程:
将由(5)表示的非线性系统转换为SDC(State-Dependent Coefficients,SDC)的形式,得到的方程:
式中,F(xk-1,θk-1)和Ν(xk,θk)为状态转移矩阵,G(xk-1,θk-1)和M(xk,θk)为偏差系数矩阵。
本发明中PSTCSDREF算法实现步骤如下:
1、对INS/BDS组合导航系统模型初始化
即将根据经验估计的初始参数代入系统模型,设置初始状态和协方差,以便于进行一步预测,组合导航系统的初始参数为
初始状态初始数学平台在东方向误差角φe0=-0.000146°、北方向误差角φn0=0.000145°、天方向误差角φu0=-0.005818°;载体的东方向的速度ve0=0.1m/s、北方向的速度vn0=0.1m/s、天方向的速度vu0=0.1m/s;载体所在的纬度经度λ0=2.029978°、高度h0=3m;陀螺仪东方向常值漂移εe0=1.45×10-9(°)/h、北方向常值漂移εn0=1.45×10-9(°)/h、天方向常值漂移εu0=1.45×10-9(°)/h;加速度计东方向常值漂移Δe0=9.78×10-6g、北方向常值漂移Δn0=9.78×10-6g、天方向常值漂移Δu0=9.78×10-6g。
2、对状态一步预测进行计算
由第k-1步的互协方差Ck-1来计算第k步的一步预测互协方差Ck/k-1
式中,Ck-1是在时间为k-1时状态估计误差矩阵与偏差之间的互协方差矩阵。
3.对一步预测协方差进行计算
由第k-1步的状态估计误差方差Pk-1来计算第k步的一步预测方差Pk/k-1
式中,λk为自适应渐消因子,自适应渐消因子的计算方法为:
式中,Ok和Uk的计算方法如下所示:
4.计算滤波增益矩阵
通过一步预测协方差和测量噪声方差矩阵获取Kalman滤波器的增益矩阵
式中,Ωk的计算方法为:
5.计算状态更新
6.计算协方差更新
状态估计误差方差为:
状态估计误差与偏差的互协方差为:
通过以上6步循环迭代,可以得到INS/BDS组合导航系统的姿态误差、速度和位置,其中无人机姿态信息为载体在东方向、北方向和天方向的状态量误差角、和,载体速度信息包括载体的东方向的速度、北方向的速度和天方向的速度,载体位置信息包括纬度、经度、高度。
实验例:参见图2至图7,表示本申请PSTCSDREF算法和传统的SDREF算法得出的无人机组合导航系统在动、北、天方向上的位置及速度误差。可以看出PSTCSDREF算法得出的误差值都在O附近,而SDREF算法偏差较大,特别是在400s和1400s,更是出现了巨大的毛刺。该实验例中采样时间为h=1[s],当k=1时,对应的时间为T=0[s];当k=2时,对应的时间为T=1[s],每步的对应时间以此类推。在观测次数为N=50、总的采样时间为统计获得
上面结合附图和实施例对本发明作了详细的说明,但是,所属技术领域的技术人员能够理解,在不脱离本发明宗旨的前提下,还可以对上述实施例中的各个具体参数进行变更,形成多个具体的实施例,均为本发明的常见变化范围,在此不再一一详述。
Claims (9)
1.一种基于PSTCSDREF算法的无人机INS BDS组合导航方法,其特征在于,包括:
步骤1:测量无人机组合导航系统的初始参数;
步骤2:将所述初始参数带入无人机的状态方程和量测方程,所述量测方程包括量测偏差;
步骤3:获取无人机状态的一步预测、所述一步预测的协方差、滤波增益矩阵;
步骤4:利用所述一步预测、协方差和滤波增益矩阵,根据卡尔曼滤波算法,获得下一时刻的无人机状态更新;
步骤5:结合无人机的当前时刻状态与下一时刻的预测状态,获取协方差更新;
步骤6:将所述下一时刻的预测状态作为基础带入步骤3中,依次执行步骤3-步骤5,得出更下一时刻的无人机预测状态,如此循环迭代,得出无人机的运行状态。
2.根据权利要求1所述的基于PSTCSDREF算法的无人机INS BDS组合导航方法,其特征在于,所述初始参数包括:
无人机的东方向误差角、北方向误差角、天方向误差角;载体的东方向的速度、北方向的速度、天方向的速度;
无人机所在的纬度、经度、高度;
陀螺仪的东方向常值漂移、北方向常值漂移、天方向常值漂移;
加速度计的东方向常值漂移、北方向常值漂移、天方向常值漂移;
初始状态估计误差方差矩阵、初始误差角方差矩阵、初始速度方差矩阵、初始位置方差矩阵;
陀螺仪的常值漂移方差矩阵、加速度计的常值漂移方差矩阵。
3.根据权利要求1所述的基于PSTCSDREF算法的无人机INS BDS组合导航方法,所述无人机的状态方程表达式为:
4.根据权利要求3所述的基于PSTCSDREF算法的无人机INS BDS组合导航方法,其特征在于,所述量测方程为:
z=h(x)+θ+v;
式中,θ=[bvge,bvgn,bvgu,bpge,bpgn,bpgu]T是量测偏差,bvge、bvgn和bvgu分别为在导航坐标系东方向、北方向、天方向的速度量测偏差,bpge、bpgn和bpgu分别为在导航坐标系东方向、北方向、天方向的位置量测偏差,量测噪声为v=[vvge,vvgn,vvgu,vpge,vpgn,vpgu]T,vvge、vvgn和vvgu分别为在导航坐标系东方向、北方向、天方向的BDS速度量测值的随机误差,vpge、vpgn和vpgu分别为在导航坐标系东方向、北方向、天方向BDS位置量测值的随机误差。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010020948.9A CN111190207B (zh) | 2020-01-09 | 2020-01-09 | 基于pstcsdref算法的无人机ins bds组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010020948.9A CN111190207B (zh) | 2020-01-09 | 2020-01-09 | 基于pstcsdref算法的无人机ins bds组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111190207A true CN111190207A (zh) | 2020-05-22 |
CN111190207B CN111190207B (zh) | 2023-08-08 |
Family
ID=70709897
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010020948.9A Active CN111190207B (zh) | 2020-01-09 | 2020-01-09 | 基于pstcsdref算法的无人机ins bds组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111190207B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111982126A (zh) * | 2020-08-31 | 2020-11-24 | 郑州轻工业大学 | 一种全源BeiDou/SINS弹性状态观测器模型设计方法 |
CN112284388A (zh) * | 2020-09-25 | 2021-01-29 | 北京理工大学 | 一种无人机多源信息融合导航方法 |
CN113916220A (zh) * | 2021-08-30 | 2022-01-11 | 西北工业大学 | 一种具有协方差反馈控制的动态自适应导航定位方法 |
Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105988129A (zh) * | 2015-02-13 | 2016-10-05 | 南京理工大学 | 一种基于标量估计算法的ins/gnss组合导航方法 |
WO2018014602A1 (zh) * | 2016-07-19 | 2018-01-25 | 东南大学 | 适于高维gnss/ins深耦合的容积卡尔曼滤波方法 |
CN108759838A (zh) * | 2018-05-23 | 2018-11-06 | 安徽科技学院 | 基于秩卡尔曼滤波器的移动机器人多传感器信息融合方法 |
-
2020
- 2020-01-09 CN CN202010020948.9A patent/CN111190207B/zh active Active
Patent Citations (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105988129A (zh) * | 2015-02-13 | 2016-10-05 | 南京理工大学 | 一种基于标量估计算法的ins/gnss组合导航方法 |
WO2018014602A1 (zh) * | 2016-07-19 | 2018-01-25 | 东南大学 | 适于高维gnss/ins深耦合的容积卡尔曼滤波方法 |
CN108759838A (zh) * | 2018-05-23 | 2018-11-06 | 安徽科技学院 | 基于秩卡尔曼滤波器的移动机器人多传感器信息融合方法 |
Non-Patent Citations (2)
Title |
---|
任珊珊;赵良玉;娄泰山;: "基于强跟踪SDRE滤波的GPS/INS组合导航" * |
王力;杨忠辉;: "自适应序贯UKF的INS/BDS紧组合导航算法" * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111982126A (zh) * | 2020-08-31 | 2020-11-24 | 郑州轻工业大学 | 一种全源BeiDou/SINS弹性状态观测器模型设计方法 |
CN112284388A (zh) * | 2020-09-25 | 2021-01-29 | 北京理工大学 | 一种无人机多源信息融合导航方法 |
CN112284388B (zh) * | 2020-09-25 | 2024-01-30 | 北京理工大学 | 一种无人机多源信息融合导航方法 |
CN113916220A (zh) * | 2021-08-30 | 2022-01-11 | 西北工业大学 | 一种具有协方差反馈控制的动态自适应导航定位方法 |
CN113916220B (zh) * | 2021-08-30 | 2023-06-23 | 西北工业大学 | 一种具有协方差反馈控制的动态自适应导航定位方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111190207B (zh) | 2023-08-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109211276B (zh) | 基于gpr与改进的srckf的sins初始对准方法 | |
CN110398257B (zh) | Gps辅助的sins系统快速动基座初始对准方法 | |
CN103344259B (zh) | 一种基于杆臂估计的ins/gps组合导航系统反馈校正方法 | |
CN111190207B (zh) | 基于pstcsdref算法的无人机ins bds组合导航方法 | |
Jung et al. | Inertial attitude and position reference system development for a small UAV | |
CN103900574B (zh) | 一种基于迭代容积卡尔曼滤波姿态估计方法 | |
CN109945895B (zh) | 基于渐消平滑变结构滤波的惯性导航初始对准方法 | |
CN105136145A (zh) | 一种基于卡尔曼滤波的四旋翼无人机姿态数据融合的方法 | |
CN111024064A (zh) | 一种改进Sage-Husa自适应滤波的SINS/DVL组合导航方法 | |
CN109945859B (zh) | 一种自适应h∞滤波的运动学约束捷联惯性导航方法 | |
CN111189442B (zh) | 基于cepf的无人机多源导航信息状态预测方法 | |
CN112798021B (zh) | 基于激光多普勒测速仪的惯导系统行进间初始对准方法 | |
CN109507706B (zh) | 一种gps信号丢失的预测定位方法 | |
CN110849360B (zh) | 面向多机协同编队飞行的分布式相对导航方法 | |
CN101246012A (zh) | 一种基于鲁棒耗散滤波的组合导航方法 | |
CN110941285A (zh) | 一种基于双ip核的无人机飞行控制系统 | |
CN111750865A (zh) | 一种用于双功能深海无人潜器导航系统的自适应滤波导航方法 | |
CN115033844A (zh) | 一种无人机状态估计方法、系统、设备及可读存储介质 | |
CN111982126B (zh) | 一种全源BeiDou/SINS弹性状态观测器模型设计方法 | |
CN111207734B (zh) | 一种基于ekf的无人机组合导航方法 | |
Kortunov et al. | Integrated mini INS based on MEMS sensors for UAV control | |
CN114111840B (zh) | 一种基于组合导航的dvl误差参数在线标定方法 | |
CN114964226A (zh) | 噪声自适应强跟踪扩展卡尔曼滤波器四旋翼姿态解算方法 | |
CN106931966A (zh) | 一种基于泰勒高阶余项拟合的组合导航方法 | |
Wang et al. | An Adaptive Federated Filter Based on Variational Bayes with Application to Multi-source Navigation |
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 |