引言
物體在運動中的傾角是描述物體運動狀態、特征的重要參數,在交通、航天、軍事領域中都有著重要的意義,對目標的定位、追蹤起到非常重要的作用。所以開發價格適中、精度高,測量范圍大的角度測量模塊具有很強的實用價值。
本文根據對實際運動的分析,研究建立了相應的數學模型,利用數字式MEMS加速度傳感器并配合適當的硬件電路和軟件算法實現了一種性價比高,高精度,測量范圍大的角度測量模塊并通過實際運行,取得良好的效果。
1 對象研究和建模
本文研究的對象是物體運動時,其整體平臺的傾斜角,例如普通車輛機車,軍用車輛機車和海上裝備等,在運動過程中由于路面、坡度等影響會使整個平臺架產生一定的傾角,而這些參數對于精確導航、列車行程控制等系統都具有重要的意義。
根據經典力學可以知道,當對象與基準平面有一個角度的夾角時,其運動方向的加速度與重力加速度的比值和沒有夾角時其加速度與重力加速度的夾角α是不同的。根據力的分解,重力加速度就會有分量作用在Ax方向,且Ax=gsinα,于是傾斜角α=sin-1(Ax/g)。見圖1-(a)所示。但是,當對象在基準面方向上做變加速的運動時,其Ax同樣是一個變化值,這樣將由于無法區別對象的靜態加速度和動態加速度而做出正確的判斷。也可以考慮采用圖1-(b)中所示方法測量,將Ax設定為始終與運動面垂直的方向,這樣Ax=gcosα,則傾斜角α= cos-1(Ax/g)。這個方法在普通的道路坡度只能在Ax方向產生一個很小的加速度變化,而這對于該傳感器的精度是很難達到的。
故考慮采用如圖1- (c)所示方法進行測量,利用雙軸的加速度傳感器,其兩個夾角之間相差90°,兩個角分別為45°和135°角,當車輛靜止在平面上時,加速度傳感器的兩個軸向測得加速度:Ax=Ay=0.707g。
圖1 測量力學原理圖
當車輛在平面上加速時,加速度傳感器的兩個軸向就會測得兩個大小相等,極性相反的加速度變化,而(Ax+ Ay)保持不變,例如:車輛向前加速時,Ax增大而Ay減小。
當車輛傾斜時,傾斜角α=cos-1[0.707(Ax+Ay)/g]。但是在實際情況中,由于測量、安裝等原因,幾乎不可能做到加速度傳感器與車輛的徑向正好成45°,所以需要在系統初始化時,首先測量出加速度傳感器與車輛的徑向的夾角β,可根據公式β=arctan(Ay/Ax)計算得到。
由此可得最后的傾斜角為:α=cos-1[ (Axsinβ+Aycosβ)/g]。根據這個數學模型,可以很好的測得角度的變化。所以在實際使用就利用軟、硬件根據該模型進行設計從而實現了微小角度的測量。
2 系統設計
根據上面的對象研究和建模分析,并結合實際需求開始進行系統設計。在設計的過程中,根據算法設計選取了相應的硬件,按照硬件的選取經過分析,最后確定所需硬件電路,然后編制了相應的軟件完成整個設計。
2.1硬件設計
設計中使用的是ADXL213芯片,其采用先進的MEMS 技術,在同一硅片中刻蝕了一個多晶硅表面微機械傳感器,并集成了一套精密的信號處理電路。信號處理電路能將表面微機械傳感器產生的模擬信號轉換為占空比調制(DCM) 數字信號輸出。
這種占空比調制信號可以直接使用單片機或計算機進行處理。用單片機進行數據處理時,使用計數器測量方波周期T2 以及脈沖的寬度T1。其計算公式:AX=(T1/T2―Zero Bias)/Sensitivity;Zero Bias=50%,Sensitivity=30%/g,T2=Rset/125。ADXL213可以測量靜態加速度,也可以測量動態加速度,其最大測量帶寬為2.5kHz。帶寬(W)是由低通濾波器的參數確定的。其滿足如下關系式:W=1/2πRFCF。式中:RF為濾波器的電阻值, 即集成在芯片內部的電阻;CF為濾波器的電容值。可見,帶寬主要由CF確定。在實際設計過程中,根據汽車加速度-時間曲線,選定濾波器的帶寬為1Hz,這樣做不僅有利于濾除高頻干擾,也利于降低系統噪聲干擾。由于ADXL213中T2的范圍為1~10