慣性平臺防倒臺保護電路設計
加入技術交流群
2．2 控制電路
以MCU為核心控制電路需在檢測到GATE門變為低電平后立即讀取計數值，并計算出角度值和角速度值。這里采用宏晶科技的STC11F08XE單片機。STC11F08XE單片機是單時鐘／機器周期單片機，平均執行速度比傳統8051單片機快8～12倍，這樣在保證執行速度的前提下，可以選擇較低的晶振頻率，減小對系統的干擾。此外STC11F08XE單片機還具有3個可編程時鐘輸出腳(CLKOUT0／P3．4，CLKOUT1／P3．5，CLKOUT2／P1．1)，并且最大輸出頻率為單片機時鐘頻率的1／2。在這里，使用P1．1腳作為82C54 3個通道的填充脈沖源。當單片機判斷平臺出現倒臺時，立即控制繼電器切斷平臺回路的電源使平臺不飛轉。
3 軟件設計
電路的保護功能是由單片機STC11F08XE根據內部程序設計來實現。
防倒臺保護板的軟件要實現的功能有：(1)對計數芯片82C54的控制。(2)讀取計數值，在82C54完成計數后實時讀取計數值。(3)判斷是否超差，根據計數值判斷是否超差。(4)斷開繼電器，在計數值超差的情況下，及時發出斷開繼電器的指令。包括：1)單片機初始化模塊。2)82C54初始化模塊。3)計算、判斷、執行模塊。本文引用地址：http://cqxgywz.com/article/172973.htm
(1)單片機初始化模塊。
單片機初始化模塊在單片機上電復位后，首先要保證在完成對單片機內部寄存器的配置及完成82C54的初始化之前，控制平臺伺服回路供電的繼電器處于斷開狀態，然后對單片機的各內部寄存器進行配置，并在P1.1口產生82C54所需特定頻率的脈沖信號。
(2)82C54初始化模塊。
在單片機完成初始化后，程序將對82C54 3個計數通道進行初始化，完成3個通道的寄存器的配置。寫入控制字使計數方式為方式4，裝入計數初值。
(3)計算、判斷、執行模塊。
計算、判斷、執行模塊檢測到某個通道停止計數后，將立即讀取該通道的計數值，并與預設的超差數據比較，做出角速度值是否超差的判斷。為防止誤判，在檢測到角速度值超差后，單片機將連續6次讀取此通道的計數值，如果仍判斷為超差則認為平臺出現倒臺，將立即斷開繼電器、發出報警聲并將此時的狀態存入單片機內部的EEROM。
4 結束語
文中為某型號平臺的測試系統設計了硬件防倒臺保護電路板。目前保護電路板已調試完畢，并已在例試臺上進行了實驗。實驗結果表明，保護板在平臺出現倒臺時能夠及時地切斷平臺伺服回路的電源、有效地防止倒臺對平臺的損害。
伺服電機相關文章:伺服電機工作原理
評論