两个人的电影免费视频_国产精品久久久久久久久成人_97视频在线观看播放_久久这里只有精品777_亚洲熟女少妇二三区_4438x8成人网亚洲av_内谢国产内射夫妻免费视频_人妻精品久久久久中国字幕

一種智能超螺旋強魯棒姿態(tài)控制方法與流程

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

技術特征:

1.一種智能超螺旋強魯棒姿態(tài)控制方法,其特征在于步驟如下:

(1)建立撓性飛行器系統(tǒng)模型;

(2)利用步驟(1)得到的所述撓性飛行器系統(tǒng)模型,基于四元數(shù)建立撓性飛行器運動學誤差方程和動力學誤差方程;

(3)根據(jù)步驟(2)中的撓性飛行器運動學誤差方程和動力學誤差方程,建立有限時間非奇異終端滑模面;

(4)根據(jù)步驟(3)中建立的有限時間非奇異終端滑模面,利用BP自適應神經(jīng)網(wǎng)絡結合超螺旋算法確定控制律,實現(xiàn)智能超螺旋強魯棒姿態(tài)控制。

2.根據(jù)權利要求1所述的一種智能超螺旋強魯棒姿態(tài)控制方法,其特征在于:撓性飛行器系統(tǒng)模型,具體為:

<mrow> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>J</mi> <mo>)</mo> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mo>-</mo> <msup> <mi>&Omega;</mi> <mo>&times;</mo> </msup> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>J</mi> <mo>)</mo> <mi>&Omega;</mi> <mo>+</mo> <mi>u</mi> <mo>+</mo> <mover> <mi>d</mi> <mo>~</mo> </mover> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mover> <mi>&eta;</mi> <mo>&CenterDot;&CenterDot;</mo> </mover> <mo>+</mo> <mi>L</mi> <mover> <mi>&eta;</mi> <mo>&CenterDot;</mo> </mover> <mo>+</mo> <mi>K</mi> <mi>&eta;</mi> <mo>+</mo> <mi>&delta;</mi> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>

其中:d∈R3是外部擾動,δ∈R3×3為剛體與撓性附件的耦合矩陣,δT是δ的轉(zhuǎn)置,η為撓性模態(tài),分別為η的一階導數(shù)和二階導數(shù);J0∈R3×3為已知的標稱慣量矩陣,且為正定矩陣;ΔJ為慣量矩陣中的不確定部分,Ω=[Ω123]T是飛行器在本體坐標系中的角速度分量,是Ω的一階導數(shù);×是運算符號,將×用于向量b=[b1,b2,b3]T可得到:

<mrow> <msup> <mi>b</mi> <mo>&times;</mo> </msup> <mo>=</mo> <mfenced open = "[" close = "]"> <mtable> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>b</mi> <mn>3</mn> </msub> </mrow> </mtd> <mtd> <msub> <mi>b</mi> <mn>2</mn> </msub> </mtd> </mtr> <mtr> <mtd> <msub> <mi>b</mi> <mn>3</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mo>-</mo> <msub> <mi>b</mi> <mn>1</mn> </msub> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <msub> <mi>b</mi> <mn>2</mn> </msub> </mrow> </mtd> <mtd> <msub> <mi>b</mi> <mn>1</mn> </msub> </mtd> <mtd> <mn>0</mn> </mtd> </mtr> </mtable> </mfenced> <mo>;</mo> </mrow>

L=diag{2ζiωni,i=1,2,...,N}和分別為阻尼矩陣和剛度矩陣,N為模態(tài)階數(shù),ωni,i=1,2,...,N為振動模態(tài)頻率矩陣,ζi,i=1,2,...,N為振動模態(tài)阻尼比;u是智能超螺旋強魯棒姿態(tài)控制器。

3.根據(jù)權利要求2所述的一種智能超螺旋強魯棒姿態(tài)控制方法,其特征在于:撓性飛行器運動學誤差方程和動力學誤差方程具體為:

撓性飛行器運動學誤差方程:

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mi>e</mi> <mi>v</mi> </msub> <mo>=</mo> <msub> <mi>q</mi> <mrow> <mi>d</mi> <mn>4</mn> </mrow> </msub> <msub> <mi>q</mi> <mi>v</mi> </msub> <mo>-</mo> <msubsup> <mi>q</mi> <mrow> <mi>d</mi> <mi>v</mi> </mrow> <mo>&times;</mo> </msubsup> <msub> <mi>q</mi> <mi>v</mi> </msub> <mo>-</mo> <msub> <mi>q</mi> <mn>4</mn> </msub> <msub> <mi>q</mi> <mrow> <mi>d</mi> <mi>v</mi> </mrow> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mi>e</mi> <mn>4</mn> </msub> <mo>=</mo> <msubsup> <mi>q</mi> <mrow> <mi>d</mi> <mi>v</mi> </mrow> <mi>T</mi> </msubsup> <msub> <mi>q</mi> <mi>v</mi> </msub> <mo>+</mo> <msub> <mi>q</mi> <mn>4</mn> </msub> <msub> <mi>q</mi> <mrow> <mi>d</mi> <mn>4</mn> </mrow> </msub> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>

<mrow> <mtable> <mtr> <mtd> <mrow> <msub> <mover> <mi>e</mi> <mo>&CenterDot;</mo> </mover> <mi>v</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <mrow> <mo>(</mo> <msub> <mi>q</mi> <mn>4</mn> </msub> <msub> <mi>I</mi> <mn>3</mn> </msub> <mo>+</mo> <msubsup> <mi>q</mi> <mi>v</mi> <mo>&times;</mo> </msubsup> <mo>)</mo> </mrow> <msub> <mi>&Omega;</mi> <mi>e</mi> </msub> </mrow> </mtd> <mtd> <mrow> <msub> <mover> <mi>e</mi> <mo>&CenterDot;</mo> </mover> <mn>4</mn> </msub> <mo>=</mo> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msubsup> <mi>q</mi> <mi>v</mi> <mi>T</mi> </msubsup> <msub> <mi>&Omega;</mi> <mi>e</mi> </msub> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>

其中:(ev,e4)∈R3×R,ev=[e1,e2,e3]T是當前飛行器姿態(tài)與期望姿態(tài)的誤差四元數(shù)矢量部分,e4是標量部分,且滿足分別是ev、e4的一階導數(shù);(qv,q4)∈R3×R,qv=[q1,q2,q3]T是描述飛行器姿態(tài)的單位四元數(shù)矢量部分,q4是標量部分,且滿足qdv=[qd1,qd2,qd3]T是描述期望姿態(tài)的單位四元數(shù)矢量部分,qd4是標量部分,且滿足Ωe=Ω-CΩd=[Ωe1Ωe2Ωe3]T=[Ωei]T,i=1,2,3是建立在本體坐標系和目標坐標系之間的角速度誤差向量,Ωd∈R3是期望角速度向量,是轉(zhuǎn)換矩陣,且滿足‖C‖=1,是C的一階導數(shù),I3是3×3單位矩陣;

撓性飛行器動力學誤差方程為:

<mrow> <mtable> <mtr> <mtd> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>J</mi> <mo>)</mo> <msub> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>e</mi> </msub> <mo>=</mo> <mo>-</mo> <msup> <mrow> <mo>(</mo> <msub> <mi>&Omega;</mi> <mi>e</mi> </msub> <mo>+</mo> <msub> <mi>C&Omega;</mi> <mi>d</mi> </msub> <mo>)</mo> </mrow> <mo>&times;</mo> </msup> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>J</mi> <mo>)</mo> <mo>(</mo> <msub> <mi>&Omega;</mi> <mi>e</mi> </msub> <mo>+</mo> <msub> <mi>C&Omega;</mi> <mi>d</mi> </msub> <mo>)</mo> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>+</mo> <mrow> <mo>(</mo> <msub> <mi>J</mi> <mn>0</mn> </msub> <mo>+</mo> <mi>&Delta;</mi> <mi>J</mi> <mo>)</mo> </mrow> <mrow> <mo>(</mo> <msubsup> <mi>&Omega;</mi> <mi>e</mi> <mo>&times;</mo> </msubsup> <msub> <mi>C&Omega;</mi> <mi>d</mi> </msub> <mo>-</mo> <mi>C</mi> <msub> <mover> <mi>&Omega;</mi> <mo>&CenterDot;</mo> </mover> <mi>d</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mi>u</mi> <mo>+</mo> <mover> <mi>d</mi> <mo>~</mo> </mover> </mrow> </mtd> </mtr> </mtable> <mo>;</mo> </mrow>

其中,是Ωe的一階導數(shù),Ωd是期望角速度,是Ωd的一階導數(shù)。

4.根據(jù)權利要求3所述的一種智能超螺旋強魯棒姿態(tài)控制方法,其特征在于:有限時間非奇異終端滑模面S,具體為:

S=Ωe+K1ev+K2Sc;

其中S=[S1,S2,S3]T∈R3,Kj=diag{kji}>0,i=1,2,3,j=1,2,diag(a1,a2,…,an)表示對角線元素為a1,a2,…,an的對角矩陣;且定義Sc=[Sc1,Sc2,Sc3]T如下:

其中r1,r2是正奇數(shù),且0<r<1,l1i、l2i、εi,i=1,2,3、ι1、ι2是設計參數(shù),sign(a)是符號函數(shù),定義如下:

<mrow> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mi>a</mi> <mo>)</mo> </mrow> <mo>=</mo> <mfenced open = "{" close = ""> <mtable> <mtr> <mtd> <mn>1</mn> </mtd> <mtd> <mrow> <mi>a</mi> <mo>&gt;</mo> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mn>0</mn> </mtd> <mtd> <mrow> <mi>a</mi> <mo>=</mo> <mn>0</mn> </mrow> </mtd> </mtr> <mtr> <mtd> <mrow> <mo>-</mo> <mn>1</mn> </mrow> </mtd> <mtd> <mrow> <mi>a</mi> <mo>&lt;</mo> <mn>0</mn> </mrow> </mtd> </mtr> </mtable> </mfenced> <mo>.</mo> </mrow>

5.根據(jù)權利要求4所述的一種智能超螺旋強魯棒姿態(tài)控制方法,其特征在于:智能超螺旋強魯棒姿態(tài)控制器具體為:

u=J0[u1,u2,u3]T;

<mrow> <msub> <mi>u</mi> <mi>i</mi> </msub> <mo>=</mo> <mo>-</mo> <msub> <mi>&lambda;</mi> <mn>1</mn> </msub> <msub> <mi>&Gamma;</mi> <mrow> <mi>o</mi> <mi>i</mi> </mrow> </msub> <mo>-</mo> <msubsup> <mo>&Integral;</mo> <mn>0</mn> <mi>t</mi> </msubsup> <msub> <mi>&lambda;</mi> <mn>2</mn> </msub> <msub> <mi>&theta;</mi> <mi>i</mi> </msub> <mi>d</mi> <mi>t</mi> <mo>;</mo> </mrow>

其中:

<mrow> <msub> <mi>&Gamma;</mi> <mrow> <mi>o</mi> <mi>i</mi> </mrow> </msub> <mo>=</mo> <msup> <mrow> <mo>|</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>;</mo> </mrow>

<mrow> <msub> <mi>&theta;</mi> <mi>i</mi> </msub> <mo>=</mo> <msub> <mi>&sigma;</mi> <mi>i</mi> </msub> <msub> <mi>&Gamma;</mi> <mrow> <mi>o</mi> <mi>i</mi> </mrow> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <mfrac> <mn>3</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>|</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> </msup> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>;</mo> </mrow>

<mrow> <msub> <mi>&sigma;</mi> <mi>i</mi> </msub> <mo>=</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> <msup> <mrow> <mo>|</mo> <msub> <mi>S</mi> <mi>i</mi> </msub> <mo>|</mo> </mrow> <mrow> <mo>-</mo> <mfrac> <mn>1</mn> <mn>2</mn> </mfrac> </mrow> </msup> <mo>+</mo> <mn>1</mn> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>;</mo> </mrow>

u的離散形式為:

<mrow> <mi>u</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mo>-</mo> <msub> <mi>&lambda;</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msub> <mi>&Gamma;</mi> <mrow> <mi>o</mi> <mi>i</mi> </mrow> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>-</mo> <munderover> <mo>&Sigma;</mo> <mrow> <mi>j</mi> <mo>=</mo> <mn>0</mn> </mrow> <mi>k</mi> </munderover> <msub> <mi>&lambda;</mi> <mn>2</mn> </msub> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> <msub> <mi>&theta;</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>j</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>;</mo> </mrow>

其中λ1(k)、λ2(j),j=0,1,...,k為相應增益系數(shù),u(k)為第k次采樣時刻的輸入值;u(k)的增量是:

Δu(k)=u(k)-u(k-1)=-λ1(k)(Γoi(k)-Γoi(k-1))-λ2(k)θi(k),i=1,2,3;

神經(jīng)元輸出為:

<mrow> <mi>u</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <mi>u</mi> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>+</mo> <msub> <mi>&lambda;</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <munderover> <mo>&Sigma;</mo> <mrow> <mi>i</mi> <mo>=</mo> <mn>1</mn> </mrow> <mn>2</mn> </munderover> <msub> <mi>w</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <msub> <mi>x</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>;</mo> </mrow>

其中,x1(k)=Γoi(k)-Γoi(k-1),x2(k)=θi(k),i=1,2,3分別對應神經(jīng)元的兩個輸入,wi(k)對應第i個輸入所對應的連接權值,λi(k)=[λi1i2i3],i=1,2為神經(jīng)元增益。

6.根據(jù)權利要求5所述的一種智能超螺旋強魯棒姿態(tài)控制方法,其特征在于:所述神經(jīng)元增益λi(k)的自適應律為:

其中:

<mrow> <msub> <mi>T</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> <mo>=</mo> <msub> <mi>T</mi> <mi>v</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>-</mo> <mn>1</mn> <mo>)</mo> </mrow> <mo>+</mo> <mi>H</mi> <mo>&CenterDot;</mo> <mi>s</mi> <mi>i</mi> <mi>g</mi> <mi>n</mi> <mrow> <mo>(</mo> <mo>|</mo> <mrow> <msub> <mi>&Delta;S</mi> <mi>i</mi> </msub> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> <mo>|</mo> <mo>-</mo> <msub> <mi>T</mi> <mi>v</mi> </msub> <mo>(</mo> <mrow> <mi>k</mi> <mo>-</mo> <mn>1</mn> </mrow> <mo>)</mo> <mo>|</mo> <mrow> <msubsup> <mi>&Delta;S</mi> <mi>i</mi> <mn>2</mn> </msubsup> <mrow> <mo>(</mo> <mi>k</mi> <mo>)</mo> </mrow> </mrow> <mo>|</mo> <mo>)</mo> </mrow> <mo>,</mo> <mi>i</mi> <mo>=</mo> <mn>1</mn> <mo>,</mo> <mn>2</mn> <mo>,</mo> <mn>3</mn> <mo>;</mo> </mrow>

0.025≤c≤0.05,0.05≤H≤0.1,|·|表示取絕對值,Si(k),i=1,2,3表示第k步的滑模面值,Si(k-1),i=1,2,3表示第k-1步的滑模面值,ΔSi(k)=Si(k)-Si(k-1),i=1,2,3,γi、κi、νi是正實數(shù)。

當前第2頁1 2 3 
網(wǎng)友詢問留言 已有0條留言
  • 還沒有人留言評論。精彩留言會獲得點贊!
1
建宁县| 盐津县| 浦北县| 清流县| 吕梁市| 炎陵县| 田林县| 丹阳市| 罗平县| 遵义市| 焦作市| 安阳县| 枣强县| 乐安县| 济源市| 谢通门县| 乡宁县| 息烽县| 扬州市| 维西| 万源市| 肃北| 漳平市| 靖边县| 济源市| 阳东县| 施甸县| 叶城县| 芷江| 永修县| 双流县| 郧西县| 扎赉特旗| 定州市| 咸阳市| 密山市| 临沧市| 东明县| 富平县| 桐乡市| 纳雍县|