CN113534800B - 一种循迹控制方法、自动行走设备及可读存储介质 - Google Patents
一种循迹控制方法、自动行走设备及可读存储介质 Download PDFInfo
- Publication number
- CN113534800B CN113534800B CN202110791863.5A CN202110791863A CN113534800B CN 113534800 B CN113534800 B CN 113534800B CN 202110791863 A CN202110791863 A CN 202110791863A CN 113534800 B CN113534800 B CN 113534800B
- Authority
- CN
- China
- Prior art keywords
- boundary line
- signal
- automatic walking
- detector
- control method
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 59
- 230000008569 process Effects 0.000 claims abstract description 28
- 238000009966 trimming Methods 0.000 claims description 8
- 238000000926 separation method Methods 0.000 claims description 3
- 230000000694 effects Effects 0.000 abstract description 5
- 238000001514 detection method Methods 0.000 description 19
- 244000025254 Cannabis sativa Species 0.000 description 6
- 230000007257 malfunction Effects 0.000 description 3
- 230000008859 change Effects 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 230000007547 defect Effects 0.000 description 1
- 238000009434 installation Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
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/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
-
- A—HUMAN NECESSITIES
- A01—AGRICULTURE; FORESTRY; ANIMAL HUSBANDRY; HUNTING; TRAPPING; FISHING
- A01D—HARVESTING; MOWING
- A01D34/00—Mowers; Mowing apparatus of harvesters
- A01D34/006—Control or measuring arrangements
- A01D34/008—Control or measuring arrangements for automated or remotely controlled operation
-
- 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/0219—Control 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)
- Life Sciences & Earth Sciences (AREA)
- Environmental Sciences (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本申请提供一种循迹控制方法、自动行走设备及可读存储介质。本申请在自动行走设备沿边界线运行的过程中,以自动行走设备上的一个信号检测器为主检测器,保持该主检测器随同自动行走设备运行而往复地在边界线内外两侧之间交替摆动。由于本申请在主检测器运行至边界线外侧时即迅速驱动自动行走设备向内偏转,而在主检测器运行至边界线内侧时即迅速驱动自动行走设备向外偏转,因此,本申请能够有效限制机器沿边界线循迹运行过程中的摆头幅度,并通过选择不同位置的主检测器,控制自动行走设备底部作业单元相对于边界线的作业范围,从而保障工作区域边缘的作业效果或保护边界线不会被作业单元触碰。
Description
技术领域
本申请涉及自动行走设备领域,具体而言涉及一种循迹控制方法、自动行走设备及可读存储介质。
背景技术
目前割草机器人等自动行走设备在沿边界线返回基站或者割草作业过程中,需要利用图1所示的分别安装在设备两侧的两个信号检测器来检测机器人的位置信息。现有的自动行走设备同时通过其机身两侧的信号检测器采集边界线信号,通过分别识别两个信号检测器所采集的信号而在自动行走设备移动过程中确保两个信号检测器分别位于边界线的内外两侧,进而保证自动行走设备能够沿边界线行走。
采用上述循迹方式时自动行走设备采用固定的速度向前移动,当检测到两个信号检测器均位于边界线内侧或检测到两个信号检测器均位于边界线外侧时,判断设备偏航,需控制设备停下向相反方向偏转,调整其运行姿态。此过程中,由于现有自动行走设备的两个信号检测器分别位于机身左右两侧,两个信号检测器之间间距比较大,因此,现有自动行走设备通过其两信号检测器检测运行方向的偏转时,只能识别出较为严重的航向偏转,在沿边界线循迹运行过程中会产生比较明显的摆头。
发明内容
本申请针对现有技术的不足,提供一种循迹控制方法、自动行走设备及可读存储介质,本申请通过自动行走设备上的若干信号检测器检测自动行走设备与边界线之间位置关系,通过驱动自动行走设备保其中主检测器沿边界线内外两侧交替摆动而减少自动行走设备沿边界线循迹运行过程中的摆头幅度。本申请具体采用如下技术方案。
首先,为实现上述目的,提出一种循迹控制方法,用于自动行走设备,其中,所述自动行走设备上设置有至少一个信号检测器,自动行走设备沿边界线运行的过程中,仅以其中一个信号检测器为主检测器,执行以下步骤:当根据主检测器所接收的边界线信号判断其位于边界线外侧时,驱动自动行走设备向边界线内侧偏转;当根据主检测器所接收的边界线信号判断其位于边界线内侧时,驱动自动行走设备向边界线外侧偏转。
可选的,如上任一所述的循迹控制方法,其特征在于,自动行走设备沿边界线运行的过程中,当所述主检测器在边界线内外两侧交替摆动时,自动行走设备上的其他信号检测器始终不跨越边界线 。
可选的,如上任一所述的循迹控制方法,其特征在于,所述信号检测器包括分别设置在自动行走设备机身左侧、机身中部和机身右侧的三组。
可选的,如上任一所述的循迹控制方法,其特征在于,所述主检测器位于自动行走设备的机身中部。
可选的,如上任一所述的循迹控制方法,其特征在于,所述自动行走设备设置有默认模式和修边模式,默认模式下,在自动行走设备沿边界线运行的过程中,仅以其中位于机身中部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动;修边模式下,在自动行走设备沿边界线运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的外侧 。
可选的,如上任一所述的循迹控制方法,其特征在于,所述自动行走设备还设置有安全模式,安全模式下,在自动行走设备沿边界线运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的内侧 。
可选的,如上任一所述的循迹控制方法,其特征在于,所述边界线按照预设的信号周期辐射边界线信号,每个信号周期内,所述边界线信号均包括若干个标准脉冲和至少一个抗干扰脉冲,其中,抗干扰脉冲的脉冲宽度和/或脉冲幅值区别于标准脉冲;一个完整信号周期内,若任意信号检测器所接收到的边界线信号不包含抗干扰脉冲且其他信号检测器接收到完整边界线信号,则判断该信号检测器故障,或判断其当前所接收到的边界线信号为干扰信号一个完整信号周期内,若任意信号检测器一直处于无接收信号状态,且其他信号检测器接收到完整边界线信号,则判断该信号检测器故障。
可选的,如上任一所述的循迹控制方法,其特征在于,当任意信号检测器被判断为故障,则驱动自动行走设备移动预设距离或偏转预设角度,然后再次判断该信号检测器是否故障,如果该信号检测器仍被判断为故障,则更换其他信号检测器为主检测器,否则仍使用该信号检测器为主检测器 。
可选的,如上任一所述的循迹控制方法,其特征在于,当判断为故障的信号检测器为主检测器时,切换未发生故障的信号检测器作为主检测器。
可选的,如上任一所述的循迹控制方法,其特征在于,相邻信号检测器之间的间隔距离不低于:自动行走设备在边界线内外两侧交替摆动时垂直于边界线的运行速度分量与自动行走设备信号延迟时长之积。
可选的,如上任一所述的循迹控制方法,其特征在于,相邻信号检测器之间的间隔距离不低于5厘米。
同时,为实现上述目的,本申请还提供一种自动行走设备,其包括:至少一个信号检测器,用于接收边界线信号;驱动单元,其连接自动行走设备的控制单元,根据控制单元所输出的控制信号驱动自动行走设备运行;所述控制单元连接各信号检测器,被设置为按照如上任一所述的循迹控制方法输出控制信号,驱动自动行走设备沿边界线内外两侧交替摆动。
此外,本申请还提供一种可读存储介质,其包括存储在其上的程序指令,所述程序指令在被自动行走设备的控制单元执行时,使得所述控制单元执行如上任一项所述的循迹控制方法。
有益效果
本申请在自动行走设备沿边界线运行的过程中,以自动行走设备上的一个信号检测器为主检测器,保持该主检测器随同自动行走设备运行而往复地在边界线内外两侧之间交替摆动。由于本申请在主检测器运行至边界线外侧时即迅速驱动自动行走设备向内偏转,而在主检测器运行至边界线内侧时即迅速驱动自动行走设备向外偏转,因此,本申请能够有效限制机器沿边界线循迹运行过程中的摆头幅度,并通过选择不同位置的主检测器,控制自动行走设备底部作业单元相对于边界线的作业范围,从而保障工作区域边缘的作业效果或保护边界线不会被作业单元触碰。
本申请的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本申请而了解。
附图说明
附图用来提供对本申请的进一步理解,并且构成说明书的一部分,并与本申请的实施例一起,用于解释本申请,并不构成对本申请的限制。在附图中:
图1是现有自动行走设备中信号检测器的安装位置示意图;
图2是信号检测器位于边界线内侧时所采集到的信号的示意图;
图3是信号检测器位于边界线外侧时所采集到的信号的示意图;
图4是本申请的自动行走设备在第一种循迹模式下的运行方式示意图;
图5是本申请的自动行走设备在第二种循迹模式下的运行方式示意图;
图6是本申请的自动行走设备在第三种循迹模式下的运行方式示意图。
图中,1表示自动行走设备;2表示第一信号检测器;3表示第二信号检测器;4表示第三信号检测器;5表示边界线。
具体实施方式
为使本申请实施例的目的和技术方案更加清楚,下面将结合本申请实施例的附图,对本申请实施例的技术方案进行清楚、完整地描述。显然,所描述的实施例是本申请的一部分实施例,而不是全部的实施例。基于所描述的本申请的实施例,本领域普通技术人员在无需创造性劳动的前提下所获得的所有其他实施例,都属于本申请保护的范围。
本技术领域技术人员可以理解,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本申请所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
本申请中所述的“和/或”的含义指的是各自单独存在或两者同时存在的情况均包括在内。
本申请中所述的“内、外”的含义指的是相对于边界线本身而言,指向边界线所包围的工作区域内部的方向为内,反之为外;而非对本申请的装置机构的特定限定。
本申请中所述的“左、右”的含义指的是使用者正自动行走设备运行方向时,使用者的左边即为左,使用者的右边即为右,而非对本申请的装置机构的特定限定。
本申请中所述的“连接”的含义可以是部件之间的直接连接也可以是部件间通过其它部件的间接连接。
图1为根据本申请的一种自动行走设备,其配套设置有基站以及与基站相连的边界线。基站产生边界信号,通过与之相连的边界线5发送出来。自动行走设备可在机身外壳上设置至少一个信号检测器2,通过该信号检测器接收工作区域边界线所辐射的无线信号,通过控制单元根据预设值判断信号的合法性,判断出机器是在界内还是界外,由此调整驱动单元的驱动方向,设置其在机器需要回基站进行充电时,或者充满电沿边界线5割草时驱动自动行走设备沿边界线循迹运行;
其中的驱动单元,可连接自动行走设备的控制单元,根据控制单元所输出的控制信号相应的驱动自动行走设备运行,通过调节自动行走设备行走轮之间速度差实现行走方向的偏转或通过调整行走轮的方向直接驱动自动行走设备进行转向;
所述的控制单元连接各信号检测器,其由自动行走设备内部可读存储介质上所存储的程序指令设置为:在自动行走设备沿边界线5运行的过程中,仅以设备中的一个信号检测器为主检测器,在根据该主检测器所接收的边界线信号判断该主检测器位于边界线外侧时输出控制信号驱动自动行走设备向边界线内侧偏转,而在根据该主检测器所接收的边界线信号判断该主检测器位于边界线内侧时输出控制信号驱动自动行走设备向边界线外侧偏转,由此保证自动行走设备的主检测器在沿边界线循迹的过程中始终往复地在边界线内外两侧交替摆动,而其他各检测器始终保持在边界线的一侧,不会越过边界线。
由于本申请在主检测器每次越过边界线时即触发自动行走设备调整其行走方向,因此,本申请的自动行走设备沿边界线内外两侧摆动循迹行走时,其偏转的距离得以限制在较小范围,由此,本申请能够有效减小自动行走设备沿边界线行走时的摆动幅度。
由于上述步骤仅需单独一个主检测器即可实现,因此,在需要限制硬件成本的应用场景中,本申请可仅在自动行走设备的外壳上布置单独一个信号检测器,即可通过控制该信号检测器往复沿边界线内外两侧偏转而实现循迹行走。
在其他实现方式中,本申请还可通过图1所示的两个、图5所示的三个或更多信号检测器实现上述循迹控制过程。以割草机器人使用3个信号检测器为例,三个信号检测装置可分别安装在机器前端,分别为第一信号检测器2、第二信号检测器3和第三信号检测器,其中第三信号检测器4位于第一信号检测器2和第二信号检测器3中间。当需要循迹时,三个信号检测器分别把其所检测到的信号特征值,如,信号检测器位于界内、界外或者无信号,传递给自动行走设备的控制单元,控制单元根据三个信号检测器传递过来的信号信息,来决定机器人的运动状态。
由此,上述循迹过程可设置其中任意一个信号检测器作为主检测器,通过控制单元和驱动单元的配合,使得主检测器在循迹过程中始终沿边界线内外两侧交替摆动,并限制此时自动行走设备上的其他信号检测器始终不跨越边界线。由此,自动行走设备沿边界线左右偏转的幅度可通过其他检测器的检测信号而被限制在主检测器与相邻信号检测器的间隔距离内。
由于3个信号检测器可分别设置为主检测器,而3个信号检测器的位置分别设置在自动行走设备机身的左侧、中部和机身的右侧,因此,正常模式下,可参考图4所示,选择位于自动行走设备机身中部的信号检测器为主检测器。使自动行走设备按照中间信号头的检测信号沿边界线内外两侧小幅度摆动实现循迹行走。此循迹过程中,在自动行走设备沿边界线5逆时针运行的过程中,位于机身右侧的信号检测器始终保持在边界线外侧,位于机身左侧的信号检测器始终保持在边界线内侧,自动行走设备根据中间主检测器所检测到的边界线内外两侧的变化信号左右往复偏转,使机器主体保持在边界线上左右交替摆动。
上述的自动行走设备还可设置有修边模式和安全模式,分别利用其他位置的信号检测器实现循迹以调整自动行走设备相对于边界线的距离位置:
修边模式下,可参考图5所示,在自动行走设备沿边界线5运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使该主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的外侧。考虑到现有的割草机器人等自动行走设备,其割草刀盘或其他作业装置多设置于机身中间位置,实际割草过程中,位于边界线5边缘的草地容易被遗漏,特别是位于边界线5外侧一周的草地不会被割到。针对此问题,本申请可通过上述修边模式,在自动行走设备沿边界线循迹过程中,使设备底部的割草刀盘等作业装置随设备机身而偏向于边界线,甚至靠向边界线5以外,基本保持在边界线的上方进行作业,外扩了割草区域,使其切割范围最大,由此可保证对边界线附近草地的割草作业效果。
当自动行走设备运行故障需要返回基站时,可设置其切换至安全模式。安全模式下,可参考图6所示,在自动行走设备沿边界线5运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的内侧。由此,自动行走设备沿边界线循迹过程中,设备底部的割草刀盘等作业装置随设备机身而偏向于边界线内侧,基本保持在边界线的范围内进行作业,减小了割草机器人驶出边界线5的可能性,提高了安全性,由此可保护地面埋设的边界线,使其不易接触到割草刀盘等作业装置,保护边界线不易被误伤。适用于执行安全模式的设备故障不限于割草作业装置的驱动电机故障,也不限于设备中某个传感器故障。
实际运行过程中,修边模式和安全模式下具体使用哪一侧的信号检测器进行边界线5循迹行走需要根据机器的具体行走方向判定。
具体实现时,所述边界线可按照预设的信号周期辐射边界线信号,每个信号周期内,所述边界线信号均包括若干个标准脉冲和至少一个抗干扰脉冲,其中,抗干扰脉冲的脉冲宽度和/或脉冲幅值区别于标准脉冲。当自动行走设备在边界线限定的区域外时,检测装置识别出来的信号如图3所示。当自动行走设备在边界线限定的区域内时,检测装置识别出来的信号如图2所示。
上述的边界信号输出包括幅值Vmax大于阈值Vref+的峰值和小于Vmin的谷值。其中第一个峰值和第二个峰值可设置为标准脉冲,具有相等脉冲宽度;第三个峰值脉冲宽度加长可作为抗干扰脉冲,用来增强抗干扰性:
如果一个完整信号周期内,连续两个相等脉冲宽度的标准脉冲后,第三个信号不是特定加长的波峰值,则可当做干扰信号处理,判定信号检测器未接收到有效信号;
若任意信号检测器所接收到的边界线信号不包含抗干扰脉冲且其他信号检测器能够接收到完整边界线信号,则判断该信号检测器故障,或判断其当前所接收到的边界线信号为干扰信号;
一个完整信号周期内,若任意信号检测器一直处于无接收信号状态,且其他信号检测器均能接收到完整边界线信号,则判断该信号检测器故障。
考虑到信号检测器位于边界线正上方时,其接收到的内外两侧正负脉冲基本对冲,处于无接收信号的状态,因此,为避免这种情况下误判检测器故障,还可进一步的设置当任意信号检测器被判断为故障时,先驱动自动行走设备移动较小的预设距离或偏转一定的预设角度,使误判为故障的检测器能够离开边界线正上方,然后再次判断该信号检测器是否故障。如果移动、偏转后,该信号检测器仍被判断为故障,则可确认其确实存在故障情况,需要更换其他信号检测器为主检测器,以保证准确循迹;如果移动、偏转后,该信号检测器即能够接收到边界线信号,即可判断该检测器能够正常工作,可继续使用该信号检测器为主检测器。
具体实现时,以设备前端分别设置3个信号检测器为例,相邻信号检测器之间的间隔距离一般设置为不低于:自动行走设备在边界线内外两侧交替摆动时垂直于边界线的运行速度分量与自动行走设备信号延迟时长的乘积,或者设置为,相邻信号检测器之间的间隔距离不低于5厘米。由此可避免由于信号延迟导致割草机器人在摆动幅度较小的情况下,不止一个信号检测装置发生信号变化
此时,当三个信号检测器接收到的信号状态值都对应处于边界线内时,控制单元驱动机器继续前进,直至当三个信号检测值都到达界外时,控制系统控制机器人停止运行。此时可控制边界线附近的自动行走设备向界内转弯,当有机器中的一个信号检测器的检测值变为界内时,判断到达循迹路径范围,可先暂停运行,以进一步判断三个检测器相对于边界线的具体位置关系。当三个信号检测器传递到自动行走设备控制系统的值分别对应是界内、界外、界外时,可控制系统继续驱动行走电机,自动行走设备1先沿原方向行走至第三信号检测器的检测值发生变化,当第三信号检测器的检测值发生变化时,控制系统立即控制行走电机带动割草机器人转向,在整个行走过程中,确保第三信号检测器在界内和界外交替出现,如图4所示,达到机器人沿着边界线5平稳前进的目的。
实际使用过程中,上述自动行走设备也可以只通过2个或单个信号检测装置实现同样的循迹过程。假如多个信号检测装置中的某一个侧检测装置损坏,一直是无信号,也可以利用其于的信号检测装置进行沿边界线5循迹行走。
例如,若第一信号检测装置或第二信号检测装置损坏,此时,当完好的两个信号检测装置值从界内移动到界外时,可设置自动行走设备1向边界线5内转弯,使其中一个信号检测装置偏转至界内之后判断自动行走设备运行至边界线位置,并驱动自动行走设备继续沿边界线移动。此过程中,可设置其中一个信号检测装置始终位于边界线内或设置其中一个信号检测装置始终位于边界线外,而保持另一个信号检测装置的信号在界内、界外交替变化,使自动行走设备仍然能够平稳向前移动。当自动行走设备只有一个有效的信号检测装置时,也可以通过这一个信号检测装置的特征值,使其在界内和界外交替偏转,实现寻线驱动自动行走设备运行的目的。
综上,本申请可使用单个信号检测器,以该信号检测器为基准通过驱动自动行走设备在边界线界内和界外交替摆动的方式设置自动行走设备沿边界线循迹行走,减少机器摆动幅度。
对于安装有若干信号检测器的自动行走设备,本申请还可在运行过程中,在不同模式下分别以不同位置的信号检测器为主检测器,以主检测器的检测信号为基准控制自动行走设备的主检测器往复在边界线内外交替摆动进行边界线循迹行走,由此通过选择不同位置的主检测器调整自动行走设备相对于边界线的距离和偏转范围以提高机器割草效果或提升机器的安全性。
以上仅为本申请的实施方式,其描述较为具体和详细,但并不能因此而理解为对本申请专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本申请构思的前提下,还可以做出若干变形和改进,这些均属于本申请的保护范围。
Claims (12)
1.一种循迹控制方法,用于自动行走设备,其特征在于,所述自动行走设备上设置有至少一个信号检测器,自动行走设备沿边界线(5)运行的过程中,仅以其中一个信号检测器为主检测器,执行以下步骤:当根据主检测器所接收的边界线信号判断其位于边界线外侧时,驱动自动行走设备向边界线内侧偏转;
当根据主检测器所接收的边界线信号判断其位于边界线内侧时,驱动自动行走设备向边界线外侧偏转;
其中,自动行走设备沿边界线(5)运行的过程中,当所述主检测器在边界线内外两侧交替摆动时,自动行走设备上的其他信号检测器始终不跨越边界线。
2.如权利要求1所述的循迹控制方法,其特征在于,所述信号检测器包括分别设置在自动行走设备机身左侧、机身中部和机身右侧的三组。
3.如权利要求2所述的循迹控制方法,其特征在于,所述主检测器位于自动行走设备的机身中部。
4.如权利要求3所述的循迹控制方法,其特征在于,所述自动行走设备设置有默认模式和修边模式,默认模式下,在自动行走设备沿边界线(5)运行的过程中,仅以其中位于机身中部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动;
修边模式下,在自动行走设备沿边界线(5)运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的外侧。
5.如权利要求3所述的循迹控制方法,其特征在于,所述自动行走设备还设置有安全模式,安全模式下,在自动行走设备沿边界线(5)运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的内侧。
6.如权利要求1-5任一所述的循迹控制方法,其特征在于,所述边界线按照预设的信号周期辐射边界线信号,每个信号周期内,所述边界线信号均包括若干个标准脉冲和至少一个抗干扰脉冲,其中,抗干扰脉冲的脉冲宽度和/或脉冲幅值区别于标准脉冲;
一个完整信号周期内,若任意信号检测器所接收到的边界线信号不包含抗干扰脉冲且其他信号检测器接收到完整边界线信号,则判断该信号检测器故障,或判断其当前所接收到的边界线信号为干扰信号一个完整信号周期内,若任意信号检测器一直处于无接收信号状态,且其他信号检测器接收到完整边界线信号,则判断该信号检测器故障。
7.如权利要求6所述的循迹控制方法,其特征在于,当任意信号检测器被判断为故障,则驱动自动行走设备移动预设距离或偏转预设角度,然后再次判断该信号检测器是否故障,如果该信号检测器仍被判断为故障,则更换其他信号检测器为主检测器,否则仍使用该信号检测器为主检测器。
8.如权利要求7所述的循迹控制方法,其特征在于,当判断为故障的信号检测器为主检测器时,切换未发生故障的信号检测器作为主检测器。
9.如权利要求8所述的循迹控制方法,其特征在于,相邻信号检测器之间的间隔距离不低于:自动行走设备在边界线内外两侧交替摆动时垂直于边界线的运行速度分量与自动行走设备信号延迟时长之积。
10.如权利要求9所述的循迹控制方法,其特征在于,相邻信号检测器之间的间隔距离不低于5厘米。
11.一种自动行走设备,其特征在于,包括:
至少一个信号检测器,用于接收边界线信号;
驱动单元,其连接自动行走设备的控制单元,根据控制单元所输出的控制信号驱动自动行走设备运行;
所述控制单元连接各信号检测器,被设置为按照权利要求1所述的循迹控制方法输出控制信号,驱动自动行走设备沿边界线内外两侧交替摆动。
12.一种可读存储介质,其特征在于,包括存储在其上的程序指令,所述程序指令在被自动行走设备的控制单元执行时,使得所述控制单元执行权利要求1所述的循迹控制方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110791863.5A CN113534800B (zh) | 2021-07-13 | 2021-07-13 | 一种循迹控制方法、自动行走设备及可读存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202110791863.5A CN113534800B (zh) | 2021-07-13 | 2021-07-13 | 一种循迹控制方法、自动行走设备及可读存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN113534800A CN113534800A (zh) | 2021-10-22 |
CN113534800B true CN113534800B (zh) | 2023-08-15 |
Family
ID=78127788
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202110791863.5A Active CN113534800B (zh) | 2021-07-13 | 2021-07-13 | 一种循迹控制方法、自动行走设备及可读存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113534800B (zh) |
Citations (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103744425A (zh) * | 2012-08-23 | 2014-04-23 | 苏州宝时得电动工具有限公司 | 自动工作设备及其控制方法 |
CN106354141A (zh) * | 2016-11-02 | 2017-01-25 | 北京汽车集团有限公司 | 一种驾驶控制系统和方法 |
WO2018010650A1 (zh) * | 2016-07-11 | 2018-01-18 | 苏州宝时得电动工具有限公司 | 自动工作系统及自移动园艺设备的回归控制方法 |
CN108205313A (zh) * | 2016-12-19 | 2018-06-26 | 苏州宝时得电动工具有限公司 | 自动工作系统,自移动设备及其控制方法 |
CN112256013A (zh) * | 2019-07-05 | 2021-01-22 | 苏州科瓴精密机械科技有限公司 | 自动工作系统、自动行走设备及其控制方法 |
-
2021
- 2021-07-13 CN CN202110791863.5A patent/CN113534800B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103744425A (zh) * | 2012-08-23 | 2014-04-23 | 苏州宝时得电动工具有限公司 | 自动工作设备及其控制方法 |
WO2018010650A1 (zh) * | 2016-07-11 | 2018-01-18 | 苏州宝时得电动工具有限公司 | 自动工作系统及自移动园艺设备的回归控制方法 |
CN107608341A (zh) * | 2016-07-11 | 2018-01-19 | 苏州宝时得电动工具有限公司 | 自动工作系统及自移动园艺设备的回归控制方法 |
CN106354141A (zh) * | 2016-11-02 | 2017-01-25 | 北京汽车集团有限公司 | 一种驾驶控制系统和方法 |
CN108205313A (zh) * | 2016-12-19 | 2018-06-26 | 苏州宝时得电动工具有限公司 | 自动工作系统,自移动设备及其控制方法 |
CN112256013A (zh) * | 2019-07-05 | 2021-01-22 | 苏州科瓴精密机械科技有限公司 | 自动工作系统、自动行走设备及其控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN113534800A (zh) | 2021-10-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
EP2939513B1 (en) | Lawn mower robot and control method thereof | |
US11287821B2 (en) | Autonomous working system, an autonomous vehicle and a turning method thereof | |
US11188087B2 (en) | Autonomous working system, autonomous vehicle and steering method thereof | |
EP3324261B1 (en) | Automatic lawn mower robot and controlling method associated | |
CN109426264A (zh) | 自移动设备及其移动路径的控制方法 | |
CN106444736B (zh) | 自动返回系统及控制方法 | |
WO2017198222A1 (zh) | 自动工作系统,自移动设备及其控制方法 | |
CN107479546B (zh) | 自移动园艺设备 | |
CN113940186B (zh) | 一种智能割草机的控制方法 | |
WO2019223725A1 (zh) | 自动割草机及其转向方法 | |
US11800831B1 (en) | Vision system integration | |
CN109765899A (zh) | 自移动机器人系统 | |
WO2020155715A1 (zh) | 行走机器人及其转向控制方法、控制系统以及行走机器人工作系统 | |
EP2997808B1 (en) | A system for an optimised cutting of grass | |
EP2679083B1 (en) | Apparatus for cutting grass | |
CN113534800B (zh) | 一种循迹控制方法、自动行走设备及可读存储介质 | |
CN113950935B (zh) | 一种用于割草机器人的滑动式压力检测装置和割草机器人 | |
CN106982585B (zh) | 履带式割草机及其转向方法 | |
CN113534798B (zh) | 循迹返回控制方法、自动行走设备及可读存储介质 | |
EP3920002B1 (en) | Self-moving device and associated obstacle detection method | |
CN210222566U (zh) | 检测前方障碍物的移动机器人 | |
CN112230643A (zh) | 检测前方障碍物的移动机器人及其方法 | |
CN219644569U (zh) | 自动割草机 | |
JP7274741B2 (ja) | 自律制御型草刈機 | |
CN117898106A (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 |