一種自動過數平臺的伺服定位方法研究與實現

梅許文，劉 鵬

(1.成都信息工程學院 電子工程學院，成都 610225；2.成都信息工程學院 控制工程學院，成都 610225)

0 引言

在現代某些特種印刷業的生產過程中，每個生產環節都需要對紙張數量嚴格檢點，過程中對紙張邊緣不能損傷，當前，國內工廠里仍然普遍使用人工操作的辦法，而人工操作一直面臨著工作量繁重以及對操作規程要求很高等問題，另外，因為工作熟練度的問題，高效率不能持續保證，為此，開發一種全自動化的設備成為了行業必需。

可編程序控制器（PLC）是一種在工業控制領域應用最廣泛的控制器，它的控制模式多樣，其中，順序控制功能極大的方便了對一些動作流程順序性要求很高場合的控制，本文介紹的便是一個典型的應用案例。

本課題在自動過數流水線平臺的機械結構設計完成的基礎上，對其控制系統進行了設計和實現，系統中涉及到的較長距離運動控制，本文著重分析了運動中的伺服定位方法；順序控制使用西門子S7300PLC自有的S7Graph圖形化編程語言，最終完成了系統各項控制要求。

1 自動過數平臺的結構和動作

1.1 自動過數平臺的結構

如圖1所示為自動過數平臺平面示意圖，其中含有各個位置的定位銷（自右上方往左下方向依次命名為定1、側1、定2、定34、側2）、橫向和縱向機械手。縱向機械手旁有一臺過數機（圖中圓圈位置），定位銷通過PLC控制上下升降，以實現對紙垛的定位和規正；機械手的夾爪動作實現對紙垛的抓取，其中橫向機械手通過伺服電機的傳動實現前后運動，縱向機械手將紙垛拉入過數機區域進行過數。

圖1 自動過數平臺示意圖

1.2 自動過數平臺的工作原理

以運送一垛紙為例，首先，橫向機械手抓取紙垛之后被伺服電機帶動高速后退至預停2位（距離定2前方5mm處）；電機轉為低速，橫向機械手精確運行至定2處停；縱向機械手進入抓取并返回原位使用過數機過數；過數完畢縱向機械手1將紙垛送回（此時紙垛緊靠側1）。過數機過數期間，橫向機械手1降至平臺下并被伺服電機帶動返回原位，等待下一次抓取。

當過數1區域人工放置第二垛紙動作后，橫向機械手1后退過程中將第一垛紙背推至過數2區域，橫向機械手2抓取后退一定距離后，向前回推紙垛靠近定34；縱向機械手2進入抓取，拉回原位過數，之后的流程如過數1。

每一垛紙過數兩次的原因是要確保數量準確，兩次過數完畢以后，橫向機械手2將紙垛后推至后面的機器平臺進行其他操作，整個運動過程都是在伺服電機的帶動下進行，且定位要求精確，時間節拍必須符合設計要求。

2 以西門子PLC為核心的系統控制方案

2.1 系統的硬件結構

西門子S7-300為中型模塊化PLC，適用于自動化工程中對于控制性能要求較高的場合，它主要由機架、電源模塊（PS）、中央處理器模塊（CPU）、信號模塊（SM）、功能模塊（FM）組成。本系統硬件構成如圖2所示。

圖2 控制系統硬件構成

其中，高速計數FM350模塊對伺服電機反饋的脈沖信號計數，計數值通過換算成距離值來判斷伺服電機行走的位置；數字量輸入模塊接收位置傳感器的信號；數字量輸出模塊的信號作用于電磁閥和伺服驅動器，電磁閥控制氣缸執行動作，在該平臺上表現為各個定位銷和機械手的升降動作，伺服驅動器控制伺服電機的運行，伺服驅動器選用松下MINAS A5系列驅動器。由圖可以看出，伺服系統通過編碼器的反饋組成了一個閉環控制系統。

2.2 伺服控制方法

在伺服電機運用中，一般有三種控制方式：轉矩控制、位置控制和速度控制。對橫向機械手運動至定位銷2處“停”這一要求，最初計劃采用轉矩控制的方式，即在伺服驅動器上設置電機軸對外輸出轉矩大小的限制，當橫向機械手夾帶紙垛后退運行被定位銷2阻擋時，外部負載轉矩大于設定值，此時電機停止。但是在現場實驗過程中，由于機械結構的限制，當轉矩設置稍小時，由于傳動履帶自身阻力以及轉矩控制精度存在一定波動等因素，使得機械手出現反復走走停停的情況；當轉矩設置稍大時，到位瞬間未能達到設定轉矩的大小，電機到位時停不下來。

另外，橫向機械手運行過程要求高速和低速兩種速度狀態，伺服開始運行時是高速狀態，在距目標指定位置處自動改為低速狀態，這種設計對速度自身的實時控制和隨動性要求較高。針對這一情況，本文采取一種使用速度控制方式并能達到位置控制效果的新方法。

首先，在機械部分安裝完成的基礎上，對電機的停車性能進行測試。定義高速狀態下電機收到停止信號后仍然慣性行走的距離為“漸進距離”，定義低速狀態下電機接收到停止信號后慣性行走的距離為“死區距離”，分別進行了20組和25組測試，測試結果如圖3和圖4所示。

圖3 漸進距離的測試結果

圖4 死區距離的測試結果

數據的處理：從圖3～圖4可以看出，數據在某一值附近波動，首先，使用肖維勒準則剔除個別異常數據，剩余的數據取樣本均值。

動作流程中要求橫向機械手運行至高速預停2位停止，等待定位銷2上升到位以后再低速運行至紙垛緊靠定位銷2，針對這種控制要求，伺服程序的設計要充分考慮上述兩種距離的運用，具體方法是：高速運行時，目標脈沖減去漸進距離后的值為實際高速狀態運行的距離，高速運行結束后立刻轉為低速運行；低速運行時，目標脈沖減去死區距離的值為實際低速狀態運行的距離，計數器讀取到這一距離脈沖后，給電機停止信號。

運用這一方法，經過大量的現場實驗證明，能夠達到0.1mm精度級誤差的定位結果。完全滿足產品的性能要求。

如果采用位置控制模塊FM351等定位模塊，需要額外加上該模塊，而且不減少計數器模塊，成本上比計數模塊高兩倍多。而且采取這種定位辦法，速度大小設置靈活，可自由調整節拍時間，而且更經濟，編程更簡單，PLC效率明顯更高一些。

2.3 系統的軟件設計

系統的程序設計采用模塊化設計，在STEP7軟件中，用戶編寫的程序均放在塊中，塊是一種獨立的程序或者數據單元，對各種塊的使用，類似于調用子函數，只需要設置好接口參數，這樣，極大的簡化了程序組織，程序的可讀性更好。

1）I/O點數分配

根據動作流程的要求以及傳感器設置的具體情況，I/O分配如表5所示，系統中信號類型均為數字量。

圖5 I/O分配表

2）控制系統程序設計

控制系統方式分為自動運行和手動運行。其中，運行方式的切換在觸摸屏上完成，可以用手動方式逐步的完成各個單獨動作；自動運行方式采用順序控制方法，能對各種邏輯關系、順序進行精確控制。控制系統程序流程如圖6所示。

圖6 程序流程圖

各模塊化編程組織如圖7所示，有初始化程序OB100、自動運行FB、伺服調用FB、數據處理FC以及各種數據塊，主程序OB1完成模式的切換和各個程序的調用。

圖7 模塊化編程程序截圖

3 結束語

本文介紹了基于S7-300PLC的自動過數流水線平臺的控制系統設計，該設計包括硬件設計和軟件設計，其中，硬件設計包括了控制系統硬件組成、各模塊的使用；軟件設計方面著重分析了伺服定位的方法并加以實現，用梯形圖語言和S7-Graph語言設計出完整的程序，并對它進行了調試。目前，該設備已經調試完畢，通過一段時間的運行，證明了設備有著極高的穩定可靠性，極大的降低了現場工人的勞動強度，伺服定位完全符合設計要求。總之，該系統設計合理、操作方便，各方面均達到預期效果。

[1]西門子S7-300/400快速入門[M].北京:人民郵電出版社,2012.

[2]王曉晨,朱釗.基于S7-300PLC鍍膜控制系統的設計與應用[J].制造業自動化2014.2.146-149.

[3]張少波,江天亮.基于S7-200PLC卸垛機的控制系統設計[J].電子技術2013.4.60-62.

[4]林立芬,肖化,吳先球.肖維勒準則和格拉布斯準則的比較[J].大學物理實驗2012.12.86-88.