[发明专利]机器人的导航控制方法

说明书

技术领域

本发明涉及控制系统，特别涉及机器人的行走控制系统。

背景技术

现有的群体机器人的控制系统如图1所示，在该框架中，一般是把任务调度和任务分配模块在服务器上实现，在机器人本身的计算机上实现路径规划、运动控制、障碍物避让等功能。比如，通过机器人本身的传感器探测地图的变化、障碍物的存在及运动，并使用机器人自身的计算机计算行进的路线。机器人之间通过无线网络互相通信，根据需要分享相互之间的位置、速度、姿态、及探测到的障碍物信息等。

为了保证机器人按照规划的路线行走，通常需要在机器人中设计一个用于测距的红外线检测模块，通过该模块对外界物体的测距，控制机器人的行走。

然而，在上述方案中，不但需要对机器人增设红外线检测模块，导致机器人的制造成本上升。而且，仅根据对外界物体的测距控制机器人的行走，也无法保证其行进路线的准确性。

发明内容

本发明的目的在于提供一种机器人的导航控制方法，不但可以降低机器人的制造成本，同时保证了对机器人行进路线的精准控制。

为解决上述技术问题，本发明的实施方式提供了一种机器人的导航控制方法，包含以下步骤：

机器人在根据制定的导航指令进行行走的过程中，周期性地获取位于机器人前方的路面图像；

在每一次获取到所述路面图像后，检测所述路面图像中是否存在地面标志；

如果存在所述地面标志，则根据以路面图像建立的坐标系，计算所述机器人的位置和方向；如果不存在所述地面标志，则根据航位推测法计算所述机器人的位置和方向；

所述机器人根据所述计算的位置和方向，控制所述机器人的行走方向和速度。

本发明实施方式相对于现有技术而言，通过周期性地获取位于机器人前方的路面图像，检测获取的路面图像中是否存在地面标志，并根据地面标志存在与否的检测结果分两种情况计算机器人的位置和方向，进而再根据计算的位置和方向，控制所述机器人的行走方向和速度。由于是利用了存在于地面上的地面标志，进行机器人当前位置和方向(姿态)的计算，因此无需对机器人增设红外线检测模块，降低了机器人的制造成本，而且坐标系的位置检测以及航位推测法的位置检测都是相对红外检测更为精准的位置计算方式，从而保证了对机器人行进路线的精准控制。另外，由于针对是否能检测到地面标志，分两种情况进行处理，可使得获取路面图像的周期时长不受限制，从而保证了对机器人行进方向与位置的实时计算。

优选地，在根据以路面图像建立的坐标系，计算所述机器人的位置和方向时，以所述路面图像的垂直方向为x轴方向，水平方向为y轴方向，建立坐标系；在建立的所述坐标系中，获取所述所述机器人的中心点K和所述地面标志的中心点T；判断所述K的y轴坐标与所述T的y轴坐标是否相同，如果相同，则判定所述机器人的行走方向未发生偏移；如果不相同，则判定所述机器人的行走方向发生偏移，计算所述机器人偏移的距离x和角度θ。在检测到地面标志的情况下，进一步根据路面图像的中轴线和地面标志的中轴线是否一致，判断机器人的行走方向是否发生偏移，计算简单，简化了机器人的运算负荷。

优选地，在根据航位推测法计算机器人的位置和方向时，根据以下公式计算机器人偏移的距离x和角度θ：

其中，所述v₀表示机器人的行进速度；所述r表示机器人左右侧的轮距；所述θ₀表示最近一次根据以路面图像建立的坐标系，计算到的机器人的偏移角度；所述x₀表示最近一次根据以路面图像建立的坐标系，计算到的机器人的偏移距离；所述Δv表示根据最近一次以路面图像建立的坐标系，计算到的机器人的偏移角度和偏移距离，在机器人的两个轮子上施加的纠正偏差的控制量，所述dt表示对时间的积分。进一步保证了在未检测到地面标志时，对机器人位置和方向的计算准确性。

优选地，机器人利用自身携带的摄像头周期性地拍摄前方路面，得到所述路面图像。由于摄像头是机器人本身会配备的设备，因此，本发明实施方式的机器人的导航控制方法，无需对机器人增设额外的设备，易于实现。

附图说明

图1是根据现有技术中的群体机器人的控制系统结构示意图；

图2是本发明第一实施方式所涉及的机器人群体的控制系统结构示意图；

图3是根据本发明第一实施方式的机器人的导航控制方法流程图；

图4是根据本发明第一实施方式中的地图栅格化示意图；

图5是根据本发明第一实施方式中的行进路线示意图；