樊依圣 徐鳴 劉文威 董成舉

開發(fā)設(shè)計

基于半實物仿真的工業(yè)機器人末端振動分析*

樊依圣1徐鳴2劉文威1董成舉1

（1.工業(yè)和信息化部電子第五研究所，廣東 廣州 511370 2.海軍裝備部重大專項項目管理中心，北京 100071）

速度規(guī)劃算法作為工業(yè)機器人控制技術(shù)的關(guān)鍵環(huán)節(jié)，其加速度的連續(xù)性對機器人振動性能有較大影響。目前，工業(yè)機器人控制系統(tǒng)大多采用集成式的控制器或運動板卡，控制系統(tǒng)封閉，運動控制算法權(quán)限沒有開放給用戶。為解決集成式控制系統(tǒng)運動控制算法受限的問題，基于dSPACE設(shè)計工業(yè)機器人半實物仿真控制系統(tǒng)，對比T型速度規(guī)劃算法和S型速度規(guī)劃算法下工業(yè)機器人末端的振動表現(xiàn)，并進行定量分析。實驗結(jié)果表明，利用S型速度曲線替代T型速度曲線進行速度規(guī)劃時，工業(yè)機器人末端加速度峰峰值降低了20.5%，低頻振動振幅降低了30%，機器人末端振動顯著減小。

半實物仿真；工業(yè)機器人；末端振動；速度規(guī)劃；S型速度曲線

0 引言

隨著工業(yè)機器人應(yīng)用范圍的擴大及生產(chǎn)效率的提高，其正朝大負載、高速化方向發(fā)展。負載和速度的提高導(dǎo)致工業(yè)機器人運行時慣性力增大，從而產(chǎn)生振動效應(yīng)。工業(yè)機器人的減速機構(gòu)通常由諧波減速器、傳動軸、齒輪等組成，這些柔性關(guān)節(jié)會對機器人動力學(xué)產(chǎn)生影響，導(dǎo)致機器人結(jié)構(gòu)的固有頻率降低，使機器人在運行中易產(chǎn)生共振[1]。振動不僅影響機器人自身的位姿精度，而且在低頻（10～30 Hz）時還可能引起周邊設(shè)備的共振[2]。因此，抑制柔性關(guān)節(jié)產(chǎn)生低頻振動的相關(guān)技術(shù)成為工業(yè)機器人研究的熱點和方向。

柔性關(guān)節(jié)機器人振動抑制方法主要有結(jié)構(gòu)優(yōu)化設(shè)計、機敏材料應(yīng)用、反饋控制、開環(huán)控制等4種。其中，結(jié)構(gòu)優(yōu)化設(shè)計簡單易實現(xiàn)，但振動抑制效果不明顯[3-4]；機敏材料應(yīng)用增加系統(tǒng)復(fù)雜性，使系統(tǒng)控制更加繁瑣[5]；反饋控制需要增加額外的傳感器，對機器人結(jié)構(gòu)空間有一定要求[6-7]；開環(huán)控制以軌跡規(guī)劃優(yōu)化為典型[8-9]。寧學(xué)濤等人[10]在關(guān)節(jié)空間內(nèi)采用五次插值多項式進行運動軌跡擬合，雖然運動參數(shù)的連續(xù)性可以得到保證，但存在龍格現(xiàn)象；葉增林等人[11]提出一種帶有速度和加速度約束的梯型速度規(guī)劃算法，雖然一定程度地減小了振動，但加速度的不連續(xù)性沒有得到有效解決；ZHANG Y等人[12]對正弦速度曲線進行修正，通過變量優(yōu)化使轉(zhuǎn)矩平滑，從而減小振動，但未考慮速度約束。對比上述速度規(guī)劃算法，S型曲線速度規(guī)劃算法不僅能保證加速度等參數(shù)的連續(xù)性，避免運動參數(shù)突變造成的沖擊，而且能滿足運動參數(shù)的約束。

本文以工業(yè)六軸機器人低頻階段的振動為抑制目標，以S型速度曲線替代T型速度曲線作為速度規(guī)劃算法；搭建實驗對這2種速度規(guī)劃算法下的時/頻域振動信號進行定量比較分析，從而驗證S型曲線速度規(guī)劃算法在工業(yè)機器人末端振動抑制方面的優(yōu)越性。

1 運動學(xué)建模

工業(yè)六軸機器人本體主要包括機械本體和管線包2部分。其中，機械本體主要由底座、大臂、小臂、手腕4小部分組成，如圖1所示；管線包串接于工業(yè)六軸機器人本體內(nèi)部，主要由電機動力線、編碼線、I/O信號接口、氣管等組成。

1—底座；2—大臂；3—小臂；4—手腕。

工業(yè)六軸機器人運動學(xué)模型如圖2所示。

圖2 工業(yè)六軸機器人運動學(xué)模型

表1 工業(yè)六軸機器人連桿參數(shù)

本文以六自由度串聯(lián)機器人ER3A-C60為例，采用改進D-H方法（modified denavit-hartenberg，MDH）對機器人進行運動學(xué)建模。

1.1 正運動學(xué)建模

工業(yè)機器人正運動學(xué)問題是求工業(yè)機器人運動學(xué)的正解，即在給定組成運動副相鄰連桿的相對位置情況下，確定工業(yè)機器人末端執(zhí)行器的位置和姿態(tài)。

確定連桿變換矩陣為

各連桿矩陣相乘可得到工業(yè)機器人的末端坐標系和基坐標系之間的關(guān)系矩陣：

式中：

式中：

1.2 逆運動學(xué)建模

工業(yè)機器人逆運動學(xué)問題是求工業(yè)機器人運動學(xué)的逆解，即給定末端執(zhí)行器位置和方向的值，求其對應(yīng)的各關(guān)節(jié)變位量。

對于六自由度串聯(lián)機器人的逆運動學(xué)求解，主要方法有代數(shù)法、幾何法和解析法3種。其中，代數(shù)法直接求取機器人每個關(guān)節(jié)角與旋轉(zhuǎn)矩陣中元素的對應(yīng)關(guān)系，求解方法直觀，計算效率高、速度快。

以工業(yè)六軸機器人為例，結(jié)合連桿參數(shù)進行逆運動學(xué)建模。對公式(2)進行矩陣處理，得到各關(guān)節(jié)位置為

式中：

式中：

式中：

2 速度規(guī)劃算法

速度規(guī)劃主要為避免工業(yè)機器人在啟動和停止時產(chǎn)生沖擊、振動等現(xiàn)象，關(guān)鍵是速度規(guī)劃算法。在工業(yè)機器人控制系統(tǒng)中，普遍采用T型速度曲線和S型速度曲線進行速度規(guī)劃。

2.1 T型曲線速度規(guī)劃算法

T型曲線速度規(guī)劃算法廣泛應(yīng)用于鍛造機器人、碼垛機器人等效率要求較高的機器人領(lǐng)域。完整的T型速度曲線如圖3所示，可分為勻加速、勻速和勻減速3個階段。運動過程中最大速度為m，最大加速度為m。

圖3 T型速度曲線

T型曲線速度規(guī)劃算法的規(guī)劃可分為存在勻速階段、不存在勻速階段2類。假設(shè)位移為，存在勻速階段，則說明2。由于T型速度曲線左右對稱，可求得

當(dāng)位移滿足公式(11)時，則勻速階段存在。

T型曲線速度規(guī)劃算法簡單、占用時間少、響應(yīng)快、效率高，但在加減速階段的起點和終點處有加速度突變，存在運動沖擊。

2.2 S型曲線速度規(guī)劃算法

相較于T型曲線速度規(guī)劃算法，S型曲線速度規(guī)劃算法引入了加加速度Jerk對加速度進行精確控制，實現(xiàn)加速度連續(xù)，避免加速度突變引起振動和沖擊，降低機器人損傷，具有較好的柔性。完整的S型速度曲線如圖4(a)所示，分為加加速階段、勻加速階段、減加速階段、勻速階段、加減速階段、勻減速階段和減減速階段7個階段。S型速度曲線的加速度曲線如圖4(b)所示。

圖4 S型速度曲線及其對應(yīng)的加速度曲線

S型速度曲線的計算需確定以下參數(shù)：機器人末端位移、初始速度0、最大速度m、最大加速度m、加加速度。參數(shù)不同導(dǎo)致S型速度曲線表現(xiàn)出不同的形式，如給定位移太小時，速度無法從0變換到m，這將導(dǎo)致S型速度曲線不存在勻速階段。根據(jù)不同的加速、減速和勻速階段存在的情況，S型速度曲線共有17種情況。本文僅考慮S型速度曲線7個階段都存在的情況。如圖4(b)所示，加速度經(jīng)過1時間的加加速階段后達到m，時間1的計算公式為

經(jīng)過3時間后，速度達到v

將參數(shù)代入求得

3 半實物仿真控制系統(tǒng)搭建

工業(yè)機器人半實物仿真控制系統(tǒng)主要由上位機操作站、dSPACE實時仿真控制器、MATLAB/ Simulink仿真軟件、交流伺服電氣柜和機器人本體組成，如圖5所示。

圖5 工業(yè)機器人半實物仿真控制系統(tǒng)組成

利用MATLAB中Simulink模塊搭建工業(yè)機器人運動學(xué)仿真模型，同時編寫控制算法，調(diào)用硬件接口庫實現(xiàn)Simulink仿真模型與實際硬件接口的連接與通訊；通過串口將MATLAB生成的M代碼下載到dSPACE實時仿真控制器；控制器接收交流伺服電氣柜和機器人本體的反饋信號，通過運動控制算法進行信號分析處理，從而輸出控制信號實現(xiàn)機器人控制。

工業(yè)機器人半實物仿真控制算法包括機器人軌跡規(guī)劃、正/逆解、伺服使能、控制器和反饋6個模塊。其中機器人軌跡規(guī)劃模塊作為整個運動控制算法的核心，主要分為3部分：

1）笛卡爾坐標系下點動控制；

2）笛卡爾坐標系下的T型曲線速度規(guī)劃算法和S型曲線速度規(guī)劃算法程序；

3）位置指令邏輯切換，如圖6所示。

正/逆解模塊以運動學(xué)模型為基礎(chǔ)，主要對工業(yè)機器人進行坐標系變換和運動學(xué)分析控制；伺服使能模塊控制6個伺服驅(qū)動器使能。

反饋模塊如圖7所示。首先，工業(yè)機器人上電時通過RS232接口讀取其初始位置；然后，通過與各軸的增量值相加，得到工業(yè)機器人的實時關(guān)節(jié)反饋；最后，根據(jù)各關(guān)節(jié)減速器減速比，計算減速器端輸出的實際關(guān)節(jié)弧度。

控制器模塊根據(jù)反饋模塊的輸出選用比例（P）算法進行工業(yè)機器人位置閉環(huán)控制。此外，控制器模塊還做邏輯選擇，分別選擇機器人回零、關(guān)節(jié)/笛卡爾坐標系的輸入、速度指令等，通過DA轉(zhuǎn)換器輸出。

圖6 軌跡規(guī)劃模塊組成

圖7 反饋模塊

4 實驗驗證

工業(yè)機器人末端的振動狀態(tài)可通過末端加速度振動的幅值來描述，搭建實驗系統(tǒng)，如圖8所示。

圖8 工業(yè)機器人半實物仿真控制實驗系統(tǒng)

工業(yè)機器人半實物仿真控制實驗系統(tǒng)包括加速度傳感器、振動測量儀、工業(yè)機器人本體、計算機以及dSPACE實時仿真控制系統(tǒng)。加速度傳感器置于工業(yè)機器人末端，用以測量其末端加速度值；加速度傳感器的輸出信號通過振動測量儀轉(zhuǎn)換為數(shù)字信號并保存。

通過MATLAB將T型曲線速度規(guī)劃算法和S型曲線速度規(guī)劃算法應(yīng)用于工業(yè)機器人半實物仿真控制系統(tǒng)，分析和處理檢測到的振動信號，并進行振動抑制效果比較，結(jié)果如表2、圖9、圖10所示。

表2 2種速度規(guī)劃算法下的振動數(shù)據(jù)對比結(jié)果

圖9 T型曲線速度規(guī)劃算法下加速度時/頻域響應(yīng)

圖10 S型速度規(guī)劃算法下的加速度時/頻域響應(yīng)

實驗結(jié)果表明：采用T型曲線速度規(guī)劃算法時，機器人末端的加速度峰峰值為13.261 9 m/s2，在10～ 30 Hz低頻段內(nèi)的最大幅值為0.009 5 m/s2；采用S型曲線速度規(guī)劃算法時，機器人末端的加速度峰峰值為10.537 9 m/s2，比T型曲線速度規(guī)劃算法降低了20.5%，在10～30 Hz低頻段內(nèi)的最大幅值為0.006 8 m/s2，降低了30%，抑振效果明顯。由此驗證了S型曲線速度規(guī)劃算法相較于T型曲線速度規(guī)劃算法在機器人振動抑制性能方面的優(yōu)越性。

5 結(jié)語

本文根據(jù)工業(yè)六軸機器人運動學(xué)模型進行半實物仿真控制系統(tǒng)的設(shè)計，并將T型曲線速度規(guī)劃算法和S型曲線速度規(guī)劃算法應(yīng)用于工業(yè)機器人末端振動實驗。實驗結(jié)果表明：工業(yè)機器人末端加速度峰峰值降低了20.5%；低頻振動的振幅降低了30%。由此說明在運動精度要求較高的應(yīng)用場合，工業(yè)機器人控制系統(tǒng)宜采用S型速度規(guī)劃算法進行末端軌跡規(guī)劃和速度控制。

[1] 強艷輝.工業(yè)機器人關(guān)節(jié)柔性分析與減振控制[D].北京:中國科學(xué)院大學(xué),2012.

[2] 吳明月,劉延杰,蔡鶴皋.基于最優(yōu)S型曲線軌跡的硅片傳輸機器人末端振動抑制方法[J].機器人,2014,36(4):446-454.

[3] ONODA J, SANO T, MINESUGI K. Passive damping of truss vibration using preloaded joint backlash[J]. Aiaa Journal, 2012, 33(7):1335-1341.

[4] ZHANG Y H, HE W D, XIAO J J. Dynamical model of RV reducer and key influence of stiffness to the nature character[J]. IEEE Computer Society, 2010:192-195.

[5] 宋軼民,張策,馬文貴.壓電材料在機敏結(jié)構(gòu)振動控制中的應(yīng)用[J].機械設(shè)計,1999(4):26-29.

[6] 吳震宇,袁惠群,羅寶佳,等.關(guān)節(jié)型工業(yè)機器人扭轉(zhuǎn)振動的伺服補償技術(shù)研究[J].振動與沖擊,2020,39(9):132-137.

[7] 韓亞麗,劉聰,郭亞男.雙連桿柔性機器人手臂的非線性自適應(yīng)魯棒控制器設(shè)計[J].機床與液壓,2020,48(3):47-51,23.

[8] 李國洪,王遠亮.基于B樣條和改進遺傳算法的機器人時間最優(yōu)軌跡規(guī)劃[J].計算機應(yīng)用與軟件,2020,37(11):215-223, 279.

[9] 李寶華,劉麒,王影,等.基于模糊控制算法的六自由度工業(yè)機器人運動路徑規(guī)劃[J].科技經(jīng)濟導(dǎo)刊,2019,27(13):58.

[10] 寧學(xué)濤,潘玉田,楊亞威,等.基于運動學(xué)和動力學(xué)的關(guān)節(jié)空間軌跡規(guī)劃[J].計算機仿真,2015,32(2):409-413.

[11] 葉增林,陳華,吳昊.基于帶約束的修正梯形加速度規(guī)律規(guī)劃算法研究[J].河南工程學(xué)院學(xué)報(自然科學(xué)版),2020,32(4): 53-58.

[12] ZHANG Y, HUANG R, LOU Y, et al. Dynamics based time-optimal smooth motion planning for the delta robot[C]// Robotics and Biomimetics (ROBIO), 2012 IEEE International Conference on. IEEE, 2013.

End Vibration Analysis of Industrial Robot Based on Semi-physical Simulation

FAN Yisheng1XU Ming2LIU Wenwei1DONG Chengju1

（1.The Fifth Institute of Electronics, Ministry of Industry and Information Technology,Guangzhou 511370, China 2.Major Special Project Management Center of the Naval Equipment Department, Beijing 100071, China)

As the key link of industrial robot control technology, the continuity of acceleration has a great impact on the vibration performance of the robot. At present, industrial robot control systems mostly use integrated controller or motion board. The control system is closed, and the authority of motion control algorithm cannot be opened to users. In order to solve the problem that the motion control algorithm of the integrated control system is limited, thesemi-physical simulation control system of industrial robot is designed based on dSPACE, the vibration performance of the end of industrial robot under T-curve velocity profile planning algorithm and S-curve velocity profile planning algorithm is compared and analyzed quantitatively. The experimental results show that when using S-curve instead of T-curve for speed planning, the peak and peak acceleration of industrial robot end is reduced by 20.5%, the low-frequency vibration amplitude is reduced by 30%, and the robot end vibration is significantly reduced.

semi-physical simulation; industrial robot; end vibration; speed planning; S-curve velocity profile

樊依圣,徐鳴,劉文威,等.基于半實物仿真的工業(yè)機器人末端振動分析[J].自動化與信息工程,2022,43(1):25-32.

FAN Yisheng, XU Ming, LIU Wenwei, et al. End vibration analysis of industrial robot based on semi-physical simulation[J]. Automation & Information Engineering, 2022,43(1):25-32.

廣州市科技計劃項目（202002030314）

樊依圣，男，1996年生，碩士研究生，助理工程師，主要研究方向：工業(yè)機器人控制技術(shù)研究。E-mail: 18813120471@163.com

徐鳴（通信作者），男，1982年生，大學(xué)本科，工程師，主要研究方向：裝備項目管理工作。E-mail: xugongmei@hotmail.cn

劉文威，男，1987年生，博士研究生，高級工程師，主要研究方向：智能機器人質(zhì)量可靠性與仿真技術(shù)研究。

董成舉，男，1991年生，碩士研究生，工程師，主要研究方向：機器人可靠性技術(shù)。

TP249

A

1674-2605(2022)01-0005-08

10.3969/j.issn.1674-2605.2022.01.005