发明公开
- 专利标题: 面向室内行人导航的KF/EM-KF/FIR混合滤波方法及系统
-
申请号: CN202410273575.4申请日: 2024-03-11
-
公开(公告)号: CN118225091A公开(公告)日: 2024-06-21
- 发明人: 魏功槐 , 周茂祥 , 吴庆东 , 潘光科 , 李鹏 , 王令尚
- 申请人: 山东省路桥集团有限公司
- 申请人地址: 山东省济南市历下区经十路14677号
- 专利权人: 山东省路桥集团有限公司
- 当前专利权人: 山东省路桥集团有限公司
- 当前专利权人地址: 山东省济南市历下区经十路14677号
- 代理机构: 济南圣达知识产权代理有限公司
- 代理商 董雪
- 主分类号: G01C21/20
- IPC分类号: G01C21/20 ; G01C21/16 ; H03H17/02
摘要:
本发明公开了一种面向室内行人导航的KF/EM‑KF/FIR混合滤波方法及系统,包括:确定目标行人当前时刻k在东‑北‑天三个方向的运动姿态,所述运动姿态包括剧烈运动姿态和平稳运动姿态;以目标行人k时刻在三个方向的位置误差和速度误差作为混合滤波算法的状态向量,以INS和UWB测量的目标行人k时刻的位置之差作为混合滤波算法的观测向量,对目标行人的位置进行预估;本发明选取最优的滤波方式完成对目标行人对位置变化小于设定阈值的方向进行平滑,能够有效的提高局部方向处于静止状态下的导航预估的精度,进而提高整个导航的精度。