CN110448241A - 机器人被困检测及脱困方法 - Google Patents

机器人被困检测及脱困方法 Download PDF

Info

Publication number
CN110448241A
CN110448241A CN201910649017.2A CN201910649017A CN110448241A CN 110448241 A CN110448241 A CN 110448241A CN 201910649017 A CN201910649017 A CN 201910649017A CN 110448241 A CN110448241 A CN 110448241A
Authority
CN
China
Prior art keywords
robot
grid coordinate
poverty
region
grid
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN201910649017.2A
Other languages
English (en)
Other versions
CN110448241B (zh
Inventor
周娴玮
曾国威
郑卓斌
王立磊
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Guangdong Bona Robot Corp ltd
South China Normal University
Original Assignee
Guangdong Bolak Robot Ltd By Share Ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Guangdong Bolak Robot Ltd By Share Ltd filed Critical Guangdong Bolak Robot Ltd By Share Ltd
Priority to CN201910649017.2A priority Critical patent/CN110448241B/zh
Publication of CN110448241A publication Critical patent/CN110448241A/zh
Priority to PCT/CN2020/102738 priority patent/WO2021008611A1/zh
Application granted granted Critical
Publication of CN110448241B publication Critical patent/CN110448241B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Classifications

    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/24Floor-sweeping machines, motor-driven
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
    • A47L11/4011Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L11/00Machines for cleaning floors, carpets, furniture, walls, or wall coverings
    • A47L11/40Parts or details of machines not provided for in groups A47L11/02 - A47L11/38, or not restricted to one of these groups, e.g. handles, arrangements of switches, skirts, buffers, levers
    • A47L11/4061Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • AHUMAN NECESSITIES
    • A47FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
    • A47LDOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
    • A47L2201/00Robotic cleaning machines, i.e. with automatic control of the travelling movement or the cleaning operation
    • A47L2201/04Automatic control of the travelling movement; Automatic obstacle detection

Landscapes

  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本发明涉及一种机器人被困检测及脱困方法。该被困检测方法包括:建立栅格地图获取所述机器人当前位置在栅格地图下的第一栅格坐标和目标位置在所述栅格地图下的第二栅格坐标,目标位置为所述机器人检测过的位置;根据第一栅格坐标和第二栅格坐标判断所述机器人所处的区域是否为封闭状态;响应于机器人所处的区域为封闭状态,则判断所述第一栅格坐标所在的连通区域的数量;响应于第一栅格坐标所在的连通区域大于或等于两个,则获取所述第一栅格坐标所处区域的封闭清扫面积;根据所述封闭清扫面积判断所述机器人是否被困于狭窄区域。本申请可以快速、及时的检测出机器人是否被困,从而提高机器人的有效清扫效率,降低系统的能量损耗。

Description

机器人被困检测及脱困方法
技术领域
本发明涉及机器人运动控制技术领域,特别是涉及一种机器人被困检测及脱困方法。
背景技术
自主移动机器人是一类利用传感器自主探测周围环境、利用控制器来决定本体的运动、,利用执行机构(如轮子)来实现上述运动的机器人。随着经济和科技的发展,越来越多的清洁机器人已经在家庭得到应用。现有的清洁机器人如在家庭环境中凳子的四条脚、茶几的入口等狭窄区域,清洁机器人若进入这些区域,由于累计误差的存在、碰撞传感器和红外传感器的分辨率低,机器人想从原来的入口离开,只要略有偏差,就容易撞上边角,导致被困于此狭窄区域,而不能清扫家庭中的其他地方。
传统的技术方案在进入狭窄区域后,往往需要很长时间才能检测被困于此,并需要很长时间才能脱离。比如部分机器人采用弓形清扫和沿边清扫结合的方式来缓解狭窄区域被困的问题,即弓形清扫一段时间后,立即切换到沿边清扫方式,此时若机器人被困于狭窄区域,则有可能顺着障碍物的轮廓行走脱离此区域。因此这种方式不能及时发现机器被困于狭窄区域,也无法判断是否能真的脱离此狭窄区域。
另外一些清洁机器人利用精密的距离传感器(如激光雷达)来探测周围的障碍物轮廓,由于其精度高,虽然机器人存在累计误差和打滑情况,但只要狭窄区域入口并未真正堵住,机器人就能调整姿态,从入口离开此区域。但是这种方式的距离传感器价格昂贵,只能在少部分机器上使用。
发明内容
基于此,有必要针对上述问题,提供一种机器人被困检测及脱困方法。
一种机器人被困检测方法,所述方法包括:
建立栅格地图,所述机器人行进过程中实时更新所述栅格地图,获取所述机器人当前位置在所述栅格地图下的第一栅格坐标和目标位置在所述栅格地图下的第二栅格坐标,所述目标位置为所述机器人检测过的位置;
根据所述第一栅格坐标和所述第二栅格坐标判断所述机器人所处的区域是否为封闭状态;
响应于所述机器人所处的区域为封闭状态,则判断所述第一栅格坐标所在的连通区域的数量;
响应于所述第一栅格坐标所在的连通区域大于或等于两个,则获取所述第一栅格坐标所处区域的封闭清扫面积;
根据所述封闭清扫面积判断所述机器人是否被困于狭窄区域。
在其中一个实施例中,所述根据所述封闭清扫面积判断所述机器人是否被困于狭窄区域的步骤,包括:
判断所述封闭清扫面积是否小于第一预设阈值;
若是,则判定所述机器人被困于狭窄区域。
在其中一个实施例中,所述方法还包括:
响应于所述封闭清扫面积大于所述第一预设阈值,则判断所述第一栅格坐标所在的连通区域的面积与最大连通区域的面积之间的比值是否小于第二预设阈值;
若是,则判定所述机器人被困在狭窄区域。
在其中一个实施例中,所述第二预设阈值为0.3-0.4。
在其中一个实施例中,所述根据所述第一栅格坐标和所述第二栅格坐标判断所述机器人所处的区域是否为封闭状态的步骤,包括:
判断所述第一栅格坐标和所述第二栅格坐标之间是否具有路径;
响应于所述第一栅格坐标和所述第二栅格坐标之间不具有路径,则判定所述机器人所处的区域为封闭状态。
基于同样的发明构思,本申请还提供一种机器人脱困方法,所述方法包括:
通过前述所述的机器人被困检测方法,确定所述机器人被困在狭窄区域;
控制所述机器人切换至沿边模式;其中,所述沿边模式下,所述机器人与障碍物或者栅格地图边界之间的距离保持一定;
于所述沿边模式下,所述机器人按照预设的沿边方向进行移动;
在移动过程中实时更新所述机器人在所述栅格地图下的栅格坐标,并根据更新后的所述栅格坐标判断所述机器人是否脱困。
在其中一个实施例中,所述根据更新后的栅格坐标判断所述机器人是否脱困的步骤,包括:
根据所述更新后的所述栅格坐标获取所述机器人所处的第一连通区域;
判断所述第一连通区域是否与所述机器人记录到的外部连通区域连通;
响应于所述第一连通区域与所述机器人记录到的外部连通区域连通,则脱困成功。
在其中一个实施例中,所述方法还包括:
若所述第一连通区域与所述机器人记录到的最大栅格地图区域之间的间隔在一预设距离,则判定所述机器人脱困成功。
在其中一个实施例中,所述脱困方法还包括:
响应于所述机器人按照当前的沿边方向仍然未能脱困成功;
则控制所述机器人以与当前沿边方向相反的方向继续进行移动;
记录所述机器人在移动过程中沿边行走的第一累计角度。
在其中一个实施例中,所述机器人包括红外传感器和碰撞传感器;所述脱困方法还包括:
响应于记录到的第一累计角度的绝对值大于预设阈值,则控制所述红外传感器关闭;
通过所述碰撞传感器进行沿边移动,在所述碰撞传感器移动过程中实时更新所述机器人在所述栅格地图下的栅格坐标、并记录所述机器人在移动过程中沿边行走的第二累计角度,并根据更新后的所述栅格坐标和所述第二累计角度判断所述机器人是否脱困;
响应于记录到的第二累计角度的绝对值大于同一预设阈值,则判定所述机器人所处的区域被封死,并控制所述机器人停止工作。
上述机器人被困检测及脱困方法,通过建立栅格地图,先判断机器人是否处于封闭状态,然后获取机器人所在的连通区域的数量,最后获取机器人的封闭清扫面积,并根据封闭清扫面积来判断机器人是否被困在狭窄区域这样层层递进的方式来检验机器人是否被困在狭窄区域;相比于传统的被困检测方法来说,可以快速、及时的检测出机器人是否被困,从而提高机器人的有效清扫效率,降低系统的能量损耗;同时此方法不需要机器人具备精密的距离传感器(如激光雷达),只需要普通的红外或者碰撞传感器即可,所以可以降低机器人的成本。
附图说明
图1为一实施例中的机器人被困检测方法流程示意图;
图2为图1中步骤S110的具体实现方法流程示意图;
图3为图1中步骤S104的具体实现方法流程示意图;
图4为一实施例中的机器人脱困方法流程示意图;
图5为图4中步骤S408的具体实现方法流程示意图;
图6为机器人初始位置时建立的栅格地图;
图7为机器人按照规划的清洁路径进行移动时建立的栅格地图;
图8为机器人按照规划的清洁路径移动到房间门口时建立的栅格地图;
图9为机器人从门口进入狭窄区域进行清洁时建立的栅格地图;
图10为机器人清洁完狭窄区域后建立的栅格地图;
图11为一实施中的机器人脱困示意图。
具体实施方式
为了便于理解本申请,下面将参照相关附图对本申请进行更全面的描述。附图中给出了本申请的较佳实施方式。但是,本申请可以以许多不同的形式来实现,并不限于本文所描述的实施方式。相反地,提供这些实施方式的目的是使对本申请的公开内容理解的更加透彻全面。
需要说明的是,当元件被称为“固定于”另一个元件,它可以直接在另一个元件上或者也可以存在居中的元件。当一个元件被认为是“连接”另一个元件,它可以是直接连接到另一个元件或者可能同时存在居中元件。本文所使用的术语“垂直的”、“水平的”、“左”、“右”以及类似的表述只是为了说明的目的,并不表示是唯一的实施方式。
除非另有定义,本文所使用的所有的技术和科学术语与属于本申请的技术领域的技术人员通常理解的含义相同。本文中在本申请的说明书中所使用的术语只是为了描述具体的实施方式的目的,不是旨在于限制本申请。
一般的扫地机器人进入狭窄区域后,往往需要很长时间才能检测被困于此,并需要很长时间才能脱离。比如部分机器人采用弓形清扫和沿边清扫结合的方式来缓解狭窄区域被困的问题,即弓形清扫一段时间后,立即切换到沿边清扫方式,此时若机器人被困于狭窄区域,则有可能顺着障碍物的轮廓行走脱离此区域。因此这种方式不能及时发现机器被困于狭窄区域,也无法判断是否能真的脱离此狭窄区域。
另外一些清洁机器人利用精密的距离传感器(如激光雷达)来探测周围的障碍物轮廓,由于其精度高,虽然机器人存在累计误差和打滑情况,但只要狭窄区域入口并未真正堵住,机器人就能调整姿态,从入口离开此区域。但是这种方式的距离传感器价格昂贵,只能在少部分机器上使用。
基于此,本申请希望提供一种能够解决上述技术问题的技术方案。本申请所提供的技术方案将在以下实施例中详细说明。
请先参阅图6、7、8、9、10、11。该栅格地图中,RB表示机器人,L1表示第一参考线,带有箭头的虚线表示机器人RB的清扫路线,带有箭头的实线表示机器人RB的脱困路线,A表示栅格地图的边界,B表示障碍物,C表示机器人RB上次记录为障碍不可通过,但实际为可以通过的区域,D表示机器人RB的传感器探测认为能去的区域,E表示机器人RB未探测区域,空白部分表示已经清扫的区域,Dr表示门,A1表示第一区域,A2表示第二区域,T表示目标位置。应当说明的是,本申请中B可能会变化(由于移动障碍或者误差)。
请先参阅图7-图10,如图7所示,机器人RB在清扫过程中,一边清扫一边建立栅格地图,其自带的传感器可以感应前方及左右的共五个栅格坐标(阴影部分),确认相应位置是否有障碍物,若存在障碍物则标识为B,若无障碍物则标识为D。如图8所示,机器人RB行进到门附近,门Dr所在的栅格单元标识为D,表示可以行进,并经由该门Dr进入到第一区域A1。如图9所示,机器人进入到第一区域A1后,由于传感器误差将半掩的门Dr感应为障碍物B/或进入后由于门Dr被关闭使得该栅格单元被感应为障碍物B。由于机器人RB之前由该栅格位置进入第一区域A1,后续才感应到该栅格单元为障碍物B,因而将栅格单元标注为C。如图10所示,机器人RB完成第一区域A1的清扫,其传感器感应到周围的栅格单元要么被清扫,要么为障碍物B或者边界A,因而准备寻找新的区域进行清扫。此时将寻找之前未清扫但已探测过的栅格单元D作为目标位置T,从而开始进行机器人的被困检测和脱困过程。
请同时参阅图1和图7,本申请提供一种机器人被困检测方法。该方法可以包括步骤S102-S110。
步骤S102,建立栅格地图,所述机器人行进过程中实时更新所述栅格地图,获取所述机器人当前位置在所述栅格地图下的第一栅格坐标和目标位置在所述栅格地图下的第二栅格坐标,所述目标位置为所述机器人检测过的位置。
具体地,通常扫地机器人在执行清扫作业的时候,均会按照预设的路径规划进行行走,通过建立栅格地图来计算扫地机器人行走的栅格数,从而可以实现构建地图,记录清扫轨迹,计算清扫面积等功能。本申请也通过建立栅格地图来进行路径规划。在本具体实施例中,机器人开始清扫前,会建立一个带边界的地图,边界标识为A。机器人在清扫过程中,一边清扫一边建立栅格地图,其自带的传感器可以感应前方及左右的共五个栅格坐标(阴影部分),确认相应位置是否有障碍物,若存在障碍物则标识为B,若无障碍物则标识为D。获取机器人当前在所述栅格地图下的位置坐标,记为第一栅格坐标(图未示),以及目标位置在所述栅格地图下的位置坐标,记为第二栅格坐标(图未示)。目标位置为所述机器人检测过、且检测无障碍物的位置,通常,机器人之所以会出现这样一个判断是因为机器人已清扫完当前区域,需要寻找新的清扫区域。
步骤S104,根据所述第一栅格坐标和所述第二栅格坐标判断所述机器人所处的区域是否为封闭状态。
具体地,该步骤S104可以包括子步骤S1042-S1046。
步骤S1042,判断所述第一栅格坐标和所述第二栅格坐标之间是否具有路径。
步骤S1044,响应于所述第一栅格坐标和所述第二栅格坐标之间不具有路径,则判定所述机器人所处的区域为封闭状态。
具体地,如果所述第一栅格坐标和所述第二栅格坐标之间不具有路径,则表明机器人所处的区域为封闭状态。
步骤S106,响应于所述机器人所处的区域为封闭状态,则判断所述第一栅格坐标所在的连通区域的数量。
步骤S108,响应于所述第一栅格坐标所在的连通区域大于或等于两个,则获取以所述第一栅格坐标为中心,向外层层扩散的封闭清扫面积。
具体地,根据前述步骤确定机器人RB所处的区域为封闭状态之后,可以开始搜索整个栅格地图,获取第一栅格坐标所在的连通区域的数量。其中,连通区域指该区域内所有点可以互相连通,外部为障碍或者地图边界的一个区域。如果发现连通区域大于或等于两个,说明还有其他需要清扫的区域;如果当该连通区域为唯一时,说明机器人已经处于唯一的清扫环境下,不需要再跨越到其他区域清扫。然后获取以所述第一栅格坐标为中心,向外层层扩散的封闭清扫面积。
步骤S110,根据所述封闭清扫面积判断所述机器人是否被困于狭窄区域。
具体地,该步骤S110可以包括子步骤S112-S114。
步骤S112,判断所述封闭清扫面积是否小于第一预设阈值。
步骤S114,若是,则判定所述机器人被困于狭窄区域。
具体地,判断获取的封闭清扫面积与第一预设阈值的大小,本申请中,第一预设阈值可以为2平方米,如果获取的封闭清扫面积小于2平方米,则判定机器人RB被困于狭窄区域。
在一个实施例中,该机器人被困检测方法还可以包括步骤:
响应于所述封闭清扫面积大于所述第一预设阈值,则判断所述第一栅格坐标所在的连通区域的面积与最大连通区域的面积之间的比值是否小于第二预设阈值;
若是,则判定所述机器人被困在狭窄区域。
具体地,如果获取的封闭清扫面积大于2平方米,但是第一栅格坐标所在的连通区域的面积与最大连通区域的面积之间的比值又小于第二预设阈值,本申请中,第二预设阈值可以为0.3-0.4。因为,机器人RB当前所在的连通区域相比最大连通区域的面积来说,小得多,通过机器人RB当前所在的连通区域相比最大连通区域的面积来进行判定也可以判定机器人被困在狭窄区域。如果所述第一栅格坐标所在的连通区域的面积与最大连通区域的面积之间的比值大于0.4,则也可以表明机器人所处的区域不为狭窄区域。
上述机器人被困检测方法,通过建立栅格地图,先判断机器人是否处于封闭状态,然后获取机器人所在的连通区域的数量,最后获取机器人的封闭清扫面积,并根据封闭清扫面积来判断机器人是否被困在狭窄区域这样层层递进的方式来检验机器人是否被困在狭窄区域,可以快速、及时的检测出机器人是否被困,从而提高机器人的有效清扫效率,降低系统的能量损耗;同时此方法不需要机器人具备精密的距离传感器(如激光雷达),只需要普通的红外或者碰撞传感器即可,所以可以降低机器人的成本。
基于同样的发明构思,请参阅图4,本申请还提供一种机器人脱困方法,该方法可以包括步骤:S402-S408。
步骤S402,通过前述所述的机器人被困检测方法,确定所述机器人被困在狭窄区域。
具体地,可辅助参阅图9,机器人RB按照预设的路径规划进行清扫作业,开始时,机器人RB从狭窄入口(Dr)进入狭窄区域(第一区域A1)进行清扫,此时入口未封闭,机器人RB在狭窄区域清扫的过程中,因移动障碍、误差等原因探测导致狭窄入口被封闭,机器人将其进行标记为状态C;然后此时通过前述的机器人被困检测方法,确定机器人被困在狭窄区域。
步骤S404,控制所述机器人切换至沿边模式;其中,所述沿边模式下,所述机器人与障碍物或者栅格地图边界之间的距离保持一定。
具体地,可先设定机器人RB中的距离传感器(红外传感器)的感应阈值,不停调整机器位置使得该阈值为恒定值,使机器人RB与障碍物或者栅格地图边界之间的距离保持一定,(通常为0.5厘米-1.5厘米),从而实现模式的切换。
步骤S406,于所述沿边模式下,所述机器人按照预设的沿边方向进行移动。
具体地,作为机器人脱困方法中比较重要的沿边方向,可辅助参阅图11,本申请中预设的沿边方向为所述机器人RB当前位置指向瓶颈的方向偏离第一参考线或第二参考线的方向。如图11所示,L1为第一参考线,也就是垂直方向的直线,其中,所述瓶颈为狭窄区域的入口,也就是C,所述第一参考线与所述第二参考线垂直,相应的,第二参考线为水平方向的直线。以图11所示为例,机器人RB当前位置与入口C的连线方向相对于第一参考线L1来说,位于第一参考线L1的左边,所以,可以设置机器人RB的沿边方向为逆时针旋转(位于右边设置为顺时针旋转)。
步骤S408,在移动过程中实时更新所述机器人在所述栅格地图下的栅格坐标,并根据更新后的所述栅格坐标判断所述机器人是否脱困。
具体地,该步骤S408还可以包括子步骤S4082-S4086。
步骤S4082,根据所述更新后的所述栅格坐标获取所述机器人所处的第一连通区域。
步骤S4084,判断所述第一连通区域是否与所述机器人记录到的外部连通区域连通。
步骤S4086,响应于所述第一连通区域与所述机器人记录到的外部连通区域连通,则脱困成功。
具体地,当机器人RB按照前述确定的沿边方向进行移动的过程中,实时更新所述机器人RB在所述栅格地图下的栅格坐标,并且根据更新后的所述栅格坐标获取所述机器人RB所处的第一连通区域,然后判断所述第一连通区域是否与所述机器人RB记录到的外部连通区域连通,如果发现,第一连通区域与外部区域连通,则表明脱困成功。
在一个实施例中,该机器人脱困方法还可以包括步骤:
若所述第一连通区域与所述机器人记录到的最大栅格地图区域之间的间隔在一预设距离,则判定所述机器人脱困成功。
具体地,在遇到狭窄区域的出口被打开(例如门Dr被开启),机器人RB从门Dr进入另外一个未在当前栅格地图记录的区域(例如第二区域A2)下时,也就是机器人RB有可能发现了一个新区域,此时,进入该新区域A2也可以视为脱困,本申请将新发现的区域与所述机器人RB记录到的最大栅格地图区域之间的间隔设定在一预设距离作为判定机器人RB是否进入新区域的一个依据,该预设距离可以为60厘米,如果大于或者等于60厘米,则表明机器人RB进入了一个新的区域,此种情况也可以视为脱困。
在一个实施例中,该脱困方法还可以包括以下步骤:
响应于所述机器人按照当前的沿边方向仍然未能脱困成功;
则控制所述机器人以与当前沿边方向相反的方向继续进行移动;
记录所述机器人在移动过程中沿边行走的第一累计角度。
具体地,在机器人RB按照当前的沿边方向仍然未能脱困成功的情况下,则控制机器人RB反向沿边(即与前面沿边方向相反的方向),同时纪录机器人在狭窄区域的沿边行走的累计角度,该累计角度可以记为第一累计角度。
进一步地,所述脱困方法还可以包括步骤:
响应于记录到的第一累计角度的绝对值大于预设阈值,则控制所述红外传感器关闭;
通过所述碰撞传感器进行沿边移动,在所述碰撞传感器移动过程中实时更新所述机器人在所述栅格地图下的栅格坐标、并记录所述机器人在移动过程中沿边行走的第二累计角度,并根据更新后的所述栅格坐标和所述第二累计角度判断所述机器人是否脱困;
响应于记录到的第二累计角度的绝对值大于同一预设阈值,则判定所述机器人所处的区域被封死,并控制所述机器人停止工作。
具体地,在机器人RB反向沿边的过程中,若记录到的第一累计角度的绝对值>360°+A(A为保证算法鲁棒性的边缘角度,一般为90°左右,以保证机器人RB能刚好沿墙体一周多点),则关闭机器人RB的红外传感器,利用机器人RB的碰撞传感器进行沿边,同时实时更新机器人RB的栅格坐标,并根据更新的栅格坐标获取连通区域,判断该连通区域是否与外部区域连通;若记录的第二累计角度的绝对值>360°+A,并且仍然未脱困成功,则说明该区域已被人为封死,则控制机器人RB停机。此流程可以避免机器人RB长时间进行无用的脱困操作,导致机器人RB系统的能量损耗。
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。
以上所述实施例仅表达了本发明的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本发明构思的前提下,还可以做出若干变形和改进,这些都属于本发明的保护范围。因此,本发明专利的保护范围应以所附权利要求为准。

Claims (10)

1.一种机器人被困检测方法,其特征在于,所述方法包括:
建立栅格地图,所述机器人行进过程中实时更新所述栅格地图,获取所述机器人当前位置在所述栅格地图下的第一栅格坐标和目标位置在所述栅格地图下的第二栅格坐标,所述目标位置为所述机器人检测过的位置;
根据所述第一栅格坐标和所述第二栅格坐标判断所述机器人所处的区域是否为封闭状态;
响应于所述机器人所处的区域为封闭状态,则判断所述第一栅格坐标所在的连通区域的数量;
响应于所述第一栅格坐标所在的连通区域大于或等于两个,则获取所述第一栅格坐标所处区域的封闭清扫面积;
根据所述封闭清扫面积判断所述机器人是否被困于狭窄区域。
2.根据权利要求1所述的机器人被困检测方法,其特征在于,所述根据所述封闭清扫面积判断所述机器人是否被困于狭窄区域的步骤,包括:
判断所述封闭清扫面积是否小于第一预设阈值;
若是,则判定所述机器人被困于狭窄区域。
3.根据权利要求2所述的机器人被困检测方法,其特征在于,还包括:
响应于所述封闭清扫面积大于所述第一预设阈值,则判断所述第一栅格坐标所在的连通区域的面积与最大连通区域的面积之间的比值是否小于第二预设阈值;
若是,则判定所述机器人被困在狭窄区域。
4.根据权利要求3所述的机器人被困检测方法,其特征在于,所述第二预设阈值为0.3-0.4。
5.根据权利要求1所述的机器人被困检测方法,其特征在于,所述根据所述第一栅格坐标和所述第二栅格坐标判断所述机器人所处的区域是否为封闭状态的步骤,包括:
判断所述第一栅格坐标和所述第二栅格坐标之间是否具有路径;
响应于所述第一栅格坐标和所述第二栅格坐标之间不具有路径,则判定所述机器人所处的区域为封闭状态。
6.一种机器人脱困方法,其特征在于,所述方法包括:
通过权利要求1-5任一项所述的机器人被困检测方法,确定所述机器人被困在狭窄区域;
控制所述机器人切换至沿边模式;其中,所述沿边模式下,所述机器人与障碍物或者栅格地图边界之间的距离保持一定;
于所述沿边模式下,所述机器人按照预设的沿边方向进行移动;
在移动过程中实时更新所述机器人在所述栅格地图下的栅格坐标,并根据更新后的所述栅格坐标判断所述机器人是否脱困。
7.根据权利要求6所述的机器人脱困方法,其特征在于,所述根据更新后的栅格坐标判断所述机器人是否脱困的步骤,包括:
根据所述更新后的所述栅格坐标获取所述机器人所处的第一连通区域;
判断所述第一连通区域是否与所述机器人记录到的外部连通区域连通;
响应于所述第一连通区域与所述机器人记录到的外部连通区域连通,则脱困成功。
8.根据权利要求7所述的机器人脱困方法,其特征在于,还包括:
若所述第一连通区域与所述机器人记录到的最大栅格地图区域之间的间隔在一预设距离,则判定所述机器人脱困成功。
9.根据权利要求6所述的机器人脱困方法,其特征在于,所述脱困方法还包括:
响应于所述机器人按照当前的沿边方向仍然未能脱困成功;
则控制所述机器人以与当前沿边方向相反的方向继续进行移动;
记录所述机器人在移动过程中沿边行走的第一累计角度。
10.根据权利要求9所述的机器人脱困方法,其特征在于,所述机器人包括红外传感器和碰撞传感器;所述脱困方法还包括:
响应于记录到的第一累计角度的绝对值大于预设阈值,则控制所述红外传感器关闭;
通过所述碰撞传感器进行沿边移动,在所述碰撞传感器移动过程中实时更新所述机器人在所述栅格地图下的栅格坐标、并记录所述机器人在移动过程中沿边行走的第二累计角度,并根据更新后的所述栅格坐标和所述第二累计角度判断所述机器人是否脱困;
响应于记录到的第二累计角度的绝对值大于同一预设阈值,则判定所述机器人所处的区域被封死,并控制所述机器人停止工作。
CN201910649017.2A 2019-07-18 2019-07-18 机器人被困检测及脱困方法 Active CN110448241B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN201910649017.2A CN110448241B (zh) 2019-07-18 2019-07-18 机器人被困检测及脱困方法
PCT/CN2020/102738 WO2021008611A1 (zh) 2019-07-18 2020-07-17 机器人被困检测及脱困方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201910649017.2A CN110448241B (zh) 2019-07-18 2019-07-18 机器人被困检测及脱困方法

Publications (2)

Publication Number Publication Date
CN110448241A true CN110448241A (zh) 2019-11-15
CN110448241B CN110448241B (zh) 2021-05-18

Family

ID=68482884

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201910649017.2A Active CN110448241B (zh) 2019-07-18 2019-07-18 机器人被困检测及脱困方法

Country Status (2)

Country Link
CN (1) CN110448241B (zh)
WO (1) WO2021008611A1 (zh)

Cited By (14)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111197987A (zh) * 2020-02-26 2020-05-26 深圳市银星智能科技股份有限公司 一种困境识别方法、装置以及计算机存储介质
WO2021008611A1 (zh) * 2019-07-18 2021-01-21 广东宝乐机器人股份有限公司 机器人被困检测及脱困方法
CN112947478A (zh) * 2021-03-23 2021-06-11 深圳市云鼠科技开发有限公司 机器人绕柱脱困方法、装置、计算机设备及存储介质
WO2021208530A1 (zh) * 2020-04-14 2021-10-21 北京石头世纪科技股份有限公司 一种机器人避障方法、装置和存储介质
CN113616115A (zh) * 2021-07-14 2021-11-09 湖南格兰博智能科技有限责任公司 一种适用于扫地机的脱困算法
CN113693521A (zh) * 2021-02-10 2021-11-26 北京石头世纪科技股份有限公司 自动清洁设备控制方法及装置、介质及电子设备
CN113741446A (zh) * 2021-08-27 2021-12-03 深圳市优必选科技股份有限公司 一种机器人自主探索的方法、终端设备及存储介质
CN114504273A (zh) * 2020-11-16 2022-05-17 科沃斯机器人股份有限公司 机器人控制方法及装置
CN114518744A (zh) * 2020-10-30 2022-05-20 深圳乐动机器人有限公司 机器人的脱困方法、装置、机器人及存储介质
CN114532898A (zh) * 2020-11-24 2022-05-27 追创科技(苏州)有限公司 机器人的建图方法、机器人、存储介质、电子装置
WO2022170712A1 (zh) * 2021-02-10 2022-08-18 北京石头创新科技有限公司 清洁机器人脱困方法及装置、介质及电子设备
CN115476357A (zh) * 2022-09-09 2022-12-16 云鲸智能(深圳)有限公司 机器人控制方法、装置及计算机可读存储介质
US11612295B2 (en) 2021-01-04 2023-03-28 Beijing Roborock Technology Co., Ltd. Autonomous cleaning device
CN117796711A (zh) * 2024-02-29 2024-04-02 杭州华橙软件技术有限公司 一种机器人的脱困处理方法、机器人和存储介质

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112982252B (zh) * 2021-02-20 2022-09-06 深圳一清创新科技有限公司 一种沿边清扫方法、装置和清扫车
CN115191868B (zh) * 2021-04-09 2024-06-14 美智纵横科技有限责任公司 沿边清洁方法及清洁机器人
CN114355887B (zh) * 2021-12-03 2023-08-08 云鲸智能(深圳)有限公司 机器人窄道通行方法、装置、机器人及存储介质
CN114397893B (zh) * 2021-12-28 2024-02-02 深圳银星智能集团股份有限公司 路径规划方法、机器人清扫方法及相关设备

Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20090104393A (ko) * 2008-03-31 2009-10-06 엘지전자 주식회사 로봇 청소기의 제어방법
CN104757910A (zh) * 2014-11-26 2015-07-08 深圳市银星智能科技股份有限公司 智能扫地机器人及其控制方法
CN106155056A (zh) * 2016-07-26 2016-11-23 广东宝乐机器人股份有限公司 自移动机器人行走方法与装置
CN107831773A (zh) * 2017-11-30 2018-03-23 深圳市沃特沃德股份有限公司 扫地机器人全覆盖清扫的方法及扫地机器人
CN107898387A (zh) * 2017-10-16 2018-04-13 深圳市艾特智能科技有限公司 回充控制方法、系统、可读存储介质及智能设备
CN107943025A (zh) * 2017-11-09 2018-04-20 珠海市微半导体有限公司 机器人被困的检测方法及脱困的处理方法
WO2018131856A1 (ko) * 2017-01-13 2018-07-19 엘지전자 주식회사 청소기 및 그 제어방법
CN108553041A (zh) * 2018-03-19 2018-09-21 珠海市微半导体有限公司 一种机器人被困的判断方法及其脱困的控制方法
CN109358619A (zh) * 2018-09-28 2019-02-19 北京奇虎科技有限公司 一种机器人清扫方法、装置及电子设备
CN109363585A (zh) * 2018-12-17 2019-02-22 深圳市银星智能科技股份有限公司 分区遍历方法、清扫方法及其扫地机器人
CN109827592A (zh) * 2019-03-04 2019-05-31 广东乐生智能科技有限公司 一种扫地机器人被困的检测方法

Family Cites Families (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102599862B (zh) * 2012-03-26 2013-12-18 慈溪迈思特电子科技有限公司 自动吸尘器困境识别及脱离的方法
US10635913B2 (en) * 2016-10-17 2020-04-28 Mediatek Inc. Path planning method and related navigation device
CN108469816B (zh) * 2018-02-28 2021-06-18 北京奇虎科技有限公司 一种机器人的脱困处理方法、装置和机器人
CN108490955A (zh) * 2018-05-04 2018-09-04 深圳市沃特沃德股份有限公司 一种扫地机器人的控制方法及系统
CN109528089B (zh) * 2018-11-19 2021-03-23 珠海市一微半导体有限公司 一种被困清洁机器人的继续行走方法、装置及芯片
CN110448241B (zh) * 2019-07-18 2021-05-18 华南师范大学 机器人被困检测及脱困方法

Patent Citations (11)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
KR20090104393A (ko) * 2008-03-31 2009-10-06 엘지전자 주식회사 로봇 청소기의 제어방법
CN104757910A (zh) * 2014-11-26 2015-07-08 深圳市银星智能科技股份有限公司 智能扫地机器人及其控制方法
CN106155056A (zh) * 2016-07-26 2016-11-23 广东宝乐机器人股份有限公司 自移动机器人行走方法与装置
WO2018131856A1 (ko) * 2017-01-13 2018-07-19 엘지전자 주식회사 청소기 및 그 제어방법
CN107898387A (zh) * 2017-10-16 2018-04-13 深圳市艾特智能科技有限公司 回充控制方法、系统、可读存储介质及智能设备
CN107943025A (zh) * 2017-11-09 2018-04-20 珠海市微半导体有限公司 机器人被困的检测方法及脱困的处理方法
CN107831773A (zh) * 2017-11-30 2018-03-23 深圳市沃特沃德股份有限公司 扫地机器人全覆盖清扫的方法及扫地机器人
CN108553041A (zh) * 2018-03-19 2018-09-21 珠海市微半导体有限公司 一种机器人被困的判断方法及其脱困的控制方法
CN109358619A (zh) * 2018-09-28 2019-02-19 北京奇虎科技有限公司 一种机器人清扫方法、装置及电子设备
CN109363585A (zh) * 2018-12-17 2019-02-22 深圳市银星智能科技股份有限公司 分区遍历方法、清扫方法及其扫地机器人
CN109827592A (zh) * 2019-03-04 2019-05-31 广东乐生智能科技有限公司 一种扫地机器人被困的检测方法

Cited By (19)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021008611A1 (zh) * 2019-07-18 2021-01-21 广东宝乐机器人股份有限公司 机器人被困检测及脱困方法
CN111197987A (zh) * 2020-02-26 2020-05-26 深圳市银星智能科技股份有限公司 一种困境识别方法、装置以及计算机存储介质
US11586201B2 (en) 2020-02-26 2023-02-21 ShenZhen Silver Star Intelligent Technology CO.. LTD Method and apparatus for recognizing a stuck status as well as computer storage medium
WO2021208530A1 (zh) * 2020-04-14 2021-10-21 北京石头世纪科技股份有限公司 一种机器人避障方法、装置和存储介质
CN114518744A (zh) * 2020-10-30 2022-05-20 深圳乐动机器人有限公司 机器人的脱困方法、装置、机器人及存储介质
CN114504273A (zh) * 2020-11-16 2022-05-17 科沃斯机器人股份有限公司 机器人控制方法及装置
CN114532898A (zh) * 2020-11-24 2022-05-27 追创科技(苏州)有限公司 机器人的建图方法、机器人、存储介质、电子装置
CN114532898B (zh) * 2020-11-24 2023-06-23 追觅创新科技(苏州)有限公司 机器人的建图方法、机器人、存储介质、电子装置
US11612295B2 (en) 2021-01-04 2023-03-28 Beijing Roborock Technology Co., Ltd. Autonomous cleaning device
CN113693521A (zh) * 2021-02-10 2021-11-26 北京石头世纪科技股份有限公司 自动清洁设备控制方法及装置、介质及电子设备
WO2022170712A1 (zh) * 2021-02-10 2022-08-18 北京石头创新科技有限公司 清洁机器人脱困方法及装置、介质及电子设备
CN112947478B (zh) * 2021-03-23 2024-02-06 深圳市云鼠科技开发有限公司 机器人绕柱脱困方法、装置、计算机设备及存储介质
CN112947478A (zh) * 2021-03-23 2021-06-11 深圳市云鼠科技开发有限公司 机器人绕柱脱困方法、装置、计算机设备及存储介质
CN113616115A (zh) * 2021-07-14 2021-11-09 湖南格兰博智能科技有限责任公司 一种适用于扫地机的脱困算法
CN113741446A (zh) * 2021-08-27 2021-12-03 深圳市优必选科技股份有限公司 一种机器人自主探索的方法、终端设备及存储介质
CN113741446B (zh) * 2021-08-27 2024-04-16 深圳市优必选科技股份有限公司 一种机器人自主探索的方法、终端设备及存储介质
CN115476357A (zh) * 2022-09-09 2022-12-16 云鲸智能(深圳)有限公司 机器人控制方法、装置及计算机可读存储介质
CN117796711A (zh) * 2024-02-29 2024-04-02 杭州华橙软件技术有限公司 一种机器人的脱困处理方法、机器人和存储介质
CN117796711B (zh) * 2024-02-29 2024-06-07 杭州华橙软件技术有限公司 一种机器人的脱困处理方法、机器人和存储介质

Also Published As

Publication number Publication date
CN110448241B (zh) 2021-05-18
WO2021008611A1 (zh) 2021-01-21

Similar Documents

Publication Publication Date Title
CN110448241A (zh) 机器人被困检测及脱困方法
US20230409032A1 (en) Method for controlling an autonomous, mobile robot
CN106959695B (zh) 移动机器人在工作区域内的角度修正方法及移动机器人
US10882187B2 (en) Method of planning a cleaning route for a cleaning robot and a chip for achieving the same
US11022976B2 (en) Path planning method of intelligent robot
US9298183B2 (en) Robot and method for autonomous inspection or processing of floor areas
US10423160B2 (en) Local obstacle avoidance walking method of self-moving robot
CN108885436B (zh) 自主监视机器人系统
JP7352318B2 (ja) ロボット汎用の充電台帰還充電制御方法、チップ及びロボット
CN106264359B (zh) 清洁机器人及其避障方法
CN103099586B (zh) 一种沿边导航向中扩展的清洁机器人的清洁方法
US8364309B1 (en) User-assisted robot navigation system
WO2021037065A1 (zh) 清洁机器人及其控制方法
JP2020533720A (ja) 自律移動ロボットによる未知の環境の探索
CN107981790A (zh) 室内区域划分方法及扫地机器人
US20160008982A1 (en) Method for automatically triggering a self-positioning process
JP2017511549A (ja) 自走式ロボットの障害物回避歩行方法
CN110464262A (zh) 扫地机器人的脱困方法
CN104731101A (zh) 清洁机器人室内场景地图建模方法及机器人
CN101238960A (zh) 使用边角检测的机器人清洁器及其控制方法
CN110580047B (zh) 一种自主机器人的防跌落行进方法及自主机器人
CN108873880A (zh) 智能移动设备及其路径规划方法、计算机可读存储介质
CN109276191A (zh) 一种清洁机器人的路径清扫方法、系统和芯片
KR20180062315A (ko) 청소 기능 제어 장치와 방법 및 청소 로봇
KR102428256B1 (ko) 건물 내 층간이동이 가능한 지능형 로봇 및 이의 제어 방법

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
TA01 Transfer of patent application right
TA01 Transfer of patent application right

Effective date of registration: 20191223

Address after: 510000 Guangdong Guangzhou Guangzhou Shi Pai Campus

Applicant after: SOUTH CHINA NORMAL University

Applicant after: GUANGDONG BONA ROBOT Corp.,Ltd.

Address before: 518000 two or three floor, block D, 438 East Ring Road, Baoan District Xinqiao street, Shenzhen, Guangdong.

Applicant before: GUANGDONG BONA ROBOT Corp.,Ltd.

GR01 Patent grant
GR01 Patent grant
PP01 Preservation of patent right
PP01 Preservation of patent right

Effective date of registration: 20230320

Granted publication date: 20210518