一种机械臂姿态速度规划控制方法

    公开(公告)号:CN115008468B

    公开(公告)日:2024-09-03

    申请号:CN202210785947.2

    申请日:2022-07-04

    Abstract: 本发明涉及一种机械臂姿态速度规划控制方法,属于轨迹规划领域。本发明包括:步骤一,获取机械臂末端连杆坐标系当前姿态与目标姿态之间的旋转变换矩阵,并将其表示成欧拉角形式。步骤二,将欧拉角的各个角度乘以阻尼系数,得到机械臂末端连杆坐标系下期望旋转速度,然后通过机器人正向运动学矩阵,将其转换到机械臂基坐标系下。步骤三,按按照欧拉角的旋转次序依次对绕基坐标系各个轴的旋转进行速度控制,三个控制周期后重复上述两个步骤,直到机械臂末端到达目标姿态。

Patent Agency Ranking