麻豆精品无码国产在线播放,国产亚洲精品成人AA片新蒲金,国模无码大尺度一区二区三区,神马免费午夜福利剧场

一種針對仿生撲翼飛行機器人的控制方法與流程

文檔序號:12062597閱讀:來源:國知局

技術特征:

1.一種針對仿生撲翼飛行機器人的控制方法,其特征在于,包括:

對所述仿生撲翼飛行機器人進行運動學和動力學分析,建立拉格朗日型模型;

基于所述拉格朗日型模型,設計帶有擾動觀測器的基于模型的姿態控制器;

基于設計的帶有擾動觀測器的基于模型的姿態控制器,設計帶有擾動觀測器的神經網絡全狀態反饋姿態控制器;

基于所述仿生撲翼飛行機器人的位置控制模型,設計帶有擾動觀測器的基于模型的位置控制器;

根據設計的帶有擾動觀測器的基于模型的姿態控制器、神經網絡全狀態反饋姿態控制器及基于模型的位置控制器,對所述仿生撲翼飛行機器人的姿態和位置進行軌跡跟蹤控制。

2.根據權利要求1所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述拉格朗日型模型表示為:

<mrow> <msub> <mi>D</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>q</mi> <mi>r</mi> </msub> <mo>)</mo> </mrow> <msub> <mover> <mi>q</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>q</mi> <mi>r</mi> </msub> <mo>,</mo> <msub> <mover> <mi>q</mi> <mo>&CenterDot;</mo> </mover> <mi>r</mi> </msub> <mo>)</mo> </mrow> <msub> <mover> <mi>q</mi> <mo>&CenterDot;</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>&tau;</mi> <mi>r</mi> </msub> </mrow>

其中,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所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述帶有擾動觀測器的基于模型的姿態控制器表示為:

<mrow> <msub> <mi>&tau;</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>K</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>,</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>+</mo> <msub> <mi>D</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mover> <mi>&alpha;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> </mrow>

er1=xr1-xr1d

er2=xr2r1

er3=dr(t)-Φ(er2)

<mrow> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mover> <mi>e</mi> <mo>^</mo> </mover> <mrow> <mi>r</mi> <mn>3</mn> </mrow> </msub> <mo>+</mo> <mi>&Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <mover> <mover> <mi>e</mi> <mo>^</mo> </mover> <mo>&CenterDot;</mo> </mover> <mrow> <mi>r</mi> <mn>3</mn> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mi>K</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> <msubsup> <mi>D</mi> <mi>r</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>)</mo> </mrow> <mo>&lsqb;</mo> <msub> <mi>&tau;</mi> <mi>r</mi> </msub> <mo>-</mo> <msub> <mi>C</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>,</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>&rsqb;</mo> <mo>+</mo> <mi>K</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mover> <mi>&alpha;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> </mrow>

其中,τr1表示姿態控制器,xr1=qrxr1表示姿態狀態矩陣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所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述帶有擾動觀測器的神經網絡全狀態反饋姿態控制器表示為:

<mrow> <msub> <mi>&tau;</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>K</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>C</mi> <mn>0</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>,</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mi>&alpha;</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <msup> <mover> <mi>W</mi> <mo>^</mo> </mover> <mi>T</mi> </msup> <mi>S</mi> <mrow> <mo>(</mo> <mi>Z</mi> <mo>)</mo> </mrow> </mrow>

er1=xr1-xr1d

er2=xr2r1

er3=dr(t)-Φ(er2)

<mrow> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mover> <mi>e</mi> <mo>^</mo> </mover> <mrow> <mi>r</mi> <mn>3</mn> </mrow> </msub> <mo>+</mo> <mi>&Phi;</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> </mrow>

<mrow> <msub> <mover> <mover> <mi>e</mi> <mo>^</mo> </mover> <mo>&CenterDot;</mo> </mover> <mrow> <mi>r</mi> <mn>3</mn> </mrow> </msub> <mo>=</mo> <mo>-</mo> <mi>K</mi> <mrow> <mo>(</mo> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>)</mo> </mrow> <msubsup> <mi>D</mi> <mn>0</mn> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msub> <mi>&tau;</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>C</mi> <mn>0</mn> </msub> <mo>(</mo> <mrow> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>,</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> </mrow> <mo>)</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>+</mo> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>r</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> </mrow>

其中,τr2表示神經網絡全狀態反饋姿態控制器,xr1=qrxr1表示姿態狀態矩陣,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所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述位置控制模型表示為:

<mrow> <msub> <mi>D</mi> <mi>t</mi> </msub> <msub> <mover> <mi>q</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mi>t</mi> </msub> <mo>+</mo> <msub> <mi>G</mi> <mi>t</mi> </msub> <mo>=</mo> <msup> <mi>R</mi> <mrow> <mi>I</mi> <mi>B</mi> </mrow> </msup> <mrow> <mo>(</mo> <msub> <mi>q</mi> <mi>r</mi> </msub> <mo>(</mo> <mi>t</mi> <mo>)</mo> <mo>)</mo> </mrow> <msub> <mi>&tau;</mi> <mi>t</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>d</mi> <mi>t</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow>

其中,Dt、Gt表示矩陣,RIB(qr(t))表示坐標系變換陣,qr(t)表示系統姿態狀態矩陣,的簡寫形式,表示qr(t)對時間t的二階導數,τt(t)表示位置控制器,dt(t)表示系統擾動。

6.根據權利要求5所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述帶有擾動觀測器的基于模型的位置控制器表示為:

<mrow> <msub> <mi>&tau;</mi> <mi>t</mi> </msub> <mo>=</mo> <msup> <mrow> <mo>(</mo> <msup> <mi>R</mi> <mrow> <mi>I</mi> <mi>B</mi> </mrow> </msup> <mo>(</mo> <msub> <mi>q</mi> <mi>r</mi> </msub> <mo>)</mo> <mo>)</mo> </mrow> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msup> <mo>&lsqb;</mo> <mo>-</mo> <msub> <mi>e</mi> <mrow> <mi>t</mi> <mn>1</mn> </mrow> </msub> <mo>-</mo> <msub> <mi>K</mi> <mrow> <mi>t</mi> <mn>4</mn> </mrow> </msub> <msub> <mi>e</mi> <mrow> <mi>t</mi> <mn>2</mn> </mrow> </msub> <mo>-</mo> <msub> <mover> <mi>d</mi> <mo>^</mo> </mover> <mi>t</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>G</mi> <mi>t</mi> </msub> <mo>+</mo> <msub> <mi>D</mi> <mi>t</mi> </msub> <msub> <mover> <mi>&alpha;</mi> <mo>&CenterDot;</mo> </mover> <mrow> <mi>t</mi> <mn>1</mn> </mrow> </msub> <mo>&rsqb;</mo> </mrow>

et1=xt1-xt1d

et2=xt2t1

其中,τt為τt(t)的簡寫形式,τt表示位置控制器,qr是qr(t)的簡寫形式,(RIB(qr))-1表示RIB(qr(t))的逆矩陣,xt1=qtxt1、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所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:

采用李雅普諾夫直接法,分析加入所述帶有擾動觀測器的基于模型的姿態控制器后閉環系統的穩定性以及系統狀態的有界性,構造的李雅普諾夫函數表示為:

<mrow> <msub> <mi>V</mi> <mn>1</mn> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mi>e</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> <mi>T</mi> </msubsup> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> <mi>T</mi> </msubsup> <msub> <mi>D</mi> <mi>r</mi> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mover> <mi>d</mi> <mo>~</mo> </mover> <mi>r</mi> <mi>T</mi> </msubsup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <msub> <mover> <mi>d</mi> <mo>~</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow>

其中,V1表示構造的李雅普諾夫函數,表示與dr(t)之間的誤差,分別表示er1、er2的轉置。

8.根據權利要求7所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:

若er1、er2都有界,則加入所述帶有擾動觀測器的基于模型的姿態控制器后閉環系統的系統狀態滿足有界性。

9.根據權利要求4所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:

采用李雅普諾夫直接法,分析加入所述帶有擾動觀測器的神經網絡全狀態反饋姿態控制器后閉環系統的穩定性以及系統狀態的有界性,構造的李雅普諾夫函數表示為:

<mrow> <msub> <mi>V</mi> <mn>2</mn> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mi>e</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> <mi>T</mi> </msubsup> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> <mi>T</mi> </msubsup> <msub> <mi>D</mi> <mn>0</mn> </msub> <mrow> <mo>(</mo> <msub> <mi>x</mi> <mrow> <mi>r</mi> <mn>1</mn> </mrow> </msub> <mo>)</mo> </mrow> <msub> <mi>e</mi> <mrow> <mi>r</mi> <mn>2</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msub> <mover> <mi>d</mi> <mo>~</mo> </mover> <mi>r</mi> </msub> <msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>T</mi> </msup> <msub> <mover> <mi>d</mi> <mo>~</mo> </mover> <mi>r</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mi>n</mi> </munderover> <msubsup> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>i</mi> <mi>T</mi> </msubsup> <msubsup> <mi>&Gamma;</mi> <mi>i</mi> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </msubsup> <msub> <mover> <mi>W</mi> <mo>~</mo> </mover> <mi>i</mi> </msub> </mrow>

其中,V2表示構造的李雅普諾夫函數,D0(xr1)表示Dr(xr1)的虛擬部分,表示與dr(t)之間的誤差,表示神經網絡的權重誤差,表示的轉置,表示預設的常數矩陣的逆矩陣,i=1,2,3,n表示矩陣中元素的數目,分別表示er1、er2的轉置。

10.根據權利要求6所述的針對仿生撲翼飛行機器人的控制方法,其特征在于,所述方法還包括:

采用李雅普諾夫直接法,分析加入所述帶有擾動觀測器的基于模型的位置控制器后閉環系統的穩定性以及系統狀態的有界性,構造的李雅普諾夫函數表示為:

<mrow> <msub> <mi>V</mi> <mn>3</mn> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mi>e</mi> <mrow> <mi>t</mi> <mn>1</mn> </mrow> <mi>T</mi> </msubsup> <msub> <mi>e</mi> <mrow> <mi>t</mi> <mn>1</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mi>e</mi> <mrow> <mi>t</mi> <mn>2</mn> </mrow> <mi>T</mi> </msubsup> <msub> <mi>D</mi> <mi>t</mi> </msub> <msub> <mi>e</mi> <mrow> <mi>t</mi> <mn>2</mn> </mrow> </msub> <mo>+</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msub> <mover> <mi>d</mi> <mo>~</mo> </mover> <mi>t</mi> </msub> <msup> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> <mi>T</mi> </msup> <msub> <mover> <mi>d</mi> <mo>~</mo> </mover> <mi>t</mi> </msub> <mrow> <mo>(</mo> <mi>t</mi> <mo>)</mo> </mrow> </mrow>

其中,V3表示構造的李雅普諾夫函數,表示與dt(t)之間的誤差,分別表示et1、et2的轉置。

當前第2頁1 2 3 
網友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1
主站蜘蛛池模板: 宜兰市| 曲阳县| 伽师县| 丰镇市| 建湖县| 绥化市| 拜城县| 石泉县| 怀远县| 板桥市| 安平县| 绵阳市| 连南| 营山县| 且末县| 句容市| 鹤峰县| 左云县| 修武县| 开阳县| 仲巴县| 娄烦县| 黑山县| 拜泉县| 响水县| 四平市| 平山县| 屯留县| 墨玉县| 鸡东县| 太保市| 临夏县| 丹东市| 河北区| 阿拉善左旗| 福贡县| 庆阳市| 大同县| 柞水县| 电白县| 葫芦岛市|