发明公开
- 专利标题: 一种基于自主导航与ZigBee约束的应急救援人员协同定位方法
-
申请号: CN202310862667.1申请日: 2023-07-13
-
公开(公告)号: CN116907484A公开(公告)日: 2023-10-20
- 发明人: 姬淼鑫 , 任桂辉 , 张会娟 , 刘建娟 , 吴才章 , 张弛 , 袁航 , 陈红梅 , 许强伟 , 刘振江 , 董鸿儒 , 徐晟皓
- 申请人: 河南工业大学
- 申请人地址: 河南省郑州市高新技术产业开发区莲花街100号
- 专利权人: 河南工业大学
- 当前专利权人: 河南工业大学
- 当前专利权人地址: 河南省郑州市高新技术产业开发区莲花街100号
- 代理机构: 郑州德勤知识产权代理有限公司
- 代理商 张微微
- 主分类号: G01C21/16
- IPC分类号: G01C21/16 ; G01S19/45
摘要:
本发明提供一种基于自主导航与ZigBee约束的应急救援人员协同定位方法,包括以下步骤:使用INS、GPS分别获取应急救援人员的初始估计位置坐标和指挥人员的位置坐标;通过ZigBee定位系统获取TDOA测量值,建立方程式组,将方程式组用Taylor级数法展开,得到目标应急救援人员的估计位置坐标;使用气压计和磁力计分别对目标应急救援人员的高度和航向角进行修正;将目标应急救援人员的估计位置坐标与目标应急救援人员的初始估计位置坐标之差、气压计输出的高度与INS捷联解算后的高度之差、磁力计解算出来的航向角与INS捷联解算后的航向角之差送入卡尔曼滤波,通过卡尔曼滤波估计出状态误差值,通过闭环反馈对INS进行校正,得到目标应急救援人员准确的位置、速度和姿态信息。
IPC分类: