目标引导的苹果多目标连续采摘路径规划方法

本发明公开了一种目标引导的苹果多目标连续采摘路径规划方法，按以下步骤进行：一、初始化；采集苹果树的图像，建立苹果树的仿真三维模型，在三维工作空间X中生成树T；二、选择一个苹果确定当前目标节点q_goal；将苹果收集容器的位置作为初始节点q_init；三、迭代扩展；重复以下1－4，直到找到满足条件的路径：1、随机采样：从特定区域中随机采样一个普通节点q_rand；特定区域为锥状区域且其规定性为：q_init为顶点，q_goal为底面的圆心；q_init到q_goal的距离为h，底面半径为h/30.5；2、选择最近节点；3、扩展树；4、检查碰撞。四、路径生成：通过回溯生成路径。本发明改进RRT算法，使其更贴合苹果采摘的实际情况，提高路径规划效率，具有强扩展能力，最终生成的路径也更为平滑。