一种果园采摘运输多机器人的任务分配和路径规划方法技术

本发明专利技术属于农业多机器人技术领域，具体涉及一种果园采摘运输多机器人的任务分配和路径规划方法，本方案包括的主要步骤如下：1.保障多机器人在无故障的状态下顺利采收，不断更新采收区域，并根据采收区域内正在行驶的机器人数量来划分机器人作业任务性质；2.在更新后的采收区域内有单个机器人正在行驶时，执行紧耦合任务分配，标记机器人状态为其规划到达目标点的最短路径；3.当更新后的采收区域内有2个以上的机器人正在行驶时，执行松耦合任务分配，为采摘运输多机器人建立配合顺序，标记机器人状态为其规划到达目标点的最短路径；4.根据机器人状态和机器人目标点是否清楚，为其计算准确的目标点，并建立从机器人当前位置到目标点的最短路径。标点的最短路径。标点的最短路径。

【技术实现步骤摘要】
一种果园采摘运输多机器人的任务分配和路径规划方法


[0001]本专利技术属于农业多机器人
，具体涉及一种果园采摘运输多机器人的任务分配和路径规划方法。

技术介绍

[0002]水果采收运输是果园种植生产中用工量最大的环节，且人力采摘时多浪费时间在果园行走中。即采用携带小型容器装满果品后，运送到地头的检验点，检验无损坏后将果品进行装箱。随着集约化种植模式的推广，适用于狭窄果园的小型采摘机器人开始进入果园替代人工采摘，而灵活性强的采摘机器人承重能力有限，仍需要往返在地头和果园之间，导致生产效率低下。
[0003]现有的多机器人任务分配多用于工厂AGV小车运输、无人机群编队、机器人足球大赛等应用环境中机器人的调度，多机器人的任务性质单一，多为松耦合或紧耦合。而果园采摘运输多机器人需要不断往返于采摘机器人和机器人仓库之间，其作业任务的性质并不固定，且同一棵树果品成熟的时间是不同的、机器人在运行过程中电量不断减少、承载重量不断增加，这些因素都会导致采摘运输多机器人的任务性质在松耦合和紧耦合之间来回转换，以及执行任务机器人的数量变换，同样地机器人的采收路径也是实时动态变化的。但果园有大量成排种植的果树，机器人可自由活动的区域较少。因此，在环境限制条件下，既能适应多机器人作业任务性质的转变，又能动态分配合理的任务量和行驶路径，是果园采摘运输多机器人任务分配和路径规划方法需要解决的问题。

技术实现思路

[0004]为了解决现有任务分配和路径规划方法存在的缺陷，本专利技术提出一种果园采摘运输多机器人的任务分配和路径规划方法，将紧耦合和松耦合相结合，根据环境变化的情况和机器人当前的状态，动态地规划采摘运输机器人的作业路径，实时地调整机器人的任务量。
[0005]本专利技术采用以下技术方案实现：
[0006]一种果园采摘运输多机器人的任务分配和路径规划方法，涉及集约化大规模种植的果园，分为松耦合任务分配和路径规划方法、紧耦合任务分配和路径规划方法，包括如下步骤：
[0007]S0：根据果园大小为采摘运输多机器人划分采收区域，同时获取果园可行驶路线，并记录机器人的编号和当前位置信息，并检查机器人是否故障，当发现机器存在故障问题，由采摘运输多机器人系统紧急调配新的机器人进行替换；
[0008]S1：在已更新的“1+2”采摘运输多机器人采收区域，根据采收区域内行驶机器人的数量是否大于等于2，将采摘运输多机器人的任务分配和路径规划划分为松耦合任务分配和路径规划和紧耦合任务分配和路径规划，每执行完一次任务，就判断机器人当前位置点是否为采收区域最后一个换接点，若否则更新采摘运输多机器人的采收区域，反之则任务
结束。
[0009]进一步地，本实施列中的松耦合任务分配，包括如下步骤：
[0010](1)获取“1+2”采摘或运输机器人采收区域及果园可行驶路线；
[0011](2)根据机器人当前位置信息判断是在机器人仓库还是采收区域内，当机器人在采收区域时进入步骤(3)。反之，在机器人仓库内则继续判断机器人电量是否在阈值范围内，电量不足时给机器人充电，电量充足时继续判断机器人承载量，有载重时清空，空载时则标记机器人状态为采收，并进入步骤(4)；
[0012](3)当机器人在已更新后采收区域内时，获取机器人编号，判断是否有突发故障的出现，当存在故障时，则返回S0；反之，则根据机器人的承载量和电量是否符合阈值要求，标记机器人状态为采收或返仓；
[0013](4)当机器人状态为采收或返仓时，根据机器人状态分别计算机器人和目标点之间的最短路径；
[0014]进一步地，当行驶的机器人数量超过2时，则执行本实施列中的紧耦合任务分配，包括如下步骤：
[0015](1)判断是否有突发故障，当存在突发故障时，则返回S0。当没有突发故障时，则继续判断当前位置点是否在机器人仓库，当在机器人仓库时，则继续判断是否符合满电量、空载的要求，不满足要求时则充电或清空。满足满电量和空载要求则进入步骤(3)；
[0016](2)当前位置点不在机器人仓库时，则继续判断是否电量、承载量是否符合阈值要求，当满足阈值要求时则标记机器人状态为返仓并返回机器人仓库；当不满足阈值要求时进入步骤(3)；
[0017](3)判断采收区域内最后一个换接点附近的果树是否已采摘，当果树已采摘，则标记机器人状态为返仓并返回机器人仓库。反之，则进入步骤(4)；
[0018](4)当采收区域内最后一个换接点附近的果树未采摘完，则标记多机器人状态为采收，行驶至已更新后的采收区域内，采收作业路径距离最短的换接点上，并按照划分区域内固定行间距逐棵开始采摘，记录正在采摘的第q棵树已采摘的果品数量和单个果品的重量，同时每采摘完一棵树就返回一次S1，并估算采摘运输多机器人采完第q棵树后的承载量最大和最小界限，并得到采完q棵树后较准确的承载量；
[0019](5)基于得到采摘至q棵树后运输车较准确的承载量，根据承载量与载重阈值差值，判断多机器人采摘下一棵树的位置是否在采收区域内的当前采摘行的换接点附近；
[0020](6)当下棵树在换接点附近时，新换接的机器人的位置在采摘机器人后方与采摘机器人相隔1米处，反之，新换接机器人的位置在采摘机器人前方与采摘机器人相隔1米处。根据新换接机器人的位置，建立多机器人间配合的顺序，并向新运输机器人发送目标点的消息，为运输机器人建立到目标点的最短路径；
[0021]进一步地，根据采摘运输多机器人的松耦合任务分配和紧耦合任务分配，为采摘运输多机器人规划最短的作业路径，包括如下步骤：
[0022](1)机器人标记状态为采收时，不清楚机器人在采收区域内采收的位置时，计算机器人到达采收区域的目标点并得到到达该点的最短路径；
[0023](2)机器人标记状态为采收时，清楚机器人在采收区域内继续采收的位置时，并得到到达该点的最短路径；
[0024](3)机器人标记状态为返仓时，得到机器人从当前位置点返回出入点1的最短路径；
[0025]本专利技术的有益效果在于：基于整数规划的分支定界法为采摘运输多机器人单次采收任务估算出最大的承载量，得到适宜地多机器人换接点。并利用路径优化算法，为采摘运输多机器人规划出到目标点的最短路径。同时，当机器人出现故障时，为替换的同类机器人规划出合适的路径。既保证采摘运输多机器人能正常协同作业，又能保证在机器人故障时采收工作能持续进行。
附图说明
[0026]以下将结合附图对本专利技术做进一步详细说明：
[0027]图1为本专利技术的任务分配规则流程图；
[0028]图2为本专利技术的松耦合任务分配流程图；
[0029]图3为本专利技术的紧耦合任务分配流程图；
[0030]图4为规划果园采摘运输多机器人最短作业路径示意图。
具体实施方式
[0031]以下结合附图对本专利技术作进一步的详细说明：
[0032]本实施例中，机器人仓库前采收区域外道路行走路线上的交叉点1为各机器人出入仓库的本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种果园采摘运输多机器人的任务分配和路径规划方法，分为松耦合任务分配和路径规划方法、紧耦合任务分配和路径规划方法，其特征在于，包括以下步骤：S0：根据果园大小为采摘运输多机器人划分采收区域(果园行≤k)，同时获取果园可行驶路线G(包含交叉点v
i
,道路行走路线e
i
‑1，换接点v
n
‑
j
，采收行走路线e
n
)，并记录机器人的编号(采摘机器人编号m，与该采摘机器人配套的运输机器人1编号m_1、运输机器人2编号m_2)和当前位置信息v
current
，并检查机器人是否故障，当发现机器存在故障问题，由采摘运输多机器人系统紧急调配新的机器人进行替换；S1：在已更新的“1+2”采摘运输多机器人采收区域，根据采收区域内行驶机器人的数量是否大于等于2，将采摘运输多机器人的任务分配和路径规划方法分为松耦合任务分配和路径规划方法和紧耦合任务分配和路径规划方法，且每执行完一次任务，就判断机器人当前位置点v
current
是否为采收区域最后一个换接点，若否则更新采摘运输多机器人的采收区域，反之则任务结束。2.根据权利要求1所述的一种果园采摘运输多机器人的任务分配和路径规划方法，其特征在于松耦合任务分配包括如下步骤：(1)获取“1+2”采摘运输机器人采收区域及果园可行驶路线；(2)根据机器人当前位置信息判断是在机器人仓库还是采收区域内，当机器人在采收区域时进入步骤(3)。反之，在机器人仓库内则继续判断机器人电量是否在阈值范围内，电量不足时给机器人充电，电量充足时继续判断机器人承载量，有载重时清空，空载时则标记机器人状态为采收，并进入步骤(4)；(3)当机器人在已更新后采收区域内时，获取机器人编号，判断是否有突发故障的出现，当存在故障时，则返回S0；反之，则根据机器人的承载量和电量是否符合阈值要求，标记机器人状态为采收或返仓；(4)当机器人状态为采收或返仓时，根据机器人状态分别为机器人规划到达目标点的最短路径。3.根据权利要求1所述的一种果园采摘运输多机器人的任务分配和路径规划方法，其特征在于紧耦合任务分配包括如下步骤：(1)判断是否有突发故障，当存在突发故障时，则返回S0。当没有突发故障时，则继续判断当前位置点是否在机器人仓库，当在机器人仓库时，则继续判断是否符合满电量、空载的要求，不满足要求时则充电或清空。满足满电量和空载要求则进入步骤(3)；(2)当前位置点不在机器人仓库时，则继续判断是否电量、承载量是否符合阈值要求，当满足阈值要求时则标记机器人状态为返仓并返回机器人仓库；当不满足阈值要求时进入步骤(3)；(3)判断采收区域内最后一个换接点附近的果树是否已采摘，当果树已采摘，则标记机器人状态为返仓并返回机器人仓库。反之，则进入步骤(4)；(4)当采收区域内最后一个换接点附近的果树...

【专利技术属性】
技术研发人员：杨福增，毛文菊，刘恒，
申请(专利权)人：西北农林科技大学，
类型：发明
国别省市：