MEMS加速度傳感器的自動(dòng)校準(zhǔn)平臺(tái)
摘要:介紹了一種基于MEMS加速度傳感器的自動(dòng)校準(zhǔn)平臺(tái)的設(shè)計(jì)方案。從數(shù)學(xué)模型入手,推導(dǎo)了傾角測(cè)量算法并設(shè)計(jì)了調(diào)平控制方案。在電機(jī)控制環(huán)節(jié)加入改進(jìn)后的PID算法,解決了輸出突變導(dǎo)致系統(tǒng)性能下降的問(wèn)題??炻龣n的設(shè)定使系統(tǒng)在縮短調(diào)平時(shí)間的同時(shí)兼顧精度的要求。實(shí)驗(yàn)結(jié)果表明,該系統(tǒng)工作穩(wěn)定,可用于一般調(diào)平場(chǎng)合。
關(guān)鍵詞:MXC62025G;自動(dòng)調(diào)平;PID控制;抗干擾
引言
現(xiàn)代測(cè)控系統(tǒng)在正常工作時(shí)往往需要一個(gè)基準(zhǔn)平臺(tái),在這樣的客觀需求下調(diào)平技術(shù)應(yīng)運(yùn)而生。目前該技術(shù)已廣泛應(yīng)用于各種工業(yè)領(lǐng)域,如起重機(jī)支架、鉆井平臺(tái)、火炮底座、衛(wèi)星天線基座、導(dǎo)彈發(fā)射平臺(tái)等。傳統(tǒng)的手動(dòng)調(diào)平方式費(fèi)時(shí)費(fèi)力,嚴(yán)重影響了平臺(tái)上設(shè)備機(jī)動(dòng)性能的發(fā)揮。自動(dòng)校準(zhǔn)平臺(tái)的研制彌補(bǔ)了手動(dòng)方式的不足,并且在效率、精度、可靠性等方面都優(yōu)于手動(dòng)校準(zhǔn)平臺(tái)。本文介紹了一種能夠?qū)崟r(shí)監(jiān)控平臺(tái)狀況并通過(guò)步進(jìn)電機(jī)進(jìn)行相應(yīng)調(diào)節(jié)的自動(dòng)校準(zhǔn)平臺(tái)。
1 傾角測(cè)量原理
MXC62025G是美新(Memsic)公司推出的一款基于MEMS技術(shù)的雙軸加速度傳感器,集成了片上信號(hào)處理和I2C總線模塊,無(wú)需外接A/D轉(zhuǎn)換器便可以與微處理器通信。該傳感器可以同時(shí)測(cè)量恒定和變化的加速度,測(cè)量范圍為-2~+2 g,在25℃室溫、3 V工作電壓的條件下,其靈敏度可達(dá)512計(jì)數(shù)點(diǎn)/g。其內(nèi)部結(jié)構(gòu)如圖1所示,硅片中心有一個(gè)熱源,四周等間距地放置了4個(gè)熱電堆。當(dāng)硅片水平靜止時(shí),熱源周?chē)臏囟忍荻仁蔷鶆虻?,所?個(gè)熱電堆的溫度相同,輸出電壓相同。當(dāng)硅片傾斜或在某一方向上有加速度時(shí),熱源周?chē)臏囟忍荻劝l(fā)生擾動(dòng),因而輸出電壓發(fā)生變化。
由于傳感器的輸出不能為負(fù),因而需要減去一個(gè)偏移量來(lái)區(qū)分正負(fù),此處取輸出值的中值,即最大值與最小值之和的一半。另外,傳感器的輸出是加載在兩個(gè)測(cè)量軸上的重力加速度的分量,要輸出傾角值還需進(jìn)行數(shù)據(jù)處理。假設(shè)X軸向的傾角為α,Y軸向的傾角為β,則輸出值與傾角大小存在以下關(guān)系:
即
當(dāng)傾角較小時(shí),軸向加速度與傾角之間近似為線性關(guān)系,故有:,K值選取與傾角誤差之間的關(guān)系如表1所列。
不難看出,測(cè)量范圍與測(cè)量精度是一對(duì)矛盾。為了提高系統(tǒng)的精度,應(yīng)當(dāng)盡量減小平臺(tái)調(diào)節(jié)的幅度,所以自動(dòng)校準(zhǔn)平臺(tái)應(yīng)當(dāng)先大致擺放到水平位置再按啟動(dòng)開(kāi)關(guān)。
pid控制器相關(guān)文章:pid控制器原理
傾角傳感器相關(guān)文章:傾角傳感器原理
評(píng)論