摘 要： 根據澆鑄機器人的功能需求和特點，設計了具有良好通用性和開放性的工業機器人澆鑄控制系統的軟硬件結構。以三軸澆鑄機器人為應用實例，分析了其運動學正逆解算法，并根據實際生產需求，通過PLC程序中定義的M指令實現整個澆鑄系統的I/O信號交互控制。實際應用結果表明，該澆鑄控制系統有效地提高了澆鑄生產效率，并且運行穩定可靠。
關鍵詞： 工業機器人；澆鑄控制系統；運動學； PLC；交互控制
隨著工業機器人相關技術的不斷發展和成熟，工業機器人應用范圍不斷擴展，產品涵蓋金屬焊接、噴涂、澆鑄、裝配、搬運、包裝、激光加工等方面，應用領域包括汽車、摩托車、工程機械、家電等行業[1,2]。不同用途的工業機器人在工作環境、機器人的自由度、與外部系統的信號交互控制等方面存在較大的差異。作為工業機器人的主要應用之一，澆鑄機器人具有以下顯著特點：(1)可靠性強、穩定性高、正常運行時間長；(2)安全性高，澆鑄中金屬液體溫度極高，要充分保障人員、機器人和其他財產安全；(3)速度快，澆鑄工藝決定了操作周期時間短；(4)精度高，保證零件生產質量穩定；(5)運動范圍廣，為提高工作效率，一般一臺機器人同時為多臺澆鑄機澆鑄，要求機器人具有較大的運動范圍；(6)信號多且交互頻繁；(7)堅固耐用，能適應普通澆鑄車間惡劣的生產環境；(8)通用性和柔性化，適合不同的應用場合。鑒于澆鑄機器人的上述特點，本文將結合其應用實例，介紹相關的設計方案和一些具體問題的解決措施。
1 機器人澆鑄控制系統的結構
機器人澆鑄控制系統分為硬件結構和軟件結構兩大部分。
1.1 系統硬件結構
本文所設計的機器人澆鑄控制系統的硬件系統包括系統控制單元、人機接口、伺服驅動系統等主要部分[3]，其結構示意圖如圖1所示。
系統控制單元是整個澆鑄控制系統硬件結構的核心，主要組成部分包括CPU、主板和多功能板等。CPU和主板等硬件模塊都集成在工業PC中，而在實際應用中，鑒于工業PC強大的處理能力及其良好的通用性，越來越多的機器人采用工業PC作為控制系統的核心控制器[2]，本文采用的是嵌入式X86工業PC，實現數據和信號處理。多功能板支持操作面板、數字I/O信號接口、模擬輸出信號接口、脈沖計數器和脈沖發生器等接口，提供控制單元與外界進行數據和信息交換的通道。
伺服驅動系統由最多可達8個的獨立的伺服單元組成，每個伺服單元由一個帶標準脈沖指令接口的伺服驅動器及一個伺服電機組成，并對應機器人一個關節軸。一般來說，工業機器人最多有6個關節軸，即使在某些應用場合下，還需要1或2個自由度的導軌、變位機等設備，系統仍然可以滿足實際應用的需求。
1.2 系統軟件結構
為提高系統的開放式和通用性，軟件系統分為三層：系統層、控制核心層和主要由人機交互模塊HMI(Human Machine Interface)組成的系統應用層，其結構示意圖如圖2所示。
軟件結構的系統層主要包括操作系統和驅動程序、硬件接口等。為了實現控制系統的實時控制，需要在DOS系統或者Linux系統平臺上開發出相應的實時模塊RTM(Real Time Module)。
控制核心層是整個軟件系統和整個控制系統的核心，主要包括機器人控制系統核心CSKR(Control System Kernel of Robot)和PLC是其主體部分。系統內部CSKR和PLC采用共享存儲的方式來進行信息交換，按照事先約定劃分功能區，并定義訪問規則[3]?？刂坪诵膶油ㄟ^底層接口實現信息交換和功能調用，以軟中斷的方式處理實時任務、運動控制、插補運算和報警；以共享內存的形式與寄存器交換數據并進行參數配置。
系統應用層中數控內核接口，一方面作為控制核心層與上層應用的接口，另一方面進行數據管理，為開發的應用程序提供友好接口。
按照上述原則搭建出的工業機器人澆鑄控制系統應用實例軟硬件系統如圖3、圖4所示。
2 工業機器人運動學
從本文構建的軟件體系結構來看，控制核心層的一部分內容就是運動學算法，本文設計的澆鑄控制系統已經成功應用于東風集團某廠的鋁制活塞的澆鑄生產，下面以其所使用的意大利法塔鋁UNO三軸澆鑄機器人為例建立機器人運動學。機器人結構簡圖和關節坐標系如圖5所示。
2.1 運動學正解
機器人三個關節坐標軸(實軸)分別為關節1（控制機器人左右運動）、關節2（控制機器人上下運動）和關節4（控制機器人末端容器翻轉）。關節3并沒有驅動單元，連桿與鉛直線的夾角?酌是一個確定的值。關節3的作用在于當機器人關節1和關節2運動時，保證末端容器姿態不變，防止容器中高溫金屬液體潑濺造成不必要的損失。按照D-H方法建立運動方程[4,5]，運動學正解得到末端容器在機器人基坐標系中位姿矩陣
3 系統信號控制的實現
控制核心層的另外一個重要方面就是PLC。本文設計的澆鑄控制系統采用開關量交換信號，簡單易行，并能滿足工業機器人信號控制的應用需求。在前面提到的應用實例中，機器人系統與兩臺澆鑄機、兩臺鋁液熔爐和廢料箱構成的澆鑄系統進行頻繁的信號交互。
3.1 澆鑄系統功能需求
工作過程中，澆鑄機器人運動過程示意圖如圖6所示。
實線表示澆鑄系統使用熔爐1中的鋁液澆鑄活塞的運動過程，虛線表示澆鑄系統使用熔爐2中的鋁液澆鑄活塞的運動過程。以使用熔爐1為例，整個澆鑄動作過程為：
（1）程序開始。機器人運動到并停在熔爐正上方，判斷是否有“允許舀信號”；
（2）如果有，判斷來自澆鑄機1（FM1）還是澆鑄機2（FM2），根據FM1和FM2安裝模具的型號，機器人末端容器進入鋁液熔爐，直到固定在連桿上的金屬測頭測到“測頭接觸鋁液液面”信號，末端容器停止下降，然后舀取對應量的鋁液；如果沒有則繼續等待；
（3）舀取完成后機器人停在熔爐正上方，判斷是否有來自上一步中給出信號的同一澆鑄機的“允許澆鑄信號”；如果沒有則繼續等待；
（4）如果等待超過一定時間（由工藝參數和工作環境、鋁液的量等因素決定），則機器人將鋁液倒回熔爐，機器人運動到廢料箱吹風處，吹掉附著在容器內外的氧化皮，回到熔爐上方，報警“等待超時”！
（5）如果在允許的時間內對應的澆鑄機給出“允許澆鑄信號”，則機器人對澆鑄機澆鑄（動作b或d），澆鑄完成后機器人向澆鑄機給出澆鑄完成信號，機器人運動到廢料箱吹風處（動作c或e），吹掉氧化皮，回到熔爐上方（動作a），開始下次循環。返回步驟（1）。
整個工作周期中，熔爐的使用可根據實際情況隨時切換，具體操作可以通過操作面板上的自定義按鍵來實現。針對不同的活塞模具，只需要通過改變舀取鋁液是機器人末端容器的傾斜角度控制鋁液的量，方法簡單實用。
3.2 系統信號控制的實現
工業機器人澆鑄控制系統與整個澆鑄系統通過PLC控制程序來實現控制信號的交互[6]。主要控制信號如表1所示。
系統在PLC控制程序中通過信號交互，與外部澆鑄系統和輔助設備實現手動、自動、單段和增量等運行方式。報警、急停、故障和測頭等系統輸入信號的控制，可以由PLC控制程序的指令直接實現。以“金屬測頭接觸鋁液液面信號”為例，代碼如下：
…
if (bit(X[0],5))//測頭接觸到液面
{
…//末端容器停止
}
else
{
…//否則，末端容器繼續下降
}
…
系統輸出信號的控制和其他輔助功能，需要在機器人PLC控制程序中定義不同的M指令，并由機器人工作程序調用對應的M指令。本系統中定義的M指令及其功能如表2所示。
M指令的定義在PLC控制程序的exec_M( )子程序中。其中，M50指令執行過程中，PLC控制程序定時掃描輸入信號X1.0和X2.0，一旦澆鑄機給出“允許澆鑄信號”，通過改變PLC控制程序中的用戶自定義控制字*ch_user_in(0)的值，判斷澆鑄對象。指令mod_M_code(0)=-1通知系統該M指令處理完畢，機器人工作程序接著執行下一條指令。
系統運行結果吻合3.1節中的整個澆鑄動作過程。
4 應用實例
本文設計的工業機器人澆鑄控制系統已經成功應用于東風集團某廠的鋁制活塞澆鑄生產。系統整體調試完成后，系統整體運行穩定。人工澆鑄鋁制活塞，每人每班次（8 h）實際生產合格活塞數目為600個，使用本文設計的工業機器人進行澆鑄，因為良好的工藝穩定性和雙澆鑄容器設計，每人每班次實際生產合格活塞數目可達1 000個以上，極大地提高了工作效率，提高鋁液使用率，大大減輕了工人的勞動強度，取得了良好的效果。從投入實際生產使用開始至發稿之日，系統已經連續穩定運行10個月，完全滿足設計和生產需求。
按照軟硬件通用性和開放性的原則，以系統控制單元為核心搭建了澆鑄機器人系統硬件結構，以控制核心層為關鍵建立了系統軟件結構。針對澆鑄機器人的特點和應用實例，給出了機器人運動學算法，并以共享內存的方式進行信號交互控制。投入使用后，系統運行穩定可靠，各項性能指標均符合實際需求，達到了預期目標，在機器人澆鑄生產中具有較高的實用價值。
參考文獻
[1] 潘麗霞. 論工業機器人的發展與應用[J]. 山西科技，2010, 25(3)：22-25.
[2] 王天然，曲道奎. 工業機器人控制系統的開放體系結構[J]. 機器人，2002, 24(3)：256-261.
[3] 田茂勝，唐小琦，孟國軍，等. 基于嵌入式PC的工業機器人開放式控制系統交互控制的實現[J]. 計算機應用，2010, 30(11)：3087-3090.
[4] 熊有倫. 機器人技術基礎[M]. 武漢：華中科技大學出版社，2008：32-50.
[5] JOHN J C. Introduction to robotics mechanics and control[M]. 贠超譯.第3版. 北京：機械工業出版社，2005.
[6] 周宜. 機器人噴涂生產線控制系統的設計與應用[J]. 電氣自動化，2009, 31(4)：39-41.