基于G-RRT*算法的煤矸石分拣机器人路径规划

Path planning of coal gangue sorting robot based on G-RRT* algorithm

  • 摘要: 由于煤矸石分拣环境复杂,为了避免机器人与障碍物发生碰撞,提高分拣效率,对机器人进行路径规划十分必要。分析了煤矸石分拣系统原理,将煤矸石分拣机器人路径规划问题归结为在障碍物环境下规划出一条从给定起点到目标点的无碰撞路径,且需同时满足速度快、避免与障碍物碰撞2个约束条件。结合笛卡尔空间和关节空间的优点,提出一种在关节空间进行路径规划、在笛卡尔空间进行碰撞检测的煤矸石分拣机器人路径规划方案,该方案不需要对机器人进行运动学求逆,且可避免在关节空间中描述障碍物。针对RRT*路径规划算法存在盲目性的问题,提出一种变概率的目标偏置策略,并将其引入RRT*算法,得到G-RRT*算法。变概率的目标偏置策略在无障碍物区域增大目标偏置概率值,以增强算法的目标导向性;而在障碍物区域减小目标偏置概率值,以保证算法的避障能力。G-RRT*算法将变概率的目标偏置策略与RRT*算法相结合,既保留了RRT*算法路径长度渐进最优的特点,也提高了算法的目标导向性,可极大地提高路径规划效率。实验结果表明,与加入固定概率目标偏置策略的RRT-Connect算法和RRT算法相比,采用G-RRT*算法得到的路径长度平均值最小,说明G-RRT*算法更适用于煤矸石分拣机器人路径规划。

     

    Abstract: The coal gangue sorting environment is complex. In order to avoid the collision between robot and obstacles and improve sorting efficiency, it is necessary to carry out path planning for robot. The principle of coal gangue sorting system is analyzed. The path planning problem of coal gangue sorting robot is summed up as planning a collision-free path from a given starting point to a target point in the environment of obstacles, and the two constraints of high speed and avoiding collision with obstacles must be met at the same time. Combining the advantages of Cartesian space and joint space, a path planning scheme for coal gangue sorting robot with path planning in joint space and collision detection in Cartesian space is proposed. The scheme does not need to carry out kinematic inversion of the robot, and can avoid describing obstacles in joint space. In order to solve the problem of blindness in the improved rapidly-exploring random trees (RRT*) path planning algorithm, a variable probability target bias strategy is proposed and introduced into RRT* algorithm to obtain the G-RRT* algorithm. The target bias strategy with variable probability increases the target bias probability in the obstacle-free area so as to enhance the target orientation of the algorithm. In the obstacle area, the target bias probability value is reduced to ensure the obstacle avoidance capability of the algorithm. The G-RRT* algorithm combines the variable probability target bias strategy with RRT* algorithm. The G-RRT* algorithm not only retains the asymptotic optimal path length characteristic of RRT* algorithm, but also improves the target orientation of the algorithm, and can improve the path planning efficiency greatly. The experimental results show that compared with RRT-Connect algorithm and RRT algorithm with fixed probability target bias strategy, the G-RRT* algorithm can get the shortest average path length, and is more suitable for path planning of coal gangue sorting robot.

     

/

返回文章
返回