王 帥,邵丹璐,王 凌,張 云,王斌銳
(中國計量大學(xué)機電工程學(xué)院,浙江 杭州 310018)
電機故障是機械臂作業(yè)過程中的常見故障之一。在機械臂運行中,對電機故障進行檢測是及時發(fā)現(xiàn)故障和安全作業(yè)的前提[1-2]。對機械臂故障的準確分類可為有效排除機械臂故障提供支撐[3-4]。
Alessandro等[5]提出一種將環(huán)境故障通過殘差形式表現(xiàn)的方法。由于殘差計算需基于精確的系統(tǒng)模型,因此魯棒性較差。K.Suita等[6]通過對比實際驅(qū)動器力矩與模型計算得出的力矩,檢測機械臂是否發(fā)生故障;Trevor等[7]基于統(tǒng)計學(xué)學(xué)習(xí)方法,研究了支持向量機(support vector machine,SVM)在故障分類問題中的應(yīng)用。Felzenszwalb等[8-9]用支持向量機來設(shè)計分類器,構(gòu)建故障檢測算法,目標檢測的準確率相對較高。邵丹璐等[10]基于動量導(dǎo)數(shù),設(shè)計了殘余動量算子,通過分析碰撞中殘余動量值的變化來檢測柔性臂是否發(fā)生碰撞故障。萬書亭等[11]提出了一種基于提升模式的非抽樣小波變換方法。該方法用于對數(shù)據(jù)信號進行分類處理,對滾動軸承故障能作出有效診斷,但缺乏對故障發(fā)生過程的分析。
本文以三自由度機械臂的電機故障為檢測對象,通過支持向量機訓(xùn)練分類器,得到殘余動量在頻域中的特征向量,并與時域特征向量相結(jié)合。通過分析故障源與特征向量變化之間的關(guān)系檢測故障,搭建機械臂虛擬樣機聯(lián)合仿真平臺,開展故障檢測仿真。對工業(yè)機器人開展了試驗驗證。通過仿真和試驗,驗證了故障檢測和分類的有效性。
動力學(xué)建模是數(shù)學(xué)分析的基礎(chǔ)。參考文獻[12]建立的機械臂動力學(xué)模型為:
(1)
根據(jù)文獻[13]定義殘余動量算子r為:
(2)
式中:放大系數(shù)k為大于零的對角陣;p為機械臂的總
能量。
當機械臂與環(huán)境發(fā)生碰撞時:
(3)
式中:τ為碰撞力矩。
式(2)求導(dǎo)后滿足:
(4)
提取特征向量可降低計算的難度,便于進行故障檢測和分類。殘余動量是一維時變信號,本文采用均值、方差和相關(guān)系數(shù)組成時域特征向量。
三自由機械臂殘余動量的均值為:
D=[D1,D1,D3]
(5)
方差為:
C=[C1,C2,C3]
(6)
相關(guān)系數(shù)表示殘余動量值之間的相似性。三自由機械臂殘余動量的相關(guān)系數(shù)為:
ρ=[ρ12,ρ23,ρ13]
(7)
(8)
式中:N為數(shù)據(jù)長度;j=1,2,…,2k為分解頻帶的序號;rjm為重構(gòu)信號離散點的幅值。
分解層數(shù)與計算量有密切關(guān)系。為便于計算,選定分解層數(shù)k。
三自由機械臂殘余動量的小波包能量譜為:
T=[Er1,Er2,Er3]
(9)
小波包能量譜T共有3×8=24個特征值,時域的均值D、方差C和相關(guān)系數(shù)ρ共有3×3=9個特征值。
本文基于ADAMS和Simulink,搭建了完整的虛擬樣機仿真平臺,如圖1所示。
虛擬樣機的輸入為3個關(guān)節(jié)的力矩,輸出為3個關(guān)節(jié)的角度和角速度,從而便于電機故障模擬和殘余動量計算。
ADAMS模型參數(shù)如表1所示。
圖1 虛擬樣機仿真平臺 Fig.1 Virtual prototype simulation platform 表1 ADAMS模型參數(shù)Tab.1 ADAMS model parameters
模型長度/mm平均直徑/mm質(zhì)量/kg大臂31382.8017.78小臂23779.2013.10基座500100.0099.00
機械臂電機故障有多種,忽略基座故障,本文研究的機械臂故障分類如表2所示。
“哎呀,我們楊連長真細心,妹子,快接著。我說有沙棗花吧?你看一串一串的花苞,要開了?!迸说脑掃€沒落地,一片掌聲攆出一片哄笑,田志芳面對這突發(fā)的一切,有點不知所措?!芭芰诉@么多天的長途路,終于到家了,妹子,肯定累了,走吧,到你住宿地方休息去?!?/p>
表2 機械臂故障分類Tab.2 Fault classification of manipulator
通過人為設(shè)置故障和聯(lián)合仿真,得到殘余動量值樣本。利用得到的故障數(shù)據(jù)樣本,采用基于核函數(shù)的非線性軟間隔分類器,即C-支持向量分類機,對出現(xiàn)的故障進行分類。
本文通過聯(lián)合仿真,共采集200組殘余動量值,其中,機械臂正常狀態(tài)數(shù)據(jù)80組,其余六種故障數(shù)據(jù)各20組。根據(jù)式(5)~式(7)和式(9)計算,并作歸一化處理,樣本數(shù)據(jù)的均值、方差、相關(guān)系數(shù)如圖2所示。部分樣本小波包能量譜如圖3所示。由圖2可見,時域特征值變化劇烈且無明顯規(guī)律,所以僅從單個時域特征值的變化無法分類故障。由圖3可見,不同故障下的小波包能量譜圖有顯著區(qū)別,但規(guī)律性不明顯。因此,需要將多個特征值綜合應(yīng)用于故障分類。
圖2 均值、方差、相關(guān)系數(shù)圖 Fig.2 The mean,variance and correlation coefficient
圖3 部分樣本小波包能量譜圖 Fig.3 Partial sample wavelet packet energy spectrum
本文任意選取200個樣本中的100個作為訓(xùn)練樣本,其余樣本作為測試樣本?;贚ibsvm工具包,本文采用徑向基核函數(shù),通過交叉驗證法,自動尋優(yōu)確定最優(yōu)的懲罰因子c=512和核函數(shù)的參數(shù)γ=0.007 8。測試樣本的故障分類準確率如表3所示。
表3 不同特征向量分類準確率Tab.3 Classification accuracy of different feature vectors
采用時域和頻域特征值進行故障分類,其準確率高于僅采用時域特征值的故障分類。
正常運動試驗結(jié)果如圖4所示。
圖4 正常運動試驗結(jié)果圖 Fig.4 Experimental results of normal motion
試驗采用工業(yè)機器臂,其控制系統(tǒng)如圖5所示。
圖5 機械臂控制系統(tǒng)框圖 Fig.5 Block diagram of manipulator control system
碰撞故障試驗結(jié)果如圖6所示。
圖6 碰撞故障試驗結(jié)果圖 Fig.6 Experimental results of collision fault
對機械臂的第2、3關(guān)節(jié)運動進行試驗。設(shè)關(guān)節(jié)2為手臂1,關(guān)節(jié)3為手臂2,其余關(guān)節(jié)鎖定。試驗過程中,控制手臂1和手臂2逆時針運動30°,并通過在機械臂運動空間中放置工作臺來人為制造碰撞故障。采集機械臂運行過程中的角度和角速度數(shù)據(jù),計算得到殘余動量值。
對比圖5和圖6可見,正常運動時殘余動量值的波形周期性變化明顯。當發(fā)生碰撞時,殘余動量值有明顯突變。試驗中,計算并提取到的時域和頻域的特征值如表4所示。由于工業(yè)機械臂封裝嚴格,電機異常振動和噪聲故障試驗困難。
本文重復(fù)上述正常和碰撞故障兩類試驗,并在不同時間點人為制造碰撞故障。將試驗中測得的殘余動量時域和頻域特征值輸入到SVM分類器。測試結(jié)果表明,碰撞故障檢測準確率為100%。
表4 試驗所得特征向量Tab.4 Eigenvector obtained by experiments
本文基于殘余動量對機械臂的故障進行檢測與分類,對殘余動量信號的特征提取分類進行了詳細的分析。最后通過仿真和試驗進行了驗證,結(jié)果如下。
①電機異常振動、噪聲以及碰撞故障會使得殘余動量值發(fā)生變化。但單獨的時域或頻域特征值變化與故障類型之間無明顯規(guī)律。
②綜合利用殘余動量值的時域和頻域特征進行故障分類,可以得到較高的準確率。
③設(shè)計的基于支持向量機分類算法能夠?qū)Χ嚓P(guān)節(jié)機械臂、高維的殘余動量時頻特征向量進行分類。
下一步研究將豐富故障的種類,并對分類器進行優(yōu)化設(shè)計。
參考文獻:
[1] SHI J,LIANG M,GUAN Y.Bearing fault diagnosis under variable rotational speed via the joint application of windowed fractal dimension transform and generalized demodulation:a method free from prefiltering andresampling[J].Mechanical Systems and Signal Processing,2016,68(1):15-33.
[2] BRKOVIC A,GAJIC D,GLIGORIGEVIC J,et al.Early fault detection and diagnosis in bearings for more efficient operation of rotating machinery[J].Energy,2017,136(11):63-71.
[3] 曾艷濤.美國未來15年制造業(yè)機器人研究路線[J].機器人技術(shù)與應(yīng)用,2013(3):1-5.
[4] GAN M,WANG C.Construction of hierarchical diagnosis network based on deep learning and its application in the fault pattern recognition of rolling element bearings[J].Mechanical Systems and Signal Processing,2016,72(9):92-104.
[5] DE L A,FERRAJOLI L.Exploiting robot redundancy in collision detection and reaction[C]//Intelligent Robots and Systems,IROS 2008.IEEE/RSJ International Conference on IEEE,2008:3299-3305.
[6] SUITA K,YAMADA Y,TSUCHIDA N,et al.A failure-to-safety "Kyozon" system with simple contact detection and stop capabilities for safe human-autonomous robot coexistence[C]//Robotics and Automation,IEEE International Conference on,IEEE,1995:3089-3096.
[7] HASTIE T,TIBSHIRANI R,FRIEDMAN J.The elements of statistical learning:data mining,inference and prediction[J].Mathematical Intelligencer,2005,27(2):83-85.
[8] FELZENSZWALB P F,GIRSHICK R B,MCALLESTER D.Cascade object detection with deformable part models[C]//Computer Vision and Pattern Recognition (CVPR),2010 IEEE Conference on IEEE,2010:2241-2248.
[9] GIRSHICK R B,FEIZENSZWALB P F,MCALLESTER D.Object detection with grammar models[C]//International Conference on Neural Information Processing Systems,Curran Associates Incorporation,2011:442-450.
[10]邵丹璐,王斌銳,金英連.基于殘余動量的兩連桿柔性臂驅(qū)動器故障檢測[J].計量學(xué)報,2015,36(3):279-283.
[11]萬書亭,呂路勇,何玉靈.基于提升模式非抽樣小波變換的滾動軸承故障診斷方法研究[J].振動與沖擊,2009(1):170-173.
[12]溫金環(huán).三關(guān)節(jié)六自由度機械臂運動學(xué)及動力學(xué)分析和不確定剛性機器人的魯棒軌跡跟蹤控制研究[D].西安:西北工業(yè)大學(xué),2002.
[13]DE L A,FLACCO F.Integrated control for pHRI:Collision avoidance,detection,reaction and collaboration[C]//Biomedical Robotics and Biomechatronics (BioRob),2012 4th IEEE, RAS & EMBS International Conference on,IEEE,2012:288-295.
[14]GILLES J.Empirical wavelet transform[J].IEEE Transactions on Signal Processing,2013,61(16):3999-4010.
[15]何學(xué)文,卜英勇.基于小波包分解和支持向量機的機械故障診斷方法[J].機械強度,2004,26(1):20-24.