机器人是一个多输入多输出的运动系统，为了更好地控制机器人的运动，必须精确求解机器人操作空间与关节空间之间的速度关系。

雅可比矩阵定义为：关节空间速度向末端操作空间速度传递的映射矩阵，可以通过下式来认识雅克比矩阵。

求解速度雅克比矩阵的方法有：

位置求导法：运动方程直接求导

矢量积法：矢量方法求解，表达形式简单

微分变换法：相对动坐标系的微分运动

速度递推法：从基座递推各连杆线速度与角速度

机器人的m维操作空间X与n维关节空间q之间的位移关系为

将两边对时间求导，可得到操作空间的速度与关节速度之间的关系：

其中  为末端操作空间的速度，为关节空间速度。

求导后的式子可以用矩阵表达为：

J 为 m x n 形式的雅可比矩阵，其各项均为操作空间的参数对各关节变量的偏导数。

例：平面2R机器人如图所示，求该机器人的雅可比矩阵。

 该机器人操作空间和关节空间的分量分别为：

上式两端分别对时间求导可得：

 前面的各项系数就是我们所求的雅可比矩阵的各项。

将上式写为矩阵形式，便可得到雅可比矩阵：

令为雅可比矩阵的第一列矢量和第二列矢量，上式的速度传递关系可表示为：

其中 分别表示为单位关节速度在末端位置产生的速度分量的传递比，表明机器人的末端空间速度为机器人各关节速度的线性叠加。

矢量积法的思想为：通过将机器人各关节在末端产生的速度进行叠加得到操作速度。

末端产生的线速度矢量，其中  为关节速度值， 为关节单位向量。

 对应移动关节的一列雅克比矩阵。

其中  为关节速度值， 为关节单位向量。均可通过运动学模型求解。

 对应转动关节的一列雅克比矩阵。

由此，我们便得到了雅克比矩阵各列的固定形式：

 按照运动副从始端到末端的顺序写出各项，即可构造出机器人的雅克比矩阵：

 （1）J 的每一列代表相应的关节速度对于末端线速度和角速度的传递比；

（2）前三行代表对末端线速度 v 的传递比；

（3）后三行代表对末端角速度 Ω 的传递比；

例：求平面2R机器人雅可比矩阵（两个运动副都为转动副）

机器人各转轴的单位矢量为：

各转轴对应末端点的矢径可根据运动学的关系或矢量叠加的原理得到：

然后我们再根据列雅可比矩阵的形式就可写出2R机器人的两列雅可比矩阵，进而得到2R机器人6 x 2形式的雅可比矩阵：

 J 表明2R机器人只有xy平面的移动和绕z轴的转动速度。

值得注意的是，此次得到的雅可比矩阵为6 x 2形式，而采用位置求导法得到的雅可比为2 x 2形式，这是因为两种方法使用的操作空间的参数不同。位置求导法以末端（x,y）坐标的速度作为操作空间的参数，而矢量积法将机构末端的六维速度全部表达出。两种方法的结果具有一致性，我们提取矢量积法的前两行，便是位置求导法的结构。

例：求SCARA机器人的雅可比矩阵（前三个关节为转动副，第四关节为移动副）

 将得到的雅可比矩阵依次排列，就可以到得到SCARA机器人6x4形式的雅可比矩阵：

机器人的末端操作器通常受到外载荷的作用，各关节的驱动力（矩）通过连杆传递到末端执行器，从而克服外界作用力（矩）。本节研究机器人静止状态下末端操作器所受的外载荷和关节驱动力（矩）之间的关系。即已知末端载荷，求静止状态时的各关节驱动力（矩）。

 机器人由连杆和关节组成，以其中一个连杆 i 为对象进行静力分析，连杆 i 以及相邻连杆之间的作用力和作用力矩关系如图所示：

 连杆的力和力矩平衡方程在坐标系{i}中表达为：

第一行为连杆 i 的受力平衡方程，第二项为连杆 i 的力矩平衡方程。式中的负号表示连杆 i+1 对连杆 i 的反作用力和反作用矩。矢量左上标 i 表示该矢量在坐标系 i 中的表达；是连杆 i 的质心相对于 i 的表示； 是坐标系{i+1}的原点相对于坐标系{i}的表示。

通常需要根据末端连杆上的载荷，从末端连杆依次递推到操作臂的基座，计算出每个连杆的受力情况。

如果忽略连杆自身的重力，上式可写成反向迭代的形式：

通过旋转矩阵可将上式有段力（矩）表示在自身坐标系{i+1}中：

该式中的迭代关系非常重要，他可以实现静力从一连杆向另一连杆的传递，根据这一关系可进一步求得各关节的驱动力和力矩。

如果不考虑关节中的摩擦，除了关节驱动力（矩）外，其余各方向的力和力矩分量都由机械构件承受。为了保证连杆平衡，对于转动关节，关节驱动力矩应该等于：

对于移动关节，关节驱动力为：

例：分析平面2R机器人的关节力矩（已知末端受到的平面操作力）。

 根据运动学中确定连杆坐标系的方法建立连杆坐标系{0}，{1}，{2}，{3}；

末端操作力在坐标系{3}中表示：

我们需要将末端力传递到其他连杆中，求解其他连杆的受力情况。

由连杆坐标系可得相邻连杆旋转变换矩阵：

根据递推公式可得到连杆1对连杆2的作用力和作用力矩：

 因此关节2上的驱动力矩为：

同理可得到基座对连杆1的作用力和作用力矩：

关节1上的驱动力矩为：

将两个关节的关节力矩写成矩阵形式为：

将外载荷从坐标系{3}的表示转换为极坐标系{0}中的表示：

式中矩阵即为该机器人的力雅可比矩阵，该矩阵恰巧是上文通过为止求导法求得的速度雅克比矩阵的转置。

做过轴运动控制的小伙伴肯定都知道，对于轴类的运动控制（伺服电机、步进电机等运动控制）是有软限位与硬限位这个概念的。限位可以限定轴的运动范围，防止其运动超出机械结构所能承受的极限。轴的限位一般都是软限位与硬限位同时存在的，且软限位的范围比硬限位的范围要小。一般情况下单靠软限位就可以胜任限定轴运动范围的工作，但是有些情况如伺服轴没有找原点时，软限位可谓是形同虚设，还是要靠硬限位来保证设备与人员的安全。...