论文部分内容阅读
采摘机器人的应用有利于缓解农业劳动力日趋不足的问题,能够大大提高农业产品的市场竞争力。但是采摘过程中障碍物阻碍采摘机器人机械臂的问题严重制约了采摘机器人在农业生产中的应用和发展。因此,开展采摘机器人机械臂避障路径规划方法的研究,有着十分重要的现实意义和广阔的应用前景。本文主要从三个方面展开研究:快速构形空间构建算法;机械臂碰撞模型建立方法;高维空间路径规划算法。快速构形空间构建算法。分析现有避障算法所存在的不足,结合油茶果采摘机器人机械臂的结构特点,选取构形空间作为本文的避障路径规划空间。对传统的机械臂构形空间构建方法所存在的不足进行分析,在此基础上提出一种由离线阶段和在线阶段构成的快速构形空间构建方法。算法在离线阶段通过遍历机械臂构形完成外部碰撞数据库和自碰撞数据库的建立。通过在线阶段计算出实时工作场景中的障碍物所占据的工作空间单元,并根据单元序号索引离线阶段所建立的两大数据库,快速构建机械臂在实时场景中的构形空间模型。机械臂碰撞模型的建立方法。通过对常用碰撞检测技术和空间包围盒优缺点的分析,确定以方向包围盒(Oriented Bounding Box,OBB)作为机械臂的碰撞检测拟合模型。利用固连在方向包围盒上的局部坐标系对方向包围盒各顶点坐标进行描述,并通过几何分析法和空间矢量法详细描述局部坐标系的建立过程,最后利用局部坐标系在基础坐标系中的齐次变换矩阵将方向包围盒在局部坐标系中的描述转换到基础坐标系中。高维空间路径规划算法。对路径规划中基于图形,基于启发,基于采样以及智能路径规划算法的优劣势进行详细的分析,在此基础上选择基于采样的路径规划算法进行本文的避障路径搜索。对双向快速扩展随机树算法(RRT-Connect)以及渐进快速扩展随机树算法(Asymptotically Optimal Rapidly-exploring Random Tree,RRT*)进行融合改进,得到一种双向渐进最优快速扩展随机树算法。通过与原始的RRT-Connect和RRT*算法的性能比较验证了融合算法的优势。本文通过虚拟仿真系统和采摘机器人机械臂实体样机进行方法的验证。结果显示,本文所提出的方法能够快速、有效地进行避障路径规划。