自移动机器人的行走探测控制方法
【技术领域】
[0001]本发明涉及一种自移动机器人的行走探测控制方法，属于小家电制造技术领域。
【背景技术】
[0002]自移动机器人是一种自动化程度较高的小型家用电器，能够在特定的工作区域内自行行走。但由于工作区域内行走表面的状况比较复杂，可能由于存在的凸起或凹陷导致的行走过程中遇到障碍物或坠落等情况，进而影响自移动机器人的正常行走和作业。为了解决这一问题，现有的自移动机器人通过在机体上设置位移探测传感器来对工作区域内的行走表面工况进行检测。在现有的自移动机器人中，位移探测传感器的安装方式主要包括两种，其中一种是垂直安装在机体上的，即:位移探测传感器的安装位置与机体的底面垂直，这种安装方式使自移动机器人只能探测到机器正下方是否有台阶，且待探测到后留给机器的反应时间很短。另一种是倾斜安装在机体上的，即:位移探测传感器的安装位置与机体的底面之间形成夹角。现有位移探测传感器的工作过程是对行走表面进行探测，并将探测信号与预设信号进行比较，当位移探测传感器接收到的探测信号与预设信号值时不符时，控制自移动机器人停止或转向。现有的安装控制方法，对于具有一定高度的机器人来说，如导购机器人，突然停止或转向容易导致机器人的跌倒而损坏。
【发明内容】
[0003]本发明所要解决的技术问题在于针对现有技术的不足，提供一种一种自移动机器人的行走探测控制方法，对行走环境情况判断准确，有效防止自移动机器人误动作和跌倒损坏。
[0004]本发明的所要解决的技术问题是通过如下技术方案实现的:
[0005]一种自移动机器人的行走探测控制方法，所述自移动机器人包括机体，机体上设有控制单元、驱动单元和感测单元，所述感测单元将感测到的信号发送给控制单元，控制单元根据感测信号控制驱动单元，驱动机体运动，所述的感测单元包括位移探测传感器，所述位移探测传感器倾斜设置在所述机体上，其设置中心线与机体底面之间的夹角为α，其中0° < α < 90° ;
[0006]该方法包括如下步骤:
[0007]步骤100:在自移动机器人中预设基本位移变化值Λ SO ；
[0008]步骤200:将自移动机器人置入工作区域，开始正常行走，所述位移探测传感器对其设置位置与工作区域行走表面之间的直线距离进行实时扫描，记录本时刻的直线距离S2和前一时刻的直线距离SI，实时计算两者之间的直线距离差，得到实时位移变化值Λ SI ；
[0009]步骤300:判断Λ SI是否大于等于Λ S0，如果否，则自移动机器人继续正常行走；如果是，则控制单元控制自移动机器人减速。
[0010]为了有效防止自移动机器人跌落，所述自移动机器人在步骤300中减速之后，控制单元还可以进一步控制自移动机器人转向。
[0011]为了防止自移动机器人在起始状态发生跌落，在所述步骤100之前还包括:
[0012]步骤010:在自移动机器人中预设基本距离值SO ；
[0013]步骤020:将自移动机器人置入工作区域，在开始正常行走之前，所述位移探测传感器首先对其设置位置与工作区域行走表面之间的直线距离进行扫描，得到初始距离值S3 ；
[0014]步骤030:将初始距离值S3与基本距离值SO进行比较，判断S3是否符合S0，如果是，则自移动机器人继续正常行走；如果否，则自移动机器人转向。
[0015]更具体地，所述步骤030包括:
[0016]当S3 > SO时，表示自移动机器人前方有下行台阶；
[0017]当S3 < SO时，表示自移动机器人前方有上行台阶。
[0018]根据需要，所述步骤100中的基本位移变化值Λ SO为8-15厘米；所述步骤010中的基本距离值SO为60-70厘米。
[0019]综合考虑灵敏度和工作效率等因素的影响，所述步骤200中的本时刻和前一时刻之间的时间差为200毫秒-500毫秒。
[0020]为了保证位移探测传感器有效工作，所述α的优选角度为30° -40°。
[0021]综上所述，本发明通过自移动机器人的控制单元先后对距离值和位移变化值分别进行预设和判断，从而防止漏判和误判；且当位移探测传感器探测到信号不符合预定要求时，先控制机体减速，减速之后再进行其他动作，既能够对行走环境情况判断准确，又有效防止自移动机器人误动作和跌倒损坏。
[0022]下面结合附图和具体实施例，对本发明的技术方案进行详细地说明。
【附图说明】
[0023]图1为本发明自移动机器人运动状态示意图；
[0024]图2为本发明自移动机器人初始位置靠近台阶的示意图。
【具体实施方式】
[0025]实施例一
[0026]图1为本发明自移动机器人运动状态示意图。本发明提供一种自移动机器人的行走探测控制方法，如图1所示，所述自移动机器人包括机体100,机体100上设有控制单元、驱动单元和感测单元，所述感测单元将感测到的信号发送给控制单元，控制单元根据感测信号控制驱动单元，驱动机体运动。所述的感测单元包括位移探测传感器200，所述位移探测传感器200倾斜设置在所述机体100上，其设置中心线与机体底面之间的夹角为α，其中0° < α <90°，α的优选角度为30° -40°。结合图1所示，将位移探测传感器200倾斜安装，使探测头向外，这样即可提前探测到前方的地面情况，若出现台阶，则也有充足的时间进行应对处理。
[0027]具体来说，为了有效防止自移动机器人在运动过程中因运到障碍而停止或因行走地面的高度差异而坠落，比如，上、下行台阶，该方法包括如下步骤:
[0028]步骤100:在自移动机器人中预设基本位移变化值Λ SO ；
[0029]步骤200:将自移动机器人置入工作区域，开始正常行走，所述位移探测传感器对其设置位置与工作区域行走表面之间的直线距离进行实时扫描，记录本时刻的直线距离S2和前一时刻的直线距离SI，实时计算两者之间的直线距离差，得到实时位移变化值Λ SI ；
[0030]步骤300:判断Λ SI是否大于等于Λ S0，如果否，则自移动机器人继续正常行走；如果是，则控制单元控制自移动机器人减速。为了有效防止自移动机器人跌落，所述自移动机器人在步骤300中减速之后，控制单元还可以进一步控制自移动机器人转向。
[0031]可以根据实际的需要，对所述步骤200中的本时刻和前一时刻之间时间差的大小进行限制。为了兼顾自移动机器人的灵敏度同时留有适当的信号反馈工作时间，通常可以设置为200晕秒-500晕秒。
[0032]另外需要说明的是，预设的基本位移变化值Λ SO不是定