朱亞紅 劉鴻亮

（1重慶市工業(yè)機器人應用服務工程技術研究中心，重慶，402160；2重慶科創(chuàng)職業(yè)學院機器人中心，重慶，402160）

0 引言

經(jīng)過多年發(fā)展，工業(yè)機器人已經(jīng)在越來越多的領域得到應用，尤其在汽車制造業(yè)，工業(yè)機器人得到廣泛的應用。例如,在毛坯制造（沖壓、壓鑄、鑄造等）、機械加工、焊接、熱處理、表面涂覆、上下料、裝配、檢測及倉庫碼垛等作業(yè)中，機器人都已逐步取代了人工作業(yè)[1]。

工業(yè)機器人在正常工作時，可能會產(chǎn)生抖動，非正常抖動涉及到的原因較多，可能性較大的有以下幾個方面：一是工作周圍有其他的機械振動干擾，恰巧工作頻率和工業(yè)機器人工作頻率相一致，達到共振；二是工作時，機器人本身各運動部位的振動頻率相一致，達到共振，進而引起了振動；三是機器人電氣控制部分參數(shù)設置和控制部分算法有問題，引起了振動；四是機器人工作時，可能受到電信號或磁場干擾，從而產(chǎn)生控制不穩(wěn)定[2]。

本文針對第三種情況進行詳細分析與研究。

1 智能仿形示教系統(tǒng)

智能仿形示教系統(tǒng)是一種機器人輔助示教裝置，通過收集人手部在操作機器人時形成軌跡數(shù)據(jù)，并將軌跡數(shù)據(jù)優(yōu)化后傳遞給工業(yè)機器人，從而實現(xiàn)機器人示教過程。

例如圖1為人工操作機器人實物圖，圖2為智能仿形示教軟件界面。

圖1 人工操作機器人

圖2 智能仿形示教軟件界面

智能仿形示教系統(tǒng)在實際使用過程中，操作人員發(fā)現(xiàn)，工業(yè)機器人在復現(xiàn)軌跡時，會出現(xiàn)抖動的問題。如果人工示教軌跡速度過快，那么機器人按照這個軌跡運動時，會發(fā)出異常聲響，同時出現(xiàn)機器人速度發(fā)生突變的現(xiàn)象。通過監(jiān)控智能仿形示教系統(tǒng)軟件，可得到機器人發(fā)生抖動時的速度曲線，如圖3所示。

圖3 機器人發(fā)生抖動時的速度曲線

2 問題分析

根據(jù)圖3分析得出機器人發(fā)生抖動時的軌跡數(shù)據(jù)，再根據(jù)數(shù)據(jù)分析出機器人整個運動軌跡的理論速度情況，如圖4所示。

根據(jù)ABB機器人RAPID程序指令MaxRobSpeed，得出當前型號機器人可實現(xiàn)的最大TCP(Tool Center Point,工具中心點)速度是7000mm/s，如圖4中直線所示。從圖4中可以看出，機器人的軌跡速度有很大一部分是超過7000 mm/s的。根據(jù)ABB機器人RAPID指令手冊得知，軌跡速度超過7000 mm/s的部分，機器人會按照最大速度（即7000 mm/s）移動。因此，得出機器人實際速度曲線圖，如圖5所示。

圖4 機器人理論速度曲線

圖5 機器人實際速度曲線

由圖4、圖5可以看出，在點1、2、3、4、5處，機器人的加速度會發(fā)生突變。根據(jù)原始數(shù)據(jù)繪制加速度，得出機器人實際運動加速度曲線圖、機器人實際速度和加速度對比圖，如圖6、圖7所示。

圖7 機器人實際速度和加速度對比

圖6 機器人實際運動加速度曲線

通過分析圖6、圖7中數(shù)據(jù)，得出機器人抖動的原因是：示教軌跡某些點速度過快，超過機器人TCP的最大速度7000m/s，機器人突然由加速，變?yōu)?000mm/s的勻速，導致加速度產(chǎn)生突變，機器人無法適應如此大的加速度突變，導致機器人抖動。

3 實驗驗證

3.1 改變T值

在機器人軌跡數(shù)據(jù)不變的情況下，把下述RAPID指令中T∶=0.1改成T∶=1，也就是點與點之間的移動時間變長，讓機器人速度降下來。

當T∶=0.1時，編程代碼如下：

MoveJ [[X{J},Y{J},z{J}],[q1{J},q2{J},q3{J},q4{J}],[0,0,0,0],[9E9,9E9,9E9,9E9,9E9,9E9]],v100T∶= 0.1,z5,tool1WObj∶=wobj1;

當T∶=1時，編程代碼如下：

MoveJ [[X{J},Y{J},z{J}],[q1{J},q2{J},q3{J},q4{J}],[0,0,0,0],[9E9,9E9,9E9,9E9,9E9,9E9]],v100T∶= 1,z5,tool1WObj∶=wobj1;

當T=1時，速度和加速度曲線圖如圖8所示。

圖8 T=1時機器人速度與加速度曲線

實驗結果證明：通過改變T值，機器人運動軌跡和之前抖動軌跡相同，只是運動速度變慢，未出現(xiàn)抖動情況。

3.2 改變Z值

在ABB機器人MoveL運動指令中，包括Zonedata（運行轉角數(shù)據(jù)）參數(shù)（詳細資料可參考RAPID手冊），該參數(shù)決定了TCP什么時候開始轉彎。如果把Zonedata設置成5mm,則當TCP距離目標點5mm時開始轉彎，轉彎過程中涉及到速度的調整和變化。如果將Zonedata值設置太小，則TCP只有很短的一段距離去調整速度；反之，如果將Zonedata值設置得大一些，那么TCP將會有很長的一段距離進行計算和調整速度，并朝下一個目標點運動。

機器人在軌跡數(shù)據(jù)相同的情況下，通過調整MoveL指令中Z的取值，分別取1、5、10、15、20、30、40、200，得出機器人速度曲線對比圖和機器人軌跡曲線對比圖，如圖9、圖10所示。

圖9 機器人速度曲線對比

圖10 機器人軌跡曲線對比

4 結論

工業(yè)機器人在智能仿形示教系統(tǒng)中復現(xiàn)軌跡時，盡管機器人型號可能不同，但是其TCP的最大速度總是固定的，無法改變。因此，解決機器人抖動問題的唯一辦法是：示教速度小于機器人TCP的最大運動速度，即本文小于7000mm/s。

具體措施是：在數(shù)據(jù)導入機器人前，首先在智能仿形示教軟件上對所采集的機器人軌跡數(shù)據(jù)進行處理，并判斷該組軌跡數(shù)據(jù)的運動速度是否超過TCP最大運動速度，如果超過，則該次采集的軌跡數(shù)據(jù)不符合機器人運動的要求，不進行導入，刪除數(shù)據(jù)，重新示教；反之，則判定數(shù)據(jù)有效，并將數(shù)據(jù)導入到工業(yè)機器人，以實現(xiàn)示教過程。

[1]王田苗,陶永.我國工業(yè)機器人技術現(xiàn)狀與產(chǎn)業(yè)化發(fā)展戰(zhàn)略[J].機械工程學報, 2014,50(9)∶1-13.

[2]侯新平.關節(jié)工業(yè)機器人在工作時非正常抖動分析[J].機電一體化,2014(3)∶72.

[3]譚志飛.智能機器人運動分析與仿真的研究[D].湖南：湘潭大學,2007.

[4楊振,費樹岷,王芳,等.一種工業(yè)機器人軌跡跟蹤的自適應切換控制方法[J].東南大學學報：英文版,2016（2）∶183-186.

[5]王斌.基于物聯(lián)網(wǎng)的工業(yè)機器人視覺裝配系統(tǒng)研究與實現(xiàn)[D].廣州∶華南理工大學,2015.

[6]任云星,馬世杰.AGV+工業(yè)機器人在精密搬運中的應用[J].山西電子技術, 2016(3)∶51-52.

[7]王會方.串聯(lián)機器人多目標軌跡優(yōu)化與運動控制研究[D].杭州∶浙江大學,2011.

[8]孫逸超.仿人機器人控制系統(tǒng)設計與姿態(tài)控制方法[D].杭州∶浙江大學,2014.

[9]劉海濤.工業(yè)機器人的高速高精度控制方法研究[D].廣州∶華南理工大學,2012.

[10]駱敏舟,方健,趙江海.工業(yè)機器人的技術發(fā)展及其應用[J].機械制造與自動化, 2015(1)∶1-4.

[11]尹仕斌.工業(yè)機器人定位誤差分級補償與精度維護方法研究[D].天津∶天津大學,2015.

[12]張紅強.工業(yè)機器人時間最優(yōu)軌跡規(guī)劃[D].長沙∶湖南大學,2004.2

[13]李正義.機器人與環(huán)境間力/位置控制技術研究與應用[D].武漢∶華中科技大學,2011.

[14]李寧.機器人控制系統(tǒng)軟件模塊化的研究[D].天津∶天津大學,2010.

[15]黃文嘉.工業(yè)機器人運動控制系統(tǒng)的研究與設計[D].杭州∶浙江工業(yè)大學,2014.

[16]馮崇.工業(yè)機器人運動分析及控制研究[D].洛陽∶河南科技大學,2015.