一种锚杆支护机器人工作臂轨迹规划方法及系统

摘要

本发明涉及一种锚杆支护机器人工作臂轨迹规划方法及系统，根据第一锚孔和第二锚孔的位置确定锚杆支护机器人工作臂的起止位置；在起止位置间进行工作臂末端关节的无障碍路径规划，确定工作臂末端关节的无障碍路径轨迹；将所述轨迹离散为若干个路径点，计算各路径点相对工作臂的关节坐标；基于工作臂摆动范围和各路径点相对工作臂的关节坐标，计算工作臂在相邻路径点间的运动时间，进而确定工作臂剩余关节的三次样条轨迹。采用三次样条插值法进行路径规划，保证工作臂可以经过预设路径点，满足锚杆支护机器人工作时的避障要求；且能够保证锚杆支护机器人工作臂在运动过程中对速度和加速度的连续性要求，使锚杆支护机器人工作臂运动平稳，无冲击。