回転ベクトル・回転行列・クォータニオン・オイラー角についてまとめてみた
以前の記事(OpenCVで取得したカメラパラメータをUnityで使う - かみのメモ)を書いたのをきっかけに、三次元座標系での回転の表現方法について色々調べたので、まとめておきたいと思います。
はじめに
三次元座標系で回転を表現するための方法として、回転ベクトル, 回転行列, オイラー角, クォータニオン(四元数)がよく知られています。
この記事では、これら4つの表現方法について
- 原理とその特徴
- 右手系・左手系の変換
- 各表現の相互変換(代表的なもののみ)
の3つを紹介していきます。
実際にPythonで回転後の座標を計算したり各表現を相互変換したりするプログラムは、以下の記事で紹介しています↓。
なお、この記事はコンピュータビジョンと航空力学をかじっただけの人が書いたものです。 できるだけ誤りのないように書いているつもりですが、もし間違いを見つけた場合は報告していただけるとありがたいです。
※ 2021/10/18:コメントで頂いた、クォータニオンの計算表の の符号が逆転していた間違いを修正しました
スポンサーリンク
もくじ
0. 準備
0.1. 回転を表現するとは?
はじめに、回転を表現するとはどういうことなのかを復習しておきます。
工学の分野では、三次元空間にあるオブジェクトの姿勢を考えるとき、どこか(例えば地面)に基準となる世界座標系を、オブジェクトに固有のローカル座標系を設定してその関係を回転成分・並進成分で記述するという考え方をします。
この回転成分の記述方法としては、以下4つの表現のどれかを使うことがほとんどです。
- 世界座標系で見ると である点は、ローカル座標系で見ると になる
- ローカル座標系で見ると である点は、世界座標系で見ると になる
- 世界座標系の座標軸をこう回転させると、ローカル座標系の座標軸に重なる
- ローカル座標系の座標軸をこう回転させると、世界座標系の座標軸に重なる
これらの表現は表裏一体で、どれで記述してもオブジェクトの回転、すなわち姿勢を表現していることになります。
今回紹介する回転ベクトル・回転行列・クォータニオンは1,2の発想に近いものです。 "変換前の座標系での座標値"から"変換後の座標系での座標値"への射影を関数で記述する、つまり点を別の点に移動させるツールで回転を定義しようというアイデアです。
一方、オイラー角は3,4の発想に近いもので、"変換前の座標系の座標軸"と"変換後の座標系の座標軸"の関係をなるべく直感的に記述しようというアイデアに基づいています。
回転を考えるときは、自分が1〜4のどれをベースに考えているのかということを常に意識しましょう。 特に1と3、2と4は似て非なる発想です(むしろ1と4、2と3の方が近い)。 この辺りを曖昧にしたまま直感的に考えると失敗しやすいので注意が必要です。
0.2. 左手系と右手系の関係
次に、右手座標系と左手座標系の関係について決めごとをしておきます。
右手座標系と左手座標系は、軸のどれか1本を反転させた関係であると言えます。
べつに右手系X,Y,Z
が左手系X,-Z,-Y
と対応するような変換を考えてもいいのですが、右手系X,Y,Z
と左手系X,-Y,Z
の対応を考えた後にX軸周りに270°回転させたものと考えたほうが分かりやすいです。
ということで、この記事では右手系と左手系は2本の軸を共有していて1本の軸だけ反転している関係と考えます。
今後この記事で右手・左手変換の例を紹介するときは、Y軸反転、つまり右手系で見ると である点を左手系で見ると になるような変換を取り上げることにします。
1. 回転ベクトル
まずは回転ベクトル(rotation vector)の紹介です。
回転ベクトルは、「ある点 を、原点を通るベクトル の周りでその長さ の分の角度だけ回転させる」という形で回転(=点の移動)を記述したものです。
たとえば、 はX軸を中心に90°回すように点を移動させることを意味します。 回転方向は、右手座標系では右ねじの方向(ベクトル方向を向いて時計回り)を正とし、左手座標系では左ねじの方向(ベクトル方向を向いて反時計回り)を正とします。
回転ベクトルはあくまで「点の回転移動」だけを記述するツールなので、グローバル->ローカルなのかローカル->グローバルなのかによって意味が変わることに注意してください。 つまり、 のどちらがグローバル座標でどちらがローカル座標なのかは状況によって違うということです。 これは、後で紹介する回転行列・クォータニオンも同じです。
1.1. 回転ベクトルの特徴
コンパクト
回転ベクトルは、回転を最もコンパクトに記述する、つまり最低限の変数(3自由度)で記述する表現方法です。 そのため、パラメータの自由度を拘束する条件式を考える必要がなく扱いやすいです。
ジンバルロックがない
後で紹介するオイラー角と違って、ジンバルロックを生じないという特徴があります。 これは、回転ベクトルを滑らかに変化させることで、ある回転の状態(=姿勢)から任意の別の回転の状態へと滑らかに変化させられることを意味します。
最適化問題で利用しやすい
上2つの特徴は、姿勢に関する最適化問題を解くときに非常に重要になります。
最適化問題を数値計算で解くときは、各パラメータを少しずつ変化させて評価関数の値がよくなるところを探索するという方法を採ります。 このとき、パラメータに無駄な自由度があるとそれを抑えるための制約条件を加える必要が出てきますが、制約付き最適化問題は制約なしに比べて複雑になるので計算コストが高くなってしまいます。 また、パラメータを滑らかに変化させたときに実際の姿勢も滑らかに変化してくれないと、効率的に最適化を行うことができません。
このような理由から、最適化問題では姿勢を回転ベクトル表現で記述することが多いです。
例えば、OpenCVのcalibrateCamera()
やsolvePnP()
なども、内部では回転ベクトル表現を利用しています。
同じ回転を表す組
長さを だけ変化させた回転ベクトルは、同じ回転を表していることになります。
回転量に対して という条件を課すことで、任意の回転は一意な回転ベクトルと一対一に対応します(ただし のときだけ など方向を一意に定める条件が必要)。
1.2. 回転ベクトルの逆変換
回転ベクトルは、向きを逆にしてやれば、真逆の回転を表す回転ベクトルになります。 そのため、 の逆変換は になります。
1.3. ロドリゲスの回転公式
回転ベクトルを使って点を移動させるアルゴリズムは、ロドリゲスの回転公式としてよく知られています。 回転ベクトル によって点 を回転させるとき、回転後の点 は以下の式で表されます。
この式は右手系と左手系で共通です。 気になる方は、 を代入したとき(右手系)と、 を代入したとき(Y軸反転の左手系)を比較して、 のY成分の符号だけが反転することを確かめてみてください。
1.4. 回転ベクトルの右手系と左手系の変換
右手系で取得した回転ベクトルを左手系での表現に直すときは、向きを反転させた後で普通のベクトルと同じように変換してやればよいです。 たとえば、右手系で観測した回転ベクトル はY軸反転した左手系で観測すると になります。
向きを反転させるのは、右手系と左手系で正とする回転方向が逆であるためです。
2. 回転行列
次に、みんな大好き回転行列(rotation matrix)のお話です。
回転行列は、三次元の回転を3×3の直交行列で表現する方法です。 点の座標を縦ベクトルで表現する場合、回転行列 によって点 を回転させると回転後の点 は以下の式で表されます。
2.1. 回転行列の特徴
回転を9パラメータで表現する
回転行列の各列ベクトルは、変換前の座標系における基底ベクトルXYZが、変換後にどのベクトルに対応するかを示しています。 見た目上は3自由度の回転を9つのパラメータで表現することになりますが、直交行列であるという条件( もしくは同値な条件として、列ベクトル表現を として )によって6自由度が抑えられるため、結果として3自由度を過不足なく表現できます。
あとで説明するように、回転行列はある回転ベクトルに対するロドリゲスの回転公式を成分に書き下したときの表現に相当します。
任意の回転と一対一に対応する
回転行列は任意の回転と一対一に対応します。
ジンバルロックがない
回転ベクトルと同じく、ジンバルロックは生じません。
数学的にシンプルに記述できる
回転行列表現の利点は、ベクトルの回転(点の移動)や回転の合成(重ねがけ)をベクトルと行列の式で記述できるようになることです。
たとえば、座標系AからBへの座標値の変換とBからCへの座標値の変換がそれぞれ回転行列 であるなら、座標系AからCへの座標値の変換は となりますし、座標系CからAへの座標値の変換は となり、かなりシンプルに記述できます。
また、回転行列を拡張した同次座標系の概念を導入すれば、ベクトルと行列の式で回転・並進移動をまとめて扱えるようになります。 幾何関係を数学的に分析したいときによく使われる表現方法です。
2.2. 回転行列の逆変換
上でちらっと取り上げたように、回転行列の逆行列は逆変換に相当します。 また、直交行列の性質として が成立するので、結局、転置行列 が逆変換を表す回転行列となります。
2.3. 回転行列と回転ベクトルの関係
先ほどの回転ベクトル のロドリゲスの回転公式を成分に書き下すと、
となります。 ここで出てきた3×3の行列がそのまま回転行列になります。
ロドリゲスの回転公式は右手系・左手系で共通ですので、もちろんこの式も右手系・左手系で共通です。 ただし次の項で説明するように、右手系と左手系どちらで見るかによって の値が変わるので、実際の回転行列の成分値は異なります。
2.4. 回転行列の右手系と左手系の変換
回転行列の右手系から左手系への変換は、上の式を調べればわかります。
例えば、右手系で である回転ベクトルは、Y軸反転の左手系では になります。 これを上の式に代入すれば、Y軸反転の左手系での表現に変換するためには回転行列の1行2列目・2行1列目・2行3列目・3行2列目の4箇所の符号を反転させれば良いことがわかります。
3. クォータニオン
続いて、最近流行り(?)のクォータニオン(quaternion : 四元数)について紹介します。
3.1. クォータニオンの定義
たまに「クォータニオン=回転」みたいな表現を耳にしますが、クォータニオン自体は複素数を拡張したような数学的な体系の一つです。
名前の通り、クォータニオンは のように4つの基底を持つベクトルとして表現されます。 そして乗算に関して次のようなルールを持っています。
この式を分解して表にすると次のようになります。
この表に従ってクォータニオン同士の積を成分に書き下すと、以下のようになります。
試してみるとわかりますが、クォータニオンでは結合則が成立します( )。 一方、交換則は成立しません( )。
また、あるクォータニオン に対して、 を共役クォータニオンと呼びます。
本当はもう少し色々と定義すべきことがあるのですが、回転を表すツールとして使う分にはここまでの知識で十分です。
3.2. クォータニオンによる回転の表現
クォータニオンによる回転表現は、回転ベクトルとの関係を示すのが一番わかりやすいです。
回転ベクトル (方向ベクトル 、長さ )があるとき、同じ回転を表現するクォータニオンは
であると定義されます。 この定義から の制約条件が付き、結果的に3自由度の回転をぴったり表現できていることになります。
上記の通りクォータニオンは4変数で表現されるので、本質的には4次元空間上での射影を考える必要があるのですが、3次元の回転を考えるだけならそこまでの分析は必要ないでしょう。 とりあえずは、上の定義に従って回転ベクトルに読み替えるのが図解しやすく直観的にもわかりやすいと思います。
クォータニオンと回転行列の相互変換については、この定義と2.3. 回転ベクトルと回転行列の関係を照らし合わせてみてください。
クォータニオンを使って点 を回転させるときは、点の座標を というクォータニオンに読み替えて
を計算します。 の 成分を取り出すと、回転後の点の座標値になっています。
また、クォータニオン で回転させた後に で回転させたような回転は となります。 この回転にしたがって点を移動させるときは のようにすればよいです。 ちなみに、 が成り立ちます。
3.3. クォータニオンの特徴
ジンバルロックがない
回転ベクトルと同じく、ジンバルロックは生じません。
同じ回転を表す組
クォータニオン と は同じ回転を表します。 これは、方向 長さ の回転ベクトルと、方向 長さ の回転ベクトルが同じ回転を表すことに対応しています。 そのため最終的な回転の状態としては同じですが、右回りで辿り着いたのか、左回りで辿り着いたのか、という区別があります。
クォータニオンの成分 を順に見ていったとき最初に出てくる非ゼロな成分が正である、という条件を付ければクォータニオンと任意の回転は一対一に対応します。
球面線形補間が楽に計算できる
回転をクォータニオンで表現することのメリットとして球面線形補間(slerp : spherical linear interpolation)が楽に計算できることが挙げられます。 球面線形補間は、ある回転の状態(=姿勢)から別の回転の状態への変化を角度に対して線形に補間する処理です。 つまり、オブジェクトをある姿勢から別の姿勢までスムーズに回転させるような処理を簡単に実装できるようになります。
回転を表す2つのクォータニオン と配分率 が与えられたとき、補間して得られるクォータニオンは以下のように計算されます。
累乗の計算はコストが高いので、以下のように近似することもあるようです。
また、slerpの際に の代わりに を使うと補間されるルートが変わります。 ざっくり言うと、一方は地球を西廻りして日本→韓国のルートを辿りますが、もう一方は日本→ブラジル→アフリカ→韓国という遠回りの東廻りルートを辿ります。 短い方のルートを選びたいときは、 と内積を取って正になる方を使えばよいです。
3.4. クォータニオンの逆変換
クォータニオン の逆変換は、その共役クォータニオン となります。
3.5. クォータニオンの右手系と左手系の変換
クォータニオンの右手系・左手系の変換は、反転していない2軸に対応する成分の符号を反転してやればよいです。 気になる方は、クォータニオンによる回転の定義と回転ベクトルの右手系・左手系の変換を照らし合わせてみてください。
例えば、右手系で であったクォータニオンは、Y軸反転の左手系では となります。
4. オイラー角
続いて、オイラー角(Euler angles)の紹介です。 これが一番ややこしいです。
オイラー角は、「座標軸の1本を選びその周りで回転させる、という操作を3回繰り返す」という形で座標系の関係を表現する方法です。 3回それぞれの回転量を並べて、 の形で回転を表現します。
オイラー角と一口に言っても、選ぶ回転軸の組み合わせによってX->Y->Z
, Z->Y->X
, Z->Y->Z
, X->Y->X
など12通りの表現があります。
ただ、結局はどの姿勢を と置くかの違いなので、どの表現も基本的な性質は変わりません。
また、2回目・3回目の回転のときに「もとの座標系の軸」と「回転後の座標系の軸」のどちらを基準に回転させるのかによっても種類が分かれます。 回転前の世界座標系の軸を使うものを外因性オイラー角(extrinsic Euler angles)、回転後の座標系の軸を使うものを内因性オイラー角(intrinsic Euler angles)と呼ぶようです。 なお、この記事では便宜上、内因性・外因性と呼ぶことにしますが正式な日本語訳があるのかはよくわかりません。
一般的にオイラー角といえば内因性オイラー角を指すことがほとんどです。 また、4.2. 回転行列との関係で説明しますが、内因性オイラー角と外因性オイラー角には対応関係があり、基本的な性質は共通しています。
ちなみに、X->Y->Z
のオイラー角をz-y-x
とかx-y'-z"
のように記述している文献もたまに見かけるので、文献ごとの流儀をよく確認しましょう。
4.1. オイラー角の特徴
リンク機構と対応している
内因性オイラー角を説明するときのイメージとしては、ジンバルがよく取り上げられます。 これはジャイロスコープなどに採用されている機構で、外側のリングから順番に回転量を指定していくと中のコマの姿勢が1つに定まる、という機構がオイラー角と対応しています。 また、ロボットアームのようなリンク機構もオイラー角と対応しています。
このように、実在する回転機構と一致すること、回転をイメージしやすいことから、オイラー角は広く利用されています。
Unityのシーンエディタでもオブジェクトの回転を入力するのにX->Y->Z
の内因性オイラー角が使用されています。
ヨー・ピッチ・ロールと対応している
航空を始めとするいくつかの工学分野では姿勢を「ヨー(yaw)、ピッチ(pitch)、ロール(roll)」の3パラメータで表現することがありますが、これもオイラー角と対応しています。
ただし、この表現はオイラー角と同じように、XYZを前後左右上下のどれに割り当てるかと、外因性オイラー角と内因性オイラー角のどちらを使うかによって微妙に定義が変わります。
よく使われるのは、下をZ・右をY・前をXとしたZ->Y->X
の内因性オイラー角における回転量をヨー・ピッチ・ロールと呼ぶスタイルらしいですが、文献によってバラバラの可能性があるのでよく確認してください。
ジンバルロックがある
オイラー角の厄介な性質として、ジンバルロック(特異姿勢)が知られています。 詳しい解説は他文献に譲りますが、これはある姿勢において回転の自由度が2に制限されてしまう現象です。 同じ意味ですが、3変数のうちの2つが同じ1自由度の表現に使われるため姿勢を一意に記述できなくなる現象、と説明されることもあります。
ジンバルロック時は、オイラー角を滑らかに変化させても、ある姿勢から別の姿勢へと滑らかに変化させられない場合があります。 これは画像から姿勢を推定するなどの最適化問題を解くときや、CGでオブジェクトを自由に回転させるときに問題になることがあります。
同じ回転を表現する組
回転角を の範囲で変化させるとき、同一の角度を表現するオイラー角は複数存在します。 特に、ジンバルロックの姿勢では1方向の回転を2軸が担っている状態なので、無数のオイラー角表現が存在します。 詳細に知りたい場合は、対象とするオイラー角を回転行列に変換して各成分を調べてみてください。
4.2. オイラー角の逆変換
オイラー角の逆変換は簡単で、回転の操作を向きを逆にして逆順に施してやればよいです。
例えばX->Y->Z
のオイラー角 の逆変換は、Z->Y->X
のオイラー角 になります。
これをX->Y->Z
のオイラー角で表現するのはなかなか面倒なので省略します。
4.3. オイラー角と回転行列の関係
ここでは比較的よく使う、オイラー角から回転行列への変換だけを紹介します。
まず、座標系Aから座標系Bへの回転を表すX->Y->Z
の内因性オイラー角の場合。
各軸周りの回転行列を とすると全体の回転行列は となります。
座標系AからBへのオイラー角を考えていたのに、出てくるのが「座標系Bの座標値をAで見たときの座標値に変換する回転行列」である辺りが割と直感に反しているので気をつけてください。
回転量を として成分に書き下すと以下のようになります。
この式は右手系・左手系で共通です。
X->Y->X
などの他の内因性オイラー角も同じ要領で計算できます。
次に、座標系Aから座標系Bへの回転を表すX->Y->Z
の外因性オイラー角の場合。
これは計算式を細かく追うと面倒なので省略しますが、座標系Bの基底が座標系Aで見るとどのようになっているのかを考えることで であることが確認できます。
よく見ると、内因性オイラー角と行列を掛け合わせる順を逆にしただけの式であることがわかります。
つまり、座標系Aから座標系Bへの回転を表すX->Y->Z
の内因性オイラー角 と、座標系Aから座標系Bへの回転を表すZ->Y->X
の外因性オイラー角 は全く同じ回転を表現しています。
4.4. オイラー角の右手系と左手系の変換
オイラー角の右手系・左手系の変換は、反転している軸以外の回転量の符号を逆にしてやればよいです。
例えば、右手系でのX->Y->Z
のオイラー角 は、Y軸反転左手系ではX->Y->Z
のオイラー角 となります。
5. あとがきと参考文献
過去最長の記事になってしまいました。 図を作る体力が残らなかったのでとりあえずこのまま投稿します…。
誤植・追記希望等ありましたらコメントください。
この記事を作成するに当たって以下の文献を参考にさせていただきました。 ありがとうございました。
- Rotation formalisms in three dimensions - Wikipedia
- Quaternions, Interpolation and Animation - MIT
- クォータニオンと回転 - エフアンダーバー
- Transformations and Projections in Computer Graphics, David Salomon, Springer 2006
- オイラー角について – EL-EMENT blog
- 機械制御工学研究講義ノート - 理工学部・理工学研究科・理工学研究センター
もしよければ↓の☆を1クリックお願いします!