CN116058725A - Anti-collision method, device, equipment and storage medium of cleaning robot - Google Patents
Anti-collision method, device, equipment and storage medium of cleaning robot Download PDFInfo
- Publication number
- CN116058725A CN116058725A CN202111276477.9A CN202111276477A CN116058725A CN 116058725 A CN116058725 A CN 116058725A CN 202111276477 A CN202111276477 A CN 202111276477A CN 116058725 A CN116058725 A CN 116058725A
- Authority
- CN
- China
- Prior art keywords
- cleaning robot
- distance
- point cloud
- collision
- obstacle point
- 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
Links
Images
Classifications
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/24—Floor-sweeping machines, motor-driven
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts 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
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts 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/4011—Regulation of the cleaning machine by electric means; Control systems and remote control systems therefor
-
- A—HUMAN NECESSITIES
- A47—FURNITURE; DOMESTIC ARTICLES OR APPLIANCES; COFFEE MILLS; SPICE MILLS; SUCTION CLEANERS IN GENERAL
- A47L—DOMESTIC WASHING OR CLEANING; SUCTION CLEANERS IN GENERAL
- A47L11/00—Machines for cleaning floors, carpets, furniture, walls, or wall coverings
- A47L11/40—Parts 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/4061—Steering means; Means for avoiding obstacles; Details related to the place where the driver is accommodated
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
Description
技术领域technical field
本申请属于智能机器人技术领域,具体涉及一种清洁机器人的防碰撞方法、装置、设备及存储介质。The present application belongs to the technical field of intelligent robots, and in particular relates to an anti-collision method, device, equipment and storage medium of a cleaning robot.
背景技术Background technique
随着人工智能的发展,越来越多的智能型机器人正在投入使用,为人们的生活带来便利。尤其是家庭服务机器人的科技进步,给人们的生活带来了很多便捷,越来越多的消费者正在使用家庭服务机器人产品。With the development of artificial intelligence, more and more intelligent robots are being put into use, bringing convenience to people's lives. In particular, the technological progress of home service robots has brought a lot of convenience to people's lives, and more and more consumers are using home service robot products.
清洁机器人便是家庭服务机器人中的一种,是为人类服务的特种机器人,主要从事家庭卫生的清洁、清洗等工作。清洁机器人大致分为智能吸尘器、智能扫地机和集吸、扫于一体的智能清扫机。Cleaning robot is one of the household service robots, which is a special robot serving human beings, mainly engaged in cleaning and cleaning of household hygiene. Cleaning robots are roughly divided into smart vacuum cleaners, smart sweepers, and smart sweepers that integrate suction and sweeping.
目前的去清洁机器人,在正常清扫过程中,通过激光雷达识别行进方向上的障碍物,以避免在清扫过程中,与室内的家具发生碰撞。但是,目前激光雷达扫描获取的激光点云数据较多,识别算法较为复杂,识别速度较慢,导致对清洁机器人行进方向上的障碍物的识别不够及时,从而发生磕坏、碰歪家具的情况。The current cleaning robot uses laser radar to identify obstacles in the direction of travel during the normal cleaning process, so as to avoid collisions with indoor furniture during the cleaning process. However, at present, there are a lot of laser point cloud data acquired by lidar scanning, the recognition algorithm is relatively complex, and the recognition speed is slow, which leads to insufficient timely recognition of obstacles in the direction of the cleaning robot, resulting in damage and crooked furniture. .
因此,有必要对现有技术予以改良以克服现有技术中的所述缺陷。Therefore, it is necessary to improve the prior art to overcome the defects in the prior art.
发明内容Contents of the invention
本申请的目的在于提供一种清洁机器人的防碰撞方法、装置、设备及存储介质,其所要解决的技术问题是:清洁机器人无法及时识别行进方向上的障碍物,从而导致碰撞家具的问题。The purpose of this application is to provide an anti-collision method, device, equipment and storage medium for a cleaning robot. The technical problem to be solved is: the cleaning robot cannot identify obstacles in the direction of travel in time, resulting in collisions with furniture.
为解决上述技术问题,本申请采用如下技术方案:In order to solve the above technical problems, the application adopts the following technical solutions:
第一方面,本申请提供一种清洁机器人的防碰撞方法,包括:In a first aspect, the present application provides an anti-collision method for a cleaning robot, including:
在清洁机器人行走路径上的多个目标区域内,分别获取距离所述清洁机器人的最近障碍物点云;所述多个目标区域是以所述清洁机器人为中心,在360°范围内划分得到的多个扇形区域;In multiple target areas on the cleaning robot’s walking path, respectively obtain point clouds of obstacles closest to the cleaning robot; the multiple target areas are obtained by dividing the cleaning robot within a 360° range with the cleaning robot as the center Multiple fan-shaped areas;
在所述多个目标区域内,分别计算对应的最近障碍物点云到所述清洁机器人的距离,并将所述最近障碍物点云到清洁机器人的距离与预设距离阈值进行比较,得到比较结果;In the plurality of target areas, respectively calculate the distance from the corresponding nearest obstacle point cloud to the cleaning robot, and compare the distance from the nearest obstacle point cloud to the cleaning robot with a preset distance threshold to obtain a comparison result;
根据所述比较结果,确定所述清洁机器人的防碰撞动作。According to the comparison result, the anti-collision action of the cleaning robot is determined.
可选地,根据本申请第一方面所述的清洁机器人的防碰撞方法,所述预设距离阈值包括第一预设阈值,所述根据所述比较结果,确定所述清洁机器人的防碰撞动作,包括:Optionally, according to the anti-collision method of the cleaning robot described in the first aspect of the present application, the preset distance threshold includes a first preset threshold, and the anti-collision action of the cleaning robot is determined according to the comparison result ,include:
若所述比较结果为所述最近障碍物点云到清洁机器人的距离小于等于第一预设阈值,则确定所述清洁机器人的防碰撞动作为减速运行。If the comparison result is that the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to a first preset threshold, it is determined that the anti-collision action of the cleaning robot is deceleration operation.
可选地,根据本申请第一方面所述的清洁机器人的防碰撞方法,所述预设距离阈值还包括第二预设阈值,且所述第二预设阈值小于所述第一预设阈值,所述方法,还包括:Optionally, according to the anti-collision method for a cleaning robot described in the first aspect of the present application, the preset distance threshold further includes a second preset threshold, and the second preset threshold is smaller than the first preset threshold , the method also includes:
若所述比较结果为所述最近障碍物点云到清洁机器人的距离小于等于第二预设阈值,则确定所述清洁机器人的防碰撞障动作为停止运行。If the comparison result is that the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to a second preset threshold, then it is determined that the anti-collision obstacle action of the cleaning robot is to stop running.
可选地,根据本申请第一方面所述的清洁机器人的防碰撞方法,所述在清洁机器人行走路径上的多个目标区域内,分别获取距离所述清洁机器人的最近障碍物点云,包括:Optionally, according to the anti-collision method of the cleaning robot described in the first aspect of the present application, in the plurality of target areas on the walking path of the cleaning robot, respectively acquiring point clouds of obstacles closest to the cleaning robot, including :
获取障碍物点云;Get obstacle point cloud;
将获取的所述障碍物点云分别投影到预先构建的二维栅格地图上;respectively projecting the obtained obstacle point cloud onto a pre-built two-dimensional grid map;
在所述二维栅格地图上,对每个所述目标区域,分别确定与所述清洁机器人中心距离最近的栅格内的障碍物点云,即为对应目标区域内的最近障碍物点云。On the two-dimensional grid map, for each target area, respectively determine the obstacle point cloud in the grid closest to the center of the cleaning robot, which is the nearest obstacle point cloud in the corresponding target area .
可选地,根据本申请第一方面所述的清洁机器人的防碰撞方法,所述在所述多个目标区域内,分别计算对应的最近激光点云到清洁机器人的距离,包括:Optionally, according to the anti-collision method of the cleaning robot described in the first aspect of the present application, in the plurality of target areas, calculating the distance from the corresponding closest laser point cloud to the cleaning robot includes:
在每个所述目标区域内,分别确定清洁机器人中心到对应的最近障碍物点云的距离;In each of the target areas, respectively determine the distance from the center of the cleaning robot to the corresponding nearest obstacle point cloud;
将所述清洁机器人中心到对应的最近障碍物点云的距离,减去当前目标区域内所述清洁机器人中心到所述清洁机器人边缘的距离,得到对应的最近障碍物点云到清洁机器人的距离。The distance from the center of the cleaning robot to the corresponding nearest obstacle point cloud is subtracted from the distance from the center of the cleaning robot to the edge of the cleaning robot in the current target area to obtain the distance from the corresponding nearest obstacle point cloud to the cleaning robot .
第二方面,本申请还提供一种清洁机器人的防碰撞装置,包括:In a second aspect, the present application also provides an anti-collision device for a cleaning robot, including:
目标区域确定模块,用于在清洁机器人行走路径上的多个目标区域内,分别获取距离所述清洁机器人的最近障碍物点云;所述多个目标区域是以所述清洁机器人为中心,在360°范围内划分得到的多个扇形区域;The target area determination module is used to obtain the nearest obstacle point cloud from the cleaning robot in multiple target areas on the cleaning robot's walking path; the multiple target areas are centered on the cleaning robot, in Multiple fan-shaped areas divided within a 360° range;
距离比较模块,用于在所述多个目标区域内,分别计算对应的最近障碍物点云到所述清洁机器人的距离,并将所述最近障碍物点云到清洁机器人的距离与预设距离阈值进行比较,得到比较结果;The distance comparison module is used to calculate the distance from the corresponding nearest obstacle point cloud to the cleaning robot in the plurality of target areas, and compare the distance from the nearest obstacle point cloud to the cleaning robot with the preset distance Thresholds are compared to obtain the comparison result;
防碰撞模块,根据所述比较结果,确定所述清洁机器人的防碰撞动作。The anti-collision module determines the anti-collision action of the cleaning robot according to the comparison result.
可选地,根据本申请第二方面所述的清洁机器人的防碰撞装置,所述预设距离阈值包括第一预设阈值和第二预设阈值,且所述第二预设阈值小于所述第一预设阈值;所述防碰撞模块包括:Optionally, according to the anti-collision device of the cleaning robot described in the second aspect of the present application, the preset distance threshold includes a first preset threshold and a second preset threshold, and the second preset threshold is smaller than the The first preset threshold; the anti-collision module includes:
第一判断单元,用于若所述比较结果为:所述最近障碍物点云到清洁机器人的距离小于等于第一预设阈值,则确定所述清洁机器人的防碰撞动作为减速运行。The first judging unit is configured to determine that the anti-collision action of the cleaning robot is deceleration operation if the comparison result is: the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to a first preset threshold.
第二判断单元,用于若所述比较结果为:所述最近障碍物点云到清洁机器人的距离小于等于第二预设阈值,则确定所述清洁机器人的防碰撞障动作为停止运行。The second judging unit is configured to determine that the anti-collision obstacle action of the cleaning robot is to stop running if the comparison result is: the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to a second preset threshold.
第三方面,本申请还提供一种清洁机器人,包括本申请第二方面任一实施例所述的防碰撞装置。In a third aspect, the present application further provides a cleaning robot, including the anti-collision device described in any embodiment of the second aspect of the present application.
第四方面,本申请还提供一种电子设备,包括处理器和存储器,所述存储器存储有程序,所述程序在被所述处理器执行时,用以实现本申请第一方面任一实施例所述防碰撞方法的步骤。In a fourth aspect, the present application also provides an electronic device, including a processor and a memory, the memory stores a program, and when the program is executed by the processor, it is used to implement any embodiment of the first aspect of the present application The steps of the anti-collision method.
第五方面,本申请还提供一种计算机存储介质,所述计算机存储介质上存储有程序,所述程序在被处理器执行时,用以实现本申请第一方面任一实施例所述防碰撞方法的步骤。In the fifth aspect, the present application also provides a computer storage medium, on which a program is stored, and when the program is executed by a processor, it is used to realize the anti-collision described in any embodiment of the first aspect of the present application. method steps.
本申请提供的技术方案,具有以下优点:在清洁机器人行走路径上的多个目标区域内,分别获取距离清洁机器人的最近障碍物点云,然后在多个目标区域内,分别计算对应的最近障碍物点云到清洁机器人的距离,并将对应的距离与预设距离阈值进行比较,以确定清洁机器人的防碰撞动作。本申请通过划分多个目标区域,对每个目标区域,只确定最近障碍物点云用于障碍物识别,使得识别算法更加简便,大大缩短了障碍物识别的过程,提高了检测效率,对行走方向上的障碍物能更及时的检测到,有效避免发生碰撞。The technical solution provided by the present application has the following advantages: in multiple target areas on the cleaning robot’s walking path, obtain the point cloud of the nearest obstacle to the cleaning robot, and then calculate the corresponding nearest obstacles in the multiple target areas The distance from the object point cloud to the cleaning robot is compared with the preset distance threshold to determine the anti-collision action of the cleaning robot. This application divides multiple target areas, and for each target area, only the nearest obstacle point cloud is determined for obstacle identification, which makes the identification algorithm more convenient, greatly shortens the process of obstacle identification, improves the detection efficiency, and is useful for walking Obstacles in the direction can be detected in a more timely manner, effectively avoiding collisions.
附图说明Description of drawings
为了更清楚地说明本申请具体实施方式或现有技术中的技术方案,下面将对具体实施方式或现有技术描述中所需要使用的附图作简单地介绍,显而易见,下面描述中的附图是本申请的一些实施方式,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其他的附图。In order to more clearly illustrate the specific embodiments of the present application or the technical solutions in the prior art, the following will briefly introduce the drawings that need to be used in the description of the specific embodiments or prior art. Obviously, the accompanying drawings in the following description These are some implementations of the present application. For those skilled in the art, other drawings can also be obtained according to these drawings without creative work.
图1为本申请一个实施例提供的清洁机器人防碰撞系统架构图;FIG. 1 is a structure diagram of a cleaning robot anti-collision system provided by an embodiment of the present application;
图2为本申请一个实施例提供的防碰撞方法的流程图;Fig. 2 is a flow chart of the anti-collision method provided by one embodiment of the present application;
图3为本申请一个实施例提供的目标区域的示意图;FIG. 3 is a schematic diagram of a target area provided by an embodiment of the present application;
图4为本申请一个实施例提供的防碰撞装置的结构框图;Fig. 4 is a structural block diagram of an anti-collision device provided by an embodiment of the present application;
图5为本申请一个实施例提供的电子设备的结构框图。Fig. 5 is a structural block diagram of an electronic device provided by an embodiment of the present application.
附图标记说明:Explanation of reference signs:
101-机器人控制装置,102-机器人驱动装置,103-激光雷达。101-robot control device, 102-robot driving device, 103-lidar.
具体实施方式Detailed ways
下面将结合附图对本申请的技术方案进行清楚、完整地描述,显然,所描述的实施例是本申请一部分实施例,而不是全部的实施例。下文中将参考附图并结合实施例来详细说明本申请。需要说明的是,在不冲突的情况下,本申请的实施例及实施例中的特征可以相互组合。The technical solutions of the present application will be clearly and completely described below in conjunction with the accompanying drawings. Apparently, the described embodiments are some of the embodiments of the present application, not all of them. Hereinafter, the present application will be described in detail with reference to the drawings and embodiments. It should be noted that, in the case of no conflict, the embodiments of the present application and the features in the embodiments can be combined with each other.
需要说明的是,本申请的说明书和权利要求书及上述附图中的术语“第一”、“第二”等是用于区别类似的对象,而不必用于描述特定的顺序或先后次序。It should be noted that the terms "first" and "second" in the description and claims of the present application and the above drawings are used to distinguish similar objects, but not necessarily used to describe a specific sequence or sequence.
本实施例中的清洁机器人可以是一种扫地机器人,可以应用于室内有家具等障碍物的环境下。现有技术中,扫地机器人对障碍物的识别不够及时,识别速度慢,导致扫地机器人在工作过程中,与障碍物发生碰撞,如果碰撞到家具,容易导致家具损坏。The cleaning robot in this embodiment may be a sweeping robot, and may be applied in indoor environments where there are obstacles such as furniture. In the prior art, the sweeping robot's recognition of obstacles is not timely enough, and the recognition speed is slow, which causes the sweeping robot to collide with obstacles during the working process. If it collides with furniture, it is easy to cause damage to the furniture.
针对上述现有技术中存在的技术问题,本申请实施例提供一种清洁机器人的防碰撞方法和装置。图1给出了本申请一个实施例提供的清洁机器人的防碰撞系统架构图,该防碰撞系统架构可以实现本实施例的防碰撞方法和装置。Aiming at the technical problems existing in the above-mentioned prior art, embodiments of the present application provide a collision avoidance method and device for a cleaning robot. Fig. 1 shows a structure diagram of an anti-collision system of a cleaning robot provided by an embodiment of the present application, and the structure of the anti-collision system can realize the anti-collision method and device of this embodiment.
如图1所示,该防碰撞系统架构包括:机器人控制装置101、机器人驱动装置102和激光雷达103。As shown in FIG. 1 , the architecture of the anti-collision system includes: a
机器人控制装置101的信号输入端连接激光雷达103,机器人控制装置101的控制输出端连接机器人驱动装置102。The signal input end of the
激光雷达103向机器人行走方向的预设距离范围内发射激光,扫描障碍物,获取障碍物点云数据,并发送至机器人控制装置101。The
机器人控制装置101在清洁机器人行走路径上的多个目标区域内,分别获取距离清洁机器人的最近障碍物点云;其中的多个目标区域是以所述清洁机器人为中心,在360°范围内划分得到的多个扇形区域。在多个目标区域内,分别计算对应的最近障碍物点云到清洁机器人的距离,并将最近障碍物点云到清洁机器人的距离与预设距离阈值进行比较,根据比较结果,确定清洁机器人的防碰撞动作,并输出驱动命令给机器人驱动装置102,以驱动清洁机器人执行防碰撞动作。The
关于机器人控制装置101的具体实施过程,将在下文详述。The specific implementation process of the
图2是本申请一个实施例提供的清洁机器人防碰撞方法的流程图,本实施例的防碰撞方法以图1所示系统架构的机器人控制装置101为执行主体,下面以图1所示系统架构的机器人控制装置101为执行主体,对本实施例的防碰撞方法进行说明,如图1所示,本实施例的清洁机器人防碰撞方法,至少包括:Fig. 2 is a flowchart of a cleaning robot anti-collision method provided by an embodiment of the present application. The anti-collision method of this embodiment takes the
S201:在清洁机器人行走路径上的多个目标区域内,分别获取距离清洁机器人的最近障碍物点云。S201: In multiple target areas on the walking path of the cleaning robot, respectively acquire point clouds of obstacles closest to the cleaning robot.
具体地,图3给出了本申请一个实施例提供的多个目标区域的示意图,如图3所示,本实施例的多个目标区域是以清洁机器人为中心,在360°范围内划分得到的多个扇形区域。Specifically, FIG. 3 shows a schematic diagram of multiple target areas provided by an embodiment of the present application. As shown in FIG. 3 , the multiple target areas in this embodiment are centered on the cleaning robot and divided within a range of 360°. multiple fan-shaped areas.
本实施例通过激光雷达扫描清洁机器人行走路径前方预设距离范围内的障碍物,获取预设距离范围的障碍物点云,本实施例的机器人控制装置对激光雷达获取的障碍物点云进行处理,确定落入各个扇形区域内的最近障碍物点云。In this embodiment, the laser radar scans the obstacles within the preset distance range in front of the cleaning robot's walking path, and obtains the obstacle point cloud of the preset distance range, and the robot control device in this embodiment processes the obstacle point cloud acquired by the laser radar. , to determine the nearest obstacle point cloud falling within each fan-shaped area.
可选地,本实施例确定最近障碍物点云,可以通过如下方式实现:Optionally, this embodiment determines the nearest obstacle point cloud, which can be implemented in the following manner:
获取障碍物点云;将获取的所述障碍物点云分别投影到预先构建的二维栅格地图上;在所述二维栅格地图上,对每个所述目标区域,分别确定与所述清洁机器人中心距离最近的栅格内的障碍物点云,即为对应目标区域内的最近障碍物点云。Obtaining obstacle point clouds; respectively projecting the obtained obstacle point clouds onto pre-built two-dimensional grid maps; on the two-dimensional grid maps, for each of the target areas, respectively determine The obstacle point cloud in the grid closest to the center of the cleaning robot is the closest obstacle point cloud in the corresponding target area.
本实施例在机器人控制装置内存储有预先构建的二维栅格地图,激光雷达将扫描得到的障碍物点云实时发送至机器人控制装置,机器人控制装置将实时获取的障碍物点云依次投影至二维栅格地图上。In this embodiment, a pre-built two-dimensional grid map is stored in the robot control device, and the laser radar sends the scanned obstacle point cloud to the robot control device in real time, and the robot control device projects the obstacle point cloud obtained in real time to the 2D grid map.
对落入同一目标区域内的障碍物点云,分别确定不同时刻获取的障碍物点云所在的栅格与清洁机器人中心的距离,并保留距离清洁机器人中心最近的栅格内的障碍物点云,即为对应目标区域内距离清洁机器人的最近障碍物点云。其中,落入障碍物点云的栅格表示障碍物的位置信息。For the obstacle point cloud falling into the same target area, determine the distance between the grid of the obstacle point cloud obtained at different times and the center of the cleaning robot, and keep the obstacle point cloud in the grid closest to the center of the cleaning robot , which is the point cloud of the closest obstacle to the cleaning robot in the corresponding target area. Among them, the grid falling into the obstacle point cloud represents the location information of the obstacle.
本实施例中的激光雷达获取障碍物点云以及将障碍物点云投影至二维栅格地图,均属于本领域比较熟知的技术,在此不再赘述。The lidar in this embodiment acquires the obstacle point cloud and projects the obstacle point cloud to the two-dimensional grid map, both of which are relatively well-known technologies in the art, and will not be repeated here.
S202:在多个目标区域内,分别计算对应的最近障碍物点云到清洁机器人的距离,并将该距离与预设距离阈值进行比较,得到比较结果。S202: In multiple target areas, respectively calculate the distances from the corresponding nearest obstacle point cloud to the cleaning robot, and compare the distances with a preset distance threshold to obtain a comparison result.
S203:根据比较结果,确定清洁机器人的防碰撞动作。S203: Determine the anti-collision action of the cleaning robot according to the comparison result.
具体地,本实施例的预设距离阈值可以预先存储于机器人控制装置内。机器人控制装置获取落入不同目标区域内的最近障碍物点云,并分别计算对应的最近障碍物点云到清洁机器人的距离,然后将计算得到的距离与预设距离阈值进行比较,得到比较结果,根据比较结果,即可确定清洁机器人的防碰撞动作。Specifically, the preset distance threshold in this embodiment may be pre-stored in the robot control device. The robot control device obtains the nearest obstacle point cloud falling into different target areas, and calculates the distance from the corresponding nearest obstacle point cloud to the cleaning robot, and then compares the calculated distance with the preset distance threshold to obtain the comparison result , according to the comparison result, the anti-collision action of the cleaning robot can be determined.
可选地,本实施例计算对应的最近障碍物点云到清洁机器人的距离,可通过如下方式实现:Optionally, this embodiment calculates the distance from the corresponding nearest obstacle point cloud to the cleaning robot, which can be implemented in the following manner:
在每个所述目标区域内,分别确定清洁机器人中心到对应的最近障碍物点云的距离;将清洁机器人中心到对应的最近障碍物点云的距离,减去当前目标区域内清洁机器人中心到清洁机器人边缘的距离,得到对应的最近障碍物点云到清洁机器人的距离。In each of the target areas, the distance from the center of the cleaning robot to the corresponding nearest obstacle point cloud is determined respectively; the distance from the center of the cleaning robot to the corresponding nearest obstacle point cloud is subtracted from the center of the cleaning robot in the current target area to The distance from the edge of the cleaning robot is obtained to obtain the distance from the point cloud of the corresponding nearest obstacle to the cleaning robot.
如图3所示,示例性地,例如,清洁机器人为圆形结构的扫地机器人,在对应的目标区域内,最近障碍物点云到清洁机器人中心的距离为m,清洁机器人中心到清洁机器人边缘的距离为n,那么,得到该目标区域内最近障碍物点云到清洁机器人的距离为m-n。As shown in Figure 3, for example, the cleaning robot is a sweeping robot with a circular structure. In the corresponding target area, the distance from the point cloud of the nearest obstacle to the center of the cleaning robot is m, and the distance from the center of the cleaning robot to the edge of the cleaning robot is m The distance is n, then the distance from the nearest obstacle point cloud to the cleaning robot in the target area is m-n.
对于圆形的扫地机器人来说,每个目标区域内,清洁机器人中心到清洁机器人边缘的距离都相等,图3只是示例性地给出清洁机器人的形状,在他实施例中,清洁机器人也可能为三角形、五边形等其他形状,那么,清洁机器人中心到清洁机器人边缘的距离将各不相同。本实施例对清洁机器人的形状不做限定。For a circular sweeping robot, in each target area, the distance from the center of the cleaning robot to the edge of the cleaning robot is equal. Figure 3 is an example of the shape of the cleaning robot. In other embodiments, the cleaning robot may also other shapes such as triangle, pentagon, etc., then the distance from the center of the cleaning robot to the edge of the cleaning robot will be different. This embodiment does not limit the shape of the cleaning robot.
可选地,本实施例的预设距离阈值包括第一预设阈值,本实施例确定清洁机器人的防碰撞动作,具体可通过如下方式实现:Optionally, the preset distance threshold in this embodiment includes a first preset threshold, and this embodiment determines the anti-collision action of the cleaning robot, which can be specifically implemented in the following manner:
若比较结果为:最近障碍物点云到清洁机器人的距离小于等于第一预设阈值,则确定清洁机器人的防碰撞动作为减速运行。If the comparison result is: the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to the first preset threshold, then it is determined that the anti-collision action of the cleaning robot is deceleration operation.
本实施例中,设置了第一预设阈值,对于各目标区域,若最近障碍物点云到清洁机器人的距离小于等于第一预设阈值,那么,机器人控制装置则发出减速运行的指令给机器人驱动装置,以控制清洁机器人减速运行。In this embodiment, a first preset threshold is set. For each target area, if the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to the first preset threshold, then the robot control device sends an instruction to slow down the operation to the robot. The driving device is used to control the deceleration operation of the cleaning robot.
可选地,预设距离阈值还包括第二预设阈值,且第二预设阈值小于第一预设阈值,本实施例确定清洁机器人的防碰撞动作,具体可通过如下方式实现:Optionally, the preset distance threshold further includes a second preset threshold, and the second preset threshold is smaller than the first preset threshold. This embodiment determines the anti-collision action of the cleaning robot, which can be specifically implemented in the following manner:
若比较结果为:最近障碍物点云到清洁机器人的距离小于等于第二预设阈值,则确定清洁机器人的防碰撞障动作为停止运行。If the comparison result is: the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to the second preset threshold, then it is determined that the anti-collision obstacle action of the cleaning robot is to stop running.
本实施例中,预设距离阈值还包括第二预设阈值,对于各目标区域,若最近障碍物点云到清洁机器人的距离小于等于第二预设阈值,那么,机器人控制装置则发出停止运行的指令给机器人驱动装置,以控制清洁机器人停止运行。In this embodiment, the preset distance threshold also includes a second preset threshold. For each target area, if the distance from the point cloud of the nearest obstacle to the cleaning robot is less than or equal to the second preset threshold, then the robot control device issues a stop operation The instruction is given to the robot driving device to control the cleaning robot to stop running.
另外,机器人控制装置在控制清洁机器人减速运行的过程中,若检测到对应目标区域内的最近障碍物点云到清洁机器人的距离小于等于第二预设阈值,则控制清洁机器人停止运行。In addition, the robot control device controls the cleaning robot to stop running if it detects that the distance from the point cloud of the nearest obstacle in the corresponding target area to the cleaning robot is less than or equal to the second preset threshold during the process of controlling the cleaning robot to decelerate.
本实施例中,若比较结果为每个目标区域对应的最近障碍物点云到清洁机器人的距离均大于第一预设阈值,则控制清洁机器人继续按照规划路线执行清扫作业。In this embodiment, if the comparison result is that the distance from the nearest obstacle point cloud corresponding to each target area to the cleaning robot is greater than the first preset threshold, the cleaning robot is controlled to continue to perform cleaning operations according to the planned route.
本实施例只要有一个目标区域对应的最近障碍物点云到清洁机器人的距离小于等于第一预设阈值或第二预设阈值,便控制清洁机器人执行相应的防碰撞动作。In this embodiment, as long as the distance between the nearest obstacle point cloud corresponding to a target area and the cleaning robot is less than or equal to the first preset threshold or the second preset threshold, the cleaning robot is controlled to perform corresponding anti-collision actions.
综上所述,本申请提供的防碰撞方法,在清洁机器人行走路径上的多个目标区域内,分别获取距离清洁机器人的最近障碍物点云,然后在多个目标区域内,分别计算对应的最近障碍物点云到清洁机器人的距离,并将对应的距离与预设距离阈值进行比较,以确定清洁机器人的防碰撞动作。本申请通过划分多个目标区域,对每个目标区域,只确定最近障碍物点云用于障碍物识别,使得识别算法更加简便,大大缩短了障碍物识别的过程,提高了检测效率,对行走方向上的障碍物能更及时的检测到,有效避免发生碰撞。To sum up, the anti-collision method provided by this application obtains the point clouds of the closest obstacles to the cleaning robot in multiple target areas on the walking path of the cleaning robot, and then calculates the corresponding The distance from the nearest obstacle point cloud to the cleaning robot, and compare the corresponding distance with the preset distance threshold to determine the anti-collision action of the cleaning robot. This application divides multiple target areas, and for each target area, only the nearest obstacle point cloud is determined for obstacle identification, which makes the identification algorithm more convenient, greatly shortens the process of obstacle identification, improves the detection efficiency, and is useful for walking Obstacles in the direction can be detected in a more timely manner, effectively avoiding collisions.
本申请实施例还提供一种清洁机器人的防碰撞装置,图4给出了本申请一个实施例提供的防碰撞装置的结构框图,如图4所示,该防碰撞装置,包括:An embodiment of the present application also provides an anti-collision device for a cleaning robot. FIG. 4 shows a structural block diagram of an anti-collision device provided by an embodiment of the present application. As shown in FIG. 4 , the anti-collision device includes:
目标区域确定模块,用于在清洁机器人行走路径上的多个目标区域内,分别获取距离所述清洁机器人的最近障碍物点云;所述多个目标区域是以所述清洁机器人为中心,在360°范围内划分得到的多个扇形区域;The target area determination module is used to obtain the nearest obstacle point cloud from the cleaning robot in multiple target areas on the cleaning robot's walking path; the multiple target areas are centered on the cleaning robot, in Multiple fan-shaped areas divided within a 360° range;
距离比较模块,用于在所述多个目标区域内,分别计算对应的最近障碍物点云到所述清洁机器人的距离,并将所述最近障碍物点云到清洁机器人的距离与预设距离阈值进行比较,得到比较结果;The distance comparison module is used to calculate the distance from the corresponding nearest obstacle point cloud to the cleaning robot in the plurality of target areas, and compare the distance from the nearest obstacle point cloud to the cleaning robot with the preset distance Thresholds are compared to obtain the comparison result;
防碰撞模块,根据所述比较结果,确定所述清洁机器人的防碰撞动作。The anti-collision module determines the anti-collision action of the cleaning robot according to the comparison result.
可选地,所述预设距离阈值包括第一预设阈值和第二预设阈值,且所述第二预设阈值小于所述第一预设阈值;所述防碰撞模块包括:Optionally, the preset distance threshold includes a first preset threshold and a second preset threshold, and the second preset threshold is smaller than the first preset threshold; the anti-collision module includes:
第一判断单元,用于若所述比较结果为:所述最近障碍物点云到清洁机器人的距离小于等于第一预设阈值,则确定所述清洁机器人的防碰撞动作为减速运行。The first judging unit is configured to determine that the anti-collision action of the cleaning robot is deceleration operation if the comparison result is: the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to a first preset threshold.
第二判断单元,用于若所述比较结果为:所述最近障碍物点云到清洁机器人的距离小于等于第二预设阈值,则确定所述清洁机器人的防碰撞障动作为停止运行。The second judging unit is configured to determine that the anti-collision obstacle action of the cleaning robot is to stop running if the comparison result is: the distance from the nearest obstacle point cloud to the cleaning robot is less than or equal to a second preset threshold.
本实施例提供的清洁机器人的防碰撞装置与对应的清洁机器人的防碰撞方法实施例属于同一构思,其具体实现过程详见方法实施例,这里不再赘述。The anti-collision device of the cleaning robot provided in this embodiment belongs to the same idea as the corresponding embodiment of the anti-collision method of the cleaning robot, and its specific implementation process is detailed in the method embodiment, and will not be repeated here.
需要说明的是:上述实施例中提供的清洁机器人的防碰撞装置,仅以上述各功能模块的划分进行举例说明,实际应用中,可以根据需要将上述功能分配由不同的功能模块完成,即将清洁机器人的防碰撞装置的内部结构划分成不同的功能模块,以完成以上描述的全部或者部分功能。It should be noted that the anti-collision device of the cleaning robot provided in the above-mentioned embodiments is only illustrated by the division of the above-mentioned functional modules. The internal structure of the anti-collision device of the robot is divided into different functional modules to complete all or part of the functions described above.
本申请实施例还提供一种电子设备,图5是本申请一个实施例提供的电子设备的结构框图,如图5所示,该电子设备包括处理器和存储器,其中:An embodiment of the present application also provides an electronic device. FIG. 5 is a structural block diagram of an electronic device provided by an embodiment of the present application. As shown in FIG. 5, the electronic device includes a processor and a memory, wherein:
处理器,可以包括一个或多个处理核心,比如:4核心处理器、6核心处理器等。处理器可以采用DSP(Digital Signal Processing,数字信号处理)、FPGA(Field-Programmable Gate Array,现场可编程门阵列)、PLA(Programmable LogicArray,可编程逻辑阵列)中的至少一种硬件形式来实现。The processor may include one or more processing cores, such as a 4-core processor, a 6-core processor, and the like. The processor can be implemented in at least one hardware form of DSP (Digital Signal Processing, Digital Signal Processing), FPGA (Field-Programmable Gate Array, Field Programmable Gate Array), and PLA (Programmable Logic Array, programmable logic array).
存储器,可以包括高速随机存储器,还可以包括非易失性存储器,例如硬盘、内存、插接式硬盘,智能存储卡(Smart Media Card,SMC),安全数字(Secure Digital,SD)卡、闪存卡(Flash Card)、至少一个磁盘存储器件、内存器件、或其他易失性固态存储器件。Memory can include high-speed random access memory, and can also include non-volatile memory, such as hard disk, internal memory, plug-in hard disk, smart memory card (Smart Media Card, SMC), secure digital (Secure Digital, SD) card, flash memory card (Flash Card), at least one disk storage device, memory device, or other volatile solid-state storage device.
本实施例的存储器中存储有计算机程序,所述计算机程序可在所述处理器上运行,所述处理器执行所述计算机程序时,可以实现本申请清洁机器人的防碰撞方法或上述清洁机器人的防碰撞装置相关实施例中的所有或部分实施步骤,和/或文本中描述的其他内容。A computer program is stored in the memory of this embodiment, and the computer program can run on the processor. When the processor executes the computer program, the anti-collision method of the cleaning robot of the present application or the cleaning robot described above can be realized. All or part of the implementation steps in the relevant embodiments of the anti-collision device, and/or other content described in the text.
本领域技术人员可以理解,图5仅仅是本申请实施例电子设备的一种可能的实现方式,其他实施方式中,还可以包括更多或更少的部件,或者组合某些部件,或者不同部件,本实施例对此不作限定。Those skilled in the art can understand that FIG. 5 is only one possible implementation of the electronic device of the embodiment of the present application. In other implementations, more or fewer components may be included, or certain components may be combined, or different components may be included. , which is not limited in this embodiment.
本申请还提供一种计算机存储介质,所述计算机存储介质上存储有程序,所述程序被处理器执行时,用以实现清洁机器人的防碰撞方法实施例的步骤。The present application also provides a computer storage medium, on which a program is stored, and when the program is executed by a processor, it is used to implement the steps of the embodiment of the anti-collision method for a cleaning robot.
本申请实施例还提供一种清洁机器人,该清洁机器人包括防碰撞装置。该防碰撞装置具体请参阅图4所示防碰撞装置实施例的具体内容,在此不再赘述。The embodiment of the present application also provides a cleaning robot, which includes an anti-collision device. For details of the anti-collision device, please refer to the specific content of the embodiment of the anti-collision device shown in FIG. 4 , which will not be repeated here.
以上所述实施例的各技术特征可以进行任意的组合,为使描述简洁,未对上述实施例中的各个技术特征所有可能的组合都进行描述,然而,只要这些技术特征的组合不存在矛盾,都应当认为是本说明书记载的范围。The technical features of the above-mentioned embodiments can be combined arbitrarily. To make the description concise, all possible combinations of the technical features in the above-mentioned embodiments are not described. However, as long as there is no contradiction in the combination of these technical features, should be considered as within the scope of this specification.
以上所述实施例仅表达了本申请的几种实施方式,其描述较为具体和详细,但并不能因此而理解为对发明专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些都属于本申请的保护范围。因此,本申请的保护范围应以所附权利要求为准。The above-mentioned embodiments only represent several implementation modes of the present application, and the description thereof is relatively specific and detailed, but it should not be construed as limiting the scope of the patent for the invention. It should be noted that those skilled in the art can make several modifications and improvements without departing from the concept of the present application, and these all belong to the protection scope of the present application. Therefore, the protection scope of the present application should be determined by the appended claims.
Claims (10)
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111276477.9A CN116058725A (en) | 2021-10-29 | 2021-10-29 | Anti-collision method, device, equipment and storage medium of cleaning robot |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN202111276477.9A CN116058725A (en) | 2021-10-29 | 2021-10-29 | Anti-collision method, device, equipment and storage medium of cleaning robot |
Publications (1)
| Publication Number | Publication Date |
|---|---|
| CN116058725A true CN116058725A (en) | 2023-05-05 |
Family
ID=86175494
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN202111276477.9A Pending CN116058725A (en) | 2021-10-29 | 2021-10-29 | Anti-collision method, device, equipment and storage medium of cleaning robot |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN116058725A (en) |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN119214881A (en) * | 2024-08-20 | 2024-12-31 | 深圳市科曼医疗设备有限公司 | Anti-collision device, method, micro control unit and computer readable storage medium |
Citations (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10161745A (en) * | 1996-11-29 | 1998-06-19 | Murata Mach Ltd | Controller of unmanned running vehicle |
| CN103455034A (en) * | 2013-09-16 | 2013-12-18 | 苏州大学张家港工业技术研究院 | Avoidance path planning method based on closest distance vector field histogram |
| US20140277868A1 (en) * | 2013-03-12 | 2014-09-18 | Intellibot Robotics Llc | Cleaning machine with collision prevention |
| US20160132056A1 (en) * | 2013-08-21 | 2016-05-12 | Sharp Kabushiki Kaisha | Autonomous mobile body |
| CN105629985A (en) * | 2016-03-20 | 2016-06-01 | 北京工业大学 | Indoor four-rotor UAV 360° three-dimensional obstacle avoidance system |
| JP2017068439A (en) * | 2015-09-29 | 2017-04-06 | シャープ株式会社 | Autonomous traveling device |
| CN107562048A (en) * | 2017-08-08 | 2018-01-09 | 浙江工业大学 | Dynamic obstacle avoidance control method based on laser radar |
| CN111000496A (en) * | 2019-12-19 | 2020-04-14 | 深圳市云鼠科技开发有限公司 | All-dimensional obstacle avoidance processing method for sweeper |
| CN111521184A (en) * | 2020-04-13 | 2020-08-11 | 轻客小觅机器人科技(成都)有限公司 | Map building method, device and system of sweeping robot |
| CN111930127A (en) * | 2020-09-02 | 2020-11-13 | 广州赛特智能科技有限公司 | Robot obstacle identification and obstacle avoidance method |
| CN112493926A (en) * | 2020-11-25 | 2021-03-16 | 珠海市一微半导体有限公司 | A robot of sweeping floor for scanning furniture bottom profile |
| WO2021052403A1 (en) * | 2019-09-20 | 2021-03-25 | 杭州海康机器人技术有限公司 | Obstacle information sensing method and device for mobile robot |
| CN213216758U (en) * | 2020-05-29 | 2021-05-18 | 北京石头世纪科技股份有限公司 | Cleaning robot |
| US11016491B1 (en) * | 2018-01-26 | 2021-05-25 | X Development Llc | Trajectory planning for mobile robots |
| CN113485369A (en) * | 2021-08-03 | 2021-10-08 | 浙江大学 | Indoor mobile robot path planning and path optimization method for improving A-x algorithm |
-
2021
- 2021-10-29 CN CN202111276477.9A patent/CN116058725A/en active Pending
Patent Citations (15)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| JPH10161745A (en) * | 1996-11-29 | 1998-06-19 | Murata Mach Ltd | Controller of unmanned running vehicle |
| US20140277868A1 (en) * | 2013-03-12 | 2014-09-18 | Intellibot Robotics Llc | Cleaning machine with collision prevention |
| US20160132056A1 (en) * | 2013-08-21 | 2016-05-12 | Sharp Kabushiki Kaisha | Autonomous mobile body |
| CN103455034A (en) * | 2013-09-16 | 2013-12-18 | 苏州大学张家港工业技术研究院 | Avoidance path planning method based on closest distance vector field histogram |
| JP2017068439A (en) * | 2015-09-29 | 2017-04-06 | シャープ株式会社 | Autonomous traveling device |
| CN105629985A (en) * | 2016-03-20 | 2016-06-01 | 北京工业大学 | Indoor four-rotor UAV 360° three-dimensional obstacle avoidance system |
| CN107562048A (en) * | 2017-08-08 | 2018-01-09 | 浙江工业大学 | Dynamic obstacle avoidance control method based on laser radar |
| US11016491B1 (en) * | 2018-01-26 | 2021-05-25 | X Development Llc | Trajectory planning for mobile robots |
| WO2021052403A1 (en) * | 2019-09-20 | 2021-03-25 | 杭州海康机器人技术有限公司 | Obstacle information sensing method and device for mobile robot |
| CN111000496A (en) * | 2019-12-19 | 2020-04-14 | 深圳市云鼠科技开发有限公司 | All-dimensional obstacle avoidance processing method for sweeper |
| CN111521184A (en) * | 2020-04-13 | 2020-08-11 | 轻客小觅机器人科技(成都)有限公司 | Map building method, device and system of sweeping robot |
| CN213216758U (en) * | 2020-05-29 | 2021-05-18 | 北京石头世纪科技股份有限公司 | Cleaning robot |
| CN111930127A (en) * | 2020-09-02 | 2020-11-13 | 广州赛特智能科技有限公司 | Robot obstacle identification and obstacle avoidance method |
| CN112493926A (en) * | 2020-11-25 | 2021-03-16 | 珠海市一微半导体有限公司 | A robot of sweeping floor for scanning furniture bottom profile |
| CN113485369A (en) * | 2021-08-03 | 2021-10-08 | 浙江大学 | Indoor mobile robot path planning and path optimization method for improving A-x algorithm |
Cited By (1)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN119214881A (en) * | 2024-08-20 | 2024-12-31 | 深圳市科曼医疗设备有限公司 | Anti-collision device, method, micro control unit and computer readable storage medium |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| Himmelsbach et al. | Fast segmentation of 3D point clouds for ground vehicles | |
| US20200215694A1 (en) | Dynamic region division and region passage identification methods and cleaning robot | |
| CN107728615B (en) | self-adaptive region division method and system | |
| JP2023500994A (en) | Obstacle recognition method, device, autonomous mobile device and storage medium | |
| US20220371581A9 (en) | Method and Apparatus for Avoidance Control of Vehicle, Electronic Device and Storage Medium | |
| JP7265027B2 (en) | Processing device and point cloud reduction method | |
| CN114740867B (en) | Intelligent obstacle avoidance method and device based on binocular vision, robot and medium | |
| CN110286389A (en) | A kind of grid management method for obstacle recognition | |
| CN108628318A (en) | Congestion environment detection method and device, robot and storage medium | |
| CN111505652A (en) | Map establishing method, device and operation equipment | |
| CN114529539B (en) | Unmanned equipment road obstacle detection method, device, unmanned equipment and storage medium | |
| WO2025040133A1 (en) | Target following method and apparatus, movable following device and storage medium | |
| CN117302263A (en) | Method, device, equipment and storage medium for detecting drivable area | |
| CN111493750A (en) | Control method and device of sweeping robot and electronic equipment | |
| CN116058725A (en) | Anti-collision method, device, equipment and storage medium of cleaning robot | |
| CN115338864A (en) | Robot pile back control method, device, electronic equipment and storage medium | |
| CN111912418B (en) | Method, device and medium for removing obstacles in a non-travelable area of a mobile carrier | |
| CN114489058A (en) | Sweeping robot, path planning method and device thereof and storage medium | |
| JP2021124781A (en) | Map data generator, map data generation method, and program | |
| WO2023142711A1 (en) | Robot control method and device, and robot and storage medium | |
| CN116540690A (en) | Robot navigation method, device, robot and storage medium | |
| CN115177186A (en) | Sweeping method, sweeping device, sweeping robot and computer readable storage medium | |
| CN112214018A (en) | Robot path planning method and device | |
| CN118873048A (en) | Obstacle avoidance method for sweeping robot, sweeping robot and storage medium | |
| WO2021246169A1 (en) | Information processing device, information processing system, method, and program |
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 |