機器人學總結（1） —— 機器人的描述

0 前言

接觸機器人已經有一定的時間了（其實也不是很長），一直想把這方面的知識和經驗總結一下。主要是想為自己做個整理，如果那裡有錯誤或者有問題的地方，還請大家指正、’指點和交流。

這裡所說的機器人主要指的是串聯的機械臂。我們對機器人的描述主要關注的是末端的狀態，可以從兩個方面出發：關節空間和笛卡爾空間。例如：我想用左手拿一個杯子，我的身體不動，只移動胳膊和手（這跟機械臂很像），描述手的狀態，我可描述每個關節轉了多少度（關節空間），也可以說我的手心（末端的一個點）的空間位置和方向（笛卡爾空間）。

1 關節空間描述

關節空間，需要確定每個關節的零位，然後計算當前位置和零位的差值（關節分為平動關節和轉動關節）。

如上圖所示（SCARA機械臂），末端關節為平動關節（伸縮關節），前面的是轉動關節（旋轉關節）。

2 笛卡爾空間描述

笛卡爾空間，需要規定一個參考系，我們定義基礎坐標系{A}為：X軸向外，Y軸向右，Z軸向上。如下圖：

2.1 位置、姿態和框

位置是一個向量，使用空間點的坐標進行描述，如：P（x，y，z）；

姿態（方向）有很多種描述方法描述，這裡主要介紹利用旋轉矩陣的描述方法。首先我們在被描述的物體上要建立一個可以隨物體的方向改變的坐標系{B}，那麼對於{B}的X、Y、Z三個坐標軸在{A}中的描述可以表示物體的姿態。因為由三個向量組成，可以寫成一個3x3的矩陣R = {X，Y，Z}，我們稱它為姿態矩陣。其中X，Y，Z為{B}的坐標軸在{A}的坐標軸上的投影。R 的具體信息在下一節說明。

框（frame）是位置和姿態的組合，即 {R，P}，框的描述在下面可以用來推出齊次矩陣；

2.2 旋轉矩陣

在描述末端位姿時，我們通常在每個關節末端建立一個直接坐標系，依次地推求出末端和基座（基座標系）之間的相對位姿。因此，需要熟悉不同坐標系之間的轉換。

设在{xyz} 坐标系下向量P 的坐标为(x,y,z)，在{noa} 坐标系下向量P 的坐标为(n,o,a)，向量P 的两种表示形式（這是同一向量在不同坐標系下的描述）：

其中x，y，z和n，o，a是向量P 分別在兩個坐標系的坐標軸上的投影。坐标(n,o,a)變換到坐标(x,y,z)的關係可以通過，坐標系{noa} 取長度為n，o，a的三個軸向量向{xyz} 坐标系投影計算得到。這裡可以利用線性代數的知識簡化計算，兩坐標系之間的關係可以用一個3x3的矩陣乘法計算：在描述末端位姿時，我們通常在每個關節末端建立一個直接坐標系，依次地推求出末端和基座（基座標系）之間的相對位姿。因此，需要熟悉不同坐標系之間的轉換。设在{xyz} 坐标系下向量P 的坐标为(x,y,z)，在{noa} 坐标系下向量P 的坐标为(n,o,a)，向量P 的两种表示形式：

因為，左右兩側的矩陣均為正交單位陣，所以逆為矩陣的轉置，得到R：

觀察定義式（右邊的矩陣），我們可以知道R是n，o，a在x，y，z上的投影，即R是坐標系{noa}在坐標系{xyz}中的姿態。

矩陣R也是單位正交陣（可以通過上面的定義式證明）。這裡還可以看出坐標系之間的轉化是相對的過程，如果A通過R變為B則B通過R的逆（轉置）變為A。

特殊化上面矩陣，得到下面繞坐標軸旋轉的變換矩陣（繞轉軸逆時針方向為正向）：

這三個矩陣是稱為基礎旋轉，可以用來構造旋轉矩陣（下面會經常用到）。左乘上面的矩陣，就可以把旋轉後的坐標系中的向量，描述到原坐標系下。

2.2 旋轉合成

下面的算式，我們規定上角標表示描述使用的參考系（一般情況下標在左上角，這裡我為了公式編寫方便放在右上角），所以P0是P在坐標系{0}下的描述），R的下角標表示被描述的坐標系，通過上一節我們知道R01除了表示坐標系{1}在坐標系{0}中的描述外，它還是將向量在坐標系{1}中的描述轉化到坐標系{0}中描述是左乘的矩陣，則有：

聯立式子可以得到：

可以得到結論：旋轉的合成可以分解成成一系列旋轉，每個旋轉都是相對前一個旋轉進行定義，按給定的旋轉顺序右乘旋轉矩陣進行合成。

注意：旋轉的合成是矩陣乘法，不滿足交換律，一般兩個旋轉不能交換。

2.3 其次變換

首先來處理位置描述的轉化，上面我們得到了姿態之間的關係（姿態代表的是方向，平移不影響結果），下面我們來描述不同坐標系下的位置描述間的轉化關係。

現在我們考慮一個點在不同坐標系下的描述（這裡不是一個向量）。如上圖，在{xyz}一個點的位置用向量P1表示，它同樣可以用兩個向量的和的形式表示（注意這些向量都是在{xyz}中的描述），即：

通過上一節我們可以得出P2向量在{noa}坐標系中描述和{xyz}坐標系中描述的關係：

可以的到點在{ona}坐標系和{xyz}坐標系中描述的轉換關係：

剛體在空間中的位置可以通過剛體上某一適當的點相對參考坐標系的位置來表示（平移）。而方向可以通過固連在剛體上的坐標系連描述。這裡利用o來代表坐標系間的位置關係，得到轉化后的公式（和上面公式相同）：

寫成矩陣形式如下：

我們稱這個4x4的矩陣為其次矩陣（有些地方用T表示，這裡用A表示連續的兩個坐標系的變換，T表示多個變換的合成）。

對應的逆變換為：

對應的矩陣形式為：

可以看出來A01就是坐標系{noa}在左邊系{xyz}下的位姿，因此一個齊次矩陣可以表示兩個坐標系轉化，同時也表示坐標系的描述。對應的連續的變化可以使用一系列的矩陣乘法表示。

注意：其次矩陣不是正交單位陣（可以從上面求逆的過程看出來）。

2.4 算子

為了後面計算運動學是方便，我們需要定義算子。這裡的算子是用來計算特殊運動（同樣用來可以描述相對位姿）的其次矩陣，有這些矩陣和便是狀態的矩陣做乘法就可以實現運動的描述。

平移算子是用來描述平移運動的。分別按x，y，z三軸平移的運動算子如下：

旋轉算子是用來描述旋轉運動的。分別按x，y，z三軸旋轉的運動算子如下：

上面的計算為旋轉矩陣的推廣，將平移和旋轉統一用齊次矩陣表示出來。

2.5 總結

到此，我們可以對一個機械臂的抹點在笛卡爾坐標系下進行描述了，具體步驟如下：

1，確定參考坐標系，一般是大地上的一點記為{B}；

2，在每個關節上固連一個坐標系{R1}，...{Rn}；

3，通過其次變換，將末端坐標系{Rn}（或者記為{T}）的描述轉化到{B}中；

3 其他描述方法

雖然旋轉矩陣可以直觀的描述出的卡爾空間的姿態，但是它包含了大量的冗餘信息，正交和單位約束給它帶來6個約束。因此，只需要3個參數就可以描述空間中的姿態。

3.1 角度

旋轉的最簡單表示，可以通過三個角度來描述：

將表示繞一個坐標軸進行的基本旋轉矩陣（2.2節）看成是單個角度的函數。一般的旋轉可以通過3個基本旋轉適當的組合實現（需要保證兩個連續旋轉不是繞平行軸進行）。27種組合中可以確定12中不同的描述集合。這12中描述按照每次旋轉的相對參考系不同分為兩種不同的計算（左乘和右乘），因此一共有24組。一般稱相對固定不變坐標系的描述為固定坐標角描述，另一種基於上次旋轉生成的新坐標系的描述稱為歐拉角描述。下面介紹其中的兩種。