一种具备人体自动跟随功能的割草机器人及其控制方法与流程
本发明涉及智能园林机器人,尤其涉及一种具备人体自动跟随功能的割草机器人及其控制方法。
背景技术:
1、随着园林自动化设备的普及,智能割草机器人已广泛应用于庭院、园区、绿地等场景。目前市面主流割草机器人主要分为全自动规划式与遥控式两类。全自动规划式割草机器人依靠预设地图、边界线完成自主割草,作业路径固定,灵活性较差,无法适配临时修剪、局部补割等临时作业场景;遥控式割草机器人依靠人工手持遥控器控制行进、启停与转向,是当下临时作业、不规则区域割草的主流方案。
2、现有遥控式割草机器人主要通过无线遥控模块接收操控指令,人工持续操作遥控器控制机器人移动与切割作业。部分机型搭载视觉、雷达模块,可实现基础环境感知与避障,但均未集成人体自动跟随功能。在实际作业中,操作人员需一手操作遥控器、一手打理周边环境,双手被占用,长时间作业易产生疲劳;同时当需要引导机器人完成场地建图、划定定点切割区域时,操作人员需反复遥控走位,操作流程繁琐,作业效率偏低。
3、进一步地,现有技术中虽存在少数由操作人员引导的教学/示教模式(例如通过遥控器记录路径或沿预设边界线行走),但该类方案通常要求操作人员严格沿场地边界线行走,机器人仅能复现预设的边界路径,无法复刻操作人员在任意区域内的历史移动轨迹,更无法在复刻轨迹的同时进行适用于全局定位与导航的增量式地图构建。此外,该类方案将“边界建图”与“设备调度”两类任务混杂于同一遥控逻辑中,无法根据“路径优先”(建图)或“位置优先”(调度至定点)的不同语义需求进行针对性优化,导致建图灵活性差、定点调度步骤繁琐。
4、在实现本发明过程中,发明人发现现有技术还存在以下缺陷:
5、操作便捷性差:传统遥控式割草机器人全程依赖人工操控遥控器,操作人员无法解放双手,长时间户外作业劳动强度大,单人难以兼顾周边环境整理与机器人操控两项工作。
6、场地建图效率低:在进行草坪环境建图、划定作业区域时,操作人员需持续操控遥控器引导机器人遍历场地,走位控制精度低、耗时久,地图构建完整性与准确性易受人为操作影响。
7、定点切割灵活性不足:针对草坪局部杂草、边角区域等需要定点切割的场景,反复遥控调整机器人位置与姿态,操作步骤多,定位缓慢,无法快速响应临时局部割草需求。
8、人机配合性弱:作业过程中机器人与操作人员无联动,操作人员移动时需停下动作单独操控机器人,人机行动脱节,整体作业连贯性差。
9、建图与机器人位置调度无法兼得:现有遥控割草机器人在“沿边界采集”和“把设备调度到指定作业位置”两类任务中,均依赖人工反复操控遥控器,且二者控制逻辑混杂在同一遥控通道里,无法分别按“路径优先”和“位置优先”两种语义高效完成任务。
10、所以,现有技术方案都存在一些问题,还不能很好地满足割草机器人作业边界确定、场地建图及灵活调度等多方面的需求。
技术实现思路
1、本发明的目的是为了解决现有技术中的问题,而提出的一种具备人体自动跟随功能的割草机器人及其控制方法。
2、为了实现上述目的,本发明采用了如下技术方案:
3、本技术的一个方面,提供一种割草机器人的控制方法,包括如下步骤:
4、提供第一跟随模式和第二跟随模式;
5、当获取到模式选择信号时,根据所述模式选择信号控制所述割草机器人进入所述第一跟随模式或所述第二跟随模式;
6、其中,所述第一跟随模式为轨迹跟随建图模式,在所述轨迹跟随建图模式下,所述割草机器人复刻所述跟随对象的历史移动轨迹,并根据复刻的所述历史移动轨迹生成作业边界;所述第二跟随模式为实时位置跟随模式,在所述实时位置跟随模式下,所述割草机器人以预设跟随距离实时跟随所述跟随对象的当前位置直至到达目标位置。
7、在一些可实现的方式中,所述第一跟随模式包括如下步骤:
8、通过所述传感器模块检测跟随对象,所述跟随对象为人体或人体携带的目标特征;
9、控制所述割草机器人沿所述跟随对象的历史移动轨迹行驶,并在行驶过程中通过所述定位模块持续记录所述割草机器人的位置信息,以生成移动轨迹;
10、根据所述移动轨迹确定作业边界。
11、在一些可实现的方式中,控制所述割草机器人沿所述跟随对象的历史移动轨迹行驶,包括:
12、持续检测所述跟随对象的实时位置;
13、根据持续检测的所述实时位置,生成历史轨迹缓冲队列,所述历史轨迹缓冲队列用于存储所述跟随对象的位置序列;
14、从所述历史轨迹缓冲队列中依次取点,按照路径跟踪算法控制所述割草机器人逐点行驶。
15、在一些可实现的方式中,所述历史轨迹缓冲队列设置有距离阈值和最大容量上限;所述根据持续检测的所述实时位置,生成历史轨迹缓冲队列,包括:
16、每当所述跟随对象的实时位置相对于前一记录位置的移动距离大于或等于所述距离阈值时,将当前实时位置加入所述历史轨迹缓冲队列;
17、当所述历史轨迹缓冲队列中的位置数量达到所述最大容量上限时,以滚动覆盖的方式存储最新的位置序列;
18、所述距离阈值依据所述定位模块的定位精度与数据存储开销预设,优选为0.05m至0.2m。
19、在一些可实现的方式中,所述第二跟随模式包括如下步骤:
20、通过所述传感器模块检测跟随对象,所述跟随对象为人体或人体携带的目标特征;
21、持续检测所述跟随对象的实时位置;
22、根据所述跟随对象的实时位置与所述割草机器人的当前位置之间的相对位姿,控制所述割草机器人以预设跟随距离跟随所述跟随对象移动。
23、在一些可实现的方式中,所述根据所述跟随对象的实时位置与所述割草机器人的当前位置之间的相对位姿,控制所述割草机器人以预设跟随距离跟随所述跟随对象移动,包括:
24、根据所述割草机器人相对于所述跟随对象的相对位置信息,确定距离偏差值和角度偏差值;
25、将所述距离偏差值和所述角度偏差值作为输入,通过pid闭环控制算法计算所述割草机器人的移动信息;
26、根据所述移动信息控制所述割草机器人移动,以使所述割草机器人与所述跟随对象之间的距离趋近于所述预设跟随距离;
27、根据所述移动信息控制所述割草机器人移动,以使所述割草机器人与所述跟随对象之间的距离趋近于所述预设跟随距离。
28、在一些可实现的方式中,还包括速度自适应控制步骤:
29、所述割草机器人预设有多个速度档位;
30、实时获取所述割草机器人前方的障碍物距离信息;
31、根据所述障碍物距离信息与所述跟随对象的移动速度,从所述多个速度档位中确定目标速度档位;
32、控制所述割草机器人以所述目标速度档位对应的速度跟随所述跟随对象移动。
33、在一些可实现的方式中,还包括跟丢检测与恢复步骤:
34、当所述传感器模块连续丢失所述跟随对象的检测信号达到预设丢帧阈值时,判定进入跟丢状态;
35、在进入跟丢状态后的预设恢复时间内,控制所述割草机器人减速至低速档位,并沿最后一次有效检测的跟随对象运动方向进行预测搜索;
36、当超过所述预设恢复时间仍未重新检测到所述跟随对象时,控制所述割草机器人停止移动,并发出跟丢提示信号。
37、在一些可实现的方式中,还包括目标重锁定步骤:
38、当重新检测到人体时,提取当前检测到的人体的特征向量;
39、将所述特征向量与跟丢前锁定的目标人体的特征向量进行相似度比对;
40、当所述相似度大于预设相似度阈值时,将当前检测到的人体确定为所述跟随对象并恢复跟随;
41、所述特征向量通过预训练的卷积神经网络提取人体表观特征,并结合人体姿态估计模型提取骨架关键点坐标,将两者融合后经全连接层映射为固定长度的归一化特征向量。
42、在一些可实现的方式中,还包括多人场景目标锁定步骤:
43、当首次锁定跟随对象时,提取并存储目标人体的多维度特征向量,生成目标特征档案;
44、当视野中出现多个人员时,分别计算每个检测到的人体与所述目标特征档案的相似度;
45、将相似度最高者确定为所述跟随对象。
46、本技术的另一个方面,提供了一种具备人体自动跟随功能的割草机器人,包括:
47、定位模块,用于获取所述割草机器人的位置信息;
48、传感器模块,用于检测和跟踪跟随对象;
49、行走模块,用于驱动所述割草机器人移动;
50、无线通信模块,用于接收来自终端设备的模式选择信号和/或控制指令;
51、处理模块,配置为执行上述的控制方法。
52、与现有技术相比,本发明具有以下有益效果:
53、该割草机器人提供了两种独立可切换的人体跟随模式,将“沿轨迹建图”与“调度到位置”两类任务解耦,用户可根据实际需求按需切换。在轨迹跟随建图模式下,割草机器人复刻操作人员的历史移动轨迹并同步建图,无需人工遥控即可完成场地边界的确定,建图效率与完整性显著提升;在实时位置跟随模式下,割草机器人以设定距离实时跟随人体位置,可被快速引导至任意指定位置,省去反复遥控的繁琐操作。两种模式彻底摆脱了遥控依赖,操作人员无需持续手持遥控器即可引导机器人作业,降低了劳动强度,提升了整体作业效率。同时,速度自适应控制、跟丢检测与恢复、多人场景目标锁定、儿童识别与安全保护等机制的引入,进一步提高了人机协同的安全性和可靠性。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com