基于編碼識別和變頻控制技術(shù)的自動定位系統(tǒng)的研究

羅庚興

（佛山職業(yè)技術(shù)學(xué)院，廣東佛山 528000）

自動定位控制是工業(yè)自動化系統(tǒng)中非常重要的環(huán)節(jié)之一。比如，在食品制藥灌裝車間、糧食皮帶輸送系統(tǒng)等的物料小車定位控制，冶煉企業(yè)的加熱爐鋼坯定位控制、焦?fàn)t大車行走定位控制、飛剪自動定位控制、吐絲機等控制系統(tǒng)中，經(jīng)常需要高精度的位置控制。一般采用直流或交流伺服技術(shù)來解決，但造價維護成本比較高。而一般的生產(chǎn)線采用PLC進(jìn)行控制，并利用接近開關(guān)實現(xiàn)定位，其定位精度又難以達(dá)到要求。用PLC控制結(jié)合編碼識別技術(shù)和變頻控制技術(shù)，構(gòu)建自動定位的半閉環(huán)控制系統(tǒng)，可以很好地實現(xiàn)預(yù)定目標(biāo)的高效自動行走控制和準(zhǔn)確定位。該控制方案在物料小車自動行走定位控制試驗系統(tǒng)中應(yīng)用，效果良好。

1 定位控制系統(tǒng)的構(gòu)成

物料小車沿導(dǎo)軌做直線往復(fù)運動，其行走由交流電動機驅(qū)動，經(jīng)齒輪減速箱驅(qū)動車體。電動機主軸上裝有光電編碼器，作為行走定位的檢測元件。電動機由變頻器控制?，F(xiàn)場檢測信號、變頻器的執(zhí)行命令和操作面板的指令等均接到S7－300 PLC上，經(jīng)PLC運算后，發(fā)出控制命令給變頻器，驅(qū)動小車行走，PLC通過USB/MPI接到上位機 PC，上位機 PC中安裝了WINCC實時數(shù)據(jù)采集與監(jiān)控組態(tài)軟件，用于系統(tǒng)監(jiān)控?？刂葡到y(tǒng)框圖如圖1所示。

2 定位控制過程

在一般位置控制系統(tǒng)中，定位控制過程分為4個階段，即恒加速階段、高速運行階段、高速減速階段和低速爬行階段，定位過程曲線如圖2所示。圖中，0～t1為恒加速階段，t1～t2為高速運行階段，t2～t3為高速減速階段，t3～t4為低速爬行階段。速度控制采用VVVF調(diào)速方案，升降速方式均采用線性方式。

為了能實行準(zhǔn)確定位控制，需要估計在何位置開始進(jìn)行減速。設(shè)被控對象的高速為vH，爬行速度為vL，減速開始時間t2對應(yīng)的行程為S2，定位行程為S4。則減速位置行程為

爬行時間根據(jù)拖動系統(tǒng)的慣性設(shè)定。為了拖動系統(tǒng)能夠平穩(wěn)地減低，適當(dāng)選擇降速的時間。同樣，在升速過程中，升速電流不超過允許值，盡可能縮短升速時間。升降速時間和方式均在變頻器中設(shè)定。

在實際工業(yè)系統(tǒng)中，對物料小車來說，由于各托盤庫、裝卸料站所處的位置不同，則小車運行的距離有長有短。為此，用編碼器和高速計數(shù)器來測定實際的位置，并與計算位置進(jìn)行比較，當(dāng)比較結(jié)果一旦大于S2時，小車減速進(jìn)入低速爬行。開始減速的設(shè)定位置S2的選取非常重要，S2選得過小，則系統(tǒng)低速運行的距離過長，S2選得過大，則易引起超調(diào)。S2需經(jīng)反復(fù)試驗后設(shè)定，使小車行走基本無超調(diào)，定位精度在±0.5 mm之內(nèi)。

3 定位控制的實現(xiàn)

3.1 系統(tǒng)主要配置

PLC控制系統(tǒng)的主要配置。PLC選用CPU 315－2DP（訂貨號6ES7 315－2AG10－0AB0 V2.0版），高速計數(shù)模塊選用FM350（訂貨號6ES7 350－1AH03－0AE0），數(shù)字量輸入模塊選用DI×16 DC24V的6ES7 321－1BH02－0AA0，數(shù)字量輸出模塊選用 DO×16 DC24V/0.5A 的6ES7 322－1BH01－0AA0，模擬量輸出模塊選用AO2的6ES7 332－5HB01－0AB0。

檢測元件主要有:電容傳感器，直徑18 mm，檢測距離5 mm，型號EKC－M18A－5N1;編碼器1000P/R，5出線結(jié)構(gòu)，日本歐姆龍。

傳動系統(tǒng)主要配置。臺灣STK的0.4 kW三相交流異步電動機，配30:1減速比行星擺減速箱;SIEMENS G110型變頻器，0.75 kW。

3.2 主要參數(shù)設(shè)置

（1）FM350的參數(shù)設(shè)置

運行 STEP 7管理器，進(jìn)入硬件組態(tài)窗口“HW Config”，雙擊FM350計數(shù)器打開編程界面，單擊編程界面中的相關(guān)按鈕，選擇下述參數(shù)。①編碼器（Encoders）:24 V，增量式。②輸入（Inputs）:電平控制的硬件門。③過程中斷啟用（Hardware Interrupt Ena）:不可能，在基本參數(shù)中取消。④輸出（Outputs）:DO0未激活，DO1未激活。⑤操作模式（Operating Modes）:操作模式（Operating Modes）選擇“連續(xù)計數(shù)（Continuous Counting）”，硬件門（Gate Control）選擇“SW Gate”，如圖3 所示。

在SIMATIC管理器中，選擇“文件”→打開“庫”，打開“FMx50LIB”庫。將塊文件下的函數(shù)FC2和用戶定義數(shù)據(jù)類型UDT2拷貝到硬件站“物料小車定位控制”下程序“S7程序（1）”的塊文件夾中。FC2計數(shù)和測量功能，支持等時模式，能夠在操作中改變參數(shù)和置位、復(fù)位輸出;使用UDT2生成的數(shù)據(jù)塊。

在“S7程序（1）”的塊文件夾中，選擇“插入”→“S7塊”→“數(shù)據(jù)塊”，將DB2作為類型UDT2的DB插入到“塊”文件中，然后“確定”。

在硬件組態(tài)窗口“HW Config”中→右鍵單擊“FM350 COUNTER”條目→選擇“對象屬性”→打開“屬性—FM350計數(shù)器”→“常規(guī)”選項卡→單擊“Mod Addr…”按鈕→選擇DB“DB2”→“確定”→“確定”。

編譯保存硬件組態(tài)，退出組態(tài)窗口“HW Config”。這樣，實際位移的編碼脈沖計數(shù)值就存放在DB2.DBD34中，數(shù)據(jù)類型為DINT。

（2）設(shè)置模擬量輸出模塊的參數(shù)

模擬量輸出信號用于調(diào)節(jié)變頻器的頻率，范圍0～10 V。因此，設(shè)置模擬量模塊的參數(shù)如圖4。圖中，輸出模塊的通道1輸出類型選擇“取消激活”，通道0輸出類型選擇為電壓“E”，輸出范圍為“±10 V”，CPU進(jìn)入STOP模式的響應(yīng)選擇為“OCV”（輸出無電壓或電流）。

（3）G110變頻器的參數(shù)設(shè)置

G110型變頻器的參數(shù)設(shè)置如表1所示。

表1 G110變頻器的參數(shù)快速設(shè)置

（4）建立物料小車定位監(jiān)控的共享數(shù)據(jù)塊DB3

為了便于與上位計算機通信，創(chuàng)建共享數(shù)據(jù)塊“DB3”，統(tǒng)一保存通信數(shù)據(jù)。數(shù)據(jù)通信信號如表2所示，各變量加注適當(dāng)?shù)恼f明，便于閱讀。

表2 共享數(shù)據(jù)塊DB3

3.3 控制程序設(shè)計

物料小車自動定位控制系統(tǒng)的STEP 7程序結(jié)構(gòu)如圖5所示。圖中OB1是總程序，F(xiàn)C2是計數(shù)函數(shù)，F(xiàn)C4是工作模式功能，F(xiàn)C5是物料小車運行控制功能，F(xiàn)C6是速度設(shè)定和輸出控制功能，F(xiàn)C7是報警控制功能，F(xiàn)C8是小車運行位移比較功能。DB2是用來保存計數(shù)參數(shù)的UDT類型數(shù)據(jù)塊，DB3是共享數(shù)據(jù)塊。FC105是模擬量規(guī)范化處理程序，F(xiàn)C106是模擬量輸出規(guī)范化處理程序。

小車運行位移比較功能FC8中，主要完成以下任務(wù)。

（1）計算減速位置行程S2

根據(jù)公式（1）計算物料小車的減速位置行程S2。試驗中物料小車的爬行時間設(shè)定為3 s，減速時間設(shè)定為2 s。

（2）計算實際位置行程S

設(shè)實際計數(shù)脈沖數(shù)為N，編碼器分辨率為R1，減速器分頻率為R2，則，實際位置行程S為

在程序中運用公式（2）計算時，為了保證計算精度，必須將雙整型脈沖數(shù)轉(zhuǎn)化為實型數(shù)據(jù)，分辨率也必須是實型數(shù)據(jù)。

（3）位移比較

當(dāng)實際位置行程S小于減速位置行程S2時，產(chǎn)生高速運行信號VH;當(dāng)實際位置行程S大于減速位置行程S2并小于給定位置行程S4時，產(chǎn)生爬行運行信號VL;當(dāng)實際位置行程S大于等于給定位置行程S4時，產(chǎn)生位置到達(dá)的停止信號SR。

根據(jù)上述控制要求可得到FC8的變量聲明表如表3。

表3 FC8的變量聲明表

4 結(jié)語

基于編碼識別技術(shù)、PLC控制技術(shù)和變頻控制技術(shù)，構(gòu)建的物料小車行走自動定位控制系統(tǒng)，其控制方法先進(jìn)，具有穩(wěn)定性高、響應(yīng)快、誤差小、可靠性好、定位精度高等優(yōu)點。這種控制原理和方法可以應(yīng)用到諸如機械手、自動送料等其他精確定位控制系統(tǒng)中，具有一定的推廣價值。

［1］羅庚興，寧玉珊.大中型PLC應(yīng)用技術(shù)［M］.北京:北京師范大學(xué)出版集團，2010.

［2］SIEMENS公司.G100簡明操作手冊［Z］.2005.

［3］楊奕.PLC高速計數(shù)器在定位控制系統(tǒng)中的應(yīng)用［J］.電氣自動化，2007，29（4）:2122.

［4］李園園，尤文.鐵合金廠配料系統(tǒng)配料小車的定位控制［J］.長春工業(yè)大學(xué)學(xué)報:自然科學(xué)版，2009，30（3）:512 －516.

［5］杜東，黃尚先.PLC在準(zhǔn)確定位系統(tǒng)中的應(yīng)用［J］.電氣傳動，2000（1）:47－49.

作者:羅庚興，男，1972年生，碩士，副教授，主要研究方向為PLC控制及自動化。

（編輯 孫德茂）

如果您想發(fā)表對本文的看法，請將文章編號填入讀者意見調(diào)查表中的相應(yīng)位置。