一种残膜回收机防缠绕挑膜装置的制 一种秧草收获机用电力驱动行走机构

一种循迹控制方法、自动行走设备及可读存储介质与流程

2021-10-24 05:44:00 来源:中国专利 TAG:行走 设备 可读 控制 方法


1.本技术涉及自动行走设备领域,具体而言涉及一种循迹控制方法、自动行走设备及可读存储介质。


背景技术:

2.目前割草机器人等自动行走设备在沿边界线返回基站或者割草作业过程中,需要利用图1所示的分别安装在设备两侧的两个信号检测器来检测机器人的位置信息。现有的自动行走设备同时通过其机身两侧的信号检测器采集边界线信号,通过分别识别两个信号检测器所采集的信号而在自动行走设备移动过程中确保两个信号检测器分别位于边界线的内外两侧,进而保证自动行走设备能够沿边界线行走。
3.采用上述循迹方式时自动行走设备采用固定的速度向前移动,当检测到两个信号检测器均位于边界线内侧或检测到两个信号检测器均位于边界线外侧时,判断设备偏航,需控制设备停下向相反方向偏转,调整其运行姿态。此过程中,由于现有自动行走设备的两个信号检测器分别位于机身左右两侧,两个信号检测器之间间距比较大,因此,现有自动行走设备通过其两信号检测器检测运行方向的偏转时,只能识别出较为严重的航向偏转,在沿边界线循迹运行过程中会产生比较明显的摆头。


技术实现要素:

4.本技术针对现有技术的不足,提供一种循迹控制方法、自动行走设备及可读存储介质,本技术通过自动行走设备上的若干信号检测器检测自动行走设备与边界线之间位置关系,通过驱动自动行走设备保其中主检测器沿边界线内外两侧交替摆动而减少自动行走设备沿边界线循迹运行过程中的摆头幅度。本技术具体采用如下技术方案。
5.首先,为实现上述目的,提出一种循迹控制方法,用于自动行走设备,其中,所述自动行走设备上设置有至少一个信号检测器,自动行走设备沿边界线运行的过程中,仅以其中一个信号检测器为主检测器,执行以下步骤:当根据主检测器所接收的边界线信号判断其位于边界线外侧时,驱动自动行走设备向边界线内侧偏转;当根据主检测器所接收的边界线信号判断其位于边界线内侧时,驱动自动行走设备向边界线外侧偏转。
6.可选的,如上任一所述的循迹控制方法,其特征在于,自动行走设备沿边界线运行的过程中,当所述主检测器在边界线内外两侧交替摆动时,自动行走设备上的其他信号检测器始终不跨越边界线 。
7.可选的,如上任一所述的循迹控制方法,其特征在于,所述信号检测器包括分别设置在自动行走设备机身左侧、机身中部和机身右侧的三组。
8.可选的,如上任一所述的循迹控制方法,其特征在于,所述主检测器位于自动行走设备的机身中部。
9.可选的,如上任一所述的循迹控制方法,其特征在于,所述自动行走设备设置有默认模式和修边模式,默认模式下,在自动行走设备沿边界线运行的过程中,仅以其中位于机
身中部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动;修边模式下,在自动行走设备沿边界线运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的外侧 。
10.可选的,如上任一所述的循迹控制方法,其特征在于,所述自动行走设备还设置有安全模式,安全模式下,在自动行走设备沿边界线运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的内侧 。
11.可选的,如上任一所述的循迹控制方法,其特征在于,所述边界线按照预设的信号周期辐射边界线信号,每个信号周期内,所述边界线信号均包括若干个标准脉冲和至少一个抗干扰脉冲,其中,抗干扰脉冲的脉冲宽度和/或脉冲幅值区别于标准脉冲;一个完整信号周期内,若任意信号检测器所接收到的边界线信号不包含抗干扰脉冲且其他信号检测器接收到完整边界线信号,则判断该信号检测器故障,或判断其当前所接收到的边界线信号为干扰信号一个完整信号周期内,若任意信号检测器一直处于无接收信号状态,且其他信号检测器接收到完整边界线信号,则判断该信号检测器故障。
12.可选的,如上任一所述的循迹控制方法,其特征在于,当任意信号检测器被判断为故障,则驱动自动行走设备移动预设距离或偏转预设角度,然后再次判断该信号检测器是否故障,如果该信号检测器仍被判断为故障,则更换其他信号检测器为主检测器,否则仍使用该信号检测器为主检测器 。
13.可选的,如上任一所述的循迹控制方法,其特征在于,当判断为故障的信号检测器为主检测器时,切换未发生故障的信号检测器作为主检测器。
14.可选的,如上任一所述的循迹控制方法,其特征在于,相邻信号检测器之间的间隔距离不低于:自动行走设备在边界线内外两侧交替摆动时垂直于边界线的运行速度分量与自动行走设备信号延迟时长之积。
15.可选的,如上任一所述的循迹控制方法,其特征在于,相邻信号检测器之间的间隔距离不低于5厘米。
16.同时,为实现上述目的,本技术还提供一种自动行走设备,其包括:至少一个信号检测器,用于接收边界线信号;驱动单元,其连接自动行走设备的控制单元,根据控制单元所输出的控制信号驱动自动行走设备运行;所述控制单元连接各信号检测器,被设置为按照如上任一所述的循迹控制方法输出控制信号,驱动自动行走设备沿边界线内外两侧交替摆动。
17.此外,本技术还提供一种可读存储介质,其包括存储在其上的程序指令,所述程序指令在被自动行走设备的控制单元执行时,使得所述控制单元执行如上任一项所述的循迹控制方法。
18.有益效果本技术在自动行走设备沿边界线运行的过程中,以自动行走设备上的一个信号检测器为主检测器,保持该主检测器随同自动行走设备运行而往复地在边界线内外两侧之间交替摆动。由于本技术在主检测器运行至边界线外侧时即迅速驱动自动行走设备向内偏转,而在主检测器运行至边界线内侧时即迅速驱动自动行走设备向外偏转,因此,本技术能
够有效限制机器沿边界线循迹运行过程中的摆头幅度,并通过选择不同位置的主检测器,控制自动行走设备底部作业单元相对于边界线的作业范围,从而保障工作区域边缘的作业效果或保护边界线不会被作业单元触碰。
19.本技术的其它特征和优点将在随后的说明书中阐述,并且,部分地从说明书中变得显而易见,或者通过实施本技术而了解。
附图说明
20.附图用来提供对本技术的进一步理解,并且构成说明书的一部分,并与本技术的实施例一起,用于解释本技术,并不构成对本技术的限制。在附图中:图1是现有自动行走设备中信号检测器的安装位置示意图;图2是信号检测器位于边界线内侧时所采集到的信号的示意图;图3是信号检测器位于边界线外侧时所采集到的信号的示意图;图4是本技术的自动行走设备在第一种循迹模式下的运行方式示意图;图5是本技术的自动行走设备在第二种循迹模式下的运行方式示意图;图6是本技术的自动行走设备在第三种循迹模式下的运行方式示意图。
21.图中,1表示自动行走设备;2表示第一信号检测器;3表示第二信号检测器;4表示第三信号检测器;5表示边界线。
具体实施方式
22.为使本技术实施例的目的和技术方案更加清楚,下面将结合本技术实施例的附图,对本技术实施例的技术方案进行清楚、完整地描述。显然,所描述的实施例是本技术的一部分实施例,而不是全部的实施例。基于所描述的本技术的实施例,本领域普通技术人员在无需创造性劳动的前提下所获得的所有其他实施例,都属于本技术保护的范围。
23.本技术领域技术人员可以理解,除非另外定义,这里使用的所有术语(包括技术术语和科学术语)具有与本技术所属领域中的普通技术人员的一般理解相同的意义。还应该理解的是,诸如通用字典中定义的那些术语应该被理解为具有与现有技术的上下文中的意义一致的意义,并且除非像这里一样定义,不会用理想化或过于正式的含义来解释。
24.本技术中所述的“和/或”的含义指的是各自单独存在或两者同时存在的情况均包括在内。
25.本技术中所述的“内、外”的含义指的是相对于边界线本身而言,指向边界线所包围的工作区域内部的方向为内,反之为外;而非对本技术的装置机构的特定限定。
26.本技术中所述的“左、右”的含义指的是使用者正自动行走设备运行方向时,使用者的左边即为左,使用者的右边即为右,而非对本技术的装置机构的特定限定。
27.本技术中所述的“连接”的含义可以是部件之间的直接连接也可以是部件间通过其它部件的间接连接。
28.图1为根据本技术的一种自动行走设备,其配套设置有基站以及与基站相连的边界线。基站产生边界信号,通过与之相连的边界线5发送出来。自动行走设备可在机身外壳1上设置至少一个信号检测器2,通过该信号检测器接收工作区域边界线所辐射的无线信号,通过控制单元根据预设值判断信号的合法性,判断出机器是在界内还是界外,由此调整驱
动单元的驱动方向,设置其在机器需要回基站进行充电时,或者充满电沿边界线5割草时驱动自动行走设备沿边界线循迹运行;其中的驱动单元,可连接自动行走设备的控制单元,根据控制单元所输出的控制信号相应的驱动自动行走设备运行,通过调节自动行走设备行走轮之间速度差实现行走方向的偏转或通过调整行走轮的方向直接驱动自动行走设备进行转向;所述的控制单元连接各信号检测器,其由自动行走设备内部可读存储介质上所存储的程序指令设置为:在自动行走设备沿边界线5运行的过程中,仅以设备中的一个信号检测器为主检测器,在根据该主检测器所接收的边界线信号判断该主检测器位于边界线外侧时输出控制信号驱动自动行走设备向边界线内侧偏转,而在根据该主检测器所接收的边界线信号判断该主检测器位于边界线内侧时输出控制信号驱动自动行走设备向边界线外侧偏转,由此保证自动行走设备的主检测器在沿边界线循迹的过程中始终往复地在边界线内外两侧交替摆动,而其他各检测器始终保持在边界线的一侧,不会越过边界线。
29.由于本技术在主检测器每次越过边界线时即触发自动行走设备调整其行走方向,因此,本技术的自动行走设备沿边界线内外两侧摆动循迹行走时,其偏转的距离得以限制在较小范围,由此,本技术能够有效减小自动行走设备沿边界线行走时的摆动幅度。
30.由于上述步骤仅需单独一个主检测器即可实现,因此,在需要限制硬件成本的应用场景中,本技术可仅在自动行走设备的外壳上布置单独一个信号检测器,即可通过控制该信号检测器往复沿边界线内外两侧偏转而实现循迹行走。
31.在其他实现方式中,本技术还可通过图1所示的两个、图5所示的三个或更多信号检测器实现上述循迹控制过程。以割草机器人使用3个信号检测器为例,三个信号检测装置可分别安装在机器前端,分别为第一信号检测器2、第二信号检测器3和第三信号检测器,其中第三信号检测器4位于第一信号检测器2和第二信号检测器3中间。当需要循迹时,三个信号检测器分别把其所检测到的信号特征值,如,信号检测器位于界内、界外或者无信号,传递给自动行走设备的控制单元,控制单元根据三个信号检测器传递过来的信号信息,来决定机器人的运动状态。
32.由此,上述循迹过程可设置其中任意一个信号检测器作为主检测器,通过控制单元和驱动单元的配合,使得主检测器在循迹过程中始终沿边界线内外两侧交替摆动,并限制此时自动行走设备上的其他信号检测器始终不跨越边界线。由此,自动行走设备沿边界线左右偏转的幅度可通过其他检测器的检测信号而被限制在主检测器与相邻信号检测器的间隔距离内。
33.由于3个信号检测器可分别设置为主检测器,而3个信号检测器的位置分别设置在自动行走设备机身的左侧、中部和机身的右侧,因此,正常模式下,可参考图4所示,选择位于自动行走设备机身中部的信号检测器为主检测器。使自动行走设备按照中间信号头的检测信号沿边界线内外两侧小幅度摆动实现循迹行走。此循迹过程中,在自动行走设备沿边界线5逆时针运行的过程中,位于机身右侧的信号检测器始终保持在边界线外侧,位于机身左侧的信号检测器始终保持在边界线内侧,自动行走设备根据中间主检测器所检测到的边界线内外两侧的变化信号左右往复偏转,使机器主体保持在边界线上左右交替摆动。
34.上述的自动行走设备还可设置有修边模式和安全模式,分别利用其他位置的信号检测器实现循迹以调整自动行走设备相对于边界线的距离位置:
修边模式下,可参考图5所示,在自动行走设备沿边界线5运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使该主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的外侧。考虑到现有的割草机器人等自动行走设备,其割草刀盘或其他作业装置多设置于机身中间位置,实际割草过程中,位于边界线5边缘的草地容易被遗漏,特别是位于边界线5外侧一周的草地不会被割到。针对此问题,本技术可通过上述修边模式,在自动行走设备沿边界线循迹过程中,使设备底部的割草刀盘等作业装置随设备机身而偏向于边界线,甚至靠向边界线5以外,基本保持在边界线的上方进行作业,外扩了割草区域,使其切割范围最大,由此可保证对边界线附近草地的割草作业效果。
35.当自动行走设备运行故障需要返回基站时,可设置其切换至安全模式。安全模式下,可参考图6所示,在自动行走设备沿边界线5运行的过程中,仅以位于机身侧部的信号检测器为主检测器,驱动自动行走设备左右往复偏转,使其主检测器在边界线内外两侧交替摆动,并保持其他信号检测器始终位于边界线的内侧。由此,自动行走设备沿边界线循迹过程中,设备底部的割草刀盘等作业装置随设备机身而偏向于边界线内侧,基本保持在边界线的范围内进行作业,减小了割草机器人1驶出边界线5的可能性,提高了安全性,由此可保护地面埋设的边界线,使其不易接触到割草刀盘等作业装置,保护边界线不易被误伤。适用于执行安全模式的设备故障不限于割草作业装置的驱动电机故障,也不限于设备中某个传感器故障。
36.实际运行过程中,修边模式和安全模式下具体使用哪一侧的信号检测器进行边界线5循迹行走需要根据机器的具体行走方向判定。
37.具体实现时,所述边界线可按照预设的信号周期辐射边界线信号,每个信号周期内,所述边界线信号均包括若干个标准脉冲和至少一个抗干扰脉冲,其中,抗干扰脉冲的脉冲宽度和/或脉冲幅值区别于标准脉冲。当自动行走设备在边界线限定的区域外时,检测装置识别出来的信号如图3所示。当自动行走设备在边界线限定的区域内时,检测装置识别出来的信号如图2所示。
38.上述的边界信号输出包括幅值vmax大于阈值vref 的峰值和小于vmin的谷值。其中第一个峰值和第二个峰值可设置为标准脉冲,具有相等脉冲宽度;第三个峰值脉冲宽度加长可作为抗干扰脉冲,用来增强抗干扰性:如果一个完整信号周期内,连续两个相等脉冲宽度的标准脉冲后,第三个信号不是特定加长的波峰值,则可当做干扰信号处理,判定信号检测器未接收到有效信号;若任意信号检测器所接收到的边界线信号不包含抗干扰脉冲且其他信号检测器能够接收到完整边界线信号,则判断该信号检测器故障,或判断其当前所接收到的边界线信号为干扰信号;一个完整信号周期内,若任意信号检测器一直处于无接收信号状态,且其他信号检测器均能接收到完整边界线信号,则判断该信号检测器故障。
39.考虑到信号检测器位于边界线正上方时,其接收到的内外两侧正负脉冲基本对冲,处于无接收信号的状态,因此,为避免这种情况下误判检测器故障,还可进一步的设置当任意信号检测器被判断为故障时,先驱动自动行走设备移动较小的预设距离或偏转一定的预设角度,使误判为故障的检测器能够离开边界线正上方,然后再次判断该信号检测器
是否故障。如果移动、偏转后,该信号检测器仍被判断为故障,则可确认其确实存在故障情况,需要更换其他信号检测器为主检测器,以保证准确循迹;如果移动、偏转后,该信号检测器即能够接收到边界线信号,即可判断该检测器能够正常工作,可继续使用该信号检测器为主检测器。
40.具体实现时,以设备前端分别设置3个信号检测器为例,相邻信号检测器之间的间隔距离一般设置为不低于:自动行走设备在边界线内外两侧交替摆动时垂直于边界线的运行速度分量与自动行走设备信号延迟时长的乘积,或者设置为,相邻信号检测器之间的间隔距离不低于5厘米。由此可避免由于信号延迟导致割草机器人1在摆动幅度较小的情况下,不止一个信号检测装置发生信号变化此时,当三个信号检测器接收到的信号状态值都对应处于边界线内时,控制单元驱动机器继续前进,直至当三个信号检测值都到达界外时,控制系统控制机器人停止运行。此时可控制边界线附近的自动行走设备向界内转弯,当有机器中的一个信号检测器的检测值变为界内时,判断到达循迹路径范围,可先暂停运行,以进一步判断三个检测器相对于边界线的具体位置关系。当三个信号检测器传递到自动行走设备控制系统的值分别对应是界内、界外、界外时,可控制系统继续驱动行走电机,自动行走设备1先沿原方向行走至第三信号检测器的检测值发生变化,当第三信号检测器的检测值发生变化时,控制系统立即控制行走电机带动割草机器人1转向,在整个行走过程中,确保第三信号检测器在界内和界外交替出现,如图4所示,达到机器人沿着边界线5平稳前进的目的。
41.实际使用过程中,上述自动行走设备也可以只通过2个或单个信号检测装置实现同样的循迹过程。假如多个信号检测装置中的某一个侧检测装置损坏,一直是无信号,也可以利用其于的信号检测装置进行沿边界线5循迹行走。
42.例如,若第一信号检测装置或第二信号检测装置损坏,此时,当完好的两个信号检测装置值从界内移动到界外时,可设置自动行走设备1向边界线5内转弯,使其中一个信号检测装置偏转至界内之后判断自动行走设备运行至边界线位置,并驱动自动行走设备继续沿边界线移动。此过程中,可设置其中一个信号检测装置始终位于边界线内或设置其中一个信号检测装置始终位于边界线外,而保持另一个信号检测装置的信号在界内、界外交替变化,使自动行走设备仍然能够平稳向前移动。当自动行走设备只有一个有效的信号检测装置时,也可以通过这一个信号检测装置的特征值,使其在界内和界外交替偏转,实现寻线驱动自动行走设备运行的目的。
43.综上,本技术可使用单个信号检测器,以该信号检测器为基准通过驱动自动行走设备在边界线界内和界外交替摆动的方式设置自动行走设备沿边界线循迹行走,减少机器摆动幅度。
44.对于安装有若干信号检测器的自动行走设备,本技术还可在运行过程中,在不同模式下分别以不同位置的信号检测器为主检测器,以主检测器的检测信号为基准控制自动行走设备的主检测器往复在边界线内外交替摆动进行边界线循迹行走,由此通过选择不同位置的主检测器调整自动行走设备相对于边界线的距离和偏转范围以提高机器割草效果或提升机器的安全性。
45.以上仅为本技术的实施方式,其描述较为具体和详细,但并不能因此而理解为对本技术专利范围的限制。应当指出的是,对于本领域的普通技术人员来说,在不脱离本技术
构思的前提下,还可以做出若干变形和改进,这些均属于本技术的保护范围。
再多了解一些

本文用于企业家、创业者技术爱好者查询,结果仅供参考。

发表评论 共有条评论
用户名: 密码:
验证码: 匿名发表

相关文献

  • 日榜
  • 周榜
  • 月榜