3. 机器人正运动学---坐标系及其变换

最新推荐文章于 2024-04-06 13:26:58 发布

hitgavin

最新推荐文章于 2024-04-06 13:26:58 发布

阅读量1.6w

点赞数 59

分类专栏：机器人运动学文章标签：机器人坐标系变换方向余弦矩阵

本文链接：https://blog.csdn.net/hitgavin/article/details/101113331

版权

机器人运动学专栏收录该内容

16 篇文章 412 订阅

订阅专栏

1. 引言

个人认为机器人运动学是整个机器人学的核心内容。仍然以前面的SCARA机器人为例，如下图所示，假设笛卡尔坐标系{A}是一个固定坐标系（笛卡尔坐标系实际上就是利用相交于一点的三条数轴来衡量空间中点的位置的一种坐标系，相对应的有极坐标系，球坐标系等；所谓固定坐标系就是坐标系不随着机器人运动）。蓝色的P点是机器人丝杆末端的上的一个点。

想像一下，如果我们知道机器人各个关节当前旋转的角度，如何确定P点在坐标系{A}中的坐标P(x,y,z)呢？老实说即使是这样一个问题也曾经困扰了我很久。

这就是我们在机器人运动学中碰到的第一个问题---正运动学问题。也就是在已知机器人各个关节的位置的情况下确定其末端执行器的位置。

2. 位姿的描述（位置与姿态）

整个机器人运动学都是建立在坐标系及其变换的基础之上，而这一部分也确实存在诸多有趣的问题。因此我们以坐标系及其变换作为机器人正运动学的切入点。

2.1 平移的描述（位置）

从最简单的情况说起，如下图所示，两个坐标系{A}和{B}的坐标轴分别平行，设坐标系{A}为基坐标系，那么如何表达坐标系B与坐标系A关系呢？

这个问题其实是比较简单的，从图中我们知道，空间中任意一点M在基坐标系{A}中的位置可以用向量 $P_{M}^{A}$ 表示，而在坐标系{B}中可以用向量 $P_{M}^{B}$ 表示。坐标系{B}的原点可以用向量 $P_{B}^{A}$ 表示（注意这些记法的上标代表该向量在哪个坐标系中表达，也就是向量的起点与哪个坐标系的原点重合，下标代表的是空间中的点，比如M代表的是M点。因此 $P_{X}^{Y}$ 代表X点在坐标系Y下的向量表示）。根据向量的运算法则，我们很容易得到下面的等价关系

$P_{M}^{A}=P_{B}^{A}+P_{M}^{B}$

在上面的等式中 $P_{M}^{A}$ 和 $P_{M}^{B}$ 都代表了点M的坐标，只是参考坐标系不同，一个参考系是坐标系{A}，一个参考系是坐标系{B}。那么 $P_{B}^{A}$ 又代表了什么呢？我想你应该能够想到这个代表了两个坐标系之间的位置关系。因此对于只存在平移关系的两个坐标系，我们通过一个三维向量 $P_{B}^{A}$ 就可以描述坐标系{B}与坐标系{A}的关系。上面的等式也就是在只有平移的情况下点在坐标系{A}与{B}之间的坐标变换公式。

2.2 旋转的描述（姿态）

旋转的描述是比较复杂的，我们先讨论只有旋转，没有平移的情况，即两个坐标系原点重合的情况。如下图所示，在这样的情况下怎么去描述坐标系{B}与坐标系{A}之间的关系呢？

我们依然以坐标系{A}为基坐标系。那么坐标系{A}的三个坐标轴可以用如下三个单位向量描述：

$i_A=\begin{bmatrix} 1\\ 0\\ 0 \end{bmatrix} j_A=\begin{bmatrix} 0\\ 1\\ 0 \end{bmatrix} k_A=\begin{bmatrix} 0\\ 0\\ 1 \end{bmatrix}$

同时我们设坐标系{B}的三个坐标轴在基坐标系{A}下的向量描述为： $i_B, j_B, k_B$ 。现在我们假设空间中有一点V，那么我们知道这个点既可以在坐标系{A}中表示，又可以在坐标系{B}中表示。设点V在基坐标系{A}下的坐标为： $P_{V}^{A}=\begin{bmatrix} x_A & y_A& z_A \end{bmatrix}^{T}$ ，点V在坐标系{B}中的坐标为 $P_{V}^{B}=\begin{bmatrix} x_B & y_B& z_B \end{bmatrix}^{T}$ ，设O为坐标系{A}和{B}的公共原点。

此时我们意识到向量 $\overrightarrow{OV}$ 其实存在两种分解，第一种是将向量 $\overrightarrow{OV}$ 分解到坐标系{A}的三个轴上，此时向量 $\overrightarrow{OV}$ 可以表示为： $\overrightarrow{OV}=x_A\overrightarrow{i_A}+y_A\overrightarrow{j_A}+z_A\overrightarrow{k_A}$ ；第二种是将向量 $\overrightarrow{OV}$ 分解到坐标系{B}的三个轴上，此时向量 $\overrightarrow{OV}$ 可以表示为： $\overrightarrow{OV}=x_B\overrightarrow{i_B}+y_B\overrightarrow{j_B}+z_B\overrightarrow{k_B}$ （注意我们前面已经提到所有的六个坐标轴单位向量都是在基坐标系中描述的）。由于这是同一个向量的两种表示方法。因此我们可以得到如下的等价关系：

$x_A\overrightarrow{i_A}+y_A\overrightarrow{j_A}+z_A\overrightarrow{k_A}=x_B\overrightarrow{i_B}+y_B\overrightarrow{j_B}+z_B\overrightarrow{k_B}$

如果在这个等式两边同时点乘 $\overrightarrow{i_A}$ 可以得到：

$x_A=x_B\overrightarrow{i_B}\cdot \overrightarrow{i_A}+y_B\overrightarrow{j_B}\cdot \overrightarrow{i_A}+z_B\overrightarrow{k_B}\cdot \overrightarrow{i_A}$

注意在上面的推导中我们用到了向量点乘法则，即两个互相垂直的单位向量点积为0，单位向量与其自身的点积为1。根据向量点乘法则，

$\overrightarrow{i_B}\cdot \overrightarrow{i_A}=\left | \overrightarrow{i_B} \right |\left | \overrightarrow{i_A}\right |cos<i_B, i_A>=cos<i_B, i_A>$

注意在上面的推导中我们用到了单位向量模长为1的性质。根据这些性质， $x_A$ 可以进一步表示为：

$x_A=x_Bcos<i_B, i_A>+y_Bcos<j_B, i_A>+z_Bcos<k_B, i_A>=\begin{bmatrix} cos<i_B, i_A> & cos<j_B, i_A> & cos<k_B, i_A> \end{bmatrix}\begin{bmatrix} x_B\\ y_B\\ z_B \end{bmatrix}$

同理可得：

$y_A=\begin{bmatrix} cos<i_B, j_A> & cos<j_B, j_A> & cos<k_B, j_A> \end{bmatrix}\begin{bmatrix} x_B\\ y_B\\ z_B \end{bmatrix}$

$z_A=\begin{bmatrix} cos<i_B, k_A> & cos<j_B, k_A> & cos<k_B, k_A> \end{bmatrix}\begin{bmatrix} x_B\\ y_B\\ z_B \end{bmatrix}$

最终整理可得：

$\begin{bmatrix} x_A\\ y_A\\ z_A \end{bmatrix}=\begin{bmatrix} cos<i_B, i_A> & cos<j_B, i_A>& cos<k_B, i_A>\\ cos<i_B, j_A> & cos<j_B, j_A>& cos<k_B, j_A>\\ cos<i_B, k_A> & cos<j_B, k_A>&cos<k_B, k_A> \end{bmatrix}\begin{bmatrix} x_B\\ y_B\\ z_B \end{bmatrix}=R\begin{bmatrix} x_B\\ y_B\\ z_B \end{bmatrix}$

前面我们进行了那么多的推导，看上去很复杂，但是其实都是最简单的向量以及矩阵运算。我们观察最后得到的这个等式。等式左边是点V在坐标系{A}中的坐标；等式右边是一个矩阵R乘上点V在坐标系{B}中的坐标。那么根据这个等式我们可以将空间中任意一点由坐标系{B}中的表示转换到坐标系{A}中的表示。可见我们利用同一个向量（即 $\overrightarrow{OV}$ ）的两种不同分解（在坐标系{A}中分解得到其在坐标系{A}中的坐标表示，同理在坐标系{B}中分解得到在坐标系{B}中的坐标表示）的等价性已经不自觉地推导出了两个原点重合的坐标系之间的姿态关系，这个关系就是前面提到的矩阵R。

接下来我们总结一下关于旋转的描述。当两个坐标系{A}和{B}原点重合时，他们的姿态关系可以利用一个3x3的矩阵来描述。我们看到这个矩阵的所有元素都是余弦值，因此我们称这个矩阵为方向余弦矩阵。这可以认为是方向余弦矩阵的由来。