欢迎来到知嘟嘟! 联系电话:13336804447 卖家免费入驻,海量在线求购! 卖家免费入驻,海量在线求购!
知嘟嘟
我要发布
联系电话:13336804447
知嘟嘟经纪人
收藏
专利号: 2022112078073
申请人: 山东省维天雷泽光电技术有限公司
专利类型:发明专利
专利状态:已下证
专利领域: 测量;测试
更新日期:2026-01-27
缴费截止日期: 暂无
价格&联系人
年费信息
委托购买

摘要:

权利要求书:

1.一种采用动态积分卡尔曼滤波的混合高度测量方法,其特征在于,包括以下步骤:

步骤S10,在载体上安装SiA200 MEMS加速度传感器,并进行积分得到惯性速度与惯性高度;在载体上安装GPS接收器,测量载体GPS高度;在载体上安装无线电高度表,测量载体的无线电高度如下:v=∫adt;

h=∫vdt;

其中a(n)对应的是时间t=n*ΔT时刻采用SiA200 MEMS加速度传感器测量的载体加速度信号,简写为a,其中ΔT为数据的输出采样周期,dt表示对时间信号的积分,v为惯性速度信号,h为惯性高度信号;在载体上安装FYC-LG24-800型无线电高度表,测量载体高度,记作yw,称为无线电高度信号,然后按照加速度计的数据间隔周期ΔT,将高度数据进行离散化,得到数据yw(n),其中n=1,2,3…,对应的是时间t=n*ΔT时刻的无线电高度信号数据;在载体上安装GPS接收器,测量载体GPS高度,记作yg,称作GPS高度信号,然后按照加速度计的数据间隔周期ΔT,将高度数据进行离散化,得到数据yg(n),其中n=1,2,3…,对应的是时间t=n*ΔT时刻的GPS高度信号数据;

步骤S20,设计二阶开方非线性平滑滤波器,将所述的惯性高度信号数据通过二阶开方非线性平滑滤波器,得到惯性高度平滑信号;然后将无线电高度信号数据通过二阶开方非线性平滑滤波器,得到无线电高度平滑信号;最后将GPS高度信号数据,通过二阶开方非线性平滑滤波器,得到GPS平滑信号如下:eh=h(n)-hl(n);

eh1=yw(n)-ywl(n);

eh2=yg(n)-ygl(n);

其中T1、T2、T3为滤波器常值参数;k1、k2、k3、k4、k5、k6为滤波器增益参数,为常数;ε1为滤波器开方柔化系数,为常值;h1为惯性高度一阶微分信号;hl1为惯性平滑高度一阶微分信号;hl2为惯性平滑高度二阶微分信号;eh为惯性高度滤波误差信号;hl为惯性高度平滑信号;yw1为无线电高度一阶微分信号;ywl1为无线电平滑高度一阶微分信号;ywl2为无线电平滑高度二阶微分信号;eh1为无线电高度滤波误差信号;ywl为无线电高度平滑信号;yg1为GPS高度一阶微分信号;ygl1为GPS平滑高度一阶微分信号;ygl2为GPS平滑高度二阶微分信号;eh2为GPS高度滤波误差信号;ygl为GPS高度平滑信号;

步骤S30,将GPS平滑信号与无线电高度平滑信号进行组合卡尔曼滤波,得到GPS无线电组合卡尔曼滤波高度信号,分别对组合卡尔曼滤波高度信号求解高度误差,再进行非线性积分,得到误差积分信号,再进行协方差信号在线解算,调节卡尔曼滤波器如下:pw1(n)=pw(n-1)+Qw1;

bw(n)=pw1(n)·[pw1(n)+Rw1]-1;

ywgk(n)=ywl(n)+bw(n)·[ygl(n)-ywl(n)];

ea1(n)=ywgk(n)-ywl(n);

ea2(n)=ywgk(n)-ygl(n);

其中pw(n)为卡尔曼滤波器中的无线电误差协方差信号,pw(1)为pw(n)在第一个采样点的值;bw(n)为卡尔曼无线电增益,pw1(n)为无线电误差协方差的预测值;Qw1为无线电前验方差,其初始值选取为常值,Rw1为无线电观测方差,其初始值选取为常值;ywgk(n)为GPS无线电组合卡尔曼滤波高度信号;ea1(n)为无线电组合高度误差信号;ea2(n)为GPS组合高度误差信号;sa1为无线电组合高度误差积分信号与sa2为GPS组合高度误差积分信号;ε2为常值参数信号;ε3为常值参数信号;ka1、ka2、ka3、ka4为常值参数信号;

步骤S40,将GPS平滑信号与惯性高度平滑信号进行组合卡尔曼滤波,得到GPS惯性组合卡尔曼滤波高度信号,分别对合卡尔曼滤波高度信号求解高度误差,再进行非线性积分,得到误差积分信号,再进行协方差信号在线解算,调节卡尔曼滤波器如下:pi1(n)=pi(n-1)+Qi1;

bi(n)=pi1(n)·[pi1(n)+Ri1]-1;

yigk(n)=hl(n)+bi(n)·[ygl(n)-hl(n)];

eb1(n)=yigk(n)-hl(n);

eb2(n)=yigk(n)-ygl(n);

其中pi(n)为卡尔曼滤波器中的惯性误差协方差信号,pi(1)为pi(n)在第一个采样点的值;bi(n)为卡尔曼惯性增益,pi1(n)为惯性误差协方差的预测值;Qi1为惯性前验方差,其初始值选取为常值,Ri1为惯性观测方差,其初始值选取为常值;yigk(n)为GPS惯性组合卡尔曼滤波高度信号;eb1(n)为惯性组合高度误差信号;eb2(n)为GPS惯性组合高度误差信号;sb1为惯性组合高度误差积分信号与sb2为GPS惯性组合高度误差积分信号;ka5、ka6、ka7、ka8为常值参数信号;

步骤S50,将惯性平滑信号与无线电高度平滑信号进行组合卡尔曼滤波,得到惯性无线电组合卡尔曼滤波高度信号,分别对合卡尔曼滤波高度信号求解高度误差,再进行非线性积分,得到误差积分信号,再进行协方差信号在线解算,调节卡尔曼滤波器如下:pwi1(n)=pwi(n-1)+Qwi1;

bwi(n)=pwi1(n)·[pwi1(n)+Rwi1]-1;

ywik(n)=ywl(n)+bwi(n)·[hl(n)-ywl(n)];

ec1(n)=ywik(n)-hl(n);

ec2(n)=ywik(n)-ywl(n);

其中pwi(n)为卡尔曼滤波器中的惯性无线电误差协方差信号,pwi(1)为pwi(n)在第一个采样点的值;bwi(n)为卡尔曼惯性无线电增益,pwi1(n)为惯性无线电误差协方差的预测值;Qwi1为惯性无线电前验方差,其初始值选取为常值,Rwi1为惯性无线电观测方差,其初始值选取为常值;ywik(n)为GPS惯性无线电组合卡尔曼滤波高度信号;ec1(n)为惯性相对组合误差信号;ec2(n)为无线电相对组合误差信号;sc1为惯性相对组合误差信号积分信号与sc2为无线电相对组合误差信号积分信号;ε3为常值参数信号;ka9、ka10、ka11、ka12为常值参数信号;

步骤S60,对所述的三种组合卡尔曼滤波高度信号进行动态组合,得到优化组合高度信号,并求解三种组合卡尔曼滤波高度信号对优化组合高度信号的误差信号,进行非线性积分后并叠加相应方差信号,实时生成动态组合加权因子,对三种卡尔曼滤波高度进行优化组合后得到最终高度输出总信号如下:ew1(n)=yo(n)-ywgk(n)+Qw1(n)+Rw1(n);

ew2(n)=yo(n)-yigk(n)+Qi1(n)+Ri1(n);

ew3(n)=yo(n)-ywik(n)+Qwi1(n)+Rwi1(n);

d11(n+1)=d11(n)+ew1(n)ΔT;

d12(n+1)=d12(n)+ew2(n)ΔT;

d13(n+1)=d13(n)+ew3(n)ΔT;

yo(n)=d1ywgk(n)+d2yigk(n)+d3ywik(n);其中ew1(n)为无线电GPS总误差信号;ew2(n)为惯性GPS总误差、ew3(n)为无线电惯性总误差信号;d11为无线电GPS总误差积分信号、d12为惯性GPS总误差积分信号、d13为无线电惯性总误差积分信号;d1为无线电GPS加权因子、d2为惯性GPS加权因子、d3为无线电惯性加权因子;yo(n)为高度输出总信号。