CN116125991A - 一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备 - Google Patents

一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备 Download PDF

Info

Publication number
CN116125991A
CN116125991A CN202310167552.0A CN202310167552A CN116125991A CN 116125991 A CN116125991 A CN 116125991A CN 202310167552 A CN202310167552 A CN 202310167552A CN 116125991 A CN116125991 A CN 116125991A
Authority
CN
China
Prior art keywords
map
robot
obstacle
forbidden zone
layer
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Granted
Application number
CN202310167552.0A
Other languages
English (en)
Other versions
CN116125991B (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.)
Maiyan Intelligent Technology Beijing Co ltd
Original Assignee
Maiyan Intelligent Technology Beijing 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 Maiyan Intelligent Technology Beijing Co ltd filed Critical Maiyan Intelligent Technology Beijing Co ltd
Priority to CN202310167552.0A priority Critical patent/CN116125991B/zh
Publication of CN116125991A publication Critical patent/CN116125991A/zh
Application granted granted Critical
Publication of CN116125991B publication Critical patent/CN116125991B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

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/0219Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory ensuring the processing of the whole working surface

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)
  • Manipulator (AREA)

Abstract

本发明涉及清洁机器人的地图算法技术领域,特别是一种基于面向高端场景的商用服务机器人的禁区脱困方法,本发明的有益效果在于:在禁区,全部不可通行的区域,依靠传感器规划出路径并防止避碰;针对商用机器人高大,沉重的特点,三维传感器矩阵全面覆盖所有的障碍;针对禁区中悬空的区域,采用点云拟合的方式侦测悬崖,并在地图中标记;鲁棒的控制方法,尽可能避免碰撞发生。

Description

一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备
技术领域
本发明涉及清洁机器人的地图算法技术领域,尤其是一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备。
背景技术
在商业场景中,存在一些地点,例如楼梯,扶梯,门槛,水池等,是服务机器人无法通行的区域,一般对于此类区域,会在软件中设置电子围栏,将此类区域封锁无法通行。但是一般会存在以下情形,诸如机器人定位丢失,位置发生跳变,机器人控制精度不够等原因,导致机器人与电子围栏产生交集,或陷入禁区之中,此时机器人是无法规划路径去往下一个目标点的,想申请一种服务机器人陷入禁区脱困的方法。
传统的机器人禁区脱困方法,主要适用于家用扫地机器人场景,家用扫地机器人在误入禁区之后,使用自身配置的碰撞传感器无目的试探运行,碰到障碍物后更换试探方向,直到整机轮廓在地图上的投影脱离禁区。这种脱困方法面临以下两个问题:
当前方处于类似台阶等悬崖或者悬空场景时,机器人容易跌落;
碰撞传感器刹车车程较小,如果机器人运行速度偏快,容易撞倒家庭中贵重物品;
那么对于体积大,重量大的商用清洁机器人,上述方案显然是不适用的,需要设计一种方案,在禁区中依靠地图找寻禁区外可达点,并且通过传感器自主规划路径运行到该可达点;
基于此,亟需一种基于面向高端场景的商用服务机器人的禁区脱困,以解决现有技术中存在的问题。
发明内容
本发明的目的是提供一种基于面向高端场景的商用服务机器人的禁区脱困,解决现有技术中的问题。
本发明公开了一种基于面向高端场景的商用服务机器人的禁区脱困方法,包括如下步骤:
S1、利用代价栅格地图,通过广度优先搜索的方式寻找一个禁区之外,离自身位置最接近的可达点,随即先执行原地自旋动作,确保朝向脱困可达点;
S2、结合自身所搭载的多传感器模组,感知机器人当前在禁区中所处的位置和可达点之间的障碍物;
S3、随后使用A*算法规划出一条可通行最优路径,沿着这条路径执行运动控制,控制过程中,依靠服务机器人自身的slam系统不断确定机器人自身位置,当判断抵达脱困可达点后,即可判断脱困成功。
进一步地,在S1步骤中,通过腐蚀地图将地图分割,包括如下步骤:
S11、收集原始地图;将原始的户型图进行录入;并将障碍物标记为第一颜色;可通行空间标记为第二颜色;
S12、侵蚀地图以提取等高线;
S13、找到提取的连接,如果符合预设的房间面积标准,则保存该数据;
S14、在S11的地图克隆中绘制并填充保存的等高线,并利用除第一颜色、第二颜色外的其他随机颜色进行填充;保存该数据;
S15、从原始地图中获取障碍物信息,并将其绘制在S14的克隆中;
S16、加大侵蚀程度,重复S12-S15步骤,直到达到以下的临界点:有些区域经过腐蚀之后断开了连接;
S17、将S16每一次断开连接的区域均绘制在S11采集的地图副本上并保存;
S18、将已经在S17绘制的区域涂成第一颜色,并重复S16,直至地图中每个区域均断开连接,并记录在S17所保存的地图副本中;
S19、将S18中的彩色区域扩散到第二颜色区域,不同色彩即表示为不同的地图分区。
进一步地,在S3步骤中,基于有限视场角深度相机和多层代价地图的障碍物留存,包括如下步骤:
S31、根据障碍点在世界坐标系(map)中的坐标以及该帧点云的时间戳(time_stamp)将每一个障碍点以std::map[1]数据结构进行储存;该图层记为camera_layer;
S32、在移动机器人行驶过程中,有限视场角的深度相机采集到点云数据,并通过体素滤波,地面拟合等方法去除非障碍点;并输入camera_layer;
S33、根据相机的视场角,在代价地图内描述一个“视场多边形”(FOV polygon),去除[1]中在视场多边形内的障碍点;
S34、将新一帧点云数据在视场多边形内进行标注,已经被标注的障碍点则更新标记时间;
S35、在机器人一定范围内的障碍点,除非进入视场多边形被更新或删除,否则永远保留;超出一定范围的障碍点,根据其上被更新的时间,超时删除;
S36、每轮代价地图更新时,无需创建及维护本层栅地图,直接遍历[1]中的全部障碍点,以最大值方对总图层(master层)进行更新;
S37、在膨胀层中,对障碍物依据梯度进行膨胀。
本发明还公开了一种存储介质,保存有所述基于面向高端场景的商用服务机器人的禁区脱困的计算机程序。
本发明还公开了一种计算机设备,包括存储器、处理器,所述存储器包括所述存储介质。
本发明的有益效果在于:
1、在禁区,全部不可通行的区域,依靠传感器规划出路径并防止避碰;
2、针对商用机器人高大,沉重的特点,三维传感器矩阵全面覆盖所有的障碍;
3、针对禁区中悬空的区域,采用点云拟合的方式侦测悬崖,并在地图中标记;
4、鲁棒的控制方法,尽可能避免碰撞发生。
附图说明
图1、为逻辑框图;
具体实施方式
下面结合附图和实施例对本发明的具体实施方式作进一步描述,以下实施例仅用于更加清楚地说明本发明的技术方案,而不能以此来限制本发明的保护范围。
下面将结合附图对本发明的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
在本发明的描述中,需要说明的是,术语“中心”、“上”、“下”、“左”、“右”、“竖直”、“水平”、“内”、“外”等指示的方位或位置关系为基于附图所示的方位或位置关系,仅是为了便于描述本发明和简化描述,而不是指示或暗示所指的装置或元件必须具有特定的方位、以特定的方位构造和操作,因此不能理解为对本发明的限制。此外,术语“第一”、“第二”、“第三”仅用于描述目的,而不能理解为指示或暗示相对重要性。
在本发明的描述中,需要说明的是,除非另有明确的规定和限定,术语“安装”、“相连”、“连接”应做广义理解,例如,可以是固定连接,也可以是可拆卸连接,或一体地连接;可以是机械连接,也可以是电连接;可以是直接相连,也可以通过中间媒介间接相连,可以是两个元件内部的连通。对于本领域的普通技术人员而言,可以具体情况理解上述术语在本发明中的具体含义。
实施例1
如图1所示,一种基于面向高端场景的商用服务机器人的禁区脱困方法,包括如下步骤:
S1、利用代价栅格地图,通过广度优先搜索的方式寻找一个禁区之外,离自身位置最接近的可达点,随即先执行原地自旋动作,确保朝向脱困可达点;
S2、结合自身所搭载的多传感器模组,感知机器人当前在禁区中所处的位置和可达点之间的障碍物;
S3、随后使用A*算法规划出一条可通行最优路径,沿着这条路径执行运动控制,控制过程中,依靠服务机器人自身的slam系统不断确定机器人自身位置,当判断抵达脱困可达点后,即可判断脱困成功。
进一步地,在S1步骤中,通过腐蚀地图将地图分割,包括如下步骤:
S11、收集原始地图;将原始的户型图进行录入;并将障碍物标记为第一颜色;可通行空间标记为第二颜色;
S12、侵蚀地图以提取等高线;
S13、找到提取的连接,如果符合预设的房间面积标准,则保存该数据;
S14、在S11的地图克隆中绘制并填充保存的等高线,并利用除第一颜色、第二颜色外的其他随机颜色进行填充;保存该数据;
S15、从原始地图中获取障碍物信息,并将其绘制在S14的克隆中;
S16、加大侵蚀程度,重复S12-S15步骤,直到达到以下的临界点:有些区域经过腐蚀之后断开了连接;
S17、将S16每一次断开连接的区域均绘制在S11采集的地图副本上并保存;
S18、将已经在S17绘制的区域涂成第一颜色,并重复S16,直至地图中每个区域均断开连接,并记录在S17所保存的地图副本中;
S19、将S18中的彩色区域扩散到第二颜色区域,不同色彩即表示为不同的地图分区。
进一步地,在S3步骤中,基于有限视场角深度相机和多层代价地图的障碍物留存,包括如下步骤:
S31、根据障碍点在世界坐标系(map)中的坐标以及该帧点云的时间戳(time_stamp)将每一个障碍点以std::map[1]数据结构进行储存;该图层记为camera_layer;
S32、在移动机器人行驶过程中,有限视场角的深度相机采集到点云数据,并通过体素滤波,地面拟合等方法去除非障碍点;并输入camera_layer;
S33、根据相机的视场角,在代价地图内描述一个“视场多边形”(FOV polygon),去除[1]中在视场多边形内的障碍点;
S34、将新一帧点云数据在视场多边形内进行标注,已经被标注的障碍点则更新标记时间;
S35、在机器人一定范围内的障碍点,除非进入视场多边形被更新或删除,否则永远保留;超出一定范围的障碍点,根据其上被更新的时间,超时删除;
S36、每轮代价地图更新时,无需创建及维护本层栅地图,直接遍历[1]中的全部障碍点,以最大值方对总图层(master层)进行更新;
S37、在膨胀层中,对障碍物依据梯度进行膨胀。
本发明还公开了一种存储介质,保存有所述基于面向高端场景的商用服务机器人的禁区脱困的计算机程序。
本发明还公开了一种计算机设备,包括存储器、处理器,所述存储器包括所述存储介质。
最后应说明的是:以上各实施例仅用以说明本发明的技术方案,而非对其限制;尽管参照前述各实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分或者全部技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的范围。

Claims (5)

1.一种基于面向高端场景的商用服务机器人的禁区脱困方法,其特征在于,包括如下步骤:
S1、利用代价栅格地图,通过广度优先搜索的方式寻找一个禁区之外,离自身位置最接近的可达点,随即先执行原地自旋动作,确保朝向脱困可达点;
S2、结合自身所搭载的多传感器模组,感知机器人当前在禁区中所处的位置和可达点之间的障碍物;
S3、随后使用A*算法规划出一条可通行最优路径,沿着这条路径执行运动控制,控制过程中,依靠服务机器人自身的slam系统不断确定机器人自身位置,当判断抵达脱困可达点后,即可判断脱困成功。
2.如权利要求1所述的一种基于面向高端场景的商用服务机器人的禁区脱困方法,其特征在于,在S1步骤中,通过腐蚀地图将地图分割,包括如下步骤:
S11、收集原始地图;将原始的户型图进行录入;并将障碍物标记为第一颜色;可通行空间标记为第二颜色;
S12、侵蚀地图以提取等高线;
S13、找到提取的连接,如果符合预设的房间面积标准,则保存该数据;
S14、在S11的地图克隆中绘制并填充保存的等高线,并利用除第一颜色、第二颜色外的其他随机颜色进行填充;保存该数据;
S15、从原始地图中获取障碍物信息,并将其绘制在S14的克隆中;
S16、加大侵蚀程度,重复S12-S15步骤,直到达到以下的临界点:有些区域经过腐蚀之后断开了连接;
S17、将S16每一次断开连接的区域均绘制在S11采集的地图副本上并保存;
S18、将已经在S17绘制的区域涂成第一颜色,并重复S16,直至地图中每个区域均断开连接,并记录在S17所保存的地图副本中;
S19、将S18中的彩色区域扩散到第二颜色区域,不同色彩即表示为不同的地图分区。
3.如权利要求1所述的一种基于面向高端场景的商用服务机器人的禁区脱困方法,其特征在于,在S3步骤中,通过有限视场角深度相机和多层代价地图的障碍物留存,包括如下步骤:
S31、根据障碍点在世界坐标系(map)中的坐标以及该帧点云的时间戳(time_stamp)将每一个障碍点以std::map[1]数据结构进行储存;该图层记为camera_layer;
S32、在移动机器人行驶过程中,有限视场角的深度相机采集到点云数据,并通过体素滤波,地面拟合等方法去除非障碍点;并输入camera_layer;
S33、根据相机的视场角,在代价地图内描述一个“视场多边形”(FOV polygon),去除[1]中在视场多边形内的障碍点;
S34、将新一帧点云数据在视场多边形内进行标注,已经被标注的障碍点则更新标记时间;
S35、在机器人一定范围内的障碍点,除非进入视场多边形被更新或删除,否则永远保留;超出一定范围的障碍点,根据其上被更新的时间,超时删除;
S36、每轮代价地图更新时,无需创建及维护本层栅地图,直接遍历[1]中的全部障碍点,以最大值方对总图层(master层)进行更新;
S37、在膨胀层中,对障碍物依据梯度进行膨胀。
4.一种存储介质,其特征在于,保存有权利要求1所述的基于面向高端场景的商用服务机器人的禁区脱困的计算机程序。
5.一种计算机设备,包括存储器、处理器,所述存储器包括权利要求2所述存储介质。
CN202310167552.0A 2023-02-27 2023-02-27 一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备 Active CN116125991B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202310167552.0A CN116125991B (zh) 2023-02-27 2023-02-27 一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202310167552.0A CN116125991B (zh) 2023-02-27 2023-02-27 一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备

Publications (2)

Publication Number Publication Date
CN116125991A true CN116125991A (zh) 2023-05-16
CN116125991B CN116125991B (zh) 2023-08-15

Family

ID=86311737

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202310167552.0A Active CN116125991B (zh) 2023-02-27 2023-02-27 一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备

Country Status (1)

Country Link
CN (1) CN116125991B (zh)

Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018121448A1 (zh) * 2016-12-30 2018-07-05 深圳市杉川机器人有限公司 移动机器人的拓扑地图创建方法、导航方法、可编程设备及计算机可读介质
CN114415654A (zh) * 2021-12-01 2022-04-29 上海思岚科技有限公司 一种脱困路径的生成方法及设备
WO2022089159A1 (zh) * 2020-10-30 2022-05-05 速感科技(北京)有限公司 困境规避方法、自主移动设备和存储介质
CN114594761A (zh) * 2022-01-05 2022-06-07 美的集团(上海)有限公司 机器人的路径规划方法、电子设备及计算机可读存储介质
CN114721396A (zh) * 2022-04-15 2022-07-08 杭州萤石软件有限公司 一种移动机器人脱困的处理方法、装置和移动机器人
WO2022170712A1 (zh) * 2021-02-10 2022-08-18 北京石头创新科技有限公司 清洁机器人脱困方法及装置、介质及电子设备
WO2022170715A1 (zh) * 2021-02-10 2022-08-18 北京石头创新科技有限公司 清洁机器人脱困方法及装置、介质及电子设备
CN114942630A (zh) * 2022-04-26 2022-08-26 深圳乐动机器人股份有限公司 控制自移动设备移动的方法、电子设备及存储介质
CN115008465A (zh) * 2022-06-29 2022-09-06 武汉擎朗智能科技有限公司 机器人控制方法、机器人及计算机可读存储介质
CN115494834A (zh) * 2022-04-11 2022-12-20 北京盈迪曼德科技有限公司 机器人路径规划方法、装置及机器人

Patent Citations (10)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2018121448A1 (zh) * 2016-12-30 2018-07-05 深圳市杉川机器人有限公司 移动机器人的拓扑地图创建方法、导航方法、可编程设备及计算机可读介质
WO2022089159A1 (zh) * 2020-10-30 2022-05-05 速感科技(北京)有限公司 困境规避方法、自主移动设备和存储介质
WO2022170712A1 (zh) * 2021-02-10 2022-08-18 北京石头创新科技有限公司 清洁机器人脱困方法及装置、介质及电子设备
WO2022170715A1 (zh) * 2021-02-10 2022-08-18 北京石头创新科技有限公司 清洁机器人脱困方法及装置、介质及电子设备
CN114415654A (zh) * 2021-12-01 2022-04-29 上海思岚科技有限公司 一种脱困路径的生成方法及设备
CN114594761A (zh) * 2022-01-05 2022-06-07 美的集团(上海)有限公司 机器人的路径规划方法、电子设备及计算机可读存储介质
CN115494834A (zh) * 2022-04-11 2022-12-20 北京盈迪曼德科技有限公司 机器人路径规划方法、装置及机器人
CN114721396A (zh) * 2022-04-15 2022-07-08 杭州萤石软件有限公司 一种移动机器人脱困的处理方法、装置和移动机器人
CN114942630A (zh) * 2022-04-26 2022-08-26 深圳乐动机器人股份有限公司 控制自移动设备移动的方法、电子设备及存储介质
CN115008465A (zh) * 2022-06-29 2022-09-06 武汉擎朗智能科技有限公司 机器人控制方法、机器人及计算机可读存储介质

Non-Patent Citations (1)

* Cited by examiner, † Cited by third party
Title
张志远;赵幸;靳晔;: "基于生物激励神经网络的清洁机器人遍历路径规划算法的改进", 轻工学报, no. 04 *

Also Published As

Publication number Publication date
CN116125991B (zh) 2023-08-15

Similar Documents

Publication Publication Date Title
Chang et al. Argoverse: 3d tracking and forecasting with rich maps
US11151281B2 (en) Video monitoring method for mobile robot
CN107981790A (zh) 室内区域划分方法及扫地机器人
Kümmerle et al. A navigation system for robots operating in crowded urban environments
CN110497901A (zh) 一种基于机器人vslam技术的泊车位自动搜索方法和系统
JP5180733B2 (ja) 移動物体追跡装置
CN107390721A (zh) 机器人随行控制方法、装置及机器人
CN111104933A (zh) 地图处理方法、移动机器人及计算机可读存储介质
KR101992662B1 (ko) Gis 정보를 이용한 3차원 지형과 cctv 영상의 정합을 통한 3차원 기반 cctv 관제 시스템
CN110428632A (zh) 基于bim和ibms的停车管理方法、存储介质及智能终端
CN108122412B (zh) 用于监控机器人检测车辆乱停的方法
CN113532461B (zh) 一种机器人自主避障导航的方法、设备及存储介质
CN112015187B (zh) 一种用于智能移动机器人的语义地图构建方法及系统
EP4208763A1 (en) Method of operating a mobile device
JP2022508032A (ja) データ処理方法及び装置
CN110986945A (zh) 基于语义高度地图的局部导航方法和系统
CN111656138A (zh) 构建地图及定位方法、客户端、移动机器人及存储介质
CN115752474A (zh) 非平坦地面环境下的机器人导航规划方法、装置及机器人
CN116125991B (zh) 一种基于面向高端场景的商用服务机器人的禁区脱困、存储介质、设备
CN113345118B (zh) 停车收费管理方法、系统及存储介质
CN112818866A (zh) 车辆定位的方法、装置及电子设备
WO2020248851A1 (zh) 库位的检测方法及装置、存储介质和电子装置
CN116182840B (zh) 地图构建方法、装置、设备及存储介质
CN115752476B (zh) 一种基于语义信息的车辆地库重定位方法、装置、设备和介质
CN115628734A (zh) 一种点云地图的维护系统

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
GR01 Patent grant
GR01 Patent grant