CN104750105A - 自移动机器人的行走探测控制方法 - Google Patents

Abstract

一种自移动机器人的行走探测控制方法，包括步骤100：在自移动机器人中预设基本位移变化值△S0；步骤200：将自移动机器人置入工作区域，开始正常行走，所述位移探测传感器对其设置位置与工作区域行走表面之间的直线距离进行实时扫描，记录本时刻的直线距离S2和前一时刻的直线距离S1，实时计算两者之间的直线距离差，得到实时位移变化值△S1；步骤300：判断△S1是否大于等于△S0，如果否，则自移动机器人继续正常行走；如果是，则控制单元控制自移动机器人减速。本发明能够对行走环境情况判断准确，有效防止自移动机器人误动作和跌倒损坏。

Description

自移动机器人的行走探测控制方法

技术领域

本发明涉及一种自移动机器人的行走探测控制方法，属于小家电制造技术领域。

背景技术

自移动机器人是一种自动化程度较高的小型家用电器，能够在特定的工作区域内自行行走。但由于工作区域内行走表面的状况比较复杂，可能由于存在的凸起或凹陷导致的行走过程中遇到障碍物或坠落等情况，进而影响自移动机器人的正常行走和作业。为了解决这一问题，现有的自移动机器人通过在机体上设置位移探测传感器来对工作区域内的行走表面工况进行检测。在现有的自移动机器人中，位移探测传感器的安装方式主要包括两种，其中一种是垂直安装在机体上的，即：位移探测传感器的安装位置与机体的底面垂直，这种安装方式使自移动机器人只能探测到机器正下方是否有台阶，且待探测到后留给机器的反应时间很短。另一种是倾斜安装在机体上的，即：位移探测传感器的安装位置与机体的底面之间形成夹角。现有位移探测传感器的工作过程是对行走表面进行探测，并将探测信号与预设信号进行比较，当位移探测传感器接收到的探测信号与预设信号值时不符时，控制自移动机器人停止或转向。现有的安装控制方法，对于具有一定高度的机器人来说，如导购机器人，突然停止或转向容易导致机器人的跌倒而损坏。

发明内容

本发明所要解决的技术问题在于针对现有技术的不足，提供一种一种自移动机器人的行走探测控制方法，对行走环境情况判断准确，有效防止自移动机器人误动作和跌倒损坏。

本发明的所要解决的技术问题是通过如下技术方案实现的：

一种自移动机器人的行走探测控制方法，所述自移动机器人包括机体，机体上设有控制单元、驱动单元和感测单元，所述感测单元将感测到的信号发送给控制单元，控制单元根据感测信号控制驱动单元，驱动机体运动，所述的感测单元包括位移探测传感器，所述位移探测传感器倾斜设置在所述机体上，其设置中心线与机体底面之间的夹角为α，其中0°＜α＜90°；

该方法包括如下步骤：

步骤100：在自移动机器人中预设基本位移变化值△S0；

步骤200：将自移动机器人置入工作区域，开始正常行走，所述位移探测传感器对其设置位置与工作区域行走表面之间的直线距离进行实时扫描，记录本时刻的直线距离S2和前一时刻的直线距离S1，实时计算两者之间的直线距离差，得到实时位移变化值△S1；

步骤300：判断△S1是否大于等于△S0，如果否，则自移动机器人继续正常行走；如果是，则控制单元控制自移动机器人减速。

为了有效防止自移动机器人跌落，所述自移动机器人在步骤300中减速之后，控制单元还可以进一步控制自移动机器人转向。

为了防止自移动机器人在起始状态发生跌落，在所述步骤100之前还包括：

步骤010：在自移动机器人中预设基本距离值S0；

步骤020：将自移动机器人置入工作区域，在开始正常行走之前，所述位移探测传感器首先对其设置位置与工作区域行走表面之间的直线距离进行扫描，得到初始距离值S3；

步骤030：将初始距离值S3与基本距离值S0进行比较，判断S3是否符合S0，如果是，则自移动机器人继续正常行走；如果否，则自移动机器人转向。

更具体地，所述步骤030包括：

当S3＞S0时，表示自移动机器人前方有下行台阶；

当S3＜S0时，表示自移动机器人前方有上行台阶。

根据需要，所述步骤100中的基本位移变化值△S0为8-15厘米；所述步骤010中的基本距离值S0为60-70厘米。

综合考虑灵敏度和工作效率等因素的影响，所述步骤200中的本时刻和前一时刻之间的时间差为200毫秒-500毫秒。

为了保证位移探测传感器有效工作，所述α的优选角度为30°-40°。

综上所述，本发明通过自移动机器人的控制单元先后对距离值和位移变化值分别进行预设和判断，从而防止漏判和误判；且当位移探测传感器探测到信号不符合预定要求时，先控制机体减速，减速之后再进行其他动作，既能够对行走环境情况判断准确，又有效防止自移动机器人误动作和跌倒损坏。

下面结合附图和具体实施例，对本发明的技术方案进行详细地说明。

附图说明

图1为本发明自移动机器人运动状态示意图；

图2为本发明自移动机器人初始位置靠近台阶的示意图。

具体实施方式

实施例一

图1为本发明自移动机器人运动状态示意图。本发明提供一种自移动机器人的行走探测控制方法，如图1所示，所述自移动机器人包括机体100，机体100上设有控制单元、驱动单元和感测单元，所述感测单元将感测到的信号发送给控制单元，控制单元根据感测信号控制驱动单元，驱动机体运动。所述的感测单元包括位移探测传感器200，所述位移探测传感器200倾斜设置在所述机体100上，其设置中心线与机体底面之间的夹角为α，其中0°＜α＜90°，α的优选角度为30°-40°。结合图1所示，将位移探测传感器200倾斜安装，使探测头向外，这样即可提前探测到前方的地面情况，若出现台阶，则也有充足的时间进行应对处理。

具体来说，为了有效防止自移动机器人在运动过程中因运到障碍而停止或因行走地面的高度差异而坠落，比如，上、下行台阶，该方法包括如下步骤：

步骤100：在自移动机器人中预设基本位移变化值△S0；

步骤200：将自移动机器人置入工作区域，开始正常行走，所述位移探测传感器对其设置位置与工作区域行走表面之间的直线距离进行实时扫描，记录本时刻的直线距离S2和前一时刻的直线距离S1，实时计算两者之间的直线距离差，得到实时位移变化值△S1；

步骤300：判断△S1是否大于等于△S0，如果否，则自移动机器人继续正常行走；如果是，则控制单元控制自移动机器人减速。为了有效防止自移动机器人跌落，所述自移动机器人在步骤300中减速之后，控制单元还可以进一步控制自移动机器人转向。

可以根据实际的需要，对所述步骤200中的本时刻和前一时刻之间时间差的大小进行限制。为了兼顾自移动机器人的灵敏度同时留有适当的信号反馈工作时间，通常可以设置为200毫秒-500毫秒。

另外需要说明的是，预设的基本位移变化值△S0不是定值而是一个范围值，通常为8-15厘米，一旦在自移动机器人中预设完成，就作为定值与△S0判断对照使用。

实施例二

前述实施例中，是在自移动机器人的行进过程中对行走环境的判断和控制。除了上述判断控制过程之外，如果自移动机器人刚刚开机处于初始位置，还没有进入运动状态之前，也需要对所处状态进行判断。因此，本实施例是对实施例判断控制过程的优化，具体来说，在所述步骤100之前还包括：

步骤010：在自移动机器人中预设基本距离值S0，为60-70厘米；

步骤020：将自移动机器人置入工作区域，在开始正常行走之前，所述位移探测传感器首先对其设置位置与工作区域行走表面之间的直线距离进行扫描，得到初始距离值S3；

步骤030：将初始距离值S3与基本距离值S0进行比较，判断两者是否相等，如果结果为是，则自移动机器人继续正常行走；如果结果为否，则自移动机器人转向。

其中，所述步骤030具体包括：

当S3＞S0时，表示自移动机器人前方有下行台阶；

当S3＜S0时，表示自移动机器人前方有上行台阶。

同样地，预设的基本距离值S0的大小在预设之前也是一个范围值，同城为60-70厘米。一旦预设完成，则作为定值对照使用。

本实施例中的其他技术特征与前述实施例一相同，参见前述内容，在此不再赘述。

综合上述两个实施例可知，本发明自移动机器人的行走探测控制方法，当与机体倾斜安装的位移探测传感器探测信号不符合预定要求时，提前控制机体减速，防止机器人突然停止或转向而跌倒。特别的，本发明通过位移探测传感器对自移动机器人所处行走环境的探测还可以具体区分为启动状态和行走状态的探测。机体每次在启动状态下启动行走时，都需要先行判断初始距离值S3与基本距离值S0之间的大小关系，进而确定直接启动正常行走还是转向。当机体进入正常行走状态时，再通过后续对实时位移变化值△S1是否处于基本位移变化值△S0的范围值内的判断，确定自移动机器人正常行走或者减速。这种通过利用位移变化值进行判断，控制自移动机器人提前减速的控制方式，既可以避免现有判断控制方法中采用实时位移值与预设位移值比对时，易产生的误判，又可以通过提前减速的方式，防止自移动机器人在现有突然转向或停止的动作中不稳而摔倒。

换句话说，如实施例一中单纯利用位移变化值△S与预设值比较来判断机体前方或后方是否具有障碍物的方法，可以准确判断控制行走过程中的状况，但对于启动初期仍然不够安全。尤其是当自移动机器人的初始位置A刚好位于台阶附近时，如图2所示，机体通过位移变化值△S（△S趋于0，小于△S0）是无法判断前方存在台阶的，刚启动开始行走就面临坠落的危险。此时，如实施例二所述，可优先通过判断初始距离值S3与基本距离值S0之间的大小关系，进而确定直接启动正常行走还是转向。

因此，本发明的关键点在于：其一，自移动机器人的控制单元需要先后对距离值和位移变化值分别进行预设和判断，从而防止漏判和误判；其二，当位移探测传感器探测到信号不符合预定要求时，控制机体减速，从而防止自移动机器人摔倒。

Claims (8)

1.一种自移动机器人的行走探测控制方法，所述自移动机器人包括机体，机体上设有控制单元、驱动单元和感测单元，所述感测单元将感测到的信号发送给控制单元，控制单元根据感测信号控制驱动单元，驱动机体运动，所述的感测单元包括位移探测传感器，所述位移探测传感器倾斜设置在所述机体上，其设置中心线与机体底面之间的夹角为α，其中0°＜α＜90°；

其特征在于，该方法包括如下步骤：

步骤100：在自移动机器人中预设基本位移变化值△S0；

步骤200：将自移动机器人置入工作区域，开始正常行走，所述位移探测传感器对其设置位置与工作区域行走表面之间的直线距离进行实时扫描，记录本时刻的直线距离S2和前一时刻的直线距离S1，实时计算两者之间的直线距离差，得到实时位移变化值△S1；

步骤300：判断△S1是否大于等于△S0，如果否，则自移动机器人继续正常行走；如果是，则控制单元控制自移动机器人减速。

2.如权利要求1所述的方法，其特征在于，所述步骤300具体包括：所述自移动机器人减速后，控制单元控制自移动机器人转向。

3.如权利要求2所述的方法，其特征在于，所述步骤100之前还包括：

步骤010：在自移动机器人中预设基本距离值S0；

步骤020：将自移动机器人置入工作区域，在开始正常行走之前，所述位移探测传感器首先对其设置位置与工作区域行走表面之间的直线距离进行扫描，得到初始距离值S3；

步骤030：将初始距离值S3与基本距离值S0进行比较，判断S3是否符合S0，如果是，则自移动机器人继续正常行走；如果否，则自移动机器人转向。

4.如权利要求3所述的方法，其特征在于，所述步骤030具体包括：

当S3＞S0时，表示自移动机器人前方有下行台阶；

当S3＜S0时，表示自移动机器人前方有上行台阶。

5.如权利要求1所述的方法，其特征在于，所述步骤100中的基本位移变化值△S0为8-15厘米。

6.如权利要求1所述的方法，其特征在于，所述步骤200中的本时刻和前一时刻之间的时间差为200毫秒-500毫秒。

7.如权利要求1所述的方法，其特征在于，所述α的优选角度为30°-40°。

8.如权利要求3所述的方法，其特征在于，所述步骤010中的基本距离值S0为60-70厘米。