技術(shù)特征：

1.一種欠驅(qū)動(dòng)飛艇航跡跟蹤控制方法，其特征在于，包括以下步驟：

S1：給定期望航跡：P_d＝[x_d,y_d,z_d]^T，其中，x_d、y_d和z_d分別為期望x坐標(biāo)、期望y坐標(biāo)和期望z坐標(biāo)，上標(biāo)T表示向量或矩陣的轉(zhuǎn)置；

S2：計(jì)算期望航跡與實(shí)際航跡之間的航跡誤差量P_e；

S3：根據(jù)航跡誤差量P_e求解期望速度U_d；

S4：考慮飛艇的欠驅(qū)動(dòng)特性，設(shè)計(jì)航跡跟蹤控制律，計(jì)算航跡控制量τ。

2.根據(jù)權(quán)利要求1所述的欠驅(qū)動(dòng)飛艇航跡跟蹤控制方法，其特征在于，步驟S2中，航跡誤差量P_e的計(jì)算方法如下：

P_e＝P-P_d＝[x-x_d,y-y_d,z-z_d]^T (1)

P＝[x,y,z]^T為實(shí)際航跡，x、y和z分別為x坐標(biāo)、y坐標(biāo)和z坐標(biāo)。

3.根據(jù)權(quán)利要求1所述的欠驅(qū)動(dòng)飛艇航跡跟蹤控制方法，其特征在于，步驟S3中期望速度U_d的求解方法為：

1)建立飛艇空間運(yùn)動(dòng)的數(shù)學(xué)模型

飛艇空間運(yùn)動(dòng)的坐標(biāo)系及運(yùn)動(dòng)參數(shù)定義如下：

采用地面坐標(biāo)系o_ex_ey_ez_e和體坐標(biāo)系o_bx_by_bz_b對(duì)飛艇的空間運(yùn)動(dòng)進(jìn)行描述，CV為浮心，CG為重心，浮心到重心的矢量為r_G＝[x_G,y_G,z_G]^T；

運(yùn)動(dòng)參數(shù)定義：實(shí)際航跡P＝[x,y,z]^T；姿態(tài)角Ω＝[θ,ψ,φ]^T，θ、ψ、φ分別為俯仰角、偏航角和滾轉(zhuǎn)角；速度v＝[u,v,w]^T，u、v、w分別為體坐標(biāo)系中軸向、側(cè)向和垂直方向的速度；角速度ω＝[p,q,r]^T，p、q、r分別為滾轉(zhuǎn)、俯仰和偏航角速度；

記廣義坐標(biāo)η＝[x,y,z,θ,ψ,φ]^T，廣義速度為V＝[u,v,w,p,q,r]^T，飛艇在v、w和p自由度上存在欠驅(qū)動(dòng)；

2)飛艇空間運(yùn)動(dòng)的數(shù)學(xué)模型描述如下：

$\stackrel{\·}{\mathrm{\η}}=J\left(\mathrm{\η}\right)=\left[\begin{array}{cc}{J}_1& 0_{3\×3}\\ 0_{3\×3}& J_2\end{array}\right]V---\left(2\right)$

$M\stackrel{\·}{V}=\stackrel{\‾}{N}+\stackrel{\‾}{G}+\mathrm{\τ}---\left(3\right)$

式中

$J_1=\left[\begin{array}{ccc}\cos \mathrm{\ψ}\cos \mathrm{\θ}& \cos \mathrm{\ψ}\sin \mathrm{\θ}\sin \mathrm{\φ}-\sin \mathrm{\ψ}\cos \mathrm{\φ}& \cos \mathrm{\ψ}\sin \mathrm{\θ}\cos \mathrm{\φ}+\sin \mathrm{\ψ}\sin \mathrm{\φ}\\ \sin \mathrm{\ψ}\cos \mathrm{\θ}& \sin \mathrm{\ψ}\sin \mathrm{\θ}\sin \mathrm{\φ}+\cos \mathrm{\ψ}\cos \mathrm{\φ}& \sin \mathrm{\ψ}\sin \mathrm{\θ}\cos \mathrm{\φ}-\cos \mathrm{\ψ}\sin \mathrm{\φ}\\ -\sin \mathrm{\θ}& \cos \mathrm{\θ}\sin \mathrm{\φ}& \cos \mathrm{\θ}\cos \mathrm{\φ}\end{array}\right]---\left(4\right)$

$J_2=\left[\begin{array}{ccc}0& cos\mathrm{\φ}& -\sin \mathrm{\φ}\\ 0& \sec \mathrm{\θ}\sin \mathrm{\φ}& \sec \mathrm{\θ}cos\mathrm{\φ}\\ 1& tan\mathrm{\θ}\sin \mathrm{\φ}& tan\mathrm{\θ}cos\mathrm{\φ}\end{array}\right]---\left(5\right)$

$M=\left[\begin{array}{cccccc}m+m_{11}& 0& 0& 0& {\mathrm{mz}}_G& -{\mathrm{my}}_G\\ 0& m+m_{22}& 0& -{\mathrm{mz}}_G& 0& {\mathrm{mx}}_G\\ 0& 0& m+m_{33}& {\mathrm{my}}_G& -{\mathrm{mx}}_G& 0\\ 0& -{\mathrm{mz}}_G& {\mathrm{my}}_G& I_x+I_{11}& 0& 0\\ {\mathrm{mz}}_G& 0& -{\mathrm{mx}}_G& 0& I_x+I_{22}& 0\\ 0& {\mathrm{mx}}_G& 0& -I_{xz}& 0& I_x+I_{33}\end{array}\right]---\left(6\right)$

$\stackrel{\‾}{G}=\left[\begin{array}{c}(B-G)sin\mathrm{\θ}\\ (G-B)cos\mathrm{\θ}\sin \mathrm{\φ}\\ (G-B)cos\mathrm{\θ}\cos \mathrm{\φ}\\ y_{G}G\cos \mathrm{\θ}cos\mathrm{\φ}-z_{G}Gcos\mathrm{\θ}sin\mathrm{\φ}\\ -x_{G}G\cos \mathrm{\θ}\cos \mathrm{\φ}-z_{G}Gsin\mathrm{\θ}\\ x_{G}G\cos \mathrm{\θ}\sin \mathrm{\φ}+y_{G}G\sin \mathrm{\θ}\end{array}\right]---\left(7\right)$

$\mathrm{\τ}=\left[\begin{array}{c}{\mathrm{\τ}}_u\\ 0\\ 0\\ 0\\ {\mathrm{\τ}}_m\\ {\mathrm{\τ}}_n\end{array}\right]=\left[\begin{array}{c}Tcos\mathrm{\μ}cos\mathrm{\υ}\\ 0\\ 0\\ 0\\ T{\mathrm{cos\μcos\υl}}_z-T{\mathrm{cos\μsin\υl}}_x\\ T{\mathrm{sin\μl}}_x-T{\mathrm{cos\μcos\υl}}_y\end{array}\right]---\left(8\right)$

$\stackrel{\‾}{N}={\[N_u,N_v,N_w,N_p,N_q,N_r\]}^T---\left(9\right)$

其中

$\begin{array}{c}{N}_u=(m+m_{22})vr-(m+m_{33})wq+m\[x_G(p^2+r^2)-y_{G}pq-z_{G}pr\]\\ +{\mathrm{QV}}^{2/3}(-C_X\cos \mathrm{\α}\cos \mathrm{\β}+C_Y\cos \mathrm{\α}\sin \mathrm{\β}+C_Z\sin \mathrm{\α})\end{array}---\left(10\right)$

$\begin{array}{c}{N}_v=(m+m_{33})wp-(m+m_{11})ur-m\[x_{G}pq-y_G(p^2+r^2)+z_{G}qr\]\\ +{\mathrm{QV}}^{2/3}(C_X\sin \mathrm{\β}+C_Y\cos \mathrm{\β})\end{array}---\left(11\right)$

$\begin{array}{c}{N}_w=(m+m_{22})vp-(m+m_{11})uq-m\[x_{G}pr+y_{G}qr-z_G(p^2+q^2)\]\\ +{\mathrm{QV}}^{2/3}(-C_X\sin \mathrm{\α}\sin \mathrm{\β}+C_Y\sin \mathrm{\α}\cos \mathrm{\β}-C_Z\cos \mathrm{\α})\end{array}---\left(12\right)$

$\begin{array}{c}{N}_p=\[(I_y+I_{22})-(I_z+I_{33})\]qr+I_{xz}pq-I_{xy}pr-I_{yz}(r^2-q^2)+\\ \[{\mathrm{mz}}_G(ur-wp)+y_G(uq-vp)\]+{\mathrm{QVC}}_l\end{array}---\left(13\right)$

$\begin{array}{c}{N}_q=\[(I_z+I_{33})-(I_x+I_{11})\]pr+I_{xy}qr-I_{yz}pq-I_{xz}(p^2-r^2)\\ +m\[x_G(vp-uq)-z_G(wp-vr)\]+{\mathrm{QVC}}_m\end{array}---\left(14\right)$

$\begin{array}{c}{N}_r=\[(I_y+I_{22})-(I_x+I_{11})\]pq-I_{xz}qr-I_{xy}(q^2-p^2)+I_{yz}pr\\ +m\[y_G(wq-vr)-x_G(ur-wp)\]+{\mathrm{QVC}}_n\end{array}---\left(15\right)$

式中，m為飛艇質(zhì)量，m₁₁、m₂₂、m₃₃為附加質(zhì)量,I₁₁、I₂₂、I₃₃為附加慣量；Q為動(dòng)壓，α為迎角，β為側(cè)滑角，C_X、C_Y、C_Z、C_l、C_m、C_n為氣動(dòng)系數(shù)；I_x、I_y、I_z分別為繞o_bx_b、o_by_b、o_bz_b的主慣量；I_xy、I_xz、I_yz分別為關(guān)于平面o_bx_by_b、o_bx_bz_b、o_by_bz_b的慣量積；T為推力大小，μ為推力矢量與o_bx_bz_b面之間的夾角，規(guī)定其在o_bx_bz_b面之左為正，υ為推力矢量在o_bx_bz_b面的投影與o_bx_b軸之間的夾角，規(guī)定其投影在o_bx_b軸之下為正；l_x、l_y、l_z表示推力作用點(diǎn)距原點(diǎn)o_b的距離；

3)解算期望速度U_d

將航跡誤差量P_e變換為體坐標(biāo)系中的誤差

ξ_e＝J^-1P_e (16)

式中，J^-1為J的逆矩陣；

定義

ζ_e＝ξ_e-λ (17)

式中，λ＝[ρ,0,0]^T，ρ為一個(gè)正實(shí)數(shù)；

對(duì)式(17)求導(dǎo)，可得：

$\begin{array}{c}{\stackrel{\·}{\mathrm{\ζ}}}_e=-\mathrm{\ω}\×{\mathrm{\ζ}}_e-\mathrm{\ω}\×{\mathrm{\λ\ζ}}_e+v-J^{-1}{\stackrel{\·}{P}}_d\\ =\left[\begin{array}{ccc}1& 0& 0\\ 0& 0& -\mathrm{\ρ}\\ 0& \mathrm{\ρ}& 0\end{array}\right]\left[\begin{array}{c}u\\ q\\ r\end{array}\right]+\left[\begin{array}{c}0\\ v\\ w\end{array}\right]-\mathrm{\ω}\×{\mathrm{\ζ}}_e-J^{-1}{\stackrel{\·}{P}}_d\end{array}---\left(18\right)$

考慮到飛艇在v、w和p自由度上存在欠驅(qū)動(dòng)，定義期望速度與實(shí)際速度之間的誤差為：

U_e＝U-U_d (19)

式中，U_e＝[u_e,q_e,r_e]^T，U＝[u,q,r]^T，U_d＝[u_d,q_d,r_d]^T；

由式(18)可得：

$U_d=\left[\begin{array}{c}{u}_d\\ q_d\\ r_d\end{array}\right]={\left[\begin{array}{ccc}1& 0& 0\\ 0& 0& -\mathrm{\ρ}\\ 0& \mathrm{\ρ}& 0\end{array}\right]}^{-1}{\left(-\mathrm{\γ}\left[\begin{array}{ccc}1& 0& 0\\ 0& 1& 0\\ 0& 0& 1\end{array}\right]{\mathrm{\ζ}}_e-\left[\begin{array}{c}0\\ v\\ w\end{array}\right]\right)}_e+J^{-1}{\stackrel{\·}{P}}_d---\left(20\right)$

式中，γ為正實(shí)數(shù)。

4.根據(jù)權(quán)利要求1所述的欠驅(qū)動(dòng)飛艇航跡跟蹤控制方法，其特征在于，步驟S4的方法為：

定義以下誤差量

V_e＝V-V_d (21)

式中，V＝[u,0,0,0,q,r]^T，V_d＝＝[u_d,0,0,0,q_d,r_d]^T。

對(duì)式(21)微分可得：

${\stackrel{\·}{V}}_e=\stackrel{\·}{V}-{\stackrel{\·}{V}}_d---\left(21\right)$

等號(hào)左右兩側(cè)同乘M，可得：

$M{\stackrel{\·}{V}}_e=M\stackrel{\·}{V}-M{\stackrel{\·}{V}}_d---\left(22\right)$

將式(3)代入式(22)，可得

$M{\stackrel{\·}{V}}_e=MV-M{\stackrel{\·}{V}}_d=\stackrel{\‾}{N}+\stackrel{\‾}{G}+\mathrm{\τ}-M{\stackrel{\·}{V}}_d---\left(23\right)$

根據(jù)式(23)可設(shè)計(jì)如下控制律：

$\mathrm{\τ}=M{\stackrel{\·}{V}}_d+K{\stackrel{\·}{V}}_e-\stackrel{\‾}{N}-\stackrel{\‾}{G}---\left(24\right)$

式中，K＝diag(k₁,0,0,0,k₂,k₃)，diag()表示對(duì)角矩陣。