[发明专利]用于大尺度多站点场景的移动机器人位姿测量方法及系统

说明书

本发明属于移动机器人位姿测量领域，并具体公开了一种用于大尺度多站点场景的移动机器人位姿测量方法及系统，包括如下步骤：移动机器人在各个站点示教，获取移动机器人在站点示教位置的绝对位姿即目标位姿，并利用视觉测量获得移动机器人在各站点目标位姿与站点标志的相对位姿；移动机器人在多站点场景中移动，获得移动机器人在当前绝对位姿与观测站点标志的相对位姿，进而得到移动机器人当前绝对位姿与该观测站点目标位姿的相对位姿，最后结合观测站点的目标位姿实时、精准地得到移动机器人在站点附近的绝对位姿。本发明具有布置便捷、成本低廉、测量精度高、不易被障碍物遮挡失效等优势，尤其适用于大尺度、多站点的复杂工作场景。

技术领域

本发明属于移动机器人位姿测量领域，更具体地，涉及一种用于大尺度多站点场景的移动机器人位姿测量方法及系统。

背景技术

移动机器人因其适用性与移动性被广泛运用于大尺度多站点的复杂场景中，如电子电器制造车间、汽车零部件制造车间等，精准的位姿测量是移动机器人在该场景中实现自主移动的核心技术。通常情况下，移动机器人需要频繁地在场景内执行站点停靠任务并在站点完成精准的拾取和放置物料等操纵任务，因此为了精准、可靠地实现以上任务，移动机器人在站点附近的位姿测量精度要求相比其他工作区域要求更高。

在相对固定的空间中，利用少量的激光跟踪器、相机等传感器就可以对移动机器人进行精准的位姿测量。然而，由于移动机器人具有较高的灵活性和机动性，并运行于多站点的大尺度场景下，空间尺度大，存在站点、动态障碍物遮挡等问题，上述简单的测量方法难以满足实际需求。在过去的几十年中，多种位姿测量技术如外部观测系统，三角测量技术以及概率自定位技术等被广泛的研究，虽已被验证可以用于在大规模场景下进行移动机器人的位姿测量，但仍存在明显的不足，具体概括如下：

(1)外部观察系统，例如论文《An Approach Towards Automated Navigation ofVehicles Using Overhead Cameras》和专利CN201810433262.5《一种足式机器人本体状态测量方法》中的运动捕捉系统，是准确获得机器人位姿的常见方法。该方法需要对大量图片进行复杂的信号处理并且要求机器人在传感器观察范围内。因此在大尺度和多站点的场景中，该方法需要放置大量的外部设备(如视觉传感器)，提高了测量系统的规模、成本以及布置的时间。

(2)三角测量技术，如专利CN201621117777.7《一种可增强测量范围的激光测距装置》和CN201510467525.0《基于光电扫描的室内移动机器人位姿测量系统及测量方法》，可以在大场景中实现高精度测量。但该方法仍存在反射器布局较为复杂以及站点或障碍物遮挡导致定位失败等问题。

(3)概率定位技术，其通常采用扩展卡尔曼滤波器和蒙特卡罗定位等技术，如论文《基于自适应多提议分布粒子滤波的蒙特卡洛定位算法》所示，可以使用移动机器人自身传感器进行位姿测量，该方法测量精度较低。

综上所述，目前存在的移动机器人位姿测量系统在大尺度多站点的复杂场景中存在系统规模和成本大，布置的时间长，易受障碍物遮挡导致测量失效或者测量精度低等不足，并且没有对大尺度多站点环境的高精度位姿测量进行专门的研究。

发明内容

针对现有技术的以上缺陷或改进需求，本发明提供了一种用于大尺度多站点场景的移动机器人位姿测量方法及系统，其目的在于，通过将移动机器人在站点示教，利用点云匹配技术根据多帧雷达数据以及地图点云数据，计算出其在各个站点示教位置的精准位姿，即目标位姿；然后当机器人运动在站点附近或停靠在站点时，利用环绕车体的CCD相机以及站点标志，采用视觉测量方法获得目标位姿与当前位姿的相对位姿，结合目标位姿和相对位姿即可从实现移动机器人在站点附近的精确位姿测量。

为实现上述目的，按照本发明的一方面，提出了一种用于大尺度多站点场景的移动机器人位姿测量方法，包括如下步骤：

S1移动机器人在站点示教，获取移动机器人在该站点示教位置的绝对位姿，即目标位姿；