一种救生舱机器人的定位方法及定位系统
摘要:
本发明适用于定位技术领域,提供了一种救生舱机器人的定位方法及定位系统。本发明通过利用多个无线定位终端在多次等时间间隔测量获取救生舱机器人的多组全局定位数据,以及通过多次等距离间隔测量获取救生舱机器人的局部定位数据,并获取救生舱机器人的瞬时姿态信息和瞬时环境信息,通过预先建立的权重函数对全局定位数据、局部定位数据、瞬时姿态信息及瞬时环境信息进行加权数据融合,再利用预先建立的算法获取救生舱机器人的精确位置坐标,从而使得定位方法具有干扰误差小、定位精度高、收敛速度快、稳定性好的优点,增强井下作业的安全性,加大被救人员生还的概率。
公开/授权文献
0/0