夏晶, 张昊, 周世宁, 朱蓉军, 马宏伟, 王鹏. 煤矸分拣机器人动态拣取避障路径规划[J]. 煤炭学报, 2021, 46(S1): 570-577. DOI: 10.13225/j.cnki.jccs.2020.1448
引用本文: 夏晶, 张昊, 周世宁, 朱蓉军, 马宏伟, 王鹏. 煤矸分拣机器人动态拣取避障路径规划[J]. 煤炭学报, 2021, 46(S1): 570-577. DOI: 10.13225/j.cnki.jccs.2020.1448
XIA Jing, ZHANG Hao, ZHOU Shining, ZHU Rongjun, MA Hongwei, WANG Peng. Dynamic picking and obstacle avoidance path planning of coal gangue sorting robot[J]. Journal of China Coal Society, 2021, 46(S1): 570-577. DOI: 10.13225/j.cnki.jccs.2020.1448
Citation: XIA Jing, ZHANG Hao, ZHOU Shining, ZHU Rongjun, MA Hongwei, WANG Peng. Dynamic picking and obstacle avoidance path planning of coal gangue sorting robot[J]. Journal of China Coal Society, 2021, 46(S1): 570-577. DOI: 10.13225/j.cnki.jccs.2020.1448

煤矸分拣机器人动态拣取避障路径规划

Dynamic picking and obstacle avoidance path planning of coal gangue sorting robot

  • 摘要: 针对煤矸分拣机器人在矸石拣取的过程中无法实时地避开大块障碍物、效率低且抓取目标矸石时会产生振动与冲击的问题,分析了煤矸分拣机器人现有拣矸方法的局限性以及动态路径规划算法对于煤矸分拣机器人的适用性,提出了一种适用于煤矸分拣机器人的动态拣取避障路径规划算法。首先在传统人工势场法的基础上将机器人与煤矸石的相对速度和相对加速度引入势场函数,势场产生的力驱使机器人到达目标矸石位置,且趋向于与矸石的运动保持一致,使煤矸分拣机器人具备动态环境下的实时避障能力以及对输送带变速运送的适应能力;其次,针对带式输送机对煤矸分拣机器人的末端位置约束,将高度约束引入势场函数,该势场力驱使煤矸分拣机器人在避障路径规划过程中避开带式输送机,保证机器人运动的合理性和安全性;最后,进行仿真和机器人试验,结果表明该算法能够实现煤矸分拣机器人的动态避障拣取,满足带式输送机对机器人的位置约束条件,且在到达矸石位置时机器人与矸石的相对速度、相对加速度为零,即机器人与目标矸石具有相同的运动趋势,在对目标矸石进行拣取时不会产生振动与冲击;与传统人工势场法进行对比试验,验证了所述算法在煤矸分拣机器人上的适用性和优越性。

     

    Abstract: In order to solve the problems that the coal gangue sorting robot cannot avoid large obstacles in real time, the efficiency of picking coal gangue is low, and the vibration and shock will be generated when grasping target gangue, the limitations of the traditional intercepting method of picking up coal gangue and the applicability of the dynamic programming algorithm to coal gangue sorting robots are analyzed, and a dynamic obstacle avoidance path planning algorithm suitable for coal gangue sorting robots is proposed.Firstly, this algorithm introduces relative speed and relative acceleration into the potential field function based on the traditional artificial potential field method.The potential field force acting on the coal gangue sorting robots drives the robot to reach the target gangue position, and tends to keep consistent with the movement of gangue, so that the coal gangue sorting robot has the capability of dynamic obstacle avoidance, the capability to adapt to variable-speed belt transportation.Then aiming at the end position constraint of belt conveyor to the coal gangue sorting robot, a height constraint is introduced into the potential field function.The potential field force drives the coal and gangue sorting robot to avoid the belt conveyor during the obstacle avoidance path planning, which ensures the rationality and safety of the robot movement.Finally, the simulation and robot experiment results show that the algorithm can realize the dynamic obstacle avoidance picking of coal gangue by sorting robot, meet the position constraints of the belt conveyor to the robot.When the robot reaches the position of gangue, the relative velocity and acceleration are zero, that is, the robot and the target gangue have the same movement trend, and there will be no vibration and shock during the gangue grasping.In the comparative experiment with the traditional artificial potential field method, the applicability and superiority of the proposed algorithm for the coal gangue sorting robot are verified.

     

/

返回文章
返回