CN111198557A - 行走机器人的控制方法及控制系统 - Google Patents

行走机器人的控制方法及控制系统 Download PDF

Info

Publication number
CN111198557A
CN111198557A CN201811410347.8A CN201811410347A CN111198557A CN 111198557 A CN111198557 A CN 111198557A CN 201811410347 A CN201811410347 A CN 201811410347A CN 111198557 A CN111198557 A CN 111198557A
Authority
CN
China
Prior art keywords
point
walking robot
narrow area
starting
perimeter
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
CN201811410347.8A
Other languages
English (en)
Other versions
CN111198557B (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.)
Suzhou Cleva Precision Machinery and Technology Co Ltd
Original Assignee
Suzhou Cleva Precision Machinery and 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 Suzhou Cleva Precision Machinery and Technology Co Ltd filed Critical Suzhou Cleva Precision Machinery and Technology Co Ltd
Priority to PCT/CN2019/114040 priority Critical patent/WO2020088461A1/zh
Priority to PCT/CN2019/114029 priority patent/WO2020088460A1/zh
Publication of CN111198557A publication Critical patent/CN111198557A/zh
Application granted granted Critical
Publication of CN111198557B publication Critical patent/CN111198557B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

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/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/0212—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory
    • G05D1/0214—Control of position or course in two dimensions specially adapted to land vehicles with means for defining a desired trajectory in accordance with safety or protection criteria, e.g. avoiding hazardous areas

Landscapes

  • Engineering & Computer Science (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Aviation & Aerospace Engineering (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：将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域，以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域；S4：根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值；所述出发点设置在所述巡线路径上，且每个所述非狭窄区域中包括至少一个所述出发点；所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值；S5：在达到预设条件之前，仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式，且禁止所述行走机器人进入所述狭窄区域。
作为本发明一具体实施方式的优选方案，所述初始点设置在基站位置。
作为本发明一具体实施方式的优选方案，所述预设条件为累计工作时长、累计工作行走的路程、电池包的电量中的至少一种。
作为本发明一具体实施方式的优选方案，所述方法还包括：S21：向边界线发射信号，以在所述边界线周围产生电磁信号；S22：驱动所述行走机器人沿巡线路径的延伸方向行走过程中，记录行走机器人实际接收到电磁信号的强度；S23：根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。
作为本发明一具体实施方式的优选方案，“根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值”具体包括：S41：获取狭窄区域与非狭窄区域之间形成的临界点，以及各个临界点对应的位置值；其中，沿巡线路径的延伸方向，形成的临界点顺序为临界点P1、临界点P2、临界点P3、临界点P4，各个临界点对应的位置值依次为LP1、LP2、LP3、LP4；S42：根据各个临界点对应的位置值获取各个非狭窄区域的周长；或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长；S43：根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。
作为本发明一具体实施方式的优选方案，“根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长”具体包括：判断所述初始点是否在当前非狭窄区域上，若是，则当前非狭窄区域的周长lA＝lsum-(LP4-LP1)；若否，则当前非狭窄区域的周长lA＝LP3-LP2，其中，lsum表示巡线路径的周长，lA表示当前非狭窄区域的周长。
作为本发明一具体实施方式的优选方案，“根据各个临界点对应的位置值获取各个非狭窄区域的周长”具体包括：采用累加算法获得各个非狭窄区域的周长，即判断所述初始点是否在当前非狭窄区域上，若是，沿巡线路径的延伸方向，自初始点开始累加当前非狭窄区域的周长，并在到达临界点P1时，停止累加当前非狭窄区域的周长，当到达临界点P4时，继续累加当前非狭窄区域的周长，直至返回至初始点；若否，当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P2至临界点P3之间的长度。
作为本发明一具体实施方式的优选方案，“根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值”具体包括：S431：依照非狭窄区域的周长lA获得起始点S的位置值LS、终点E的位置值LE和沿巡线路径从起始点S到终点E之间的出发区间的线长lSE；所述出发区间为依照巡线路径行走的轨迹，出发点均在所述出发区间内选取；则lSE＝LE-LS，LS＝x·lA，LE＝y·lA，lSE≤lA，其中，x<y，x∈[0,1)，y∈(0,1]；S432：在出发区间内选取至少1个出发点。
作为本发明一具体实施方式的优选方案，所述方法还包括：判断所述初始点是否处于当前非狭窄区域上，若是，则将初始点设置为当前非狭窄区域的起始点S；若否，则将临界点P3设置为当前非狭窄区域的起始点S。
作为本发明一具体实施方式的优选方案，所述方法具体包括：将出发区间划分为多个子区间；分别在每个子区间中选取对应于该子区间的至少1个出发点。
作为本发明一具体实施方式的优选方案，“将出发区间划分为多个子区间”具体包括：将出发区间按照有序数列划分为多个子区间。
作为本发明一具体实施方式的优选方案，“将出发区间按照有序数列划分为多个子区间”具体包括：将出发区间按照有序数列划分为多个子区间，使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、斐波那契数列、分群数列、周期数列、阶差数列至少其中之一。
作为本发明一具体实施方式的优选方案，“在出发区间内选取至少1个出发点”具体包括：在出发区间内按照随机或伪随机的方式获得至少1个出发点。
作为本发明一具体实施方式的优选方案，所述方法具体包括：在出发区间内，自起始点S的位置值LS开始，按照第一预设长度选取第一出发区间，并在该第一出发区间内随机选定第1个出发点；依次以选定的出发点为起始点，按照第二预设长度划分至少1个第二出发区间，并在该第二出发区间内随机选定下一个出发点，直至遍历整个出发区间。
作为本发明一具体实施方式的优选方案，所述方法还包括：自动获取当前巡线路径中各个出发点对应的频数值；所述频数值为所述行走机器人在同一出发点连续出发的次数。
作为本发明一具体实施方式的优选方案，所述方法还包括：在预设频数阈值范围内，配置每个出发点的频数值相等；或在预设频数阈值范围内，按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配置各个出发点对应的频数值；或在预设频数阈值范围内，对各个出发点随机配置任一频数值。
作为本发明一具体实施方式的优选方案，所述方法还包括：实时获取行走机器人的状态属性，所述状态属性包括：电池包的电量、连续工作时长以及连续工作行走的路程至少其中之一；若行走机器人电池包的电量小于预设电量阈值，和/或连续工作时长大于预设的工作时长阈值，和/或连续行走的路程大于预设的连续行走的路程阈值，则驱动所述行走机器人返回至所述基站。
作为本发明一具体实施方式的优选方案，当所述行走机器人达到预设情况时，重新确定出发点的位置值和/或频数值。
为了实现上述发明目的另一，本发明一实施方式提供一种行走机器人的控制系统，所述系统包括：配置模块，用于提供一闭合的巡线路径，所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路；巡查模块，用于驱动所述行走机器人从初始点出发、沿巡线路径行走一周，记录巡线路径的周长以及确认巡线路径上狭窄通道的位置；区域划分模块，用于将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域，以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域；控制处理模块，用于根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值；所述出发点设置在所述巡线路径上，且每个所述非狭窄区域中包括至少一个所述出发点；所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值；在达到预设条件之前，仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入工作状态，且禁止所述行走机器人进入所述狭窄区域。
与现有技术相比，本发明行走机器人的控制方法及控制系统，对于具有狭窄通道的工作空间，自动对工作区域进行划分，以形成狭窄区域和非狭窄区域，并使行走机器人在工作过程中，根据需要自由穿过狭窄区域以遍历每个非狭窄区域，进而提升行走机器人在工作区间内的遍历性，提高工作效率。
附图说明
图1是本发明一实施方式中行走机器人的结构示意图；
图2是本发明一实施方式中行走机器人的控制方法的流程示意图；
图3是本发明一实施方式中工作区域中狭窄通道判断方法的流程示意图；
图4是本发明一实施方式中获取任一非狭窄区域中各个出发点对应的位置值的流程示意图；
图5、图6分别是本发明在具体应用环境下的具体示例的效果图；
图7是本发明一实施方式中出发点选取方法的流程示意图；
图8是本发明一具体示例中行走机器人行走路线的结构示意图；
图9是本发明一实施方式中行走机器人的控制系统的模块示意图；
图10是本发明一实施方式中行走机器人的控制系统的工作流程示意图。
具体实施方式
以下将结合附图所示的各实施方式对本发明进行详细描述。但这些实施方式并不限制本发明，本领域的普通技术人员根据这些实施方式所做出的结构、方法、或功能上的变换均包含在本发明的保护范围内。
本发明的行走机器人可以是自动割草机，或者自动吸尘器等，其自动行走于工作区域以进行割草、吸尘工作，本发明具体示例中，以行走机器人为割草机为例做具体说明，相应的，所述工作区域可为草坪。
如图1所示，在本发明的一较佳实施方式提供一种行走机器人，所述行走机器人包括：本体10，设置于本体10上的行走单元、控制单元；以及供行走机器人停靠并充电的基站。
所述基站连接一沿工作区域的周侧布置的边界线，基站向边界线发射脉冲编码信号时，该脉冲编码信号在边界线内传输，以在边界线附近形成磁场并产生电磁信号。
所述行走单元包括：主动轮21、被动轮23以及用于驱动主动轮21的电机25；所述电机25可为带减速箱的无刷电机；电机25启动后，可通过减速箱带动主动轮21行走，并控制主动轮21的转速，进一步的，配合主动轮21调整，带动整个行走机器人实现前进、后推、转弯等动作。所述被动轮23可为万向轮，其主要起支撑平衡的作用。
所述控制单元至少包括：状态传感器，用于获取行走机器人沿巡线路径行走过程中获得的各种信息，例如：获取巡线路径上的电磁信号强度；在本具体实施方式中，状态传感器包括边界线传感器，以下内容中将会详细描述；数据存储器，用于存储机器行走机器人沿巡线路径行走过程中获得的各种信息，所述数据存储器例如：EPROM、Flash或SD卡等。行走机器人沿巡线路径行走过程中获得的各种信息有多种，以下内容中将会进一步的详细描述。
由于基站沿边界线发射脉冲编码信号，以在边界线附近形成电磁信号，故，控制单元可根据边界线附近电磁信号的强弱变化以及其通过状态传感器获取到的边界线内外信号的差异来控制电机运行，从而使行走机器人始终沿边界线运行或沿距离边界线具有等距的边界线内或外运行。
所述行走机器人还包括：用于工作的工作机构，在本实施例中，工作机构为割草刀盘，用于感应行走机器人的行走状态的各种传感器，例如：倾倒、离地、碰撞传感器等，在此不做具体赘述。
本发明的具体应用环境中，所述工作区域(草坪)可能为一整块非狭窄区域，也可能是由至少一个狭窄通道形成的至少一个狭窄区域、以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域。
结合图2所示，本发明一较佳实施提供的行走机器人的控制方法，所述方法包括：
S1、提供一呈闭合的巡线路径，所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路。
S2、驱动所述行走机器人从初始点出发、沿巡线路径行走一周，记录巡线路径的周长以及确认巡线路径上狭窄通道的位置。
本发明一较佳实施方式中，为行走机器人至少配置一巡线模式和一作业模式；巡线模式下，可以驱动所述行走机器人从初始点出发、沿巡线路径行走一周，记录所述巡线路径的周长、行走机器人实际接收到电磁信号的强度等。巡线模式下，还可以驱动所述行走机器人从初始点出发、沿巡线路径到达特定出发点后进入作业模式。作业模式下，可以驱动行走机器人在工作区域内沿直线或曲线行走并割草，当行走机器人达到特定姿态(如遇到边界线)时朝向进入工作区域内部的方向转向。作业模式下，还可以驱动行走机器人沿边界线行走并割草。
本发明一可实现方式中，所述状态传感器还包括：里程传感器，用于记录巡线路径的周长，即行走机器人的行驶距离；所述里程传感器也可为里程计、惯性传感器、霍尔或光电传感器等。
本发明较佳实施方式中，结合图3所示，所述步骤S2具体包括：S21、沿巡线路径发射脉冲编码信号，以在所述巡线路径上产生电磁信号；S22、驱动所述行走机器人沿巡线路径的延伸方向行走过程中，记录行走机器人实际接收到电磁信号的强度；S23、根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。
本发明较佳实施方式中，通过边界线传感器检测行走机器人上实际接收到的电磁信号。
本发明一较佳实施方式中，沿行走机器人的中线对称设置一对边界线传感器，行走机器人沿巡线路径行走过程中，一对边界线传感器分别检测巡线路径两侧的电磁信号强度；所述狭窄区域因为相对边界线产生的磁场叠加而使狭窄区域之间的磁场强度加强，使狭窄区域外侧的磁场强度减弱，如此，可将两个边界线传感器实际接收到电磁信号强度与发射脉冲编号信号产生的电磁强度进行对比，或根据两个边界线传感器实际接收到的电磁信号强度的变化，确认狭窄区域的位置及范围。
在确认存在狭窄通道后，所述方法还包括：S3、将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域，以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域。
需要说明的是，若确认不存在狭窄通道，则直接在当前巡线路径形成的工作区域完成工作。
S4、根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值；所述出发点设置在所述巡线路径上，且每个所述非狭窄区域中包括至少一个所述出发点；所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值。行走机器人从初始点出发，以巡线模式沿边界线行走至指定出发点后，向工作区域内转向并进入作业模式。对于初始点与出发点重合的情况，则行走机器人直接在初始点向工作区域内转向并进入作业模式。
结合图4所示，本发明一具体实施方式中，所述步骤S4具体包括：S41、获取狭窄区域与非狭窄区域之间形成的临界点，以及各个临界点对应的位置值；其中，沿巡线路径的延伸方向，形成的临界点顺序为临界点P1、临界点P2、临界点P3、临界点P4，各个临界点对应的位置值依次为LP1、LP2、LP3、LP4；S42、根据各个临界点对应的位置值获取各个非狭窄区域的周长；或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长；S43、根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。
需要说明的是，所述步骤S4可选择在巡线模式下完成，也可以选择在作业模式下完成，亦可以在两种模式下配合完成；所述初始点为行走机器人沿巡线路径行走一周过程中的起始出发点。本发明具体实施方式中，行走机器人通常由基站出发沿巡线路径行走一周后回到基站，如此，可将基站的位置作为初始点。
步骤S41中，当确定狭窄通道位置后，行走机器人可自动识别出所述临界点，即可以确定临界点的位置，为了便于理解，本发明将临界点在巡线路径的延伸方向(即方向D1)上按照到达的顺序分别以临界点P1、临界点P2、临界点P3、临界点P4进行表示；本发明其他实施方式中，还可以在临界点的对应位置通过人工敷设线圈的方式增加对临界点的识别精度，在此不做详细赘述。
本发明第一种较佳实施方式中，所述步骤S42具体包括：判断初始点是否在当前非狭窄区域上，若是，则当前非狭窄区域的周长lA＝lsum-(LP4-LP1)；若否，则当前非狭窄区域的周长lA＝LP3-LP2，其中，lsum表示巡线路径的周长，lA表示当前非狭窄区域的周长。
为了便于理解，结合图5所示，本发明描述一具体示例以方便理解；该示例中，巡线路径自初始点(在本实施例中为基站位置)开始，沿箭头D1方向延伸，并还回至初始点结束；工作区域包括非狭窄区域A、非狭窄区域B，以及将工作区域分隔为非狭窄区域A、非狭窄区域B的狭窄区域C；该示例中，在巡线模式下，行走机器人沿边界线(即巡线路径)行走一周后，获得该巡线路径的周长以lsum表示，非狭窄区域A与狭窄区域C在巡线路径的延伸方向上形成的临界点顺序为P1和临界点P4，非狭窄区域B与狭窄区域C在巡线路径的延伸方向上形成的临界点顺序为P2和临界点P3，在巡线路径的延伸方向上各个临界点对应的位置值顺序以LP1、LP2、LP3、LP4表示。
相应的，初始点处于非狭窄区域A上，所以非狭窄区域A的周长可表示为lA＝lsum-(LP4-LP1)，非狭窄区域B的周长可以表示为lB＝LP3-LP2。
本发明第二种较佳实施方式中，所述步骤S42具体包括：采用累加算法获得各个非狭窄区域的周长，即判断初始点是否在当前非狭窄区域上，若是，沿巡线路径的延伸方向，自初始点开始累加当前非狭窄区域的周长，并在到达临界点P1时，停止累加当前非狭窄区域的周长，当到达临界点P4时，继续累加当前非狭窄区域的周长，直至返回至初始点；若否，当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P2至临界点P3之间的长度。
为了便于理解，结合图6所示，本发明描述一具体示例以方便理解。
需要说明的是，图6所示示例与图5所示示例中，巡线路径周长、区域划分、初始点、临界点以及临界点对应的位置值的表达方式均与图5相同，因此不再具体赘述。
该较佳实施方式中，由于初始点处于非狭窄区域A上，故对于非狭窄区域A，沿巡线路径的延伸方向，自初始点开始累加当前非狭窄区域A的周长，当到达临界点P1时，停止累加当前非狭窄区域A的周长，当到达P4时，继续累加当前非狭窄区域A的周长，直至返回至初始点；即非狭窄区域A的周长等于在巡线路径的延伸方向上初始点至P1的长度与P4至初始点的长度之和。
对于非狭窄区域B，由于初始点不在非狭窄区域B上，当到达P2时开始累加当前非狭窄区域B的周长，直至到达P3后，停止累加当前非狭窄区域B的周长；即非狭窄区域B的周长等于在巡线路径的延伸方向上P2至P3的长度。
本发明较佳实施方式中，结合图7所示，所述步骤S43具体包括：S431、依照非狭窄区域的周长lA获得出发区间的线长lSE，起始点S的位置值LS和终点E的位置值LE，所述出发区间为依照巡线路径行走的轨迹，则lSE＝LE-LS，LS＝x·lA，LE＝y·lA，lSE≤lA，其中，x<y，x∈[0,1)，y∈(0,1]；S432、在出发区间内选取至少1个出发点。
需要说明的是，起始点LS可为当前巡线路径上的任一点，本发明一较佳实施方式中，判断所述初始点是否处于当前非狭窄区域上，若是，则将初始点设置为当前非狭窄区域的起始点S；若否，则将临界点P3设置为当前非狭窄区域的起始点S。
本发明具体实施方式中，所述步骤S432具体包括：将出发区间划分为多个子区间；分别在每个子区间中选取对应于该子区间的至少1个出发点。
将出发区间划分为多个子区间的方式有多种，其中一种较佳实施方式中，将出发区间按照有序数列划分为多个子区间，使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、斐波那契数列、分群数列、周期数列、阶差数列等至少其中之一。
本发明一具体实施方式中，将出发区间划分为n个子区间，n为正整数，则每个子区间的长度具有确定的关系，其可以表示为：LAi＝Rt(i,lSubi)+LS，其中，i∈[1,n]，且i为整数；lSubi表示对应第i个子区间的长度，LAi表示第i个子区间中的出发点的位置值，Rt(i,lSubi)为关系函数。
该具体示例中，可预设n的值，也可以指定每个子区间的长度，并通过公式
Figure BDA0001878325650000111
获得子区间的数量n，其中，intD()为向下取整函数。
作为该具体实施方式的一个特例，采用等差数列将出发区间划分为多个子区间，取其公差为0，并设定n的具体数值；则Rt(i,lSubi)＝(k+i-1)·lSubi，
Figure BDA0001878325650000112
k∈[0,1]，LAi＝(k+i-1)·lSubi+LS。例如：当k＝0时，表示取每个子区间的起点为当前子区间的起始点，当k＝0.5时，表示取每个子区间的中点为当前子区间的起始点，当k＝1时，表示取每个子区间的终点为当前子区间的起始点。
继续参照图5所示，该实施方式中，为了避免赘述，本发明仅以区域A为例做具体介绍；该示例中，获得的非狭窄区域A的周长lA＝300m，经过查询获得x＝0，y＝0.5，n＝10，k＝1，且采用等差数列的方式分隔区域A形成多个子区间，公差为0；则lSE＝0.5×300m-0＝150m，lSubi＝150m÷10＝15m，lA1＝15m，lA2＝30m，lA3＝45m，……，lA10＝150m。
本发明另一较佳实施方式中，所述步骤S432具体包括：在出发区间内，按照随机或伪随机的方式获得至少1个出发点。
本发明一具体实施方式中，在出发区间内，自起始点S的位置值LS开始，按照第一预设长度选取第一出发区间，并在该第一出发区间内随机选定第1个出发点；依次以选定的出发点为起始点，按照第二预设长度划分至少1个第二出发区间，并在该第二出发区间内随机选定下一个出发点，直至遍历整个出发区间。
所述第一预设长度、第二预设长度均为长度预设常数值，其大小可以根据出发区间的长度具体设定，例如：按照其对应于出发区间的长度占比进行设定，在此不做详细赘述；所述出发区间按照第一预设长度、第二预设长度、选择的出发点的位置分为第一出发区间以及至少一个第二出发区间，所述第一出发区间和第二出发区间仅按照第二预设长度进行区分，其真实长度并不做具体限定，由于各个出发点随机或伪随机的方式进行选定，如此，当第二出发区间超过一个时，每个第二出发区间的长度可能会不等。
作为该具体实施方式的一个示例，设定第一预设长度的范围为[a1,b1]，第二预设长度的范围为[a2,b2]，则LA1＝RND(i)+LS,其中RND(i)为随机/伪随机函数，且RND(i)∈[a1,b1]，LAj＝LA(j-1)+RND(j)，其中RND(j)∈[a2,b2]，j为整数且j∈[2,c]，c满足使LAc≤LE且LA(c+1)>LE。即第1个出发点位于起始点S与第一预设长度限定的范围内，其在该范围内的具体位置可以任意指定，也可以通过随机或伪随机的算法进行确定，下一个出发点在上一个出发点的位置与第二预设长度限定的出发区间内选定。
进一步的，所述方法还包括：S5、在达到预设条件之前，仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式，且禁止所述行走机器人进入所述狭窄区域。
本发明较佳实施方式中，自动获取当前巡线路径中各个出发点对应的频数值；所述频数值为同一出发点连续出发的次数。
本发明中对应各个出发点的频数值可以任意指定，也可以按照一定的规则进行获取。本发明一较佳实施方式中，在预设频数阈值范围内，配置每个出发点的频数值相等；或在预设频数阈值范围内，按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配置各个出发点对应的频数值；或在预设频数阈值范围内，对各个出发点随机配置任一频数值。
频数阈值范围通常为一数值范围，其最小值为1，最大值为M，M为正整数；通常情况下，可根据工作区域的大小、相邻出发点之间的长度关系具体设定，例如：获得的各个出发点为等距设置时，通常将各个出发点对应的频数值设置为相等，当相邻出发点之间的间距越大时，相邻的出发点其频数值也相应的设置为较大；当然，也可以设定总的频数值，之后通过出发点对应的位置值，按比例分配频数值，在此不做详细赘述。
本发明一较佳实施方式中，所述方法还包括：建立一存储器列表，用于存储各个出发点以及其所对应的位置值和频数值；通过查询所述存储器列表，获得各个出发点对应的位置值和频数值。
驱动所述行走机器人在当前非狭窄区域内工作，直到达到预设条件，再穿过狭窄区域并进入到下一个非狭窄区域内完成工作。在当前非狭窄区域内工作时，行走机器人仅被允许在属于当前非狭窄区域中的出发点处进入工作状态，且禁止行走机器人进入狭窄区域。本发明较佳实施方式中，对应于出发点的位置不同，行走机器人工作顺序也稍有调整。
结合参照图5所示，当前非狭窄区域上的所有出发点，在巡线路径的延伸方向上均处于同一段连续的巡线路径上，如此，在工作过程中，持续沿巡线路径行走，即可以分别遍历非狭窄区域A和非狭窄区域B上的所有出发点。需要说明的是，第一种较佳实施方式的根据各个临界点对应的位置值获取各个非狭窄区域的周长，更适用于非狭窄区域上的所有出发点，在巡线路径的延伸方向上均处于同一段连续的巡线路径。
结合图6所示，当前非狭窄区域上的出发点，在巡线路径的延伸方向上处于2段连续的巡线路径上，如此，行走机器人在未完成当前非狭窄区域A的工作时，需要避免其进入狭窄区域，此时，若行走机器人意外进入狭窄区域，需要其重新返回当前非狭窄区域A，并在遍历狭窄区域A的所有出发点后，再穿过狭窄区域进入非狭窄区域B。需要说明的是，第二种较佳实施方式的根据各个临界点对应的位置值获取各个非狭窄区域的周长，更适用于非狭窄区域上的出发点，在巡线路径的延伸方向上处于2段连续的巡线路径上。
本发明一种可实现方式中，若通过狭窄区域的一条边界线使行走机器人意外进入狭窄区域，可在进入狭窄区域后，调整机器人的行走方向以到达当前边界线对应的另一条边界线，之后再调整机器人的行走方向，使其重新返回当前非狭窄区域继续工作。
进一步的，本发明的行走机器人的控制方法还包括：实时获取行走机器人的状态属性，所述状态属性包括：电池包的电量、连续工作时长以及连续工作行走的路程至少其中之一；根据行走机器人的状态属性，判断是否执行回归模式。
若行走机器人电池包的电量小于预设电量阈值，和/或连续工作时长大于预设的工作时长阈值，和/或连续行走的路程大于预设的连续行走的路程阈值，则驱动所述行走机器人执行回归模式。回归模式下，行走机器人查找基站位置，并返回至基站进行充电，并在充电完成后，返回至执行回归模式时的位置，继续工作。
需要说明的是，在行走机器人在巡线路径上所有的出发点均按照获取的频数值完成工作后，其也需要执行回归模式，此后，若下一次执行工作的工作区域与上一次执行的工作区域相同，则直接巡线至出发点后进入到作业模式，或重新确定出发点和/或频数值后，在巡线至新的出发点；若不同，需要重新进入到巡线模式，在此不做详细赘述。优选的，当行走机器人按照获取的频数值遍历所有出发点完成工作后回到基站，再下次从基站出发开始工作前，重新确定出发点的位置值和/或频数值，有助于避免行走机器人在相同位置过多此处的转向出发而造成草地磨损的问题。在其他优选实施方式中，也可根据其他预设情况重新确定出发点位置值和/或频数值，所述预设情况包括但不限于累计工作时间、累计工作行走路程、累计充电次数、是否为特定次数的开机等。
进一步的，在同一工作区域下，为了避免行走机器人总是在边界线两侧的同一位置行走而走出车辙，破坏草坪，可以采取沿边界线平行区域不同位置轮流行驶的方法驱动行走机器人行走，如图8所示，边界线自初始点开始，沿箭头D1方向延伸，并还回至初始点结束；line1为边界线line位于草坪的内平行线，line2为边界线line位于草坪边沿的外平行线，二者距边界线line的距离一般为一个车身，内边界线line1的距离可以适当加宽；行走机器人可以行驶在边界line两侧line1和line2之间范围内；并可以按一定顺序执行：如第一次靠左，下一次向右移动一个车轮宽的位置，再下一次再移动一个车轮宽位置，当到达右边极限位置时，再转为靠左行驶，如此往复驶出充电站；也可以在边界线line1和line2之间按随机或者其他方法驱动行走机器人行走，以达到保护草坪的目的。
如图9所示，在本发明的第一实施方式中，所述行走机器人的控制系统包括：配置模块100、巡查模块200、区域划分模块300、控制处理模块400以及存储模块500。
配置模块100用于提供一呈闭合的巡线路径，所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路。
巡查模块200用于驱动所述行走机器人从初始点出发、沿巡线路径行走一周，记录巡线路径的周长以及确认巡线路径上狭窄通道的位置。
基站开启后，配置模块100通过设置在基站内的信号发生装置沿巡线路径发射脉冲编码信号，以在所述巡线路径上产生电磁信号。
巡查模块200用于驱动所述行走机器人沿巡线路径的延伸方向行走过程中，记录行走机器人实际接收到电磁信号的强度，根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。
区域划分模块300用于将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域，以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域。。
控制处理模块400用于：根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值；所述位置值为当前出发点距离初始点在巡线路径上的长度。
本发明一具体实施方式中，控制处理模块400具体用于：获取狭窄区域与非狭窄区域之间形成的临界点，以及各个临界点对应的位置值；其中，沿巡线路径的延伸方向，形成的临界点顺序为临界点P1、临界点P2、临界点P3、临界点P4，各个临界点对应的位置值依次为LP1、LP2、LP3、LP4；根据各个临界点对应的位置值获取各个非狭窄区域的周长；或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长；S43、根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。
本发明第一种较佳实施方式中，控制处理模块400具体用于判断初始点是否在当前非狭窄区域上，若是，则当前非狭窄区域的周长lA＝lsum-(LP4-LP1)；若否，则当前非狭窄区域的周长lA＝LP3-LP2，其中，lsum表示巡线路径的周长，lA表示当前非狭窄区域的周长。
本发明第二种较佳实施方式中，控制处理模块400具体用于采用累加算法获得各个非狭窄区域的周长，即判断初始点是否在当前非狭窄区域上，若是，沿巡线路径的延伸方向，自初始点开始累加当前非狭窄区域的周长，并在到达临界点P1时，停止累加当前非狭窄区域的周长，当到达临界点P4时，继续累加当前非狭窄区域的周长，直至返回至初始点；若否，当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P2至临界点P3之间的长度。
进一步的，控制处理模块400具体用于依照非狭窄区域的周长lA获得出发区间的线长lSE，起始点S的位置值LS和终点E的位置值LE，所述出发区间为依照巡线路径行走的轨迹，则lSE＝LE-LS，LS＝x·lA，LE＝y·lA，lSE≤lA，其中，x<y，x∈[0,1)，y∈(0,1]；在出发区间内选取至少1个出发点。。
进一步的，本发明具体实施方式中，控制处理模块400具体用于将出发区间划分为多个子区间；分别在每个子区间中选取对应于该子区间的至少1个出发点。
控制处理模块400将出发区间划分为多个子区间的方式有多种，其中一种较佳实施方式中，将出发区间按照有序数列划分为多个子区间，使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、斐波那契数列、分群数列、周期数列、阶差数列等至少其中之一。
进一步的，控制处理模块400还用于在出发区间内，按照随机或伪随机的方式获得至少1个出发点。
本发明一具体实施方式中，控制处理模块400在出发区间内，自起始点S的位置值LS开始，按照第一预设长度选取第一出发区间，并在该第一出发区间内随机选定第1个出发点；依次以选定的出发点为起始点，按照第二预设长度划分至少1个第二出发区间，并在该第二出发区间内随机选定下一个出发点，直至遍历整个出发区间。
进一步的，控制处理模块400还用于驱动所述行走机器人按照所述巡线路径行走以遍历每个非狭窄区域上的每个出发点，在同一非狭窄区域内依照对应的位置值到达每个出发点时，驱动所述行走机器人进入工作状态；其中，在每个狭窄区域工作完成之前，阻止行走机器人进入狭窄区域。
本发明一种可实现方式中，控制处理模块400若确认通过狭窄区域的一条边界线使行走机器人意外进入狭窄区域，可在进入狭窄区域后，调整机器人的行走方向以到达当前边界线对应的另一条边界线，之后再调整机器人的行走方向，使其重新返回当前非狭窄区域继续工作。
本发明较佳实施方式中，控制处理模块400自动获取当前巡线路径中各个出发点对应的频数值；所述频数值为同一出发点连续出发的次数；在达到预设条件之前，仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式，且禁止所述行走机器人进入所述狭窄区域。。
本发明中对应各个出发点的频数值可以任意指定，也可以按照一定的规则进行获取。本发明一较佳实施方式中，控制处理模块400在预设频数阈值范围内，配置每个出发点的频数值相等；或在预设频数阈值范围内，按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配置各个出发点对应的频数值；或在预设频数阈值范围内，对各个出发点随机配置任一频数值。
所述存储模块500中设置至少一存储器列表；所述存储器列表用于存储各个出发点以及其所对应的位置值和频数值，并根据频数值生成位置值序列表，具体地，位置值序列表包括出发序列号及其对应的位置值。例如，在一个实施例中，出发点PA1的位置值LPA1＝0m，频数值FPA1＝1；出发点PA2的位置值LPA2＝15m，频数值FPA2＝3；出发点PA3的位置值LPA3＝30m，频数值FPA3＝2；出发点PA4的位置值LPA4＝45m，频数值FPA4＝2。那么，生成的出发序列号-位置值列表{(index,LPAi)}为{(1,0),(2,15),(3,15),(4,15),(5,30),(6,30),(7,45),(8,45)}，其中index为出发序列号，LPAi为出发点PAi的位置值。控制处理模块400可通过查询所述存储器列表中存储的位置值序列表和当次出发序列号，获得当次出发所选择的出发点对应的位置值和频数值。
当进入到作业模式后，行走机器人在到达任一出发点时，按照该出发点对应的频数值进入工作区域进行割草。
进一步的，控制处理模块400还用于实时获取行走机器人的状态属性，所述状态属性包括：电池包的电量、连续工作时长以及连续行走的路程至少其中之一；根据行走机器人的状态属性，判断是否执行回归模式。若行走机器人电池包的电量小于预设电量阈值，和/或连续工作时长大于预设的工作时长阈值，和/或连续行走的路程大于预设的连续行走的路程阈值，则驱动所述行走机器人执行回归模式。
与现有技术相比，本发明行走机器人的控制方法及系统，对于具有狭窄通道的工作空间，自动对工作区域进行划分，以形成狭窄区域和非狭窄区域，并使行走机器人在工作过程中，根据需要自由穿过狭窄区域以遍历每个非狭窄区域，进而提升行走机器人在工作区间内的遍历性，提高工作效率。
所属领域的技术人员可以清楚地了解到，为描述的方便和简洁，上述描述的系统中模块的具体工作过程，可以参考前述方法实施方式中的对应过程，在此不再赘述。
在本申请所提供的几个实施方式中，应该理解到，所揭露的系统，系统和方法，可以通过其它的方式实现。例如，以上所描述的系统实施方式仅仅是示意性的，例如，所述模块的划分，仅仅为一种逻辑功能划分，实际实现时可以有另外的划分方式，例如多个模块或组件可以结合或者可以集成到另一个系统，或一些特征可以忽略，或不执行。另一点，所显示或讨论的相互之间的耦合或直接耦合或通信连接可以是通过一些接口，系统或模块的间接耦合或通信连接，可以是电性，机械或其它的形式。
所述作为分离部件说明的模块可以是或者也可以不是物理上分开的，作为模块显示的部件可以是或者也可以不是物理模块，即可以位于一个地方，或者也可以分布到多个网络模块上。可以根据实际的需要选择其中的部分或者全部模块来实现本实施方式方案的目的。
另外，在本申请各个实施方式中的各功能模块可以集成在一个处理模块中，也可以是各个模块单独物理存在，也可以2个或2个以上模块集成在一个模块中。上述集成的模块既可以采用硬件的形式实现，也可以采用硬件加软件功能模块的形式实现。
上述以软件功能模块的形式实现的集成的模块，可以存储在一个计算机可读取存储介质中。上述软件功能模块存储在一个存储介质中，包括若干指令用以使得一台计算机系统(可以是个人计算机，服务器，或者网络系统等)或处理器(processor)执行本申请各个实施方式所述方法的部分步骤。而前述的存储介质包括：U盘、移动硬盘、只读存储器(Read-Only Memory，ROM)、随机存取存储器(Random Access Memory，RAM)、磁碟或者光盘等各种可以存储程序代码的介质。
为了更加清楚全面地阐释本发明的技术方案，参考图10，上述任意一个实施例所述的行走机器人的控制系统，按照以下步骤进行工作。
ST1：系统初始化并开始工作。具体地，基站上电，向边界线发送信号以在边界线附近产生电磁信号。此时，机器人位于基站内，即位于初始位置，且出发序列号初始值为0。
ST2：机器人进入巡线模式，从初始点开始、沿边界线行走并绕边界线一周后回到初始点，并记录边界线的周长及狭窄区域的位置。具体方法在前文中已详细说明，在此不再赘述。
ST3：根据边界线的周长，分别确定每个非狭窄区域的边界线上各个出发点的位置值及各个出发点对应的频数值，并根据频数值形成针对各个非狭窄区域的位置值序列，进而形成出发序列号-位置值列表。其中，位置值、频数值及出发序列号列表的确定方法依照上述方法实现，这里不再赘述；每个非狭窄区域的出发序列号-位置值列表是各自独立的。
ST4：调取并使用一非狭窄区域的出发序列号-位置值列表。
ST5：出发序列号的值增加1。
ST6：机器人以巡线模式，再次从初始点开始、沿边界线行走到达该一非狭窄区域的出发序列号对应的出发点。
ST7：机器人从该出发点转向离开边界线，进入该一非狭窄区域并开始割草作业，即从巡线模式进入作业模式。
ST8：机器人保持作业模式，在工作区域内进行割草作业。
ST9：判断机器人是否满足特定的状态属性。具体地，在一些实施例中，判断电池包的剩余电量满足小于等于一阈值，若是，则机器人执行ST10回到基站，若否，则执行ST8继续在工作区域内进行割草作业。在一些实施例中，判断机器人累计割草时间是否满足大于等于一阈值，若是，则机器人执行ST10回到基站，若否，则执行ST8继续在工作区域内进行割草作业。在一些实施例中，判断机器人累计作业行走路程是否满足大于等于一阈值，若是，则机器人执行ST10回到基站，若否，则执行ST8继续在工作区域内进行割草作业。这里的特定的状态属性，可以是单一的状态属性，也可以是综合考虑多个状态属性，包括但不限于上述以举例形式列出的状态属性。
ST10：机器人回到初始点。具体地，驱动机器人回到基站，并进行充电和/或维护。
ST11：判断是否继续工作。具体地，在充电和/或维护完成后，判断是否完成当前工作计划，即是否继续工作。若继续工作，则执行ST2，若不继续工作，则执行ST15。
ST12：判断是否允许机器人进入另一非狭窄区域。具体地，在一些实施例中，判断条件为在该一非狭窄区域内累计作业时间是否达到一阈值；在一些实施例中，判断条件为在该一非狭窄区域内累计作业行走路程是否达到一阈值。若是，则执行ST13，若否，则执行ST14。这里的判断条件，可以是单一的条件，也可以是综合考虑多个条件，包括但不限于上述以举例形式列出的条件。
ST13：调取并使用另一非狭窄区域的出发序列号-位置值列表，并将出发序列号的值设为0。
ST14：继续使用当前非狭窄区域的出发序列号-位置值列表。
ST15：系统关闭，结束工作。在该步骤，机器人通常以存储状态位于基站内，机器人和/或基站的电源自动地或人为地切断。
最后应说明的是：以上实施方式仅用以说明本申请的技术方案，而非对其限制；尽管参照前述实施方式对本申请进行了详细的说明，本领域的普通技术人员应当理解：其依然可以对前述各实施方式所记载的技术方案进行修改，或者对其中部分技术特征进行等同替换；而这些修改或者替换，并不使相应技术方案的本质脱离本申请各实施方式技术方案的精神和范围。

Claims (19)

1.一种行走机器人的控制方法，包括：
S1：提供一闭合的巡线路径，所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路；
S2：驱动所述行走机器人从初始点出发、沿巡线路径行走一周，记录巡线路径的周长以及确认巡线路径上狭窄通道的位置；
S3：将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域，以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域；
S4：根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值；所述出发点设置在所述巡线路径上，且每个所述非狭窄区域中包括至少一个所述出发点；所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值；
S5：在达到预设条件之前，仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入作业模式，且禁止所述行走机器人进入所述狭窄区域。
2.根据权利要求1所述的行走机器人的控制方法，其特征在于，所述初始点设置在基站位置。
3.根据权利要求2所述的行走机器人的控制方法，其特征在于，所述预设条件为累计工作时长、累计工作行走的路程、电池包的电量中的至少一种。
4.根据权利要求2所述的行走机器人的控制方法，其特征在于，所述方法还包括：
S21：向边界线发射信号，以在所述边界线周围产生电磁信号；
S22：驱动所述行走机器人沿巡线路径的延伸方向行走过程中，记录行走机器人实际接收到电磁信号的强度；
S23：根据行走机器人实际接收到的电磁信号的强度确认巡线路径上狭窄通道的位置。
5.根据权利要求2所述的行走机器人的控制方法，其特征在于，“根据记录的巡线路径周长获取每个非狭窄区域中各个出发点对应的位置值”具体包括：
S41：获取狭窄区域与非狭窄区域之间形成的临界点，以及各个临界点对应的位置值；其中，沿巡线路径的延伸方向，形成的临界点顺序为临界点P1、临界点P2、临界点P3、临界点P4，各个临界点对应的位置值依次为LP1、LP2、LP3、LP4；
S42：根据各个临界点对应的位置值获取各个非狭窄区域的周长；或根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长；
S43：根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值。
6.根据权利要求5所述的行走机器人的控制方法，其特征在于，“根据获得的临界点所对应的位置值以及巡线路径的周长获得各个非狭窄区域的周长”具体包括：
判断所述初始点是否在当前非狭窄区域上，
若是，则当前非狭窄区域的周长lA＝lsum-(LP4-LP1)；
若否，则当前非狭窄区域的周长lA＝LP3-LP2，其中，lsum表示巡线路径的周长，lA表示当前非狭窄区域的周长。
7.根据权利要求5所述的行走机器人的控制方法，其特征在于，“根据各个临界点对应的位置值获取各个非狭窄区域的周长”具体包括：
采用累加算法获得各个非狭窄区域的周长，即
判断所述初始点是否在当前非狭窄区域上，
若是，沿巡线路径的延伸方向，自初始点开始累加当前非狭窄区域的周长，并在到达临界点P1时，停止累加当前非狭窄区域的周长，当到达临界点P4时，继续累加当前非狭窄区域的周长，直至返回至初始点；
若否，当前非狭窄区域的周长为沿巡线路径的延伸方向临界点P2至临界点P3之间的长度。
8.根据权利要求5至7任一项所述的行走机器人的控制方法，其特征在于，“根据每个非狭窄区域的周长独立获取该非狭窄区域中各个出发点对应的位置值”具体包括：
S431：依照非狭窄区域的周长lA获得起始点S的位置值LS、终点E的位置值LE和沿巡线路径从起始点S到终点E之间的出发区间的线长lSE；所述出发区间为依照巡线路径行走的轨迹，出发点均在所述出发区间内选取；则lSE＝LE-LS，LS＝x·lA，LE＝y·lA，lSE≤lA，其中，x<y，x∈[0,1)，y∈(0,1]；
S432：在出发区间内选取至少1个出发点。
9.根据权利要求8所述的行走机器人的控制方法，其特征在于，所述方法还包括：
判断所述初始点是否处于当前非狭窄区域上，
若是，则将初始点设置为当前非狭窄区域的起始点S；
若否，则将临界点P3设置为当前非狭窄区域的起始点S。
10.根据权利要求8所述的行走机器人的控制方法，其特征在于，所述方法具体包括：
将出发区间划分为多个子区间；
分别在每个子区间中选取对应于该子区间的至少1个出发点。
11.根据权利要求10所述的行走机器人的控制方法，其特征在于，“将出发区间划分为多个子区间”具体包括：
将出发区间按照有序数列划分为多个子区间。
12.根据权利要求11所述的行走机器人的控制方法，其特征在于，“将出发区间按照有序数列划分为多个子区间”具体包括：
将出发区间按照有序数列划分为多个子区间，使子区间之间的长度关系呈例如等差数列、等比数列、等和数列、斐波那契数列、分群数列、周期数列、阶差数列至少其中之一。
13.根据权利要求8所述的行走机器人的控制方法，其特征在于，“在出发区间内选取至少1个出发点”具体包括：
在出发区间内按照随机或伪随机的方式获得至少1个出发点。
14.根据权利要求13所述的行走机器人的控制方法，其特征在于，所述方法具体包括：
在出发区间内，自起始点S的位置值LS开始，按照第一预设长度选取第一出发区间，并在该第一出发区间内随机选定第1个出发点；
依次以选定的出发点为起始点，按照第二预设长度划分至少1个第二出发区间，并在该第二出发区间内随机选定下一个出发点，直至遍历整个出发区间。
15.根据权利要求5所述的行走机器人的控制方法，其特征在于，所述方法还包括：
自动获取当前巡线路径中各个出发点对应的频数值；所述频数值为所述行走机器人在同一出发点连续出发的次数。
16.根据权利要求15所述的行走机器人的控制方法，其特征在于，所述方法还包括：
在预设频数阈值范围内，配置每个出发点的频数值相等；
或在预设频数阈值范围内，按照各个出发点距离其相邻的上一出发点在巡线路径上的距离差正相关于配置各个出发点对应的频数值；
或在预设频数阈值范围内，对各个出发点随机配置任一频数值。
17.根据权利要求2所述的行走机器人的控制方法，其特征在于，所述方法还包括：
实时获取行走机器人的状态属性，所述状态属性包括：电池包的电量、连续工作时长以及连续工作行走的路程至少其中之一；
若行走机器人电池包的电量小于预设电量阈值，和/或连续工作时长大于预设的工作时长阈值，和/或连续行走的路程大于预设的连续行走的路程阈值，则驱动所述行走机器人返回至所述基站。
18.根据权利要求1所述的行走机器人的控制方法，其特征在于，当所述行走机器人达到预设情况时，重新确定出发点的位置值和/或频数值。
19.一种行走机器人的控制系统，其特征在于，所述系统包括：
配置模块，用于提供一闭合的巡线路径，所述巡线路径为行走机器人所在工作区域的边界线形成的闭合回路；
巡查模块，用于驱动所述行走机器人从初始点出发、沿巡线路径行走一周，记录巡线路径的周长以及确认巡线路径上狭窄通道的位置；
区域划分模块，用于将当前巡线路径形成的区域划分为由至少一个狭窄通道形成的至少一个狭窄区域，以及连接在至少一个所述狭窄区域两端的至少两个非狭窄区域；
控制处理模块，用于根据记录的巡线路径周长获取每个所述非狭窄区域中各个出发点对应的位置值；所述出发点设置在所述巡线路径上，且每个所述非狭窄区域中包括至少一个所述出发点；所述位置值等于当前出发点距离所述初始点在巡线路径上的长度值；
在达到预设条件之前，仅允许所述行走机器人选择在属于同一所述非狭窄区域中的所述出发点处进入工作状态，且禁止所述行走机器人进入所述狭窄区域。
CN201811410347.8A 2018-10-31 2018-11-23 行走机器人的控制方法及控制系统 Active CN111198557B (zh)

Priority Applications (2)

Application Number Priority Date Filing Date Title
PCT/CN2019/114040 WO2020088461A1 (zh) 2018-10-31 2019-10-29 行走机器人的控制方法及系统
PCT/CN2019/114029 WO2020088460A1 (zh) 2018-10-31 2019-10-29 行走机器人的控制方法及系统

Applications Claiming Priority (4)

Application Number Priority Date Filing Date Title
CN201811281652 2018-10-31
CN201811281641 2018-10-31
CN2018112816413 2018-10-31
CN2018112816521 2018-10-31

Publications (2)

Publication Number Publication Date
CN111198557A true CN111198557A (zh) 2020-05-26
CN111198557B CN111198557B (zh) 2022-03-18

Family

ID=70494712

Family Applications (4)

Application Number Title Priority Date Filing Date
CN201811410354.8A Active CN111123905B (zh) 2018-10-31 2018-11-23 行走机器人的控制方法及系统
CN201811410347.8A Active CN111198557B (zh) 2018-10-31 2018-11-23 行走机器人的控制方法及控制系统
CN201910638888.4A Active CN111198559B (zh) 2018-10-31 2019-07-16 行走机器人的控制方法及系统
CN201910638761.2A Active CN111198558B (zh) 2018-10-31 2019-07-16 行走机器人的控制方法及系统

Family Applications Before (1)

Application Number Title Priority Date Filing Date
CN201811410354.8A Active CN111123905B (zh) 2018-10-31 2018-11-23 行走机器人的控制方法及系统

Family Applications After (2)

Application Number Title Priority Date Filing Date
CN201910638888.4A Active CN111198559B (zh) 2018-10-31 2019-07-16 行走机器人的控制方法及系统
CN201910638761.2A Active CN111198558B (zh) 2018-10-31 2019-07-16 行走机器人的控制方法及系统

Country Status (2)

Country Link
CN (4) CN111123905B (zh)
WO (2) WO2021008058A1 (zh)

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111796598A (zh) * 2020-07-16 2020-10-20 苏州科瓴精密机械科技有限公司 自动行走设备及其控制方法和系统及存储介质
CN113219967A (zh) * 2021-04-15 2021-08-06 上海岚豹智能科技有限公司 一种用于移动机器人通行窄道的方法及设备

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113805571B (zh) * 2020-05-29 2024-03-12 苏州科瓴精密机械科技有限公司 机器人行走控制方法、系统，机器人及可读存储介质
CN112731935B (zh) * 2020-12-25 2024-09-06 格力博(江苏)股份有限公司 自动割草机的路径规划方法、系统、设备及自动割草机
WO2021249366A1 (zh) * 2020-06-08 2021-12-16 上海山科机器人有限公司 自主作业设备和系统、控制方法及可读存储介质
CN113467479B (zh) * 2021-08-05 2023-08-15 南京苏美达智能技术有限公司 一种工作区域中作业路径的调整方法及自动行走设备

Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020156556A1 (en) * 1999-07-12 2002-10-24 Ruffner Bryan J. Multifunctional mobile appliance
CN103217898A (zh) * 2012-01-20 2013-07-24 苏州宝时得电动工具有限公司 自动工作设备及其控制方法
CN104375505A (zh) * 2014-10-08 2015-02-25 北京联合大学 一种基于激光测距的机器人自主寻路方法
CN105911981A (zh) * 2012-04-28 2016-08-31 苏州宝时得电动工具有限公司 自动工作系统、自动行走设备及其转向方法
CN107782315A (zh) * 2017-10-31 2018-03-09 成都交大光芒科技股份有限公司 一种电力智能巡检机器人路径规划和路径遍历方法
CN108490945A (zh) * 2018-04-12 2018-09-04 南京苏美达智能技术有限公司 割草机器人判断狭窄区域并自动离开的方法

Family Cites Families (36)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH01180605A (ja) * 1988-01-12 1989-07-18 Toshiba Corp 移動体の走行制御方式
JPH0944245A (ja) * 1995-08-02 1997-02-14 Fujitsu General Ltd 無人清掃車の制御方法
WO2000007492A1 (de) * 1998-07-31 2000-02-17 Volker Sommer Haushaltsroboter zum automatischen staubsaugen von bodenflächen
JP2007213236A (ja) * 2006-02-08 2007-08-23 Sharp Corp 自律走行ロボットの経路計画方法及び自律走行ロボット
WO2011115534A1 (en) * 2010-03-17 2011-09-22 Husqvarna Ab Method and system for navigating a robotic garden tool
DK2703925T3 (da) * 2011-04-28 2021-05-10 Positec Power Tools Suzhou Co Ltd Automatisk arbejdssystem, automatisk gangindretning og styrefremgangsmåde dertil
KR101334960B1 (ko) * 2011-08-03 2013-11-29 엘지전자 주식회사 잔디 깎기용 이동로봇 시스템 및 이의 제어방법
US9026299B2 (en) * 2012-07-09 2015-05-05 Deere & Company Navigation system and method for autonomous mower
CN103891463A (zh) * 2012-12-28 2014-07-02 苏州宝时得电动工具有限公司 自动割草系统
JP2014200449A (ja) * 2013-04-04 2014-10-27 シャープ株式会社 自走式掃除機
CN103901890B (zh) * 2014-04-09 2017-05-24 中国科学院深圳先进技术研究院 基于家庭庭院的户外自动行走装置及其控制系统和方法
CN104090575A (zh) * 2014-07-11 2014-10-08 大连理工大学 一种自动巡线机器人控制系统及自动巡线机器人
CN105511458B (zh) * 2014-09-25 2019-06-28 中国科学院深圳先进技术研究院 自动行走设备及其路径规划方法
US9538702B2 (en) * 2014-12-22 2017-01-10 Irobot Corporation Robotic mowing of separated lawn areas
CN105988415B (zh) * 2015-02-13 2019-09-20 苏州宝时得电动工具有限公司 多区域切割控制系统及其控制方法
CN105320140B (zh) * 2015-12-01 2018-09-18 浙江宇视科技有限公司 一种扫地机器人及其清扫路径规划方法
CN107291071A (zh) * 2016-03-30 2017-10-24 苏州宝时得电动工具有限公司 自动工作系统、自动行走设备及其转向方法
CN107402573B (zh) * 2016-05-19 2021-05-14 苏州宝时得电动工具有限公司 自动工作系统，自移动设备及其控制方法
CN107728608A (zh) * 2016-08-10 2018-02-23 向忠宏 一种移动机器人路径规划方法
CN108142070B (zh) * 2016-12-06 2020-05-22 苏州宝时得电动工具有限公司 自动割草系统及其控制方法
CN106818062A (zh) * 2016-12-25 2017-06-13 惠州市蓝微电子有限公司 一种割草机区域划定方法
CN107340768B (zh) * 2016-12-29 2020-08-28 珠海市一微半导体有限公司 一种智能机器人的路径规划方法
CN106983460B (zh) * 2017-04-07 2019-08-27 小狗电器互联网科技（北京）股份有限公司 一种扫地机器人区域清扫图像控制方法
CN107544517B (zh) * 2017-10-11 2021-06-01 珠海市一微半导体有限公司 智能清洁机器人的控制方法
CN107775664B (zh) * 2017-10-20 2018-08-28 重庆鲁班机器人技术研究院有限公司 控制器位置控制性能测试方法及装置
CN107831772A (zh) * 2017-11-17 2018-03-23 北京奇虎科技有限公司 清洁路线的排布方法、装置及机器人
CN107773164B (zh) * 2017-11-17 2020-11-03 北京奇虎科技有限公司 用于清洁机器人的清洁方法、装置及机器人
CN107928565A (zh) * 2017-11-17 2018-04-20 北京奇虎科技有限公司 清洁机器人的清洁方法、装置及机器人
CN108143364B (zh) * 2017-12-28 2021-02-19 湖南格兰博智能科技有限责任公司 一种自移动清洁机器人清洁地图区域划分的方法
CN108255178A (zh) * 2018-01-18 2018-07-06 山东理工大学 一种巡逻机器人全覆盖遍历路径规划算法的设计方法
CN108415420B (zh) * 2018-01-25 2021-09-14 上海思岚科技有限公司 一种用于移动机器人搜索路径的方法及设备
CN108415421A (zh) * 2018-01-26 2018-08-17 广东宝乐机器人股份有限公司 一种提高移动机器人边角覆盖率的方法
CN108507578B (zh) * 2018-04-03 2021-04-30 珠海市一微半导体有限公司 一种机器人的导航方法
CN109588100A (zh) * 2018-10-31 2019-04-09 浙江亚特电器有限公司 用于智能割草机的原路径返回方法
CN109839936A (zh) * 2019-03-04 2019-06-04 中新智擎科技有限公司 一种大环境下的自动导航方法、机器人及存储介质
CN109984685B (zh) * 2019-04-11 2021-08-06 云鲸智能科技（东莞）有限公司 清洁控制方法、装置、清洁机器人和存储介质

Patent Citations (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20020156556A1 (en) * 1999-07-12 2002-10-24 Ruffner Bryan J. Multifunctional mobile appliance
CN103217898A (zh) * 2012-01-20 2013-07-24 苏州宝时得电动工具有限公司 自动工作设备及其控制方法
CN105911981A (zh) * 2012-04-28 2016-08-31 苏州宝时得电动工具有限公司 自动工作系统、自动行走设备及其转向方法
CN104375505A (zh) * 2014-10-08 2015-02-25 北京联合大学 一种基于激光测距的机器人自主寻路方法
CN107782315A (zh) * 2017-10-31 2018-03-09 成都交大光芒科技股份有限公司 一种电力智能巡检机器人路径规划和路径遍历方法
CN108490945A (zh) * 2018-04-12 2018-09-04 南京苏美达智能技术有限公司 割草机器人判断狭窄区域并自动离开的方法

Cited By (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN111796598A (zh) * 2020-07-16 2020-10-20 苏州科瓴精密机械科技有限公司 自动行走设备及其控制方法和系统及存储介质
CN113219967A (zh) * 2021-04-15 2021-08-06 上海岚豹智能科技有限公司 一种用于移动机器人通行窄道的方法及设备

Also Published As

Publication number Publication date
CN111123905B (zh) 2022-08-26
WO2021008059A1 (zh) 2021-01-21
CN111123905A (zh) 2020-05-08
CN111198558A (zh) 2020-05-26
CN111198558B (zh) 2021-11-26
WO2021008058A1 (zh) 2021-01-21
CN111198557B (zh) 2022-03-18
CN111198559B (zh) 2021-06-08
CN111198559A (zh) 2020-05-26

Similar Documents

Publication Publication Date Title
CN111198557B (zh) 行走机器人的控制方法及控制系统
US9788481B2 (en) Robotic mower navigation system
CN111185899B (zh) 机器人控制方法及机器人系统
EP2590495B1 (en) Communication and safety device for boundary aided systems
JP2019528801A (ja) 自律型ロボットの自動ドッキング及びエネルギー管理システム及び方法
US9072219B2 (en) Robotic mower navigation system
JP6253567B2 (ja) 作業車両の移動システム
US11126193B2 (en) Automatic beacon position determination
EP2390741A2 (en) Method for controlling an autonomous machine across multiple sub-areas
CN113625701A (zh) 一种割草机器人路径规划方法及割草机器人
EP2390746A2 (en) Condition based keep-out for machines
CN113729551A (zh) 借助机器人的机器人辅助表面处理
EP2296071A1 (en) Modular and scalable positioning and navigation system
CN112015186A (zh) 一种具有社会属性的机器人路径规划方法、装置和机器人
US20110046836A1 (en) Modular and scalable positioning and navigation system
WO2023246802A9 (zh) 割草方法、装置、割草机器人以及存储介质
CN111123909A (zh) 自行走设备的行走控制方法、系统及自行走设备
CN110063142B (zh) 割草机的回归方法和装置
WO2020088461A1 (zh) 行走机器人的控制方法及系统
CN116360443A (zh) 路线规划方法、装置、割草机器人以及存储介质
EP4270136A1 (en) Smart mowing system
WO2020088460A1 (zh) 行走机器人的控制方法及系统
WO2020103675A1 (zh) 机器人控制方法以及机器人系统
CN112204488B (zh) 自移动设备的工作方法及装置、自移动设备
JP2021018734A (ja) サーバ装置

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