一种基于Hybrid A*算法的自动驾驶农机平滑路径规划方法
摘要:
本发明涉及农机自动驾驶技术领域,公开了一种基于HybridA*算法的自动驾驶农机平滑路径规划方法,通过Step4中加入的偏航角信息,可以确保农机转向角度满足最小转弯半径的约束,达到了规划出带有非完整性约束的平滑路径的效果。能够规划出带有非完整性约束的平滑路径,通过Step2中加入启发函数h(n),可以保证始终朝着终点方向进行路径规划,减少非必须的行驶里程,通过Step2中的多目标代价函数g(n),可以保证农机尽量直线行驶,有效降低减速再加速的转向及掉头过程,达到有效提高自动驾驶农机作业效率的效果。
0/0