黃 杰
(重慶交通大學(xué)機(jī)電與車輛工程學(xué)院,重慶 400074)
工業(yè)機(jī)械手臂是一種自動(dòng)操作裝置,可以模擬人類手和手臂動(dòng)作實(shí)現(xiàn)某些功能。因此,廣泛應(yīng)用于機(jī)械制造等制造領(lǐng)域的生產(chǎn)[1-3]。一方面,人類不大愿意從事重復(fù)性工作,喜歡善于進(jìn)行戰(zhàn)略思考。此時(shí)機(jī)器人的作用就凸顯出來(lái)了,它們就可以代替人類從事這些工作。因此,一些基于活動(dòng)級(jí)控制的機(jī)械工業(yè)手臂可以充分發(fā)揮兩者的優(yōu)勢(shì):操作者只需要指定機(jī)器人需要做什么、完成什么工作內(nèi)容,機(jī)器人只需要負(fù)責(zé)完成一步步的指令,最終就把任務(wù)完成了。這樣,一個(gè)工人就可以操作多個(gè)機(jī)器人展開(kāi)有序工作,從而就可以減少所需人數(shù),大大降低項(xiàng)目成本[4]。隨著科技的不斷發(fā)展,機(jī)器人在人類的生活隨處可見(jiàn),例如:機(jī)器人在軍事、醫(yī)學(xué)、農(nóng)業(yè)、工業(yè)上的廣泛應(yīng)用。機(jī)器人的出現(xiàn)將會(huì)用更少的勞動(dòng)力去保質(zhì)保量完成既定的工作,完成一些人類無(wú)法完成的事[2]。這些工業(yè)機(jī)器人和人一樣由手臂和手指組成,可以代替人類從事機(jī)械化和自動(dòng)化的繁重工作,甚至這些工作有可能是在危險(xiǎn)條件下進(jìn)行,因此,工業(yè)機(jī)械手臂被廣泛應(yīng)用于機(jī)械、冶金、電子等行業(yè),輕工業(yè)和原子能[5-6]。
以工業(yè)機(jī)械手臂為研究對(duì)象,利用拉格朗日數(shù)學(xué)原理建立了兩自由度工業(yè)機(jī)械手臂的動(dòng)力學(xué)模型。針對(duì)二自由度工業(yè)機(jī)械手臂設(shè)計(jì)了基于模型整體逼近的機(jī)械臂RBF網(wǎng)絡(luò)自適應(yīng)控制器,并且基于s函數(shù)在Matlab中創(chuàng)建了Simulink控制圖。采用模型整體逼近的機(jī)械臂RBF網(wǎng)絡(luò)自適應(yīng)對(duì)機(jī)械臂的軌跡跟蹤性能進(jìn)行了仿真并且驗(yàn)證了控制算法的有效性。
神經(jīng)網(wǎng)絡(luò)廣泛地應(yīng)用于系統(tǒng)不確定項(xiàng)的辨識(shí)。文獻(xiàn)[7]使用神經(jīng)網(wǎng)絡(luò)對(duì)時(shí)變的機(jī)械臂動(dòng)力學(xué)系統(tǒng)中的不確定項(xiàng)進(jìn)行了辨識(shí),由此提高了控制精度;文獻(xiàn)[8]使用神經(jīng)網(wǎng)絡(luò)對(duì)套索傳動(dòng)系統(tǒng)進(jìn)行辨識(shí),調(diào)高了套索傳動(dòng)的跟蹤精度。因此,可以使用神經(jīng)網(wǎng)絡(luò)對(duì)柔性機(jī)械臂動(dòng)力學(xué)系統(tǒng)中的柔性耦合非線性項(xiàng)進(jìn)行辨識(shí),然后以內(nèi)控回路的方式對(duì)輸入力矩進(jìn)行補(bǔ)償。文獻(xiàn)[9-10]的創(chuàng)新之處在于它將柔性機(jī)械臂等效為柔性梁模型,這大大簡(jiǎn)化了模型的復(fù)雜性。其次利用假設(shè)模態(tài)法建立了柔性機(jī)械臂伺服系統(tǒng)的動(dòng)力學(xué)方程。在動(dòng)力學(xué)的建模過(guò)程中將重力因素加以考慮。
我們以工業(yè)機(jī)械手臂系統(tǒng)的動(dòng)力學(xué)模型為:
采用RBF逼近不確定項(xiàng)f,那么神經(jīng)網(wǎng)絡(luò)模型的輸出為設(shè)計(jì)的控制率為
控制率取:τ=(x)+Kv r-v,魯棒項(xiàng)v?。簐=-(εN+bd)sgn(r),被控對(duì)象中的(fx)?。╢x)=M(q)ζ(1t)+C(q,)ζ(2t)+G(q)+F()。其中,ζ(1t)=+,ζ(2t)+Λe。
從圖1可以看出,在基于模型整體逼近RBF網(wǎng)絡(luò)自適應(yīng)控制下,關(guān)節(jié)1在1.3時(shí)能夠較為精確跟蹤期望軌跡,0~1 s過(guò)程中抖動(dòng)較大,最大超調(diào)量為0.032 rad。關(guān)節(jié)2在1.4時(shí)能夠較為精確跟蹤期望軌跡。0~0.8 s過(guò)程中抖動(dòng)比較大,最大超調(diào)量為0.028 rad。
圖2顯示了基于模型整體逼近的自適應(yīng)RBF網(wǎng)絡(luò)控制所獲得的兩個(gè)驅(qū)動(dòng)力相對(duì)穩(wěn)定,且平滑,無(wú)需大抖動(dòng),由于采用RBF神經(jīng)網(wǎng)絡(luò)對(duì)系統(tǒng)進(jìn)行無(wú)限精度逼近,不確定項(xiàng)(f)項(xiàng)能夠有效地補(bǔ)償軌跡控制誤差,減少系統(tǒng)不確定性因素對(duì)系統(tǒng)的影響。
圖2 關(guān)節(jié)1與關(guān)節(jié)2驅(qū)動(dòng)力矩
由圖3RBF網(wǎng)絡(luò)對(duì)于不確定項(xiàng)及其估計(jì)值的逼近結(jié)果可以看出,不確定項(xiàng)在0~2下降得非常厲害,當(dāng)2 s以后不確定項(xiàng)及其估計(jì)值始終維持在40~42內(nèi)波動(dòng),從而極大減小了不確定項(xiàng)對(duì)于工業(yè)機(jī)械臂在工作過(guò)程中的干擾。
圖3 對(duì)于不確定項(xiàng)及其不確定項(xiàng)估計(jì)值的逼近結(jié)果
研究了工業(yè)機(jī)械臂工作過(guò)程中的軌跡控制補(bǔ)償算法偏差大、魯棒性差、效率低跟蹤控制問(wèn)題,根據(jù)李亞普諾夫穩(wěn)定性原理,設(shè)計(jì)了一種基于模型總體逼近的RBF網(wǎng)絡(luò)自適應(yīng)控制,由于實(shí)際的制系統(tǒng)中模型建模的不精確會(huì)導(dǎo)致控制性能的急劇下降,因此本文提出對(duì)模型不精確部分進(jìn)行逼近。并利用RBF神經(jīng)網(wǎng)絡(luò)對(duì)系統(tǒng)的不確定項(xiàng)進(jìn)行了補(bǔ)償,得到了RBF網(wǎng)絡(luò)自適應(yīng)控制。通過(guò)仿真實(shí)驗(yàn)得到如下結(jié)論:
(1)基于模型整體逼近的機(jī)械臂RBF網(wǎng)絡(luò)自適應(yīng)控制使得工業(yè)機(jī)械臂在工作工程中具有更精確的軌跡跟蹤控制??刂菩阅艿玫搅颂岣?,提高了系統(tǒng)的學(xué)習(xí)速度,因而能夠得到較理想的控制效果。
(2)RBF網(wǎng)絡(luò)自適應(yīng)控制使得工業(yè)機(jī)械臂對(duì)于外界的干擾具有更高的魯棒性。