一种油茶果采收机器人的全局路径规划方法及系统
本发明涉及路径规划,特别是指一种油茶果采收机器人的全局路径规划方法及系统。
背景技术:
1、在传统的油茶种植与采收作业中,果园巡检、施肥及采摘主要依赖人工或半机械化方式,存在作业效率低、劳动强度大、复杂地形适应性差等问题。近年来,基于建图与自主导航的全局路径规划技术为农业机器人实现无人化作业提供了重要支撑。
2、然而,在实际应用中,油茶果园的复杂环境特征给现有路径规划技术带来了一些挑战。
3、例如,通过slam技术获取的初始栅格地图常因建图初始朝向误差存在坐标系倾斜,且果树排列受自然生长影响往往不够规则,导致行列空间特征提取困难,有效通行易受不规则树冠挤压。
4、果园地面常存在起伏、沟壑或散落枝叶等非结构化地形,传统路径搜索算法生成的离散折线路径往往包含尖锐转角,难以满足履带式或轮式移动机器人非完整运动学约束,直接应用易导致底盘行驶颠簸、轨迹跟踪失稳。
5、机器人作业不仅需完成行间安全避障通行,还需在接近果树时向树冠侧向靠拢以配合机械臂进行精准采收,而现有全局规划路径多仅围绕行间中心线生成,缺乏向采收目标点平滑过渡的局部偏移机制,导致机器人定位突兀、机械臂作业位姿偏离最佳范围。
6、地头掉头区域空间受限,常规规划方法生成的掉头轨迹曲率突变较大,易造成机器人舵向控制量震荡。
技术实现思路
1、本发明提供了油茶果采收机器人的全局路径规划方法及系统,能够适应油茶果园复杂地形与不规则种植布局。
2、为解决上述技术问题,本发明的技术方案如下:
3、第一方面,一种油茶果采收机器人的全局路径规划方法,所述方法包括:
4、步骤1,获取油茶果园初始栅格地图,提取果树障碍物坐标并进行主成分分析得到点云主方向,根据主方向与地图坐标轴的夹角对初始栅格地图进行旋转校正,得到校正栅格地图;
5、步骤2,基于校正栅格地图拟合各行果树坐标点得到果树拟合直线,计算相邻果树拟合直线的中线,提取行间引导路径;
6、步骤3,基于行间引导路径构建含引导启发项与障碍斥力项的综合代价函数,采用改进a*算法进行避障搜索,对位于行间引导路径的节点进行代价降权,对距障碍小于安全阈值的节点叠加斥力代价,生成离散避障路径点集,并对离散避障路径点集进行平滑拟合,得到行间平顺巡航路径;
7、步骤4,基于行间平顺巡航路径识别校正栅格地图中每行果树末端的边界锚点,结合相邻行间距与机器人最小转弯半径生成地头掉头控制点,并采用贝塞尔曲线对行间平顺巡航路径的首尾端与地头掉头控制点进行平滑连接,得到地头掉头轨迹;
8、步骤5,将行间平顺巡航路径与地头掉头轨迹拼接为全局参考路径,基于全局参考路径确定各果树对应的采收目标点位姿,通过正弦平方分布函数构造平滑修正系数,在采收目标点位姿前后设定段内生成采收偏离曲线并对全局参考路径进行局部偏移,得到用于控制油茶果采收机器人的全局规划轨迹。
9、第二方面,油茶果采收机器人的全局路径规划系统,包括:
10、获取模块,用于获取油茶果园初始栅格地图,提取果树障碍物坐标并进行主成分分析得到点云主方向,根据主方向与地图坐标轴的夹角对初始栅格地图进行旋转校正,得到校正栅格地图;
11、提取模块,用于基于校正栅格地图拟合各行果树坐标点得到果树拟合直线,计算相邻果树拟合直线的中线,提取行间引导路径;
12、处理模块,用于基于行间引导路径构建含引导启发项与障碍斥力项的综合代价函数,采用改进a*算法进行避障搜索,对位于行间引导路径的节点进行代价降权,对距障碍小于安全阈值的节点叠加斥力代价,生成离散避障路径点集,并对离散避障路径点集进行平滑拟合,得到行间平顺巡航路径;
13、识别模块,用于基于行间平顺巡航路径识别校正栅格地图中每行果树末端的边界锚点,结合相邻行间距与机器人最小转弯半径生成地头掉头控制点,并采用贝塞尔曲线对行间平顺巡航路径的首尾端与地头掉头控制点进行平滑连接,得到地头掉头轨迹;
14、控制模块,用于将行间平顺巡航路径与地头掉头轨迹拼接为全局参考路径,基于全局参考路径确定各果树对应的采收目标点位姿,通过正弦平方分布函数构造平滑修正系数,在采收目标点位姿前后设定段内生成采收偏离曲线并对全局参考路径进行局部偏移,得到用于控制油茶果采收机器人的全局规划轨迹。
15、第三方面,一种计算设备,包括:
16、一个或多个处理器;
17、存储装置,用于存储一个或多个程序,当所述一个或多个程序被所述一个或多个处理器执行,使得所述一个或多个处理器实现所述的方法。
18、第四方面,一种计算机可读存储介质,所述计算机可读存储介质中存储有程序,该程序被处理器执行时实现所述的方法。
19、本发明的上述方案至少包括以下有益效果:
20、通过主成分分析提取果树点云主方向并据此对初始栅格地图进行旋转校正,有效消除了slam建图过程中的坐标系倾斜偏差,实现了果园地图坐标系的标准化对齐,为后续果树行直线拟合与空间特征提取提供了高精度、高一致性的地图基准,解决了初始地图倾斜导致行列特征提取错位的技术痛点。
21、基于校正栅格地图拟合果树拟合直线并计算相邻直线中线提取行间引导路径,能够自适应过滤离散异常点与自然生长带来的不规则干扰,精准还原实际作物行走向,确保机器人巡航基准线始终处于两行果树的安全居中位置,为后续避障搜索提供了稳定的空间参考基准。
22、构建包含引导路径启发项与障碍斥力项的综合代价函数,结合改进a*算法进行避障搜索,使路径扩展过程优先沿行间引导路径延伸,同时在靠近障碍物时自动叠加斥力代价实现动态绕行;配合三次b样条曲线对离散避障路径点集进行插值拟合与平滑处理,彻底消除了传统规划路径中的尖锐折角,输出具备高阶导数连续性的行间平顺巡航路径,完全契合移动底盘的非完整运动学约束,大幅提升了机器人行进的平稳性与复杂地形下的避障安全性。
23、通过识别每行果树末端边界锚点,结合相邻行间距与机器人最小转弯半径自适应生成地头掉头控制点,并利用三次贝塞尔曲线进行轨迹动态拟合,充分发挥了贝塞尔曲线的凸包特性与天然曲率连续优势,在空间受限的地头区域生成平滑过渡的掉头轨迹,避免了传统掉头路径曲率突变导致的舵向震荡与行驶失稳,保障了行间巡航与地头转向的无缝衔接。
24、基于全局参考路径精准计算各果树对应的采收目标点位姿,并引入正弦平方分布函数构造平滑修正系数,在目标点位姿前后设定段内生成采收偏离曲线对全局参考路径进行局部偏移。该设计使机器人能够在无作业区保持行间中线安全巡航,在接近目标果树时自动、平缓地向树侧偏移至机械臂最佳作业位姿,采摘完成后沿对称曲线平稳切回中线,有效解决了传统路径规划无法满足机械臂协同作业需求的技术瓶颈,提升了油茶果采收的自动化水平、轨迹跟踪精度与整体作业效率。
1.一种油茶果采收机器人的全局路径规划方法,其特征在于,所述方法包括:
2.根据权利要求1所述的一种油茶果采收机器人的全局路径规划方法,其特征在于,所述步骤1包括:
3.根据权利要求2所述的一种油茶果采收机器人的全局路径规划方法,其特征在于,所述步骤2包括:
4.根据权利要求3所述的一种油茶果采收机器人的全局路径规划方法,其特征在于,所述步骤3包括:
5.根据权利要求4所述的一种油茶果采收机器人的全局路径规划方法,其特征在于,所述步骤4包括:
6.根据权利要求5所述的一种油茶果采收机器人的全局路径规划方法,其特征在于,步骤5,将行间平顺巡航路径与地头掉头轨迹拼接为全局参考路径,基于全局参考路径确定各果树对应的采收目标点位姿,包括:
7.根据权利要求6所述的一种油茶果采收机器人的全局路径规划方法,其特征在于,通过正弦平方分布函数构造平滑修正系数,在采收目标点位姿前后设定段内生成采收偏离曲线并对全局参考路径进行局部偏移,得到用于控制油茶果采收机器人的全局规划轨迹,包括:
8.一种油茶果采收机器人的全局路径规划系统,该系统实现如权利要求1至8中任一项所述的方法,其特征在于,包括:
9.一种计算设备,其特征在于,包括:
10.一种计算机可读存储介质,其特征在于,所述计算机可读存储介质中存储有程序,该程序被处理器执行时实现如权利要求1至7中任一项所述的方法。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com