一种通信高效的双融合一致性分布式协同定位方法及系统

本发明公开了一种通信高效的双融合一致性分布式协同定位方法及系统，涉及多机器人协同定位技术领域。本发明的技术要点包括：对于多机器人系统，每个机器人依次执行以下操作以获得自身定位：自我运动预测：基于自运动信息，使用扩展卡尔曼滤波器预测自身的状态估计和协方差估计；异构融合：机器人获取邻近观察到的机器人的状态估计和协方差估计，并将自身的估计和来自邻近观察到的机器人的估计以及相对或绝对测量进行联合融合；同构融合：使用协方差交集技术将联合融合获得的后验估计与自身的估计结合在一起，从而获得最终位置估计。本发明结合了异构和同构融合，对存储、通信负载和网络连接性要求最低，确保了充分利用所有可用信息。