空間機械臂碰撞過程的模糊無模型自適應振動控制

2023-10-18 03:47:34浦玉學周潤閏

振動與沖擊 2023年19期

浦玉學, 周潤閏, 陳演, 張方

(1.合肥工業大學土木與水利工程學院,合肥 230009; 2.復旦大學航空航天系,上海 200433;3.南京航空航天大學機械結構力學及控制國家重點實驗室,南京 210016)

近些年來,空間機械臂代替宇航員執行輔助對接、目標搬運、在軌建設以及捕獲釋放等空間操作任務成為重要發展趨勢[1-2]。然而在空間機械臂執行上述任務[3]時,尤其是在對接、捕獲過程中不可避免地與合作目標或非合作目標發生碰撞[4]。無論主動捕獲或被動碰撞均會引起機械臂瞬時動量急劇變化,機械臂桿彈性振動加劇,軌跡跟蹤精度降低,甚至會導致空間機械臂系統失穩[5]。

空間機械臂碰撞過程的研究受到了廣泛關注。Wee等[6]針對完全剛性臂建立了空間機器人的動力學模型,基于最小碰撞沖擊的目標,研究空間機器人的軌跡優化算法。Yoshikawa等[7]將空間機械臂與目標碰撞物混合體等價為一個彈簧阻尼系統,進一步分析在碰撞過程中系統對于碰撞力的響應。董楸煌等[8]對漂浮基空間機械臂捕獲目標衛星過程及捕獲后混合體系統響應進行動力學和控制分析。賈慶軒等[9]對空間機械臂在軌捕獲問題進行了碰撞分析,分析表明空間機械臂在碰撞過程中存在碰撞力矩可能超過電機承受力矩的問題。

目前關于空間機械臂碰撞過程研究主要以合作目標(衛星捕獲)為研究對象,但對于非合作碰撞物(如太空碎片)與空間機械臂產生碰撞的研究較少。王文龍等[10]對航天器對接、捕獲技術進行綜述,提煉了捕獲非合作目標的八項關鍵技術,給出在該領域開展研究的方向和建議。郭吉豐等[11]探討了空間非合作目標柔性捕獲機構的研究進展,提出一步式消旋法更具有研究前景。然而隨著太空環境逐漸惡化,非合作碰撞物對空間機械臂的干擾不容忽視,尤其是碰撞引起的機械臂系統模型突變,導致空間機械臂的運動狀態與系統參數急劇變化且不可預測,給傳統基于精確模型參數的控制方法帶來嚴重挑戰。另外,空間機械臂的輕量化設計趨勢使得機械臂桿柔性變大,上述碰撞將引起機械臂桿產生較大的彈性振動[12],嚴重影響機械臂軌跡跟蹤和末端定位精度。由于非合作碰撞物的不確定性,如何采用非模型控制方法實現空間機械臂碰撞過程的軌跡跟蹤和振動控制逐漸成為研究熱點。

無模型自適應控制(model-free adaptive control, MFAC)指僅利用受控系統的輸入、輸出數據直接進行控制器的設計和分析,并能實現未知非線性受控系統的參數自適應控制和結構自適應控制的一種控制理論與方法。MFAC算法具有算法簡單,計算量小的優點,但對于步長因子和權重因子的取值較為敏感。對于空間機械臂碰撞過程的模型參數和振動響應急劇變化的情況,傳統無模型控制算法難以達到較優的控制效果,因此設計合適的控制參數的在線自整定策略至關重要。

考慮到空間柔性機械臂碰撞過程模型參數的不確定性,本文建立空間機械臂與非合作碰撞物的碰撞過程動力學模型,并以此為控制對象。提出了模糊策略與無模型自適應控制相結合的模糊-無模型自適應控制(Fuzzy-MFAC)方法,對MFAC算法中步長因子與權重因子進行在線自整定,提高無模型自適應控制性能。

1 空間機械臂動力學模型

將空間機械臂作為研究對象,分別采用拉格朗日方程和牛頓-歐拉法建立空間機械臂和非合作碰撞物的動力學模型,然后基于動量守恒原理對兩者碰撞過程進行分析,根據其相互作用內力關系,聯立兩者的動力學方程,得到機械臂-碰撞物混合系統綜合動力學模型。本章建立碰撞過程的空間機械臂動力學模型,為后文控制方法驗證和控制仿真試驗開展提供模型對象。

1.1 空間機械臂與碰撞物動力學模型

空間機械臂在軌運行與非合作碰撞物發生碰撞的運動過程,如圖1所示。碰撞模型由衛星主體、空間機械臂與非合作碰撞物組成。

圖1 空間機械臂碰撞過程Fig.1 Collision process of space manipulator

為了簡化模型,將空間機械臂與衛星主體相連的臂桿視為剛性臂,著重討論第二根柔性臂桿,并假設關節角轉動和彈性振動與非合作碰撞物的運動均發生在同一個平面上。建立坐標系,如圖2所示。OX0Y0為固定于關節轉軸上的慣性坐標系,OX1Y1為機械臂發生彈性振動時的參考坐標系,始終與柔性機械臂的根部相切。m1,l1,ρ1,E1,I1,A1分別為柔性臂的質量、長度、密度、彈性模量、對中性軸的慣性矩、橫截面積。τ為關節的驅動力矩,θ為柔性臂轉動角位移,ω(x,t)為柔性臂的彈性位移,J1為關節的轉動慣量。m2和J2分別為非合作碰撞物的質量和中心轉動慣量。

1.1.1 柔性機械臂模型

本文假設機械臂為均勻細長桿,等效為Euler-Bernoulli梁[13],在t時刻桿上任意一點P的橫向彈性變形可由假設模態法表示為

(1)

式中:qi(t)與Φi(x)分別為機械臂的第i階模態坐標和模態函數;n為保留的模態項數,此處取n=4。則P點相對于參考坐標系OX1Y1的矢量rp為

rp=x1eX1+ω(x1,t)eY1

(2)

同時eX1與eY1在慣性坐標系OX0Y0下可以寫為

(3)

均對t求導可得

(4)

(6)

機械臂的系統彈性勢能可以表示為

(7)

由于碰撞前機械臂系統與碰撞物之間無相互作用,則根據第二類拉格朗日方程可得柔性機械臂系統的動力學方程為

(8)

式中:M∈5×5為柔性機械臂系統的廣義質量矩陣;H∈5×1為包含科氏力和離心力矢量;K∈5×5為系統剛度矩陣;τ為關節對柔性機械臂的作用力矩。

1.1.2 非合作碰撞物模型

對于非合作碰撞物的剛體系統,可得非合作碰撞物的速度與對應廣義坐標速度的運動學關系為

(9)

式中:vt為非合作碰撞物在慣性坐標系下的線速度;α為非合作碰撞物質心在慣性坐標系下坐標以及姿態角,α=(xt,yt,θt)T;Jt∈2×3為碰撞物的運動Jacobian矩陣。使用拉格朗日方程建立動力學方程為

(10)

式中:Mt∈5×5為非合作碰撞物系統的廣義質量矩陣;Ct∈5×1包含科氏力和離心力矢量。

1.2 碰撞過程機械臂系統動力學分析

在碰撞的瞬時,機械臂與碰撞物同時受到沖擊力作用,則兩個動力學方程改變為

(11)

(12)

式中:Fp為機械臂末端所受到的沖擊力;Fp′為剛體系統所受外力。由牛頓第三定律可知,

Fp=-Fp′

(13)

則有

(14)

(15)

由于碰撞過程非常短暫,則Δt趨向于0,又碰撞力極大。做出假設,碰撞過程中系統廣義坐標并未發生明顯變化而廣義速度瞬時發生了變化,柔性臂系統與碰撞物系統的廣義質量矩陣、Jacobian矩陣均為廣義坐標的函數,則視為未發生明顯變化,令關節對柔性機械臂的作用力τ=0,再進一步積分可得

(16)

式中,左側為有限量,右側因為Δt趨向于0,則積分總和趨向于0,則式(16)可改寫為

(17)

非合作碰撞物與機械臂碰撞后的工況分為兩種情況:機械臂與非合作碰撞物碰撞后吸附;機械臂與碰撞物碰撞后彈開。

1.2.1 空間機械臂與非合作碰撞物碰撞后吸附

由兩者發生碰撞后發生吸附不再分開,則兩個系統速度相同有

(18)

聯立式(15)與(16)有

(19)

由此得到了碰撞過后系統的廣義速度公式,這體現了碰撞過程中沖量對系統運動狀態的影響,后文繼續進行碰撞后的動力學分析。

碰撞過后空間機械臂與非合作碰撞物發生吸附,成為一個整體,因此放在一起進行動力學分析,聯立兩個單獨系統的動力學方程

(21)

消去碰撞力Fp與Fp′,再由非合作碰撞物吸附在機械臂末端可整理得混合體系統動力學方程為

(22)

式中:Mz∈5×5為整體的廣義質量矩陣;Hz∈5×1為交叉耦合矩陣;Kz∈5×5為剛度矩陣;G為作用力位置矩陣,G=(1,0,0,0,0)T。

1.2.2 空間機械臂與非合作碰撞物碰撞后彈開

空間機械臂與非合作碰撞物碰撞后彈開等同于機械臂在某一時刻受到一個瞬時碰撞產生外部沖擊力F,沖擊力矩為τa。令碰撞處產生一個虛位移δXa,機械臂的位置幾何關系為

δXa=Jδq

(23)

根據虛功原理,機器人系統的主動力、主動力矩對作用點的虛位移做功之和為零,即

(24)

聯立式(20)與(21)可得

τa=JTF

(25)

當機器人末端受到外部沖擊作用時,根據靜力平衡條件,機器人系統的碰撞動力學方程為

(26)

2 空間機械臂系統主動控制方法

目前,針對空間機械臂的控制方法大多為基于模型的控制[14],例如力矩補償法、阻抗控制等[15],這些傳統的控制方法需要得到系統精確的模型[16-17],而對于發生碰撞的機械臂系統而言獲取精確的模型參數很難實現。無模型自適應控制因其基于系統輸入、輸出數據進行控制器的設計特點,能夠適應于空間機械臂在太空工作時發生碰撞導致模型參數難以精確描述的情況,由此得到不依賴于柔性機械臂精確參數的MFAC算法是必要的[18]。

2.1 無模型自適應控制

MFAC算法是一種無需建立過程模型的自適應控制方法,即控制系統不考慮模型,也無需精確的碰撞過程定量知識。MFAC算法的優勢在于只需要系統的輸入量與輸出量就可以對控制對象進行有效控制,其控制原理如下

τ(k)=τ(k-1)+

(27)

式中:τ(k)為柔性機械臂的關節驅動力矩;ρ∈(0,1]是力矩步長因子,目的是使控制算法更具有一般性,λ>0是一個力矩權重因子,用來限制控制輸入量的變化;y*(k+1)為期望柔性機械臂關節轉動角速度;y(k)為實際的機械臂關節轉動角速度。

對于非線性系統而言,關節轉動角位移與關節驅動力矩之間必定存在一個非線性關系,令

(28)

則當Δτ≠0時,一定存在一個偏導數ψ(k),且該偏導數滿足

Δy(k+1)=ψ(k)τ(k)

(29)

式中,ψ(k)的估計算法為

(30)

or |Δu(k-1)|≤ε

(31)

由偽偏導數方程和控制律方程可以得到無模型自適應控制器的設計不需要受控模型的具體參數,僅使用受控系統的I/O數據,其算法簡單,計算量小的優點便于實現實時控制。但是由于MFAC算法對于步長因子和權重因子的取值較為敏感,不合適的初值會影響MFAC算法的控制性能。以空間機械臂為研究對象,使機械臂關節運動指令如下

(32)

式中:t0和tb為空間機械臂運動的起始時刻和終止時刻;θ0和θb分別為系統關節的起始位置和終止位置。設定θ0=0,θb=2π,運動時間tb=4 s,總仿真時間為10 s。無模型自適應控制參數ρ與μ對控制效果具有很大影響,為量化分析這種影響,控制器其他參數不變,取力矩步長因子ρ分別為0.1、0.2、0.3,混合體運動軌跡偏差如圖3所示。控制器其他參數不變,取偏導數權重因子μ分別為0.2、0.4、0.6,混合體運動軌跡偏差如圖4所示。

圖3 ρ與運動軌跡偏差關系Fig.3 Relationship between ρ and trajectory deviation

圖4 μ與運動軌跡偏差關系Fig.4 Relationship between μ and trajectory deviation

由此可以驗證合適的初值能夠提高MFAC算法的控制性能。由圖3可得,隨著ρ的增大,運動過程中跟隨誤差變大,末端振動變大,控制效果變差。由圖4可得,隨著μ的增大跟隨效果更優,但是收斂速度變慢,整體控制效果變好。因此,在MFAC算法中實時更新其中的參數是必要的。

2.2 模糊-無模型自適應控制器設計

MFAC算法需要在控制過程中實時更新參數,而模糊策略能夠根據系統的輸入、輸出誤差在線調整控制系統的參數[19]。由此提出的模糊-無模型自適應控制(Fuzzy-MFAC)是在無模型自適應控制的基礎上實時更新無模型自適應控制的參數,實現MFAC算法中的步長因子和權重因子進行實時在線整定。

模糊控制器的輸入為[y*(k+1)-y(k)]與Δy(k),即期望柔性機械臂關節轉動角位移對實際柔性機械臂關節轉動角位移差值E;實際柔性機械臂關節轉動角速度差值Ec。Δμ與Δρ為模糊控制器的輸出,作為無模型控制器的輸入對偏導數權重因子μ與力矩步長因子ρ進行修正,實現無模型控制器參數的實時整定[20]。基于Fuzzy-MAFC算法結構框圖,如圖5所示。

圖5 模糊無模型控制器結構框圖Fig.5 Fuzzy-MAFC controller block diagram

確定模糊化輸入、輸出變量及確定隸屬度函數,則更新MFAC算法的參數為

(33)

式中:μ0與ρ0為柔性機械臂靜止時設置的初值;μ與ρ為修正過后的MFAC算法參數;Δμ與Δρ為模糊控制器實時輸出的參數變化量。

模糊控制器的精度由設計的論域數值決定,本文將根據空間機械臂的結構特點選擇適應的模糊輸入、輸出論域。使模糊控制器輸入變量的論域為[-0.6,-0.4,-0.2,0,0.2,0.4,0.6],輸出變量的論域為[-0.3,-0.2,-0.1,0,0.1,0.2,0.3];模糊子集的設定為[NB,NM,NS,ZO,PS,PM,PB],分別為負大、負中、負小、零、正小、正中、正大。其隸屬度函數如圖6所示。

(a) E、Ec隸屬度函數

(b) Δμ、Δρ隸屬度函數圖6 輸入輸出變量隸屬度函數Fig.6 Membership function of input and output variables

空間機械臂模糊控制規則具體為: 誤差偏大時,需適當縮小誤差,即E過大,則取較大Δμ與Δρ對誤差進行調整;誤差中等時,需適當縮小誤差,并避免縮小時出現過度調整,以確保響應速度,即E中等,則縮小Δμ;誤差偏小時,需保障穩定性,避免狀態突變,即E過小,則取較小Δμ與Δρ對誤差進行調整。由此得到Δμ與Δρ的模糊控制規則,如表1、表2所示。

表1 Δμ的模糊控制規則表Tab.1 Fuzzy control rule table for Δμ

表2 Δρ的模糊控制規則表Tab.2 Fuzzy control rule table for Δρ

去模糊化即清晰化模糊推理所得理論[21],本文采用重心法進行解模糊,求解后得到輸出變量Δμ與Δρ。

(34)

(35)

式中,μi與ρi為各組元素的權重。模糊控制器所得輸出清晰量為Δμ與Δρ,再由式(33)可得對應的力矩步長因子ρ與偏導數權重因子μ。

3 數值分析仿真

對空間機械臂進行關于碰撞問題的仿真分析。將對同一被控對象在不進行任何控制(No Control)、僅使用傳統MFAC算法和使用Fuzzy-MFAC方法三種狀態進行仿真分析,揭示碰撞對于空間機械臂的影響,驗證Fuzzy-MFAC方法的優越性。

仿真時設定空間機械臂與非合作碰撞物A、B的具體參數如表3所示。

表3 機械臂與碰撞物參數Tab.3 Manipulator and collider parameters

由機械臂參數可以分析得到機械臂第一階頻率為20.3 Hz。仿真過程中空間機械臂以式(36)所示軌跡進行運動

(36)

式中:t0和tb為空間機械臂運動的起始時刻和終止時刻;θ0和θb分別為系統關節的起始位置和終止位置。設定θ0=0,θb=π/2,運動時間tb=1 s,總仿真時間為10 s。

3.1 空間機械臂碰撞仿真試驗設計

為討論設計控制器對空間機械臂的控制效果,共設置三種空間機械臂與非合作碰撞物相碰撞的工況進行分析。在碰撞過程中碰撞物A會與機械臂碰撞后彈開,需較大的碰撞速度,設置為3 m/s,而碰撞物B在與機械臂發生碰撞后與機械臂發生吸附,碰撞速度較小,選取1 m/s的速度。

試驗一:0～0.5 s空間機械臂正常工作,在0.5 s時,碰撞物A以3 m/s的速度與空間機械臂垂直碰撞,并與空間機械臂彈開,機械臂繼續工作。

試驗二:0～0.5 s空間機械臂正常工作,在0.5 s時,碰撞物B以1 m/s的速度與空間機械臂垂直碰撞,并與空間機械臂吸附,機械臂繼續工作。

試驗三:工況三設計為較為復雜的情況,整個運動過程空間機械臂共有三種狀態。

階段一:在0～0.5 s時,空間機械臂以式(31)所示軌跡進行正常工作。

階段二:在0.5 s時,碰撞物A以3 m/s的速度與空間機械臂垂直碰撞,并與空間機械臂彈開,在0.5～2.0 s時,機械臂在受到碰撞后繼續運動。

階段三:在2.0 s時,碰撞物B以1 m/s的速度與空間機械臂末端垂直碰撞,吸附于空間機械臂末端。

3.2 碰撞仿真試驗結果分析

試驗一的仿真結果如圖7所示。

(a) 空間機械臂的末端轉角響應

(b) 時域曲線

(d) 控制參數變化曲線圖7 試驗一仿真結果Fig.7 Simulation results of test one

由圖7可知,空間機械臂與碰撞物的碰撞會嚴重影響空間機械臂的正常工作,在未控制情況下機械臂產生了往復運動,而Fuzzy-MFAC方法仿真振幅衰減小于90%的時間為4.2 s,傳統MFAC算法仿真振幅衰減小于90%的時間為5.4 s,振動衰減速度提高了22%。對機械臂關節運動到位后的振動響應進行頻域分析,結果見圖6(c),可以發現Fuzzy-MFAC方法仿真結果相較于傳統MFAC算法仿真結果在第一階模態振動響應幅值降低了48%。

試驗二的仿真結果如圖8所示。