基于MAD2020E加速度的0°~360°傾角傳感器設(shè)計
PIC16F873的RC3和RC2端設(shè)置選擇和校準零點按鍵,當PIC16F873讀入時,通過按鍵的循環(huán)選擇進行0 g的校準和靈敏度的校準。
MAD2020E型加速度計傳感器輸出是2個PWM(占空比):T1/(T1+T2),則加速度輸出為:
PIC16F873中有3個定時器,利用time1可計算PWM高低脈沖寬度的時間。
由MEMIC加速度計輸入與輸出的關(guān)系,信號的輸出表達關(guān)系式:
AOUT(α)=AOUT(0)+SENSITIVITY×SIN(α) (5)
O°~360°傾角實現(xiàn)方法是先把MEMIC加速度計垂直放置,然后在調(diào)整可得AOUT(0),后利用ARCTAN函數(shù):
該方法無需溫度補償。0 g校準是通過預(yù)先設(shè)定一個偏置角度(AngleOffset)來實現(xiàn),然后每次把偏置角度與AOUTX相加,就可完成0 g校準。
而系統(tǒng)軟件主程序流程如圖5所示。
3.2 實驗結(jié)果
按上述傾角測量原理及電路設(shè)計,在實際轉(zhuǎn)角測試平臺上進行數(shù)據(jù)測量,測量角度誤差如圖6所示,測量誤差結(jié)果的不大于±0.1°,實驗證明測量傾角的方法具有良好的精度,從而實現(xiàn)了無溫度補償?shù)碾p軸0°~360°傾角的測量。
4 結(jié)論
采用PIC16F873單片機的加速度傾角傳感器設(shè)計,巧妙利用熱電耦式MEMSIC加速度計MAD2020E傳感器的靈敏度具有可重復(fù)的溫度特性,兩個軸的輸出都是相同的變化幅度,反正切的運算剔除了靈敏度的誤差,同時0 g的偏差利用預(yù)先設(shè)定好的角度偏置來實現(xiàn),從而避免零點漂移造成的角度測量誤差,實現(xiàn)了無溫度補償?shù)碾p軸加速度0°~360°傾角高精度、智能化的測量。
評論