王威 許勇 劉勇 宋偉基

摘要：以雙機器人協(xié)作系統(tǒng)模型為研究對象，根據(jù)其D|H參數(shù)求出運動學(xué)正解，基于Matlab，利用蒙特卡洛方法解出雙機器人工作空間的公共區(qū)域，采用極值理論法和搜索區(qū)域法對公共區(qū)域邊界曲線進行提取，可確定雙機器人協(xié)作空間的界限曲面和極限位置.仿真結(jié)果表明，該方法具有易于實現(xiàn)、空間表達直觀等優(yōu)點，可應(yīng)用于其他結(jié)構(gòu)形式和任意自由度的雙臂機器人類似問題求解.

Abstract：Taking the double|robot cooperation system as the research object， the kinematics positive solution was obtained according to its D|H parameter. Based on Matlab， the Monte Carlo method was used to solve the common area of the double|robot workspace， and the extreme value theory and search area method were used to the common area boundary. By extracting the curve， the boundary surface and the extreme position of the dual robot cooperation space could be determined. The simulation results showed that the method had the advantages of easy implementation and intuitive spatial expression， and could be applied to any dual|arm robots with other structural forms and arbitrary degrees of freedom to solve similar problems.

關(guān)鍵詞：雙機器人;協(xié)作空間;蒙特卡洛法;極值理論;Matlab仿真

Key words：double|robot;collaborative workspace;Monte Carlo method;extreme value theory;Matlab simulation

中圖分類號：TP242文獻標(biāo)識碼：ADOI：10.3969/j.issn.2096-1553.2019.04.015

文章編號：2096-1553（2019）04-0102-07

0 引言

目前，在工業(yè)生產(chǎn)制造領(lǐng)域中，雙工業(yè)機器人協(xié)同作業(yè)得到了廣泛的應(yīng)用，如雙機器人協(xié)同焊接、協(xié)同搬運、協(xié)同噴漆等.多機器人協(xié)同作業(yè)的工作空間問題是多機器人系統(tǒng)研究中的難點之一[1].雙機器人的協(xié)作空間代表了機器人的活動范圍，它是雙機器人工作能力的重要表現(xiàn)[2].協(xié)作工作空間的研究，對機器人的機構(gòu)設(shè)計、路徑規(guī)劃、軌跡規(guī)劃、避碰研究、最佳操作位形研究等，都有相當(dāng)重要的意義[3-4].

蘆俊等[5]采用數(shù)值法對雙臂智能機器人的協(xié)作工作空間進行了分析研究，得出了最佳協(xié)作空間，該方法使用幾何計算，數(shù)據(jù)量大、精確度低，相比計算機數(shù)據(jù)計算存在一定的誤差;趙燕江等[6]提出了基于Matlab的機器人工作空間求解方法，該方法簡單、快速、準確，可通過 Matlab輸出可視化結(jié)果，但該方法只針對單一機械臂的工作空間求解;謝生良等[7]采用蒙特卡洛法分析了雙臂機器人的工作空間，并采用按列和按角度劃分的方法提取協(xié)作空間的邊界點，此方法提取精度高，較準確，但相對計算量較大.

當(dāng)前對機器人工作空間的求解多集中在雙臂機器人和單個工業(yè)機器人上，對于雙機器人協(xié)作空間的研究很少[7].鑒于此，本文擬在雙臂機器人工作空間求解方法的基礎(chǔ)上，以雙機器人協(xié)作系統(tǒng)為參考模型，通過確定D|H參數(shù)和求解運動學(xué)正解，基于Matlab，利用蒙特卡洛法[8]對雙機器人協(xié)同工作空間進行分析，按列劃分邊界點，并對邊界點進行曲線擬合，進而求出最佳協(xié)作空間，以期為雙機器人的動力學(xué)分析、協(xié)調(diào)軌跡規(guī)劃、機器人本體尺度優(yōu)化奠定理論基礎(chǔ).

1 雙機器人運動學(xué)分析

本文以由兩個六自由度工業(yè)機器人組成的雙機器人協(xié)作系統(tǒng)為研究對象，該機器人協(xié)作系統(tǒng)旨在用于工業(yè)生產(chǎn)上協(xié)同焊接、鉚釘、裝配等復(fù)雜任務(wù)作業(yè).

在SolidWorks 2012軟件中建立雙機器人協(xié)作系統(tǒng)的結(jié)構(gòu)模型如圖1所示.該系統(tǒng)模型采用主機器人1（左）和從機器人2（右）結(jié)構(gòu)布局，兩機器人距離為2L.

工作空間的大小與機器人結(jié)構(gòu)參數(shù)有關(guān)，若雙機器人的工作空間剛好包裹住待加工工件實際大小，即為最佳協(xié)作空間的區(qū)域.在已知待加工工件尺寸大小的基礎(chǔ)上，通過上述方法求解，得出機器人工作空間的大小，可為機器人的選型提供依據(jù)，降低機器人購買成本，有效地減少不必要的損耗.

以上所求得的工作空間都是不考慮機器人本身避障情況[11]下所得到的工作空間.

2.3 協(xié)作工作空間邊界曲線數(shù)值計算

采用極值理論和搜索區(qū)域法對協(xié)作工作空間邊界曲線進行提取.假設(shè)機器人工作空間由N個平面組成，每個平面上都至少有一個在一定范圍內(nèi)的蒙特卡洛點，因此只要得到每個平面上點的范圍，這些點在面上層層重疊組成的所有點的集合即為機器人工作空間.現(xiàn)對三維圖中的內(nèi)切圖圖4c）中的雙機器人工作空間邊界進行邊界提取，圖中重合部分即為協(xié)作工作空間.對機器人協(xié)作工作空間邊界曲線提取具體步驟如下.

步驟1 設(shè)X軸的最大區(qū)域為k=Xmax-Xmin，將圖4c）所在面沿X軸平均分為N列，設(shè)列的寬度為b=k/N，N要無限大，從而確保所提取的邊界曲線的精確度.

步驟2 在N個列中，沿著Z軸坐標(biāo)系搜索所在列的Zmax和Zmin，然后確定它們所對應(yīng)的坐標(biāo)極值點.

步驟3 在搜索Zmax和Zmin過程中可能出現(xiàn)空洞：如果在某一列發(fā)現(xiàn)兩個相鄰的點之間的差值遠遠大于列的寬度b，就表明在此點有空洞出現(xiàn).此時，這兩個相鄰的點記為邊界點，依次類推，直至搜索到X軸的最大區(qū)域k點，得到每列的邊界曲線點.

步驟4 依次尋找最近點連接所求的所有邊界點，建立邊界曲線.

3 數(shù)值計算與分析

為驗證本文雙機器人協(xié)作工作空間求解方法的有效性，運用上述求解方法，基于Matlab求解出雙機器人工作空間的空間區(qū)域和極限位置.6R雙機器人D|H參數(shù)見表1，兩機器人位置距離2L=3000 mm，關(guān)節(jié)θ4—θ6對末端執(zhí)行器的姿態(tài)有影響，而對執(zhí)行器末端點位置沒有影響，故未計算在內(nèi).單個機器人工作空間極限位置和關(guān)節(jié)變量參數(shù)計算結(jié)果見表2，由此得到協(xié)作工作空間極限位置、主機器人1和從機器人2關(guān)節(jié)變量參數(shù)計算結(jié)果見表3.連接所求的所有邊界點，得到二維工作空間曲線圖，如圖5所示，其中的公共區(qū)域為雙機器人能夠到達的區(qū)域，即協(xié)作工作空間的邊界輪廓.

由表3和圖5可知，通過求得雙機器人協(xié)作空間邊界圖，從而確定機器人工作空間邊界極限位置，通過逆解公式即可求得每個極限位置所對應(yīng)的各個關(guān)節(jié)角值，具有易于實現(xiàn)、空間表達直觀等優(yōu)點.該雙機器人協(xié)作工作空間求解方法相比李國棟等[12]運用代數(shù)求解方法求解，可以避免求解方程數(shù)目多、計算量大、空間表達不直觀等不足，并且該方法可應(yīng)用于其他結(jié)構(gòu)形式和任意自由度的雙臂機器人類似問題求解.

4 結(jié)語

本文以雙機器人協(xié)作系統(tǒng)模型為研究對象，根據(jù)其D|H參數(shù)求出運動學(xué)正解，通過Matlab對雙機器人協(xié)作運動的工作空間進行求解，并通過極值搜索域法進行協(xié)作空間邊界曲線的提取與繪制，從而得到雙機器人協(xié)作空間的公共區(qū)域形狀和在空間內(nèi)協(xié)作空間的極限位置參數(shù).

仿真結(jié)果表明，該方法具有易于實現(xiàn)、空間表達直觀等優(yōu)點，可應(yīng)用于其他結(jié)構(gòu)形式和任意自由度的雙臂機器人類似問題求解，從而為下一步在協(xié)作工作空間內(nèi)研究雙機器人協(xié)同作業(yè)的路徑規(guī)劃、動力學(xué)分析、機器人的機構(gòu)參數(shù)優(yōu)化，以及協(xié)作避碰問題奠定理論基礎(chǔ).

參考文獻：

[1] 趙大興，周小明，李九靈.集裝箱噴漆機械手工作空間分析與仿真[J].機械設(shè)計，2008，25（2）：15.

[2] 曹毅，王樹新，邱燕，等.面向靈活工作空間的顯微鏡外科手術(shù)機器人設(shè)計[J].機器人，2005，27（3）：220.

[3] 周律，周昱明，汪亮，等.基于蒙特卡羅方法的雙臂機器人工作空間分析[J].機械傳動，2014，38（6）：85.

[4] 李情，茅健，朱姿娜，等.雙機械手協(xié)同運動模型及其工作空間分析[J].制造業(yè)自動化，2017，39 （11）：44.

[5] 蘆俊，池宏勛，席文明，等.雙臂機器人的協(xié)作空間數(shù)值計算方法[J].中國機械工程，2001，12（SI）：125.

[6] 趙燕江，張永德，姜金剛，等.基于Matlab的機器人工作空間求解方法[J].機械科學(xué)與技術(shù)，2009，28（12）：1657.

[7] 謝生良，劉祚時.雙臂機器人工作空間的分析與仿真[J].機械傳動，2018，42（6）：139.

[8] GUPTA K C，ROTH B.Design considerations for manipulator workspace[J].Journal of Machanical Design，1982，104（4）：704.

[9] 蔡自興.機器人學(xué)[M].2版.北京：清華大學(xué)出版社，2009.

[10]李瑞峰，馬國慶.基于Matlab防人機器人雙臂運動特性分析[J].華中科技大學(xué)學(xué)報（自然科學(xué)版），2013，41（Z1）：343.

[11]曹彩霞，趙明揚，朱思俊，等.雙臂機器人協(xié)調(diào)搬運運動的運動學(xué)分析[J].組合機床與自動化加工技術(shù)，2017（8）：44.

[12]李國棟，陳寧新.機器人工作空間的界限面及其位置奇異曲面的代數(shù)求解方法[J].機器人，1988，2（1）：50.