一种角速度辅助的Kalman滤波定位方法
基本信息
申请号 | CN201610905124.3 | 申请日 | - |
公开(公告)号 | CN107918139B | 公开(公告)日 | 2021-05-11 |
申请公布号 | CN107918139B | 申请公布日 | 2021-05-11 |
分类号 | G01S19/42 | 分类 | 测量;测试; |
发明人 | 贾小波;王倩倩;郑丹旸;吴淑琴;邹世合;李军华 | 申请(专利权)人 | 郑州威科姆科技股份有限公司 |
代理机构 | 郑州中原专利事务所有限公司 | 代理人 | 霍彦伟;李想 |
地址 | 450002 河南省郑州市高新技术开发区莲花街55号1号楼 | ||
法律状态 | - |
摘要
摘要 | 一种角速度辅助的Kalman滤波定位方法,包括如下步骤:步骤1、捕获卫星信号,解调导航电文,剔除故障卫星;步骤2、解算运动载体的初始状态变量、方位角、角速度、方差;步骤3、确定采用的Kalman滤波方程模型,根据不同载体类型和不同的接收机类型确定各个参数的值:步骤4、检测接收卫星信息是否良好,若是,直接利用Kalman方程解算出当前时刻的状态变量‑位置、速度和加速度;当接收卫星信息不好,不能利用卫星信息进行卫星定位时,确定现时刻的载体的所在方位,联合Kalman滤波的预测方程,两者进行等权计算现时刻状态解算载体的位置、速度等信息。本发明在卫星定位失败时,能够显著提高没有惯性传感器等辅助手段情况下的动态定位精度。 |
