CN115202330A - Control method for cleaning robot to move along obstacle and cleaning robot - Google Patents

Control method for cleaning robot to move along obstacle and cleaning robot Download PDF

Info

Publication number
CN115202330A
CN115202330A CN202110384342.8A CN202110384342A CN115202330A CN 115202330 A CN115202330 A CN 115202330A CN 202110384342 A CN202110384342 A CN 202110384342A CN 115202330 A CN115202330 A CN 115202330A
Authority
CN
China
Prior art keywords
obstacle
cleaning robot
motion model
distance
type
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.)
Pending
Application number
CN202110384342.8A
Other languages
Chinese (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.)
Midea Robozone Technology Co Ltd
Original Assignee
Midea Robozone Technology Co 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 Midea Robozone Technology Co Ltd filed Critical Midea Robozone Technology Co Ltd
Priority to CN202110384342.8A priority Critical patent/CN115202330A/en
Priority to PCT/CN2022/077058 priority patent/WO2022213732A1/en
Publication of CN115202330A publication Critical patent/CN115202330A/en
Pending legal-status Critical Current

Links

Images

Classifications

    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0221Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • GPHYSICS
    • G05CONTROLLING; REGULATING
    • G05DSYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/02Control of position or course in two dimensions
    • G05D1/021Control of position or course in two dimensions specially adapted to land vehicles
    • G05D1/0212Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0223Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving speed control of the vehicle

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)

Abstract

本申请公开了一种清洁机器人沿障碍物运动的控制方法、装置、清洁机器人及存储介质,其中清洁机器人沿障碍物运动的控制方法包括:获取清洁机器人上障碍物探测器的探测数据;根据所述探测数据,识别清洁机器人运动前方的障碍物类型;确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动,相比于现有技术,本申请能够改善机器人沿障碍物运动的能力,从而实现清洁机器人高效自主的沿边清扫功能。

Figure 202110384342

The present application discloses a control method, device, cleaning robot and storage medium for a cleaning robot to move along an obstacle, wherein the control method for the cleaning robot to move along an obstacle includes: acquiring detection data of an obstacle detector on the cleaning robot; The detection data is used to identify the obstacle type in front of the movement of the cleaning robot; the motion model corresponding to the obstacle type is determined, and the movement model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the obstacle type; The motion model and the detection data are used to control the cleaning robot to move along the edge of the obstacle. Compared with the prior art, the present application can improve the robot's ability to move along the obstacle, so as to realize the efficient and autonomous edge of the cleaning robot. Cleaning function.

Figure 202110384342

Description

清洁机器人沿障碍物运动的控制方法及清洁机器人Control method of cleaning robot moving along obstacles and cleaning robot

技术领域technical field

本申请属于家电技术领域,尤其涉及一种清洁机器人沿障碍物运动的控制方法、装置、清洁机器人及存储介质。The present application belongs to the technical field of home appliances, and in particular relates to a control method and device for a cleaning robot to move along an obstacle, a cleaning robot and a storage medium.

背景技术Background technique

扫地机,又称自动打扫机、智能吸尘器、清洁机器人等,是智能家用电器的一种,能凭借一定的人工智能,自动在房间内完成地面清理工作。目前的扫地机器人逐渐成为人们生活中必备智能帮手。Sweepers, also known as automatic cleaners, smart vacuum cleaners, cleaning robots, etc., are a kind of smart household appliances that can automatically complete the floor cleaning work in the room with certain artificial intelligence. The current sweeping robot has gradually become an essential intelligent helper in people's lives.

沿障碍物运动的能力是扫地机器人最基本的能力,现有的扫地机器人采用单传感器,或者红外或者激光雷达等来控制机器人沿着障碍物运动,受限于单个传感器的探测能力,扫地机器人在含有某些特殊障碍物的环境中,如曲率变化较大的障碍物环境(例如桌子腿),超出单一传感器测量范围的环境,沿障碍物运动的能力会变差或者丧失,从而影响扫地机器人的边角清扫能力以及清扫覆盖率等基本性能。The ability to move along the obstacle is the most basic ability of the sweeping robot. The existing sweeping robot uses a single sensor, or infrared or lidar to control the robot to move along the obstacle, which is limited by the detection ability of a single sensor. In an environment containing some special obstacles, such as an obstacle environment with a large curvature change (such as table legs), and an environment beyond the measurement range of a single sensor, the ability to move along the obstacle will be deteriorated or lost, thus affecting the robot vacuum cleaner. Basic performance such as edge cleaning ability and cleaning coverage.

发明内容SUMMARY OF THE INVENTION

有鉴于此,本申请实施例提供了一种清洁机器人沿障碍物运动的控制方法、装置、清洁机器人及存储介质,以能够改善机器人沿障碍物运动的能力,从而实现清洁机器人高效自主的沿边清扫功能。In view of this, embodiments of the present application provide a control method, device, cleaning robot, and storage medium for a cleaning robot to move along an obstacle, so as to improve the robot's ability to move along an obstacle, thereby realizing the efficient and autonomous edge cleaning of the cleaning robot Function.

本申请第一方面实施例提供一种清洁机器人沿障碍物运动的控制方法,包括:An embodiment of the first aspect of the present application provides a control method for a cleaning robot to move along an obstacle, including:

获取清洁机器人上障碍物探测器的探测数据;Obtain the detection data of the obstacle detector on the cleaning robot;

根据所述探测数据,识别清洁机器人运动前方的障碍物类型;According to the detection data, identify the type of obstacles in front of the cleaning robot;

确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;Determine the motion model corresponding to the obstacle type, and the motion model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the obstacle type;

根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动。According to the motion model and the detection data, the cleaning robot is controlled to move along the edge of the obstacle.

本申请第一方面实施例的清洁机器人沿障碍物运动的控制方法,获取清洁机器人上障碍物探测器的探测数据;根据所述探测数据,识别清洁机器人运动前方的障碍物类型;确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动,相比于现有技术,本申请能够改善机器人沿障碍物运动的能力,从而实现清洁机器人高效自主的沿边清扫功能。The method for controlling the movement of a cleaning robot along an obstacle according to the embodiment of the first aspect of the present application obtains detection data of an obstacle detector on the cleaning robot; identifies the type of obstacle in front of the cleaning robot moving according to the detection data; determines the obstacle The motion model corresponding to the object type is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the type of the obstacle; according to the motion model and the detection data, the cleaning robot is controlled to follow the obstacle Compared with the prior art, the present application can improve the ability of the robot to move along the obstacle, so as to realize the efficient and autonomous edge cleaning function of the cleaning robot.

在本申请的一些实施例中,所述确定所述障碍物类型对应的运动模型,包括:In some embodiments of the present application, the determining the motion model corresponding to the obstacle type includes:

根据所述障碍物类型为连续墙面类型,确定对应的运动模型为小曲率运动模型;According to the type of the obstacle being a continuous wall type, it is determined that the corresponding motion model is a small curvature motion model;

根据所述障碍物类型为孤立柱状类型,确定对应的运动模型为大曲率运动模型。According to the type of the obstacle being an isolated columnar type, it is determined that the corresponding motion model is a large-curvature motion model.

在本申请的一些实施例中,所述小曲率运动模型构建过程如下:In some embodiments of the present application, the construction process of the small curvature motion model is as follows:

Figure BDA0003014217400000021
Figure BDA0003014217400000021

其中,dW表示清洁机器人沿着障碍物的边沿运动过程中,清洁机器人与障碍物的距离;v表示清洁机器人的线速度;w表示清洁机器人的角速度;θ为清洁机器人相对于墙体平行方向的差角;θ0为上沿边激光与墙体垂线的夹角;d0表示清洁机器人质心到墙面的距离。Among them, d W represents the distance between the cleaning robot and the obstacle during the movement of the cleaning robot along the edge of the obstacle; v represents the linear velocity of the cleaning robot; w represents the angular velocity of the cleaning robot; θ is the parallel direction of the cleaning robot relative to the wall θ 0 is the angle between the upper edge laser and the vertical line of the wall; d 0 represents the distance from the center of mass of the cleaning robot to the wall.

在本申请的一些实施例中,所述大曲率运动模型构建过程如下:In some embodiments of the present application, the construction process of the large curvature motion model is as follows:

从探测数据中确定上绕障距离、中绕障距离和下绕障距离;Determine the upper obstacle distance, the middle obstacle distance and the lower obstacle distance from the detection data;

确定清洁机器人半径与预设的绕障距离之和为位置关系阈值;Determine the sum of the cleaning robot radius and the preset obstacle-around distance as the position relationship threshold;

根据所述上绕障距离、中绕障距离、下绕障距离与所述位置关系阈值确定清洁机器人与障碍物的相对位置关系;Determine the relative positional relationship between the cleaning robot and the obstacle according to the distance around the upper obstacle, the distance around the middle obstacle, the distance around the lower obstacle and the positional relationship threshold;

根据所述相对位置关系和预设的至少两个旋转运动状态,控制清洁机器人沿着障碍物的边沿运动,不同的旋转运动状态对应不同的线速度和角速度。According to the relative position relationship and the preset at least two rotational motion states, the cleaning robot is controlled to move along the edge of the obstacle, and different rotational motion states correspond to different linear and angular velocities.

在本申请的一些实施例中,所述根据所述相对位置关系和预设的至少两个旋转运动状态,控制清洁机器人沿着障碍物的边沿运动,包括:In some embodiments of the present application, controlling the cleaning robot to move along the edge of the obstacle according to the relative positional relationship and the preset at least two rotational motion states includes:

确定所述相对位置关系对应的目标旋转运动状态;determining the target rotational motion state corresponding to the relative positional relationship;

控制清洁机器人按照所述目标旋转运动状态进行运动;Controlling the cleaning robot to move according to the target rotational motion state;

获取新的所述相对位置关系,根据新的所述相对位置关系重复上述步骤,直至清洁机器人完成障碍物沿边。The new relative position relationship is acquired, and the above steps are repeated according to the new relative position relationship, until the cleaning robot completes the obstacle edge.

本申请第二方面实施例的清洁机器人沿障碍物运动的控制装置,包括:The control device for the cleaning robot to move along the obstacle according to the embodiment of the second aspect of the present application includes:

获取模块,用于获取清洁机器人上障碍物探测器的探测数据;The acquisition module is used to acquire the detection data of the obstacle detector on the cleaning robot;

识别模块,用于根据所述探测数据,识别清洁机器人运动前方的障碍物类型;an identification module for identifying the type of obstacles in front of the cleaning robot moving according to the detection data;

确定模块,用于确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;a determination module for determining a motion model corresponding to the obstacle type, the motion model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the obstacle type;

控制模块,用于根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动。The control module is configured to control the cleaning robot to move along the edge of the obstacle according to the motion model and the detection data.

本申请第二方面实施例的清洁机器人沿障碍物运动的控制装置,获取清洁机器人上障碍物探测器的探测数据;根据所述探测数据,识别清洁机器人运动前方的障碍物类型;确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动,相比于现有技术,本申请能够改善机器人沿障碍物运动的能力,从而实现清洁机器人高效自主的沿边清扫功能。The control device for a cleaning robot moving along an obstacle according to the embodiment of the second aspect of the present application acquires detection data of an obstacle detector on the cleaning robot; identifies the type of obstacle in front of the cleaning robot according to the detection data; determines the obstacle The motion model corresponding to the object type is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the type of the obstacle; according to the motion model and the detection data, the cleaning robot is controlled to follow the obstacle Compared with the prior art, the present application can improve the ability of the robot to move along the obstacle, so as to realize the efficient and autonomous edge cleaning function of the cleaning robot.

在本申请的一些实施例中,所述确定模块,具体用于:In some embodiments of the present application, the determining module is specifically used for:

根据所述障碍物类型为连续墙面类型,确定对应的运动模型为小曲率运动模型;According to the type of the obstacle being a continuous wall type, it is determined that the corresponding motion model is a small curvature motion model;

根据所述障碍物类型为孤立柱状类型,确定对应的运动模型为大曲率运动模型。According to the type of the obstacle being an isolated columnar type, it is determined that the corresponding motion model is a large-curvature motion model.

在本申请的一些实施例中,所述控制模块,还用于小曲率运动模型构建,所述小曲率运动模型构建过程如下:In some embodiments of the present application, the control module is also used to construct a small curvature motion model, and the construction process of the small curvature motion model is as follows:

Figure BDA0003014217400000031
Figure BDA0003014217400000031

其中,dW表示清洁机器人沿着障碍物的边沿运动过程中,清洁机器人与障碍物的距离;v表示清洁机器人的线速度;w表示清洁机器人的角速度;θ为清洁机器人相对于墙体平行方向的差角;θ0为上沿边激光与墙体垂线的夹角;d0表示清洁机器人质心到墙面的距离。Among them, d W represents the distance between the cleaning robot and the obstacle during the movement of the cleaning robot along the edge of the obstacle; v represents the linear velocity of the cleaning robot; w represents the angular velocity of the cleaning robot; θ is the parallel direction of the cleaning robot relative to the wall θ 0 is the angle between the upper edge laser and the vertical line of the wall; d 0 represents the distance from the center of mass of the cleaning robot to the wall.

在本申请的一些实施例中,所述控制模块,还用于大曲率运动模型构建,所述大曲率运动模型构建过程如下:In some embodiments of the present application, the control module is also used to construct a large-curvature motion model, and the process of constructing the large-curvature motion model is as follows:

从探测数据中确定上绕障距离、中绕障距离和下绕障距离;Determine the upper obstacle distance, the middle obstacle distance and the lower obstacle distance from the detection data;

确定清洁机器人半径与预设的绕障距离之和为位置关系阈值;Determine the sum of the cleaning robot radius and the preset obstacle-around distance as the position relationship threshold;

根据所述上绕障距离、中绕障距离、下绕障距离与所述位置关系阈值确定清洁机器人与障碍物的相对位置关系;Determine the relative positional relationship between the cleaning robot and the obstacle according to the distance around the upper obstacle, the distance around the middle obstacle, the distance around the lower obstacle and the positional relationship threshold;

根据所述相对位置关系和预设的至少两个旋转运动状态,控制清洁机器人沿着障碍物的边沿运动,不同的旋转运动状态对应不同的线速度和角速度。According to the relative position relationship and the preset at least two rotational motion states, the cleaning robot is controlled to move along the edge of the obstacle, and different rotational motion states correspond to different linear and angular velocities.

在本申请的一些实施例中,所述控制模块,具体用于:In some embodiments of the present application, the control module is specifically used for:

获取目标区域边界上相隔预设距离的多个位置的环境湿度;Obtain the ambient humidity of multiple locations on the boundary of the target area separated by a preset distance;

计算所述多个位置的环境湿度的平均值,得到目标区域的湿度均值。The average value of the ambient humidity of the multiple locations is calculated to obtain the average value of the humidity of the target area.

本申请第三方面实施例的清洁机器人,包括:存储器、处理器及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器运行所述计算机程序时执行以实现第一方面实施例的清洁机器人沿障碍物运动的控制方法。The cleaning robot according to the embodiment of the third aspect of the present application includes: a memory, a processor, and a computer program stored on the memory and executable on the processor, and the processor executes the computer program to achieve The control method for a cleaning robot moving along an obstacle according to the embodiment of the first aspect.

本申请第四方面实施例的计算机可读存储介质,其上存储有计算机可读指令,所述计算机可读指令可被处理器执行以实现第一方面实施例的清洁机器人沿障碍物运动的控制方法。The computer-readable storage medium of the embodiment of the fourth aspect of the present application has computer-readable instructions stored thereon, and the computer-readable instructions can be executed by the processor to implement the control of the cleaning robot moving along the obstacle according to the embodiment of the first aspect method.

附图说明Description of drawings

通过阅读下文优选实施方式的详细描述,各种其他的优点和益处对于本领域普通技术人员将变得清楚明了。附图仅用于示出优选实施方式的目的,而并不认为是对本申请的限制。而且在整个附图中,用相同的参考符号表示相同的部件。在附图中:Various other advantages and benefits will become apparent to those of ordinary skill in the art upon reading the following detailed description of the preferred embodiments. The drawings are for purposes of illustrating preferred embodiments only and are not to be considered limiting of the application. Also, the same components are denoted by the same reference numerals throughout the drawings. In the attached image:

附图1示出了本申请实施例的一种清洁机器人沿障碍物运动的控制方法的流程图;1 shows a flowchart of a control method for a cleaning robot to move along an obstacle according to an embodiment of the present application;

附图2示出了本申请实施例中所用到的6束激光数据的示意图;FIG. 2 shows a schematic diagram of the 6-beam laser data used in the embodiment of the present application;

附图3示出了本申请实施例中小曲率运动模型构建的检测过程示意图;FIG. 3 shows a schematic diagram of the detection process of the construction of the small curvature motion model in the embodiment of the present application;

附图4示出了本申请实施例中两个旋转运动状态之间状态转移的示意图;4 shows a schematic diagram of state transition between two rotational motion states in the embodiment of the present application;

附图5示出了本申请实施例的一种清洁机器人沿障碍物运动的控制装置的示意图;5 shows a schematic diagram of a control device for a cleaning robot to move along an obstacle according to an embodiment of the present application;

附图6示出了本申请实施例的一种清洁机器人的示意图;FIG. 6 shows a schematic diagram of a cleaning robot according to an embodiment of the present application;

附图7示出了本申请实施例的一种计算机可读存储介质的示意图。FIG. 7 shows a schematic diagram of a computer-readable storage medium according to an embodiment of the present application.

本发明目的的实现、功能特点及优点将结合实施例,参照附图做进一步说明。The realization, functional characteristics and advantages of the present invention will be further described with reference to the accompanying drawings in conjunction with the embodiments.

具体实施方式Detailed ways

下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明的一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有作出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。The technical solutions in the embodiments of the present invention will be clearly and completely described below with reference to the accompanying drawings in the embodiments of the present invention. Obviously, the described embodiments are only a part of the embodiments of the present invention, not all of the embodiments. Based on the embodiments of the present invention, all other embodiments obtained by those of ordinary skill in the art without creative efforts shall fall within the protection scope of the present invention.

需要说明,本发明实施例中所有方向性指示(诸如上、下、左、右、前、后……)仅用于解释在某一特定姿态(如附图所示)下各部件之间的相对位置关系、运动情况等,如果该特定姿态发生改变时,则该方向性指示也相应地随之改变。It should be noted that all directional indications (such as up, down, left, right, front, back, etc.) in the embodiments of the present invention are only used to explain the relationship between various components under a certain posture (as shown in the accompanying drawings). The relative positional relationship, the movement situation, etc., if the specific posture changes, the directional indication also changes accordingly.

另外,在本发明中如涉及“第一”、“第二”等的描述仅用于描述目的,而不能理解为指示或暗示其相对重要性或者隐含指明所指示的技术特征的数量。由此,限定有“第一”、“第二”的特征可以明示或者隐含地包括至少一个该特征。在本发明的描述中,“多个”的含义是至少两个,例如两个,三个等,除非另有明确具体的限定。In addition, descriptions such as "first", "second", etc. in the present invention are only for descriptive purposes, and should not be construed as indicating or implying their relative importance or implicitly indicating the number of indicated technical features. Thus, a feature delimited with "first", "second" may expressly or implicitly include at least one of that feature. In the description of the present invention, "plurality" means at least two, such as two, three, etc., unless otherwise expressly and specifically defined.

在本发明中,除非另有明确的规定和限定,术语“连接”、“固定”等应做广义理解,例如,“固定”可以是固定连接,也可以是可拆卸连接,或成一体;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通或两个元件的相互作用关系,除非另有明确的限定。对于本领域的普通技术人员而言,可以根据具体情况理解上述术语在本发明中的具体含义。In the present invention, unless otherwise expressly specified and limited, the terms "connected", "fixed" and the like should be understood in a broad sense, for example, "fixed" may be a fixed connection, a detachable connection, or an integrated; It can be a mechanical connection or an electrical connection; it can be a direct connection or an indirect connection through an intermediate medium, and it can be an internal communication between two elements or an interaction relationship between the two elements, unless otherwise explicitly defined. For those of ordinary skill in the art, the specific meanings of the above terms in the present invention can be understood according to specific situations.

另外,本发明各个实施例之间的技术方案可以相互结合,但是必须是以本领域普通技术人员能够实现为基础,当技术方案的结合出现相互矛盾或无法实现时应当认为这种技术方案的结合不存在,也不在本发明要求的保护范围之内。In addition, the technical solutions between the various embodiments of the present invention can be combined with each other, but must be based on the realization by those of ordinary skill in the art. When the combination of technical solutions is contradictory or cannot be achieved, it should be considered that the combination of technical solutions does not exist and is not within the scope of protection claimed by the present invention.

本申请提出了一种清洁机器人沿障碍物运动的控制方法、装置、清洁机器人及存储介质,获取清洁机器人上障碍物探测器的探测数据,障碍物探测器可以是线激光探测器或者激光雷达等传感器;根据所述探测数据,识别清洁机器人运动前方的障碍物类型;确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动,相比于现有技术,本申请能够改善机器人沿障碍物运动的能力,从而实现清洁机器人高效自主的沿边清扫功能。This application proposes a control method, device, cleaning robot and storage medium for a cleaning robot to move along an obstacle, to obtain detection data of an obstacle detector on the cleaning robot, and the obstacle detector may be a line laser detector or a lidar, etc. sensor; according to the detection data, identify the obstacle type in front of the cleaning robot movement; determine the motion model corresponding to the obstacle type, and the motion model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the obstacle type ; According to the motion model and the detection data, the cleaning robot is controlled to move along the edge of the obstacle, compared with the prior art, the present application can improve the robot's ability to move along the obstacle, thereby realizing the cleaning robot Efficient and autonomous edge cleaning function.

为使本申请的上述目的、特征和优点能够更为明显易懂,下面结合附图对本申请的具体实施例做详细的说明。In order to make the above objects, features and advantages of the present application more obvious and easy to understand, specific embodiments of the present application will be described in detail below with reference to the accompanying drawings.

实施例一Example 1

图1是本申请实施例提供的一种清洁机器人沿障碍物运动的控制方法的流程图。如图1所示,该清洁机器人沿障碍物运动的控制方法包括:FIG. 1 is a flowchart of a control method for a cleaning robot to move along an obstacle provided by an embodiment of the present application. As shown in Figure 1, the control method for the cleaning robot to move along the obstacle includes:

步骤S101:获取清洁机器人上障碍物探测器的探测数据。Step S101: Acquire detection data of an obstacle detector on the cleaning robot.

本实施例中,障碍物探测器可以是线激光探测器或者激光雷达等传感器,即探测数据可以是激光数据或者说激光测距数据。In this embodiment, the obstacle detector may be a sensor such as a line laser detector or a lidar, that is, the detection data may be laser data or laser ranging data.

图2示出了本实施例中所用到的6束激光数据的示意图,如图2所示,6束激光数据包括3束沿边激光和3束绕障激光,分别为下沿边激光,信号范围:-11°至-9°;上沿边激光,信号范围9°至11°;中沿边激光,信号范围:-11°至11°;下绕障激光,信号范围:-5°至-1°;中绕障激光,信号范围:-1°至1°;上绕障激光,信号范围1°至5°。Figure 2 shows a schematic diagram of the 6 beams of laser data used in this embodiment. As shown in Figure 2, the 6 beams of laser data include 3 edge lasers and 3 barrier lasers, which are lower edge lasers respectively. The signal range is: -11° to -9°; upper edge laser, signal range: 9° to 11°; middle edge laser, signal range: -11° to 11°; lower barrier laser, signal range: -5° to -1°; Middle barrier laser, signal range: -1° to 1°; upper barrier laser, signal range 1° to 5°.

应理解,沿边激光对应沿边距离;绕障激光对应绕障距离。6束激光数据的信号范围可以根据实际情况进行标定得到,沿边距离和绕障距离均是信号范围内的最小距离。It should be understood that the edgewise laser corresponds to the edgewise distance; the barrier-wrap laser corresponds to the barrier-wrap distance. The signal range of the 6-beam laser data can be calibrated according to the actual situation, and the edge-to-edge distance and the distance around the obstacle are the minimum distances within the signal range.

步骤S102:根据所述探测数据,识别清洁机器人运动前方的障碍物类型。Step S102: According to the detection data, identify the type of obstacles in front of the movement of the cleaning robot.

实际应用中,清洁机器人经常所处的环境为室内,室内障碍物会存在很多,例如墙、桌子、椅子等,因此障碍物类型可以包括连续墙面类型(如前面、立地柜子柜面)和孤立柱状类型(如桌子腿、椅子腿等)。In practical applications, the environment where cleaning robots are often located is indoors, and there are many indoor obstacles, such as walls, tables, chairs, etc. Therefore, the types of obstacles can include continuous wall types (such as fronts, standing cabinets) and isolated types. Column type (eg table legs, chair legs, etc.).

步骤S103:确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的。Step S103: Determine a motion model corresponding to the obstacle type, where the motion model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the obstacle type.

在本申请的一些实施方式中,步骤S103可以具体实现为:In some embodiments of the present application, step S103 may be specifically implemented as:

根据障碍物类型为连续墙面类型,确定对应的运动模型为小曲率运动模型;According to the type of the obstacle being a continuous wall type, the corresponding motion model is determined to be a small curvature motion model;

根据障碍物类型为孤立柱状类型,确定对应的运动模型为大曲率运动模型。According to the type of the obstacle is an isolated column type, the corresponding motion model is determined as a large-curvature motion model.

具体的,连续墙面类型曲率变化较小,因此选取小曲率运动模型。孤立柱状类型曲率变化较大,因此选取大曲率运动模型。Specifically, the curvature change of the continuous wall type is small, so a small curvature motion model is selected. The curvature of the isolated columnar type varies greatly, so a large-curvature motion model is selected.

所述小曲率运动模型构建过程如下:The construction process of the small curvature motion model is as follows:

Figure BDA0003014217400000061
Figure BDA0003014217400000061

其中,dW表示清洁机器人沿着障碍物的边沿运动过程中,清洁机器人与障碍物的距离;v表示清洁机器人的线速度;w表示清洁机器人的角速度;θ为清洁机器人相对于墙体平行方向的差角;θ0为上沿边激光与墙体垂线的夹角;d0表示清洁机器人质心到墙面的距离Among them, d W represents the distance between the cleaning robot and the obstacle during the movement of the cleaning robot along the edge of the obstacle; v represents the linear velocity of the cleaning robot; w represents the angular velocity of the cleaning robot; θ is the parallel direction of the cleaning robot relative to the wall θ 0 is the angle between the upper edge laser and the vertical line of the wall; d 0 is the distance from the center of mass of the cleaning robot to the wall

通过3束沿边激光来构造出清洁机器人相对于曲率较小的障碍物的相对位置信息,具体构造的检测过程图3所示。The relative position information of the cleaning robot relative to the obstacle with small curvature is constructed by using three edgewise laser beams. The detection process of the specific structure is shown in Figure 3.

图3中,清洁机器人质心到墙面的距离为d0,上沿边激光到墙面的最近距离为dU,下沿边激光到墙面的最近距离为dL,清洁机器人机体与墙体平行时,上沿边激光束与墙体垂线的夹角为θ0,清洁机器人相对于墙体平行的方向的差角为θ,这里规定逆时针旋转差角为正,顺时针旋转差角为负,根据以上定义可以得到:In Figure 3, the distance from the center of mass of the cleaning robot to the wall is d 0 , the shortest distance from the upper edge laser to the wall is d U , and the shortest distance from the lower edge laser to the wall is d L . When the cleaning robot body is parallel to the wall , the angle between the upper edge laser beam and the vertical line of the wall is θ 0 , and the difference angle of the cleaning robot relative to the direction parallel to the wall is θ. Here, the counterclockwise rotation difference angle is defined as positive, and the clockwise rotation difference angle is negative. According to the above definition, we can get:

dUcos(θ0+θ)=d0 d U cos(θ 0 +θ)=d 0

dLcos(θ0-θ)=d0 (1)d L cos(θ 0 -θ)=d 0 (1)

定义清洁机器人与曲率较小障碍物的距离为:The distance between the cleaning robot and the obstacle with less curvature is defined as:

dW=dU-dL+d0 (2)d W =d U -d L +d 0 (2)

设清洁机器人车体的线速度为v,角速度为w,根据车体运动学模型可得:Let the linear velocity of the cleaning robot body be v and the angular velocity be w, according to the kinematics model of the car body, we can get:

Figure BDA0003014217400000062
Figure BDA0003014217400000062

Figure BDA0003014217400000063
Figure BDA0003014217400000063

根据(1)-(3)可得:According to (1)-(3), we can get:

Figure BDA0003014217400000071
Figure BDA0003014217400000071

上式可以简化为:The above formula can be simplified to:

Figure BDA0003014217400000072
Figure BDA0003014217400000072

式(4)为通过3束沿边激光数据构造的距离来控制机器沿着曲率较小的障碍物运动的模型。Equation (4) is a model for controlling the movement of the machine along obstacles with small curvature through the distance constructed by the three edgewise laser data.

下面对大曲率运动模型的构建进行介绍。The construction of the large curvature motion model is introduced below.

所述大曲率运动模型构建过程如下:The construction process of the large curvature motion model is as follows:

从探测数据中确定上绕障距离、中绕障距离和下绕障距离;Determine the upper obstacle distance, the middle obstacle distance and the lower obstacle distance from the detection data;

确定清洁机器人半径与预设的绕障距离之和为位置关系阈值;Determine the sum of the cleaning robot radius and the preset obstacle-around distance as the position relationship threshold;

根据所述上绕障距离、中绕障距离、下绕障距离与所述位置关系阈值确定清洁机器人与障碍物的相对位置关系;Determine the relative positional relationship between the cleaning robot and the obstacle according to the distance around the upper obstacle, the distance around the middle obstacle, the distance around the lower obstacle and the positional relationship threshold;

根据所述相对位置关系和预设的至少两个旋转运动状态,控制清洁机器人沿着障碍物的边沿运动,不同的旋转运动状态对应不同的线速度和角速度。According to the relative position relationship and the preset at least two rotational motion states, the cleaning robot is controlled to move along the edge of the obstacle, and different rotational motion states correspond to different linear and angular velocities.

所述根据所述相对位置关系和预设的至少两个旋转运动状态,控制清洁机器人沿着障碍物的边沿运动,包括:The controlling the cleaning robot to move along the edge of the obstacle according to the relative positional relationship and the preset at least two rotational motion states includes:

确定所述相对位置关系对应的目标旋转运动状态;determining the target rotational motion state corresponding to the relative positional relationship;

控制清洁机器人按照所述目标旋转运动状态进行运动;Controlling the cleaning robot to move according to the target rotational motion state;

获取新的所述相对位置关系,根据新的所述相对位置关系重复上述步骤,直至清洁机器人完成障碍物沿边。The new relative position relationship is acquired, and the above steps are repeated according to the new relative position relationship, until the cleaning robot completes the obstacle edge.

具体的,通过图3中的3束绕障激光数据构造出清洁机器人相对于曲率较大的障碍物的相对位置关系,具体构造方法见表1,表1中的D=清洁机器人半径+绕障距离。Specifically, the relative positional relationship of the cleaning robot relative to the obstacle with large curvature is constructed through the three beams of laser data in Figure 3. The specific construction method is shown in Table 1. In Table 1, D = the radius of the cleaning robot + the obstacle distance.

表1Table 1

Figure BDA0003014217400000073
Figure BDA0003014217400000073

Figure BDA0003014217400000081
Figure BDA0003014217400000081

在沿着障碍物边沿运动时,清洁机器人根据表1对应的清洁机器人和曲率较大的障碍物的相对位置关系,通过不同的旋转运动状态之间的切换(即不同曲率的旋转轨迹,如图4所示)逼近障碍物的外轮廓运动。When moving along the edge of the obstacle, according to the relative positional relationship between the cleaning robot and the obstacle with larger curvature corresponding to Table 1, the cleaning robot switches between different rotational motion states (that is, the rotational trajectories with different curvatures, as shown in the figure). 4) Approach the outer contour movement of the obstacle.

如图4所示,其中示出了旋转运动状态1和旋转运动状态2之间的状态转换关系,状态转换是根据清洁机器人与障碍物的相对位置关系进行的。As shown in FIG. 4 , the state transition relationship between the rotational motion state 1 and the rotational motion state 2 is shown, and the state transition is performed according to the relative positional relationship between the cleaning robot and the obstacle.

根据本申请的一些实施方式中,也可以设置更多旋转运动状态之间的状态转换关系,本申请对此不做限定。According to some embodiments of the present application, more state transition relationships between the rotational motion states may also be set, which is not limited in the present application.

步骤S104:根据所述运动模型和所述探测数据,控制清洁机器人沿着所述障碍物的边沿运动。Step S104: Control the cleaning robot to move along the edge of the obstacle according to the motion model and the detection data.

具体的控制过程参见上述大曲率运动模型的构建过程。For the specific control process, please refer to the construction process of the above-mentioned large-curvature motion model.

本申请实施例的清洁机器人沿障碍物运动的控制方法,获取清洁机器人上障碍物探测器的探测数据;根据所述探测数据,识别清洁机器人运动前方的障碍物类型;确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动,相比于现有技术,本申请能够改善机器人沿障碍物运动的能力,从而实现清洁机器人高效自主的沿边清扫功能。The method for controlling the movement of a cleaning robot along an obstacle according to the embodiment of the present application obtains detection data of an obstacle detector on the cleaning robot; identifies the type of the obstacle in front of the movement of the cleaning robot according to the detection data; determines the corresponding type of the obstacle The motion model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the type of the obstacle; according to the motion model and the detection data, the cleaning robot is controlled along the edge of the obstacle Compared with the prior art, the present application can improve the ability of the robot to move along obstacles, so as to realize the efficient and autonomous edge cleaning function of the cleaning robot.

实施例二Embodiment 2

本申请实施例提供一种清洁机器人沿障碍物运动的控制装置,该清洁机器人沿障碍物运动的控制装置与实施例一地清洁机器人沿障碍物运动的控制方法对应,相关之处参见实施例一的部分说明即可。以下描述的方法实施例仅仅是示意性的。An embodiment of the present application provides a control device for a cleaning robot to move along an obstacle. The control device for the cleaning robot to move along an obstacle corresponds to the control method for a cleaning robot to move along an obstacle in the first embodiment. For related details, refer to the first embodiment. part of the description. The method embodiments described below are merely illustrative.

图5是本申请实施例提供的一种清洁机器人沿障碍物运动的控制装置的示意图,如图5所示,装置10包括:FIG. 5 is a schematic diagram of a control device for a cleaning robot to move along an obstacle provided by an embodiment of the present application. As shown in FIG. 5 , the device 10 includes:

获取模块101,用于获取清洁机器人上障碍物探测器的探测数据;an acquisition module 101, configured to acquire detection data of the obstacle detector on the cleaning robot;

识别模块102,用于根据所述探测数据,识别清洁机器人运动前方的障碍物类型;an identification module 102, configured to identify the type of obstacles in front of the movement of the cleaning robot according to the detection data;

确定模块103,用于确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;A determination module 103, configured to determine a motion model corresponding to the obstacle type, the motion model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the obstacle type;

控制模块104,用于根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动。The control module 104 is configured to control the cleaning robot to move along the edge of the obstacle according to the motion model and the detection data.

在本申请的一些实施例中,所述确定模块103,具体用于:In some embodiments of the present application, the determining module 103 is specifically configured to:

根据所述障碍物类型为连续墙面类型,确定对应的运动模型为小曲率运动模型;According to the type of the obstacle being a continuous wall type, it is determined that the corresponding motion model is a small curvature motion model;

根据所述障碍物类型为孤立柱状类型,确定对应的运动模型为大曲率运动模型。According to the type of the obstacle being an isolated columnar type, it is determined that the corresponding motion model is a large-curvature motion model.

在本申请的一些实施例中,所述控制模块104,还用于小曲率运动模型构建,所述小曲率运动模型构建过程如下:In some embodiments of the present application, the control module 104 is also used to construct a small curvature motion model, and the construction process of the small curvature motion model is as follows:

Figure BDA0003014217400000091
Figure BDA0003014217400000091

其中,dW表示清洁机器人沿着障碍物的边沿运动过程中,清洁机器人与障碍物的距离;v表示清洁机器人的线速度;w表示清洁机器人的角速度;θ为清洁机器人相对于墙体平行方向的差角;θ0为上沿边激光与墙体垂线的夹角;d0表示清洁机器人质心到墙面的距离。Among them, d W represents the distance between the cleaning robot and the obstacle during the movement of the cleaning robot along the edge of the obstacle; v represents the linear velocity of the cleaning robot; w represents the angular velocity of the cleaning robot; θ is the parallel direction of the cleaning robot relative to the wall θ 0 is the angle between the upper edge laser and the vertical line of the wall; d 0 represents the distance from the center of mass of the cleaning robot to the wall.

在本申请的一些实施例中,所述控制模块104,还用于大曲率运动模型构建,所述大曲率运动模型构建过程如下:In some embodiments of the present application, the control module 104 is also used to construct a large-curvature motion model, and the process of constructing the large-curvature motion model is as follows:

从探测数据中确定上沿边距离、中沿边距离和下沿边距离;Determine the upper edge distance, the middle edge distance and the lower edge distance from the probe data;

确定清洁机器人半径与预设的绕障距离之和为位置关系阈值;Determine the sum of the cleaning robot radius and the preset obstacle-around distance as the position relationship threshold;

根据所述上绕障距离、中绕障距离、下绕障距离与所述位置关系阈值确定清洁机器人与障碍物的相对位置关系;Determine the relative positional relationship between the cleaning robot and the obstacle according to the distance around the upper obstacle, the distance around the middle obstacle, the distance around the lower obstacle and the positional relationship threshold;

根据所述相对位置关系和预设的至少两个旋转运动状态,控制清洁机器人沿着障碍物的边沿运动,不同的旋转运动状态对应不同的线速度和角速度。According to the relative position relationship and the preset at least two rotational motion states, the cleaning robot is controlled to move along the edge of the obstacle, and different rotational motion states correspond to different linear and angular velocities.

在本申请的一些实施例中,所述控制模块104,具体用于:In some embodiments of the present application, the control module 104 is specifically configured to:

获取目标区域边界上相隔预设距离的多个位置的环境湿度;Obtain the ambient humidity of multiple locations on the boundary of the target area separated by a preset distance;

计算所述多个位置的环境湿度的平均值,得到目标区域的湿度均值。The average value of the ambient humidity of the multiple locations is calculated to obtain the average value of the humidity of the target area.

本实施例的清洁机器人沿障碍物运动的控制装置,获取清洁机器人上障碍物探测器的探测数据;根据所述探测数据,识别清洁机器人运动前方的障碍物类型;确定所述障碍物类型对应的运动模型,所述运动模型是预先根据清洁机器人与障碍物的位置关系以及障碍物类型构建的;根据所述运动模型和所述探测数据,控制所述清洁机器人沿着所述障碍物的边沿运动,相比于现有技术,本申请能够改善机器人沿障碍物运动的能力,从而实现清洁机器人高效自主的沿边清扫功能。The control device for the movement of the cleaning robot along the obstacle in this embodiment obtains detection data of the obstacle detector on the cleaning robot; identifies the type of the obstacle in front of the movement of the cleaning robot according to the detection data; determines the corresponding type of the obstacle. A motion model, the motion model is constructed in advance according to the positional relationship between the cleaning robot and the obstacle and the type of the obstacle; according to the motion model and the detection data, the cleaning robot is controlled to move along the edge of the obstacle , compared with the prior art, the present application can improve the ability of the robot to move along the obstacle, thereby realizing the efficient and autonomous edge cleaning function of the cleaning robot.

实施例三Embodiment 3

如图6所示,本申请实施例还提供了一种清洁机器人20,包括:存储器201、处理器202及存储在所述存储器上并可在所述处理器上运行的计算机程序,所述处理器202运行所述计算机程序时执行以实现实施例一中任一实施方式的清洁机器人沿障碍物运动的控制方法。As shown in FIG. 6, an embodiment of the present application further provides a cleaning robot 20, including: a memory 201, a processor 202, and a computer program stored in the memory and running on the processor, the processing When the computer 202 runs the computer program, it is executed to implement the method for controlling the movement of the cleaning robot along the obstacle according to any one of Embodiment 1.

具体的,所述清洁机器人可以包括:处理器,存储器,总线和通信接口,所述处理器、通信接口和存储器通过总线连接;所述存储器中存储有可在所述处理器上运行的计算机程序,所述处理器运行所述计算机程序时执行本申请前述任一实施方式所提供的清洁机器人沿障碍物运动的控制方法。Specifically, the cleaning robot may include: a processor, a memory, a bus and a communication interface, the processor, the communication interface and the memory are connected by a bus; the memory stores a computer program that can run on the processor , the processor executes the method for controlling the movement of the cleaning robot along the obstacle provided by any of the foregoing embodiments of the present application when the processor runs the computer program.

其中,存储器可能包含高速随机存取存储器(RAM:Random Access Memory),也可能还包括非不稳定的存储器(non-volatile memory),例如至少一个磁盘存储器。通过至少一个通信接口(可以是有线或者无线)实现该系统网元与至少一个其他网元之间的通信连接,可以使用互联网、广域网、本地网、城域网等。The memory may include a high-speed random access memory (RAM: Random Access Memory), and may also include a non-volatile memory (non-volatile memory), such as at least one disk memory. The communication connection between the network element of the system and at least one other network element is realized through at least one communication interface (which may be wired or wireless), and the Internet, a wide area network, a local area network, a metropolitan area network, etc. may be used.

总线可以是ISA总线、PCI总线或EISA总线等。所述总线可以分为地址总线、数据总线、控制总线等。其中,存储器用于存储程序,所述处理器在接收到执行指令后,执行所述程序,前述本申请实施例任一实施方式揭示的所述清洁机器人沿障碍物运动的控制方法可以应用于处理器中,或者由处理器实现。The bus can be an ISA bus, a PCI bus, an EISA bus, or the like. The bus can be divided into an address bus, a data bus, a control bus, and the like. The memory is used to store a program, and the processor executes the program after receiving the execution instruction, and the control method for the cleaning robot moving along the obstacle disclosed in any of the foregoing embodiments of the present application can be applied to processing in the device, or implemented by the processor.

处理器可能是一种集成电路芯片,具有信号的处理能力。在实现过程中,上述方法的各步骤可以通过处理器中的硬件的集成逻辑电路或者软件形式的指令完成。上述的处理器可以是通用处理器,包括中央处理器(Central Processing Unit,简称CPU)、网络处理器(Network Processor,简称NP)等;还可以是数字信号处理器(DSP)、专用集成电路(ASIC)、现成可编程门阵列(FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。可以实现或者执行本申请实施例中的公开的各方法、步骤及逻辑框图。通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。结合本申请实施例所公开的方法的步骤可以直接体现为硬件译码处理器执行完成,或者用译码处理器中的硬件及软件模块组合执行完成。软件模块可以位于随机存储器,闪存、只读存储器,可编程只读存储器或者电可擦写可编程存储器、寄存器等本领域成熟的存储介质中。该存储介质位于存储器,处理器读取存储器中的信息,结合其硬件完成上述方法的步骤。A processor may be an integrated circuit chip with signal processing capabilities. In the implementation process, each step of the above-mentioned method can be completed by a hardware integrated logic circuit in a processor or an instruction in the form of software. The above-mentioned processor may be a general-purpose processor, including a central processing unit (Central Processing Unit, referred to as CPU), a network processor (Network Processor, referred to as NP), etc.; may also be a digital signal processor (DSP), an application-specific integrated circuit ( ASIC), off-the-shelf programmable gate array (FPGA) or other programmable logic devices, discrete gate or transistor logic devices, discrete hardware components. The methods, steps, and logic block diagrams disclosed in the embodiments of this application can be implemented or executed. A general purpose processor may be a microprocessor or the processor may be any conventional processor or the like. The steps of the methods disclosed in conjunction with the embodiments of the present application may be directly embodied as executed by a hardware decoding processor, or executed by a combination of hardware and software modules in the decoding processor. The software modules may be located in random access memory, flash memory, read-only memory, programmable read-only memory or electrically erasable programmable memory, registers and other storage media mature in the art. The storage medium is located in the memory, and the processor reads the information in the memory, and completes the steps of the above method in combination with its hardware.

本申请实施例提供的清洁机器人与本申请实施例提供的清洁机器人沿障碍物运动的控制方法出于相同的发明构思,具有与其采用、运行或实现的方法相同的有益效果。The cleaning robot provided by the embodiment of the present application and the control method of the cleaning robot moving along the obstacle provided by the embodiment of the present application are based on the same inventive concept, and have the same beneficial effects as the method adopted, operated or realized.

实施例四Embodiment 4

本申请实施例还提供了一种计算机可读存储介质,请参考图7,其示出的计算机可读存储介质为光盘30,其上存储有计算机可读指令(即程序产品),所述计算机可读指令可被处理器执行以实现实施例一中任一实施方式的清洁机器人沿障碍物运动的控制方法。The embodiment of the present application also provides a computer-readable storage medium, please refer to FIG. 7 , the computer-readable storage medium shown is an optical disc 30, on which computer-readable instructions (ie, program products) are stored, and the computer-readable storage medium is stored thereon. The readable instructions can be executed by the processor to implement the method for controlling the movement of the cleaning robot along the obstacle according to any one of the first embodiment.

所述计算机可读存储介质的例子还可以包括,但不限于相变内存(PRAM)、静态随机存取存储器(SRAM)、动态随机存取存储器(DRAM)、其他类型的随机存取存储器(RAM)、只读存储器(ROM)、电可擦除可编程只读存储器(EEPROM)、快闪记忆体或其他光学、磁性存储介质,在此不再一一赘述。Examples of the computer-readable storage medium may also include, but are not limited to, phase-change memory (PRAM), static random access memory (SRAM), dynamic random access memory (DRAM), other types of random access memory (RAM). ), read only memory (ROM), electrically erasable programmable read only memory (EEPROM), flash memory or other optical and magnetic storage media, which will not be repeated here.

本申请的上述实施例提供的计算机可读存储介质与本申请实施例提供的清洁机器人沿障碍物运动的控制方法出于相同的发明构思,具有与其存储的应用程序所采用、运行或实现的方法相同的有益效果。The computer-readable storage medium provided by the above-mentioned embodiments of the present application and the method for controlling the movement of a cleaning robot along an obstacle provided by the embodiments of the present application are based on the same inventive concept, and have methods adopted, executed or implemented by the application programs stored thereon. same beneficial effect.

需要说明的是:It should be noted:

在此处所提供的说明书中,说明了大量具体细节。然而,能够理解,本申请的实施例可以在没有这些具体细节的情况下实践。在一些实例中,并未详细示出公知的方法、结构和技术,以便不模糊对本说明书的理解。In the description provided herein, numerous specific details are set forth. It will be understood, however, that the embodiments of the present application may be practiced without these specific details. In some instances, well-known methods, structures and techniques have not been shown in detail in order not to obscure an understanding of this description.

类似地,应当理解,为了精简本申请并帮助理解各个发明方面中的一个或多个,在上面对本申请的示例性实施例的描述中,本申请的各个特征有时被一起分组到单个实施例、图、或者对其的描述中。然而,并不应将该公开的方法解释成反映如下意图:即所要求保护的本申请要求比在每个权利要求中所明确记载的特征更多的特征。更确切地说,如下面的权利要求书所反映的那样,发明方面在于少于前面公开的单个实施例的所有特征。因此,遵循具体实施方式的权利要求书由此明确地并入该具体实施方式,其中每个权利要求本身都作为本申请的单独实施例。Similarly, it is to be understood that in the above description of exemplary embodiments of the present application, various features of the present application are sometimes grouped together into a single embodiment, figure, or its description. This disclosure, however, should not be interpreted as reflecting an intention that the claimed application requires more features than are expressly recited in each claim. Rather, as the following claims reflect, inventive aspects lie in less than all features of a single foregoing disclosed embodiment. Thus, the claims following the Detailed Description are hereby expressly incorporated into this Detailed Description, with each claim standing on its own as a separate embodiment of this application.

本领域那些技术人员可以理解,可以对实施例中的设备中的模块进行自适应性地改变并且把它们设置在与该实施例不同的一个或多个设备中。可以把实施例中的模块或单元或组件组合成一个模块或单元或组件,以及此外可以把它们分成多个子模块或子单元或子组件。除了这样的特征和/或过程或者单元中的至少一些是相互排斥之外,可以采用任何组合对本说明书(包括伴随的权利要求、摘要和附图)中公开的所有特征以及如此公开的任何方法或者设备的所有过程或单元进行组合。除非另外明确陈述,本说明书(包括伴随的权利要求、摘要和附图)中公开的每个特征可以由提供相同、等同或相似目的的替代特征来代替。Those skilled in the art will understand that the modules in the device in the embodiment can be adaptively changed and arranged in one or more devices different from the embodiment. The modules or units or components in the embodiments may be combined into one module or unit or component, and further they may be divided into multiple sub-modules or sub-units or sub-assemblies. All features disclosed in this specification (including accompanying claims, abstract and drawings) and any method so disclosed may be employed in any combination, unless at least some of such features and/or procedures or elements are mutually exclusive. All processes or units of equipment are combined. Each feature disclosed in this specification (including accompanying claims, abstract and drawings) may be replaced by alternative features serving the same, equivalent or similar purpose, unless expressly stated otherwise.

此外,本领域的技术人员能够理解,尽管在此所述的一些实施例包括其它实施例中所包括的某些特征而不是其它特征,但是不同实施例的特征的组合意味着处于本申请的范围之内并且形成不同的实施例。例如,在下面的权利要求书中,所要求保护的实施例的任意之一都可以以任意的组合方式来使用。Furthermore, those skilled in the art will appreciate that although some of the embodiments described herein include certain features, but not others, included in other embodiments, that combinations of features of different embodiments are intended to be within the scope of the present application within and form different embodiments. For example, in the following claims, any of the claimed embodiments may be used in any combination.

本申请的各个部件实施例可以以硬件实现,或者以在一个或者多个处理器上运行的软件模块实现,或者以它们的组合实现。本领域的技术人员应当理解,可以在实践中使用微处理器或者数字信号处理器(DSP)来实现根据本申请实施例的虚拟机的创建装置中的一些或者全部部件的一些或者全部功能。本申请还可以实现为用于执行这里所描述的方法的一部分或者全部的设备或者装置程序(例如,计算机程序和计算机程序产品)。这样的实现本申请的程序可以存储在计算机可读介质上,或者可以具有一个或者多个信号的形式。这样的信号可以从因特网网站上下载得到,或者在载体信号上提供,或者以任何其他形式提供。Various component embodiments of the present application may be implemented in hardware, or in software modules running on one or more processors, or in a combination thereof. Those skilled in the art should understand that, in practice, a microprocessor or a digital signal processor (DSP) may be used to implement some or all functions of some or all components in the apparatus for creating a virtual machine according to the embodiments of the present application. The present application can also be implemented as an apparatus or apparatus program (eg, computer programs and computer program products) for performing part or all of the methods described herein. Such a program implementing the present application may be stored on a computer-readable medium, or may be in the form of one or more signals. Such signals may be downloaded from Internet sites, or provided on carrier signals, or in any other form.

应该注意的是上述实施例对本申请进行说明而不是对本申请进行限制,并且本领域技术人员在不脱离所附权利要求的范围的情况下可设计出替换实施例。在权利要求中,不应将位于括号之间的任何参考符号构造成对权利要求的限制。单词“包含”不排除存在未列在权利要求中的元件或步骤。位于元件之前的单词“一”或“一个”不排除存在多个这样的元件。本申请可以借助于包括有若干不同元件的硬件以及借助于适当编程的计算机来实现。在列举了若干装置的单元权利要求中,这些装置中的若干个可以是通过同一个硬件项来具体体现。单词第一、第二、以及第三等的使用不表示任何顺序。可将这些单词解释为名称。It should be noted that the above-described embodiments illustrate rather than limit the application, and alternative embodiments may be devised by those skilled in the art without departing from the scope of the appended claims. In the claims, any reference signs placed between parentheses shall not be construed as limiting the claim. The word "comprising" does not exclude the presence of elements or steps not listed in a claim. The word "a" or "an" preceding an element does not exclude the presence of a plurality of such elements. The application can be implemented by means of hardware comprising several different elements and by means of a suitably programmed computer. In a unit claim enumerating several means, several of these means may be embodied by one and the same item of hardware. The use of the words first, second, and third, etc. do not denote any order. These words can be interpreted as names.

以上所述仅为本发明的优选实施例,并非因此限制本发明的专利范围,凡是在本发明的构思下,利用本发明说明书及附图内容所作的等效结构变换,或直接/间接运用在其他相关的技术领域均包括在本发明的专利保护范围内。The above descriptions are only preferred embodiments of the present invention, and are not intended to limit the scope of the present invention. Under the conception of the present invention, the equivalent structural transformations made by the contents of the description and accompanying drawings of the present invention, or directly/indirectly applied in Other related technical fields are included within the scope of patent protection of the present invention.

Claims (12)

1. A method of controlling movement of a cleaning robot along an obstacle, comprising:
acquiring detection data of an obstacle detector on the cleaning robot;
identifying the type of an obstacle in front of the movement of the cleaning robot according to the detection data;
determining a motion model corresponding to the type of the obstacle, wherein the motion model is constructed in advance according to the position relation between the cleaning robot and the obstacle and the type of the obstacle;
controlling the cleaning robot to move along the edge of the obstacle according to the movement model and the detection data.
2. The method of claim 1, wherein the determining a motion model corresponding to the type of obstacle comprises:
determining the corresponding motion model as a small-curvature motion model according to the fact that the type of the obstacle is a continuous wall surface type;
and determining the corresponding motion model as a large-curvature motion model according to the fact that the type of the obstacle is an isolated column type.
3. The method of claim 2, wherein the small curvature motion model is constructed as follows:
Figure FDA0003014217390000011
wherein, d W Showing the distance between the cleaning robot and the obstacle in the process of moving the cleaning robot along the edge of the obstacle; v represents a linear velocity of the cleaning robot; w represents an angular velocity of the cleaning robot; theta is a difference angle of the cleaning robot relative to the parallel direction of the wall body; theta 0 The included angle between the upper edge laser and the vertical line of the wall body is formed; d 0 Representing the distance of the cleaning robot centroid to the wall surface.
4. The method of claim 2, wherein the large curvature motion model is constructed by the following steps:
determining an upper obstacle avoidance distance, a middle obstacle avoidance distance and a lower obstacle avoidance distance from the detection data;
determining the sum of the radius of the cleaning robot and a preset obstacle detouring distance as a position relation threshold;
determining the relative position relation between the cleaning robot and the obstacle according to the upper obstacle detouring distance, the middle obstacle detouring distance, the lower obstacle detouring distance and the position relation threshold;
and controlling the cleaning robot to move along the edge of the obstacle according to the relative position relation and at least two preset rotating motion states, wherein different rotating motion states correspond to different linear speeds and angular speeds.
5. The method for controlling the movement of the cleaning robot along the obstacle according to the relative position relationship and the preset at least two rotation states of movement, comprising the steps of:
determining a target rotation motion state corresponding to the relative position relation;
controlling the cleaning robot to move according to the target rotation motion state;
and acquiring a new relative position relation, and repeating the steps according to the new relative position relation until the cleaning robot finishes the obstacle edgewise.
6. A control apparatus for a cleaning robot to move along an obstacle, comprising:
an acquisition module for acquiring detection data of an obstacle detector on the cleaning robot;
the recognition module is used for recognizing the type of an obstacle in front of the movement of the cleaning robot according to the detection data;
the determining module is used for determining a motion model corresponding to the type of the obstacle, and the motion model is constructed in advance according to the position relation between the cleaning robot and the obstacle and the type of the obstacle;
and the control module is used for controlling the cleaning robot to move along the edge of the obstacle according to the movement model and the detection data.
7. A control apparatus for a cleaning robot to move along an obstacle as recited in claim 6, wherein the determining module is specifically configured to:
determining a corresponding motion model as a small-curvature motion model according to the fact that the type of the barrier is a continuous wall surface type;
and determining that the corresponding motion model is a large-curvature motion model according to the fact that the type of the obstacle is an isolated column type.
8. The control device of claim 7, wherein the control module is further configured to build a low curvature motion model, the low curvature motion model being constructed by:
Figure FDA0003014217390000021
wherein, d W Showing the distance between the cleaning robot and the obstacle in the process of moving along the edge of the obstacle; v represents a linear velocity of the cleaning robot; w represents an angular velocity of the cleaning robot; theta is a difference angle of the cleaning robot relative to the wall body in the parallel direction; theta 0 The included angle between the upper edgewise laser and the vertical line of the wall body is formed; d 0 Representing the distance of the cleaning robot centroid to the wall surface.
9. The control device of claim 7, wherein the control module is further configured to build a high curvature motion model, wherein the high curvature motion model is constructed by the following process:
determining an upper edge distance, a middle edge distance and a lower edge distance from the detection data;
determining the sum of the radius of the cleaning robot and a preset obstacle avoidance distance as a position relation threshold;
determining the relative position relation between the cleaning robot and the obstacle according to the upper obstacle avoiding distance, the middle obstacle avoiding distance, the lower obstacle avoiding distance and the position relation threshold;
and controlling the cleaning robot to move along the edge of the obstacle according to the relative position relation and at least two preset rotating motion states, wherein different rotating motion states correspond to different linear speeds and angular speeds.
10. A control device for a cleaning robot to move along an obstacle according to claim 9, wherein the control module is specifically configured to:
acquiring the environmental humidity of a plurality of positions which are separated by a preset distance on the boundary of a target area;
and calculating the average value of the environmental humidity of the plurality of positions to obtain the humidity average value of the target area.
11. A cleaning robot, comprising: memory, processor and computer program stored on the memory and executable on the processor, characterized in that the processor executes when executing the computer program to implement the method according to any of claims 1 to 5.
12. A computer readable storage medium having computer readable instructions stored thereon which are executable by a processor to implement the method of any one of claims 1 to 5.
CN202110384342.8A 2021-04-09 2021-04-09 Control method for cleaning robot to move along obstacle and cleaning robot Pending CN115202330A (en)

Priority Applications (2)

Application Number Priority Date Filing Date Title
CN202110384342.8A CN115202330A (en) 2021-04-09 2021-04-09 Control method for cleaning robot to move along obstacle and cleaning robot
PCT/CN2022/077058 WO2022213732A1 (en) 2021-04-09 2022-02-21 Method for controlling movement of cleaning robot along obstacle, and cleaning robot

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110384342.8A CN115202330A (en) 2021-04-09 2021-04-09 Control method for cleaning robot to move along obstacle and cleaning robot

Publications (1)

Publication Number Publication Date
CN115202330A true CN115202330A (en) 2022-10-18

Family

ID=83545147

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110384342.8A Pending CN115202330A (en) 2021-04-09 2021-04-09 Control method for cleaning robot to move along obstacle and cleaning robot

Country Status (2)

Country Link
CN (1) CN115202330A (en)
WO (1) WO2022213732A1 (en)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024093989A1 (en) * 2022-11-02 2024-05-10 神顶科技(南京)有限公司 Obstacle avoidance method and system for robot

Families Citing this family (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN115674220A (en) * 2022-11-11 2023-02-03 中国华能集团清洁能源技术研究院有限公司 Early warning method and device for robot operation
CN117179633A (en) * 2023-08-08 2023-12-08 深圳市优纪元科技有限公司 Floor sweeping machine and motion control method and device thereof and storage medium

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN202821209U (en) * 2012-10-09 2013-03-27 上海锍铧机电设备有限公司 Sweeper provided with edgewise cleaning function
US20160132056A1 (en) * 2013-08-21 2016-05-12 Sharp Kabushiki Kaisha Autonomous mobile body
CN106974593A (en) * 2017-05-12 2017-07-25 深圳星鸿云科技有限公司 A kind of clean robot obstacle avoidance system and method
CN110622085A (en) * 2019-08-14 2019-12-27 珊口(深圳)智能科技有限公司 Mobile robot and control method and control system thereof
CN111736603A (en) * 2020-06-22 2020-10-02 广州赛特智能科技有限公司 Unmanned sweeper and long-distance welting sweeping method thereof
CN111736616A (en) * 2020-08-27 2020-10-02 北京奇虎科技有限公司 Obstacle avoidance method and device for sweeping robot, sweeping robot and readable medium
CN112415998A (en) * 2020-10-26 2021-02-26 珠海市一微半导体有限公司 Obstacle classification and obstacle avoidance control system based on TOF camera
CN112526984A (en) * 2020-09-30 2021-03-19 深圳市银星智能科技股份有限公司 Robot obstacle avoidance method and device and robot

Family Cites Families (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN102541056A (en) * 2010-12-16 2012-07-04 莱克电气股份有限公司 Obstacle processing method for robot
JP5880498B2 (en) * 2013-08-09 2016-03-09 トヨタ自動車株式会社 Autonomous mobile object, obstacle discrimination method and obstacle avoidance method
KR102235270B1 (en) * 2017-01-18 2021-04-01 엘지전자 주식회사 Moving Robot and controlling method
CN110908378B (en) * 2019-11-28 2022-06-21 深圳乐动机器人有限公司 Robot edge method and robot
CN111949021B (en) * 2020-07-30 2024-02-09 尚科宁家(中国)科技有限公司 Self-propelled robot and control method thereof
CN112363513B (en) * 2020-11-25 2024-06-18 珠海一微半导体股份有限公司 Obstacle classification obstacle avoidance control method based on depth information
CN112327878B (en) * 2020-11-25 2022-06-10 珠海一微半导体股份有限公司 Obstacle classification and obstacle avoidance control method based on TOF camera

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN202821209U (en) * 2012-10-09 2013-03-27 上海锍铧机电设备有限公司 Sweeper provided with edgewise cleaning function
US20160132056A1 (en) * 2013-08-21 2016-05-12 Sharp Kabushiki Kaisha Autonomous mobile body
CN106974593A (en) * 2017-05-12 2017-07-25 深圳星鸿云科技有限公司 A kind of clean robot obstacle avoidance system and method
CN110622085A (en) * 2019-08-14 2019-12-27 珊口(深圳)智能科技有限公司 Mobile robot and control method and control system thereof
CN111736603A (en) * 2020-06-22 2020-10-02 广州赛特智能科技有限公司 Unmanned sweeper and long-distance welting sweeping method thereof
CN111736616A (en) * 2020-08-27 2020-10-02 北京奇虎科技有限公司 Obstacle avoidance method and device for sweeping robot, sweeping robot and readable medium
CN112526984A (en) * 2020-09-30 2021-03-19 深圳市银星智能科技股份有限公司 Robot obstacle avoidance method and device and robot
CN112415998A (en) * 2020-10-26 2021-02-26 珠海市一微半导体有限公司 Obstacle classification and obstacle avoidance control system based on TOF camera

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2024093989A1 (en) * 2022-11-02 2024-05-10 神顶科技(南京)有限公司 Obstacle avoidance method and system for robot

Also Published As

Publication number Publication date
WO2022213732A1 (en) 2022-10-13

Similar Documents

Publication Publication Date Title
WO2022213732A1 (en) Method for controlling movement of cleaning robot along obstacle, and cleaning robot
EP3764186B1 (en) Method for controlling autonomous mobile robot to travel along edge
US11914391B2 (en) Cleaning partition planning method for robot walking along boundry, chip and robot
CN110675307B (en) Implementation method from 3D sparse point cloud to 2D grid graph based on VSLAM
WO2018077306A1 (en) Obstacle avoidance and following method, electronic device, and storage medium
US10860033B2 (en) Movable object and method for controlling the same
CN110554700A (en) method for identifying room and door of mobile robot
CN111920353A (en) Cleaning control method, cleaning area division method, apparatus, equipment, storage medium
CN113741438A (en) Path planning method and device, storage medium, chip and robot
WO2023000679A1 (en) Robot recharging control method and apparatus, and storage medium
CN114431771B (en) Sweeping method of sweeping robot and related device
CN111609853A (en) Three-dimensional map construction method, cleaning robot and electronic equipment
CN114200920A (en) Path planning method, device and control system
CN111679663A (en) Three-dimensional map construction method, cleaning robot and electronic equipment
Lee et al. Sector-based maximal online coverage of unknown environments for cleaning robots with limited sensing
CN114660583B (en) A robot and its repositioning method, device and medium
CN118435141A (en) Robot, obstacle avoidance method thereof, robot system and storage medium
CN115167449A (en) An obstacle detection method, device, readable storage medium and mobile robot
WO2019183928A1 (en) Indoor robot positioning method and robot
WO2023082381A1 (en) Cleaning robot control method and apparatus, cleaning robot, and storage medium
TWI846276B (en) Path planning method and autonomous travelling robot
CN112489131B (en) Method, device, medium and robot for constructing cost map based on pavement detection
CN111650928A (en) A method and device for autonomous exploration of a sweeping robot
CN114689080B (en) Method, system, robot and readable storage medium for judging robot positioning quality
CN117193277A (en) Setting method based on map area outline and robot edge finishing control method

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