基于快速扩展随机树的工程机械路径规划研究摘要：针对复杂作业环境下的工程机械路径规划问题，提出了一种基于快速扩展随机树的路径规划方法。首先分别对路径规划的目的、约束条件、任务环境建模、路径表述方法以及针对机械本体大小的障碍物膨化方法进行了分析论述，进而介绍了RRT算法的基本原理，并给出了基于RRT的路径规划算法步骤，最后通过仿真试验验证了所提方法的有效性和先进性。关键词：工程机械；路径规划；快速扩展随机树DOI：10.16640/j.cnki.37-1222/t.2017.21.2480前言以推土机、挖掘机为代表的工程机械，通常在地面崎岖、障碍物众多的复杂环境进行土石方作业。传统的人工驾驶方式是通过车载驾驶人员进行机械设备的现场操作，但是一些特殊领域，工作环境可能存在地面塌陷、山体垮塌等危险情况，会给驾驶人员的生命安全带来威胁。智能化、精准化、无人化代表了工程机械行业未来的发展方向[1]。通过无人化设计，实现操作人员对设备的远程遥控或者机械设备的任务级自主控制，能够极大的提高工程施工的安全性、拓宽工程机械的应用场合。路径规划是综合考虑移动主体的运动学、动力学约束，以及任务环境的地形地貌、障碍分布等情况，为移动主体规划出从起始位置到目标位置的可行路径或最优路径。路径规划是实现工程机械无人化作业的关键技术之一。常见的路径规划方法包括基于数学规划的方法，基于群体智能的规划方法、基于启发式计算的方法等[1，2]。其中混合整数线性规划为典型的数学规划方法，具有严格的数学理论依据，但随着规划问题的增大，其计算量会急剧增加，因此只适合于小规模的路径规划问题。以蚁群算法、遗传算法、粒子群算法为代表的群体智能优化方法具有内在的并行机制，全局优化能力强，但存在优化时间长，有时可能会规划失败等不足。人工势场方法也是一种常见的路径规划方法，能够在势场引力和势场斥力的综合作用下，将路径向着目标位置延伸，但也存在着存在引力和斥力相同的局部极小点问题，会导致规划失败。快速扩展随机树算法（Rapidly-exploringRandomTree，RRT）是一种基于空间采样的路径规划方法，由美国学者LaValle于上个世纪末提出[3]。RRT在任务空间内采用节点生长的方式构造随机树，逐步构建出连通起始位置与目标位置的可行路径。该算法具有参数少、结构简单、收敛速度快等优点，自算法提出后，逐渐得到的学术界的认可，已有的研究表明，RRT算法具有比A*算法、隨机路线图算法等原有的路径规划算法更高的优化效率[4]。本文采用RRT算法求解复杂工作环境下的工程机械路径规划问题，包括路径规划问题描述与数学建模、算法设计、仿真试验等内容。1问题描述自动地规划出工程机械的行驶路径，是未来的智能化和无人化工程机械实现自主行进与施工作业的重要前提。该路径规划问题可以描述为：（1）根据工作环境和任务要求，为工程机械生成从起始位置到目标位置的可行路径。（2）所得路径应能够避开已知的障碍物体或危险区域，保证设备的行进安全。（3）所得路径应满足机械设备的运动学和动力学约束，比如路径长度应小于工程机械的最大行程，转弯半径应符合工程机械的机动性能。机械的行进路径由任务区域中一系列的路径节点组成，路径节点的顺序对应着工程机械的依次需要到达的行进位置。用直线段连接相邻的路径节点。假设工程机械的起始位置为，目标位置为，第个路径节点表示为，其中分别为该路径节点位置的纵横向坐标，则从起始位置历经个路径节点到达目标位置的路径可以表示为：基于上述分析，可以采用二值化的任务环境建模方法。将障碍物、危险区域、机动性能受限区域等简化为具有同等威胁程度的不可行区域，即整个工作环境区分为威胁区域（不可行区域）和可行区域两种情况。威胁区域完全不可行，规划所得路径不能与威胁区域有重合。另外由于工程机械具有自身的形状和较大的外形尺寸，在实际的行驶时，需要避免车体与周围物体的碰撞，不能简单的将车体看作为没有尺寸大小的质点。在路径规划过程中，可以采用障碍物膨胀的方法，将车体的外形尺寸进行等效处理，即根据工程机械的车体大小，将障碍物或危险区域进行等值的膨胀放大处理。经膨胀处理之后，不但解...