基于AE-RRT*的煤矸分拣机器人避障拣轨迹规划方法

Obstacle avoidance trajectory planning method for coal gangue sorting robot based on AE-RRT*

  • 摘要: 煤矸分拣机器人工作时主要通过安装有末端执行器的机械臂将煤矸流中的矸石拣出,煤矸流随带式输送机移动,待分拣煤矸石周围物体对分拣过程有一定阻挡作用;现有机械臂轨迹规划算法大多以末端执行器快速接近目标矸石或安全抵达其上方为目标,未能兼顾机械臂在动态环境中运行的安全性和分拣效率;使用机械臂对煤矸石这类移动中的大质量物体进行分拣时,还需考虑同步抓取以降低末端执行器与目标间速度差导致的冲击载荷。为保证煤矸分拣机器人工作的安全性、提升分拣效率并避免冲击载荷损伤末端执行器,以具有三自由度笛卡尔坐标机械臂的煤矸分拣机器人为研究对象,提出一种基于改进RRT*的煤矸分拣机器人避障轨迹规划方法。首先,根据视觉识别系统获取的煤矸序列,以分拣收益函数为指标,将待分拣矸石任务分配至指定机械臂,结合末端执行器尺寸对障碍物进行适当膨化处理,将时间窗内其余煤与矸石建立为障碍环境,建立末端执行器与动态矸石间的同步跟踪约束关系;然后,使用人工势场法(Artificial potential fields)对RRT*算法路径扩展过程中新节点的生长方向进行引导,提升扩展的方向性,并针对人工势场法易陷入局部最优的问题提出一种环境敏感型目标偏置策略(Environment-sensitive target bias strategy),根据新节点所处位置的势场情况实时调整目标偏置概率阈值,提升路径局部特性,使用改进后的RRT*(AE-RRT*)对障碍环境中由起点前往目标矸石的避障路径进行求解,并使用贪心算法对路径冗余节点进行剪枝处理;最后,考虑同步约束与机械臂各关节速度、加速度约束,使用三阶B样条曲线进行跟踪动态煤矸石轨迹规划。实验结果表明:所提出的AE-RRT*相较于现有煤矸分拣机器人避障轨迹规划方法,路径长度分别减少18.97%、3.09%,相较于传统RRT*算法,路径长度平均减少5.92%、路径规划时间平均降低67.66%;所提出的煤矸分拣机器人避障轨迹规划方法相较于现有方法,在保证分拣效率的同时使机械臂末端抓取时刻位置与速度精度平均提升33.87%和51.88%,分拣动态煤矸石过程中顺利避开了移动障碍物且自身运行平稳。

     

    Abstract: When the coal gangue sorting robot works, the gangue in the coal gangue flow is mainly sorted out through the mechanical arm equipped with an end effector, and the coal gangue flow moves with the belt conveyor, and the objects around the coal gangue to be sorted have a certain blocking effect on the sorting process. Most of the existing manipulator trajectory planning algorithms aim at the end effector to quickly approach the target gangue or safely reach the target gangue, but fail to take into account the safety and sorting efficiency of the manipulator in the dynamic environment. When using a robotic arm to sort a moving mass object such as coal gangue, synchronous gripping should also be considered to reduce the shock load caused by the speed difference between the end effector and the target. In order to ensure the safety of the gangue sorting robot, improve the sorting efficiency and avoid the impact load damage to the end effector, it is necessary to carry out reasonable motion planning for the robotic arm. A coal gangue sorting robot with a three-degree-of-freedom Cartesian coordinate manipulator is taken as the research object, and a trajectory planning method for the obstacle avoidance trajectory of the coal gangue sorting robot based on improved and improved RRT* is proposed. Firstly, according to the coal gangue sequence obtained by the visual recognition system, the sorting income function was used as the index to assign the gangue task to the designated robotic arm, and the obstacle was appropriately expanded according to the size of the end effector, and the remaining coal and gangue in the time window were established as the obstacle environment, and the synchronous tracking constraint relationship between the end effector and the dynamic gangue was established. Then, the artificial potential fields method was used to guide the growth direction of the new nodes in the path expansion process of the RRT* algorithm, and the directionality of the expansion was improved, and an Environment-sensitive target bias strategy was proposed to solve the problem that the artificial potential field method is easy to fall into local optimum. According to the potential field of the new node, the target bias probability threshold is adjusted in real time, the local characteristics of the path are improved, and the improved RRT* (AE-RRT*) is used to solve the obstacle avoidance path from the starting point to the target gangue in the obstacle environment. Finally, considering the synchronization constraints and the velocity and acceleration constraints of each joint of the manipulator, the third-order B-spline curve was used to track the dynamic gangue trajectory planning. Experimental results show that compared with the existing obstacle avoidance trajectory planning methods of coal gangue sorting robots, the path length of the proposed AE-RRT* is reduced by 18.97% and 3.09%, respectively, and the path length and path planning time are reduced by 5.92% and 67.66% compared with the traditional RRT* algorithm. Compared with the existing methods, the proposed obstacle avoidance trajectory planning method for the coal gangue sorting robot can improve the position and speed accuracy of the end of the robotic arm by 33.87% and 51.88% on average while ensuring the sorting efficiency, and the moving obstacles are successfully avoided in the process of sorting dynamic coal gangue and its own operation is stable.

     

/

返回文章
返回