一种基于缺苗优先级的穴盘补苗Floyd路径规划方法
本发明涉及穴盘补苗路径规划,具体为一种基于缺苗优先级的穴盘补苗floyd路径规划方法。
背景技术:
1、穴盘育苗是现代农业规模化生产中的重要环节。在育苗过程中,受种子活性和环境因素影响,部分穴孔会出现未出苗情况,需要补苗机械臂完成补苗作业。补苗路径规划决定了机械臂遍历所有缺苗穴孔的移动总距离,直接关系到作业效率与能耗。现有的补苗路径规划通常采用等间距栅格扫描方式或简单的最邻近搜索策略。
2、等间距栅格扫描方式不考虑穴盘上缺苗穴孔的实际分布状态,强制机械臂按固定行列顺序遍历全部穴孔,对不缺失的穴孔执行空跑动作。这种路径规划导致机械臂在健康苗区域消耗无效移动距离,随着缺苗率下降,空跑路径占比反而上升,造成作业时间的严重浪费。
3、最邻近搜索策略从机械臂当前位置出发,每次选择距离最近的未处理缺苗穴孔作为下一目标。该策略将全局路径规划拆解为多个局部最优选择,缺乏对穴盘内所有目标点整体空间分布的统筹。当缺苗穴孔在穴盘上呈现团块状聚集分布时,该策略可能在多个团块之间产生往返折线路径,后期访问的团块因前期选择被分隔而需要长距离跨越,累积形成的总里程远高于全局最优路径。这种贪心策略无法跳出局部最优解,导致补苗末端路径非最短。
4、另外,上述两种方式均未建立缺苗位置的差异化处理机制。所有缺苗穴孔在路径规划中被视为完全平等的待访问点,补苗顺序完全由空间位置或被扫描到的先后次序决定。实际作业中,不同区域的缺苗穴孔对路径整体长度的影响程度存在差异,高密度缺苗区域内的穴孔若被延后处理,会导致机械臂在完成大部分补苗任务后仍需返回该区域,产生额外的穿插移动距离。现有方法忽视了这一空间分布密度差异对路径总代价的潜在影响,降低了路径规划的紧凑度。
技术实现思路
1、本发明要解决的技术问题是,现有补苗路径规划方法未考虑缺苗穴孔的空间分布密度差异对路径整体代价的影响,且采用局部贪心策略无法获取全局最优的遍历顺序,导致补苗机械臂移动总距离增加、作业效率降低。针对上述问题,提出一种能够根据缺苗穴孔的局部聚集程度动态调整访问优先级,并基于该优先级生成全局最短遍历路径的穴盘补苗路径规划方法,以减少补苗机械臂的无效移动距离,提升补苗作业的整体效率。
2、为了实现上述目的,本发明提供如下技术方案:本发明提供一种基于缺苗优先级的穴盘补苗floyd路径规划方法,其核心在于通过引入缺苗穴孔的局部密度评估与时间戳加权机制,构建带优先级的补苗任务队列,并利用floyd算法对补苗机械臂的遍历路径进行全局优化,以最短的总移动距离高效完成穴盘补苗作业。
3、为实现上述目的,本发明采用的技术方案包括以下步骤:
4、获取待补苗穴盘的缺苗状态矩阵,该矩阵以数字标记的形式记录每个穴孔内是否存在幼苗缺失,从而将实际的农艺状态转化为可供系统处理的量化数据。
5、作为本发明的一个优选的技术方案,获取缺苗状态矩阵时,调用穴盘图像采集装置拍摄待补苗穴盘的俯视图并进行灰度化处理。对生成的穴盘灰度图进行方格化分割,提取与各穴孔一一对应的子图像块。计算每个子图像块的灰度均值,将其与预设的空穴灰度阈值比较,将灰度均值低于阈值的穴孔判定为缺苗穴孔并赋予第一标记值,不低于阈值的则赋予第二标记值,由此形成完整反映全盘缺苗分布的矩阵。
6、基于缺苗状态矩阵和预先建立的穴孔坐标映射表,构建初始补苗任务列表。该穴孔坐标映射表记录了穴盘上每个行列编号与物理空间坐标的固定对应关系。系统遍历矩阵中所有被赋予第一标记值的缺苗穴孔,提取其行列编号和物理空间坐标,并为每个缺苗穴孔附加一个由系统时间戳转换得到的缺苗时刻标记,将上述信息汇集成记录,生成初始补苗任务列表。该标记反映了缺苗被识别的时间先后,为后续的动态优先级计算提供依据。
7、在得到初始补苗任务列表后,遍历该列表中的每一个缺苗穴孔,提取其邻域缺苗密度并计算缺苗优先级权重。具体地,以当前处理的缺苗穴孔坐标为圆心,依照预设的邻域搜索半径划出一个圆形邻域范围,统计该范围内所有被标记为缺苗的穴孔数量,此数量即为邻域缺苗密度。该密度越高,代表该区域缺苗越集中,补苗的紧迫性也越强。将求得的邻域缺苗密度与该穴孔的缺苗时刻标记所对应的驻留时长进行加权求和,最终生成一个综合反映空间紧迫性与时间优先性的缺苗优先级权重。
8、基于此优先级权重对初始补苗任务列表中的全部缺苗穴孔进行降序排序,生成带优先级的补苗任务队列。为进一步优化路径的连贯性,优选的,在排序过程中检查相邻两个缺苗穴孔的物理空间坐标间的欧氏距离,当该距离小于预设的路径合并阈值时,将这两个空间上十分贴近的缺苗穴孔合并为一个任务节点,其坐标取二者之中点,从而减少路径规划的节点数量,提升后续算法运算效率与机械臂动作的流畅度。
9、在获得带优先级的补苗任务队列后,调用floyd算法计算补苗机械臂的最优遍历路径。根据本发明的技术方案,获取补苗机械臂末端执行器的当前空间坐标作为起始位置,并读取穴盘补苗流水线上补苗苗仓的入口坐标作为预设的回收位置,将这两个位置作为虚拟节点并入任务队列的所有节点中,构成路径计算节点集。系统为节点集中的每一个节点构建一个距离矩阵,矩阵中的元素值代表两个节点之间的移动代价。作为优选的移动代价计算方式,先计算两节点物理坐标间的曼哈顿距离作为原始移动代价,并检查两点间直线路径是否与穴盘边界或已知障碍物区域相交,若相交则在原始代价基础上叠加一个避障惩罚量,得到能反映真实通过成本的最终移动代价。将该距离矩阵输入floyd算法进行迭代计算,迭代至所有节点对之间的最短路径距离均被更新为全局最小值后终止。从floyd算法的运算结果中,依次提取当前起始位置到任务队列第一个节点、队列中顺序相邻节点之间直至队列最后一个节点到预设回收位置的最短路径子段,将所有子段按访问顺序首尾拼接,形成一条从起始点出发,按优先级依次遍历所有缺苗穴孔并最终返回回收位置的哈密顿路径,该路径即为总移动距离最小的最优遍历路径。
10、补苗机械臂依据此最优遍历路径执行补苗作业。当执行动态调整方案时,在机械臂的每次移动间隙,重新通过穴盘图像采集装置获取更新的缺苗状态矩阵,并与补前矩阵逐孔比对,实时识别新出现的缺苗穴孔。一旦发现新增缺失,即将其插入当前正在执行的路径队列中,并凭借floyd算法的高效性,从机械臂当前位置立刻重新规划访问剩余所有节点包括新插入节点的最优子路径,使整个补苗过程能够动态适应穴盘状态的变化。该方法将缺苗的空间分布密度、出现时序与机械臂全局路径优化深度结合,在确保遍历所有待补区域的同时,显著缩减了总移动距离和空行程,补苗效率与机械臂动作的节拍合理性得到协同提升。
11、在上述技术方案中,本发明提供的技术效果和优点:
12、通过计算每个缺苗穴孔的邻域缺苗密度并以此为依据生成缺苗优先级权重,建立了差异化的补苗任务队列。该权重计算方式从缺苗状态矩阵中提取目标穴孔周边圆形邻域范围内的缺苗穴孔数量,量化其空间聚集程度,同时引入缺苗时刻标记对应的驻留时长进行加权修正。依据该权重对缺苗穴孔进行降序排序并合并近距离任务点后,高密度缺苗区域的穴孔被统一安排在补苗任务队列的前段集中处理,低密度离散缺苗穴孔被调整至队列后段。这种排序策略使机械臂优先完成区域性密集补苗作业,后续离散补苗移动中无需再因返还高密度区域而产生长距离穿插位移,任务节点的空间排布更加紧凑连贯,有效压缩了补苗全过程的移动距离。
13、在带优先级的补苗任务队列基础上调用floyd算法计算最优遍历路径,求解当前起始位置、全部缺苗节点与预设回收位置之间所有节点对的最短距离。该算法对所有节点对的距离矩阵进行全源迭代计算,从输出结果中提取出一条从起始位置出发、按优先级顺序无遗漏访问所有任务节点并最终抵达回收位置的哈密顿路径。相比每次仅选择当前最近目标的最邻近单步决策方式,floyd算法同步计算所有节点对间的最短里程,通盘考虑路径串接过程中各段子路径的耦合关系,避免了因局部短期最优选择造成的全局路径折返与交叉。所得遍历路径实现了给定优先级顺序约束下的总移动距离最小化,为机械臂提供整体移动代价最低的补苗行进轨迹,消除了路径冗余,提升了单位时间内的有效补苗作业密度。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com