基于动态引导点的遥操作农业车辆人机合作路径规划方法

摘要

本发明公开了一种基于动态引导点的遥操作农业车辆人机合作路径规划方法，其特征是，包括如下步骤:步骤1)对障碍物设立规划路径，障碍物位于线路SD上；步骤2)当路径搜索至障碍物的距离小于阈值时，显示前方有障碍物，将当前障碍物进行评估，生成一个合适的安全距离d＝Φ(xa,xb,xc)；步骤3)根据步骤2)得到的安全距离，设立不少于一个的引导点，形成多线段的避障路径。本发明所达到的有益效果：本方法通过进行人机合作路径规划，结合人的认知、经验于决策中，为规划路径提供合理的瞬时引导点，引导搜索树改变原始启发式路径，顺利绕过突发威胁源到达下一个引导场，能大大减少许多无用节点的生成，也避免了路径规划进入死循环。