1. 程式人生 > >利用加速度求解位置的演算法——三軸感測器

利用加速度求解位置的演算法——三軸感測器

觀察上面的圖,加速度先增加後減少直到速度達到最大值(加速度始終為正代表往同一方向加速)。然後以相反的方式加速,直到它再次到達0。在這一點上達到一個穩定的位移和新的位置。
    在真實世界中,其中曲線正側下方的區域面積不等於負側上方的區域面積,積分結果將永遠不會達到零速度,因此將是一個傾斜定位(從未穩定)。

    正因為如此,將速度強制減為0非常關鍵。這是通過不斷讀取加速度值和0進行比較而實現的。如果在一定數量的取樣中,這種情況存在(sample==0)的話,速度將簡單地返回為0。