如圖 I 所示。上位機采用中國臺灣研華 1 P C 6 1 0 機箱和 P c A一6 1 7 9主板, 它與韓國COMIZOA公司的M COMI-LX 運動控制器通過 R S一 2 3 2 串口實現通訊, 形成一個功能強大的開放式運動控制系統。工業 P C機負責人機界面管理、運動狀態顯示、遠程監控和工藝文件存儲等功能,運動控制器負責實時運動控制和邏輯控制,該結構支持軟件升級和功能擴展,具有上、下兩級的開放性。
纏繞機主軸電機是 7.5 k W 的三相交流伺服異步電動機, 用博瑋BWS伺服驅動器驅動。對于主軸電機的速度,本系統采用了抗負載變化能力較大的閉環控制方式。運動控制器軸 3 接口的模擬量輸出作為伺服驅動器速度控制輸入信號, 在運動控制器開環控制狀態下設置模擬量電壓輸出值實現變頻器速度控制。安裝于變速箱輸入軸上的一C WZ 1 X旋轉編碼器完成主軸轉角和速度的檢測。伺服驅動器采用帶 P G矢量控制方式, P G—X 2速度卡把編碼器采樣的信號一路作為伺服驅動器輸入實現速度閉環控制,一路作為速度和位置信號輸入到控制器的編碼器接口4 ,實現了由一個編碼器完成速度閉環控制和主軸轉角位置采樣的功能。小車采用博瑋BWS伺服電機完成精確定位,它沿玻璃鋼管軸向往復運動,按照纏繞規律以一定的響應速度和精度跟蹤主軸運動。軸 0接口工作于伺服模式,完成小車伺服電機的閉環控制。主軸編碼器反饋接到 MC 2 0 6軸4接口,作為參考編碼器的輸入軸,為小車同步運動提供一個編碼器輸入。
纏繞機控制系統軟件設計
纏繞機控制系統上位機程序采用 Mi c r o s o f t 公司的V C+ + 6.0 基于 Wi n d o w s 2 0 0 0平臺開發, 完成工藝文件設置和管理、遠程監控和機床運行狀態顯示等功能。工控機和 MC 2 0 6通過串口基于 MO D B U S協議完成工藝參數下載和機床狀態參數上傳顯示。
通訊采用主從方式的查詢機制,系統將工控機設為主站, M C 2 0 6設為從站,只有主站發出查詢時,從站才能給出響應,從站不能主動發送數據。工作時工人選定待纏繞管件型號并將工藝文件下載后,進入纏繞加工狀態,此時所有運動和邏輯控制由完成,從站僅響應主站的查詢并上傳狀態數據。即使工控機由于某種原因出現故障或死機,也不會影響當前管道的纏繞加工。從而提高了系統的穩定性和控制的實時性。
運動控制程序采用 T r i o B A S I C多任務語言編制。通過運行在 P C機上的 Mo t i o n P e r f e c t 軟件將編制好的運動控制程序下載到 MC 2 0 6內即可脫機運行。T r i o B A S I C語言有三種不同類型的存儲變量:命名變量、V R( ) 變量和 T A B L E區變量。命名變量是局部變量,僅在定義它的任務內有效。
變量是可被多個任務共享的全局變量,它可用于任務間通訊;T A B L E 區通常是用于存儲 C A M/指令曲線的存儲區, 本程序用于存儲纏繞管道型號的工藝文件。運行的用戶程序被稱為線程或任務。
對于復雜的多任務程序應為線程分配優先級,控制器缺省的伺服周期是 l m s ,該周期在內部被分成三個時間片,每個時間片為 1/3 m s ,它們在內部分別被用來處理伺服功能,通訊和通常的“ h o u s e k e e —‘ 任務。在每個時間片內剩余的時間被用于運行用戶程序。M C 2 0 6zui多可運行 7個用戶線程, 每個線程用從 l 到 7的數字標號, zui高標號的線程( 線程7和 6 )被分配固定的時間片,它們被稱為” 快速任務“ ,主要用于有以下要求的任務: 要在每個伺服周期都要進行處理的任務;具有大量的運算和處理的任務;任務啟動后程序執行速度不能改變的任務。5 g - 線程被稱為 “慢速任務” ,它們具有共同的優先級,程序執行速度會隨任務的增加而降低。用戶可以使用指令啟動任務使其按的優先級運行。
在上位機軟件 Mo t i o n P e r f e c t 中打開一個” T e r m i n a l “窗口可以設置一個” C o m m a n d L i n e “ 端 口, 它始終使用” 0 “ 號任務, 用于從上位機輸入指令并立即運行。該纏繞機控制軟件中共建立了四個任務,其中任務7用于纏繞機電機運動控制和機床邏輯控制,任務 6用于管理機床與纏繞相關的I/O信號和主軸轉速控制,任務 2 完成串口通訊功能,任務1 實現輸膠控制??刂瞥绦虻娜蝿展δ芎蛨绦袝r間分配如圖 2 所示。其中任務 7和 6的優先級zui高,每個伺服周期( 1 I n s )都分配時間片,任務 1 ,2和/L ) 優先級相同,在每個伺服周期輪流為其分配時間片。纏繞程序任務功能和執行時間的分配如圖2 所示。