一种机械臂空间轨迹跟踪动态补偿方法和系统

摘要

本申请实施例提供了一种机械臂空间轨迹跟踪动态补偿方法和系统，其中，所述方法步骤包括：S1、根据机械臂末端期望位姿矩阵T1和机械臂末端当前位姿矩阵T0，计算机械臂末端位姿误差δ；S2、利用当前机械臂末端位姿下的雅克比矩阵J(q)、位姿误差δ和当前关节角q，计算关节目标角q*；S3、根据当前机械臂末端位姿下的雅克比矩阵J(q)和机械臂末端的期望速度v*，计算关节目标角速度S4、将关节目标角速度与关节位置控制器输出量相加，得到关节速度指令，驱动机械臂各关节运动。本方案计算复杂度低，占用资源少；不需要考虑复杂的动力学模型，简单实用，易于实施；通过末端轨迹规划输出的空间速度直接得到各关节目标速度作为前馈量，不存在滞后，实时性好。