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

    公开(公告)号:CN114193449B

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

    申请号:CN202111494905.5

    申请日:2021-12-09

    IPC分类号: B25J9/16

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