0 引言

　　Clavel 博士于1985年發明的Delta 機構是高速并聯機械手當中最具有代表性的。Delta 機械手的3個伺服電機固聯在機架上，伺服電機與減速器采用鎖緊套的方式連接；主動臂與減速器輸出軸同樣采用鎖緊套的方式連接，這樣可以避免采用鍵連接時的反向誤差；機械手的３ 個主從動臂構成了機械閉環結構，可進一步減小機械手的定位誤差；從動臂采用碳纖維材料，質量和慣性非常小；加減速能力與串聯機械手相比具有不可比擬的優勢。基于上述優點Delta 機械手特別適合在三維空間中快速抓取操作且定位精度要求比較高的場合應用。另外在Delta 機構的動、靜平臺間還可以設置一可伸縮轉軸，由于該可伸縮轉軸兩端帶有虎克鉸鏈，故機械手還能夠實現被抓物體垂直于靜平臺的單自由度轉動。

　　本文以Delta 高速并聯機械手為控制對象，搭建基于PLC 的并聯機械手控制系統，研究機械手的軌跡規劃、控制數據傳輸和伺服參數整定等保證機械手性能的關鍵技術

1 Delta 機械手控制系統硬件平臺

　　基于Delta 高速并聯機械手的機構特點，以“Mitsubishi Q02H PLC+ QD75MH4定位控制模塊＋串行口通訊模塊QJ71C24N”為核心搭建機械手控制系統。

　　（1） 控制系統CPU ：采用三菱MitsubishiQ02HCPU 單元，主要完成控制器控制系統參數管理，操作空間中末端執行氣爪的路徑規劃，關節空間中伺服電機3軸插補，機械手轉矩、位置、速度正解和逆解的矩陣運算，與機械手運動相關的開關量邏輯控制，分選工藝中路徑的規劃和選擇等任務。

　　（2） 運動定位模塊：控制系統運動定位模塊采用三菱Mitsubishi QD75MH4多軸位置控制模塊，通過主基板Q38B 與Mitsubishi Q02H CPU 單元通訊。定位模塊負責伺服電機的轉矩、位置和速度的控制與監視。

　　（3） 串行口通訊模塊：采用Mitsubishi QJ71C24N通訊模塊。該模塊具有RS232和RS485兩個通道，可同時進行PLC CPU 與上位機、PLC CPU 與觸摸屏的通訊。

　　（4） 工業觸摸屏：選用三菱A960GOT － EBA 彩色工業觸摸屏作為圖形化人機界面。觸摸屏通過RS － 232C串行通訊線與QJ71C24N 通訊模塊連接，從而最終與PLC CPU 進行通訊。

　　（5） I／O 模塊：用于控制機械手末端氣爪的張開閉合及檢測氣爪的張開到位和閉合到位。

　　（6） 伺服電機和伺服驅動器：采用具有內置絕對編碼器和抱閘的三相交流伺服電機，型號為三菱HC－SFS102B 。相應伺服驅動器規格為MR － J2S －100B ，與QD75MH4構成閉環控制。

　　采用“Mitsubishi Q02H PLC+QD75MH4定位控制模塊＋ 串行口通訊模塊QJ71C24N”構成的控制系統不僅組態簡單，而且穩定可靠，適合工業中應用。并且串行口通訊模塊QJ71C24N 與上位機進行實時通訊，使得機械手軌跡規劃路徑選擇與伺服電機運動控制并行處理成為可能，滿足了機械手實時控制的要求。

2 軌跡規劃及軟件設計

　　2.1 機械手軌跡規劃

　　Delta 機械手主要用于在三維空間內對重量輕、體積小的物品進行高速抓取、放置操作。本文Delta 機械手用于電池質量分選操作，機械手每次抓取一行共16個電池，并將16個電池分為（1～10）類。由于工藝要求及并聯機械手的關節空間位置與操作空間位置是非線性的關系，對于每一類電池的操作，機械手末端執行器要依次經過豎直提升（P1～ P5） → 水平移動（P6～P7） → 豎直下降（P4～ P8）3個階段.

　　基于上述，設定機械手的運動為連續軌跡運動，需要PLC CPU 在關節工作空間內對3個伺服電機做插補計算，以保證P1～ P5、P6～ P7、P4～ P8段達到一定的直線度。在軌跡規劃中，首先將手爪運動軌跡看作P1～ P2、P2～ P3、P3～ P3三段直線，為了使機械手在關節空間的振動減小及操作空間的運動更加快速平穩，對于操作空間中每一段直線，手爪的運動過程為靜止→ 加速→ 勻速→ 減速→ 靜止，從而使動平臺的速度v 和加速度a 在操作空間中每一段直線的起點和終點處為零，且位移s 具有關于時間的一階、二階導數連續，三階導數有限的運動規律。本例中采用3－4－5次多項式作為機械手末端執行器的運動規律，其具有運動時間短、過程沖擊和殘余振動小，比較適合本研究對象。在已知位移s 和最大加速度amax 的條件下，3 －4－5次多項式表達式為：

　　其中：T 為經歷該軌跡段所需要的時間；j 為3－4－ 5次多項式運動規律的躍度。

　　圖2中，P5～ P6 、P7～ P8段將沒有直線度要求的軌跡轉折處優化為弧線，從而在豎直段的加速度未減到零之前水平方向已經開始加速，這樣進一步減小了機械手的運動周期。PLC CPU 采用等時或者等距的原則，對伺服電機各軸軌跡路徑點的速度和位置進行插補計算。

　2.2 數據傳輸

　　在所設計的控制系統中，PLC CPU 要經矩陣運算對3個伺服電機進行軌跡路徑點運算，并將計算結果通過Q38B 基板提供給定位模塊。定位模塊采用三軸線性插補的方式，控制3個伺服電機聯動。PLC CPU向定位模塊傳遞位置和速度數據采用如下3種方式：

　　（1） 逐點傳輸：逐點傳遞即機械手軌跡規劃與運動控制同時進行。PLC CPU 每完成一路徑點的位置和速度計算，即將數據傳遞給定位模塊。電池提取位置或放置位置不斷變化或者在不確定的場合可使用該方法。此方法對于PLC CPU 的處理速度要求較高。

　　（2） 批量傳輸：批量傳遞即機械手準備就緒后，PLC CPU 先對機械手當前運動軌跡的所有路徑點進行計算，并將當前路徑點的所有數據全部傳遞給定位模塊。傳遞完成后機械手開始運動。在定位模塊執行運動控制的同時，PLC CPU 對機械手的下一次軌跡路徑點進行規劃。這樣軌跡規劃可以有效地利用取放電池的工作時間，有效減小了數據傳輸對機械手運動控制周期的影響，但需要知道機械手下一次的運動軌跡。

　　（3） 選擇傳輸：將機械手抓放電池的起始點坐標和終點坐標通過觸摸屏傳輸給PLC CPU 。PLC CPU計算出所有軌跡的路徑點，然后鎖存在PLC CPU 中。機械手每次運動前根據上位機傳遞的電池種類通過PLC CPU 將機械手的運動軌跡傳輸給定位模塊。該方式在機械手運動控制過程中數據傳遞量小，響應快，但軌跡數量多時需要占用PLC CPU 較大的內存。

　　采用哪種數據傳輸方式需根據機械手的具體工況，本例中機械手用于對不同電化學性能的電池進行分選，工況為：電池托盤中256個電池（行×列＝16×16）測試完畢后通過上位機將測試數據傳輸給PLCCPU ，機械手收到當前行電池分類信息后從托盤內提取當前行電池，并快速將每個電池放置在相應的傳送螺旋槽中。根據電池分選要求，所有電池分為（1～10）個質量等級。機械手抓取一行16個電池后，第一類要釋放的電池有101種可能的運動路徑。釋放完第一類電池后剩下的電池有9種可能的運動路徑。釋放完第二類電池后剩下的電池有8種可能的運動路徑。以此類推直至一排16個電池全部釋放完畢，機械手共有65種可能的路徑。考慮到QD75MH4支持的定位控制點數有限，且不能支持間接尋址，故本文中采用了選擇傳輸。

　　依據上述規則，只需將電池的抓取位置坐標和釋放位置坐標通過觸摸屏輸送給CPU 模塊。機械手每分選一行電池前先根據電池的種類自動計算軌跡，然后CPU 模塊將軌跡點通過傳輸給QD75MH4，從而控制機械手運動。

3 伺服參數的整定

　　為提高機械手的操作性能，需要根據機械手的負載、速度、可達空間對機械手的伺服參數進行調整。由于機械手末端執行氣爪沒有檢測裝置檢測其定位誤差，因此該系統為半閉環伺服系統。位置環、速度環和電流環均有調節器，也就是比例積分微分調節，調好這3個系數也就有效保證了機械手的操作性能。對于MR － J2S － B 系列伺服放大器，其伺服系統的控制算法都嵌入到放大器的硬件中，故整個系統的伺服參數調整都在放大器中進行。計算機通過MRZJW3－SETUP161E 三菱伺服設定軟件以串行通訊的方式寫入到放大器中。通過對基本參數、調整參數、擴展參數的分析，對負載慣量比、位置控制增益1和2增益進行了調整。調整后使機械手跟隨誤差較小，具有良好的剛性而且操作空間沒有較大的振動和沖擊。

4 結論

　　本文以“Mitsubishi Q02H PLC ＋ QD75MH4定位控制模塊＋ 串行口通訊模塊QJ71C24N”為核心搭建了高速并聯機械手控制系統硬件平臺，對并聯機械手軌跡規劃、數據傳輸、伺服參數整定等技術進行了深入的研究，得出如下結論： ① 以PLC CPU 、QD75MH4、QJ71C24N 為核心搭建出的機械手硬件平臺，具有組態簡單、可靠性高的優點，上位機與PLC實時進行通訊并且路徑規劃與運動控制并行處理，能夠滿足高速并聯機械手實時控制的要求；② 根據機械手具體工況，提出了３ 種不同的軌跡路徑點數據傳輸方式，滿足了不同的工作要求；③ 根據機械手的負載、速度、可達空間對機械手的伺服參數進行了調整，使機械手具有良好的操作性能。