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

    公开(公告)号:CN114227695B

    公开(公告)日:2023-09-08

    申请号:CN202210026005.6

    申请日:2022-01-11

    IPC分类号: B25J9/16

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

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

    公开(公告)号:CN114193449A

    公开(公告)日:2022-03-18

    申请号:CN202111494905.5

    申请日:2021-12-09

    IPC分类号: B25J9/16

    摘要: 本发明属于锚杆支护机器人自动锚杆支护作业的技术领域,具体是一种锚杆支护机器人工作臂轨迹规划方法。包括以下步骤,S100~确定巷道安装锚杆处相对锚护机器人的位置信息;S200~确定锚杆支护机器人工作臂的运动路径;S300~根据工作臂运动路径,确定工作臂各关节的B样条轨迹的插值时间和节点矢量;S400~确定关节i的B样条轨迹的控制点Pij;S500~根据S400确定的控制点,确定关节i的B样条轨迹,计算得到关节i的速度和加速度。本发明既可以保证锚杆机器人工作臂经过预设的路径点,又可以满足锚杆机器人工作臂的速度和加速度等约束条件,使得锚杆支护机器人在井下作业时可以避开外界环境障碍,又可以运动连续平稳。