CN113556679A - 自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质 - Google Patents
自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质 Download PDFInfo
- Publication number
- CN113556679A CN113556679A CN202010329608.4A CN202010329608A CN113556679A CN 113556679 A CN113556679 A CN 113556679A CN 202010329608 A CN202010329608 A CN 202010329608A CN 113556679 A CN113556679 A CN 113556679A
- Authority
- CN
- China
- Prior art keywords
- boundary
- point
- recording
- points
- self
- 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
- 238000003860 storage Methods 0.000 title claims abstract description 61
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000005070 sampling Methods 0.000 claims description 20
- 238000004590 computer program Methods 0.000 claims description 10
- 238000012790 confirmation Methods 0.000 claims description 10
- 238000012545 processing Methods 0.000 claims description 3
- 238000013508 migration Methods 0.000 claims description 2
- 230000005012 migration Effects 0.000 claims description 2
- 238000000926 separation method Methods 0.000 claims description 2
- 230000005484 gravity Effects 0.000 description 12
- 238000004364 calculation method Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 238000005457 optimization Methods 0.000 description 2
- 238000012937 correction Methods 0.000 description 1
- 238000013461 design Methods 0.000 description 1
- 239000000428 dust Substances 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 230000006870 function Effects 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 239000003550 marker Substances 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 238000003825 pressing Methods 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 238000010407 vacuum cleaning Methods 0.000 description 1
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/648—Performing a task within a working area or space, e.g. cleaning
- G05D1/6484—Performing a task within a working area or space, e.g. cleaning by taking into account parameters or characteristics of the working area or space, e.g. size or shape
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/021—Services related to particular areas, e.g. point of interest [POI] services, venue services or geofences
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
- G05D1/0221—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory involving a learning process
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0268—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means
- G05D1/0274—Control of position or course in two dimensions specially adapted to land vehicles using internal positioning means using mapping information stored in a memory device
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/02—Control of position or course in two dimensions
- G05D1/021—Control of position or course in two dimensions specially adapted to land vehicles
- G05D1/0276—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle
- G05D1/028—Control of position or course in two dimensions specially adapted to land vehicles using signals provided by a source external to the vehicle using a RF signal
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/60—Intended control result
- G05D1/646—Following a predefined trajectory, e.g. a line marked on the floor or a flight path
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/024—Guidance services
-
- H—ELECTRICITY
- H04—ELECTRIC COMMUNICATION TECHNIQUE
- H04W—WIRELESS COMMUNICATION NETWORKS
- H04W4/00—Services specially adapted for wireless communication networks; Facilities therefor
- H04W4/02—Services making use of location information
- H04W4/029—Location-based management or tracking services
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D2111/00—Details of signals used for control of position, course, altitude or attitude of land, water, air or space vehicles
- G05D2111/30—Radio signals
- G05D2111/36—Radio signals generated or reflected by cables or wires carrying current, e.g. boundary wires or leaky feeder cables
Landscapes
- Engineering & Computer Science (AREA)
- Radar, Positioning & Navigation (AREA)
- Computer Networks & Wireless Communication (AREA)
- Signal Processing (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Manipulator (AREA)
Abstract
本发明公开了一种自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质,所述方法包括以下步骤:获取可移动的定位模块沿巡线路径环绕预定圈数的若干记录点;将行走第1圈对应的记录点存储于第一存储链表,将剩余的记录点存储于第二存储链表;依次调取第一存储链表中的每一个记录点作为基础坐标点,并查询第二存储链表以依次选取对应每一基础坐标点的m个记录点组;根据每个基础坐标点及其对应的m个记录点组分别获取对应该基础坐标点的边界拟合点并形成边界拟合点序列;根据所述边界拟合点序列获得边界点;将所述边界点依次连接生成工作区域的虚拟边界。本发明根据巡线路径对应的记录点生成虚拟边界,节省人力成本,提高工作效率。
Description
技术领域
本发明涉及自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质,尤其涉及一种可提高工作效率的自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质。
背景技术
随着科学技术的不断进步,各种机器人已经开始慢慢的走进人们的生活,例如:自动吸尘机器人、自动割草机器人等。这种机器人能够脱离人们的操作,在一定范围内自动行走并执行工作。
全覆盖路径规划是机器人的一个热点研究方向,对于提高机器人的工作效率至关重要;现有技术中,通常采用的技术方案为,人工辅助规划工作路径,之后再驱动机器人按照规划好的工作路径进行工作;具体的,配合机器人设置一人工辅助输入界面,通过自动或辅助的方式收集当前地形输出至输入界面,并通过人工辅助的方式在输入界面上依据收集的地形绘画工作路径;最后将该工作路径转换为指令指导机器人工作。
上述技术方案,通常需要增加摄像头等辅助设备获取数据,提高设备的生产及使用成本,另外,还需要人工辅助设计工作路径,使用较为繁琐。
发明内容
本发明提供一种可提高工作效率的自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质。
本发明提供一种自移动机器人工作区域虚拟边界的生成方法,所述方法包括以下步骤:
获取可移动的定位模块沿巡线路径环绕预定圈数的若干记录点,所述巡线路径为自移动机器人所在工作区域的边界形成的回路;所述预定圈数大于等于 2;
将行走第1圈对应的记录点存储于第一存储链表,将剩余的记录点存储于第二存储链表;
依次调取第一存储链表中的每一个记录点作为基础坐标点,并查询第二存储链表以依次选取对应每一基础坐标点的m个记录点组,每个记录点组包括与第一存储链表中当前选取的基础坐标点距离最近的多个记录点,且m个记录点组的记录点的数目依次递增;所述m为不小于1的整数;
根据每个基础坐标点及其对应的m个记录点组分别获取对应该基础坐标点的边界拟合点,并将多个所述边界拟合点的集合形成边界拟合点序列;
根据所述边界拟合点序列获得边界点;
将所述边界点依次连接生成工作区域的虚拟边界。
可选地,所述定位模块为手持装置,所述手持装置可拆卸装设第一UWB 定位模块,所述自移动机器人设置第二UWB定位模块;其中,
在自移动机器人进行边界学习的应用场景下,所述第一UWB定位模块装设于所述手持装置并沿巡线路径环绕,所述第一UWB定位模块为第一UWB定位标签;所述第二UWB定位模块为第二UWB定位基站,所述第二UWB定位基站位于预设基站位置处;
在自移动机器人进行定位导航的应用场景下,所述第一UWB定位模块自所述手持装置分离并位于预设基站位置处,所述第一UWB定位模块为第一 UWB定位基站,所述第二UWB定位模块为第二UWB定位标签并随所述自移动机器人移动。
可选地,在所述自移动机器人进行边界学习的应用场景下,所述第一UWB 定位标签侦测取样确认信号,并根据所述取样确认信号计算记录点的位置坐标,并将记录点的位置坐标发送给所述自移动机器人,其中,所述取样确认信号为手持装置沿巡线路径移动时所接收的第一按键信号。
可选地,在所述自移动机器人进行边界学习的应用场景下,所述生成方法在依次调取第一存储链表中的每一个记录点作为基础坐标点之前还包括以下步骤:
所述自移动机器人侦测所述取样完成信号,并根据所述取样完成信号执行依次调取第一存储链表中的每一个记录点作为基础坐标点,其中,所述取样完成信号为手持装置于巡线路径结束时接收的第二按键信号。
可选地,所述定位模块为可拆卸装设于自移动机器人的UWB定位插件,在自移动机器人进行边界学习的应用场景下,所述UWB定位插件用于充当可移动的定位模块沿巡线路径环绕;在自移动机器人进行定位导航的应用场景下,所述UWB定位插件装设于自移动机器人端。
可选地,所述第一UWB定位标签按照预定间隔时间或按照预定距离计算记录点的位置坐标,并将记录点的位置坐标发送给所述自移动机器人。
可选地,所述根据所述边界拟合点序列获得边界点进一步包括以下步骤:
判断边界拟合点序列中的任一边界拟合点与其相邻的两个边界拟合点是否共线,若是,则以当前边界拟合点为基础,并在通过当前边界拟合点的法线上等距偏移获取对应的边界点;将边界拟合点以及其相邻的两个边界拟合点生成圆,若否,则以当前边界拟合点为基础,并在通过当前边界拟合点与其所在圆的圆心连线上等距偏移获取对应的边界点。
本发明还提供一种自移动机器人工作区域虚拟边界的生成系统,所述系统包括:
记录存储模块,用于获取可移动的定位模块沿巡线路径环绕预定圈数的若干记录点,所述巡线路径为自移动机器人所在工作区域的边界形成的回路;所述预定圈数大于等于2;以及用于将行走第1圈对应的记录点存储于第一存储链表,将剩余的记录点存储于第二存储链表;
调取模块,用于依次调取第一存储链表中的每一个记录点作为基础坐标点,并查询第二存储链表以依次选取对应每一基础坐标点的m个记录点组,每个记录点组包括与第一存储链表中当前选取的基础坐标点距离最近的多个记录点,且m个记录点组的记录点的数目依次递增;所述m为大于1的整数;
拟合模块,用于根据每个基础坐标点及其对应的m个记录点组获取该基础坐标点的边界拟合点,并将多个所述边界拟合点的集合形成边界拟合点序列;
处理模块,用于根据所述边界拟合点序列获得边界点,并用于将所述边界点依次连接生成工作区域的虚拟边界。
本发明还提供一种自移动机器人,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现所述自移动机器人工作区域虚拟边界的生成方法的步骤。
本发明又提供一种可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现所述自移动机器人工作区域虚拟边界的生成方法的步骤。
相较于现有技术,本发明在自移动机器人进行边界学习的应用场景下,借由可移动的定位模块沿巡线路径环绕预定圈数以获取各个记录点的位置坐标,通过多次获取的记录点位置坐标自动校正以自动生成自移动机器人的虚拟边界;无需人工辅助输入相关参数,节省人力成本,提高工作效率。
附图说明
图1为本发明自移动机器人进行边界学习的第一应用场景,其中,手动控制手持装置获取记录点,记录点的位置包括直线边界的拐点及非直线边界的中间点位置;
图2为本发明自移动机器人根据工作区域的虚拟边界进行定位导航的第一应用场景;
图3为本发明自移动机器人进行边界学习的第二应用场景,其中,定时控制手持装置获取记录点;
图4为本发明自移动机器人进行边界学习的第三应用场景,其中,定时控制从自移动机器人端取下的UWB定位插件获取记录点;
图5为本发明自移动机器人工作区域虚拟边界的生成方法的第一实施例的流程图;
图6为本发明自移动机器人工作区域虚拟边界的生成方法的第二实施例的流程图;
图7为图5中步骤S4的具体流程图;
图8为图5中步骤S5的具体流程图;
图9为图8的一具体示例的应用效果图;
图10为本发明自移动机器人工作区域虚拟边界的生成系统的原理方框图。
具体实施方式
为了使本技术领域的人员更好地理解本发明中的技术方案,下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例仅仅是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都应当属于本发明保护的范围。
请参阅图1-图10所示,本发明自移动机器人30可以是自动割草机,或者自动吸尘器等,其自动行走于工作区域20以进行割草、吸尘等工作。所述自移动机器人30可通过可移动的定位模块与定位基站10获取工作区域20的记录点 201并自动生成工作区域20的虚拟边界,所述工作区域内部或者边缘布置至少三个带可充电电池的定位基站10,所述定位基站10可为UWB基站或Zigbee 基站等。所述可移动的定位模块可独立于自移动机器人30完成记录坐标位置与发送坐标位置的功能,例如,可为专用的手持装置40,或为可拆卸装设于自移动机器人30的UWB定位插件31。
在本发明的一个实施例中,手持装置40具有内置的第一UWB定位模块,或将其一定位基站10可拆卸装设于手持装置40以用于充当所述手持装置40的第一UWB定位模块,所述第一UWB定位模块用于记录坐标位置并发送坐标位置至自移动机器人30。本发明自移动机器人30设置第二UWB定位模块。根据不同的应用场景,切换所述第一UWB定位模块与第二UWB定位模块的使用状态。
请参阅图1所示,在自移动机器人30进行边界学习的应用场景下,所述用于充当第一UWB定位模块的定位基站10装设于所述手持装置40并沿巡线路径202环绕,所述第一UWB定位模块为第一UWB定位标签;所述第二UWB 定位模块为第二UWB定位基站,所述第二UWB定位基站(即自移动机器人 30)位于预设基站位置处(预设基站位置对应的基站用于充当所述手持装置40 的第一UWB定位模块)。
请参阅图2所示,在自移动机器人30进行定位导航的应用场景下,所述用于充当第一UWB定位模块的定位基站10自所述手持装置分离并位于预设基站位置处,所述用于充当第一UWB定位模块的定位基站10恢复成第一UWB定位基站,所述第二UWB定位模块为第二UWB定位标签并随所述自移动机器人 30移动。
手持装置40携带第一UWB定位标签移动以作为定位模块,可通过手动控制或定时控制方式计算定位标签的当前位置与定位基站(两个定位基站10及自移动机器人30的第二UWB定位模块)之间的距离以确定定位标签的坐标位置 (即记录点201)。
记录点201的获取方式具有多种,例如:手动控制获取、按照预定间隔时间获取、按照预定距离获取等方式,仅需保证记录点201位于机器人行走过程中所通过巡线路径202之上即可。
请参阅图1所示,手动控制手持装置40获取记录点201,记录点201的位置包括直线边界的拐点及非直线边界的中间点位置,在本发明的另一个实施例中,在所述自移动机器人进行边界学习的应用场景下,所述第一UWB定位标签侦测取样确认信号,并根据所述取样确认信号计算记录点201的位置坐标,并将记录点201的位置坐标发送给所述自移动机器人,其中,所述取样确认信号为手持装置40沿巡线路径202移动时所接收的第一按键信号,所述第一按键信号可为使用者手持装置40沿巡线路径202移动预设位置(直线边界的拐点及非直线边界的中间点)单次按压手持装置40上的确认键(未图示)而产生。使用者也可通过手机APP操作以产生第一按键信号。
请参阅图3所示,手持装置40可按照预定间隔时间获取、按照预定距离获取等方式自动获取记录点201的位置,在本发明的另一个实施例中,所述第一UWB定位标签按照预定间隔时间计算记录点201的位置坐标,并将记录点201的位置坐标发送给所述自移动机器人30。例如,预定间隔时间为50ms,此时,记录点201不再局限于拐点。
请参阅图4所示,在本发明的另一个实施例中,所述定位模块为可拆卸装设于自移动机器人30的UWB定位插件31,在自移动机器人30进行边界学习的应用场景下,所述UWB定位插件31从自移动机器人30分离并用于手持使用;在自移动机器人进行定位导航的应用场景下,所述UWB定位插件31 插设于自移动机器人端。
请参阅图5所示,手持装置40或自移动机器人30沿巡线路径202行走,可通过多圈巡行的方式获取记录点201的位置坐标。本发明提供一种自移动机器人工作区域虚拟边界的生成方法,其包括以下步骤:
S1、获取可移动的定位模块沿巡线路径环绕预定圈数的若干记录点,所述巡线路径为自移动机器人所在工作区域的边界形成的回路;所述预定圈数大于等于2;
S2、将行走第1圈对应的记录点存储于第一存储链表,将剩余的记录点存储于第二存储链表;
S3、依次调取第一存储链表中的每一个记录点作为基础坐标点,并查询第二存储链表以依次选取对应每一基础坐标点的m个记录点组,每个记录点组包括与第一存储链表中当前选取的基础坐标点距离最近的多个记录点,且m个记录点组的记录点的数目依次递增;所述m为不小于1的整数;
S4、根据每个基础坐标点及其对应的m个记录点组分别获取对应该基础坐标点的边界拟合点,并将多个所述边界拟合点的集合形成边界拟合点序列;
S5、根据所述边界拟合点序列获得边界点;
S6、将所述边界点依次连接生成工作区域的虚拟边界。
需要说明的是,根据工作环境的不同,所述虚拟边界可选择地包括外边界和/或内边界;巡线路径通常由用户辅助指定,或是采用定点标记、外设磁场的方式指定,该巡线路径为工作区域的边界形成的回路,当界定工作区域在某一边界之内时,该边界为外边界,即外边界为工作区域最外侧的边界,其具有唯一性;当同时界定工作区域在某一边界之外时,该边界为内边界,内边界和外边界相互配合以限定工作区域。所述预定圈数越大,则最终获得的结果更加精准,本发明较佳实施方式中,考虑到计算的复杂程度,所述预定圈数通常取值 2至5之间的任一数值。
可以理解的是,对于同一工作区域,手持装置40或自移动机器人30沿巡线路径行走预定圈数过程中,其每圈的巡线路径形状基本相同但通常不会完全相同,每圈获取的记录点的数目可能相等也可能不等。
请参阅图6所示,在本发明的另一个实施例中,手持装置40可产生取样完成信号并发送给自移动机器人30,在所述自移动机器人进行边界学习的应用场景下,所述生成方法在步骤S2与步骤S3之间还包括以下步骤:
S21、所述自移动机器人侦测取样完成信号,并根据所述取样完成信号执行步骤S3,其中,所述取样完成信号为手持装置于巡线路径结束时接收的第二按键信号。所述第二按键信号可为使用者于巡线路径的拐点位置双击手持装置上的确认键而产生。
此外,也可通过自移动机器人自动判断是否完成取样,S2与步骤S3之间还包括以下步骤:自移动机器人判断首、尾记录点之间的直线距离是否小于第一预设距离阈值,若是,执行步骤S3;若否,返回执行步骤S1。
所述第一预设距离阈值为一距离常数值,其大小可以根据需要具体设定,当工作区域的面积较大时,其数值也可设定较大,当其数值较小时,其数值也可设定较小;当然,无论工作区域的面积大小,其数值较小时,其获得的结果更加精准。例如:本发明一具体示例中,可将该第一距离阈值设定为0.3m。
请参阅图7所示,在本发明的另一个实施例中,所述步骤S4具体包括以下步骤:
S41、分别获取每个记录点组的重心点;这里的重心点是指将记录点组中的每个点看做质点后,这个质点系的重心点,也即到记录点组中的每个点的距离的平方和最小的点为该记录点组的重心点。
S42、分别获取每个记录点组对应所述重心点的切线和法线,所述切线为当前记录点组包含的所有记录点通过最小二乘法拟合所得到的直线,所述法线为经过所述重心点且垂直于当前切线的直线;
S43、分别获取每个基础坐标点对应的m个偏心率,所述偏心率表示基础坐标点与其对应的每个重心点的偏离程度;
S44、获取当前基础坐标点对应的m个偏心率中的最大偏心率,以最大偏心率对应的重心点作为当前基础坐标点对应的边界拟合点。
作为一个特例,当m=1时,步骤S4仅包括:S41’、分别获取每个记录点组的重心点;S42’、以该重心点作为当前基础坐标点对应的边界拟合点。
为了便于理解,描述一具体示例供参考;假设预定圈数为5圈,每圈涉及的记录点均为10个,则存储于第一存储链表的记录点、即基础坐标点为100个,其分别为P1、P2、……、P100,存储于第二存储链表的记录点为400个;m的取值为20,为保证对应于每个基础坐标点的m个记录点组中的每个记录点组包含的记录点数目依次递增,则设定20个记录点组包括的与第一存储链表中当前选取基础坐标点距离最近的记录点依次为n,n+1,……,n+(m-1),假设n取值为15,则第1个记录点组包含的记录点依次表示为P21、P22、……、P215,第 2个记录点组包含的记录点依次表示为P21、P22、……、P215、P216,第m个记录点组包含的记录点依次表示为P21、P22、……、P215、P216、……、P234。
通过以上内容可知:在第一存储链表中取P1作为基础坐标点,在第二存储链表中取距离P1最近的n个记录点P21、P22、……、P2n构成第一个记录点组,且n=15;通过重心点计算公式可获得第一个记录点组的重心坐标为PEmp1(xEmp1,yEmp1),并进一步获得通过PEmp1的切线和法线,所述切线为P21、 P22、……、P2n通过最小二乘法拟合所得到的直线,所述法线为经过所述重心点且垂直于当前切线的直线;进一步的,通过公式获得P1点对应的偏心率,a、b分别表示当前基础坐标点距离切线和距离法线的距离;进一步的,重复上述步骤,对于P1点分别对应的m个记录点组,分别获得对应于P1 的m个偏心率;并获得m个偏心率中的最大偏心率,以最大偏心率对应的重心点作为当前基础坐标点对应的边界拟合点;进一步的,根据每个基础坐标点对应的m个记录点组获取每个基础坐标点对应的边界拟合点,并将所述边界拟合点的集合形成边界拟合点序列。
请参阅图8所示,在本发明的另一个实施例中,所述步骤S5进一步包括以下步骤:
S51、判断边界拟合点序列中的任一边界拟合点与其相邻的两个边界拟合点是否共线,若是,则执行步骤S52;若否,则执行步骤S53;
S52、以当前边界拟合点为基础,并在通过当前边界拟合点的法线上等距偏移获取对应的边界点;将边界拟合点以及其相邻的两个边界拟合点生成圆;
S53、以当前边界拟合点为基础,并在通过当前边界拟合点与其所在圆的圆心连线上等距偏移获取对应的边界点。
若边界包括为外边界和内边界,所述步骤S5具体包括:以外边界对应的边界拟合点为基础,向外等距偏移获得对应的外边界点;以内边界对应的边界拟合点为基础,向内等距偏移获得对应的内边界点。
所述等距偏移表示每个边界点向外偏移或向内偏移的偏移值相同,本发明较佳实施方式中,当机器人为割草机器人时,所述偏移值通常不大于机器人上刀盘的直径。
可以理解的是,在本发明的具体实施方式中,若边界包括外边界和内边界,则采用上述方法对外边界和内边界分别进行处理;即通过对应外边界获得的记录点,获取外边界对应的外边界拟合点,在根据对应的外边界拟合点获取所需的外边界点;通过对应内边界获得的记录点,获取内边界对应的外边界拟合点,在根据对应的内边界拟合点获取所需的内边界点;当然,外边界点的获取和内边界点的获取可以交叉进行,在此不做详细赘述。进一步的,当边界包括外边界和内边界时,通常先处理外边界,再处理内边界,以避免重复工作,在此不做继续赘述。
为了便于理解,描述一具体示例供参考,如图9所示,对应于外边界获得的相邻的三个外边界拟合点分别为Q0、Q1、Q2,其中,Q1、Q2分置于Q0两侧,且三个外边界拟合点不共线,如此,以Q0、Q1、Q2为同一圆上的三个坐标成圆,其圆心为C,则Q0与圆心C的连线方向为偏移方向,进一步的,本实施方式中,由于三个边界拟合点对应于外边界,如此,在Q0与圆心C的连线方向上向外偏移形成外边界点。
在本发明的另一个实施例中,在步骤S6之后,自移动机器人进一步对虚拟边界进行优化处理,所述优化处理包括在圆弧或圆上采用的点用拟合圆弧或圆替代,并取得优化后的虚拟边界。
请参阅图10所示,本发明还提供一种自移动机器人工作区域虚拟边界的生成系统,所述系统包括:
记录存储模块100,用于获取可移动的定位模块沿巡线路径环绕预定圈数的若干记录点,所述巡线路径为自移动机器人所在工作区域的边界形成的回路;所述预定圈数大于等于2;以及用于将行走第1圈对应的记录点存储于第一存储链表,将剩余的记录点存储于第二存储链表;
调取模块200,用于依次调取第一存储链表中的每一个记录点作为基础坐标点,并查询第二存储链表以依次选取对应每一基础坐标点的m个记录点组,每个记录点组包括与第一存储链表中当前选取的基础坐标点距离最近的多个记录点,且m个记录点组的记录点的数目依次递增;所述m为大于1的整数;
拟合模块300,用于根据每个基础坐标点及其对应的m个记录点组获取该基础坐标点的边界拟合点,并将多个所述边界拟合点的集合形成边界拟合点序列;
处理模块400,用于根据所述边界拟合点序列获得边界点,并用于将所述边界点依次连接生成工作区域的虚拟边界。
本发明又提供一种自移动机器人,包括存储器和处理器,所述存储器存储有计算机程序,所述处理器执行所述计算机程序时实现所述自移动机器人工作区域虚拟边界的生成方法的步骤。
本发明又提供一种可读存储介质,其上存储有计算机程序,所述计算机程序被处理器执行时实现所述自移动机器人工作区域虚拟边界的生成方法的步骤。
综上所述,本发明在自移动机器人进行边界学习的应用场景下,借由可移动的定位模块沿巡线路径环绕预定圈数以获取各个记录点的位置坐标,通过多次获取的记录点位置坐标自动校正以自动生成自移动机器人的虚拟边界;无需人工辅助输入相关参数,节省人力成本,提高工作效率。
此外,应当理解,虽然本说明书按照实施方式加以描述,但并非每个实施方式仅包含一个独立的技术方案,说明书的这种叙述方式仅仅是为清楚起见,本领域技术人员应当将说明书作为一个整体,各实施方式中的技术方案也可以经适当组合,形成本领域技术人员可以理解的其他实施方式。
上文所列出的一系列的详细说明仅仅是针对本发明的可行性实施方式的具体说明,并非用以限制本发明的保护范围,凡未脱离本发明技艺精神所作的等效实施方式或变更均应包含在本发明的保护范围之内。
Claims (10)
1.一种自移动机器人工作区域虚拟边界的生成方法,其特征在于,所述方法包括以下步骤:
获取可移动的定位模块沿巡线路径环绕预定圈数的若干记录点,所述巡线路径为自移动机器人所在工作区域的边界形成的回路;所述预定圈数大于等于2;
将行走第1圈对应的记录点存储于第一存储链表,将剩余的记录点存储于第二存储链表;
依次调取第一存储链表中的每一个记录点作为基础坐标点,并查询第二存储链表以依次选取对应每一基础坐标点的m个记录点组,每个记录点组包括与第一存储链表中当前选取的基础坐标点距离最近的多个记录点,且m个记录点组的记录点的数目依次递增;所述m为不小于1的整数;
根据每个基础坐标点及其对应的m个记录点组分别获取对应该基础坐标点的边界拟合点,并将多个所述边界拟合点的集合形成边界拟合点序列;
根据所述边界拟合点序列获得边界点;
将所述边界点依次连接生成工作区域的虚拟边界。
2.根据权利要求1所述的自移动机器人工作区域虚拟边界的生成方法,其特征在于,所述定位模块为手持装置,所述手持装置可拆卸装设第一UWB定位模块,所述自移动机器人设置第二UWB定位模块;其中,
在自移动机器人进行边界学习的应用场景下,所述第一UWB定位模块装设于所述手持装置并沿巡线路径环绕,所述第一UWB定位模块为第一UWB定位标签;所述第二UWB定位模块为第二UWB定位基站,所述第二UWB定位基站位于预设基站位置处;
在自移动机器人进行定位导航的应用场景下,所述第一UWB定位模块自所述手持装置分离并位于预设基站位置处,所述第一UWB定位模块为第一UWB定位基站,所述第二UWB定位模块为第二UWB定位标签并随所述自移动机器人移动。
3.根据权利要求2所述的自移动机器人工作区域虚拟边界的生成方法,其特征在于,在所述自移动机器人进行边界学习的应用场景下,所述第一UWB定位标签侦测取样确认信号,并根据所述取样确认信号计算记录点的位置坐标,并将记录点的位置坐标发送给所述自移动机器人,其中,所述取样确认信号为手持装置沿巡线路径移动时所接收的第一按键信号。
4.根据权利要求2所述的自移动机器人工作区域虚拟边界的生成方法,其特征在于,在所述自移动机器人进行边界学习的应用场景下,所述生成方法在依次调取第一存储链表中的每一个记录点作为基础坐标点之前还包括以下步骤:
所述自移动机器人侦测所述取样完成信号,并根据所述取样完成信号执行依次调取第一存储链表中的每一个记录点作为基础坐标点,其中,所述取样完成信号为手持装置于巡线路径结束时接收的第二按键信号。
5.根据权利要求1所述的自移动机器人工作区域虚拟边界的生成方法,其特征在于,所述定位模块为可拆卸装设于自移动机器人的UWB定位插件,在自移动机器人进行边界学习的应用场景下,所述UWB定位插件用于充当可移动的定位模块沿巡线路径环绕;在自移动机器人进行定位导航的应用场景下,所述UWB定位插件装设于自移动机器人端。
6.根据权利要求1所述的自移动机器人工作区域虚拟边界的生成方法,其特征在于,所述第一UWB定位标签按照预定间隔时间或按照预定距离计算记录点的位置坐标,并将记录点的位置坐标发送给所述自移动机器人。
7.根据权利要求1所述的自移动机器人工作区域虚拟边界的生成方法,其特征在于,所述根据所述边界拟合点序列获得边界点进一步包括以下步骤:
判断边界拟合点序列中的任一边界拟合点与其相邻的两个边界拟合点是否共线,若是,则以当前边界拟合点为基础,并在通过当前边界拟合点的法线上等距偏移获取对应的边界点;将边界拟合点以及其相邻的两个边界拟合点生成圆,若否,则以当前边界拟合点为基础,并在通过当前边界拟合点与其所在圆的圆心连线上等距偏移获取对应的边界点。
8.一种自移动机器人工作区域虚拟边界的生成系统,其特征在于,所述系统包括:
记录存储模块,用于获取可移动的定位模块沿巡线路径环绕预定圈数的若干记录点,所述巡线路径为自移动机器人所在工作区域的边界形成的回路;所述预定圈数大于等于2;以及用于将行走第1圈对应的记录点存储于第一存储链表,将剩余的记录点存储于第二存储链表;
调取模块,用于依次调取第一存储链表中的每一个记录点作为基础坐标点,并查询第二存储链表以依次选取对应每一基础坐标点的m个记录点组,每个记录点组包括与第一存储链表中当前选取的基础坐标点距离最近的多个记录点,且m个记录点组的记录点的数目依次递增;所述m为大于1的整数;
拟合模块,用于根据每个基础坐标点及其对应的m个记录点组获取该基础坐标点的边界拟合点,并将多个所述边界拟合点的集合形成边界拟合点序列;
处理模块,用于根据所述边界拟合点序列获得边界点,并用于将所述边界点依次连接生成工作区域的虚拟边界。
9.一种自移动机器人,包括存储器和处理器,所述存储器存储有计算机程序,其特征在于,所述处理器执行所述计算机程序时实现权利要求1-7中任一项所述自移动机器人工作区域虚拟边界的生成方法的步骤。
10.一种可读存储介质,其上存储有计算机程序,其特征在于,所述计算机程序被处理器执行时实现权利要求1-7中任一项所述自移动机器人工作区域虚拟边界的生成方法的步骤。
Priority Applications (4)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010329608.4A CN113556679A (zh) | 2020-04-24 | 2020-04-24 | 自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质 |
US17/768,577 US20240103545A1 (en) | 2020-04-24 | 2020-09-17 | Method and System for Generating Virtual Boundary of Working Area of Autonomous Mobile Robot, and Autonomous Mobile Robot and Readable Storage Medium |
PCT/CN2020/115900 WO2021212731A1 (zh) | 2020-04-24 | 2020-09-17 | 自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质 |
EP20931818.7A EP4142311A4 (en) | 2020-04-24 | 2020-09-17 | METHOD AND SYSTEM FOR GENERATING A VIRTUAL WORK AREA BOUNDARY OF AN AUTONOMOUS MOBILE ROBOT, AND AUTONOMOUS MOBILE ROBOT AND READABLE STORAGE MEDIUM |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010329608.4A CN113556679A (zh) | 2020-04-24 | 2020-04-24 | 自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113556679A true CN113556679A (zh) | 2021-10-26 |
Family
ID=78129479
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010329608.4A Pending CN113556679A (zh) | 2020-04-24 | 2020-04-24 | 自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质 |
Country Status (4)
Country | Link |
---|---|
US (1) | US20240103545A1 (zh) |
EP (1) | EP4142311A4 (zh) |
CN (1) | CN113556679A (zh) |
WO (1) | WO2021212731A1 (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP4270138A1 (en) * | 2022-04-28 | 2023-11-01 | Techtronic Cordless GP | Creation of a virtual boundary for a robotic garden tool |
CN115618650B (zh) * | 2022-11-15 | 2023-04-28 | 中国电子科技集团公司第十研究所 | 一种修正球面相控阵天线的虚拟球心位置坐标的方法 |
CN116188480B (zh) * | 2023-04-23 | 2023-07-18 | 安徽同湃特机器人科技有限公司 | 喷涂机器人天花板作业时agv行进路径点的计算方法 |
CN116841300B (zh) * | 2023-08-31 | 2023-12-19 | 未岚大陆(北京)科技有限公司 | 工作地图生成方法、作业方法、控制方法和相关装置 |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101960443A (zh) * | 2008-03-20 | 2011-01-26 | 迪尔公司 | 用于产生工作区的内边界的系统和方法 |
WO2016045617A1 (zh) * | 2014-09-26 | 2016-03-31 | 科沃斯机器人有限公司 | 自移动机器人移动界限划定方法 |
CN106127677A (zh) * | 2016-06-22 | 2016-11-16 | 山东理工大学 | 基于局部样本投影轮廓形状的实物表面采样点集边界特征识别方法 |
CN109032147A (zh) * | 2018-09-10 | 2018-12-18 | 扬州方棱机械有限公司 | 基于卫星定位信号生成割草机器人虚拟边界的方法 |
CN109085835A (zh) * | 2018-08-28 | 2018-12-25 | 扬州方棱机械有限公司 | 一种生成割草工作区域虚拟边界的方法 |
Family Cites Families (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
KR101626984B1 (ko) * | 2009-11-16 | 2016-06-02 | 엘지전자 주식회사 | 로봇 청소기 및 이의 제어 방법 |
US9764472B1 (en) * | 2014-07-18 | 2017-09-19 | Bobsweep Inc. | Methods and systems for automated robotic movement |
CN108267752B (zh) * | 2016-12-15 | 2022-01-18 | 苏州宝时得电动工具有限公司 | 自移动设备的工作区域的分区方法、装置和电子设备 |
EP3413155B1 (de) * | 2017-06-09 | 2020-02-26 | Andreas Stihl AG & Co. KG | Verfahren zum erfassen mindestens eines abschnitts eines begrenzungsrands einer zu bearbeitenden fläche, verfahren zum betreiben eines autonomen mobilen grünflächenbearbeitungsroboters, erfassungssystem und grünflächenbearbeitungssystem |
CN111185899B (zh) * | 2018-11-14 | 2022-05-13 | 苏州科瓴精密机械科技有限公司 | 机器人控制方法及机器人系统 |
-
2020
- 2020-04-24 CN CN202010329608.4A patent/CN113556679A/zh active Pending
- 2020-09-17 US US17/768,577 patent/US20240103545A1/en active Pending
- 2020-09-17 EP EP20931818.7A patent/EP4142311A4/en active Pending
- 2020-09-17 WO PCT/CN2020/115900 patent/WO2021212731A1/zh active Application Filing
Patent Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101960443A (zh) * | 2008-03-20 | 2011-01-26 | 迪尔公司 | 用于产生工作区的内边界的系统和方法 |
WO2016045617A1 (zh) * | 2014-09-26 | 2016-03-31 | 科沃斯机器人有限公司 | 自移动机器人移动界限划定方法 |
CN106127677A (zh) * | 2016-06-22 | 2016-11-16 | 山东理工大学 | 基于局部样本投影轮廓形状的实物表面采样点集边界特征识别方法 |
CN109085835A (zh) * | 2018-08-28 | 2018-12-25 | 扬州方棱机械有限公司 | 一种生成割草工作区域虚拟边界的方法 |
CN109032147A (zh) * | 2018-09-10 | 2018-12-18 | 扬州方棱机械有限公司 | 基于卫星定位信号生成割草机器人虚拟边界的方法 |
Also Published As
Publication number | Publication date |
---|---|
US20240103545A1 (en) | 2024-03-28 |
EP4142311A1 (en) | 2023-03-01 |
WO2021212731A1 (zh) | 2021-10-28 |
EP4142311A4 (en) | 2024-05-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN113556679A (zh) | 自移动机器人工作区域虚拟边界的生成方法、系统、自移动机器人及可读存储介质 | |
CN109998428B (zh) | 用于扫地机器人的清洁方法、系统及装置 | |
US10562177B2 (en) | System with at least two floor processing fixtures | |
CN111185899B (zh) | 机器人控制方法及机器人系统 | |
JP2884816B2 (ja) | 移動ロボットシステムにおける制御方法 | |
AU2019278049A1 (en) | Route planning method for mobile vehicle | |
CN108988403B (zh) | 自主充电系统、自主移动设备以及充电桩 | |
CN111399524B (zh) | 机器人清扫方法及机器人 | |
CN114353801B (zh) | 自移动设备及其导航方法 | |
CN108415428A (zh) | 一种移动机器人的全局路径优化方法 | |
CN108803602B (zh) | 障碍物自学习方法及新障碍物自学习方法 | |
Biglarbegian et al. | Path planning for data collectors in precision agriculture WSNs | |
JP2023071592A (ja) | カバレッジ経路計画のための自律移動ロボット | |
CN107305385B (zh) | 自动行走设备的对接方法及自动行走设备 | |
EP4270136A1 (en) | Smart mowing system | |
JP2022064681A (ja) | 経路設定装置、経路設定方法、記憶媒体及びプログラム | |
CN211698708U (zh) | 自动工作系统 | |
CN112947424B (zh) | 配网作业机器人自主作业路径规划方法和配网作业系统 | |
CN114532898B (zh) | 机器人的建图方法、机器人、存储介质、电子装置 | |
CN211558013U (zh) | 割草机器人及具有其的割草机器人系统 | |
CN114637287A (zh) | 路径生成方法、装置、机器人及计算机可读存储介质 | |
EP4148525A1 (en) | Method and apparatus for docking self-moving device to charging station, and self-moving device and readable storage medium | |
CN112558597B (zh) | 自移动设备 | |
WO2020256619A1 (en) | Control signal sensing for a robotic working tool | |
WO2023124625A1 (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 | ||
TA01 | Transfer of patent application right |
Effective date of registration: 20230609 Address after: 215000 No. 8 Ting Rong Street, Suzhou Industrial Park, Jiangsu, China Applicant after: Suzhou Cleva Precision Machinery & Technology Co.,Ltd. Applicant after: SKYBEST ELECTRIC APPLIANCE (SUZHOU) Co.,Ltd. Address before: No.18, Huahong street, Suzhou Industrial Park, Suzhou, Jiangsu Province, 215000 Applicant before: Suzhou Cleva Precision Machinery & Technology Co.,Ltd. |
|
TA01 | Transfer of patent application right |