第四章航行器動力學(xué)(Dynamics).

1、Dyn amics)第四章航行器動力學(xué)4.1剛體動力學(xué)牛頓-歐拉表達式 牛頓第二定律:歐拉第一和第二定理:PJ mvcmchj J 乃4.1剛體動力學(xué)假設(shè)：(1) 航行器是個剛體；(2) NED坐標(biāo)系是慣性坐標(biāo)系；第一個假設(shè)可以不用考慮航行器各質(zhì)量元素之間的相互作用 力；第二個假設(shè)可以不用考慮由于地球自轉(zhuǎn)而產(chǎn)生的力，這是因為地球自轉(zhuǎn)的角速度為：L 7.2921 10 5(rad /s)地球自轉(zhuǎn)產(chǎn)生的力相對于水動力來說可以忽略4.1.1 平移運動重心的速度:vj V。= coiba? COAibg+co+ ieennbnb+ cob；nb投影到n系:nVcRn(vbnb投影到b系：4.1.1平移

2、運動對上式求導(dǎo)：v;=甩& ib ； * 叮）Rn（vbb;）=Rn（v; i；b：）偎（;用;：） =RbVO S（ l：b）gb S（ QI S2（ Q訂根據(jù)歐拉第一定理：mVc fcNED近似為慣性系，mV： = T =尺 fcbmV： S（ l；b）gb S（ ： S2（ 3；= L fJ4.1.1平移運動mVbIbrbbVbb(nbgnbonbInb onbb nb如果b系的原點選在重心，貝Urgb = 0 00)T , fb b fc ,VobVc則:mV； S( :b)v； = fcb4.1.2旋轉(zhuǎn)運動歐拉第二定理：i 441% = me,!% = lc ib根據(jù)前面的假設(shè)，可以

3、得到|。吧 s（陽|。bb ms（gb）vb ms（gb）s（初）* mb式中：lzxlzylzJlzxlzylzJ1 yx1 xyixzlyz,lolzxlzylzJ4.1.2旋轉(zhuǎn)運動lx =V(y2Z2)mdV;lxy =VxymdV1廠V(X2Z2)mdV；lxz =VXZmdVlz =V(x2y2)mdV; lyz =V yzmdV如果b系的原點選在重心，即rgb 000Tnbs( ；b)lnbbmeyxzxzymdVmdVmdVyxzxzy4.1.2旋轉(zhuǎn)運動平行軸定理：相對于任意原點0的慣性矩陣可以表示為：I。= lc mS（r：）= J m（rrT 巾3 3）4.1.3剛體動力學(xué)方

4、程mV： S(加叮 s( bb)v； s2( bb)Q =lo l；b S( ；b)lo ；bmS(r：)V：mS(r；)S(=代mu _ vr + 甘耳+ r2)十y/pq r) + zg(pr + ?)=X加十 _+ iir-yg(j + p?) + gg(g廠-p) + xg(qp + r)=YniaV - uq + vp zs(p- +g】)+xs(tp - q) +yg(vq + p)=ZIxp + (A _ A )?r - (r + pqK + (r2 _ q* + (pr- q)I+ tnys(Sv _ uq + vp) _ Zg(v _ up + )=KIyq + (A _ I

5、Jrp -(p + qr)I + (p2 _ r2)! + (qp r)I+ wzg(w 一 vr + uty) 一 Xg(w - uq + ip) = Mhr + (Iy- IJpq _ (? +_K) + bq -p)I+ nixg(v 一 + ur) -yg(u 一 “ + mjj) = N4.1.3剛體動力學(xué)方程w p q r1矩陣向量形式：M rM CRB(V NRB，VU V特性:M RB二 MRB0,MRB。6 6mis 3- mS(rgb)M RB b_mS(rg)Io11m1000mzgmyg0m0_mzg0mxg010mmyg-mxg00mzgmygIx-Ixy Ixzmz

6、g0-叫- I yxIy-Iyz_mygmxg0-Izx-IzyIzTM11 MdMM0m 21 m 22其中：M21M12。則科里奧利一向心矩陣為反對稱矩陣，并可表4.1.3剛體動力學(xué)方程定理：令M為6 6的系統(tǒng)慣性矩陣:示為:03 3IC(v) =S( M11V1 M 12V2 )S(M11v/ M12v2)S(M21vM 22v2)式中，Vi =u v w】,V2 = p4.1.3剛體動力學(xué)方程特性（剛體科里奧利一向心矩陣） 剛體科里奧利一向心矩陣 CRB（V）總可以表示為反對稱矩陣，即Crb（v） =CRB（V）, v 0將M RB代入得：crb(v)03 3mS(Vi)- mS(S(

7、V2)FibbimS(vj mS(S(V2)rg)mS(S(vJrg) - S(IV2)4.1.3剛體動力學(xué)方程剛體六自由度運動方程的簡化:(1)原點0與重心一致：Q = 1 0 00TIIy1=1=1IcoyxyIIzxzyIxz11 yz, M rb =IzmI3 303 31 103 3I c進一步簡化：lc = 1。 = diag lx IyIz4.1.3剛體動力學(xué)方程剛體六自由度運動方程的簡化：(2)旋轉(zhuǎn)載體系的坐標(biāo)軸，使得I。為對角矩陣。求I。的特征值i(i T,2,3)：32det( l3 3 I。)=a2aja。= 0求模態(tài)矩陣H = 1十 h2 h3:Cilr Io)hr 0

8、；(i= 1,2,3)將坐標(biāo)系(xb,yb,zb)旋轉(zhuǎn)到新坐標(biāo)系，它的單位向量為4.1.3剛體動力學(xué)方程剛體六自由度運動方程的簡化:(2)旋轉(zhuǎn)載體系的坐標(biāo)軸，使得I。為對角矩陣Hex；e廠 HeyHezK;M ;N;則新的慣性矩陣I。= diag i 23m(dvwq) =x;(lzly)qr=m(Vwpur) =y;I yd(lxlz)rp=m(Wuqvp) =z;lz“(lylx)pq=4.1.3剛體動力學(xué)方程剛體六自由度運動方程的簡化:(3)平移原點0使得I。為對角陣。diaglx Iy Iz由平行軸定理：I egx-I eg xy-I eg xzIomS2（gb） =egI yxI e

9、gI yegI yzegI zxegIzyegI zlc對角元素必須滿足:4.1.3剛體動力學(xué)方程I 0為對角陣。剛體六自由度運動方程的簡化:(3)平移原點0使得IxlyIzI egXI eg1 yI egzm(y； m(x； + m(x； +Z2)Z2)y；)選擇Xg,yg,Zg，使得miygx：ml：gzgI cg egxy xzI eg I egxy yzI cg egxz yz4.1.3剛體動力學(xué)方程剛體六自由度運動方程的簡化：(3)平移原點0使得Io為對角陣。此時剛體動力學(xué)方程為：m_d vr wqXg(q2r2)yg(pqd)zjprd)=Xm V wp uryg(r2p2)(qr

10、p)xg(qp*)=Ym_Wuq vp-Zg(p2q2)Xg(rpd)yg(rqp)=ZIxp(lzly)qrm yg(Wuqvp)Zg(Vwpur)=Klyq(lxlz)rpm zUvrwq)xg(Wuqvp)=M擁(lylx)pqm_Xg(v wpur) yg(uvrwq)=N4.2流體動力和力矩(1) 由于流體輻射引起的力:【M av ：Ca(v)v- Dp(v)v - g( Y g0added masspote ntial damp ingrestori ng forcesDw(v)vDM (v)vskin fricti onwave drift damp ingvortex shed

11、di ng damp ing令:D(v)：Dp(v)Ds(v) Dw(v)Dm (v)M A，Ca(v)vD(v)vg()g。(2) 由于環(huán)境干擾產(chǎn)生的力如風(fēng)、浪、流產(chǎn)生的力和力矩，記為 W。(3) 最終模型M rb crb(V)V = rbrb = h W式中，為推進力和力矩。則mV c(v)v d(v)v g( )= g w式中：M = M RB M AC(v) = Crb(v) Ca(v)v4.2.1附加質(zhì)量和慣性歐拉-拉格朗日方程:L = T-V , T為動能，V為勢能d L dtJ T()式中：二n e de屮Kirchhoff方程：d T 、TS(v2)-T邛1dt v.vid T

12、 、TTS(v2)S(v)=T. 2dt v2V2viiv w,v2rX Y Z1 ,vT Mv24.2.1附加質(zhì)量和慣性 流體動能：1TAvtMav,M2代入 KirchhoffXuIXvXwXpXqXr1YuYvYwYpYqYrZuZvZ wZpZqZrAKuKvKwKpKqKrMuMvMwMpMqMrNuNvNwNpNqNr方程d T叮i +S(v?) _=T1dt yVid Tc叮Tii +S(v?)s(w)iT2dt v?叫2Vi-Kcq4.2.1附加質(zhì)量和慣性一 P rCV=嚴(yán)du STi=q、f THd 44.2.1附加質(zhì)量和慣性+Xv + Xd Kn - Jjp - Er2Xi

13、rUt K/iip -爲(wèi) ur_ ：耳+鬲問+打円-:辿-Mt冷Ma 啟価-ug） + Z（w- ug） + M直-X u: - h*） - i Qmu +再i： +心十曲 +耳仃一 jp -r；（ - Q）十f陽-Np Ij+ A;i - IXl 召j密-咐；_齊-Zr；（n/? + UT ： 更回+ E痔Aj &上 + 耳* 兩 +_TAr* -:再 _ 7衛(wèi)哎一咼幾避-+ 耳帀 + 御十 Nyi -x2 -X - （A） - YP + Mtp 十 窗 -二.ut七丄+ 咐+ JT w +一閃+號陽-隔一城胸 Sr4.2.1附加質(zhì)量和慣性特性：在理想流體下，附加質(zhì)量慣性矩陣Ma= M 0特

14、性：在理想流體下，附加質(zhì)量科里奧利一向心矩陣CA（V）總可以表示為反對稱矩陣，即Ca(v)=T03 3S( A11V1A12V2 )-Ca(v)二l - S(A11V1 + A|2v2)S(A21v1+ A22v2)j式中TAI1AI2A 二 A 0, A 二IL A21A22421附加質(zhì)量和慣性0I000-a3a?i000a30i一 ai丨000-a2印0Ca(v)二門I0-a3a20- b3b2a30 a1b30b1il_ a20-b2b10印二 XuuXyVXwW Xpp Xqq X/a YuUYyVYwWYp p q YrtraZuuZvVZwW ZppZqqZArbi =KuUKvV

15、KwW Kpp KqqKrirb2 =M ”uM vv M ww M pp Mqq Mrra NuuNvVNwWNpp Nqq Nrr4.2.2水動力阻尼水動力阻尼主要包括：（1）勢阻尼：也稱為 Radiation-induced damping （隨波浪頻 率被迫振動產(chǎn)生的阻尼），通常比較小，可以忽略。（2）表面磨擦：當(dāng)考慮航行器的低頻運動時，由于層流邊界 層理論產(chǎn)生的線性表面摩擦非常重要；此外，除了線性表面摩擦， 由于湍流邊界層將產(chǎn)生高頻部分，這通常被稱之為二次型或非線性 表面摩擦。（3）波浪漂移阻尼：波浪漂移阻尼可解釋為由于航行器在水 面運動時由于波浪產(chǎn)生的附加阻力。（4）由于渦流脫落產(chǎn)

16、生的阻尼：1f（U）CD（Rn）A|u|u422水動力阻尼R n= UD, 1.56 16v對于動力定位的低速應(yīng)用，在軸向二次項阻尼可以用 表示，在側(cè)向和航向米用 Cross-flow 表示：1 p olTTCwSCdUr Ur1一 p2 w LppITTC dragXdYdA Cd2D(x)(Vrxr) vr 十 xr dxUcurre ntNd1 A C：D(X)(Vrp2 w2 lLppxr) vr 十 xr xdxVcurre nt4.2.2水動力阻尼六自由度二次阻力可方便地表示為:-1VTDnlV111T111VDn2V11TI1VDn3Vl1T11VDn4VI1T11VDn5Vl1

17、T1-VDn6V_Dn(V)V =式中：Vu v w p qTN , Dni(i = 1,111,6)是 6 的矩陣，且取決于p，CD和A4.2.2水動力阻尼總的阻尼可表示為：D(v)= D Dn(v)特性(水動力阻尼矩陣)：在理想流體中的剛體，水動力阻尼 矩陣是非對稱、嚴(yán)格正實矩陣，即D(v) 0 v U 6例如：對于低速航行的航行器，如果其關(guān)于XZ對稱，且縱向和 軸向能夠解耦，則線性化的阻尼力和力矩可以表示為：Xu1001D=-1 0YvYr一 0NvNr對于低速應(yīng)用，也可進-步假定Nv =Yr，使得 D = Dt o422水動力阻尼動力定位（低速機動） 線性阻尼占主導(dǎo)地位機動（高速）：非

18、線性阻尼占主導(dǎo)地位u (m/s423恢復(fù)力和力矩重力：mg ,浮力：8= g001 1 n0 , fbn 1 10W一 Bf Rb()飛,Rn( r1 fbnfgb+ fbb 1 g()rb fbb fb-rg f g rg fb4.2.3恢復(fù)力和力矩W B)sin 91；-(W - B)coS sin*g()1- (W B) coS cos*ii(ygW ybB)cos cos(zgW ZbB)cos sin(zgW - zbB)sin。+ (XgW- xbB)cos cos*i -(xgW - xb B)cos sin - (ygW- ybB)sin 6 J式中：rbb = 1 Xbbrg

19、xgyZ)1，浮心坐標(biāo)ygzg，重心坐標(biāo)4.3六自由度運動方程4.3.1非線性運動方程 載體坐標(biāo)系下的向量表示：MV C(v)v D(v)v g( ) = g W I J ( )v式中：M = M rb M AC(V)= Crb(v) Ca(v)D(v)= Dp(v) Ds(v) Dw(v) Dm (v)4.3.1非線性運動方程NED坐標(biāo)系下的向量表示：I = J( )v二 v = J 丫)III = J()v J( )v= v= J( )_ II J( )J( ) I 將v和v用”1和”11代得：M ( p J T( )MJ 1()C (v, p J T( )_C(v)- MJ_1( )J(

20、 ) J_1()D (v, p J T( )D(v)J 1() g( )= J T( )g()4.3.1非線性運動方程g w)M ( )11 C (v, )1 D (v, )1 g ( )= J T()(NED坐標(biāo)系下非線性運動方程特性：(1) M ( p M ( )T 0- U 6(2) ST_ M ()- 2C (v,) s = s U 6,V- 6D(v, )0v 6,_64.3.1非線性運動方程特性（系統(tǒng)慣性矩陣）：對于剛體，系統(tǒng)慣性矩陣嚴(yán)格正實的充要條件是M a 0，即M = M RB M A 0如果剛體在理想流體下處于靜止?fàn)顟B(tài)（或以低速航行），系統(tǒng) 慣性矩陣總是正定，即 M = M

21、 T 0，且W - Xu-VymzsXqJVyni -Ip:mzg7p-YqW Zyrwy p- p-nixg-Zq-ZrXP叫-今-Ixy-Kq一zx-心-mxg-Zq-】xyJ0-jy二 TiprWp-Ap&mxaTr0-ZrJii-A/jr上一冷4.3.1非線性運動方程特性(科里奧利和向心矩陣)：在理想流體中航行的剛體，其 科里奧利和向心矩陣總可以表示反對稱形式，即C(v)CT(v)v U 6如果M不是對稱矩陣，可將 M寫成對稱和反對稱矩陣和，即11M = -(M M T)-(M - M T)2211一 1M0= T 二 一vTMv 二 一vTMv 0(vT(M - M T)v= 0)2

22、2 2式中：一 一 1M = Mt (M Mt)024.3.2線性運動方程假設(shè)橫滾角和俯仰角:P(=0J( )vP( )V)R()-3 漢 303 3I1 3 3定義(航行器平移坐標(biāo)系)航行器平移坐標(biāo)系定義為:”p=pTf)式中：” p為NED位置和姿態(tài)在載體坐標(biāo)系下的分量，注意到PT( )P( )= I66。432線性運動方程低速應(yīng)用（位置保持）：由航行器平移坐標(biāo)系可得:| p = PT ( ) PT ( 其中：r = T，且)1PT()P()+ pP01100001-100000010000010000010000000一 0000010ST( )P( )v= rS p v對于低速應(yīng)用rp

23、4.3.2線性運動方程重力和浮力也可用平移坐標(biāo)系來表示。對于小橫滾和俯仰角一og( ) PT( )G = PT()GP( ) p = G pG對于中性浮力的航行器，即 w = B，Xg = Xb，W 或，則G = diag 0 0 0 (zg - zJW (zg - zJW 0432線性運動方程低速機動和動力定位：v ： 0意味著非線性科里奧利力、向心力、 阻尼力、恢復(fù)力可以在平衡點 V = 0和=0進行線性化。因為C(00，Dn(0P 0，貝ymV c(v)v0DDn(V)V g()VDvG pg w最終狀態(tài)空間模型：”1TpmV Dv g p廠 Ax Bu Ewx =1 T vT ,u 八0A - M _1GI0-M _1D ，B . M 1 ，E4.3.2線性運動方程航行器在巡航狀態(tài)，假設(shè)航行器巡航速度滿足0= U00Tu= U0令N(u) = C(v)v+ D(v)v令,vV v v0，貝y pM v N(u0) v G pv VoI +A A(u0)x B