[发明专利]移动设备的位姿确定方法及装置

说明书

本发明提供了一种移动设备的位姿确定方法及装置，包括：在确定移动设备定位丢失的情况下，获取由移动设备拍摄得到的第一图像；在预先建立的图像库中查找与第一图像的相似度大于或等于第一预设阈值的第二图像，以及与第二图像相关联的第一位姿；对第一位姿进行旋转和/或平移处理，得到N个第一候选位姿；根据N个第一候选位姿的激光定位得分，确定移动设备的当前位姿。通过本发明，解决了机器人位姿定位误差较大的问题，进而达到了提高机器人位姿定位准确率的效果。

技术领域

本发明涉及通信领域，具体而言，涉及一种移动设备的位姿确定方法及装置。

背景技术

移动机器人在进行任务操作时，比如在仓库中进行物体搬运，移动机器人需要在该环境中精确地知道自己在当前环境的位姿，从而能够准确地执行任务。在机器人位姿丢失，即因为环境的改变，导致机器人的不知道自己在当前环境中的位姿时，机器人需要快速恢复出自己当前的位姿。

现有技术中一般是依据机器人的视觉进行视觉重定位，输出机器人的定位结果。但是基于视觉重定位，估计的机器人初始位姿误差比较大，尤其是角度上，一旦角度存在一定的偏差，后续将会导致定位丢失。

因此，针对相关技术中，机器人位姿定位误差较大的问题，目前尚无存在有效的解决方案。

发明内容

本发明实施例提供了一种移动设备的位姿确定方法及装置，以至少解决相关技术中机器人位姿定位误差较大的问题。

根据本发明的一个实施例，提供了一种移动设备的位姿确定方法，包括：在确定移动设备定位丢失的情况下，获取由所述移动设备拍摄得到的第一图像；在预先建立的图像库中查找与所述第一图像的相似度大于或等于第一预设阈值的第二图像，以及与所述第二图像相关联的第一位姿，其中，所述第二图像是所述移动设备在所述第一位姿拍摄得到的图像；对所述第一位姿进行旋转和/或平移处理，得到N个第一候选位姿，其中，所述N为大于或等于1的整数，所述N个第一候选位姿中包括所述第一位姿；根据所述N个第一候选位姿的激光定位得分，确定所述移动设备的当前位姿。

可选地，所述根据所述N个第一候选位姿的激光定位得分确定所述移动设备的当前位姿，包括：使用分枝定界法，通过所述移动设备分别在N个第一候选位姿上的N组激光点云分别落在一组不同分辨率的概率栅格地图中的得分，确定所述移动设备的当前位姿，其中，所述一组不同分辨率的概率栅格地图是对原始概率栅格地图进行降采样得到的，所述原始概率栅格地图上包括有多个栅格，每个栅格上标识的数值用于表示激光落在该栅格上的得分。

可选地，所述对原始概率栅格地图进行降采样得到所述一组不同分辨率的概率栅格地图，包括：通过双向滑窗对所述原始概率栅格地图进行降采样，得到预定分辨率的概率栅格地图，其中，所述预定分辨率的概率栅格地图的分辨率小于所述原始概率栅格地图的分辨率；按照分辨率大小对所述预定分辨率的概率栅格地图和原始概率栅格地图进行排序，得到一组不同分辨率的概率栅格地图。

可选地，所述方法还包括：获取所述移动设备在所述当前位姿的激光点云；确定所述移动设备在所述当前位姿的激光点云与所述原始概率栅格地图的匹配率；在所述匹配率小于或等于第二预设阈值的情况下，根据所述移动设备在所述当前位姿的激光点云更新所述原始概率栅格地图。

可选地，在所述在预先建立的图像库中查找与所述第一图像的相似度大于或等于第一预设阈值的第二图像之前，所述方法还包括：在所述移动设备在原始概率栅格地图移动过程中，确定移动距离或旋转角度大于或等于第一预设阈值时，所述移动设备的位姿为关键位姿；建立所述移动设备在所述关键位姿采集的关键帧和对应的关键位姿的关联关系，并将所述关联关系存储在所述图像库，其中，所述关键位姿包括所述第一位姿，所述关键帧包括所述第一图像。

可选地，所述方法还包括：获取所述移动设备在所述当前位姿拍摄的第三图像；确定第三图像与所述第二图像的匹配率；在所述匹配率小于或等于第三预设阈值的情况下，将所述图像库中的所述第二图像更新为所述第三图像，与所述第二图像对应的所述第一位姿更新为所述当前位姿。