01? ?說在前面的話?
在《MEMS 慣性傳感器 04 - 坐標系定義》這篇文章的基礎(chǔ)之上，針對導航坐標系和載體坐標系進行進一步的介紹。
導航坐標系和載體坐標之間的相互轉(zhuǎn)換是工程應(yīng)用中經(jīng)常遇到的問題。
02?
坐標系定義?
導航坐標系（也稱為：當?shù)厮阶鴺讼?、地理坐標系）分為：東北天坐標系（ENU）和 北東地坐標系（NED） ? 載體坐標系分為：前右下 和 左前上 要特別注意的：慣導坐標系的定義，關(guān)系到后續(xù)的旋轉(zhuǎn)矩陣和旋轉(zhuǎn)順序。當確定一個導航坐標系后，那么對應(yīng)的歐拉角、歐拉旋轉(zhuǎn)順序、和對應(yīng)的載體坐標都與之對應(yīng)確定。
[東北天坐標系]-[右前上]
1) x軸指向東， y軸指向北， z軸指向天 2) 繞x軸轉(zhuǎn)動，稱為pitch角;? ?繞y軸轉(zhuǎn)動，稱為roll角; ?繞z軸轉(zhuǎn)動，稱為yaw角 3) 對應(yīng)的載體坐標系是：右前上 4) 歐拉角旋轉(zhuǎn)順序：z-x-y
[東北地坐標系]-[前右下]
1) x軸指向北， y軸指向東， z軸指向地 2) 繞x軸轉(zhuǎn)動，稱為roll角；繞y軸轉(zhuǎn)動，稱為pitch角； 繞z軸轉(zhuǎn)動，成為yaw角 3) 對應(yīng)的載體坐標系是：前右下 4) 歐拉角旋轉(zhuǎn)順序：z-y-x
總結(jié)：
| ? | 北東地坐標系 | 東北天坐標系 |
| 姿態(tài)角范圍 |
俯仰角(-90 ~ 90deg)； 橫滾角(-180 ~ 180deg)； 航向角(-180 ~ 180deg，可轉(zhuǎn)換為0~360deg)； |
|
| 姿態(tài)角對應(yīng)方向 | 根據(jù)右手定則來確定 | |
| 姿態(tài)角對應(yīng)軸向 |
X軸：橫滾角 Y軸：俯仰角 Z軸：航向角 1. 俯仰角和橫滾角：方向與對應(yīng)軸向轉(zhuǎn)動方向一致；繞對應(yīng)軸正轉(zhuǎn)，相應(yīng)姿態(tài)為正；繞對應(yīng)軸反轉(zhuǎn)，相應(yīng)姿態(tài)為負 2. X軸指北時，航向角為零。北偏東順時針依次從0變?yōu)?60deg |
X軸：俯仰角 Y軸：橫滾角 Z軸：航向角 1. ?俯仰角和橫滾角：姿態(tài)角方向與對應(yīng)軸向轉(zhuǎn)動方向一致；繞對應(yīng)軸正轉(zhuǎn)，相應(yīng)姿態(tài)為正；繞對應(yīng)軸反轉(zhuǎn)，相應(yīng)姿態(tài)為負。 2. ?航向角：姿態(tài)角方向與對應(yīng)軸向轉(zhuǎn)動方向相反。 |
| ? | 注意：由于航向角定義為：Y軸指北時，航向角為零。北偏東順時針依次從0變?yōu)?60deg。而Z軸指天，Z軸反轉(zhuǎn)時，航向角才依次增大。 | |
03?
?歐拉角旋轉(zhuǎn)?
在檢索參考資料的時候發(fā)現(xiàn)有大佬（站在巨人的肩膀上）圖文并茂的介紹這部分內(nèi)容，原文作者講歐拉旋轉(zhuǎn)介紹的深入淺出、涇渭分明。
參考并直接閱讀如下三篇博文： ????
1.?三維旋轉(zhuǎn)矩陣推導與助記 ? ?
2.?歐拉角旋轉(zhuǎn) ? ?
3.?歐拉角&旋轉(zhuǎn)矩陣 ?
簡單的說明一下 ???
1. 三維空間中剛體定點轉(zhuǎn)動需要三個自由度，最簡單的就是歐拉角表示。但是由于旋轉(zhuǎn)順序問題，歐拉角表示不唯一。根據(jù)坐標系繞其軸的旋轉(zhuǎn)順序不同，存在多種定義方式 ???
?2. 作者在文章提到的 慣性坐標在本文中對應(yīng)導航坐標系（也稱為大地坐標系、實驗室參考系。不管名字怎么叫，其特點是這類坐標系是靜止不動的） ????
3. 旋轉(zhuǎn)順序按照不同的參考目標分成了 繞載體坐標軸旋轉(zhuǎn): 旋轉(zhuǎn)順序依次是X、Y、Z ?和 繞導航坐標軸旋轉(zhuǎn):旋轉(zhuǎn)順序依次是z、y、x(注意：這里的描述大寫字母XYZ坐標軸是旋轉(zhuǎn)的載體坐標軸；小寫字母xyz坐標軸是靜止不動的導航坐標軸。)
此圖順序為：先轉(zhuǎn)航向角， 再轉(zhuǎn)俯仰角，最后轉(zhuǎn)橫滾角(321(先轉(zhuǎn)Z軸，然后Y,最后X), 或者叫ZYX順序)
04? ?導航坐標系與載體坐標系之間的姿態(tài)旋轉(zhuǎn)矩陣?
1.基本旋轉(zhuǎn)矩陣
假設(shè)坐標系1 通過繞其3個軸旋轉(zhuǎn)后得到坐標系2，變換矩陣為：
?
2. 導航坐標系[東北地坐標系]-[前右下]載體坐標系 ???
?歐拉角旋轉(zhuǎn)順序 3-2-1：偏航(Z 軸) - 俯仰(Y 軸) - 橫滾(X 軸) ????將導航坐標系 n 通過三次旋轉(zhuǎn)，旋轉(zhuǎn)到與載體坐標系 b 對齊
?
3. 導航坐標系[東北天坐標系]-[右前上]載體坐標系 ????
歐拉角旋轉(zhuǎn)順序 3-1-2：偏航(Z 軸) - 俯仰(X 軸) - 橫滾(Y 軸) ????將導航坐標系 n 通過三次旋轉(zhuǎn)，旋轉(zhuǎn)到與載體坐標系 b 對齊
審核編輯：劉清