摘 要:為設計激光測高儀仿真系統(tǒng),首先分析了設計要求,給出了系統(tǒng)設計方案;然后提出了系統(tǒng)設計的部分硬件選擇;并為抑制干擾提出了一些辦法。
關鍵詞:滑動導軌;運動控制卡;伺服電機
[align=center][b]Design of simulation system for laser range finder
Ma Ye-wei Zhao Shang-hong Meng Wen Ma Li-hua[/b][/align]
Abstract: For the purpose to design the simulation system for laser range finder, this paper analyzed the design of simulation system, then some chosen is done for part of the hardware. The way to control the interfere is mentioned as well.
Keywords: slip orbit; locomotion controller; servo motor
1引言
無人機是由控制中心根據(jù)探測信息綜合分析控制其飛行和著陸的。在進場著陸過程中,高度信息是一個不可或缺的信息,對高度的精確測量對于控制無人機的精確著陸至關重要。無人機激光測高儀仿真裝置是無人機導航和著陸自主引導系統(tǒng)研制任務的一部分,為飛機在接近地面時(距離地面30m以下)提供高精確的實時高度信息,以實現(xiàn)無人機導航和著陸精確導引和全天候自主精確著陸。在飛機接近地面時,接收主控系統(tǒng)的控制信號,啟動測距機開始工作,并將測得的實時距離信息與主控系統(tǒng)發(fā)來的數(shù)據(jù)進行比較、計算,然后通過RS422接口將相關距離信息發(fā)送到主控系統(tǒng),實現(xiàn)激光實時距離測量和飛機高度測量的模擬仿真。
2系統(tǒng)設計要求
2.1系統(tǒng)須實現(xiàn)功能
滑動導軌是具有機電一體化的綜合性、高精度的仿真設備,提供實時變化的距離環(huán)境,以檢測無人機激光測高儀模擬裝置的測距精度、實時性等技術指標,并可連入無人機著陸與導航半實物仿真實驗系統(tǒng)中,實時接收并執(zhí)行來自飛控仿真機的高度數(shù)據(jù),形成仿真閉環(huán),從而進一步提高仿真的置信度。
2.2主要技術指標
滑動模擬系統(tǒng)是模擬在飛機接近地面時的運動狀態(tài),飛機此時距離地面30m,垂直初速度v(~5m/s),以加速度a勻減速下降,到地面時垂直速度為零。據(jù)此,考慮可行性,取模擬系統(tǒng)滑軌長度6m,如果要求模擬飛機降落時間不變(~t=12s),可以相應要求最大速度v/5(~1m/s),加速度a/5。
[align=center]

圖1 飛機降落過程[/align]
據(jù)此得出仿真系統(tǒng)主要性能指標如下:
1. 目標板的移動范圍:6m;
2. 最大運動速度:3m/s;
3. 定位精度:±5cm;
4. 控制周期:5ms。
5. 漫反射目標板固定在直線導軌的滑塊上,其俯仰角度可調(diào),調(diào)整范圍為±5°。
2.3系統(tǒng)組成
系統(tǒng)由支架、直線滑軌、滑塊機構、同步帶傳動機構、伺服系統(tǒng)、底座、激光測距儀、及控制箱、計算機等組成。
直線滑軌長度不小于6米,滑塊機構與直線滑軌為滾動配合,其運動平穩(wěn)?;瑝K機構與漫反射目標板連接,目標板角度可調(diào)整(±5°)。同步帶傳動機構與滑塊機構連接,使其完成直線運動,其運動由伺服電機控制系統(tǒng)完成。伺服系統(tǒng)由伺服電機、電機驅動器、光電編碼器、測速機、單片機處理等組成,完成對滑塊的位置與速度控制。
3 系統(tǒng)的實現(xiàn)
3.1總體設計及控制原理
根據(jù)滑動導軌對控制系統(tǒng)的要求,需要對目標板的速度、位置進行實時的控制、監(jiān)測、調(diào)節(jié)。在整個控制系統(tǒng)中,采用速度內(nèi)環(huán)控制和位置外環(huán)控制結合起來,實時控制目標板的運動,保證閉環(huán)仿真系統(tǒng)的高精度、穩(wěn)定性及高置信度。在該系統(tǒng)中為了實現(xiàn)整個系統(tǒng)的穩(wěn)定性、可靠性及控制的精度,我們選擇了伺服控制系統(tǒng)作為本控制系統(tǒng)的核心。如下所示:
[align=center]

圖2 控制系統(tǒng)的結構框圖[/align]
該控制系統(tǒng)中采用基于PCI總線的伺服電機的控制單元,它與PC機構成主從式控制結構,該控制單元完成運動控制的所有細節(jié),包括脈沖和方向信號的輸出、自動升降速的處理、伺服電機編碼器反饋的信號等。在該控制系統(tǒng)中,運動控制卡向伺服驅動器發(fā)出脈沖、方向等控制信號,通過伺服驅動器的放大驅動伺服電機的運動,電機的運行速度、位置又通過電機內(nèi)部的系統(tǒng)獲取通過編碼器輸出反饋給控制卡。
在整個控制系統(tǒng)中采用了伺服驅動器和伺服電機,由于交流伺服驅動系統(tǒng)為閉環(huán)控制,驅動器可直接對電機編碼器反饋信號進行采樣,內(nèi)部構成位置環(huán)和速度環(huán),一般不會出現(xiàn)象步進電機的丟步或過沖的現(xiàn)象,控制性能較步進電機構成的閉環(huán)系統(tǒng)更為可靠。整體上提高了滑動導軌運行的精度與速度,保證了整個閉環(huán)仿真系統(tǒng)的穩(wěn)定性與置信度。
電源系統(tǒng)為控制系統(tǒng)中的各控制對象提供電源。這些電源包括向伺服放大器提供的單相200V或三相200V的商用電源、開關量信號(原點、減速、限位以及I/O信號等)采用的12-24V開關電源、脈沖量信號(脈沖、方向等)采用5V的直流開關電源等。其中商用電源在接入驅動器之前采用濾波器進行濾波,使電源系統(tǒng)能滿足抗干擾、穩(wěn)定輸出的要求。另外系統(tǒng)測試設備的接地可滿足設備安全、抗電磁干擾和穩(wěn)定運行的需要。
伺服系統(tǒng)通過電源濾波器獲得200-230V的潔凈交流電源,有效的隔離電網(wǎng)的尖峰干擾脈動,保護伺服放大器以防其受到電壓變動的影響,為伺服系統(tǒng)提供穩(wěn)定的輸入電源。各種開關量及脈沖量所需的直流5V或12-24V開關電源,是把220V交流供電直接整流濾波之后,通過高頻變壓器隔離變換,再整流變?yōu)樗枰亩喾N直流電壓輸出。開關電源具有體積小、效率高、電網(wǎng)電壓寬范圍變化時輸出不易過壓或欠壓的優(yōu)點。
3.2 硬件的選擇
3.2.1控制卡的選擇
該控制系統(tǒng)中控制器部分采用當前比較流行的成熟的工業(yè)控制產(chǎn)品——運動控制卡作為該控制系統(tǒng)的中心。運動控制卡是一種數(shù)字運算操作的電子系統(tǒng),專為在工業(yè)環(huán)境中應用而設計的。它采用了典型的計算機結構,主要有CPU﹑RAM﹑ROM和專門設計的輸入輸出接口電路等組成。所以它可以用于內(nèi)部存儲程序執(zhí)行邏輯運算、順序控制、定時、記數(shù)與算術操作等面向用戶的指令,并通過數(shù)字式﹑模擬式輸入/輸出控制各種類型的機械或生產(chǎn)過程。作為一種現(xiàn)今比較流行的工業(yè)控制裝置,運動控制卡有以下一些特點:高可靠性和強抗干擾能力、靈活性好、編程簡單易學、系統(tǒng)安裝簡單、維修方便等。
控制系統(tǒng)中的控制卡選擇了成熟的MPC08型的專業(yè)運動控制卡,其主要技術指標:
1. 4軸步進或數(shù)字式伺服控制,脈沖輸出頻率可達4.0MHz;
2. 多軸高速線性插補,每軸帶有原點、減速和限位等接口;
3. 梯形加、減速,運動中可變速,可輸出脈沖/方向或雙脈沖信號;
4. 可外接編碼器位置反饋,可擴展出16路通用輸入和16路通用輸出接口;
5. WINDOWS 環(huán)境下WDM、DLL庫,演示程序。
MPC08運動控制卡采用FPGA作為控制核心,主要功能是執(zhí)行上層計算機的控制指令,并將執(zhí)行機構部分的反饋信息進行相應的處理,同時將處理結果反饋給計算機顯示當前執(zhí)行設備的狀態(tài)(實時運行速度、到達位置等)。就是通過控制卡發(fā)送脈沖信號驅動伺服電機,同時將伺服電機的實時信息反饋給控制卡進行相應的處理。
MPC08控制卡的運動控制功能主要取決于運動函數(shù)庫。運動函數(shù)庫為單軸及多軸的步進或伺服控制提供了許多運動函數(shù):單軸運動、多軸獨立運動、多軸插補運動等等。為了配合運動控制系統(tǒng)的開發(fā),還提供了間隙補償功能。下面簡單介紹一下單軸運動控制的功能。單軸運動有三個基本的類型:點位運動(pmove)、連續(xù)運動(vmove) 和回原點運動(hmove),這些運動又可以在常速模式或梯形速度模式下工作,總共有六種基本類型,列表如下:

[align=center]

圖3 運動速度圖形[/align]
3.2.2伺服電機的選擇
伺服電動機又稱執(zhí)行電動機,在自動控制系統(tǒng)中,用作執(zhí)行元件,把所收到的電信號轉換成電動機軸上的角位移或角速度輸出。分為直流和交流伺服電動機兩大類,其主要特點是,當信號電壓為零時無自轉現(xiàn)象,轉速隨著轉矩的增加而勻速下降,伺服電機內(nèi)部的轉子是永磁鐵,驅動器控制的U/V/W三相電形成電磁場,轉子在此磁場的作用下轉動,同時電機自帶的編碼器反饋信號給驅動器,驅動器根據(jù)反饋值與目標值進行比較,調(diào)整轉子轉動的角度。伺服電機的精度決定于編碼器的精度(線數(shù))。
根據(jù)多個不同廠家的產(chǎn)品性能的比較,伺服電機及驅動器選擇了型號為GYG501BC2-T2中慣量伺服電機,其主要參數(shù)如下:
電機參數(shù)表
伺服驅動器選用與電機相匹配的驅動器,其型號為RYC501B3-VVT2,該驅動器具有位置、速度、轉矩控制等功能及相應的輸入、輸出信號,同時該驅動器具有比較好的穩(wěn)定性。
驅動器主要的技術數(shù)據(jù)為:
1. DSP 全數(shù)字電機控制方式,可以實現(xiàn)多種電機控制算法,軟件更新
2. 可提供位置、速度、轉矩三種控制模式
3. 內(nèi)有增量式17位編碼器
4. 隨時可以進行位置、速度、轉矩三者中任意二者的相互轉換
5. 7段4位顯示的觸摸面板可以方便的設定伺服系統(tǒng)的各種參數(shù)
其轉矩特性圖如下所示:
[align=center]

圖4 RYC501B3-VVT2的轉矩特性圖[/align]
其主要性能指標如下表所示:
3.3抗干擾技術
電源是整個系統(tǒng)的能量供應部分。由于市電電網(wǎng)中常出現(xiàn)過壓、欠壓,當電壓超過電源工作范圍時,會使電源失?;蛘邠p壞,直接威脅控制系統(tǒng)的安全。而瞬時過壓或者欠壓形成涌流,也會造成很強的干擾和破壞性。
為了有效地抑制電源干擾,可以采用以下辦法:
1. 采用交流凈化電源。其具備過、欠壓保護、濾波等功能,能保證系統(tǒng)供電的穩(wěn)定性;
2. 選用優(yōu)質的抗干擾開關電源,作為電機控制等的電源;
3. 在電源輸出端并接一大電容,以消除大功率工作瞬間電源波動的影響。
在該控制系統(tǒng)中,伺服放大器與通用的變頻器一樣,在PWM控制電路中進行高頻開關動作。因此,輻射干擾和傳導干擾等往往對外圍設備的外部機器產(chǎn)生影響。針對以上情況可采取如下幾種對策:
1. 將伺服放大器裝在接地鐵制容器(控制盤)內(nèi),不能與電腦和測量儀表設置很近。
2. 在伺服放大器的初級端裝設濾波器(電源濾波器)。
3. 連接伺服放大器至伺服電機的配線要裝到金屬管內(nèi),把金屬管接地。
4. 接地線要盡量用短粗線 。
5. 接地端子、指令控制序列輸入輸出以及編碼器用的電源0V等信號不能相互連接。
6. 主電路和控制電路的配線絕不能捆束在一起,也不可平行配線。
除了上述的硬件措施處,在軟件上也可采用冗余設計、自恢復功能等措施,軟硬兼施,提升設備抗干擾性能。
4 結束語
本文所設計的用于激光測高儀仿真系統(tǒng)的機械滑軌系統(tǒng)設計,采用成熟的MPC08型的專業(yè)運動控制卡和GYG501BC2-T2中慣量伺服電機。同時,本系統(tǒng)的設計方法提出了部分硬件抗干擾技術對系統(tǒng)的軟硬件實現(xiàn)提供了一個借鑒。對具體系統(tǒng)的實際驗證結果將另文報道。
參考文獻
?、臡PC08運動控制卡操作手冊.
?、聘哏娯?機電控制工程[M]. 北京:清華大學出版社,2006.
?、莿⑿l(wèi)國.MATLAB程序設計教程[M]. 北京:中國水利水電出版社,2005.
?、仍S瑞華 何俊華.《基于NextMoveES運動控制卡的步進電機群控系統(tǒng)》.《微計算機信息》
?、赏粜〕?、潘笑.《PLC的參數(shù)設置及顯示設計》.《微計算機信息》.2000年第16卷第6期.