[發明專利]基于加速度計和陀螺儀的載體轉速與轉角補償測量方法

在審

• 申請號: 201410175383.6
• 申請日: 2014-04-28
• 公開（公告）號: CN103913171A
• 公開（公告）日: 2014-07-09
• 發明（設計）人: 王衛江;高巍;榮政
• 申請（專利權）人: 北京理工大學
• 主分類號: G01C21/16
• 分類號: G01C21/16;G01C25/00
• 代理公司: 暫無信息
• 代理人: 暫無信息

技術領域

本發明是一種基于加速度計和陀螺儀的載體轉速與轉角補償測量方法,屬于慣性傳感器與測量技術領域。

背景技術

對運動載體轉速和轉角測量方法的研究一直是自動化、測量控制領域當中的基礎研究，對載體轉速與轉角的測量可廣泛見于多種不同領域的不同應用場合。轉動角速度和轉動角度是描述一個旋轉運動物體運動狀態的重要參數，它表征了被測物體在旋轉運動中的角位移及角位移的變化率。

傳統的角速度和角位移測量方法有光電編碼器測量、電磁感應測量等方法，這幾種方法均需要在載體和參照物上精確安裝光電傳感器或者霍爾傳感器，并且其測量對象只能是以固定圓心固定半徑轉動的載體，無法對非固定圓心或者非固定半徑的轉動載體進行測量；另有一種基于加速度計的轉角測量方法，測量傳感器安裝簡單，但該方法下加速度計測量值由于外力等因素干擾噪聲較大，并且需要測量載體等效旋轉半徑，在無法得知、準確測量旋轉半徑或旋轉半徑變化的情況下，這種測量方法并不適用；還有一種基于陀螺儀的測量方法，該方法利用陀螺儀直接測量載體旋轉角速度，短時間內具有較高的精度，但在求解角位移時由于其使用的方法是對角速度進行積分，長期積分之后積分結果漂移嚴重，所得角位移具有很大的累積誤差。

發明內容

本發明的目的是為解決現有測量技術依賴于載體的物理結構和運動方式，實施復雜和誤差較大的問題，提供一種基于加速度計和陀螺儀的載體轉速與轉角補償測量方法，本發明方法中傳感器安裝簡單易行，測量結果精確可靠，長時間內不漂移發散。

為了達到上述目的，本發明提供一種基于加速度計和陀螺儀的載體轉速與轉角補償測量方法。所述載體為任意做旋轉運動的載體，所述測量的內容為在任意非水平面內做旋轉運動的載體的角速度與角位移。所述的測量方法包含以下步驟：

第一步：將傳感器和相關測量電路安裝于載體任意位置上，使得加速度計x、y軸平面與載體轉動平面平行即可，確定載體的初始轉角并記為θ_est(0)；

所述傳感器包括三軸加速度計、單軸陀螺儀。

所述相關測量電路包括信號采集電路和處理電路，采集電路分別與三軸加速度計和單軸陀螺儀連接，用于采集數據，處理電路與采集電路連接，用于進行數據處理。

第二步：確定傳感器數據采樣周期T和互補濾波器數字濾波方法中的互補濾波器時間常數τ，令載體開始轉動，測量電路以采樣周期T讀取三軸加速度計和單軸陀螺儀的測量值，當前時刻n的測量值包括加速度計x軸方向上的加速度值a_x(n)、y軸方向上的加速度值a_y(n)、陀螺儀角速度測量值rate(n)，采用移動平均方法對采集到的加速度計和陀螺儀測量值進行平穩去噪；

所述采樣周期T根據實際測量需求確定。

所述互補濾波器時間常數τ根據傳感器的頻率特性決定，通常取值在0.5～5之間。

第三步：利用加速度計測量值a_x(n)和a_y(n)計算加速度計所測載體轉角θ_acc(n)，利用陀螺儀測量值rate(n)計算陀螺儀所測載體轉角θ_gyro(n)。具體方法為：

所述的利用加速度計測量值計算載體轉角是利用重力加速度在x軸和y軸上分量的三角函數關系求得，當載體在非水平面內做旋轉運動時，重力加速度在加速度計的x軸和y軸上產生分量，在不考慮其他外力情況下，利用該x軸和y軸上的加速度分量根據三角關系求得：

tanθacc(n)=ax(n)ay(n),]]>

繼而得到：