买专利卖专利找龙图腾，真高效！ 查专利查商标用IPTOP,全免费！专利年费监控用IP管家,真方便！

龙图腾网获悉山东省维天雷泽光电技术有限公司申请的专利一种采用动态积分卡尔曼滤波的混合高度测量方法获国家发明授权专利权，本发明授权专利权由国家知识产权局授予，授权公告号为：CN115560725B 。

龙图腾网通过国家知识产权局官网在2025-10-31发布的发明授权授权公告中获悉：该发明授权的专利申请号/专利号为：202211207807.3，技术领域涉及：G01C5/00；该发明授权一种采用动态积分卡尔曼滤波的混合高度测量方法是由杨维松;宋婉晴;汪辉设计研发完成，并于2022-09-30向国家知识产权局提交的专利申请。

本一种采用动态积分卡尔曼滤波的混合高度测量方法在说明书摘要公布了：本发明是关于一种采用动态积分卡尔曼滤波的混合高度测量方法。其首先采用SiA200MEMS加速度传感器，测量载体加速度并两次积分得到惯性高度信息；采用FYC‑LG24‑800型无线电高度表，测量载体无线电高度信息；采用GPS设备测量GPS高度信息载体；再设计了一种二阶开方非线性平滑滤波器，得到三种测量高度信号的平滑信号；然后设计了一种基于组合后卡尔曼滤波后的高度误差以及非线性积分来调节方差信息的动态积分卡尔曼滤波器，从而求解三种高度平滑信号的两两卡尔曼滤波信号；最终采用误差信号叠加其非线性积分信号，实时生成动态组合加权因子，对三种卡尔曼滤波高度进行优化组合后得到最终高度输出总信号。

本发明授权一种采用动态积分卡尔曼滤波的混合高度测量方法在权利要求书中公布了：1.一种采用动态积分卡尔曼滤波的混合高度测量方法，其特征在于，包括以下步骤： 步骤S10，在载体上安装SiA200MEMS加速度传感器，并进行积分得到惯性速度与惯性高度；在载体上安装GPS接收器，测量载体GPS高度；在载体上安装无线电高度表，测量载体的无线电高度如下： v＝∫adt； h＝∫vdt； 其中an对应的是时间t＝n*ΔT时刻采用SiA200MEMS加速度传感器测量的载体加速度信号，简写为a，其中ΔT为数据的输出采样周期，dt表示对时间信号的积分，v为惯性速度信号，h为惯性高度信号；在载体上安装FYC-LG24-800型无线电高度表，测量载体高度，记作yw，称为无线电高度信号，然后按照加速度计的数据间隔周期ΔT，将高度数据进行离散化，得到数据ywn，其中n＝1,2,3…，对应的是时间t＝n*ΔT时刻的无线电高度信号数据；在载体上安装GPS接收器，测量载体GPS高度，记作yg，称作GPS高度信号，然后按照加速度计的数据间隔周期ΔT，将高度数据进行离散化，得到数据ygn，其中n＝1,2,3…，对应的是时间t＝n*ΔT时刻的GPS高度信号数据； 步骤S20，设计二阶开方非线性平滑滤波器，将所述的惯性高度信号数据通过二阶开方非线性平滑滤波器，得到惯性高度平滑信号；然后将无线电高度信号数据通过二阶开方非线性平滑滤波器，得到无线电高度平滑信号；最后将GPS高度信号数据，通过二阶开方非线性平滑滤波器，得到GPS平滑信号如下： eh＝hn-hln； eh1＝ywn-ywln； eh2＝ygn-ygln； 其中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无线电组合卡尔曼滤波高度信号，分别对组合卡尔曼滤波高度信号求解高度误差，再进行非线性积分，得到误差积分信号，再进行协方差信号在线解算，调节卡尔曼滤波器如下： pw1n＝pwn-1+Qw1； bwn＝pw1n·[pw1n+Rw1]-1； ywgkn＝ywln+bwn·[ygln-ywln]； ea1n＝ywgkn-ywln； ea2n＝ywgkn-ygln； 其中pwn为卡尔曼滤波器中的无线电误差协方差信号，pw1为pwn在第一个采样点的值；bwn为卡尔曼无线电增益，pw1n为无线电误差协方差的预测值；Qw1为无线电前验方差，其初始值选取为常值，Rw1为无线电观测方差，其初始值选取为常值；ywgkn为GPS无线电组合卡尔曼滤波高度信号；ea1n为无线电组合高度误差信号；ea2n为GPS组合高度误差信号；sa1为无线电组合高度误差积分信号与sa2为GPS组合高度误差积分信号；ε2为常值参数信号；ε3为常值参数信号；ka1、ka2、ka3、ka4为常值参数信号； 步骤S40，将GPS平滑信号与惯性高度平滑信号进行组合卡尔曼滤波，得到GPS惯性组合卡尔曼滤波高度信号，分别对合卡尔曼滤波高度信号求解高度误差，再进行非线性积分，得到误差积分信号，再进行协方差信号在线解算，调节卡尔曼滤波器如下： pi1n=pin-1+Qi1； bin＝pi1n·[pi1n+Ri1]-1； yigkn＝hln+bin·[ygln-hln]； eb1n＝yigkn-hln； eb2n＝yigkn-ygln； 其中pin为卡尔曼滤波器中的惯性误差协方差信号，pi1为pin在第一个采样点的值；bin为卡尔曼惯性增益，pi1n为惯性误差协方差的预测值；Qi1为惯性前验方差，其初始值选取为常值，Ri1为惯性观测方差，其初始值选取为常值；yigkn为GPS惯性组合卡尔曼滤波高度信号；eb1n为惯性组合高度误差信号；eb2n为GPS惯性组合高度误差信号；sb1为惯性组合高度误差积分信号与sb2为GPS惯性组合高度误差积分信号；ka5、ka6、ka7、ka8为常值参数信号； 步骤S50，将惯性平滑信号与无线电高度平滑信号进行组合卡尔曼滤波，得到惯性无线电组合卡尔曼滤波高度信号，分别对合卡尔曼滤波高度信号求解高度误差，再进行非线性积分，得到误差积分信号，再进行协方差信号在线解算，调节卡尔曼滤波器如下： pwi1n＝pwin-1+Qwi1； bwin＝pwi1n·[pwi1n+Rwi1]-1； ywikn＝ywln+bwin·[hln-ywln]； ec1n＝ywikn-hln； ec2n＝ywikn-ywln； 其中pwin为卡尔曼滤波器中的惯性无线电误差协方差信号，pwi1为pwin在第一个采样点的值；bwin为卡尔曼惯性无线电增益，pwi1n为惯性无线电误差协方差的预测值；Qwi1为惯性无线电前验方差，其初始值选取为常值，Rwi1为惯性无线电观测方差，其初始值选取为常值；ywikn为GPS惯性无线电组合卡尔曼滤波高度信号；ec1n为惯性相对组合误差信号；ec2n为无线电相对组合误差信号；sc1为惯性相对组合误差信号积分信号与sc2为无线电相对组合误差信号积分信号；ε3为常值参数信号；ka9、ka10、ka11、ka12为常值参数信号； 步骤S60，对所述的三种组合卡尔曼滤波高度信号进行动态组合，得到优化组合高度信号，并求解三种组合卡尔曼滤波高度信号对优化组合高度信号的误差信号，进行非线性积分后并叠加相应方差信号，实时生成动态组合加权因子，对三种卡尔曼滤波高度进行优化组合后得到最终高度输出总信号如下： ew1n＝yon-ywgkn+Qw1n+Rw1n； ew2n＝yon-yigkn+Qi1n+Ri1n； ew3n＝yon-ywikn+Qwi1n+Rwi1n； d11n+1＝d11n+ew1nΔT； d12n+1＝d12n+ew2nΔT； d13n+1＝d13n+ew3nΔT； yon＝d1ywgkn+d2yigkn+d3ywikn；其中ew1n为无线电GPS总误差信号；ew2n为惯性GPS总误差、ew3n为无线电惯性总误差信号；d11为无线电GPS总误差积分信号、d12为惯性GPS总误差积分信号、d13为无线电惯性总误差积分信号；d1为无线电GPS加权因子、d2为惯性GPS加权因子、d3为无线电惯性加权因子；yon为高度输出总信号。

如需购买、转让、实施、许可或投资类似专利技术，可联系本专利的申请人或专利权人山东省维天雷泽光电技术有限公司，其通讯地址为：264000 山东省烟台市自由贸易试验区烟台片区万寿山路5号内1号；或者联系龙图腾网官方客服，联系龙图腾网可拨打电话0551-65771310或微信搜索“龙图腾网”。

以上内容由龙图腾AI智能生成。