机器人基础第4章微分运动和速度yakebi！.ppt

习题 1. 假设手坐标系的位姿用如下的伴随矩阵来表示。若绕Z轴做0.15弧度的微分旋转，再做[0.1，0.1，0.3]的微分平移，思考这样的微分运动将产生怎样的影响，并求出手的新位置。 解： 5. 给定机器人的手坐标系和相应的雅克比矩阵。对于给定关节的微分变化，计算手坐标系的变化、新位置和相应的△。 解： 完毕 本次课的内容：●坐标系之间的微分变化●机器人及机器人手坐标系的微分变化●雅克比矩阵的计算●建立雅克比矩阵和微分算子之间的关联●雅克比矩阵求逆 3.4 坐标系之间的微分变化 前面介绍的微分算子 是相对于固定参考坐标系来说的，同样的，我们可以定义另外一个微分算子，是相对于当前坐标系的，这样使得可以在该坐标系（当前）中计算同样的变换。 由于是相对于当前坐标系的，必须用右乘该坐标系的。如下式所示： 因此，上式可以用来计算相对于本身坐标系的微分算子 。将上式矩阵相乘并加以简化，得到的结果如下： 应注意， 看上去如同 矩阵，但所有元素都是相对于当前坐标系的，这些元素可从以上矩阵相乘的结果求得，结果归纳如下： 例： 对如下的坐标系B，绕y轴做0.1弧度的微分转动，然后微分平移[0.1，0，0.2]，求微分变换的结果。 解： 举例说明如何求得相对于本身坐标系的微分算子，回忆下面的例题（上节课出现过）： 现在求出相对于本身坐标系的微分算子： 由给定的信息中可以得到以下向量，用来计算向量 公式 代入可得： 3.5 机器人及机器人手坐标系的微分运动 前面介绍的都是坐标系的变换结果，而不涉及变换是如何实现的。现在我们就研究一下机器人手坐标系的变化是如何由机器人的运动转换来的。 我们要做的就是找出机器人关节的微分运动是如何与手坐标系的微分运动关联的，尤其是与dT的关系。 这种关系取决于： 机器人的构型和设计的函数； 机器人即时位姿的函数。 举例说明： 简单的旋转机器人和斯坦福机械手臂 区别：构型不同 结果：要产生类似（相同）的机械手速度，所要求的关 节速度会有所不同。由此可知： 对于上述的任何一种机器人，手臂是否能够完全地伸展 以及能否指向任意方位，都需要将其转化为不同的关节 速度从而产生相同的手的速度。 我们可以通过雅克比矩阵建立关节运动与手运动之间的 联系，如下所示： 雅克比矩阵 3.8 雅克比矩阵的计算 a、雅克比矩阵的每一个元素是对应的运动学方程对其中一个变量的导数 雅克比矩阵的含义： 对于下面两行也可以同样处理。但是，因为没有哪个方程可以普遍适用于绕三条轴的转动。因此我们需要用不同的方法对他们进行计算。 事实上，相对于最后一个坐标系T6的雅克比矩阵的计算要比相对于第一个坐标系简单的多。因此，我们将用下面的方法进行计算。 将相对于最后一个坐标系的速度方程写成： 此时，意味着，用相同关节的微分运动来左乘最后一个坐标系的雅克比矩阵，则可得到机器人首相对于最后一个坐标系的微分运动。我们可以用以下简单的方程来计算最后一个坐标系的雅克比矩阵： 方程的微分运动关系可以写成： 假设A1,A2……An的任意组合可以用相应的n,o,a,p矩阵表示，则矩阵中相应的元素可以用来计算雅可比矩阵。 如果所考虑的关节i为旋转关节，那么： 如果所考虑的关节i为滑动关节，那么： 例： 例题 3.9 建立雅可比矩阵和微分算子之间的关联 在讨论过雅可比矩阵和微分算子之后，我们将二者联系到一起。 假设机器人的关节移动一个微分量，由式3.10以及已知的雅可比矩阵可以计算出[D]矩阵，它包括了 的值(机器人手的微分运动)。先求微分算子。然后计算dT，由此来确定机器人手的新位姿。这样，机器人关节的微分运动就与机器人手坐标系联系起来了。 例题： 3.10 雅可比矩阵求逆 为了计算机器人关节上的微分运动(或速度)以得到所需要的手的微分运动(或速度)，需要计算雅可比矩阵的逆，并且将它用于下列方程： 这就是说，知道了雅可比矩阵的逆，就可以计算出每个关节需要以多快的速度运动，才能使机器人的手产生所期望的微分运动获达到期望的速度。实际上，微分运动分析的主要目的是分析而不是进行计算。 我们知道，雅可比矩阵中所有元素的实际值都是时变的，因此，虽然雅可比矩阵的符号方程相同，但他们的数值改变了。所以我们为了能够在每秒内