假设平面二自由度机械臂的两个关节角度分别为 和
,关节长度分别为
和
。
机械臂末端的位置坐标为:
对和
分别对
和
求偏导:
则雅可比矩阵为:
应用一:已知关节速度求解末端速度
假设关节速度为 ,关节长度
和
,关节角度
和
关节速度
,
。
首先计算雅可比矩阵 :
将 和
带入上诉推导出的雅可比矩阵
:
求得:
然后末端速度 :
综上所诉:
应用二:已知末端力求解关节力矩
上诉二连杆机械臂,假设机械臂的末端受力。
已知雅可比矩阵:
代入关节角度 和
:
假设关节力矩求解关节力矩:
综上所诉: