亚洲免费av电影一区二区三区,日韩爱爱视频,51精品视频一区二区三区,91视频爱爱,日韩欧美在线播放视频,中文字幕少妇AV,亚洲电影中文字幕,久久久久亚洲av成人网址,久久综合视频网站,国产在线不卡免费播放

        ?

        基于奇異攝動理論的機器人關(guān)節(jié)控制研究

        2021-03-17 07:38:00段現(xiàn)銀閔華松黃文暉吳修玉
        武漢科技大學(xué)學(xué)報 2021年2期
        關(guān)鍵詞:控制精度觀測器滑模

        夏 杭,段現(xiàn)銀,閔華松,黃文暉,吳修玉

        (1. 武漢科技大學(xué)冶金裝備及其控制教育部重點實驗室,湖北 武漢,430081;2.武漢科技大學(xué)機器人與智能系統(tǒng)研究院,湖北 武漢,430081;3.武昌首義學(xué)院機電與自動化學(xué)院,湖北 武漢,430064)

        傳統(tǒng)工業(yè)機器人由于體積大、自重載荷比低和工作環(huán)境單一等缺點,越來越不能滿足人機共融環(huán)境下的要求,而柔性機械臂在工作時表現(xiàn)出良好的順應(yīng)性受到行業(yè)廣泛關(guān)注[1]。但柔性關(guān)節(jié)內(nèi)部存在具有彈性屬性的元器件、諧波減速機等零部件,這些具有彈性屬性的零部件讓關(guān)節(jié)控制變得更加困難,且諧波減速機內(nèi)的非線性摩擦?xí)?dǎo)致機械臂在運動過程中產(chǎn)生抖動[2]。關(guān)節(jié)彈性容易導(dǎo)致關(guān)節(jié)在控制過程中產(chǎn)生殘余振動、收斂速度慢,且超調(diào)量大[3],給關(guān)節(jié)的控制系統(tǒng)設(shè)計帶來了很大的挑戰(zhàn)。研究人員對提高柔性關(guān)節(jié)控制精度所采取的研究方法主要有奇異攝動法[4]、反饋線性化法[5]、結(jié)合關(guān)節(jié)扭矩反饋的級聯(lián)系統(tǒng)方法[6]。反饋線性化法是將柔性關(guān)節(jié)的非線性系統(tǒng)轉(zhuǎn)化為線性系統(tǒng),但運用該方法需要引入狀態(tài)觀測器,才能保證轉(zhuǎn)化為線性系統(tǒng)時的準確性,因此也增加了控制系統(tǒng)的復(fù)雜性;結(jié)合關(guān)節(jié)扭矩反饋的級聯(lián)系統(tǒng)方法是將機器人系統(tǒng)分為柔性和剛性兩個部分,然后直接對剛性部分的動力學(xué)進行控制,最后將反饋力矩補償?shù)饺嵝圆糠?,但該方法依賴準確采集系統(tǒng)輸出力矩和精準的關(guān)節(jié)動力學(xué)模型;奇異攝動法是將柔性關(guān)節(jié)系統(tǒng)解耦成兩個子系統(tǒng),首先補償關(guān)節(jié)柔性部分,再對關(guān)節(jié)進行控制[7]。

        為了抑制關(guān)節(jié)振動,國內(nèi)外研究人員展開了系列研究,Petit等[8]提出了基于模型的狀態(tài)反饋控制器,通過將關(guān)節(jié)輸出信號進行處理后反饋到輸入端,從而有效抑制關(guān)節(jié)振動,但該方法在建模時忽略了關(guān)節(jié)內(nèi)部摩擦和外界干擾的影響;Petit等[9]還提出了一種無模型的阻尼控制方法,該方法利用聯(lián)合彈性將動能轉(zhuǎn)換為彈性能來實現(xiàn)振動抑制;Sun等[10]提出了一種基于在線重力補償?shù)囊终裎恢每刂品椒▉碛行У販p小柔性關(guān)節(jié)輸出角度的超調(diào)量;韓吉霞等[11]提出了在控制策略中引入干擾觀測器來減小關(guān)節(jié)振動和保證關(guān)節(jié)控制的魯棒性。

        由于關(guān)節(jié)內(nèi)部摩擦力矩形式復(fù)雜且難以估算,目前在對柔性關(guān)節(jié)控制研究中大多忽略了摩擦力矩對位置控制的影響,但在實際應(yīng)用中,彈性元器件和諧波減速機的使用帶來了關(guān)節(jié)內(nèi)部不可忽略的柔性和摩擦以及關(guān)節(jié)彈性振動等問題。為此,本文針對機器人柔性關(guān)節(jié)存在位置控制精度低的問題,在考慮關(guān)節(jié)內(nèi)部非線性摩擦和外界擾動等因素的情況下,建立柔性關(guān)節(jié)動力學(xué)模型,提出基于奇異攝動理論的干擾觀測器滑??刂品椒ǎ迷摽刂品椒▽﹃P(guān)節(jié)控制系統(tǒng)進行Lyapunov穩(wěn)定性分析和MATLAB仿真,以期為機器人關(guān)節(jié)控制研究提供參考。

        1 柔性關(guān)節(jié)動力學(xué)建模

        1.1 柔性關(guān)節(jié)的構(gòu)成及控制系統(tǒng)

        柔性關(guān)節(jié)的構(gòu)成及控制系統(tǒng)如圖1所示。從圖1(a)中可以看出,柔性關(guān)節(jié)將無框力矩電機、諧波減速機、霍爾傳感器、磁環(huán)編碼器、彈性元器件、制動器、驅(qū)動器等多種零部件集成于一體,該關(guān)節(jié)具有體積小、輸出扭矩大、便于維修等優(yōu)點,并且具有標準的機械接口和電氣接口。在圖1(b)中,無框力矩電機為關(guān)節(jié)提供動力;諧波減速機由于質(zhì)量輕、減速比大,能進一步提高關(guān)節(jié)輸出扭矩;彈性元器件具有抗沖擊性強的特點,將動力傳遞到關(guān)節(jié)的法蘭;霍爾傳感器和磁環(huán)編碼器采集電機端和關(guān)節(jié)輸出端的位置和速度信息;制動器提供位置保持和電源保護。

        (a)關(guān)節(jié)機械結(jié)構(gòu)圖

        (b)關(guān)節(jié)控制系統(tǒng)框圖

        1.2 柔性關(guān)節(jié)動力學(xué)模型

        Spong[12]建立了一種最初的柔性關(guān)節(jié)簡化模型,將關(guān)節(jié)中具有彈性屬性的元器件和諧波減速機等零部件等效為彈性系數(shù)不變的扭簧,但該模型忽略了關(guān)節(jié)內(nèi)部非線性摩擦和外界干擾等因素的影響,不能完整地表示關(guān)節(jié)內(nèi)部的物理特性。良好的動力學(xué)模型不僅能真實反映關(guān)節(jié)內(nèi)部的物理特性,而且是實現(xiàn)關(guān)節(jié)準確控制的前提。本文在考慮關(guān)節(jié)內(nèi)部摩擦和關(guān)節(jié)外部干擾因素的情況下,對摩擦力進行辨識,并對柔性關(guān)節(jié)進行動力學(xué)建模,其簡化模型如圖2所示。柔性關(guān)節(jié)動力學(xué)方程為:

        (1)

        式中,Tm、T、Ta、Tf、Te分別為電機電磁轉(zhuǎn)矩、關(guān)節(jié)力矩、關(guān)節(jié)內(nèi)部摩擦與外界擾動產(chǎn)生的力矩之和、關(guān)節(jié)內(nèi)部摩擦力矩、外界擾動力矩,N·m;Jm、Jl分別為電機轉(zhuǎn)動慣量和負載轉(zhuǎn)動慣量,kg·m2;K為柔性扭轉(zhuǎn)彈性系數(shù),N·m/rad;Bl為負載阻尼系數(shù),N·m·s/rad;θm、θl分別為電機轉(zhuǎn)角、關(guān)節(jié)轉(zhuǎn)角,rad。

        圖2 柔性關(guān)節(jié)簡化模型

        1.3 摩擦力模型與參數(shù)辨識

        柔性關(guān)節(jié)內(nèi)部摩擦屬于混合摩擦,單一的摩擦形式無法準確描述柔性關(guān)節(jié)內(nèi)部的摩擦情況。Stribeck摩擦模型[13]包含有庫倫摩擦和最大靜摩擦,能比較全面地描述關(guān)節(jié)內(nèi)摩擦特性,其模型為:

        (2)

        式中,fc、fs分別為關(guān)節(jié)內(nèi)部庫倫摩擦力矩、最大靜摩擦力矩,N·m;ω、ωs分別為關(guān)節(jié)旋轉(zhuǎn)角速度和Stribeck速度,rad/s;Bv為關(guān)節(jié)內(nèi)部黏性摩擦系數(shù),N·m·s/rad。

        對于單關(guān)節(jié)Stribeck摩擦模型的參數(shù)辨識,首先設(shè)計三階傅里葉級數(shù)作為激勵軌跡,激勵頻率為100 Hz,采樣周期為10 s;其次采集關(guān)節(jié)角度與力矩值,對關(guān)節(jié)角度差分求取關(guān)節(jié)角速度,對關(guān)節(jié)角度二次差分獲取關(guān)節(jié)角加速度,并采用低通濾波對所采集的關(guān)節(jié)力矩值以及關(guān)節(jié)角度信號進行濾波;最后用最小二乘法辨識求得關(guān)節(jié)內(nèi)部摩擦力模型參數(shù)如表1所示。

        表1 Stribeck 摩擦模型參數(shù)

        2 控制器的設(shè)計與穩(wěn)定性分析

        由于柔性關(guān)節(jié)在轉(zhuǎn)動過程中容易產(chǎn)生振動,因此需要設(shè)計能同時實現(xiàn)位置跟蹤和抑制關(guān)節(jié)振動的控制器。依據(jù)奇異攝動理論,將柔性關(guān)節(jié)系統(tǒng)解耦為不同時間尺度并且相互獨立的兩個低階子系統(tǒng),然后分別針對兩個獨立的子系統(tǒng)設(shè)計控制器[14]。令:

        Tm=us+uf

        (3)

        式中,uf為快變子系統(tǒng)控制量,N·m;us為慢變子系統(tǒng)控制量,N·m。

        (4)

        快變子系統(tǒng)控制律為:

        (5)

        式中,Kv為力矩反饋微分增益系數(shù)。

        關(guān)節(jié)力矩方程可表示為:

        (6)

        令ε=0,得慢變子系統(tǒng)方程為:

        (7)

        2.1 基于干擾觀測器的慢變子系統(tǒng)滑??刂?/h3>

        將式(7)化為標準形式得:

        (8)

        所設(shè)計的滑模面函數(shù)(s)為:

        (9)

        式中,關(guān)節(jié)位置誤差e=θd-θl,其中θd為關(guān)節(jié)期望位置。

        針對慢變子變系統(tǒng),設(shè)計滑??刂坡蔀椋?/p>

        (10)

        式中,fd為通過干擾觀測器對f項的估計值,N·m;kf為切換增益系數(shù),將其設(shè)計為:kf>|fe|,其中,fe為f項的估計誤差,N·m,fe=f-fd。

        定義李雅普諾夫函數(shù)為:

        (11)

        =-[fd+kfsgn(s)]+f

        =fe-kfsgn(s)

        (12)

        由式(11)和式(12)得:

        (13)

        由于對f項的估計誤差fe足夠小,則需要將切換增益系數(shù)kf設(shè)計成很小的值,從而有效地抑制關(guān)節(jié)振動。

        干擾觀測器的設(shè)計為:

        (14)

        2.2 穩(wěn)定性分析

        定義李雅普諾夫函數(shù)為:

        (15)

        對式(15)求導(dǎo)得:

        (16)

        =-fex1+x1(fe-k2x1)

        (17)

        3 仿真

        關(guān)節(jié)系統(tǒng)控制框圖如圖3所示。計算得到關(guān)節(jié)轉(zhuǎn)動慣量為0.405×10-2kg·m2,負載端轉(zhuǎn)動慣量為0.605×10-2kg·m2,柔性關(guān)節(jié)剛度為450 N·m/rad,阻尼系數(shù)為0.05 N·m·s/rad,外界擾動力矩Te取2sintN·m,干擾觀測器中的極點增益參數(shù)k1=2300、k2=320,切換增益系數(shù)kf=3。分別對柔性關(guān)節(jié)進行定位和位置跟蹤仿真試驗,關(guān)節(jié)轉(zhuǎn)動的期望位置分別為5 rad和5sin(2πt)。關(guān)節(jié)輸入為階躍信號下的響應(yīng)如圖4所示,關(guān)節(jié)輸入為正弦信號下的響應(yīng)如圖5所示。從圖4中可以看出,在進行關(guān)節(jié)位置保持仿真時,關(guān)節(jié)系統(tǒng)上升時間為0.107 s,在經(jīng)過0.217 s后進入穩(wěn)定狀態(tài),關(guān)節(jié)轉(zhuǎn)動5 rad后速度快速降低到0,并且穩(wěn)態(tài)誤差趨近于0,由此表明,該關(guān)節(jié)系統(tǒng)調(diào)節(jié)時間短、穩(wěn)態(tài)誤差小、定位精度高。從圖5中可以看出,在進行關(guān)節(jié)位置跟蹤仿真時,關(guān)節(jié)位置跟蹤響應(yīng)時間為0.109 s,經(jīng)過0.109 s后,關(guān)節(jié)輸出角度與關(guān)節(jié)期望角度(5sin(2πt))接近,關(guān)節(jié)位置誤差在-0.176~0.152 rad范圍內(nèi)波動,表明關(guān)節(jié)位置跟蹤誤差較小,且跟蹤響應(yīng)速度較快。由此可見,本文提出的基于奇異攝動理論的干擾觀測器滑??刂品椒軌蛴行p小關(guān)節(jié)內(nèi)部摩擦和外界干擾對關(guān)節(jié)控制精度的影響。

        圖3 關(guān)節(jié)系統(tǒng)控制框圖

        (a)關(guān)節(jié)輸出角度

        (b)關(guān)節(jié)輸出角速度

        (a)關(guān)節(jié)輸出角度

        (b)關(guān)節(jié)輸出角速度

        PD控制下關(guān)節(jié)定位仿真結(jié)果、無干擾觀測器關(guān)節(jié)定位仿真結(jié)果分別如圖6和圖7所示,關(guān)節(jié)定位誤差量化對比如表2所示。對比圖4、圖6、圖7以及表2可以看出,在PD控制和無干擾觀測器控制下,關(guān)節(jié)系統(tǒng)超調(diào)量和穩(wěn)態(tài)誤差過大,采用干擾觀測器滑??刂品椒ê?,關(guān)節(jié)系統(tǒng)超調(diào)量降低至15.78%,關(guān)節(jié)系統(tǒng)穩(wěn)態(tài)誤差降低至0.028 rad。由此可得,在有摩擦和外界干擾的影響下,PD控制方法無法實現(xiàn)關(guān)節(jié)輸出保持穩(wěn)定,超調(diào)量大,有明顯的振動;在引入干擾觀測器后,基于奇異攝動理論的干擾觀測器滑??刂品椒軌蚴龟P(guān)節(jié)輸出響應(yīng)速度加快,系統(tǒng)在經(jīng)過0.217 s調(diào)節(jié)后達到穩(wěn)定狀態(tài),穩(wěn)態(tài)誤差減小到0.028 rad,系統(tǒng)的控制精度明顯提高。

        圖6 PD控制下關(guān)節(jié)定位仿真結(jié)果

        圖7 無干擾觀測器關(guān)節(jié)定位仿真結(jié)果

        表2 不同控制方法下關(guān)節(jié)定位誤差量化對比

        PD控制關(guān)節(jié)位置跟蹤仿真結(jié)果、無干擾觀測器關(guān)節(jié)位置跟蹤仿真結(jié)果分別如圖8和圖9所示,關(guān)節(jié)位置跟蹤誤差對比如圖10所示,不同控制方法下關(guān)節(jié)位置跟蹤誤差量化對比如表3所示。由圖8、圖9和圖10以及表3可以看出,在PD控制和無干擾觀測器控制下,關(guān)節(jié)位置跟蹤誤差范圍比較大,跟蹤響應(yīng)時間也較長;在引入干擾觀測器后,跟蹤誤差范圍縮小為-0.176~0.152 rad,跟蹤響應(yīng)時間縮短至0.109s。由此可見,基于奇異攝動理論的干擾觀測器滑??刂品椒梢詼p小關(guān)節(jié)由內(nèi)部摩擦和外界干擾引起的位置跟蹤誤差,跟蹤響應(yīng)速度更快,跟蹤性能更好。

        圖8 PD控制關(guān)節(jié)位置跟蹤仿真結(jié)果

        圖9 無干擾觀測器關(guān)節(jié)位置跟蹤仿真結(jié)果

        圖10 關(guān)節(jié)位置跟蹤誤差對比

        表3 不同控制方法下關(guān)節(jié)位置跟蹤誤差量化對比

        4 結(jié)語

        (1)針對機器人柔性關(guān)節(jié)控制精度低的問題,提出了一種基于奇異攝動理論的干擾觀測器滑??刂品椒?該方法在引入干擾觀測器后,可以減小關(guān)節(jié)內(nèi)部非線性摩擦和外界干擾對關(guān)節(jié)控制精度的影響。

        (2)與PD控制方法和無干擾觀測器控制方法相比,所提出的基于奇異攝動理論的干擾觀測器滑??刂品椒軌蚩s短關(guān)節(jié)控制系統(tǒng)調(diào)節(jié)時間,且超調(diào)量低,能有效抑制關(guān)節(jié)振動和提高系統(tǒng)的控制精度。

        猜你喜歡
        控制精度觀測器滑模
        基于多源異構(gòu)信息融合的采摘機械臂驅(qū)動控制研究
        基于組合滑??刂频慕^對重力儀兩級主動減振設(shè)計
        測控技術(shù)(2018年4期)2018-11-25 09:47:26
        并網(wǎng)逆變器逆系統(tǒng)自學(xué)習(xí)滑??箶_控制
        MW級太空發(fā)電站微波能量波束指向控制精度分析
        基于安卓的智能車轉(zhuǎn)速系統(tǒng)的設(shè)計與實現(xiàn)
        基于觀測器的列車網(wǎng)絡(luò)控制
        基于非線性未知輸入觀測器的航天器故障診斷
        基于干擾觀測器的PI控制單相逆變器
        采用干擾觀測器PI控制的單相SPWM逆變電源
        日本公与熄乱理在线播放| 亚洲av色香蕉一区二区三区av| 久久精品国产亚洲av成人文字| 欧美激情在线播放| 中文字幕美人妻亅u乚一596| 天天澡天天揉揉AV无码人妻斩 | 免费观看国产精品| 青青草一级视频在线观看| 一区二区三区在线少妇| 人妻夜夜爽天天爽三区| 久久中文字幕乱码免费| 99久久国产一区二区三区| 精品在线视频在线视频在线视频 | 美女主播网红视频福利一区二区| 99国产精品久久久蜜芽| 国产成人影院一区二区| 91精品国产色综合久久不| 亚洲国产成人av二区| 亚洲美腿丝袜 欧美另类| 亚洲自拍愉拍| 丰满少妇av一区二区三区| 国产freesexvideos中国麻豆 | 丰满少妇a级毛片| 日韩一欧美内射在线观看| 久久迷青品着产亚洲av网站| 国产av精品一区二区三区久久| 精品淑女少妇av久久免费| 纯肉无遮挡H肉动漫在线观看国产| 男女后入式在线观看视频| 天天做天天爱夜夜爽女人爽| 久久精品国产亚洲av麻| 18禁国产美女白浆在线| 人妻少妇精品视频一区二区三区l 日韩人妻中文字幕专区 | 亚洲成人黄色av在线观看| 中国国产不卡视频在线观看| 真人无码作爱免费视频禁hnn| 久久久久久无中无码| 全亚洲最大的私人影剧院在线看| 国产成人精品a视频| 国产综合色在线视频| 亚洲精品国产av成人网|