基于Elmo數(shù)字伺服控制器的機(jī)載吊艙陀螺穩(wěn)定平臺(tái)設(shè)計(jì)
在民用市場(chǎng),國(guó)內(nèi)現(xiàn)有的機(jī)載吊艙陀螺穩(wěn)定系統(tǒng)大多采用模擬伺服控制器,存在多方面的缺陷,比如:體積大,笨重,容易產(chǎn)生漂移,不易調(diào)整,伺服控制效果不好,無(wú)法實(shí)現(xiàn)數(shù)字通信等,因此無(wú)法采用諸如FPGA這樣的芯片去處理運(yùn)動(dòng)信號(hào),成了性能無(wú)法提升的瓶頸,不能很好地滿足市場(chǎng)需求。
Elmo公司的Whistle系列數(shù)字伺服控制器,體積小、重量輕、提供數(shù)字輸入與輸出接口,提供RS232與CAN總線2種通信方式,可編程。采用Elmo Whistle數(shù)字伺服控制器,通過(guò)編程,僅需設(shè)計(jì)相對(duì)簡(jiǎn)單的一部分外圍電路,就能實(shí)現(xiàn)很復(fù)雜的功能,體現(xiàn)出極大的優(yōu)越性。但目前國(guó)內(nèi)應(yīng)用這一控制器來(lái)實(shí)現(xiàn)機(jī)載吊艙陀螺穩(wěn)定平臺(tái)的廠家比較少,因此可以借鑒的經(jīng)驗(yàn)非常有限。本文通過(guò)仔細(xì)研讀Elmo相關(guān)文檔,設(shè)計(jì)出了符合性能指標(biāo)的機(jī)載陀螺穩(wěn)定平臺(tái)。
1 吊艙及陀螺穩(wěn)定平臺(tái)
吊艙是指懸掛在運(yùn)動(dòng)載體(如飛機(jī)、船舶)外的艙體有效載荷容器裝置。它的作用主要是隔離載機(jī)的姿態(tài)變化和機(jī)械振動(dòng)對(duì)光電傳感器指向的影響。吊艙系統(tǒng)由陀螺穩(wěn)定平臺(tái)伺服平臺(tái)、電視跟蹤系統(tǒng)、座艙顯示和控制系統(tǒng)、紅外測(cè)量系統(tǒng)、激光測(cè)距儀和GPS定位于測(cè)距數(shù)據(jù)鏈系統(tǒng)、數(shù)據(jù)采集和記錄系統(tǒng)、吊艙環(huán)控系統(tǒng)等7部分組成。
陀螺穩(wěn)定平臺(tái)系統(tǒng)主要用于穩(wěn)定機(jī)載吊艙上TV和紅外攝像機(jī)的視軸穩(wěn)定,消除直升飛機(jī)飛行過(guò)程中由于搖擺帶來(lái)的干擾力矩。這里設(shè)計(jì)的平臺(tái)屬于二軸四框架系統(tǒng),分為方位軸和俯仰軸。在每一個(gè)軸上安裝一個(gè)單自由度的光纖陀螺,用來(lái)感應(yīng)干擾力矩。陀螺輸出信號(hào)經(jīng)過(guò)放大濾波后,送到Elmo伺服控制器,由控制器智能處理陀螺信號(hào)。信號(hào)處理完畢之后,由控制器的輸出部分,驅(qū)動(dòng)直流伺服電機(jī),實(shí)現(xiàn)整個(gè)系統(tǒng)的穩(wěn)定。
2 穩(wěn)定平臺(tái)設(shè)計(jì)
2.1 系統(tǒng)總體設(shè)計(jì)框圖
此文設(shè)計(jì)的陀螺穩(wěn)定平臺(tái)主要是要保證各個(gè)光傳感器的視軸穩(wěn)定。結(jié)合整個(gè)吊艙系統(tǒng),主要是實(shí)現(xiàn)以下6個(gè)功能:
1)現(xiàn)吊艙的穩(wěn)定控制;2)實(shí)現(xiàn)吊艙的運(yùn)動(dòng)控制;3)限位信號(hào)輸入;4)錯(cuò)誤指示電路;5)LOCK電路;6)串口通信。
圖l為系統(tǒng)總體設(shè)計(jì)框圖。
2.2 硬件電路設(shè)計(jì)
2.2.1 陀螺信號(hào)處理電路
由于俄羅斯的Fizoptika VG94l-3AS光纖陀螺輸出信號(hào)非常微弱,輸出比例因子只有3.3 mV/deg/s。對(duì)于這么微弱的信號(hào),必須要先進(jìn)行小信號(hào)的放大電路處理,才能傳送到Elmo伺服控制器,進(jìn)行下一步的處理。這里要說(shuō)明的一點(diǎn)是,并沒(méi)有對(duì)陀螺輸出信號(hào)進(jìn)行濾波處理,原因在于Elmo伺服控制內(nèi)部已經(jīng)有了數(shù)字濾波電路,可以在調(diào)試時(shí)進(jìn)行相關(guān)設(shè)置,以達(dá)到濾波目的。
Elmo數(shù)字伺服控制器原本有2個(gè)模擬輸入口的,可直接將光纖陀螺的輸出信號(hào)接入數(shù)字伺服控制器,但由于陀螺的隨機(jī)漂移大,基本無(wú)規(guī)律可以遵循,每次開(kāi)機(jī),給陀螺供電時(shí),陀螺的隨機(jī)輸出是不一樣的。所以,應(yīng)設(shè)計(jì)陀螺信號(hào)處理電路,一方面可以將陀螺的輸出信號(hào)按一定比例的放大,然后輸入到Elmo數(shù)字伺服控制中,減少程序中的比例因子,進(jìn)而減少Elmo數(shù)字伺服控制器內(nèi)部的噪聲對(duì)整個(gè)系統(tǒng)的影響,另一方面通過(guò)外接一只可調(diào)電阻,實(shí)現(xiàn)每次開(kāi)機(jī)的漂移量補(bǔ)償,從而使吊艙保持平穩(wěn)狀態(tài)。
Fizoptika VG941-3A光纖陀螺在載體靜止時(shí),輸出電壓為2.5 V。因此要保證載體靜止時(shí),輸入到Elmo數(shù)字伺服控制模擬輸入口的電壓為0 V,必須用一個(gè)精準(zhǔn)電壓芯片產(chǎn)生2.5 V的電壓,通過(guò)放大器4558實(shí)現(xiàn)一個(gè)減法電路。在該減法電路中,用REF02CZ產(chǎn)生5 V的電壓,然后通過(guò)電阻分壓得到2.5 V基準(zhǔn)電壓。圖2為陀螺信號(hào)處理電路(減法電路)原理圖。
2.2.2 電源電路設(shè)計(jì)
這里的電源電路設(shè)計(jì)主要的目的是給各芯片提供基準(zhǔn)電壓。TSMl212D用于產(chǎn)生±12 V基準(zhǔn)電源,給放大器4558和REF02CZ提供基準(zhǔn)電壓,而REF02CZ用于產(chǎn)生+5 V基準(zhǔn)電壓,給放大器提供參考電壓。圖3為電源電路原理圖。
伺服電機(jī)相關(guān)文章:伺服電機(jī)工作原理
評(píng)論