技術特征:1.一種存在外界擾動的柔性機械臂擾動觀測控制方法,其特征在于包括以下步驟:
步驟一、n自由度柔性機械臂的動力學模型為:
其中,M為正定對稱慣性矩陣,
是與哥氏力和向心力相關的項,D1、D2為阻尼矩陣,K2為剛度矩陣,u為關節輸入力矩,
[θT,δT]T=[θ1…θn…δ1,1…δ1,m…δn,1…δn,m]T是由機械臂關節角和柔性模態組成的廣義矢量,θi為第i個關節角變量,δi,j是第i個連桿的第j個模態變量,fd為由關節摩擦以及柔性連桿的振動阻尼引起的外部干擾項;
定義
式(1)進一步寫為:
針對系統具有的非最小相位特性,進行輸出重定義:
其中,φi,j是第i個連桿的第j個模態形函數,li是第i個連桿的長度,α=[α1,α2,…αn]T為跟輸出重定義有關的參數向量,-1<αi<1與輸出重定義有關具體參數由設計者選定;式(3)寫成矩陣形式為:
y=θ+Cδ (4)
其中,![]()
步驟二、結合式(2)-(4)得到:
其中,
B=H11+CH21,B0為通過系統標稱信息所得標稱值,即B=B0+ΔB,d=(H11+CH21)fd;
定義
式(5)改寫為:
輸入輸出子系統為:
內部動態子系統為:
其中,uex為輸入輸出子系統的控制輸入,uin為內動態子系統的控制輸入,
F(θ,δ)=H21;
步驟三、定義誤差信號e1=μ1-yr,yr為關節角期望值,設計虛擬控制量;
其中,k1為正定對稱非奇異矩陣,其具體參數由設計者給定;
定義誤差信號e2=μ2-u2d,定義
設計擾動觀測器為:
其中,kd為正數其具體參數由設計者給定,
為中間變量,具體形式如下:
設計控制器:
其中,k2為正定對稱非奇異矩陣由設計者給定;
針對內動態子系統,采用狀態反饋控制器:
控制增益kδ和
采用極點配置得到;
機械臂系統控制器輸入為
u=uex+uin
步驟四、根據得到的關節輸入力矩u,返回柔性機械臂動力學模型(2)和輸出重定義(3),對關節角進行跟蹤控制。