[发明专利]一种集中式协同SlAM中的重定位方法及装置

说明书

本发明公开了一种集中式协同SlAM中的重定位方法及装置，应用于包括服务端和至少一个客户端的集中式协同SLAM系统，该方法包括：在当前客户端定位丢失的情况下，获取当前客户端中待定位关键帧，基于当前客户端关键帧数据库中的各个关键帧对待定位关键帧进行定位；在定位失败的情况下，判断当前客户端在目标地图中是否存在合并地图，若存在，在合并地图中选取预设数量的关键帧，将预设数量的关键帧发送给当前客户端，以令当前客户端基于预设数量的关键帧待定位关键帧进行重定位。上述过程中，在基于客户端定位失败后，继续在服务端选取预设数量的关键帧发送给客户端，以令客户端基于预设数量关键帧进行重定位，提高了定位成功的概率。

技术领域

本发明涉及定位与地图构建技术领域，尤其涉及一种集中式协同SlAM中的重定位方法及装置。

背景技术

集中式协同定位与地图构建SLAM(Simultaneous Localization and Mapping)包含多个可以独立完成定位和建图功能的客户端和一个计算能力强大的服务端。其中，客户端向服务端发送地图信息，服务端则利用多个客户端地图数据进行匹配和合并，构建信息更为丰富的服务端地图，并向客户端传输信息来实现多客户端之间的信息共享与协作。

现有的客户端在在定位丢失以后只能基于其本身的关键帧数据库进行重定位，由于其本身关键帧数据库中的数据有限，经常出现重定位失败的情况。

发明内容

有鉴于此，本发明提供了一种集中式协同SlAM中的重定位方法及装置，用于解决现有的客户端在在定位丢失以后只能基于其本身的关键帧数据库进行重定位，由于其本身关键帧数据库中的数据有限，经常出现重定位失败的情况的问题，具体方案如下：

一种集中式协同SlAM中的重定位方法，应用于集中式协同SLAM系统，所述集中式协同SLAM系统包括：服务端和至少一个客户端，所述方法包括：

在当前客户端定位丢失的情况下，获取所述当前客户端中待定位关键帧，基于所述当前客户端关键帧数据库中的各个关键帧对所述待定位关键帧进行定位；

在定位失败的情况下，判断所述当前客户端在目标地图中是否存在合并地图，其中，所述目标地图为在所述客户端定位成功的情况下预先进行构建的；

若存在，在所述合并地图中选取预设数量的关键帧，将所述预设数量的关键帧发送给所述当前客户端，以令所述当前客户端基于所述预设数量的关键帧所述待定位关键帧进行重定位，其中，所述预设数量的关键帧不属于所述当前客户端。

上述的方法，可选的，基于所述当前客户端关键帧数据库中的各个关键帧对所述待定位关键帧进行定位，包括：

计算所述待定位关键帧与所述当前客户端关键帧数据库中的各个关键帧的相似度值；

将相似度值大于第一预设相似度阈值的关键帧作为第一候选关键帧，得到各个第一候选关键帧，在所述各个第一候选关键帧中选取第一目标候选关键帧；

获取所述第一目标候选关键帧的位姿，基于所述位姿确定所述待定位关键帧的目标位姿。

上述的方法，可选的，还包括：

基于所述目标位姿，计算所述待定位关键帧中的内点数量；

在所述内点数量大于预设数量阈值的情况下，判定所述待定位关键帧定位成功。

上述的方法，可选的，预先构建目标地图的过程包括：

对所述客户端进行定位，获取定位成功的客户端的各个局部地图；

对所述各个局部地图进行匹配；

对匹配成功的局部地图进行融合，得到目标地图。

上述的方法，可选的，对所述各个局部地图进行匹配，包括：