1. 引言

前面的文章中我们分别讨论了坐标系及其平移，旋转两种变换。但是到目前为止我们一直都在分开讨论平移和旋转，而在实际应用中两个坐标系之间的关系往往既有平移又有旋转，因此这篇文章我们将讨论一下如何以一种更为紧凑的方式来表达两个坐标系之间的位置及姿态关系。

2. 齐次坐标系变换

我们可以把这个问题分解开来看，详细说来就是当我们无法一下看出两个坐标系{A}和{B}的变换关系时，可以尝试在这两个坐标系之间插入一个中间坐标系{C}，只要我们找到了坐标系{A}和{C}的关系，然后又找到了坐标系{C}和{B}的关系，那么我们就可以间接确定{A}和{B}之间的关系。

2.1 坐标系之间的位姿关系

如下图所示，坐标系{A}经过平移变换可以得到坐标系{C}，坐标系{C}绕其自身z轴旋转可以得到坐标系{B}。根据我们在机器人正运动学—坐标系及其变换中提到的方法，我们可以很容易的确定坐标系{A}与{C}之间的关系可以表达为：

5. 机器人正运动学---齐次变换矩阵我们来解释一下这个等式的含义。等式的左侧是空间中任意一点
$M$ 在坐标系{A}中的坐标；等式右侧
$p_{M}^{C}$ 代表点
$M$ 在坐标系{C}中的坐标；
$p_{Corg}^{A}$ 代表坐标系C的原点Corg（the origin of axis {C}）在坐标系{A}中的坐标。考虑完了坐标系{A}和{C}之间的平移关系，接下来我们讨论坐标系{B}和{C}之间的旋转关系，前面我们已经叙述了坐标系{B}的由来，它是坐标系{C}沿着其z轴旋转一个角度
$\theta$ 而来。因此，按照上一篇文章机器人正运动学—理解变换矩阵中提到的方法，将坐标系{B}的各轴单位矢量在坐标系{C}下投影即可得到坐标系{B}与坐标系{C}的姿态变换关系，如下式所示：

5. 机器人正运动学---齐次变换矩阵旋转矩阵
$^{C}\textrm{R}_{B}$ 的各列分别是坐标系{B}三个坐标轴单位矢量在坐标系{C}三个轴上的投影。我们再来解释一下上述坐标变换等式的含义，左侧代表空间点
$M$ 在坐标系{C}中的坐标；等式右侧
$^{C}\textrm{R}_{B}$ 为坐标系{B}和{C}之间的变换关系；
$p_{M}^{B}$ 代表点
$M$ 在坐标系{B}中的坐标。接下来问题来了，有了坐标系{A}和{C}的关系，也有了坐标系{B}和{C}的关系，我们如何得到坐标系{A}和{B}之间的变换呢？其实很简单，可以从两种角度去思考，第一个是从变换的角度，假设空间一点
$M$ 在坐标系{B}中坐标已知，为
$p_{M}^{B}$ 。那么通过坐标系{B}和{C}的变换关系（等式（2）），我们就可以得到点
$M$ 在坐标系{C}下的坐标为
$p_{M}^{C}$ ，而我们又知道坐标系{A}和坐标系{C}之间的关系（等式（1）），因此我们可以最终得到点
$M$ 在坐标系{A}中的坐标
$p_{M}^{A}$ 。第二个是从数学的角度，说白了就是将等式（2）代入到等式（1）就可以得到坐标系{A}和{B}之间的关系。这个关系可以用下式表示：
注意由于坐标系{B}和{C}原点是重合的，因此
$p_{Borg}^{A}=p_{Corg}^{A}$ ，又因为坐标系{A}和{C}各个轴分别平行，因此
$^{A}\textrm{R}_{B}=^{C}\textrm{R}_{B}$ 。

2.2 齐次变换矩阵

在2.1节我们得出了任意两个坐标系之间的位姿关系描述，但是这种描述其实是不够紧凑的，特别是当我们面对多重连续变换时，等式会变得很臃肿。为了解决这个问题，我们在原有旋转矩阵的基础上扩展一维用于容纳平移关系。得到最终的齐次变换矩阵，这样任意两个坐标系{A}和{B}的位姿关系可以重新形式化为：
5. 机器人正运动学---齐次变换矩阵如果你大致理解什么是分块矩阵就会发现其实等式（4）和等式（3）是完全等价的。