的溢出感知執行我試圖實現卡爾曼濾波器獲得物體的定向,使用3軸加速計和3軸陀螺儀作爲傳感器。卡爾曼濾波器
選擇此過濾器的預測階段的動態模型是直線前進,它是:
new_angle = angle + angular_velocity * time
new_angular_velocity = angular_velocity
但我沒有浮點支持的手,我需要的精度每一位來建模角度。因此,我的計劃是將角度表示爲32位整數數據,表示完整轉爲2 pi
爲2^32個小步驟。 因此,整數溢出處理換行(2 pi
與0
方向相同)是免費的。
但是,這也構成了對過濾器的一個問題:如果估計的角度將,說359°
,我的測量0°
,然後過濾器是假設一個巨大的創新,導致不確定性和奇數值。
有什麼辦法讓過濾器意識到這種可能的包裝?在上述情況下僅創新1°
?
爲了規避這個問題,我想過使用角度的差異,而不是角度,但我不能找到合適的型號。