一种无人驾驶插秧机作业路径规划方法及系统技术方案

本发明专利技术提供一种无人驾驶插秧机作业路径规划方法及系统，其中方法包括：采集所需插秧的田块的地理信息和障碍物的信息；基于田块地理信息和障碍物的信息，构建插秧作业地图；对插秧作业地图进行栅格化处理，得到作业栅格图；基于回溯法，在作业栅格图上规划作业路径；控制无人驾驶插秧机按照规划出的作业路径进行作业。本发明专利技术通过回溯法在作业栅格图上规划作业路径，对障碍物进行自动避障，同时实现插秧作业的连续性，防止了插秧机在田块上重复作业，减少了无人驾驶插秧机对秧田中的作物破坏。坏。坏。

【技术实现步骤摘要】
一种无人驾驶插秧机作业路径规划方法及系统


[0001]本专利技术涉及智能控制
，特别涉及一种无人驾驶插秧机作业路径规划方法及系统。

技术介绍

[0002]亚洲的主要粮食是水稻。“民以食为天”，水稻种植的好坏影响着粮食的安全。近几年，由于城市化发展加快，越来越多的人口涌进城市。而水稻插秧需要大量的人力，这导致了人力短缺。同时田间经常出现农田中的树木、水泥墩或者树根等障碍物，插秧机在自动运行中，需要对这些障碍物进行避让。
[0003]现有技术CN201911011775提供了一种水稻无人驾驶插秧机全路径规划方法，通过北斗/GPS导航定位装置对作业区域进行分块规划路径进行插秧。现有技术CN201911011775缺乏根据农田中的障碍物对农田进行路径连续性规划。因此，亟需一种无人驾驶插秧机对障碍物避让的作业路径规划方法。

技术实现思路

[0004]本专利技术实施例提供的一种无人驾驶插秧机作业路径规划方法，包括：
[0005]采集所需插秧的田块的地理信息和障碍物的信息；
[0006]基于田块地理信息和障碍物的信息，构建插秧作业地图；
[0007]对插秧作业地图进行栅格化处理，得到作业栅格图；
[0008]基于回溯法，在作业栅格图上规划作业路径；
[0009]控制无人驾驶插秧机按照规划出的作业路径进行作业。
[0010]优选地，基于回溯法，在作业栅格图上规划作业路径；包括：
[0011]基于田块地理信息和障碍物信息，在作业栅格图确定不可作业栅格和可作业栅格；
[0012]基于无人驾驶插秧机的起始位置，在作业栅格图上确定起始栅格；
[0013]将作业栅格图转化成第一矩阵；
[0014]基于第一矩阵和起始栅格，利用回溯法进行路径探索，得到第二矩阵；
[0015]将第二矩阵投射到作业栅格图上，并根据第二矩阵的数值大小规划出无人驾驶插秧机作业路径。
[0016]优选地，将作业栅格图转化成第一矩阵；包括：
[0017]将不可作业栅格对应的第一矩阵的矩阵元素标志为
‑
1；
[0018]基于起始栅格对应的的第一矩阵的起始矩阵元素标志为1，将与起始矩阵元素相邻未标志的可作业栅格对应的第一矩阵元素标志为0；
[0019]将与标志为0的可作业栅格的相邻未标志的可作业栅格对应的第一矩阵元素标志为1；
[0020]将与标志为1的可作业栅格的相邻的未标志的可作业栅格对应的第一矩阵元素标
志为0；
[0021]以此类推将作业栅格图中的所有栅格全部标志完成后，得到第一矩阵。
[0022]优选地，基于第一矩阵和起始栅格，进行路径探索，得到第二矩阵；包括：
[0023]统计第一矩阵中的标志为1的矩阵元素数量和标志为0的矩阵元素数量；
[0024]判断标志为1的矩阵元素数量与标志为0的矩阵元素数量是否相差为1；
[0025]若相差为1，则基于起始矩阵元素，进行路径方向上探索，得到第二矩阵；
[0026]若相差不为1，则先将第一矩阵拆分成标志为1的矩阵元素数量与标志为0的矩阵元素数量相差为1的调整第一矩阵和调整第一边缘矩阵，再基于调整第一矩阵和调整第一边缘矩阵分别进行路径方向上探索并合并，得到第二矩阵。
[0027]优选地，若相差为1，则基于起始矩阵元素，进行路径方向上探索，得到第二矩阵；包括：
[0028]以起始矩阵元素对应的第二矩阵的矩阵元素标志为1，并以起始矩阵元素为起点，在第一矩阵上可作业栅格的对应的矩阵元素向进行上下左右方向上的移动；
[0029]若移动到某一矩阵元素上无法移动，判断是否达到终点，若达到终点，则停止移动；若未达到终点，则回撤一步，继续向其他方向上移动，至到移动到终点；
[0030]计算所有可作业栅格的对应的矩阵元素的移动步数并加1，作为第二矩阵对应的某一矩阵元素数值，得到第二矩阵。
[0031]优选地，若相差不为1，则先将第一矩阵拆分成标志为1的矩阵元素数量与标志为0的矩阵元素数量相差为1的调整第一矩阵和调整第一边缘矩阵，再基于调整第一矩阵和调整第一边缘矩阵进行路径方向上探索，得到第二矩阵；包括：
[0032]对第一矩阵进行拆分成标志为1的矩阵元素数量与标志为0的矩阵元素数量相差为1的调整第一矩阵和调整第一边缘矩阵；
[0033]其中，调整第一边缘矩阵是包含设定的终点的一维矩阵，调整第一边缘矩阵不含有不可作业栅格的对应的矩阵元素；
[0034]其中，调整第一矩阵的调整终点以及调整第一边缘矩阵的起点和终点是第一矩阵的边缘矩阵元素；
[0035]对调整第一矩阵进行路径方向上探索，得到调整第一矩阵；
[0036]其中，包括：
[0037]以起始矩阵元素对应的调整第二矩阵的矩阵元素标志为1，并以起始矩阵元素为起点，在调整第一矩阵上可作业栅格的对应的矩阵元素向进行上下左右方向上的移动；
[0038]若移动到某一矩阵元素上无法移动，判断是否达到调整终点，若达到调整终点，则停止移动；若未达到调整终点，则回撤一步，继续向其他方向上移动，至到移动到设定的调整第一矩阵的调整终点；
[0039]计算所有可作业栅格的对应的矩阵元素的移动步数并加1，作为调整第二矩阵对应的某一矩阵元素数值，得到调整第二矩阵；
[0040]对调整第一边缘矩阵的起点重新标志为1，从调整第一边缘矩阵的起点到终点，按照顺序序列进行标志，得到调整边缘第二矩阵；
[0041]将调整第二矩阵与调整边缘第二矩阵进行合并，得到第二矩阵。
[0042]优选地，将第二矩阵对应到作业栅格图上，得到无人驾驶插秧机作业路径；包括：
[0043]以起始矩阵元素为起点，按照第二矩阵中的可作业栅格的对应的矩阵元素数值大小依次进行线段连接，得到第二矩阵规划路线；
[0044]将第二矩阵规划路线投射到作业栅格图，得到无人驾驶插秧机作业路径；
[0045]控制无人驾驶插秧机按照作业路径进行作业；
[0046]当无人驾驶插秧机作业完成某一区域，则某一区域对应的作业栅格图上的可作业栅格转化为不可作业栅格；
[0047]当作业栅格图上的可作业栅格全部转化为不可作业栅格，无人驾驶插秧机完成作业，驶出作业区域。
[0048]优选地，无人驾驶插秧机作业路径规划方法，还包括：
[0049]基于障碍物的类型，对障碍物进行清理并在作业栅格图中将不可作业栅格转化成可作业栅格；
[0050]其中，基于障碍物的类型，对障碍物进行清理并在作业栅格图中将不可作业栅格转化成可作业栅格；包括：
[0051]利用历史数据构建清障方案数据库；
[0052]其中，清障方案数据库包括障碍物的类型以及障碍物的类型对应的清障方案；
[0053]将采集到的障碍物的信息输入到清障方案数据库，检索出对应的清障方案；
[0054]基于清障方案，控制无人机对障碍物进行本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.一种无人驾驶插秧机作业路径规划方法，其特征在于，包括：采集所需插秧的田块的地理信息和障碍物的信息；基于田块地理信息和障碍物的信息，构建插秧作业地图；对插秧作业地图进行栅格化处理，得到作业栅格图；基于回溯法，在作业栅格图上规划作业路径；控制无人驾驶插秧机按照规划出的作业路径进行作业。2.如权利要求1所述的一种无人驾驶插秧机作业路径规划方法，其特征在于，基于回溯法，在作业栅格图上规划作业路径，包括：基于田块地理信息和障碍物信息，在作业栅格图确定不可作业栅格和可作业栅格；基于无人驾驶插秧机的起始位置，在作业栅格图上确定起始栅格；将作业栅格图转化成第一矩阵；基于第一矩阵和起始栅格，利用回溯法进行路径探索，得到第二矩阵；将第二矩阵投射到作业栅格图上，并根据第二矩阵的数值大小规划出无人驾驶插秧机作业路径。3.如权利要求2所述的一种无人驾驶插秧机作业路径规划方法，其特征在于，将作业栅格图转化成第一矩阵，包括：将不可作业栅格对应的第一矩阵的矩阵元素标志为
‑
1；基于起始栅格对应的的第一矩阵的起始矩阵元素标志为1，将与起始矩阵元素相邻未标志的可作业栅格对应的第一矩阵元素标志为0；将与标志为0的可作业栅格的相邻未标志的可作业栅格对应的第一矩阵元素标志为1；将与标志为1的可作业栅格的相邻的未标志的可作业栅格对应的第一矩阵元素标志为0；以此类推将作业栅格图中的所有栅格全部标志完成后，得到第一矩阵。4.如权利要求3所述的一种无人驾驶插秧机作业路径规划方法，其特征在于，基于第一矩阵和起始栅格，进行路径探索，得到第二矩阵，包括：统计第一矩阵中的标志为1的矩阵元素数量和标志为0的矩阵元素数量；判断标志为1的矩阵元素数量与标志为0的矩阵元素数量是否相差为1；若相差为1，则基于起始矩阵元素，进行路径方向上探索，得到第二矩阵；若相差不为1，则先将第一矩阵拆分成标志为1的矩阵元素数量与标志为0的矩阵元素数量相差为1的调整第一矩阵和调整第一边缘矩阵，再基于调整第一矩阵和调整第一边缘矩阵分别进行路径方向上探索并合并，得到第二矩阵。5.如权利要求4所述的一种无人驾驶插秧机作业路径规划方法，其特征在于，若相差为1，则基于起始矩阵元素，进行路径方向上探索，得到第二矩阵，包括：以起始矩阵元素对应的第二矩阵的矩阵元素标志为1，并以起始矩阵元素为起点，在第一矩阵上可作业栅格的对应的矩阵元素向进行上下左右方向上的移动；若移动到某一矩阵元素上无法移动，判断是否达到终点，若达到终点，则停止移动；若未达到终点，则回撤一步，继续向其他方向上移动，至到移动到终点；计算所有可作业栅格的对应的矩阵元素的移动步数并加1，作为第二矩阵对应的某一矩阵元素数值，得到第二矩阵。
6.如权利要求4所述的一种无人驾驶插秧机作业路径规划方法，其特征在于，若相差不为1，则先将第一矩阵拆分成标志为1的矩阵元素数量与标志为0的矩阵元素数量相差为1的调整第一矩阵和调整第一边缘矩阵，再基于调整第一矩阵和调整第一边缘矩阵进行路径方向上探索，得到第二矩阵，包括：对第一矩阵进行拆分成标志为1的矩阵元素数量与标志为0的矩阵元素数量相差为1的调整第一矩阵和调整第一边缘矩阵；其中，调整第一边缘矩阵是包含设定的终点的一维矩阵，调整第一边缘矩阵不含有不可作业栅格的对应的矩阵元素；其中，调整第一矩阵的调整终点以及调整第一边缘矩阵的起...

【专利技术属性】
技术研发人员：程卫根，沈卫青，
申请(专利权)人：盐城华曜农业生物科技有限公司，
类型：发明
国别省市：