磁力計如何用來計算姿態(2)

2021-08-22 04:36:02 字數 514 閱讀 8146

本篇介紹, 在無人飛行器上 常用的 加速度計+磁強計 的定姿方法。

靜止狀態 抑或 懸停狀態:利用加速度 計算橫滾角(roll)和俯仰角( pitch),利用磁強計解算 偏航角(yaw).

此處貼個圖介紹

這個圖是從下面這位博主借鑑過來的

下面主要針對圖中的解算步驟,作幾點補充:

(1)圖中方法忽略了磁偏角。圖中的假設  「磁地理座標系與b系重合」  ,最終解算的偏航角是在磁地理座標系下的,並非在我們常用的東北天地理座標系下,因此,如果得到在地理座標系下的偏航角的話,需要減去磁偏角。磁偏角需要根據觀測點的經緯高,利用igrf 或wmm地磁模型計算。

(2)圖中,將滾轉角和俯仰角帶入方向余弦矩陣後,得到公式(5),解三元一次方程組即可。

如何用Python計算Softmax?

softmax函式,或稱歸一化指數函式,它能將乙個含任意實數的k維向量z 壓縮 到另乙個k維實向量 sigma 中,使得每乙個元素的範圍都在 0,1 之間,並且所有元素的和為1。該函式的形式通常按下面的式子給出 sigma frac e quad for j 1,k 輸入向量 1,2,3,4,1,2...

如何用cublas計算逆矩陣?

cublas的文件中提供了乙個用lu分解求逆矩陣的方法,需要用到兩個函式 第乙個函式用於做lu分解,第二個函式把lu分解的結果變為逆矩陣。但官方文件對這兩個函式的用法語焉不詳,我花了幾個小時才把這個問題搞定。主要遇到兩個問題 函式有乙個引數是 const float 型別,直接把 float 指標傳...

如何用python計算方程式

互動模式 1 from scipy.optimize import fsolve 23 my str input 輸入要求解的變數 如 x or xy or xyz n 4 my list list my str 5 calc str input 輸入方程式 乘方用 表示 如 x 2 n多個方程式之...