《机器人动力学与控制》第九章——动力学 9.2 动能与势能的一般表达

《机器人动力学与控制》第九章——动力学

9.2 动能与势能的一般表达

9.2.0 前言

在前面的章节里，我们展示了如何用欧拉-拉格朗日方程直接推导出动力学方程，以及证明了我们可以用一系列通用坐标表示动能和势能。为了让这个结论在实际应用中发挥作用，因此学会如何用通用坐标表达一个机械臂的动能和势能就显得很重要。本节我们学习如何通过把DH关节变量当作通用坐标来表达出刚体机器人的动力学动能和势能。
首先明白这样一个事实：一个刚体的动能是由移动动能和转动动能组成的，移动动能是质心运动产生的动能，转动动能是刚体绕质心旋转产生的动能。举个例子，下图：

一个椭球体在一个世界坐标系里旋转跳跃闭着眼，它有着旋转运动以及线性运动。图中有两个坐标系，一个世界坐标系x0y0z0，另一个是附着在椭球体上的体坐标系xcyczc。其动能和势能和用公式表示为：

$m$是质量，$v$是位移线速度，$w$是转动角速度。$L$是惯性张量。

9.2.1 惯性张量

上述讲到的线速度和角速度都是在惯性坐标系里描述的，以下是惯性系的维基百科定义

在经典物理学与狭义相对论中，惯性参考系（常简称为惯性系）是指可以均匀且各向同性地描述空间，并且可以均匀描述时间的参考系。在惯性参考系内，系统内部的物理规律与系统外的因素无关

惯性系下我们可以通过反对称矩阵来求得角速度$w$：

这里的 $R$ 是体坐标系与惯性坐标系之间的旋转矩阵。为了计算转动动能还需要计算相对于惯性坐标系的惯性张量$L$。相对于惯性坐标系的惯性张量与物体的姿态是有关系的。不妨先计算相对于体坐标系的惯性张量$I$，然后就可以通过下面的公式计算$L$：

这是个很重要的结论，因为相对于体坐标系的惯性张量与物体的运动无关。下面我们介绍如何计算这个惯性张量矩阵。
物体的密度用 $\rho (x,y,z)$ 表示，那么体坐标系上的惯性张量可以表示为：

上述矩阵的对角部分叫做惯量矩，其余的交叉项叫做惯量积。如果该物体相对于体坐标系的质量分布是对称的，那么惯量积的值为0。我们来举个简单的例子：

例9.2：均匀长方体
考虑一个长宽高分别为a b c，密度为$\rho (x,y,z)=\rho$ 的均匀密度长方体，如下图所示

如果我们如上图那样放置体坐标系，那么该惯性张量的惯量积为0，惯量矩为：

同理，

惯性张量矩阵其余6个位置为0。

9.2.2 n连杆机器人的动能

现在我们考虑一个具有n个连杆的机器人的动能。我们已经在第五章那边知道任意连杆的线速度和角速度都可以用Jacobian矩阵以及关节变量的求导表示。由于在我们讨论的情况下，关节变量都是通用坐标系描述的，因此我们有

现在假设连杆 $i$ 的质量是 $m_i$，连杆 $i$ 的惯性矩阵 $I_i$ 是相对于：平行于连杆 $i$ 的坐标系，同时在连杆 $i$ 质心上的坐标系来评估的。那么在惯性坐标系下，机械臂的全部动能和表示为：

可以简化表示为下面的形式：

D（q）是与姿态无关的对称正定矩阵，矩阵D被叫做惯性矩阵，在9.4节我们会尝试着教大家计算几个常见的机械臂的惯性矩阵。

9.2.3 n连杆机器人的势能

现在我们考虑势能项，刚体的动力学里，重力是势能的唯一来源。连杆 $i$ 的势能可以根据连杆 $i$ 的质心位置这么计算：

$g$ 是惯性坐标系下的重力向量，$r_{ci}$ 是重心位置向量，$m_i$是质量，所以全部势能加起来：

对于会有弹性形变的机器人，势能计算还需要加上弹性势能。需要注意的是势能仅仅与机器人连杆的位置有关，与其速度无关。