慣性平臺(tái)防倒臺(tái)保護(hù)電路設(shè)計(jì)
2 硬件設(shè)計(jì)
平臺(tái)防倒臺(tái)保護(hù)電路主要由角度測(cè)量電路和控制電路兩部分組成。
2.1 角度測(cè)量電路
平臺(tái)輸出的開關(guān)門信號(hào)測(cè)量采用專用定時(shí)/計(jì)數(shù)芯片82C54進(jìn)行測(cè)量。選用的Intersil公司的82C54是標(biāo)準(zhǔn)TTL電平的邏輯器件,當(dāng)邏輯電平>2.2 V時(shí)認(rèn)為是1,當(dāng)邏輯電平0.8 V時(shí)認(rèn)為是0。
這里以X通道的姿態(tài)角測(cè)量電路為例進(jìn)行說明(如圖3所示)。平臺(tái)送出的X軸姿態(tài)角信號(hào)包括粗通道的兩路開關(guān)門信號(hào)以及精通道的兩路開關(guān)門信號(hào)。開門脈沖到來后,邏輯電路使82C54計(jì)數(shù)器的GATE端變?yōu)楦唠娖剑?2C54計(jì)數(shù)器開始計(jì)數(shù),關(guān)門脈沖到來后,邏輯電路使82C54計(jì)數(shù)GATE端變?yōu)榈碗娖剑?2C54計(jì)數(shù)器停止計(jì)數(shù),完成計(jì)數(shù)后CPU便可讀取粗精通道的計(jì)數(shù)值,經(jīng)過計(jì)算以及粗精通道的耦合即可精確也計(jì)算出姿態(tài)角的大小,進(jìn)一步計(jì)算出角速度。根據(jù)平臺(tái)倒臺(tái)的判斷依據(jù)(角速度通常達(dá)到較大角速度),平臺(tái)保護(hù)電路只需測(cè)量粗通道的姿態(tài)角即可。本文引用地址:http://www.ex-cimer.com/article/172973.htm
開關(guān)門計(jì)數(shù)需要解決的主要問題是如何使兩路開關(guān)門脈沖信號(hào)控制82C54的GATE端,實(shí)現(xiàn)開門脈沖到來時(shí)82C54開始計(jì)數(shù),關(guān)門脈沖到來時(shí)82C54停止計(jì)數(shù)。這里通過門電路實(shí)現(xiàn),如圖4所示。開關(guān)門信號(hào)經(jīng)異或門后,再與開門信號(hào)相與,最后就得到即能反映角度大小又滿足控制82C54的GATE端信號(hào),如圖5所示。
根據(jù)平臺(tái)姿態(tài)角激磁頻率和填充脈沖的頻率,一個(gè)16位的計(jì)數(shù)器即可滿足一路姿態(tài)角的計(jì)數(shù)。82C54具有3個(gè)獨(dú)立的16位計(jì)數(shù)通道,因此本保護(hù)電路只需1片82C54即可。計(jì)數(shù)方式采用方式4,軟件觸發(fā)選通Soft Triggered Strobe;這種計(jì)數(shù)方式由軟件裝入計(jì)數(shù)初值,在計(jì)數(shù)過程中如果GATE門變?yōu)榈碗娖?,則停止計(jì)數(shù),直到GATE恢復(fù)時(shí),重新從初值開始減計(jì)數(shù)。
伺服電機(jī)相關(guān)文章:伺服電機(jī)工作原理
評(píng)論