張一楠 丁建完
華中科技大學(xué)國(guó)家CAD支撐軟件工程技術(shù)研究中心,武漢,430074
串聯(lián)機(jī)器人的建模仿真與基于模型的控制需要精確的機(jī)器人動(dòng)力學(xué)模型,而關(guān)節(jié)摩擦模型是機(jī)器人動(dòng)力學(xué)模型的重要組成部分。常用的機(jī)器人關(guān)節(jié)摩擦模型為庫侖黏滯摩擦模型,除此之外,還有Stribeck模型[1]、Dahl模型[2]、Maxwell-slip模型[3]、LuGre模型[4]等。機(jī)器人實(shí)際運(yùn)行中,關(guān)節(jié)摩擦?xí)軠囟茸兓挠绊慬5],因此有必要對(duì)其進(jìn)行探究。
ANDRE等[6]通過實(shí)驗(yàn)探究了溫度對(duì)機(jī)器人關(guān)節(jié)摩擦力矩的影響。GAO等[7]建立并驗(yàn)證了考慮溫度的協(xié)作機(jī)器人非線性摩擦模型。YAN等[8]通過帶溫度影響的靜態(tài)關(guān)節(jié)摩擦模型研究了機(jī)械臂的控制方法。吳曉敏等[9]在Stribeck模型的基礎(chǔ)上提出了考慮溫度影響的摩擦力矩模型。LORINC等[10]通過對(duì)環(huán)境溫度和外殼溫度的測(cè)量來估計(jì)關(guān)節(jié)內(nèi)部溫度。上述研究考慮了溫度對(duì)機(jī)器人關(guān)節(jié)摩擦力矩的影響,提出了相應(yīng)模型,但依賴對(duì)溫度的直接測(cè)量或間接估計(jì),而在大部分實(shí)際應(yīng)用場(chǎng)景中,安裝傳感器、測(cè)量機(jī)器人關(guān)節(jié)溫度是不現(xiàn)實(shí)的。
為了避免對(duì)溫度的測(cè)量或估計(jì),PAGANI等[11]提出了基于熱平衡的關(guān)節(jié)發(fā)熱微分模型,在無需溫度傳感器的前提下預(yù)測(cè)機(jī)器人工作周期中的摩擦力矩變化。CARLSON等[12]將摩擦力矩視作以摩擦損耗為輸入的系統(tǒng),避免了溫度測(cè)量,并對(duì)所提出的方法進(jìn)行了實(shí)驗(yàn)評(píng)估。對(duì)于連續(xù)運(yùn)行狀態(tài)下的機(jī)器人,SIMONI等[13]通過探究不同運(yùn)行時(shí)間下關(guān)節(jié)摩擦的變化,研究溫度對(duì)關(guān)節(jié)摩擦的影響,并提出了連續(xù)運(yùn)轉(zhuǎn)下的關(guān)節(jié)摩擦模型。PAGANI等[14]考慮了關(guān)節(jié)結(jié)構(gòu)特點(diǎn),對(duì)關(guān)節(jié)傳熱模型進(jìn)行改進(jìn),更準(zhǔn)確地描述傳熱現(xiàn)象。
上述研究中的研究對(duì)象大多為以潤(rùn)滑油為潤(rùn)滑介質(zhì)的工業(yè)機(jī)器人,且均假設(shè)關(guān)節(jié)熱源為單一的機(jī)械摩擦。但在實(shí)際情況下,伺服電機(jī)、伺服驅(qū)動(dòng)等組件產(chǎn)生的熱量同樣對(duì)關(guān)節(jié)的升溫有貢獻(xiàn),并且不同關(guān)節(jié)結(jié)構(gòu)和潤(rùn)滑介質(zhì)的機(jī)器人的摩擦力矩也不盡相同。
機(jī)械摩擦是一種復(fù)雜的物理現(xiàn)象,目前很難通過數(shù)值計(jì)算對(duì)實(shí)際摩擦做出精確估計(jì)[15]。機(jī)器人關(guān)節(jié)摩擦來源眾多、成因復(fù)雜。對(duì)協(xié)作型串聯(lián)機(jī)器人關(guān)節(jié)而言,除伺服電機(jī)、傳感器、伺服驅(qū)動(dòng)外,還包含減速器與滾動(dòng)軸承等組件。
本文研究的協(xié)作機(jī)器人關(guān)節(jié)安裝了諧波減速器,并采用潤(rùn)滑脂作為潤(rùn)滑介質(zhì)。關(guān)節(jié)內(nèi)部機(jī)械摩擦的主要來源為滾動(dòng)軸承摩擦與減速器輪齒嚙合摩擦[7]。
1.1.1滾動(dòng)軸承摩擦
滾動(dòng)軸承的摩擦成因較為復(fù)雜,除軸承的結(jié)構(gòu)、尺寸和外界載荷外,潤(rùn)滑介質(zhì)的性能對(duì)摩擦也有較大的影響[16]。滾動(dòng)軸承的摩擦主要包括載荷摩擦、潤(rùn)滑介質(zhì)帶來的黏性摩擦、軸承滾子的自旋摩擦[17]等。從實(shí)際應(yīng)用出發(fā),可通過經(jīng)驗(yàn)公式近似計(jì)算摩擦力矩[18]:
(1)
式中,M為滾動(dòng)軸承的摩擦力矩,N/mm;f1為載荷系數(shù);F1為軸承徑向載荷,N;dm為軸承平均直徑,mm;f0為考慮結(jié)構(gòu)與潤(rùn)滑的系數(shù);ν為潤(rùn)滑介質(zhì)運(yùn)動(dòng)學(xué)黏度,m2/s;n為軸承轉(zhuǎn)速,r/min。
1.1.2輪齒嚙合摩擦
齒輪的嚙合摩擦包含滑動(dòng)摩擦與滾動(dòng)摩擦。對(duì)于滑動(dòng)摩擦而言,輪齒只有在完全理想情況下才處于完全彈流潤(rùn)滑狀態(tài),該狀態(tài)下的嚙合摩擦可通過Dowson線接觸潤(rùn)滑理論[19]來描述。實(shí)際的嚙合摩擦常處于部分彈性流體潤(rùn)滑的狀態(tài),其嚙合平均摩擦因數(shù)為[20]
(2)
式中,F(xiàn)n為齒面法向載荷,N;b為有效齒寬,mm;ρ為潤(rùn)滑介質(zhì)動(dòng)力學(xué)黏度,Pa·s;vHm、vTm分別為平均滑動(dòng)速度和平均滾動(dòng)速度,m/s。
對(duì)于輪齒嚙合的滾動(dòng)摩擦,可采用經(jīng)驗(yàn)公式對(duì)摩擦損耗進(jìn)行近似估計(jì)[21]:
(3)
式中,PR為齒面滾動(dòng)摩擦損失功率,kW;h為彈性動(dòng)力油膜厚度,mm;ζ為壓黏系數(shù),MPa-1;R為綜合曲率半徑,mm;E為綜合彈性模量,MPa;ψ為載荷系數(shù),N/mm。
由式(2)、式(3)可直觀得出,潤(rùn)滑介質(zhì)的黏度對(duì)嚙合摩擦的影響較為復(fù)雜。
實(shí)際的機(jī)器人關(guān)節(jié)除了上述的軸承摩擦和齒輪嚙合摩擦,還存在攪動(dòng)摩擦、減速器彈性形變等效摩擦等摩擦,并且不同摩擦的具體占比很難通過計(jì)算得到。因此,對(duì)于機(jī)器人關(guān)節(jié)整體而言,很難通過數(shù)值計(jì)算的方式得到完全準(zhǔn)確的摩擦力矩。從機(jī)器人的應(yīng)用層面考慮,可以將關(guān)節(jié)簡(jiǎn)化為整體,通過數(shù)學(xué)模型來研究關(guān)節(jié)整體的摩擦力矩。
在機(jī)器人應(yīng)用層面上,目前廣泛采用的關(guān)節(jié)摩擦模型主要有庫侖黏滯摩擦模型、Stribeck摩擦模型、LuGre摩擦模型[22]。
圖1 關(guān)節(jié)非線性摩擦模型Fig.1 Nonlinear friction model of joint
圖1所示摩擦模型的摩擦力矩為
(4)
由式(4)可知,該模型沒有考慮關(guān)節(jié)摩擦的Stribeck現(xiàn)象。潤(rùn)滑脂一般為非牛頓流體,其剪切應(yīng)力與剪切速率為非線性關(guān)系[23],因此機(jī)器人關(guān)節(jié)摩擦力矩大小隨關(guān)節(jié)轉(zhuǎn)速的提高非線性增長(zhǎng)。
在機(jī)器人的實(shí)際應(yīng)用中,盡管關(guān)節(jié)轉(zhuǎn)速并非恒定,但關(guān)節(jié)轉(zhuǎn)速一般高于出現(xiàn)Stribeck現(xiàn)象的臨界轉(zhuǎn)速,并且采用脂潤(rùn)滑的協(xié)作機(jī)器人的Stribeck現(xiàn)象相對(duì)不明顯,因此本文采用圖1所示的數(shù)學(xué)模型描述關(guān)節(jié)整體摩擦。
值得注意的是,實(shí)際工作的機(jī)器人關(guān)節(jié)存在加減速,此時(shí)的摩擦力矩可能存在遲滯現(xiàn)象,但實(shí)際的關(guān)節(jié)速度變化往往不大,摩擦力遲滯現(xiàn)象不明顯,因此為便于研究,本文忽略摩擦力矩的遲滯現(xiàn)象。
相關(guān)研究表明,溫度主要通過影響潤(rùn)滑介質(zhì)的動(dòng)力學(xué)黏度來間接影響摩擦力矩。潤(rùn)滑介質(zhì)的動(dòng)力學(xué)黏度可表示為溫度的指數(shù)函數(shù)[24],隨溫度的升高而非線性降低。由1.1節(jié)分析可知,無論是滾動(dòng)軸承摩擦還是輪齒嚙合摩擦,其摩擦力矩都會(huì)受潤(rùn)滑脂黏度的影響,并且與黏度呈非線性相關(guān)。
文獻(xiàn)[8-9,13]采用擴(kuò)展Stribeck模型描述溫度對(duì)工業(yè)機(jī)器人關(guān)節(jié)摩擦的影響。工業(yè)機(jī)器人關(guān)節(jié)采用潤(rùn)滑油為潤(rùn)滑介質(zhì),隨著關(guān)節(jié)溫度的升高,黏滯摩擦減小,但庫侖摩擦和混合潤(rùn)滑階段的摩擦反而會(huì)增大。
研究發(fā)現(xiàn),脂潤(rùn)滑機(jī)器人的庫侖摩擦力矩τc基本不受溫度變化影響,而黏滯摩擦隨溫度的升高非線性減小[7]?;谑?4)所述模型,提出了考慮溫度影響的擴(kuò)展模型:
(5)
由式(4)、式(5)可知,溫度升高時(shí),同一關(guān)節(jié)轉(zhuǎn)速下的摩擦力矩會(huì)非線性減小,但15~40 ℃內(nèi)的摩擦-溫度曲線斜率變化較小[7]。因此,對(duì)于溫升不大的情況,為簡(jiǎn)化模型,可將該溫度范圍內(nèi)的摩擦力矩與關(guān)節(jié)溫度近似為線性關(guān)系:
(6)
式中,T0為初始關(guān)節(jié)溫度,℃;α為摩擦力矩隨溫度變化的斜率,N·m/℃。
機(jī)器人在部分應(yīng)用場(chǎng)景中會(huì)有一段時(shí)間的持續(xù)運(yùn)行,如打磨、噴涂、焊接等任務(wù)中的機(jī)器人會(huì)按預(yù)定的程序重復(fù)動(dòng)作。持續(xù)轉(zhuǎn)動(dòng)的過程中,機(jī)器人關(guān)節(jié)的電機(jī)自身產(chǎn)熱和關(guān)節(jié)摩擦產(chǎn)熱等因素會(huì)使關(guān)節(jié)不斷升溫。當(dāng)關(guān)節(jié)溫度大于外界環(huán)境溫度時(shí),熱量會(huì)由關(guān)節(jié)向外界環(huán)境傳導(dǎo)。基于上述分析,文獻(xiàn)[11-12]提出了連續(xù)工作條件下的機(jī)器人關(guān)節(jié)溫度變化模型:
(7)
式中,t為運(yùn)行時(shí)間;T(t)為關(guān)節(jié)溫度;Ts為環(huán)境溫度,即關(guān)節(jié)初始溫度;ks為描述關(guān)節(jié)與外界環(huán)境傳熱能力系數(shù);τf(t)ω(t)為當(dāng)前時(shí)刻關(guān)節(jié)摩擦力矩的產(chǎn)熱功率。
由式(6)可知,關(guān)節(jié)的摩擦力矩會(huì)隨溫度的升高而減小。當(dāng)溫升為ΔT(t)時(shí),式(7)可表示為
(8)
式中,τfs(t)為不考慮溫度影響即環(huán)境溫度Ts下的關(guān)節(jié)摩擦力矩。
當(dāng)關(guān)節(jié)以固定軌跡連續(xù)運(yùn)行時(shí),由于軌跡周期tc往往遠(yuǎn)小于機(jī)器人連續(xù)運(yùn)行的時(shí)間th,因此可將各段的軌跡周期視作th中的一個(gè)短暫時(shí)刻,tc內(nèi)各時(shí)刻的摩擦功率可近似為其平均功率[20,25]:
(9)
軌跡周期tc內(nèi)的溫度變化很小,因此可忽略tc中的關(guān)節(jié)溫度變化。
綜合式(8)、式(9),可得
(10)
(11)
對(duì)式(11)進(jìn)行拉氏變換可得
(12)
關(guān)節(jié)溫度升高時(shí),各段軌跡周期內(nèi)的平均黏滯摩擦力矩
(13)
(14)
對(duì)式(12)、式(13)進(jìn)行拉式逆變換,得到關(guān)節(jié)溫度變化量和平均摩擦力矩變化量的時(shí)域表示形式:
(15)
式(15)描述了環(huán)境溫度相對(duì)穩(wěn)定的條件下,機(jī)器人在一段連續(xù)時(shí)間內(nèi)按照固定軌跡重復(fù)運(yùn)動(dòng)時(shí)關(guān)節(jié)摩擦力矩的變化,即連續(xù)重復(fù)工作條件下的機(jī)器人關(guān)節(jié)摩擦力矩模型。對(duì)式(15)中的參數(shù)進(jìn)行整理,可得
(16)
理論模型(式(16))僅考慮了關(guān)節(jié)機(jī)械摩擦產(chǎn)生的熱量。實(shí)際應(yīng)用中,機(jī)械摩擦不是關(guān)節(jié)產(chǎn)熱的唯一因素,因此需要對(duì)關(guān)節(jié)的其他熱源進(jìn)行分析,探究不同熱源對(duì)關(guān)節(jié)升溫的影響。
機(jī)器人電機(jī)等組件的產(chǎn)熱成因復(fù)雜,具體數(shù)值的計(jì)算難度較大,也超出了本文的研究范圍,且受限于實(shí)驗(yàn)條件,對(duì)發(fā)熱量進(jìn)行直接測(cè)量也不現(xiàn)實(shí),因此,本文基于前人的研究,對(duì)連續(xù)運(yùn)轉(zhuǎn)下的關(guān)節(jié)熱源進(jìn)行近似估計(jì)。
關(guān)節(jié)運(yùn)行時(shí),伺服電機(jī)存在損耗,且大部分最終轉(zhuǎn)化為熱量。電機(jī)損耗主要包括鐵耗、銅耗、渦流損耗、雜散損耗、機(jī)械損耗等。除銅耗外,鐵耗、渦流損耗和雜散損耗等受電機(jī)電流變化影響較小,機(jī)器人按照給定軌跡連續(xù)運(yùn)行時(shí),其電機(jī)平均速度基本不變,上述損耗基本恒定。
電機(jī)銅耗與導(dǎo)體電阻和電機(jī)電流有關(guān)。永磁直流電機(jī)的銅耗為
(17)
式中,Im為電機(jī)繞組電流;Rm為導(dǎo)體電阻。
機(jī)器人帶載工作時(shí),其銅耗約占總損耗的50%[26],摩擦力矩約占總力矩的20%[27]。假設(shè)摩擦力矩減小30%,總力矩減小6%,此時(shí)的電機(jī)繞組電流則降為先前的94%。由式(17)可知,此時(shí)電機(jī)銅耗減小約12%,總損耗減小約6%。
(18)
此時(shí),關(guān)節(jié)溫度與摩擦力矩的時(shí)域變化形式為
(19)
對(duì)于連續(xù)工作的機(jī)器人關(guān)節(jié)而言,可通過式(19)估計(jì)關(guān)節(jié)摩擦力矩隨運(yùn)行時(shí)間的變化,從而避免對(duì)關(guān)節(jié)溫度的直接測(cè)量。
為驗(yàn)證摩擦力矩模型的正確性,需測(cè)量連續(xù)工作的機(jī)器人關(guān)節(jié)摩擦力矩。機(jī)器人關(guān)節(jié)的輸出力矩包括摩擦力矩和驅(qū)動(dòng)關(guān)節(jié)運(yùn)動(dòng)力矩[13]。單個(gè)機(jī)器人關(guān)節(jié)的輸出力矩為
Jβ=τm-τf+τg
(20)
式中,J為關(guān)節(jié)折算轉(zhuǎn)動(dòng)慣量;β為關(guān)節(jié)角加速度;τm為關(guān)節(jié)實(shí)際輸出力矩;τf為關(guān)節(jié)摩擦力矩;τg為關(guān)節(jié)需要克服的連桿重力矩。
關(guān)節(jié)的角加速度β與重力矩τg為0時(shí),關(guān)節(jié)實(shí)際輸出力矩τm即為摩擦力矩τf。為準(zhǔn)確地測(cè)量關(guān)節(jié)運(yùn)動(dòng)時(shí)的摩擦力矩,可使機(jī)器人關(guān)節(jié)的軸向與重力方向相同,使式(20)中的τg=0,以消除重力矩的影響。與此同時(shí),驅(qū)動(dòng)關(guān)節(jié)1做勻速運(yùn)動(dòng),使式(20)中的β=0,以消除關(guān)節(jié)加速度的影響。
實(shí)驗(yàn)所用的機(jī)器人是中科深谷六軸串聯(lián)機(jī)器人,如圖2所示,其關(guān)節(jié)1的軸向與重力方向相同,因此本文選取關(guān)節(jié)1為研究對(duì)象做勻速運(yùn)動(dòng),消除重力矩和關(guān)節(jié)加速度的影響。
圖2 六軸串聯(lián)機(jī)器人Fig.2 Six-axis serial robot
為探究不同軌跡下的升溫對(duì)摩擦力矩的影響,采用多組不同的軌跡即驅(qū)動(dòng)關(guān)節(jié)1按照不同的速度連續(xù)勻速運(yùn)行,研究不同軌跡對(duì)應(yīng)摩擦模型效果的異同。高速狀態(tài)下的關(guān)節(jié)啟停會(huì)有較大的沖擊,因此選取角速度分別為0.4,0.6,0.8,1.0,1.2,1.4,1.6,1.8,2.0,4.0,6.0,8.0,10.0,20.0,30.0°/s(共15組)進(jìn)行實(shí)驗(yàn)。
驅(qū)動(dòng)關(guān)節(jié)1按照上述角速度連續(xù)運(yùn)行,采集對(duì)應(yīng)的關(guān)節(jié)輸出力矩,通過溫度傳感器測(cè)量關(guān)節(jié)1外殼處的溫度,采集間隔為5 min。關(guān)節(jié)力矩通過電機(jī)電流間接得到,關(guān)節(jié)輸出力矩與電機(jī)電流的關(guān)系為
τm=ηkmIm
(21)
式中,η為關(guān)節(jié)減速器減速比;km為伺服電機(jī)的轉(zhuǎn)矩常數(shù),N·m/A。
圖3所示為關(guān)節(jié)角速度2.0°/s時(shí)的關(guān)節(jié)力矩和關(guān)節(jié)角度。通過MATLAB中的巴特沃斯濾波器對(duì)采集得到的摩擦力矩進(jìn)行低通濾波,減小高頻噪聲的影響。低通濾波關(guān)節(jié)往復(fù)運(yùn)動(dòng)時(shí)的兩段力矩信號(hào)后,將其平均值作為該角速度對(duì)應(yīng)的關(guān)節(jié)摩擦力矩。
(a)輸出力矩
(b)關(guān)節(jié)角度圖3 2°/s時(shí)關(guān)節(jié)輸出力矩與關(guān)節(jié)角度Fig.3 Joint output torque and joint angle at 2°/s
為探究不同工作條件下的關(guān)節(jié)產(chǎn)熱量,分別使機(jī)器人關(guān)節(jié)以0.4°/s、2.0°/s、20.0°/s的角速度連續(xù)運(yùn)行,以5 min為間隔測(cè)量關(guān)節(jié)1外殼處溫度。為驗(yàn)證理論模型的正確性,對(duì)采集得到的溫度進(jìn)行擬合。圖4所示為關(guān)節(jié)外殼實(shí)際升溫,以及基于式(16)所得的升溫?cái)M合曲線。
圖4 關(guān)節(jié)升溫情況Fig.4 Temperature rise of joints
關(guān)節(jié)角速度分別為0.4°/s、2.0°/s、20.0°/s時(shí),實(shí)測(cè)溫度與擬合曲線對(duì)應(yīng)溫度的均方差(RMS)分別為0.0508 ℃、0.0627 ℃、0.1088 ℃。實(shí)測(cè)溫度基本符合式(16)中的理論模型,驗(yàn)證了該模型的正確性。
為探究連續(xù)運(yùn)轉(zhuǎn)狀態(tài)下摩擦力矩的變化,讓機(jī)器人按15個(gè)不同的關(guān)節(jié)角速度連續(xù)運(yùn)行115 min,以5 min為間隔采集關(guān)節(jié)力矩(每組速度的關(guān)節(jié)力矩有24個(gè)測(cè)量值)。
圖5所示為不同轉(zhuǎn)速的實(shí)測(cè)摩擦力矩?;谀Σ聊P?式(4)),對(duì)實(shí)測(cè)數(shù)據(jù)進(jìn)行最小二乘擬合,發(fā)現(xiàn)關(guān)節(jié)轉(zhuǎn)速小于1°/s時(shí)摩擦力矩出現(xiàn)Stribeck現(xiàn)象;關(guān)節(jié)轉(zhuǎn)速大于1°/s時(shí)摩擦力矩基本符合關(guān)節(jié)摩擦模型。機(jī)器人實(shí)際平穩(wěn)運(yùn)行時(shí)的關(guān)節(jié)轉(zhuǎn)速一般遠(yuǎn)大于1°/s,因此可以忽略其Stribeck現(xiàn)象。
圖5 摩擦力矩與關(guān)節(jié)轉(zhuǎn)速Fig.5 Friction torque and joint speed
為對(duì)假設(shè)(式(6))進(jìn)行驗(yàn)證,分別對(duì)2.0°/s、20.0°/s轉(zhuǎn)速下的摩擦力矩隨溫度的變化進(jìn)行最小二乘擬合。由圖6可知,當(dāng)關(guān)節(jié)溫度在17~26 ℃范圍內(nèi)變化時(shí),盡管摩擦力矩與溫度變化成非線性關(guān)系,但摩擦力矩-溫度曲線的斜率變化不大。因此簡(jiǎn)化模型時(shí)可將摩擦力矩和溫度變化近似為線性關(guān)系。
圖6 摩擦力矩與溫度變化情況Fig.6 Friction torque and temperature change
根據(jù)式(16)對(duì)關(guān)節(jié)角速度對(duì)應(yīng)的摩擦力矩進(jìn)行最小二乘擬合。由圖7可知,當(dāng)關(guān)節(jié)以10°/s的角速度連續(xù)運(yùn)行時(shí),關(guān)節(jié)摩擦力矩隨時(shí)間的增長(zhǎng)而減小,實(shí)測(cè)摩擦力矩與擬合曲線對(duì)應(yīng)摩擦力矩的均方差為0.0283 N·m。實(shí)測(cè)摩擦力矩基本符合理論模型(式(16)),驗(yàn)證了該模型的正確性。
圖7 10°/s時(shí)摩擦力矩隨時(shí)間的變化Fig.7 Friction torque changes with time at 10°/s
驅(qū)動(dòng)機(jī)器人按照不同速度連續(xù)運(yùn)行,記錄各時(shí)間點(diǎn)對(duì)應(yīng)的摩擦力矩,可得不同角速度和運(yùn)行時(shí)間對(duì)應(yīng)的關(guān)節(jié)摩擦力矩,按照式(16)對(duì)每個(gè)角速度對(duì)應(yīng)的摩擦力矩進(jìn)行最小二乘擬合。
圖8所示為關(guān)節(jié)角速度1~30°/s內(nèi),摩擦力矩隨時(shí)間的變化,圖中的淺色部分為實(shí)測(cè)摩擦力矩,深色部分為擬合摩擦力矩。速度范圍(1~30°/s)內(nèi),實(shí)測(cè)摩擦力矩曲面與理論模型(式(16))的擬合曲面基本一致。
圖8 摩擦力矩?cái)M合值和實(shí)測(cè)值Fig.8 Fitted and measured values of friction torque
為進(jìn)一步驗(yàn)證摩擦模型,探究機(jī)器人完成復(fù)雜動(dòng)作時(shí)的關(guān)節(jié)輸出力矩,設(shè)計(jì)了非勻速軌跡對(duì)上述摩擦模型進(jìn)行驗(yàn)證。
基于機(jī)器人動(dòng)力學(xué)模型的前饋控制中,關(guān)節(jié)前饋力矩的預(yù)測(cè)精度對(duì)控制精度有較大影響,因此,為驗(yàn)證式(16)中的模型效果,驅(qū)動(dòng)全部關(guān)節(jié)按隨機(jī)生成的五階傅里葉級(jí)數(shù)運(yùn)動(dòng),關(guān)節(jié)1的軌跡如圖9所示。
圖9 關(guān)節(jié)1驗(yàn)證軌跡Fig.9 Verification trajectory of joint 1
關(guān)節(jié)1的輸出力矩包含摩擦力矩、連桿本身運(yùn)動(dòng)所需力矩和其他連桿的間接作用力矩。圖10所示為機(jī)器人由0 min連續(xù)運(yùn)轉(zhuǎn)至115 min時(shí),驗(yàn)證軌跡下關(guān)節(jié)1的預(yù)測(cè)力矩和實(shí)測(cè)力矩。值得注意的是,該隨機(jī)驗(yàn)證軌跡部分時(shí)刻的關(guān)節(jié)轉(zhuǎn)速不平穩(wěn),導(dǎo)致力矩測(cè)量值不夠精確,因此其驗(yàn)證效果要稍遜于平穩(wěn)運(yùn)行時(shí)的效果。
圖10 驗(yàn)證軌跡下的關(guān)節(jié)力矩Fig.10 Joint torque under the verify trajectory
本文提出了固定軌跡連續(xù)運(yùn)轉(zhuǎn)狀態(tài)下的機(jī)器人關(guān)節(jié)摩擦力矩模型。該模型可在無需對(duì)關(guān)節(jié)溫度進(jìn)行測(cè)量或預(yù)測(cè)的前提下,探究溫度變化對(duì)關(guān)節(jié)摩擦力矩的影響,并通過實(shí)驗(yàn)驗(yàn)證了摩擦模型的可行性,因此該模型可較為準(zhǔn)確地描述關(guān)節(jié)連續(xù)運(yùn)行時(shí)摩擦力矩逐漸減小的現(xiàn)象。在實(shí)際生產(chǎn)應(yīng)用中,對(duì)于連續(xù)重復(fù)運(yùn)動(dòng)的串聯(lián)機(jī)器人,可基于該模型對(duì)摩擦力矩的變化進(jìn)行預(yù)測(cè)。
關(guān)節(jié)發(fā)熱的原因較為復(fù)雜,難以通過數(shù)學(xué)模型進(jìn)行準(zhǔn)確描述,為簡(jiǎn)化模型,將運(yùn)行時(shí)的電機(jī)損耗等產(chǎn)熱功率看作為常量。本文模型忽略了低速狀態(tài)下的Stribeck現(xiàn)象和加減速度較大時(shí)的摩擦遲滯、沖擊負(fù)荷,因此本文模型僅適用于關(guān)節(jié)速度變化較為平穩(wěn)的非低速狀態(tài)。