CN108981708A - 四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法 - Google Patents
四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法 Download PDFInfo
- Publication number
- CN108981708A CN108981708A CN201810871721.8A CN201810871721A CN108981708A CN 108981708 A CN108981708 A CN 108981708A CN 201810871721 A CN201810871721 A CN 201810871721A CN 108981708 A CN108981708 A CN 108981708A
- Authority
- CN
- China
- Prior art keywords
- moment
- torque model
- fault
- subfilter
- magnetic sensor
- 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
- G01C21/00—Navigation; Navigational instruments not provided for in groups G01C1/00 - G01C19/00
- G01C21/20—Instruments for performing navigational calculations
-
- 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
-
- 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/18—Stabilised platforms, e.g. by gyroscope
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Automation & Control Theory (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Navigation (AREA)
Abstract
本发明公开一种四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,步骤是:周期读取k时刻四旋翼飞行器机载传感器信息;执行故障检测滤波器及故障定位策略,判断z轴陀螺、扭矩模型、磁传感器的故障;确定各个子滤波器的状态方程,进行数据融合;根据故障检测结果,进行故障隔离;执行全局滤波器,对无故障的子滤波器进行数据融合,得到航向角信息;对各个子滤波器、故障检测滤波器状态量进行重置,并执行***重置策略。此种方法通过四旋翼飞行器的扭矩模型,形成z轴陀螺的冗余,实现z轴陀螺、磁传感器、扭矩模型的故障检测及***重置,在陀螺故障时仍能获得姿态角、航向角的准确估计。
Description
技术领域
本发明属于组合导航及容错导航领域,具体涉及一种四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法。
背景技术
四旋翼飞行器具有体积小、结构简单、可悬停和垂直起降等优点,特别适合在近地面环境(如室内、城区和丛林等)中执行监视、侦察等任务,具有广阔的军事和民用前景。导航***为四旋翼飞行器提供其飞行控制***所必须的导航信息,是其完成各种复杂飞行任务的必要保障。
目前四旋翼飞行器常用的传感器包括惯性传感器、GNSS(卫星导航***)、磁传感器、气压高度计,其中惯性传感器包括陀螺仪与加速度计。受成本、体积所限,四旋翼飞行器中选用的惯性传感器精度、可靠性较低,易受外界温度、振动干扰而产生性能下降,甚至失效。此时,会导致导航***精度下降,影响飞行安全。目前,尚未有针对惯性传感器失效情况下的四旋翼飞行器导航方法。
发明内容
本发明的目的,在于提供一种四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,通过四旋翼飞行器的扭矩模型,形成z轴陀螺的冗余,实现z轴陀螺、磁传感器、扭矩模型的故障检测及***重置,在陀螺故障时仍能获得姿态角、航向角的准确估计
为了达成上述目的,本发明的解决方案是:
一种四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,包括如下步骤:
步骤一:周期读取k时刻四旋翼飞行器机载传感器信息,包括旋翼转速传感器信息ω1(k)、ω2(k)、ω3(k)、ω4(k),其分别为四个旋翼的转速;磁传感器信息ψm(k);陀螺信息其分别为机体系相对于导航系的角速度在机体系x、y、z轴上的分量;加计信息分别为机体系相对于导航系的加速度在机体系x、y、z轴上的分量;
步骤二:执行故障检测滤波器及故障定位策略,判断z轴陀螺、扭矩模型、磁传感器的故障;
步骤三:根据步骤二的故障定位结果,确定各个子滤波器的状态方程,进行扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、z轴陀螺/磁传感器子滤波器的数据融合;
步骤四:根据故障检测结果,对扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、扭矩模型/加速度计子滤波器进行故障隔离;
步骤五:根据步骤四的故障定位和隔离结果,执行全局滤波器,对无故障的子滤波器进行数据融合,得到航向角信息:
步骤六:根据全局滤波器结果,对各个子滤波器、故障检测滤波器状态量进行重置,并执行***重置策略。
采用上述方案后,本发明利用四旋翼飞行器的扭矩模型,与机载陀螺、加速度计、磁传感器相融合,可实现z轴陀螺故障情况下对航向角的准确估计。在该方法中,通过扭矩模型构建z轴陀螺的冗余信息,建立故障检测函数,实现对z轴陀螺故障、磁传感器故障以及扭矩模型故障的检测;同时,在z轴陀螺故障情况下,通过扭矩模型对其角速度信号进行重构,代替故障的陀螺进行导航解算,实现容错导航。该方法无需增加额外的惯性传感器,可实现对z轴陀螺的故障检测、隔离、信号重构,保障陀螺失效情况下航向角的估计精度,并且能够检测磁传感器故障。
附图说明
图1是本发明的流程图;
图2是故障检测结构图;
图3是z轴陀螺故障时的故障检测结果;
图4是z轴陀螺故障时的z轴角速度估计结果;
图5是z轴陀螺故障时的航向角估计结果;
图6是扭矩模型故障时的故障检测结果;
图7是磁传感器故障时的故障检测结果。
具体实施方式
以下将结合附图,对本发明的技术方案及有益效果进行详细说明。
如图1所示,本发明提供一种四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,其故障检测结构如图2所示,具体是采用半物理仿真的形式,四旋翼无人机做带有z轴角加速度的航向转动,采集机载传感器实验数据,其包含惯性传感器实验数据、电子调速器数据、GPS数据、磁传感器数据。所述方法包括如下步骤:
步骤一:周期读取k时刻四旋翼飞行器机载传感器信息,包括旋翼转速传感器信息ω1(k)、ω2(k)、ω3(k)、ω4(k),其分别为四个旋翼的转速;磁传感器信息ψm(k);陀螺信息其分别为机体系相对于导航系的角速度在机体系x、y、z轴上的分量;加计信息分别为机体系相对于导航系的加速度在机体系x、y、z轴上的分量。
步骤二:执行故障检测滤波器及故障定位策略,判断z轴陀螺、扭矩模型、磁传感器的故障,故障检测滤波器由扭矩模型/z轴陀螺检测滤波器、扭矩模型/磁传感器检测滤波器、z轴陀螺/磁传感器检测滤波器3个检测滤波器组成,上述3个检测滤波器的状态更新、故障定位步骤如下:
步骤21,扭矩模型/z轴陀螺检测滤波器故障检测过程步骤如下:
步骤211,计算k时刻扭矩模型/z轴陀螺检测滤波器的状态估计值及估计均方误差
kz0(k)=kz0(k-1)
kz1(k)=kz1(k-1)
kz2(k)=kz2(k-1)
式中,kz0(k)、kz1(k)、kz2(k)为k时刻扭矩模型系数;kz0(k-1)、kz1(k-1)、kz2(k-1)为k-1时刻扭矩模型系数;ωmz(k-1)为通过扭矩模型计算得到的k-1时刻的机体系相对于导航系的角速度在机体系z轴上的分量;ωmz(k)为通过扭矩模型计算得到的k时刻的机体系相对于导航系的角速度在机体系z轴上的分量;ωi(k)为第i个旋翼转速,i=1,2,3,4;ΔT为离散采样周期;上标T表示转置;为雅可比矩阵,I3×3为3×3的单位矩阵,03×1为3×1的零矩阵;为k时刻估计均方误差;Gd1(k-1)=[I4×4],为***噪声系数矩阵,I4×4为4×4单位矩阵,;Wd1(k-1)=[wkz0(k-1)wkz1(k-1)wkz2(k-1)wmz(k-1)]T,为***噪声,wkz0(k-1)、wkz1(k-1)、wkz2(k-1)为k-1时刻扭矩模型系数的白噪声;wmz(k-1)为k-1时刻扭矩模型白噪声;
步骤212,计算k时刻扭矩模型/z轴陀螺检测滤波器的故障统计参数
式中,为k时刻扭矩模型/z轴陀螺检测滤波器的统计参数,为k时刻的残差, 为机体系相对于导航系的角速度在机体系z轴上的分量,通过陀螺输出获得, 为k时刻的残差方差,Hd1(k)=[0 0 0 1]T,Rd1(k)=diag([wgz(k)]2),wgz(k)为k时刻的机体系z轴陀螺的白噪声,diag表示对角化,-1表示求逆;
步骤213,根据故障统计参数结果,计算k时刻扭矩模型/z轴陀螺检测滤波器的检测函数
式中,T1是阈值,当J1(k)=1时,扭矩模型或z轴陀螺故障;当J1(k)=0时,扭矩模型和z轴陀螺均无故障;
步骤22,扭矩模型/磁传感器检测滤波器故障检测过程步骤如下:
步骤221,计算k时刻扭矩模型/磁传感器检测滤波器的状态估计值及估计均方误差
kz0(k)=kz0(k-1)
kz1(k)=kz1(k-1)
kz2(k)=kz2(k-1)
式中,q0(k)、q1(k)、q2(k)、q3(k)为k时刻的四元素;为k时刻机体系相对于导航系的角速度在机体系x、y轴上的分量,通过x、y轴陀螺输出获得;为k时刻估计均方误差;I3×3为3×3的单位矩阵,03×1为
3×1的零矩阵,03×4为3×4的零矩阵,01×4为1×4的零矩阵,04×3为4×3的零矩阵,
Wd2(k-1)=[wk0(k-1) wk1(k-1) wk2(k-1) wmz(k-1) wgx(k-1) wgy(k-1) wωz(k-1)]Twgx(k-1)、wgy(k-1)分别为机体系x、y轴陀螺的白噪声,wωz(k-1)为z轴角速度白噪声,01×3为1×3的零矩阵;04×1为4×1的零矩阵;
步骤222,计算k时刻检测滤波器的故障统计参数
式中,为k时刻扭矩模型/磁传感器检测器的统计参数,为k时刻的残差,Yd2(k)=ψm(k),ψm(k)为k时刻磁航向角,通过磁传感器获得; 为k时刻的残差方差,Rd2(k)=diag([wψm(k)]2),wψm(k)为k时刻磁航向角白噪声;
步骤223,根据故障统计参数结果,计算k时刻检测滤波器的检测函数
式中,T2是阈值,当J2(k)=1时,扭矩模型或磁传感器故障;当J2(k)=0时,扭矩模型或磁传感器均无故障;
步骤23,z轴陀螺/磁传感器检测滤波器检测过程步骤如下:
步骤231,计算k时刻z轴陀螺/磁传感器检测滤波器的状态估计值及估计均方误差
式中,为雅可比矩阵;Wd3(k-1)=[wgx(k-1) wgy(k-1) wgz(k-1)]T;
步骤232,计算k时刻检测滤波器的故障统计参数
式中,为k时刻z轴陀螺/磁传感器检测器的统计参数;为k时刻的残差;为k时刻的残差方差;Yd3(k)=ψm(k);
步骤233,计算k时刻检测滤波器的检测函数
式中,T3是阈值,当J3(k)=1时,z轴陀螺或磁传感器故障;当J3(k)=0时,z轴陀螺或磁传感器均无故障;
步骤24,根据各个检测滤波器的检测函数结果,计算k时刻故障定位函数及根据故障定位函数计算结果,进行故障定位,步骤如下:
步骤241,计算k时刻预发生故障定位函数
式中,“∨”表示逻辑运算中“或”运算符,“∧”表示逻辑运算中“与”运算符;当Fpre(k)=1时,进入预发生故障阶段;当Fpre(k)=0时,未进入预发生故障阶段;
步骤242,计算z轴陀螺故障定位函数
式中,“∧”表示逻辑运算中“与”运算符,“-”表示逻辑运算中“非”运算符;当FG(k)=1时,z轴陀螺故障;当FG(k)=0时,z轴陀螺无故障;
步骤243,计算扭矩模型故障定位函数
当FT(k)=1时,扭矩模型故障;当FT(k)=0时,扭矩模型无故障;
步骤244,计算磁传感器故障定位函数
当FMag(k)=1时,磁传感器故障;当FMag(k)=0时,磁传感器无故障;
步骤245,计算无故障定位函数
当Fno(k)=1时,无故障。
步骤三:根据步骤二的故障定位结果,确定各个子滤波器的状态方程,进行扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、扭矩模型/加速度计子滤波器的数据融合按照如下步骤执行三个子滤波器:
步骤31,计算k时刻三个子滤波器的状态预测及预测均方误差
情况311,无故障或z轴陀螺故障或磁传感器故障时,状态预测及预测均方误差过程如下:
步骤3111,计算k时刻扭矩模型系数
kz0(k|k-1)=kz0(k-1)
kz1(k|k-1)=kz1(k-1)
kz2(k|k-1)=kz2(k-1)
式中,kz0(k|k-1)、kz1(k|k-1)、kz2(k|k-1)为扭矩模型参数在k-1时刻到k时刻的状态一步预测;
步骤3112,计算k时刻角速度预测
式中,ωmz(k|k-1)为z轴角速度在k-1时刻到k时刻的状态一步预测;
步骤3113,计算k时刻四元素预测
式中,q0(k|k-1)、q1(k|k-1)、q2(k|k-1)、q3(k|k-1)为四元素在k-1时刻到
k时刻的状态一步预测;
步骤3114,计算一步预测均方误差PC(k|k-1)
PC(k|k-1)=ΦC(k|k-1)PC(k-1)ΦC(k|k-1)T+GC(k-1)QC(k-1)GC(k-1)T
式中,PC(k|k-1)为k-1到k时刻的一步预测均方误差;为雅可比矩阵,为非线性状态方程,为k-1时刻状态量, QC(k-1)=diag(WC(k-1)2);WC(k-1)=[wk0(k-1) wk1(k-1) wk2(k-1) wmz(k-1) wgx(k-1) wgy(k-1) wωz(k-1)]T为***噪声,
情况312,预发生故障或扭矩模型故障时,状态预测及预测均方误差过程如下:
3个子滤波器的状态方程中关于z轴角速度的预测方程修改为ωmz(k|k-1)=ωmz(k-1),雅可比矩阵修改为:其余同步骤311情况;
步骤32,扭矩模型/z轴陀螺子滤波器量测更新步骤如下:
步骤321,计算k时刻的扭矩模型/z轴陀螺子滤波器的滤波增益
KC1(k)=PC(k|k-1)HC1(k)T[HC1(k)PC(k|k-1)HC1(k)T+RC1(k)]-1
式中,HC1(k)=[01×3 1 01×4];KC1(k)为k时刻的滤波增益,RC1(k)=diag([wgz(k)]2),为k时刻的量测噪声;
步骤322,计算k时刻扭矩模型/z轴陀螺子滤波器状态估计值
式中,为k时刻状态量的估计值;为k时刻的量测量;
步骤323,计算k时刻扭矩模型/z轴陀螺子滤波器估计均方误差PC1(k)
PC1(k)=[I-KC1(k)HC1(k)]PC(k|k-1)
式中,PC1(k)为k时刻估计均方误差;I为单位矩阵;
步骤33,扭矩模型/磁传感器子滤波器量测更新步骤如下:
步骤331,计算k时刻的扭矩模型/磁传感器子滤波器的滤波增益
KC2(k)=PC(k|k-1)HC2(k)T[HC2(k)PC(k|k-1)HC2(k)T+RC2(k)]-1
式中,HC2(k)=[01×4 N1×4],KC2(k)为k时刻的滤波增益,为k时刻的量测噪声,
为k时刻的磁航向白噪声;
步骤332,计算k时刻扭矩模型/磁传感器子滤波器状态估计值
式中,为k时刻状态量的估计;YC2(k)=ψm,为k时刻的量测量;其中,q0=q0(k|k-1)、q1=q1(k|k-1)、q2=q2(k|k-1)、q3=q3(k|k-1);
步骤333,计算k时刻扭矩模型/磁传感器子滤波器估计均方误差PC2(k)
PC2(k)=[I-KC2(k)HC2(k)]PC(k|k-1)
式中,PC2(k)为k时刻估计均方误差,I为单位矩阵;
步骤34,扭矩模型/加速度计子滤波器量测更新步骤如下:
步骤341,计算k时刻的扭矩模型/加速度计子滤波器的滤波增益
KC3(k)=PC(k|k-1)HC3(k)T[HC3(k)PC(k|k-1)HC3(k)T+RC3(k)]-1
式中,HC3(k)=[02×4 ν2×4],g表示重力加速度;KC3(k)为k时刻的滤波增益;RC3(k)=diag([wfbx(k) wfby(k)]2),为k时刻的量测噪声,wfbx(k)、wfby(k)分别为机体系x、y轴加速度计白噪声;
步骤342,计算k时刻扭矩模型/加速度计子滤波器状态估计值
式中,为k时刻状态量的估计值,为k时刻的量测量,
步骤343,计算k时刻扭矩模型/加速度计子滤波器估计均方误差PC3(k)
PC3(k)=[I-KC3(k)HC3(k)]PC(k|k-1)
式中,PC3(k)为k时刻估计均方误差,I为单位矩。
步骤四:根据故障检测结果,对扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、扭矩模型/加速度计子滤波器进行故障隔离,对无故障的子滤波器进行全局融合:
情况41,无故障时,各个子滤波器按照如下进行故障隔离
步骤411,根据故障定位结果,隔离故障子滤波器
三个子滤波器均参与全局滤波,无子滤波器被隔离;
步骤412,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC1(k)-1+PC2(k)-1+PC3(k)-1]-1
步骤413,计算k时刻的全局滤波器的状态估计值
情况42,预发生故障时,各个子滤波器按照如下进行故障隔离
步骤421,根据故障定位结果,隔离故障子滤波器
采用扭矩模型故障时的状态方程,隔离扭矩模型/z轴陀螺子滤波器;
步骤422,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC2(k)-1+PC3(k)-1]-1
步骤423,计算k时刻的全局滤波器的状态估计值
情况43,z轴陀螺故障时,各个子滤波器按照如下进行故障隔离
步骤431,根据故障定位结果,隔离故障子滤波器
扭矩模型/z轴陀螺子滤波器被隔离,不进行全局融合滤波估计;
步骤432,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC2(k)-1+PC3(k)-1]-1
步骤433,计算k时刻的全局滤波器的状态估计值
情况44,扭矩模型故障时,各个子滤波器按照如下进行故障隔离
步骤441,根据故障定位结果,隔离故障子滤波器
采用扭矩模型故障时的状态方程,无子滤波器被隔离;
步骤442,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC1(k)-1+PC2(k)-1+PC3(k)-1]-1
步骤443,计算k时刻的全局滤波器的状态估计值
情况45,磁传感器故障时,各个子滤波器按照如下进行故障隔离
步骤451,根据故障定位结果,隔离故障子滤波器
使用冗余的磁传感器代替故障的磁传感器进行子滤波器滤波;
步骤452,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC1(k)-1+PC2(k)-1+PC3(k)-1]-1
步骤453,计算k时刻的全局滤波器的状态估计值
无子滤波器被隔离,按照步骤三中的磁传感器故障时,在扭矩模型/磁传感器子滤波器中使用冗余的磁传感器代替故障的磁传感器进行融合滤波。
步骤五:根据步骤四的故障定位和隔离结果对各个子滤波器、故障检测滤波器状态量进行重置,并执行***重置策略:
步骤51,根据故障检测结果及全局滤波结果对各个子滤波器进行状态量及均方误差重置
情况511,无故障时,三个子滤波器状态量及均方误差重置
PC(k)=3Pg(k)
情况512,预发生故障时,三个子滤波器状态量及均方误差重置
PC(k)=2Pg(k)
情况513,z轴陀螺故障时,三个子滤波器状态量及均方误差重置
PC(k)=2Pg(k)
情况514,扭矩模型故障时,三个子滤波器状态量及均方误差重置
PC(k)=3Pg(k)
情况515,磁传感器故障时,三个子滤波器状态量及均方误差重置
PC(k)=3Pg(k)
步骤52,根据故障检测结果及全局滤波结果对各个检测滤波器进行状态量及均方误差重置
检测滤波器为n步预测卡方检测器,设置n步重置周期,在n步之内不进行重置,使用自身的状态估计结果进行状态递推,在第n步时使用全局滤波结果进行状态量重置,状态及均方误差重置根据滤波结果采用如下方式:
情况521,无故障时,第n步检测滤波器状态及均方误差重置
式中,表示使用状态向量中的第1列中,第i到第j行元素进行重置;Pg(k)[i:j;i:j]表示使用误差估计矩阵中的第i到第j列、第i到第j行元素进行重置;
情况522,预发生故障时,检测滤波器状态及均方误差重置为如下:
扭矩模型/z轴陀螺检测滤波器、扭矩模型/磁传感器检测滤波器、z轴陀螺/磁传感器检测滤波器不进行重置更新,只进行累积直至确定故障位置;
情况523,z轴陀螺故障时,检测滤波器状态及均方误差重置
当检测到z轴陀螺故障时,对扭矩模型/z轴陀螺检测滤波器、z轴陀螺/磁传感器检测滤波器进行立即重置,其他的检测器按照n步重置规则,采用如下方法进行重置:
情况524,扭矩模型故障时,检测滤波器状态及均方误差重置
当检测到扭矩模型故障时,对扭矩模型/z轴陀螺检测滤波器、扭矩模型/磁传感器检测滤波器进行立即重置,其他的检测器按照n步重置规则,采用如下方法进行重置:
情况525,磁传感器故障时,检测滤波器状态及均方误差重置
当检测到磁传感器故障时,扭矩模型/磁传感器检测滤波器、z轴陀螺/磁传感器检测滤波器不使用n步重置规则,每一步均进行重置,其他的检测其按照n步重置规则,采用如下方法进行重置:
步骤53,当检测到故障后,基于故障特性,执行以下***重置策略
设置z轴陀螺和扭矩模型故障隔离周期,当检测到z轴陀螺或扭矩模型故障后,进入故障隔离周期,在隔离周期内认为一直存在故障,在隔离周期内若再次检测到故障,重新开始隔离周期,若隔离周期结束后仍未检测到故障,则认为故障消失,***处于无故障状态。
Claims (5)
1.一种四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,其特征在于包括如下步骤:
步骤一:周期读取k时刻四旋翼飞行器机载传感器信息,包括旋翼转速传感器信息ω1(k)、ω2(k)、ω3(k)、ω4(k),其分别为四个旋翼的转速;磁传感器信息ψm(k);陀螺信息其分别为机体系相对于导航系的角速度在机体系x、y、z轴上的分量;加计信息分别为机体系相对于导航系的加速度在机体系x、y、z轴上的分量;
步骤二:执行故障检测滤波器及故障定位策略,判断z轴陀螺、扭矩模型、磁传感器的故障;
步骤三:根据步骤二的故障定位结果,确定各个子滤波器的状态方程,进行扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、扭矩模型/加速度计子滤波器的滤波融合估计;
步骤四:根据故障检测结果,对扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、扭矩模型/加速度计子滤波器进行故障隔离,对无故障的子滤波器进行全局融合;
步骤五:根据步骤四的故障定位和隔离结果对各个子滤波器、故障检测滤波器状态量进行重置,并执行***重置策略。
2.如权利要求1所述的四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,其特征在于:所述步骤二中,故障检测滤波器由扭矩模型/z轴陀螺检测滤波器、扭矩模型/磁传感器检测滤波器、z轴陀螺/磁传感器检测滤波器3个检测滤波器组成,上述3个检测滤波器的检测过程、***故障定位步骤如下:
步骤21,扭矩模型/z轴陀螺检测滤波器故障检测过程步骤如下:
步骤211,计算k时刻扭矩模型/z轴陀螺检测滤波器的状态估计值及估计均方误差
kz0(k)=kz0(k-1)
kz1(k)=kz1(k-1)
kz2(k)=kz2(k-1)
式中,kz0(k)、kz1(k)、kz2(k)为k时刻扭矩模型系数;kz0(k-1)、kz1(k-1)、kz2(k-1)为k-1时刻扭矩模型系数;ωmz(k-1)为通过扭矩模型计算得到的k-1时刻的机体系相对于导航系的角速度在机体系z轴上的分量;ωmz(k)为通过扭矩模型计算得到的k时刻的机体系相对于导航系的角速度在机体系z轴上的分量;ωi(k)为第i个旋翼转速,i=1,2,3,4;ΔT为离散采样周期;上标T表示转置;为雅克比矩阵,I3×3为3×3的单位矩阵,03×1为3×1的零矩阵;为k时刻估计均方误差;Gd1(k-1)=[I4×4],为***噪声系数矩阵,I4×4为4×4单位矩阵,;Wd1(k-1)=[wkz0(k-1) wkz1(k-1) wkz2(k-1) wmz(k-1)]T,为***噪声,wkz0(k-1)、wkz1(k-1)、wkz2(k-1)为k-1时刻扭矩模型系数的白噪声,wmz(k-1)为k-1时刻扭矩模型白噪声;
步骤212,计算k时刻扭矩模型/z轴陀螺检测滤波器的故障统计参数
式中,为k时刻扭矩模型/z轴陀螺检测滤波器的统计参数,为k时刻的残差, 为机体系相对于导航系的角速度在机体系z轴上的分量,通过陀螺输出获得, 为k时刻的残差方差,Hd1(k)=[0 0 0 1]T,Rd1(k)=diag([wgz(k)]2),wgz(k)为k时刻的机体系z轴陀螺的白噪声,diag表示对角化,-1表示求逆;
步骤213,根据故障统计参数结果,计算k时刻扭矩模型/z轴陀螺检测滤波器的检测函数
式中,T1是阈值,当J1(k)=1时,扭矩模型或z轴陀螺故障,当J1(k)=0时,扭矩模型和z轴陀螺均无故障;
步骤22,扭矩模型/磁传感器检测滤波器故障检测过程步骤如下:
步骤221,计算k时刻扭矩模型/磁传感器检测滤波器的状态估计值及估计均方误差
kz0(k)=kz0(k-1)
kz1(k)=kz1(k-1)
kz2(k)=kz2(k-1)
式中,q0(k)、q1(k)、q2(k)、q3(k)为k时刻的四元素;为k时刻机体系相对于导航系的角速度在机体系x、y轴上的分量,通过x、y轴陀螺输出获得;为k时刻估计均方误差;I3×3为3×3的单位矩阵,03×1为3×1的零矩阵,03×4为3×4的零矩阵,01×4为1×4的零矩阵,04×3为4×3的零矩阵,
Wd2(k-1)=[wk0(k-1) wk1(k-1) wk2(k-1) wmz(k-1) wgx(k-1) wgy(k-1) wωz(k-1)]T
wgx(k-1)、wgy(k-1)分别为机体系x、y轴陀螺的白噪声,wωz(k-1)为z轴角速度白噪声,01×3为1×3的零矩阵;04×1为4×1的零矩阵;
步骤222,计算k时刻检测滤波器的故障统计参数
式中,为k时刻扭矩模型/磁传感器检测器的统计参数,为k时刻的残差,Yd2(k)=ψm(k),ψm(k)为k时刻磁航向角,通过磁传感器获得;
为k时刻的残差方差;Rd2(k)=diag([wψm(k)]2),wψm(k)为k时刻磁航向角白噪声;
步骤223,根据故障统计参数结果,计算k时刻检测滤波器的检测函数
式中,T2是阈值,当J2(k)=1时,扭矩模型或磁传感器故障;当J2(k)=0时,扭矩模型或磁传感器均无故障;
步骤23,z轴陀螺/磁传感器检测滤波器检测过程步骤如下:
步骤231,计算k时刻z轴陀螺/磁传感器检测滤波器的状态估计值及估计均方误差
式中,为雅可比矩阵;Wd3(k-1)=[wgx(k-1) wgy(k-1) wgz(k-1)]T;
步骤232,计算k时刻检测滤波器的故障统计参数
式中,为k时刻z轴陀螺/磁传感器检测器的统计参数;为k时刻的残差;为k时刻的残差方差;Rd3(k)=diag([wψm(k)]2);Yd3(k)=ψm(k);
步骤233,根据故障统计参数结果,计算k时刻检测滤波器的检测函数
式中,T3是阈值,当J3(k)=1时,z轴陀螺或磁传感器故障;当J3(k)=0时,z轴陀螺或磁传感器均无故障;
步骤24,根据各个检测滤波器的检测函数结果,计算k时刻故障定位函数及根据故障定位函数计算结果,进行故障定位,步骤如下:
步骤241,计算k时刻预发生故障定位函数
式中,“∨”表示逻辑运算中“或”运算符,“∧”表示逻辑运算中“与”运算符;当Fpre(k)=1时,进入预发生故障阶段;当Fpre(k)=0时,未进入预发生故障阶段;
步骤242,计算z轴陀螺故障定位函数
式中,“∧”表示逻辑运算中“与”运算符,“-”表示逻辑运算中“非”运算符;当FG(k)=1时,z轴陀螺故障;当FG(k)=0时,z轴陀螺无故障;
步骤243,计算扭矩模型故障定位函数
当FT(k)=1时,扭矩模型故障;当FT(k)=0时,扭矩模型无故障;
步骤244,计算磁传感器故障定位函数
当FMag(k)=1时,磁传感器故障;当FMag(k)=0时,磁传感器无故障;
步骤245,计算无故障定位函数
当Fno(k)=1时,无故障。
3.如权利要求1所述的四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,其特征在于:所述步骤三中,按照如下步骤进行扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、扭矩模型/加速度计子滤波器的数据融合;
步骤31,计算k时刻三个子滤波器的状态预测及预测均方误差
情况311,无故障或z轴陀螺故障或磁传感器故障时,状态预测及预测均方误差过程如下:
步骤3111,计算k时刻扭矩模型系数
kz0(k|k-1)=kz0(k-1)
kz1(k|k-1)=kz1(k-1)
kz2(k|k-1)=kz2(k-1)
式中,kz0(k|k-1)、kz1(k|k-1)、kz2(k|k-1)为扭矩模型参数在k-1时刻到k时刻的状态一步预测;
步骤3112,计算k时刻角速度预测
式中,ωmz(k|k-1)为z轴角速度在k-1时刻到k时刻的状态一步预测;
步骤3113,计算k时刻四元素预测
式中,q0(k|k-1)、q1(k|k-1)、q2(k|k-1)、q3(k|k-1)为四元素在k-1时刻到k时刻的状态一步预测;
步骤3114,计算一步预测均方误差PC(k|k-1)
PC(k|k-1)=ΦC(k|k-1)PC(k-1)ΦC(k|k-1)T+GC(k-1)QC(k-1)GC(k-1)T
式中,PC(k|k-1)为k-1到k时刻的一步预测均方误差;为雅可比矩阵,为非线性状态方程,为k-1时刻状态量,
WC(k-1)=[wk0(k-1) wk1(k-1) wk2(k-1) wmz(k-1) wgx(k-1) wgy(k-1) wωz(k-1)]T为***噪声,
情况312,预发生故障或扭矩模型故障时,状态预测及预测均方误差过程如下:
3个子滤波器的状态方程中关于z轴角速度的预测方程修改为ωmz(k|k-1)=ωmz(k-1),雅可比矩阵修改为:其余同步骤311情况;
步骤32,扭矩模型/z轴陀螺子滤波器量测更新步骤如下:
步骤321,计算k时刻的扭矩模型/z轴陀螺子滤波器的滤波增益
KC1(k)=PC(k|k-1)HC1(k)T[HC1(k)PC(k|k-1)HC1(k)T+RC1(k)]-1
式中,HC1(k)=[01×3 1 01×4];KC1(k)为k时刻的滤波增益,RC1(k)=diag([wgz(k)]2),为k时刻的量测噪声;
步骤322,计算k时刻扭矩模型/z轴陀螺子滤波器状态估计值
式中,为k时刻状态量的估计值;为k时刻的量测量;
步骤323,计算k时刻扭矩模型/z轴陀螺子滤波器估计均方误差PC1(k)
PC1(k)=[I-KC1(k)HC1(k)]PC(k|k-1)
式中,PC1(k)为k时刻估计均方误差;I为单位矩阵;
步骤33,扭矩模型/磁传感器子滤波器量测更新步骤如下:
步骤331,计算k时刻的扭矩模型/磁传感器子滤波器的滤波增益
KC2(k)=PC(k|k-1)HC2(k)T[HC2(k)PC(k|k-1)HC2(k)T+RC2(k)]-1
式中,HC2(k)=[01×4 N1×4],KC2(k)为k时刻的滤波增益,为k时刻的量测噪声,
为k时刻的磁航向白噪声;
步骤332,计算k时刻扭矩模型/磁传感器子滤波器状态估计值
式中,为k时刻状态量的估计;YC2(k)=ψm(k),为k时刻的量测量;其中,q0=q0(k|k-1)、q1=q1(k|k-1)、q2=q2(k|k-1)、q3=q3(k|k-1);
步骤333,计算k时刻扭矩模型/磁传感器子滤波器估计均方误差PC2(k)
PC2(k)=[I-KC2(k)HC2(k)]PC(k|k-1)
式中,PC2(k)为k时刻估计均方误差,I为单位矩阵;
步骤34,扭矩模型/加速度计子滤波器量测更新步骤如下:
步骤341,计算k时刻的扭矩模型/加速度计子滤波器的滤波增益
KC3(k)=PC(k|k-1)HC3(k)T[HC3(k)PC(k|k-1)HC3(k)T+RC3(k)]-1
式中,HC3(k)=[02×4 ν2×4];g表示重力加速度;KC3(k)为k时刻的滤波增益;RC3(k)=diag([wfbx(k) wfby(k)]2),为k时刻的量测噪声,wfbx(k)、wfby(k)分别为机体系x、y轴加速度计白噪声;
步骤342,计算k时刻扭矩模型/加速度计子滤波器状态估计值
式中,为k时刻状态量的估计值,为k时刻的量测量,
步骤343,计算k时刻扭矩模型/加速度计子滤波器估计均方误差PC3(k)
PC3(k)=[I-KC3(k)HC3(k)]PC(k|k-1)
式中,PC3(k)为k时刻估计均方误差,I为单位矩。
4.如权利要求1所述的四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,其特征在于:所述步骤四根据故障检测结果,对扭矩模型/z轴陀螺子滤波器、扭矩模型/磁传感器子滤波器、扭矩模型/加速度计子滤波器进行故障隔离,具体内容是:
情况41,无故障时,各个子滤波器按照如下进行故障隔离
步骤411,根据故障定位结果,隔离故障子滤波器
三个子滤波器均参与全局滤波,无子滤波器被隔离;
步骤412,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC1(k)-1+PC2(k)-1+PC3(k)-1]-1
步骤413,计算k时刻的全局滤波器的状态估计值
情况42,预发生故障时,各个子滤波器按照如下进行故障隔离
步骤421,根据故障定位结果,隔离故障子滤波器
采用扭矩模型故障时的状态方程,隔离扭矩模型/z轴陀螺子滤波器;
步骤422,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC2(k)-1+PC3(k)-1]-1
步骤423,计算k时刻的全局滤波器的状态估计值
情况43,z轴陀螺故障时,各个子滤波器按照如下进行故障隔离:
步骤431,根据故障定位结果,隔离故障子滤波器
扭矩模型/z轴陀螺子滤波器被隔离,不进行全局融合滤波估计;
步骤432,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC2(k)-1+PC3(k)-1]-1
步骤433,计算k时刻的全局滤波器的状态估计值
情况44,扭矩模型故障时,各个子滤波器按照如下进行故障隔离
步骤441,根据故障定位结果,隔离故障子滤波器
采用扭矩模型故障时的状态方程,无子滤波器被隔离;
步骤442,计算k时刻的全局滤波器的估计均方误差
Pg(k)=[PC1(k)-1+PC2(k)-1+PC3(k)-1]-1
步骤443,计算k时刻的全局滤波器的状态估计值
情况45,磁传感器故障时,各个子滤波器按照如下进行故障隔离:
步骤451,根据故障定位结果,隔离故障子滤波器
使用冗余的磁传感器代替故障的磁传感器进行子滤波器滤波;
步骤452,计算k时刻的全局滤波器的估计均方误差:
Pg(k)=[PC1(k)-1+PC2(k)-1+PC3(k)-1]-1
步骤453,计算k时刻的全局滤波器的状态估计值:
无子滤波器被隔离,按照步骤三中的磁传感器故障时,在扭矩模型/磁传感器子滤波器中使用冗余的磁传感器代替故障的磁传感器进行融合滤波。
5.如权利要求1所述的四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法,其特征在于,所述步骤五的具体过程是:
步骤51,根据故障检测结果及全局滤波结果对各个子滤波器进行状态量及均方误差重置
情况511,无故障时,三个子滤波器状态量及均方误差重置
PC(k)=3Pg(k)
情况512,预发生故障时,三个子滤波器状态量及均方误差重置
PC(k)=2Pg(k)
情况513,z轴陀螺故障时,三个子滤波器状态量及均方误差重置
PC(k)=2Pg(k)
情况514,扭矩模型故障时,三个子滤波器状态量及均方误差重置
PC(k)=3Pg(k)
情况515,磁传感器故障时,三个子滤波器状态量及均方误差重置
PC(k)=3Pg(k)
步骤52,根据故障检测结果及全局滤波结果对各个检测滤波器进行状态量及均方误差重置
检测滤波器为n步预测卡方检测器,设置n步重置周期,在n步之内不进行重置,使用自身的状态估计结果进行状态递推,在第n步时使用全局滤波结果进行状态量重置,状态及均方误差重置根据滤波结果采用如下方式:
情况521,无故障时,第n步检测滤波器状态及均方误差重置
式中,表示使用状态向量中的第1列中,第i到第j行元素进行重置;Pg(k)[i:j;i:j]表示使用误差估计矩阵中的第i到第j列、第i到第j行元素进行重置;
情况522,预发生故障时,检测滤波器状态及均方误差重置为如下:
扭矩模型/z轴陀螺检测滤波器、扭矩模型/磁传感器检测滤波器、z轴陀螺/磁传感器检测滤波器不进行重置更新,只进行累积直至确定故障位置;
情况523,z轴陀螺故障时,检测滤波器状态及均方误差重置
当检测到z轴陀螺故障时,对扭矩模型/z轴陀螺检测滤波器、z轴陀螺/磁传感器检测滤波器进行立即重置,其他的检测器按照n步重置规则,采用如下方法进行重置:
情况524,扭矩模型故障时,检测滤波器状态及均方误差重置
当检测到扭矩模型故障时,对扭矩模型/z轴陀螺检测滤波器、扭矩模型/磁传感器检测滤波器进行立即重置,其他的检测器按照n步重置规则,采用如下方法进行重置:
情况525,磁传感器故障时,检测滤波器状态及均方误差重置
当检测到磁传感器故障时,扭矩模型/磁传感器检测滤波器、z轴陀螺/磁传感器检测滤波器不使用n步重置规则,每一步均进行重置,其他的检测其按照n步重置规则,采用如下方法进行重置:
步骤53,当检测到故障后,基于故障特性,执行以下***重置策略
设置z轴陀螺和扭矩模型故障隔离周期,当检测到z轴陀螺或扭矩模型故障后,进入故障隔离周期,在隔离周期内认为一直存在故障,在隔离周期内若再次检测到故障,重新开始隔离周期,若隔离周期结束后仍未检测到故障,则认为故障消失,***处于无故障状态。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810871721.8A CN108981708B (zh) | 2018-08-02 | 2018-08-02 | 四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810871721.8A CN108981708B (zh) | 2018-08-02 | 2018-08-02 | 四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108981708A true CN108981708A (zh) | 2018-12-11 |
CN108981708B CN108981708B (zh) | 2021-10-19 |
Family
ID=64554501
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810871721.8A Active CN108981708B (zh) | 2018-08-02 | 2018-08-02 | 四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108981708B (zh) |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110196067A (zh) * | 2019-05-13 | 2019-09-03 | 南京航空航天大学 | 一种基于无参考***的交互式故障检测方法 |
CN111338320A (zh) * | 2020-03-11 | 2020-06-26 | 西安应用光学研究所 | 一种稳定平台故障保护方法 |
WO2020220729A1 (zh) * | 2019-04-29 | 2020-11-05 | 南京航空航天大学 | 基于角加速度计/陀螺/加速度计的惯性导航解算方法 |
CN112629521A (zh) * | 2020-12-13 | 2021-04-09 | 西北工业大学 | 一种旋翼飞行器双冗余组合的导航***建模方法 |
CN113514064A (zh) * | 2021-04-23 | 2021-10-19 | 南京航空航天大学 | 一种鲁棒因子图多源容错导航方法 |
Citations (16)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005033559A (ja) * | 2003-07-14 | 2005-02-03 | Fuji Xerox Co Ltd | 故障診断装置 |
CN101000244A (zh) * | 2007-01-05 | 2007-07-18 | 北京航空航天大学 | 一种高集成度mimu/gps/微磁罗盘/气压高度计组合导航*** |
CN101046385A (zh) * | 2007-04-20 | 2007-10-03 | 北京航空航天大学 | 一种航空用组合导航***体系结构实现方法 |
CN101216319A (zh) * | 2008-01-11 | 2008-07-09 | 南京航空航天大学 | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 |
CA2637725A1 (fr) * | 2007-07-19 | 2009-01-19 | Messier-Bugatti | Procede de commande d'un frein de vehicule avec correction en couple |
CN101549754A (zh) * | 2009-04-29 | 2009-10-07 | 北京航空航天大学 | 一种旋定翼复合式飞行器及其设计的方法 |
CN102114914A (zh) * | 2011-01-21 | 2011-07-06 | 文杰 | 分布式动力多旋翼垂直起降飞行器及其控制方法 |
CN102221363A (zh) * | 2011-04-12 | 2011-10-19 | 东南大学 | 一种水下潜器用捷联惯性组合导航***容错组合方法 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航*** |
CN103963963A (zh) * | 2014-04-22 | 2014-08-06 | 深圳市大疆创新科技有限公司 | 多旋翼飞行器的飞行控制方法及*** |
CN105045105A (zh) * | 2015-07-30 | 2015-11-11 | 南京航空航天大学 | 一种针对状态时滞的四旋翼直升机容错控制装置及方法 |
CN106184692A (zh) * | 2015-04-30 | 2016-12-07 | 郑州航空工业管理学院 | 一种可拆装倾转动力的飞翼式复合升力飞艇 |
CN106628209A (zh) * | 2017-01-06 | 2017-05-10 | 尚青 | 一种多轴载人飞行器 |
CN106679693A (zh) * | 2016-12-14 | 2017-05-17 | 南京航空航天大学 | 一种基于故障检测的矢量信息分配自适应联邦滤波方法 |
CN107651214A (zh) * | 2017-10-10 | 2018-02-02 | 南京航空航天大学 | 多旋翼无人机整机试验装置及其试验方法 |
CN108168509A (zh) * | 2017-12-06 | 2018-06-15 | 南京航空航天大学 | 一种升力模型辅助的四旋翼飞行器高度容错估计方法 |
-
2018
- 2018-08-02 CN CN201810871721.8A patent/CN108981708B/zh active Active
Patent Citations (17)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2005033559A (ja) * | 2003-07-14 | 2005-02-03 | Fuji Xerox Co Ltd | 故障診断装置 |
US7324909B2 (en) * | 2003-07-14 | 2008-01-29 | Fuji Xerox Co., Ltd. | Fault diagnosis apparatus |
CN101000244A (zh) * | 2007-01-05 | 2007-07-18 | 北京航空航天大学 | 一种高集成度mimu/gps/微磁罗盘/气压高度计组合导航*** |
CN101046385A (zh) * | 2007-04-20 | 2007-10-03 | 北京航空航天大学 | 一种航空用组合导航***体系结构实现方法 |
CA2637725A1 (fr) * | 2007-07-19 | 2009-01-19 | Messier-Bugatti | Procede de commande d'un frein de vehicule avec correction en couple |
CN101216319A (zh) * | 2008-01-11 | 2008-07-09 | 南京航空航天大学 | 基于联邦ukf算法的低轨卫星多传感器容错自主导航方法 |
CN101549754A (zh) * | 2009-04-29 | 2009-10-07 | 北京航空航天大学 | 一种旋定翼复合式飞行器及其设计的方法 |
CN102114914A (zh) * | 2011-01-21 | 2011-07-06 | 文杰 | 分布式动力多旋翼垂直起降飞行器及其控制方法 |
CN102221363A (zh) * | 2011-04-12 | 2011-10-19 | 东南大学 | 一种水下潜器用捷联惯性组合导航***容错组合方法 |
CN102879793A (zh) * | 2012-09-28 | 2013-01-16 | 北京信息科技大学 | 超小型gps/ins/磁强计/气压计组合导航*** |
CN103963963A (zh) * | 2014-04-22 | 2014-08-06 | 深圳市大疆创新科技有限公司 | 多旋翼飞行器的飞行控制方法及*** |
CN106184692A (zh) * | 2015-04-30 | 2016-12-07 | 郑州航空工业管理学院 | 一种可拆装倾转动力的飞翼式复合升力飞艇 |
CN105045105A (zh) * | 2015-07-30 | 2015-11-11 | 南京航空航天大学 | 一种针对状态时滞的四旋翼直升机容错控制装置及方法 |
CN106679693A (zh) * | 2016-12-14 | 2017-05-17 | 南京航空航天大学 | 一种基于故障检测的矢量信息分配自适应联邦滤波方法 |
CN106628209A (zh) * | 2017-01-06 | 2017-05-10 | 尚青 | 一种多轴载人飞行器 |
CN107651214A (zh) * | 2017-10-10 | 2018-02-02 | 南京航空航天大学 | 多旋翼无人机整机试验装置及其试验方法 |
CN108168509A (zh) * | 2017-12-06 | 2018-06-15 | 南京航空航天大学 | 一种升力模型辅助的四旋翼飞行器高度容错估计方法 |
Non-Patent Citations (4)
Title |
---|
JIZHOU LAI等: "Aerodynamic Model/ INS/ GPS Failure-tolerant", 《2017 CHINESE AUTOMATION CONGRESS (CAC)》 * |
MARTIN PROETZSCH等: "Fault-Tolerant Behavior-Based Motion Control for Offroad", 《PROCEEDINGS OF THE 2005 IEEE》 * |
赖际舟等: "混合粒子联邦滤波在多信息组合导航***中的应用", 《中国惯性技术学报》 * |
陈阳: "六旋翼无人机容错飞行控制研究", 《中国优秀硕士学位论文全文数据库工程科技Ⅱ辑》 * |
Cited By (7)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
WO2020220729A1 (zh) * | 2019-04-29 | 2020-11-05 | 南京航空航天大学 | 基于角加速度计/陀螺/加速度计的惯性导航解算方法 |
CN110196067A (zh) * | 2019-05-13 | 2019-09-03 | 南京航空航天大学 | 一种基于无参考***的交互式故障检测方法 |
CN111338320A (zh) * | 2020-03-11 | 2020-06-26 | 西安应用光学研究所 | 一种稳定平台故障保护方法 |
CN111338320B (zh) * | 2020-03-11 | 2023-03-28 | 西安应用光学研究所 | 一种稳定平台故障保护***及方法 |
CN112629521A (zh) * | 2020-12-13 | 2021-04-09 | 西北工业大学 | 一种旋翼飞行器双冗余组合的导航***建模方法 |
CN113514064A (zh) * | 2021-04-23 | 2021-10-19 | 南京航空航天大学 | 一种鲁棒因子图多源容错导航方法 |
CN113514064B (zh) * | 2021-04-23 | 2024-01-30 | 南京航空航天大学 | 一种鲁棒因子图多源容错导航方法 |
Also Published As
Publication number | Publication date |
---|---|
CN108981708B (zh) | 2021-10-19 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108981708A (zh) | 四旋翼扭矩模型/航向陀螺/磁传感器容错组合导航方法 | |
Bryne et al. | Nonlinear observers for integrated INS\/GNSS navigation: implementation aspects | |
CN101858748B (zh) | 高空长航无人机的多传感器容错自主导航方法 | |
US9057627B2 (en) | Low cost flight instrumentation system | |
CN101514900B (zh) | 一种单轴旋转的捷联惯导***初始对准方法 | |
CN108981709B (zh) | 基于力矩模型辅助的四旋翼横滚角、俯仰角容错估计方法 | |
CA1192665A (en) | Navigational aid to determine attitude | |
CN108106635A (zh) | 惯性卫导组合导航***的长航时抗干扰姿态航向校准方法 | |
CN108168509B (zh) | 一种升力模型辅助的四旋翼飞行器高度容错估计方法 | |
CN106990426A (zh) | 一种导航方法和导航装置 | |
CN103837151B (zh) | 一种四旋翼飞行器的气动模型辅助导航方法 | |
CN110426032B (zh) | 一种解析式冗余的飞行器容错导航估计方法 | |
CN105021183A (zh) | 多旋翼飞行器gps和ins低成本组合导航*** | |
US10488432B2 (en) | Systems and methods for compensating for the absence of a sensor measurement in a heading reference system | |
CN107643088A (zh) | 无人机导航方法、装置、无人机及存储介质 | |
Leutenegger et al. | Robust state estimation for small unmanned airplanes | |
CN112432642A (zh) | 一种重力灯塔与惯性导航融合定位方法及*** | |
CN110849360A (zh) | 面向多机协同编队飞行的分布式相对导航方法 | |
CN109612459A (zh) | 基于动力学模型的四旋翼飞行器惯性传感器容错导航方法 | |
CN108592911A (zh) | 一种四旋翼飞行器动力学模型/机载传感器组合导航方法 | |
CN108693372B (zh) | 一种四旋翼飞行器的航向轴角速度估计方法 | |
CN107063248A (zh) | 基于旋翼转速的动力学模型辅助惯导的导航方法 | |
Hazbon Alvarez et al. | Digital twin concept for aircraft sensor failure | |
CN110132267A (zh) | 空天地一体化飞行器的光纤惯导***及光纤惯导在轨对准方法 | |
Hamdy et al. | Land vehicle navigation algorithm implementation on cortex-m4 embedded processor |
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 |