VR-四元素、欧拉角转换条件
转自 欧拉角细节/旋转顺序/内旋外旋
欧拉角是由 Leonhard Euler 提出的概念,用来描述刚体/移动坐标系在一个固定坐标系中的姿态.简单的说是使用XYZ三个轴的旋转分量,来描述一个6自由度的旋转.
欧拉角一般具有两大类表示方式,每类按照旋转次序的不同分为6小类:
Proper Euler angles (z-x-z, x-y-x, y-z-y, z-y-z, x-z-x, y-x-y)
Tait–Bryan angles (x-y-z, y-z-x, z-x-y, x-z-y, z-y-x, y-x-z).
每个大类都使用了3个变量描述三次旋转过程中的旋转角度, 差别在于Proper Euler angles只涉及两个转轴.而Tait–Bryan angles涉及三个转轴.一般在SLAM中我们使用的是Tait–Bryan angles.
Tait–Bryan angles 也被称为Cardan angles, nautical angles, (heading, elevation, and bank),(yaw, pitch, and roll). 我们接触的比较多的是yaw(偏航), pitch(俯仰), roll(横滚).三个变量一般对应(车体,飞行器的)z,y,x三个坐标轴.
一般对于旋转矩阵(3 3),旋转向量/角轴(3 1),四元数(4*1),我们给定一串数字,就能表示清楚一个姿态/旋转.比如这里给出一个旋转矩阵R:
表示刚体在A某坐标系下的姿态, 我们就可以确切的画出刚体A的姿态.
但如果我给出一组欧拉角(后面都是指Tait–Bryan angles),绕x,y,z三个轴的转角分别为(α,β,γ),我们不能能确定一个明确的姿态.需要再追加两个属性:(1)旋转顺序(2)内旋/外旋.才能确定的给出这组欧拉角对应的姿态.
旋转顺序就是我们上文提到的 Tait–Bryan angles ( x - y - z , y - z - x , z - x - y , x - z - y , z - y - x , y - x - z ).
我们指定绕x轴旋转α,绕y轴旋转β.但是可以有多个旋转顺序, 比如:
情况1:先绕x轴旋转α,再绕y轴旋转β.得到姿态O1
情况2:先绕y轴旋转β,再绕x轴旋转α,得到姿态O2
得到的O1一般是不等于O2的.
对于x,y,z三个轴的不同旋转顺序一共有( x - y - z , y - z - x , z - x - y , x - z - y , z - y - x , y - x - z )六种组合.我们需要明确旋转顺序,才能确定欧拉角所指的姿态.
首先列出几种等价的概念:
内旋(intrinsic rotations) = 旋转轴(rotated axis)
外旋(extrinsic rotations) = 固定轴(static/fixed axis)
我们后面直接用内旋/外旋来描述.
内旋/外旋的定义:
假设在世界坐标系中XYZ中存在物体,物体自身坐标系为xyz,假设初始状态物体相对XYZ的旋转为(0,0,0),即xyz与XYZ重合.我们定义旋转顺序为z->y->x,转角分别为γ,β,α.
先绕z轴旋转γ,旋转过后,物体的x,y轴的坐标系发生了改变,z轴不变,得到新的物体自身坐标系,此时的坐标轴
不再与世界坐标系的坐标轴XY重合.
内旋,外旋的区别在于:
在转β(第二个转角)时:
内旋按照旋转后物体的坐标y轴.
外旋按照世界坐标系中的Y轴旋转.
旋转最后一个角度时亦然.
因此, 增加了这两个概念(旋转顺序, 内外旋)后,我们描述一个能表示确定姿态/旋转的欧拉角,应该这样:
旋转角度(α,β,γ),旋转顺序(z->y->x),外旋.
旋转角度(α,β,γ),旋转顺序(x->y->z),内旋.
等等, 三个元素缺一不可.
绛旓細涓鑸浜庢棆杞煩闃(3 3),鏃嬭浆鍚戦噺/瑙掕酱(3 1),鍥涘厓鏁(4*1),鎴戜滑缁欏畾涓涓叉暟瀛,灏辫兘琛ㄧず娓呮涓涓Э鎬/鏃嬭浆.姣斿杩欓噷缁欏嚭涓涓棆杞煩闃礡:琛ㄧず鍒氫綋鍦ˋ鏌愬潗鏍囩郴涓嬬殑濮挎, 鎴戜滑灏卞彲浠ョ‘鍒囩殑鐢诲嚭鍒氫綋A鐨勫Э鎬.浣嗗鏋滄垜缁欏嚭涓缁娆ф媺瑙(鍚庨潰閮芥槸鎸嘥ait鈥揃ryan angles),缁晉,y,z涓変釜杞寸殑杞鍒嗗埆涓(伪,...
绛旓細浜岃呭彲浠ョ浉浜掕浆鎹銆傚洓鍏冩暟鐨勬ц川鍖呮嫭1銆佹弧瓒崇粨鍚堝緥 2銆佷笉婊¤冻浜ゆ崲寰 3銆佷箻绉殑妯＄瓑浜庢ā鐨勪箻绉 4銆佷箻绉殑閫嗙瓑浜庡悇涓洓鍏冩暟鐨勯嗕互鐩稿弽鐨勯『搴忕浉涔樸傛鎷夎鐨勭己鐐瑰寘鎷1銆 娆ф媺瑙掔殑琛ㄧず鏂瑰紡涓嶅敮涓銆傜粰瀹氭煇涓捣濮嬫湞鍚戝拰鐩爣鏈濆悜锛屽嵆浣跨粰瀹歽aw銆乸itch銆乺oll鐨勯『搴忥紝涔熷彲浠ラ氳繃涓嶅悓鐨勮搴︾粍鍚堟潵琛ㄧず鎵闇鐨勬棆杞
绛旓細琛ㄧず鐭╅樀鐨 杩 锛 绗竴涓紡瀛愬嵆缃楀痉閲屾牸鏂叕寮忥紝杞磋鍒版棆杞煩闃电殑杞崲锛 绗簩涓紡瀛愬嵆琛ㄦ槑瑙掑埌鏃嬭浆鐭╅樀R鐨勮浆鎹紱 绗笁涓紡瀛愪腑鍗宠酱缁忚繃鏃嬭浆鍚庝笉鍙橈紝杞酱 鏃剁煩闃 鐗瑰緛鍊1瀵瑰簲鐨勭壒寰佸悜閲忋 锛2锛夋棆杞悜閲忎笌鍥涘厓鏁扮殑鍙樻崲锛 锛3锛夋棆杞煩闃靛埌鍥涘厓鏁扮殑鍙樻崲锛屽洓鍏冩暟鑷韩鐨勪竴浜涘熀鏈繍绠...
绛旓細涓夈佸洓鍏冩暟鍒版鎷夎鐨勮浆鎹 arctan鍜宎rcsin鐨勭粨鏋滄槸锛杩欏苟涓嶈兘瑕嗙洊鎵鏈夋湞鍚(瀵逛簬胃瑙掔殑鍙栧艰寖鍥村凡缁忔弧瓒)锛屽洜姝ら渶瑕佺敤atan2鏉ヤ唬鏇縜rctan銆傚洓銆佸湪鍏朵粬鍧愭爣绯讳笅浣跨敤 鍦ㄥ叾浠栧潗鏍囩郴涓嬶紝闇鏍规嵁鍧愭爣杞寸殑瀹氫箟锛岃皟鏁翠竴涓嬩互涓婂叕寮忋傚鍦―irect3D涓紝绗涘崱灏斿潗鏍囩郴鐨刋杞村彉涓篫杞达紝Y杞村彉涓篨杞达紝Z杞村彉涓篩杞达紙鏃犻渶...
绛旓細鎶婃鎷夎鍏杞崲鎴愭棆杞煩闃碉紙鎴栬鍥涘厓绱锛夎浆鎹㈠叕寮忕綉涓婅祫鏂欏緢澶氾紝涔熷彲浠ュ弬鑰冧竴涓嬭繖涓綉椤甸摼鎺 鐒跺悗锛屾妸娆ф媺瑙扐杞崲鎴愭棆杞煩闃礛锛屾妸娆ф媺瑙払杞崲鎴愭棆杞煩闃礜 鍐嶆眰鐭╅樀 L = N路inv(M)锛宨nv( )鏄眰閫嗙煩闃 鏈鍚庡弬鑰冪綉椤甸摼鎺ユ妸 L杞崲鎴娆ф媺瑙掞紝鍒欒繖涓鎷夎灏辨槸浠嶢鍒癇鐨勬棆杞 ...
绛旓細鎯у鑸殑鏍稿績鍦ㄤ簬閫氳繃娴嬮噺椋炶鍣ㄧ浉瀵逛簬瀵艰埅鍧愭爣绯伙紙濡傚湴鐞嗗潗鏍囷級鐨勫姞閫熷害锛岀粡杩囦袱娆＄Н鍒嗘潵鎺ㄧ畻鍑洪琛岃窛绂伙紝浠庤屽畾浣嶃傚湪鎹疯仈寮忕郴缁熶腑锛屽姞閫熷害鏄部鏈轰綋杞寸嚎娴嬪緱鐨勶紝杩欏氨闇瑕侀氳繃鏁板鎵嬫灏嗘満浣撳潗鏍囩郴鐨勫姞閫熷害淇″彿杞崲鎴愬湴鐞嗗潗鏍囩郴銆傚父鐢ㄧ殑杞崲鏂规硶鍖呮嫭娆ф媺瑙娉曘佹柟鍚戜綑寮︽硶鍜鍥涘厓绱娉曘傛鎷夎娉曢氳繃鎻忚堪鍔ㄥ潗鏍...
绛旓細鍥涘厓绱犺浆鏃嬭浆鐭╅樀: 鏃嬭浆鐭╅樀鍥涘厓绱: 宸茬煡鏃嬭浆鐭╅樀: 鍒欐眰瑙ｅ洓鍏冩暟鏃舵牴鎹殑鏂规硶灏辨槸浠庡洓鍏冩暟杞棆杞煩闃电殑鍏紡涓緱鍒: 鍒欏洓鍏冪礌: 娆ф媺瑙掕浆鍥涘厓鏁: 宸茬煡娆ф媺瑙:伪銆佄层佄 鍥涘厓鏁颁负: 鍥涘厓绱犺浆娆ф媺瑙 宸茬煡鍥涘厓鏁: 娆ф媺瑙掍负: 杩欐椂鍊欐垜浠氬父浠の=0,鐒跺悗瑙ｅ嚭娆ф媺瑙掔殑鍊笺 鍒拌繖閲屽熀鏈笂娆ф媺瑙掋佹棆杞煩闃点佸洓鍏冩暟...
绛旓細缁$x,y,z$涓変釜鍩烘湰杞存棆杞搴﹀垎鍒负$\phi,\theta,\psi$锛屽垯涓変釜鍩烘湰鏃嬭浆鐨鍥涘厓绱鍙〃寰佷负缁曚笁涓熀鏈酱鐨勬棆杞搴忎笉鍚岋紝鍏惰〃寰佺殑绌洪棿鏃嬭浆涔熶笉鍚岋紝涓嬮潰缁欏嚭椤哄簭涓$ZYX$銆$XYZ$鏃剁殑缁撴灉鍙婄浉搴旀帹瀵艰繃绋嬪浜庡潗鏍囩郴涓偣$P(\,x,y,z\,)$锛屽叾鏃嬭浆娆ф媺瑙涓$(\,...
绛旓細甯哥敤鐨勫潗鏍鎹㈢畻鏂规硶鏈娆ф媺瑙娉曘佹柟鍚戜綑寮︽硶鍜鍥涘厓绱娉曚笁绉嶃傛鎷夎娉曠敤鍔ㄥ潗鏍囩郴鐩稿鍙傝冨潗鏍囩郴渚濇缁3涓笉鍚屽潗鏍囪酱杞姩鐨3涓搴︽潵鎻忚堪瀹冧滑涔嬮棿鐨勬柟浣嶅叧绯汇傝繖 3涓搴︾О涓烘鎷夎銆傛柟鍚戜綑寮︽硶鐢ㄥ姩鍧愭爣绯3涓潗鏍囪酱鍜屽弬鑰冨潗鏍囩郴3涓酱涔嬮棿鐨勬柟鍚戜綑寮︽潵鎻忚堪杩欎袱涓潗鏍囩郴鐩稿鐨勬柟浣嶅叧绯汇傚洓鍏冪礌娉曠敤鍔ㄥ潗鏍囩郴...
