四軸姿態解算,叉積求誤差?

時間 2021-06-05 20:00:48

1樓:仰望星空

叉積可以用來求感測器實測向量和四元數計算向量兩者之間的弧度角誤差。

叉積的物理意義是得到由兩個向量構成的平面的法向量:axb=(aybz-azby)i+(azbx-axbz)j+(axby-aybx)k

叉積的數學意義是得到上述法向量的模長:axb=|a||b|sinθ當ab都是歸一化向量,θ是弧度制並且值比較小時,axb=1x1xsinθ≈θ

則兩個向量的弧度角誤差分到xyz三個軸上時,就分別為x軸誤差(aybz-azby)弧度,y軸誤差(azbx-axbz)弧度,z軸誤差(axby-aybx)弧度。

2樓:張騰

Robert的演算法是針對連續系統的,根本不存在「週期」一說。在implement時, IMU的頻率也足夠高,或者採用高階積分方式連實施濾波,所以題主並不用太擔心這些。

3樓:徐亞飛

我也曾有與題主一樣的疑問,後來我確信這是Mahnoy演算法的乙個不足之處。

事實上,我們只需要對Mahnoy的演算法稍微做一點修改即可。上乙個週期的重力向量估計值不可靠,那就把它更新到當前週期好了,方法很簡單,在叉乘匯出誤差之前,用當前週期未經修正的陀螺儀值解一遍四元數微分方程,得出當前週期的四元數(姿態矩陣)估計值,也就得到了當前週期的重力向量估計值,再用這個重力向量與加計測量向量叉乘求誤差,後面的步驟不變。

Mahnoy那樣做其實沒有大問題,誤差最終肯定還是會收斂。但做了以上改進之後理論上動態精度會有所提高。

除此之外,Mahnoy的演算法還有其他可以改進的地方,比如對積分加限幅、用高階畢卡演算法解四元數微分方程等。

4樓:張GG

你可以看一看卡爾曼濾波。

求得的值是乙個估算的最優值,它依靠上乙個週期的結果和這乙個週期的測量值,各取多少取決於二者的權重,這個權重的值每個週期都會調整。

在飛行器的姿態解算中,為什麼方向余弦矩陣描述的旋轉是按照XYZ的順序進行?

徐亞飛 DCM 以及四元數 不存在旋轉序,尤拉角才有旋轉序。對於乙個確定的旋轉,DCM是唯一確定的,四元數是唯二確定的。而尤拉角則比較複雜,如果考慮是限制尤拉角 roll yaw為 180 180,pitch為 90 90 那麼在非奇異點 pitch 90 乙個旋轉對應12個不同旋轉序的尤拉角,在奇...

為什麼數控工具機按聯動軸數分類沒有四軸

當然有啊。從單軸 兩軸 兩軸半 開始多少都有。系統加軸卡和伺服放大器就完了唄。單軸數控的 電火花成型機 兩軸和兩軸半的數控的普通數控車 兩軸半的簡易數控銑床。三軸的普通數控銑 三軸半的帶W軸動梁的數控銑床 四軸的雙頭車床 帶C軸的或者轉台的臥鏜。 精品機械技術趨勢 數控工具機涉及到直線軸和旋轉軸,直...

加工中心的四軸聯動和五軸聯動是什麼意思

哥斯拉 大神們寫的都太專業了!我這個剛接觸4軸桌面機的幼稚生也說下我的理解吧,四軸四聯動指的是加工策略!比如四軸機大多採用螺旋精加工策略旋轉加工物件,X 或 Y 軸垂直 Z 軸加工,這樣在加工時 X 或 Y 是垂直 Z 軸不動的!這樣的加工方式會有許多的死角無法一次加工到位必須多次補刀!如果四軸機採...