【技术实现步骤摘要】
一种无人驾驶插秧机作业路径规划方法及系统
[0001]本专利技术涉及智能控制
,特别涉及一种无人驾驶插秧机作业路径规划方法及系统。
技术介绍
[0002]亚洲的主要粮食是水稻。“民以食为天”,水稻种植的好坏影响着粮食的安全。近几年,由于城市化发展加快,越来越多的人口涌进城市。而水稻插秧需要大量的人力,这导致了人力短缺。同时田间经常出现农田中的树木、水泥墩或者树根等障碍物,插秧机在自动运行中,需要对这些障碍物进行避让。
[0003]现有技术CN201911011775提供了一种水稻无人驾驶插秧机全路径规划方法,通过北斗/GPS导航定位装置对作业区域进行分块规划路径进行插秧。现有技术CN201911011775缺乏根据农田中的障碍物对农田进行路径连续性规划。因此,亟需一种无人驾驶插秧机对障碍物避让的作业路径规划方法。
技术实现思路
[0004]本专利技术实施例提供的一种无人驾驶插秧机作业路径规划方法,包括:
[0005]采集所需插秧的田块的地理信息和障碍物的信息;
[0006]基于田块地理信息和障碍物的信息,构建插秧作业地图;
[0007]对插秧作业地图进行栅格化处理,得到作业栅格图;
[0008]基于回溯法,在作业栅格图上规划作业路径;
[0009]控制无人驾驶插秧机按照规划出的作业路径进行作业。
[0010]优选地,基于回溯法,在作业栅格图上规划作业路径;包括:
[0011]基于田块地理信息和障碍物信息,在作业栅格图确定不可作业栅格 ...
【技术保护点】
【技术特征摘要】
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的调整第一矩阵和调整第一边缘矩阵;其中,调整第一边缘矩阵是包含设定的终点的一维矩阵,调整第一边缘矩阵不含有不可作业栅格的对应的矩阵元素;其中,调整第一矩阵的调整终点以及调整第一边缘矩阵的起...
【专利技术属性】
技术研发人员:程卫根,沈卫青,
申请(专利权)人:盐城华曜农业生物科技有限公司,
类型:发明
国别省市:
还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。