理解如何得出雅各布矩阵对于控制6度自由(6-DOF)机器人操纵器至关重要。 雅各布将联合速度与最终效应速度联系起来,从而能够精确移动和强制控制。

操纵器的动因模型

第一步是建立机器人的运动模型。 这通常使用Denavit-Hartenberg(D-H)参数来定义每个关节的坐标框架。 这些参数包括链接长度、扭矩、偏移和关节角度。

使用 D- H 参数,您可以从一个关节到另一个关节来得出变换矩阵。将这些矩阵乘以这些基数产生从基数到末效数的整体变换。

计算雅各比人

雅各宾矩阵由两部分组成:线性速度雅各宾和角性速度雅各宾。对于每个关节,请确定它是转动的还是棱角的,因为这会影响计算。

对于转动关节,线性速度部分是联轴器的交叉产物,以及从联轴器到终端效应器的矢量,角速部分只是联轴矢量,对于棱角关节,线性组成部分是联轴矢量,角角成份是0.

构建雅各布矩阵

通过堆叠每个关节的线性速度向量和角速度向量来集合雅各布矩阵,结果的6x6矩阵将联合速度与终端效应速度联系起来.

确保雅各比人在当前联想角度上得到评价,以准确反映机器人的配置.

  • 定义机器人的D-H参数.
  • 计算变换矩阵 。
  • 确定联合轴和位置矢量。
  • 计算雅各人的每一列.
  • 集合完整的雅各布亚矩阵.