1.一種針對仿生撲翼飛行機器人的控制方法,其特征在于,包括:
對所述仿生撲翼飛行機器人進行運動學和動力學分析,建立拉格朗日型模型;
基于所述拉格朗日型模型,設計帶有擾動觀測器的基于模型的姿態控制器;
基于設計的帶有擾動觀測器的基于模型的姿態控制器,設計帶有擾動觀測器的神經網絡全狀態反饋姿態控制器;
基于所述仿生撲翼飛行機器人的位置控制模型,設計帶有擾動觀測器的基于模型的位置控制器;
根據設計的帶有擾動觀測器的基于模型的姿態控制器、神經網絡全狀態反饋姿態控制器及基于模型的位置控制器,對所述仿生撲翼飛行機器人的姿態和位置進行軌跡跟蹤控制。
2.根據權利要求1所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述拉格朗日型模型表示為:
其中,Dr(qr)、表示矩陣,Dr(qr)=IpT,
Ip表示轉動慣量矩陣,T表示由身體坐標系到慣性坐標系的坐標轉換矩陣,
表示T對時間t的一階導數,L(t)表示一個使等式
成立的矩陣,qr是qr(t)的簡寫形式,qr(t)表示系統姿態狀態矩陣,
是
的簡寫形式,
表示qr(t)對時間t的一階導數,
表示qr(t)對時間t的二階導數,τr是τr(t)的簡寫形式,τr(t)表示仿生撲翼飛行機器人姿態控制輸入。
3.根據權利要求2所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述帶有擾動觀測器的基于模型的姿態控制器表示為:
er1=xr1-xr1d
er2=xr2-αr1
er3=dr(t)-Φ(er2)
其中,τr1表示姿態控制器,xr1=qr,xr1表示姿態狀態矩陣qr(t),xr2表示表示qr(t)對時間t的一階導數,xr1d是xr1d(t)的簡寫形式,xr1d(t)=[θ1d(t),θ2d(t),θ3d(t)]T,θ1d(t),θ2d(t),θ3d(t)分別是身體坐標系中的三個歐拉角要跟蹤的期望角度,Kr2表示控制增益,er1、er2表示狀態偏差,
表示系統擾動dr(t)的估計值,
表示虛擬速度跟蹤軌跡αr1對時間t的一階導數,er3為輔助函數,
為er3的估計值,Φ(er2)關于er2的函數,
為
關于時間t的一階導數,K(er2)為Φ(er2)關于er2的導數,
表示Dr(xr1)的逆矩陣。
4.根據權利要求1所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述帶有擾動觀測器的神經網絡全狀態反饋姿態控制器表示為:
er1=xr1-xr1d
er2=xr2-αr1
er3=dr(t)-Φ(er2)
其中,τr2表示神經網絡全狀態反饋姿態控制器,xr1=qr,xr1表示姿態狀態矩陣,xr2表示表示姿態狀態矩陣對時間t的一階導數,xr1d是xr1d(t)的簡寫形式,xr1d(t)=[θ1d(t),θ2d(t),θ3d(t)]T,θ1d(t),θ2d(t),θ3d(t)分別是身體坐標系中的三個歐拉角要跟蹤的期望角度,Kr2表示控制增益,er1、er2表示狀態偏差,
表示系統擾動dr(t)的估計值,C0(xr1,xr2)表示Cr(xr1,xr2)的虛擬部分,αr1表示虛擬速度跟蹤軌跡,
表示神經網絡的權重估計值,
表示
的轉置,S(Z)表示神經網絡基函數,Z表示神經網絡的輸入,er3為輔助函數,
為er3的估計值,Φ(er2)關于er2的函數,
為
關于時間t的一階導數,K(er2)為Φ(er2)關于er2的導數,
表示Dr(xr1)的逆矩陣,
為表示Dr(xr1)虛擬部分的逆矩陣。
5.根據權利要求1所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述位置控制模型表示為:
其中,Dt、Gt表示矩陣,RIB(qr(t))表示坐標系變換陣,qr(t)表示系統姿態狀態矩陣,是
的簡寫形式,
表示qr(t)對時間t的二階導數,τt(t)表示位置控制器,dt(t)表示系統擾動。
6.根據權利要求5所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述帶有擾動觀測器的基于模型的位置控制器表示為:
et1=xt1-xt1d
et2=xt2-αt1
其中,τt為τt(t)的簡寫形式,τt表示位置控制器,qr是qr(t)的簡寫形式,(RIB(qr))-1表示RIB(qr(t))的逆矩陣,xt1=qt,xt1、qt表示位置變換狀態矩陣,xt2、
表示位置變換狀態矩陣qt對時間t的一階導數,xt1d(t)=[xd(t),yd(t),zd(t)]T,xd(t),yd(t),zd(t)分別表示大地坐標系x、y、z方向上要跟蹤的期望位置軌跡,et1、et2表示位置偏差,Kd、Kt4表示控制增益,
表示系統擾動dt(t)的估計值,
表示虛擬速度跟蹤軌跡αt1對時間t的一階導數。
7.根據權利要求3所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:
采用李雅普諾夫直接法,分析加入所述帶有擾動觀測器的基于模型的姿態控制器后閉環系統的穩定性以及系統狀態的有界性,構造的李雅普諾夫函數表示為:
其中,V1表示構造的李雅普諾夫函數,表示
與dr(t)之間的誤差,
分別表示er1、er2、
的轉置。
8.根據權利要求7所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:
若er1、er2、都有界,則加入所述帶有擾動觀測器的基于模型的姿態控制器后閉環系統的系統狀態滿足有界性。
9.根據權利要求4所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:
采用李雅普諾夫直接法,分析加入所述帶有擾動觀測器的神經網絡全狀態反饋姿態控制器后閉環系統的穩定性以及系統狀態的有界性,構造的李雅普諾夫函數表示為:
其中,V2表示構造的李雅普諾夫函數,D0(xr1)表示Dr(xr1)的虛擬部分,表示
與dr(t)之間的誤差,
表示神經網絡的權重誤差,
表示
的轉置,
表示預設的常數矩陣的逆矩陣,i=1,2,3,n表示矩陣中元素的數目,
分別表示er1、er2、
的轉置。
10.根據權利要求6所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:
采用李雅普諾夫直接法,分析加入所述帶有擾動觀測器的基于模型的位置控制器后閉環系統的穩定性以及系統狀態的有界性,構造的李雅普諾夫函數表示為:
其中,V3表示構造的李雅普諾夫函數,表示
與dt(t)之間的誤差,
分別表示et1、et2、
的轉置。