其實我覺得要說四軸的姿態，我們必須說幾樣東西。
（1）座標系
（2）方向余弦矩陣
（3）尤拉角
（4）四元數
對上面這四樣東西有了初步的理解，就可以開始看imu的飛控解算程式了。
其實我剛剛接觸四軸的時候我沒明白為什麼四軸裡面一會來個地理座標系，一會來個機體座標系。搞這麼多座標系幹什麼用的。後來在秦永元的書裡面說了，由於運動的相對性，當我們研究乙個運動物件的時候我們必須指明是相對哪個座標系運動的。因此，針對不同的研究物件和具體任務，正確的選取不同的座標系是十分必要的，這也是一種預設的習慣。
那麼四軸是否就能夠看做乙個機體座標系，而我們四軸在三維空間中的運動是不是就把它看做是相對於地理座標繫在運動。正是由於有這樣乙個關係在裡面我們才會引入方向余弦矩陣，四元數。這些聽起來高大上的名字其實說穿了只是用來表示座標系之間的旋轉。
有了上面對於座標系的鋪墊，下面我們在談談方向余弦矩陣。說這個東西必須拿出一幅圖
假設為參考座標系，為機體座標系，初始時刻兩個座標系重合，經過繞軸旋轉度，繞軸旋轉度，最後繞軸旋轉度後轉到它的新位置oxyz，我們叫這三次小角度轉動為尤拉角。其實所謂的尤拉角就是剛體繞座標軸旋轉的角度。
（1）繞軸旋轉的方向余弦矩陣為
（2）繞軸旋轉的方向余弦矩陣為
（3）繞軸旋轉的方向余弦矩陣為
最後我們可以知道為參考座標系經過的旋轉可以轉到xyx座標系。
通過上面的一些描述我們就可以對方向余弦矩陣做乙個總結。
方向余弦矩陣：這是對於座標系之間相對轉動的一種數學描述。
例如兩個重合的座標系，當乙個座標系相對另外乙個座標系做一次或者多次旋轉以後得到另外乙個新的座標系，前者一般叫做固定座標系，後者叫做動座標系。而它們之間的這種轉動關係就可以用方向余弦矩陣來表示。
上面把方向余弦矩陣和尤拉角的概念都說了，最後我們在談談四元數。
一直在說四元數這個東西，對於沒有接觸過的人這個概念可能有點陌生，下面我就為大家通俗的介紹這個東東。
先來點官方的概念介紹
根據秦永元慣性導航書本上面的知識
（1）四元數的數學定義
顧名思義，四元數就是由四個元構成的數：
其中，，q1，q2，q3都是實數，i，j，k均是相互正交的單位向量。
（2）四元數在四軸中的表達方式
我們把上面這種表示方式稱為特徵四元數，其範數
，在四軸或者導航中所遇到的四元數均為特徵四元數，在相關文獻中，統稱為四元數，不再另加說明。
好了，四元數的基本數學概念有了就行了，下面我們來說說四元數用來幹什麼，其實四元數的本質仍然表示的是座標變換。它和我們上面介紹的方向余弦矩陣本質上說的是同乙個東西。
同樣的圖我們用四元數來表示上面這個座標系的旋轉，可以用如下公式來表示
通過將上面的方向余弦矩陣和這裡的四元數矩陣相互比較就可以求出尤拉角。
今天是第一次在csdn上面發部落格，如果有什麼理解或者寫的不對的，請大家多多指正。
四軸飛行器姿態控制
用來表示三維空間中運動物體繞座標軸旋轉的情況，即物體每時每秒的姿態可以由尤拉角表示。四元數用於物體的旋轉，是一種複雜但是效率較高的旋轉方式。對於乙個物體的旋轉，我們只需要知道四個值 乙個旋轉向量 乙個旋轉角度，而四元素也正是 這樣設計的 q x,y,z,w 其中x,y,z代表向量的三維座標，w代表角...
微型四軸飛行器（5）九軸姿態融合演算法A
所謂的九軸姿態融合就是將通過感測器獲得的3軸加速度 3軸角速度 3軸磁場資料，在相應的演算法處理後能夠得到飛行器的姿態資訊 尤拉角 輸入輸出如下圖 在慣性導航領域的尤拉角分別表示的是航向角 yaw 橫滾角 roll 俯仰角 pitch 我們擬建一空間直角座標系，在該座標系中，物體做出的任何姿態同樣也...
微型四軸飛行器（5）九軸姿態融合演算法B
飛行器在空中的執行姿態可以用平面和轉動來表示，為了方便使用向量表示，需要建立兩個空間直角座標系。設r表示單位向量在機體座標系下的三個軸的投影，b表示單位向量在地球座標系下的三個軸的投影。我們通常對飛行器的偏航 俯仰 橫滾了多少度的定義是參照地球座標系而下得出的，也就是我們只需要知道向量r相較於向量b...