一种空地多视角下的多机器人协同定位及融合建图方法

摘要

本发明公开了一种空地多视角下的多机器人协同定位及融合建图方法，使用空中、地面多视角完整覆盖探测场景，融合由空中机器人、地面机器人采集的场景图像数据，通过视觉约束定位各机器人并还原三维场景信息。通过附着于机器人上的特定视觉特征，优化建图和定位系统三维点云地图和机器人六自由度位姿。基于视觉特征的位姿优化、地图融合算法显著地提高了的重建和定位精度，修正了地图尺度，使得各机器人的局部地图能够在多个异构机器人间共享，提高了三维重建的覆盖率，为任务规划、灾难环境搜救、军事反恐等情景快速提供可靠的环境信息。