基于嵌入式單片機的光電伺服控制系統(tǒng)的設(shè)計

摘 要：根據(jù)伺服系統(tǒng)的工作原理和系統(tǒng)構(gòu)成，采用8051單片機作為控制器件，利用嵌入式技術(shù)，設(shè)計一種基于單片機控制的光電伺服系統(tǒng)，并對系統(tǒng)的基本結(jié)構(gòu)、工作模塊、控制方案、驅(qū)動技術(shù)等進行分析探討。實踐應用表明該系統(tǒng)設(shè)計具有可靠性高、易于控制、智能化的特點，能快速適應目標跟蹤的需要，具有精度高、響應快、跟蹤平穩(wěn)等優(yōu)良的運作性能。

關(guān)鍵詞：伺服控制系統(tǒng)；光電伺服系統(tǒng)；數(shù)字PID控制；離散化周期

中圖分類號：TP274 文獻標識碼：B 文章編號：1004373X(2008)1804703

Design of Photoelectric Servo Control System Based on Embedded Single Chip Computer

GAO Jintao，SUN Jianguo，LI Wenjun，CHEN Jianxing

(Unit 63898 of PLA，Jiyuan，454650，China)

Abstract：In this paper，based on the ultimate system principle and structure，employs chip 8051 as core controller，using embedment technology，designs photoelectric servo control system controlled by embedded chip，and analyses the basic framework，working module，control project and drive technology.It shows that the whole system has superior working capability with high credibility，easy controllable and intelligence，the servo control system can meet the demand of fast target track，with the capability such as high precision，quick response and good stability.

Keywords：servo control system;photoelectric servo system;digital PID control;dispersant cycle

伺服系統(tǒng)是光電對抗系統(tǒng)中重要的一環(huán)。在執(zhí)行機構(gòu)的帶動下，伺服系統(tǒng)可以快速、準確、平穩(wěn)地跟蹤目標，從而為實施有效的抗干擾通信奠定基礎(chǔ)。為此，對于大型精密伺服系統(tǒng)，應選用電流、轉(zhuǎn)速、位置3環(huán)結(jié)構(gòu)，以保證高精度、快速性和穩(wěn)定性。電流環(huán)的設(shè)計采用霍爾元件作電流反饋量，轉(zhuǎn)速環(huán)反饋通道為與伺服電機同軸聯(lián)接的測速電機，這樣有助于減少齒輪系的誤差，提高系統(tǒng)的跟蹤精度；位置環(huán)采用變系數(shù)PID數(shù)字控制，可解決定位精度高，動態(tài)響應快等問題，位置反饋通道采用14位光電編碼器，可將位置信號直接轉(zhuǎn)化成數(shù)字量，精度可達80″。

1 伺服系統(tǒng)工作原理及設(shè)計

圖1所示的伺服系統(tǒng)工作原理是:外部信息與光電編碼器輸出量進行比較，獲得的誤差量經(jīng)PID運算作為轉(zhuǎn)速環(huán)的輸入量，速度調(diào)節(jié)器的輸出作為電流環(huán)的輸入，經(jīng)電流調(diào)節(jié)器驅(qū)動PWM功率放大器，以拖動力矩電機帶動負載跟蹤目標。

1.1 軟件實現(xiàn)

從軟件實現(xiàn)功能上看，控制程序包括前臺程序和后臺程序。前臺程序的任務(wù)是完成實時控制，主要包括采樣輸入、控制運算、控制輸出等。后臺程序的任務(wù)是對系統(tǒng)進行監(jiān)控，如系統(tǒng)上電后的初始化定位、狀態(tài)輸出等一系列輔助功能，其流程如圖2所示。

圖1 伺服系統(tǒng)結(jié)構(gòu)原理圖圖2 控制程序流程圖控制程序所要實現(xiàn)的各種功能可以采用消息驅(qū)動的方式。消息驅(qū)動就是利用不同的消息(事件)激活相應的中斷服務(wù)程序，系統(tǒng)所要實現(xiàn)的全部控制任務(wù)或功能都用中斷服務(wù)程序完成。根據(jù)任務(wù)的重要性和實時要求，可以對中斷服務(wù)類型和中斷源的優(yōu)先級進行設(shè)定。對有實時性要求的前臺程序，即采樣一一控制程序，用定時器中斷源激活，并占用最高的中斷級。狀態(tài)輸出等輔助功能程序則可采用 PEC中斷處理方式，且其優(yōu)先級必須低于采樣控制中斷的優(yōu)先級。

采用易于實現(xiàn)且適用范圍廣的數(shù)字PID算法，在連續(xù)PID算式中，將積分項用矩陣形式代替，微分項用差分代替，數(shù)字PID算式可寫成：U(k)=Kpe(k)+TsTi∑kj=0e(j)+TdTse(k)－e(k－1)

=Kpe(t)+Ki∑kj=0e(j)+Kd［e(k)－e(k－1)］式中，Ki=KpTsTi；Ki=KpTdTs。為了減少計算量，節(jié)省存儲空間，常采用PID增量型控制算式：

U(k)=U(k－1)+ΔU(k)

=U(k－1)+Kpe(k)－e(k－1)+TsTie(k)+TdTs［e(k)－2e(k)+e(k－2)］

=U(k－1)+q0e(k)+q1e(k－1)+q2e(k－2)

式中：q0=kp［1+TsTi+TdTs］；q1=－kp［1+2TdTs］；q2=kpTdTs。

采用數(shù)字PID算法的采樣一一控制程序流程如圖3所示。實際應根據(jù)伺服電機的類型和相關(guān)參數(shù)確定最佳控制參數(shù)。

圖3 采樣控制中斷程序流程1.2 系統(tǒng)設(shè)計

驅(qū)動電路也是一個小型的單片機系統(tǒng)，單片機接收主控單元發(fā)出的方波信號、天線正反轉(zhuǎn)、細分信號，并控制步進電動機驅(qū)動器驅(qū)動2個步進電動機分別按不同的要求轉(zhuǎn)動。天線可沿X軸向、Y軸向2個自由度運行，每個軸向分別由1個電動機驅(qū)動。實現(xiàn)平滑調(diào)速和準確定位。

根據(jù)系統(tǒng)特點，可以將其抽象成一個離散控制系統(tǒng)，離散化周期就是上位機送數(shù)周期T，第k次送數(shù)時間稱為k時刻;在每個時刻，上位機發(fā)送天線在下一個時刻X軸向、Y軸向的目標位置。系統(tǒng)與上位機通訊使用并口通訊，由系統(tǒng)以硬件中斷方式接收數(shù)據(jù)。

系統(tǒng)主程序是一個循環(huán)結(jié)構(gòu)，在中斷服務(wù)程序中，對上位機發(fā)出的滿足通訊協(xié)議的數(shù)據(jù)保存并將對應標志位置位。在主程序中，判斷這個標志位的狀態(tài)，并進行對應操作，如果目標位置沒有改變，則只顯示無線當前位置，天線速度和轉(zhuǎn)向都不變;天線某軸向到達目標位置后停轉(zhuǎn)。出于對可靠性的考慮，還要判斷天線是否轉(zhuǎn)出了給定范圍，當越界時，天線停轉(zhuǎn);如果開機位置值出錯，則天線要首先高速返回到給定范圍內(nèi)。由于系統(tǒng)有隨動和定位2種工作模式，在隨動方式下，天線要變速運行，使其始終能夠高精度跟蹤目標位置;在定位方式下則以給定速度勻速運動。為了簡化硬件結(jié)構(gòu)，設(shè)置兩種方式自動切換，在運行過程中，判斷目標位置是否刷新，如果刷新就運行在隨動方式，否則以定位方式運行;如果位置值刷新但與上次位置值相差較大，則運行在定位方式。

PWM晶體管功率放大器包括電壓脈寬變換器和開關(guān)式功率放大器2部分。其簡化結(jié)構(gòu)圖如圖4所示：

圖4 PWM式晶體管放大器結(jié)構(gòu)圖PWM功放的輸出是一串寬度可調(diào)的矩形脈沖，除包含有用的控制信號處，還包含1個頻率同放大器切換頻率相同的高頻分量，這個高頻分量使電機時刻處于微振狀態(tài)，有利于克服執(zhí)行軸上的靜摩擦，改善伺服系統(tǒng)的低速運行的特性。伺服電機的轉(zhuǎn)速大小和方向，直接取決于PWM功放的輸入信號的大小和極性。

控制器電路板主要由以下幾部分構(gòu)成：

（1） 單片機。控制器的核心部分，實現(xiàn)絕大部分的控制和計算的功能。

（2） 硬件初始化模塊。用于系統(tǒng)復位時的初始化配置。

（3） 存儲器模塊。即外部ROM，用于程序的存儲。

（4） CAN接口模塊。片內(nèi)CAN控制器與監(jiān)控系統(tǒng)進行通訊的接口電路。

（5） 輸入、輸出擴展接口。用于采集信號輸入和控制輸出。

寬調(diào)速力矩電機采用大直徑加大轉(zhuǎn)矩，同時轉(zhuǎn)動慣量也增加，電機熱容量大，過載時間可以加長，同軸帶有高精度測速反饋元件，故低速平穩(wěn)、力矩波動小。

2 結(jié) 語

采用以單片機嵌入式控制不僅能夠完成高精度的實時控制任務(wù)，還可以通過消息驅(qū)動方式靈活實現(xiàn)系統(tǒng)自檢測、故障自診斷和各種智能化輔助功能。天線伺服系統(tǒng)的模塊化設(shè)計和高集成度、低功耗芯片使得系統(tǒng)體積小、重量輕、功耗低，同時具有較高可靠性;采用合理的控制策略，使得系統(tǒng)運行平穩(wěn)、控制精度高。由于控制程序采用模塊化結(jié)構(gòu)，系統(tǒng)有可能適應各種復雜情況，對不同型號的伺服電機只需改動算法程序或控制參數(shù)，就可以獲得理想的控制效果。

參 考 文 獻

［1］李勛.單片機原理及應用\\.北京：高等教育出版社，1995.

［2］劉長年.伺服系統(tǒng)的分析與設(shè)計\\.北京：科學出版社，1985.

［3］楊蔭山.微型計算機控制系統(tǒng)\\.北京：高等教育出版社，1997.

［4］秦積榮.光電檢測原理及應用\\.北京：國防工業(yè)出版社，1985.

［5］沈安俊.現(xiàn)代直流伺服控制技術(shù)及其系統(tǒng)設(shè)計\\.北京：機械工業(yè)出版社，1999.

［6］劉勝.現(xiàn)代伺服系統(tǒng)設(shè)計\\.哈爾濱：哈爾濱工程大學出版社，2001.

［7］徐寧壽.隨機信號估計與系統(tǒng)控制\\.北京：北京工業(yè)大學出版社，2003.

［8］薛定宇.反饋控制系統(tǒng)設(shè)計與分析\\.北京：清華大學出版社，2000.

［9］邵慧鶴.工業(yè)過程高級控制\\.上海：上海交通大學出版社，1997.

［10］余永權(quán).黃英.單片機在控制系統(tǒng)中的應用\\.北京：電子工業(yè)出版社，2003.

作者簡介 高進濤 男，1981年出生，工程師，學士。主要研究方向為實時系統(tǒng)、自動控制、分布式仿真等。

注：本文中所涉及到的圖表、注解、公式等內(nèi)容請以PDF格式閱讀原文