CN104793629B - 一种飞艇三维航迹跟踪的反步神经网络控制方法 - Google Patents
一种飞艇三维航迹跟踪的反步神经网络控制方法 Download PDFInfo
- Publication number
- CN104793629B CN104793629B CN201510221276.7A CN201510221276A CN104793629B CN 104793629 B CN104793629 B CN 104793629B CN 201510221276 A CN201510221276 A CN 201510221276A CN 104793629 B CN104793629 B CN 104793629B
- Authority
- CN
- China
- Prior art keywords
- mrow
- msub
- mtd
- mover
- msup
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Active
Links
- 238000013528 artificial neural network Methods 0.000 title claims abstract description 59
- 238000000034 method Methods 0.000 title claims abstract description 36
- 238000013461 design Methods 0.000 claims abstract description 8
- 238000005312 nonlinear dynamic Methods 0.000 claims abstract description 7
- 239000011159 matrix material Substances 0.000 claims description 18
- 230000003044 adaptive effect Effects 0.000 claims description 4
- 238000004458 analytical method Methods 0.000 claims description 4
- 230000008859 change Effects 0.000 claims description 4
- 230000005484 gravity Effects 0.000 claims description 4
- 238000013178 mathematical model Methods 0.000 claims description 4
- 230000009471 action Effects 0.000 claims description 3
- 238000004364 calculation method Methods 0.000 claims description 3
- 238000006073 displacement reaction Methods 0.000 claims description 2
- 230000017105 transposition Effects 0.000 claims 1
- 230000009897 systematic effect Effects 0.000 abstract 1
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 description 3
- 238000013459 approach Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000007246 mechanism Effects 0.000 description 2
- 238000012544 monitoring process Methods 0.000 description 2
- UFHFLCQGNIYNRP-UHFFFAOYSA-N Hydrogen Chemical compound [H][H] UFHFLCQGNIYNRP-UHFFFAOYSA-N 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 230000008878 coupling Effects 0.000 description 1
- 230000001808 coupling effect Effects 0.000 description 1
- 238000010168 coupling process Methods 0.000 description 1
- 238000005859 coupling reaction Methods 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000012938 design process Methods 0.000 description 1
- 238000001514 detection method Methods 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 238000005265 energy consumption Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 239000007789 gas Substances 0.000 description 1
- 239000001307 helium Substances 0.000 description 1
- 229910052734 helium Inorganic materials 0.000 description 1
- SWQJXJOGLNCZEY-UHFFFAOYSA-N helium atom Chemical compound [He] SWQJXJOGLNCZEY-UHFFFAOYSA-N 0.000 description 1
- 239000001257 hydrogen Substances 0.000 description 1
- 229910052739 hydrogen Inorganic materials 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 238000011160 research Methods 0.000 description 1
- 230000003068 static effect Effects 0.000 description 1
Landscapes
- Feedback Control In General (AREA)
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
Abstract
本发明涉及一种飞艇三维航迹跟踪的反步神经网络控制方法。针对飞艇的航迹跟踪控制问题,本发明建立了飞艇的非线性动力学模型;以此为受控对象,将非线性动力学模型分解为两个子***,采用反步法为每个子***设计Lyapunov函数和中间虚拟控制量,通过确定适当的虚拟反馈,使得***的前面状态达到渐近稳定,一直“反向推演”至整个***,从而实现整个***的渐近稳定;针对飞艇动力学模型不确定问题,采用神经网络逼近器精确估计未知的飞艇动力学模型,以提高控制精度和***性能。由该方法控制的闭环***能够高精度跟踪任意给定的参数化指令航迹,且具有良好的稳定性、适应性、鲁棒性和动态性能,为飞艇航迹控制的工程实现提供了有效方案。
Description
技术领域
本发明涉及一种航天航空领域的飞行控制方法,它为飞艇航迹跟踪提供一种反步神经网络控制方法,属于自动控制技术领域。
背景技术
飞艇是指一种依靠轻于空气的气体(如氦气、氢气等)提供静浮力升空,依靠自动飞行控制***实现定点驻留和低速机动的飞行器,具有滞空时间长、能耗低、效费比高及定点驻留等优点,广泛应用于侦察监视、对地观测、环境监测、应急救灾、科学探测等领域,具有重要应用价值和广阔的应用前景,当前已成为航空领域的研究热点。
航迹跟踪是指飞艇从给定的初始状态出发并跟踪给定的惯性坐标系下的指令航迹。飞艇的空间运动具有非线性、通道耦合、不确定、易受外界扰动等特点,因此,航迹控制成为飞艇飞行控制的关键技术之一。众多研究人员针对飞艇的航迹跟踪问题,提出了PID控制、反馈控制、滑模控制、鲁棒控制等方法,为飞艇航迹跟踪提供了可供参考借鉴的技术方案。但是上述航迹控制方法尚未有效解决以下两类问题:一是飞艇动力学模型不确定,存在建模误差及未建模动态;二是飞艇航迹控制***为一个复杂的多变量非线性***,飞行包线内闭环控制***的稳定性难以保证。
发明内容
针对现有技术存在的不足,本发明的目的是提供一种飞艇三维航迹跟踪的反步神经网络控制方法。
本发明针对飞艇三维航迹跟踪问题,建立了飞艇的非线性动力学模型;以此为受控对象,将非线性动力学模型分解为两个子***,采用反步法为每个子***设计李雅普诺夫(Lyapunov)函数和中间虚拟控制量,通过确定适当的虚拟反馈,使得***的前面状态达到渐近稳定,一直“反向推演”至整个***,从而实现整个***的渐近稳定;针对飞艇动力学模型不确定问题,采用神经网络精确逼近未知的飞艇动力学模型,以提高控制精度和***性能。本发明的优点表现在:①采用反步法设计使得李雅普诺夫(Lyapunov)函数和控制律的设计过程***化、结构化,确保了***的稳定性;②采用神经网络精确逼近飞艇的不确定模型,使得航迹跟踪控制***具有强适应性和强鲁棒性。
本发明的技术方案是:首先由给定的指令航迹和实际航迹计算航迹控制误差量,然后采用反步方法设计航迹控制律,计算航迹控制量;为解决飞艇动力学模型不确定问题,采用神经网络精确逼近未知的不确定模型。实际应用中,飞艇航迹由组合导航***测量得到,将由该方法计算得到的控制量传输至执行机构即可实现航迹控制功能。
具体地,一种飞艇三维航迹跟踪的反步神经网络控制方法,包括以下步骤:
步骤一:给定指令航迹:ηd=[xd,yd,zd,θd,ψd,φd]T;
其中:所述的指令航迹为广义坐标ηd=[xd,yd,zd,θd,ψd,φd]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角,上标T表示向量或矩阵的转置。
步骤二:航迹控制误差量计算:计算指令航迹与实际航迹之间的航迹控制误差量e;
所述航迹控制误差量e的计算方法为:
e=ηd-η=[xd-x,yd-y,zd-z,θd-θ,ψd-ψ,φd-φ]T (1)
其中:η=[x,y,z,θ,ψ,φ]T为实际航迹,x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角。
步骤三:航迹控制律设计:选取Lypaunov函数和中间虚拟控制量,采用反步法设计航迹控制律,计算航迹控制量u,具体包括以下步骤:
1)建立飞艇的动力学模型
飞艇空间运动的坐标系及运动参数定义如下:采用地面坐标系oexeyeze和载体坐标系obxbybzb对飞艇的空间运动进行描述,CV为浮心,CG为重心,浮心到重心的矢量为rG=[xG,yG,zG]T。运动参数定义:位置P=[x,y,z]T,x、y、z分别为轴向、侧向和竖直方向的位移;姿态角Ω=[θ,ψ,φ]T,θ、ψ、φ分别为俯仰角、偏航角和滚转角;速度v=[u,v,w]T,u、v、w分别为载体坐标系中轴向、侧向和垂直方向的速度;角速度ω=[p,q,r]T,p、q、r分别为滚转、俯仰和偏航角速度。记广义坐标η=[x,y,z,θ,ψ,φ]T,广义速度为V=[u,v,w,p,q,r]T。
飞艇的动力学模型描述如下:
式中
其中
式中,m为飞艇质量,m11、m22、m33为附加质量,I11、I22、I33为附加惯量,Λ为飞艇体积;Q为动压,α为迎角,β为侧滑角,CX、CY、CZ、Cl、Cm、Cn为气动系数;Ix、Iy、Iz分别为绕obxb、obyb、obzb的主惯量;Ixy、Ixz、Iyz分别为关于平面obxbyb、obxbzb、obybzb的惯量积;T为推力大小,μ为推力矢量与obxbzb面之间的夹角,规定其在obxbzb面之左为正,υ为推力矢量在obxbzb面的投影与obxb轴之间的夹角,规定其投影在obxb轴之下为正;lx、ly、lz表示推力作用点距原点ob的距离。
式(3)为关于广义速度V的表达式,需要将其变换为关于广义坐标η的表达式。
由式(2)可得:
式中,J-1(η)为J(η)的逆矩阵。
对式(16)微分,可得
式中
式(19)左乘可得
综合式(3)、式(19)以及式(21)可得:
式中
Mη(η)=RTMR (23)
Γ=RTτ (26)
令x1=η,则动力学模型式(22)可写为如下形式:
式中,表示矩阵Mη的逆矩阵;Mη是Mη(η)的简称;
以式(27)所描述的数学模型为被控对象,采用反步方法设计航迹控制律。
2)设计航迹控制律
根据指令航迹与实际航迹之间的航迹控制误差量e,定义如下虚拟量:
式中,α1为虚拟量,k1为可调的控制参数。
定义虚拟量α1与x2之间的误差e′:
e′=x2-α1 (29)
式(29)对时间微分并将式(27)代入,可得:
令
则式(31)可表示为:
选取李雅普诺夫函数(Lyapunov函数)V1
式(33)对时间微分,并将式(32)代入,可得:
根据式(34),设计如下航迹控制律:
3)稳定性分析
将航迹控制律式(35)代入式(34),可得:
式(36)表明:采用航迹控制律(35)能够保证闭环***的稳定性。
步骤四:神经网络逼近器设计:以航迹控制误差e及其变化率实际航迹η及其变化率为神经网络的输入变量,以飞艇动力学模型的估计值为神经网络的输出变量设计了神经网络逼近器,利用神经网络无限逼近功能估计未知的不确定模型,以提高控制精度,具体步骤如下:
1)由于在实际飞行过程中难以对飞艇进行精确建模,f(x)为未知函数,难以根据式(35)进行控制律解算,因此,须采用f(x)的估计值对航迹控制律式(35)进行解算;采用神经网络逼近未知函数f(x),则有:
f(x)=wTh(x)+ε (37)
式中,w为神经网络的权重向量,ε为逼近误差,h(x)=[hi(x)]T,hi(x)为高斯基函数,下标i表示第i个高斯基函数;
2)选择输入输出变量
令航迹控制误差e及其变化率实际航迹η及其变化率为神经网络逼近器的输入变量,令估计值为神经网络逼近器的输出变量。
3)设计神经网络结构
神经网络结构包括输入层、隐层和输出层。
输入层:选取神经网络的输入变量为
隐层:选取高斯函数作为隐层节点的基函数
其中,c=[ci]T,ci为第i个高斯函数的中值,σi为第i个节点的基宽度参数,||·||表示欧几里德范数。
输出层:神经网络的输出为
其中,为w的估计值。
4)稳定性分析
定义与w差值:
选取Lyapunov函数:
式中,ξ=[e e′]T,Θ为可调的正定矩阵,λ-1表示矩阵λ的逆矩阵。
对式(41)微分,可得:
定义
则式(42)可写为:
式中,
设计如下自适应律:
式中,γ>0为可调的参数,
将自适应律代入式(44),可得:
根据施瓦茨(Schwarz)不等式,有:
式中,||·||F表示伏柔宾纽斯(Frobenius)范数。
将式(47)代入式(46),可得:
式中,εN为逼近误差的上界,kmin为可调参数矩阵k的最小特征值,WM为权重矩阵W的最大值元素。
考虑到如下等式:
若使得则须有以下不等式成立:
或
若则有||ξ||和一致最终有界,从||ξ||的收敛性可得:航迹跟踪精度与神经网络逼近误差上界εN、可调参数矩阵k有关。
由此,通过上述的神经网络逼近器能够精确估计不确定的飞艇非线性动力学模型。
本发明的有益技术效果:
1)该方法直接基于飞艇的非线性动力学模型设计航迹控制律,考虑了各项非线性因素以及多变量耦合作用,克服了线性化模型仅适于平衡态的局限性,能够高精度跟踪任意给定的参数化指令航迹。
2)该方法将复杂的非线性航迹控制***分解成两个不超过***阶数的子***,然后为每个子***设计Lypaunov函数和中间虚拟控制量,通过确定适当的虚拟反馈,使得***的前面状态达到渐近稳定,一直“后推”至整个***,确保了整个***的渐近稳定。
3)该方法不需要精确已知对飞艇动力学模型,采用神经网络逼近器估计未知的飞艇动力学模型,提高了***的适应性和控制精度。
控制工程师在应用过程中可以根据实际飞艇给定任意指令航迹,并将由该方法得到的控制量传输至执行机构实现航迹控制功能。
附图说明
图1为本发明所述飞艇航迹控制***结构图
图2为本发明所述飞艇三维航迹跟踪控制方法步骤流程图
图3为本发明所述飞艇坐标系及运动参数定义
图4为本发明所述神经网络结构图
图5为本发明所述飞艇三维航迹跟踪控制结果
图6为本发明所述飞艇三维航迹跟踪控制误差
图7为神经网络逼近结果
图中符号说明如下:
η η=[x,y,z,θ,ψ,φ]T为飞艇航迹,其中x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角;
ηd ηd=[xd,yd,zd,θd,ψd,φd]T为指令航迹,其中xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角;
oexeyeze oexeyeze表示地面坐标系;
obxbybzb obxbybzb表示飞艇体坐标系;
e e=[xe,ye,ze,θe,ψe,φe]T为航迹控制误差量,分别为航迹控制的x坐标误差、y坐标误差、z坐标误差;
u u为***控制量;
f(x) f(x)为飞艇的不确定动力学模型。
具体实施方式
本发明“一种飞艇三维航迹跟踪的反步神经网络控制方法”,其具体步骤如下:
步骤一:给定指令航迹
给定指令航迹为:
ηd=[xd,yd,zd,θd,ψd,φd]T=[(3t)m,(0.93t)m,10m,0rad,0.3rad,0rad]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角;
步骤二:航迹控制误差量计算
计算指令航迹与实际航迹之间的航迹控制误差量:
e=ηd-η=[xd-x,yd-y,zd-z,θd-θ,ψd-ψ,φd-φ]T,
其中,η=[x,y,z,θ,ψ,φ]T为实际航迹,x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角,为连续变化值。
初始航迹为:
η0=[x0,y0,z0,θ0,ψ0,φ0]T=[100m,-200m,5m,0.02rad,0.02rad,0.1rad]T。
初始速度:
V0=[u0,v0,w0,p0,q0,r0]T=[8m/s,0m/s,0m/s,0rad/s,0rad/s,0rad/s]T
步骤三:设计航迹控制律:
1)建立飞艇动力学模型
飞艇空间运动的数学模型可表示为:
式中
其中
式中,m为飞艇质量,m11、m22、m33为附加质量,I11、I22、I33为附加惯量;Λ为飞艇体积;Q为动压,α为迎角,β为侧滑角,CX、CY、CZ、Cl、Cm、Cn为气动系数;Ix、Iy、Iz分别为绕obxb、obyb、obzb的主惯量;Ixy、Ixz、Iyz分别为关于平面obxbyb、obxbzb、obybzb的惯量积;T为推力大小,μ为推力矢量与obxbzb面之间的夹角,规定其在obxbzb面之左为正,υ为推力矢量在obxbzb面的投影与obxb轴之间的夹角,规定其投影在obxb轴之下为正;lx、ly、lz表示推力作用点距原点ob的距离。
式(52)为关于广义速度V的表达式,需要将其变换为关于广义坐标η的表达式。
由式(51)可得:
式中,J-1(η)为J(η)的逆矩阵,
对式(65)微分,可得
式中
式(68)左乘可得
综合式(52)、式(68)以及式(70)可得:
式中
Mη(η)=RTMR (72)
Γ=RTτ (75)
令x1=η,则动力学模型(71)可写为如下形式:
式中,表示矩阵Mη的逆矩阵;Mη是Mη(η)的简称;
以式(76)所描述的数学模型为被控对象,采用反步方法设计航迹控制律。
本实施例中的飞艇参数见表1。
表1飞艇参数
2)设计控制律
根据指令航迹与实际航迹之间的航迹控制误差量e,定义如下虚拟量:
式中,α1为虚拟量,k1,k2为可调的控制参数。
定义虚拟量α1与x2之间的误差e′:
e′=x2-α1 (78)
式(78)对时间微分并将式(76)代入,可得:
令
则式(80)可表示为:
其中,k1取值为12。
选取Lyapunov函数V1
式(82)对时间微分并将式(81)代入,可得:
根据式(83),设计如下控制律:
其中,k2取值为10。
由于在实际飞行过程中难以对飞艇进行精确建模,f(x)为未知函数,难以根据式(35)进行控制律解算,因此,须采用f(x)的估计值对航迹控制律式(35)进行解算;
其中,在步骤四中所述的设计神经网络逼近器,其设计方法为:
1)采用神经网络逼近未知函数f(x),则有:
f(x)=wTh(x)+ε (37)
式中,w为神经网络的权重向量,ε为逼近误差,h(x)=[hi(x)]T,hi(x)为高斯基函数,下标i表示第i个高斯基函数;
2)选择输入输出变量
令航迹控制误差e及其变化率实际航迹η及其变化率为神经网络逼近器的输入变量,令估计值为神经网络逼近器的输出变量。
3)设计神经网络结构
神经网络结构包括输入层、隐层和输出层,如图4所示。
输入层:选取神经网络的输入变量为
隐层:选取高斯函数作为隐层节点的基函数
其中,
输出层:神经网络的输出为
其中,的取值取为
由此,通过上述的神经网络逼近器能够精确估计不确定的飞艇非线性动力学模型。
实施例中的飞艇三维航迹跟踪控制结果如图5-图7所示。图5给出了飞艇三维航迹跟踪控制结果,由图5可得:飞艇由初始位置出发,能够准确地跟踪指令航迹,验证了本发明所提出的航迹跟踪控制方法的有效性;图6给出了航迹跟踪控制误差,由图6可得,本发明所提出的航迹控制方法能够高精度地跟踪给定的指令航迹。图7给出了神经网络逼近结果,由图7可得,本发明所设计的神经网络逼近器能够精确地估计不确定的飞艇动力学模型。
以上包含了本发明优选实施例的说明,这是为了详细说明本发明的技术特征,并不是想要将发明内容限制在实施例所描述的具体形式中,依据本发明内容主旨进行的其他修改和变型也受本专利保护。本发明内容的主旨是由权利要求书所界定,而非由实施例的具体描述所界定。
Claims (2)
1.一种飞艇三维航迹跟踪的反步神经网络控制方法,其特征在于,包括以下步骤:
步骤一:给定指令航迹:ηd=[xd,yd,zd,θd,ψd,φd]T;
其中:指令航迹为广义坐标ηd=[xd,yd,zd,θd,ψd,φd]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角,上标T表示向量或矩阵的转置;
步骤二:航迹控制误差量计算:计算指令航迹与实际航迹之间的航迹控制误差量e;
航迹控制误差量e的计算方法为:
e=ηd-η=[xd-x,yd-y,zd-z,θd-θ,ψd-ψ,φd-φ]T (1)
η=[x,y,z,θ,ψ,φ]T为实际航迹,x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角;
步骤三:航迹控制律设计:选取Lypaunov函数和中间虚拟控制量,采用反步法设计航迹控制律,计算航迹控制量u;
1)建立飞艇的动力学模型
飞艇空间运动的坐标系及运动参数定义如下:采用地面坐标系oexeyeze和载体坐标系obxbybzb对飞艇的空间运动进行描述,CV为浮心,CG为重心,浮心到重心的矢量为rG=[xG,yG,zG]T;运动参数定义:位置P=[x,y,z]T,x、y、z分别为轴向、侧向和竖直方向的位移;姿态角Ω=[θ,ψ,φ]T,θ、ψ、φ分别为俯仰角、偏航角和滚转角;速度v=[u,v,w]T,u、v、w分别为载体坐标系中轴向、侧向和垂直方向的速度;角速度ω=[p,q,r]T,p、q、r分别为滚转、俯仰和偏航角速度;记广义坐标η=[x,y,z,θ,ψ,φ]T,广义速度为V=[u,v,w,p,q,r]T;
飞艇的动力学模型描述如下:
<mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>J</mi>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>J</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<msub>
<mi>J</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mi>V</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>2</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>M</mi>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mover>
<mi>N</mi>
<mo>&OverBar;</mo>
</mover>
<mo>+</mo>
<mover>
<mi>G</mi>
<mo>&OverBar;</mo>
</mover>
<mo>+</mo>
<mi>&tau;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>3</mn>
<mo>)</mo>
</mrow>
</mrow>
式中
<mrow>
<msub>
<mi>J</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
<mo>-</mo>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
<mo>+</mo>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
<mo>+</mo>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
<mo>-</mo>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>4</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>J</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>sec</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sec</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>1</mn>
</mtd>
<mtd>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>t</mi>
<mi>a</mi>
<mi>n</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>5</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>M</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>11</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>mz</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>my</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>22</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>mz</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>mx</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>33</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>my</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>mx</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>mz</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>my</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mrow>
<msub>
<mi>I</mi>
<mi>x</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>11</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mi>mz</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>mx</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>I</mi>
<mi>x</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>22</mn>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>mx</mi>
<mi>G</mi>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<msub>
<mi>I</mi>
<mrow>
<mi>x</mi>
<mi>z</mi>
</mrow>
</msub>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<msub>
<mi>I</mi>
<mi>x</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>33</mn>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>6</mn>
<mo>)</mo>
</mrow>
</mrow>
1
<mrow>
<mover>
<mi>G</mi>
<mo>&OverBar;</mo>
</mover>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mo>(</mo>
<mi>B</mi>
<mo>-</mo>
<mi>G</mi>
<mo>)</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>(</mo>
<mi>G</mi>
<mo>-</mo>
<mi>B</mi>
<mo>)</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>(</mo>
<mi>G</mi>
<mo>-</mo>
<mi>B</mi>
<mo>)</mo>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>y</mi>
<mi>G</mi>
</msub>
<mi>G</mi>
<mi> </mi>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mi>G</mi>
</msub>
<mi>G</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&phi;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>G</mi>
</msub>
<mi>G</mi>
<mi> </mi>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mi>G</mi>
</msub>
<mi>G</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>x</mi>
<mi>G</mi>
</msub>
<mi>G</mi>
<mi> </mi>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
<mo>+</mo>
<msub>
<mi>y</mi>
<mi>G</mi>
</msub>
<mi>G</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&theta;</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>7</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>&tau;</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>u</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>v</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>w</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>l</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>m</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mi>&tau;</mi>
<mi>n</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>T</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&mu;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&upsi;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>T</mi>
<mi> </mi>
<mi>sin</mi>
<mi>&mu;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>T</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&mu;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&upsi;</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mi>T</mi>
<mi> </mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&mu;</mi>
<mi>sin</mi>
<mi>&upsi;</mi>
<msub>
<mi>l</mi>
<mi>y</mi>
</msub>
<mo>-</mo>
<mi>T</mi>
<mi> </mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&mu;</mi>
<msub>
<mi>l</mi>
<mi>z</mi>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>T</mi>
<mi> </mi>
<msub>
<mi>cos&mu;cos&upsi;l</mi>
<mi>z</mi>
</msub>
<mo>-</mo>
<mi>T</mi>
<mi> </mi>
<msub>
<mi>cos&mu;sin&upsi;l</mi>
<mi>x</mi>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>T</mi>
<mi> </mi>
<msub>
<mi>sin&mu;l</mi>
<mi>x</mi>
</msub>
<mo>-</mo>
<mi>T</mi>
<mi> </mi>
<msub>
<mi>cos&mu;cos&upsi;l</mi>
<mi>y</mi>
</msub>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>8</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mover>
<mi>N</mi>
<mo>&OverBar;</mo>
</mover>
<mo>=</mo>
<msup>
<mrow>
<mo>&lsqb;</mo>
<msub>
<mi>N</mi>
<mi>u</mi>
</msub>
<mo>,</mo>
<msub>
<mi>N</mi>
<mi>v</mi>
</msub>
<mo>,</mo>
<msub>
<mi>N</mi>
<mi>w</mi>
</msub>
<mo>,</mo>
<msub>
<mi>N</mi>
<mi>p</mi>
</msub>
<mo>,</mo>
<msub>
<mi>N</mi>
<mi>q</mi>
</msub>
<mo>,</mo>
<msub>
<mi>N</mi>
<mi>r</mi>
</msub>
<mo>&rsqb;</mo>
</mrow>
<mi>T</mi>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>9</mn>
<mo>)</mo>
</mrow>
</mrow>
其中
<mrow>
<mfenced open='' close=''>
<mtable>
<mtr>
<mtd>
<msub>
<mi>N</mi>
<mi>u</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>22</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>vr</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>33</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>wq</mi>
<mo>+</mo>
<mi>m</mi>
<mo>[</mo>
<msub>
<mi>x</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>p</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mi>r</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>G</mi>
</msub>
<mi>pq</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mi>G</mi>
</msub>
<mi>pr</mi>
<mo>]</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>+</mo>
<msup>
<mi>Q&Lambda;</mi>
<mrow>
<mn>2</mn>
<mo>/</mo>
<mn>3</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mo>-</mo>
<msub>
<mi>G</mi>
<mi>X</mi>
</msub>
<mi>cos</mi>
<mi></mi>
<mi>&alpha;</mi>
<mi>cos</mi>
<mi>&beta;</mi>
<mo>+</mo>
<msub>
<mi>G</mi>
<mi>Y</mi>
</msub>
<mi>cos</mi>
<mi></mi>
<mi>&alpha;</mi>
<mi>sin</mi>
<mi>&beta;</mi>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>Z</mi>
</msub>
<mi>sin</mi>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>10</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open='' close=''>
<mtable>
<mtr>
<mtd>
<msub>
<mi>N</mi>
<mi>v</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>33</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>wp</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>11</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>ur</mi>
<mo>+</mo>
<mi>m</mi>
<mo>[</mo>
<msub>
<mi>x</mi>
<mi>G</mi>
</msub>
<mi>pq</mi>
<mo>-</mo>
<msub>
<mi>y</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>p</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mi>r</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>z</mi>
<mi>G</mi>
</msub>
<mi>qr</mi>
<mo>]</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>+</mo>
<msup>
<mi>Q&Lambda;</mi>
<mrow>
<mn>2</mn>
<mo>/</mo>
<mn>3</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<msub>
<mi>C</mi>
<mi>X</mi>
</msub>
<mi>sin</mi>
<mi>&beta;</mi>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>Y</mi>
</msub>
<mi>cos</mi>
<mi>&beta;</mi>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>11</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open='' close=''>
<mtable>
<mtr>
<mtd>
<msub>
<mi>N</mi>
<mi>w</mi>
</msub>
<mo>=</mo>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>22</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>vp</mi>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mi>m</mi>
<mo>+</mo>
<msub>
<mi>m</mi>
<mn>11</mn>
</msub>
<mo>)</mo>
</mrow>
<mi>uq</mi>
<mo>-</mo>
<mi>m</mi>
<mo>[</mo>
<msub>
<mi>x</mi>
<mi>G</mi>
</msub>
<mi>pr</mi>
<mo>+</mo>
<msub>
<mi>y</mi>
<mi>G</mi>
</msub>
<mi>qr</mi>
<mo>-</mo>
<msub>
<mi>z</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>p</mi>
<mn>2</mn>
</msup>
<mo>+</mo>
<msup>
<mi>q</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
<mo>]</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>+</mo>
<mi>Q</mi>
<msup>
<mi>&Lambda;</mi>
<mrow>
<mn>2</mn>
<mo>/</mo>
<mn>3</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mo>-</mo>
<msub>
<mi>C</mi>
<mi>X</mi>
</msub>
<mi>sin</mi>
<mi></mi>
<mi>&alpha;</mi>
<mi>sin</mi>
<mi>&beta;</mi>
<mo>+</mo>
<msub>
<mi>C</mi>
<mi>Y</mi>
</msub>
<mi>sin</mi>
<mi></mi>
<mi>&alpha;</mi>
<mi>cos</mi>
<mi>&beta;</mi>
<mo>-</mo>
<msub>
<mi>C</mi>
<mi>Z</mi>
</msub>
<mi>cos</mi>
<mi>&alpha;</mi>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>12</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open='' close=''>
<mtable>
<mtr>
<mtd>
<msub>
<mi>N</mi>
<mi>p</mi>
</msub>
<mo>=</mo>
<mo>[</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mi>y</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>22</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>33</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>]</mo>
<mi>qr</mi>
<mo>+</mo>
<msub>
<mi>I</mi>
<mi>xz</mi>
</msub>
<mi>pq</mi>
<mo>-</mo>
<msub>
<mi>I</mi>
<mi>xy</mi>
</msub>
<mi>pr</mi>
<mo>-</mo>
<msub>
<mi>I</mi>
<mi>yz</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>r</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<mi>q</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
<mo>+</mo>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>[</mo>
<msub>
<mi>mz</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>ur</mi>
<mo>-</mo>
<mi>wp</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>y</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>uq</mi>
<mo>-</mo>
<mi>vp</mi>
<mo>)</mo>
</mrow>
<mo>]</mo>
<mo>+</mo>
<mi>Q&Lambda;</mi>
<msub>
<mi>C</mi>
<mi>l</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>13</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open='' close=''>
<mtable>
<mtr>
<mtd>
<msub>
<mi>N</mi>
<mi>q</mi>
</msub>
<mo>=</mo>
<mo>[</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mi>z</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>33</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mi>x</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>22</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>]</mo>
<mi>pr</mi>
<mo>+</mo>
<msub>
<mi>I</mi>
<mi>xy</mi>
</msub>
<mi>qr</mi>
<mo>-</mo>
<msub>
<mi>I</mi>
<mi>yz</mi>
</msub>
<mi>pq</mi>
<mo>-</mo>
<msub>
<mi>I</mi>
<mi>xz</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>p</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<mi>r</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>+</mo>
<mi>m</mi>
<mo>[</mo>
<msub>
<mi>x</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>vp</mi>
<mo>-</mo>
<mi>uq</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>z</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>wp</mi>
<mo>-</mo>
<mi>vr</mi>
<mo>)</mo>
</mrow>
<mo>]</mo>
<mo>+</mo>
<mi>Q&Lambda;</mi>
<msub>
<mi>C</mi>
<mi>m</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>14</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mfenced open='' close=''>
<mtable>
<mtr>
<mtd>
<msub>
<mi>N</mi>
<mi>r</mi>
</msub>
<mo>=</mo>
<mo>[</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mi>y</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>22</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mrow>
<mo>(</mo>
<msub>
<mi>I</mi>
<mi>x</mi>
</msub>
<mo>+</mo>
<msub>
<mi>I</mi>
<mn>11</mn>
</msub>
<mo>)</mo>
</mrow>
<mo>]</mo>
<mi>pq</mi>
<mo>+</mo>
<msub>
<mi>I</mi>
<mi>xz</mi>
</msub>
<mi>qr</mi>
<mo>-</mo>
<msub>
<mi>I</mi>
<mi>xy</mi>
</msub>
<mrow>
<mo>(</mo>
<msup>
<mi>q</mi>
<mn>2</mn>
</msup>
<mo>-</mo>
<msup>
<mi>p</mi>
<mn>2</mn>
</msup>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>I</mi>
<mi>yz</mi>
</msub>
<mi>pr</mi>
</mtd>
</mtr>
<mtr>
<mtd>
<mo>+</mo>
<mi>m</mi>
<mo>[</mo>
<msub>
<mi>y</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>wq</mi>
<mo>-</mo>
<mi>vr</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<msub>
<mi>x</mi>
<mi>G</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>ur</mi>
<mo>-</mo>
<mi>wp</mi>
<mo>)</mo>
</mrow>
<mo>]</mo>
<mo>+</mo>
<mi>Q&Lambda;</mi>
<msub>
<mi>C</mi>
<mi>n</mi>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>15</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,m为飞艇质量,m11、m22、m33为附加质量,I11、I22、I33为附加惯量,Λ为飞艇体积;Q为动压,α为迎角,β为侧滑角,CX、CY、CZ、Cl、Cm、Cn为气动系数;Ix、Iy、Iz分别为绕obxb、obyb、obzb的主惯量;Ixy、Ixz、Iyz分别为关于平面obxbyb、obxbzb、obybzb的惯量积;T为推力大小,μ为推力矢量与obxbzb面之间的夹角,规定其在obxbzb面之左为正,υ为推力矢量在obxbzb面的投影与obxb轴之间的夹角,规定其投影在obxb轴之下为正;lx、ly、lz表示推力作用点距原点ob的距离;
式(3)为关于广义速度V的表达式,需要将其变换为关于广义坐标η的表达式;
由式(2)可得:
<mrow>
<mi>V</mi>
<mo>=</mo>
<msup>
<mi>J</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mi>R</mi>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mi>A</mi>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mi>B</mi>
</mtd>
</mtr>
</mtable>
</mfenced>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>16</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,J-1(η)为J(η)的逆矩阵;
<mrow>
<mi>A</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>sin</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
<mo>-</mo>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
<mo>+</mo>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
<mo>+</mo>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>sin</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
<mo>-</mo>
<mi>cos</mi>
<mi>&psi;</mi>
<mi>sin</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>cos</mi>
<mi>&theta;</mi>
<mi>cos</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>17</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<mi>B</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&theta;</mi>
</mrow>
</mtd>
<mtd>
<mn>1</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>-</mo>
<mi>s</mi>
<mi>i</mi>
<mi>n</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mrow>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&theta;</mi>
<mi>c</mi>
<mi>o</mi>
<mi>s</mi>
<mi>&phi;</mi>
</mrow>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>18</mn>
<mo>)</mo>
</mrow>
</mrow>
对式(16)微分,可得
<mrow>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>R</mi>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>19</mn>
<mo>)</mo>
</mrow>
</mrow>
式中
<mrow>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<mover>
<mi>A</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
</mtr>
<mtr>
<mtd>
<msub>
<mn>0</mn>
<mrow>
<mn>3</mn>
<mo>&times;</mo>
<mn>3</mn>
</mrow>
</msub>
</mtd>
<mtd>
<mover>
<mi>B</mi>
<mo>&CenterDot;</mo>
</mover>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>20</mn>
<mo>)</mo>
</mrow>
</mrow>
式(19)左乘可得
<mrow>
<msup>
<mi>R</mi>
<mi>T</mi>
</msup>
<mi>M</mi>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msup>
<mi>R</mi>
<mi>T</mi>
</msup>
<mi>M</mi>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msup>
<mi>R</mi>
<mi>T</mi>
</msup>
<mi>M</mi>
<mi>R</mi>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>21</mn>
<mo>)</mo>
</mrow>
</mrow>
综合式(3)、式(19)以及式(21)可得:
<mrow>
<msub>
<mi>M</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>N</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<msub>
<mi>G</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&Gamma;</mi>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>22</mn>
<mo>)</mo>
</mrow>
</mrow>
式中
Mη(η)=RTMR (23)
<mrow>
<msub>
<mi>N</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mi>R</mi>
<mi>T</mi>
</msup>
<mi>M</mi>
<mover>
<mi>R</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>24</mn>
<mo>)</mo>
</mrow>
</mrow>
<mrow>
<msub>
<mi>G</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>R</mi>
<mi>T</mi>
</msup>
<mrow>
<mo>(</mo>
<mover>
<mi>N</mi>
<mo>&OverBar;</mo>
</mover>
<mo>+</mo>
<mover>
<mi>G</mi>
<mo>&OverBar;</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>25</mn>
<mo>)</mo>
</mrow>
</mrow>
Γ=RTτ (26)
令x1=η,则动力学模型(22)写为如下形式:
<mrow>
<mfenced open = "{" close = "">
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msub>
<mi>x</mi>
<mn>2</mn>
</msub>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>=</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>&Gamma;</mi>
<mo>-</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>G</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>27</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,表示矩阵Mη的逆矩阵;Mη是Mη(η)的简称;
以式(27)所描述的数学模型为被控对象,采用反步方法设计航迹控制律;
2)设计航迹控制律
根据指令航迹与实际航迹之间的航迹控制误差量e,定义如下虚拟量:
<mrow>
<msub>
<mi>&alpha;</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mi>e</mi>
<mo>+</mo>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>28</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,α1为虚拟量,k1为可调的控制参数;
定义虚拟量α1与x2之间的误差e′:
e′=x2-α1 (29)
式(29)对时间微分并将式(27)代入,可得:
<mrow>
<msup>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<msub>
<mover>
<mi>x</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>2</mn>
</msub>
<mo>-</mo>
<msub>
<mover>
<mi>&alpha;</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>r</mi>
<mo>-</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>N</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>G</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>30</mn>
<mo>)</mo>
</mrow>
</mrow>
令
<mrow>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<msub>
<mi>N</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>G</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>&eta;</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>31</mn>
<mo>)</mo>
</mrow>
</mrow>
则式(31)可表示为:
<mrow>
<msup>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>&prime;</mo>
</msup>
<mo>=</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>r</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>32</mn>
<mo>)</mo>
</mrow>
</mrow>
选取Lyapunov函数V1
<mrow>
<msub>
<mi>V</mi>
<mn>1</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>e</mi>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mi>e</mi>
<mrow>
<mo>&prime;</mo>
<mi>T</mi>
</mrow>
</msup>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>33</mn>
<mo>)</mo>
</mrow>
</mrow>
式(33)对时间微分,并将式(32)代入,可得:
<mrow>
<msub>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>e</mi>
<mo>+</mo>
<msup>
<mi>e</mi>
<mrow>
<mo>&prime;</mo>
<mi>T</mi>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mi>f</mi>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mi>&Gamma;</mi>
<mo>+</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>)</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>34</mn>
<mo>)</mo>
</mrow>
</mrow>
根据式(34),设计如下航迹控制律:
<mrow>
<mi>&Gamma;</mi>
<mo>=</mo>
<msub>
<mi>M</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mi>e</mi>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<mi>f</mi>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>)</mo>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>35</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,k2为可调的控制参数;
3)稳定性分析
将航迹控制律式(35)代入式(34),可得:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>1</mn>
</msub>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>e</mi>
<mo>+</mo>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<mi>e</mi>
<mrow>
<mo>&prime;</mo>
<mi>T</mi>
</mrow>
</msup>
<mo>{</mo>
<mi>f</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<msubsup>
<mi>M</mi>
<mi>&eta;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msubsup>
<mo>&lsqb;</mo>
<msub>
<mi>M</mi>
<mi>&eta;</mi>
</msub>
<mrow>
<mo>(</mo>
<mo>-</mo>
<mi>e</mi>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>-</mo>
<mi>f</mi>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>)</mo>
<mo>&rsqb;</mo>
<mo>+</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<mover>
<mi>e</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>-</mo>
<mi>k</mi>
<msub>
<mover>
<mi>&eta;</mi>
<mo>&CenterDot;&CenterDot;</mo>
</mover>
<mi>d</mi>
</msub>
<mo>}</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>e</mi>
<mo>+</mo>
<msup>
<mi>e</mi>
<mrow>
<mo>&prime;</mo>
<mi>T</mi>
</mrow>
</msup>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mo>+</mo>
<msup>
<mi>e</mi>
<mrow>
<mo>&prime;</mo>
<mi>T</mi>
</mrow>
</msup>
<mrow>
<mo>(</mo>
<mn>1</mn>
<mo>-</mo>
<mi>e</mi>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<msup>
<mi>e</mi>
<mi>T</mi>
</msup>
<mi>e</mi>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
<msup>
<mi>e</mi>
<mrow>
<mo>&prime;</mo>
<mi>T</mi>
</mrow>
</msup>
<msup>
<mi>e</mi>
<mo>&prime;</mo>
</msup>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>36</mn>
<mo>)</mo>
</mrow>
</mrow>
式(36)表明:采用航迹控制律(35)能够保证闭环***的稳定性;
步骤四:神经网络逼近器设计:以航迹控制误差量e及其变化率实际航迹η及其变化率为神经网络的输入变量,以飞艇动力学模型的估计值为神经网络的输出变量设计神经网络逼近器,利用神经网络无限逼近功能估计未知的不确定模型,以提高控制精度。
2.根据权利要求1所述的飞艇三维航迹跟踪的反步神经网络控制方法,其特征在于:所述步骤四所述的神经网络逼近器,其设计方法为:
1)由于在实际飞行过程中难以对飞艇进行精确建模,f(x)为未知函数,难以根据式(35)进行控制律解算,因此,须采用f(x)的估计值对航迹控制律式(35)进行解算;采用神经网络逼近未知函数f(x),则有:
f(x)=wTh(x)+ε (37)
式中,w为神经网络的权重向量,ε为逼近误差,h(x)=[hi(x)]T,hi(x)为高斯基函数,下标i表示第i个高斯基函数;
2)选择输入输出变量
令航迹控制误差量e及其变化率实际航迹η及其变化率为神经网络逼近器的输入变量,令估计值为神经网络逼近器的输出变量;
3)设计神经网络结构
神经网络结构包括输入层、隐层和输出层;
输入层:选取神经网络的输入变量为
隐层:选取高斯函数作为隐层节点的基函数
<mrow>
<msub>
<mi>h</mi>
<mi>i</mi>
</msub>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>exp</mi>
<mrow>
<mo>(</mo>
<mfrac>
<mrow>
<mo>|</mo>
<mo>|</mo>
<mi>x</mi>
<mo>-</mo>
<mi>c</mi>
<mo>|</mo>
<msup>
<mo>|</mo>
<mn>2</mn>
</msup>
</mrow>
<mrow>
<mn>2</mn>
<msubsup>
<mi>&sigma;</mi>
<mi>i</mi>
<mn>2</mn>
</msubsup>
</mrow>
</mfrac>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>38</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,c=[ci]T,ci为第i个高斯函数的中值,σi为第i个节点的基宽度参数,||·||表示欧几里德范数;
输出层:神经网络逼近器的输出为
<mrow>
<mover>
<mi>f</mi>
<mo>^</mo>
</mover>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>=</mo>
<msup>
<mover>
<mi>w</mi>
<mo>^</mo>
</mover>
<mi>T</mi>
</msup>
<mi>h</mi>
<mrow>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>39</mn>
<mo>)</mo>
</mrow>
</mrow>
其中,为w的估计值;
4)稳定性分析
定义与w差值:
<mrow>
<mover>
<mi>w</mi>
<mo>~</mo>
</mover>
<mo>=</mo>
<mi>w</mi>
<mo>-</mo>
<mover>
<mi>w</mi>
<mo>^</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>40</mn>
<mo>)</mo>
</mrow>
</mrow>
选取Lyapunov函数:
<mrow>
<msub>
<mi>V</mi>
<mn>2</mn>
</msub>
<mo>=</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>&xi;</mi>
<mo>+</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>41</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,ξ=[e e′]T,Θ为可调的正定矩阵,λ-1表示矩阵λ的逆矩阵;
对式(41)微分,可得:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mover>
<mi>&xi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
<msubsup>
<mi>e</mi>
<mn>1</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>e</mi>
<mn>1</mn>
</msub>
<mo>-</mo>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
<msubsup>
<mi>e</mi>
<mn>2</mn>
<mi>T</mi>
</msubsup>
<msub>
<mi>e</mi>
<mn>2</mn>
</msub>
<mo>+</mo>
<msubsup>
<mi>e</mi>
<mn>2</mn>
<mi>T</mi>
</msubsup>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>w</mi>
<mo>^</mo>
</mover>
<mi>T</mi>
</msup>
<mi>h</mi>
<mo>(</mo>
<mi>x</mi>
<mo>)</mo>
<mo>+</mo>
<mi>&epsiv;</mi>
<mo>)</mo>
</mrow>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>42</mn>
<mo>)</mo>
</mrow>
</mrow>
定义
<mrow>
<mi>k</mi>
<mo>=</mo>
<mfenced open = "[" close = "]">
<mtable>
<mtr>
<mtd>
<msub>
<mi>k</mi>
<mn>1</mn>
</msub>
</mtd>
<mtd>
<mn>0</mn>
</mtd>
</mtr>
<mtr>
<mtd>
<mn>0</mn>
</mtd>
<mtd>
<msub>
<mi>k</mi>
<mn>2</mn>
</msub>
</mtd>
</mtr>
</mtable>
</mfenced>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>43</mn>
<mo>)</mo>
</mrow>
</mrow>
则式(42)可写为:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mover>
<mi>&xi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>w</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mover>
<mi>w</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>k</mi>
<mi>&xi;</mi>
<mo>+</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>&epsiv;</mi>
<mo>+</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>&Psi;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>k</mi>
<mi>&xi;</mi>
<mo>+</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>&epsiv;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<msup>
<mi>&Psi;&xi;</mi>
<mi>T</mi>
</msup>
<mo>+</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>44</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,
设计如下自适应律:
<mrow>
<mover>
<mover>
<mi>W</mi>
<mo>^</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>=</mo>
<msup>
<mi>&lambda;&Psi;&xi;</mi>
<mi>T</mi>
</msup>
<mo>-</mo>
<mi>&gamma;</mi>
<mi>&lambda;</mi>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>^</mo>
</mover>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>45</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,γ>0为可调的参数,
将自适应律代入式(44),可得:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>=</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mover>
<mi>&xi;</mi>
<mo>&CenterDot;</mo>
</mover>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>w</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mover>
<mover>
<mi>w</mi>
<mo>~</mo>
</mover>
<mo>&CenterDot;</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>k</mi>
<mi>&xi;</mi>
<mo>+</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>&epsiv;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<msup>
<mi>&Psi;&xi;</mi>
<mi>T</mi>
</msup>
<mo>-</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<msup>
<mi>&lambda;</mi>
<mrow>
<mo>-</mo>
<mn>1</mn>
</mrow>
</msup>
<mo>(</mo>
<mrow>
<msup>
<mi>&lambda;&Psi;&xi;</mi>
<mi>T</mi>
</msup>
<mo>-</mo>
<mi>&gamma;</mi>
<mi>&lambda;</mi>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>k</mi>
<mi>&xi;</mi>
<mo>+</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>&epsiv;</mi>
<mo>+</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<mi>&gamma;</mi>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>=</mo>
<mo>-</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>k</mi>
<mi>&xi;</mi>
<mo>+</mo>
<msup>
<mi>&xi;</mi>
<mi>T</mi>
</msup>
<mi>&epsiv;</mi>
<mo>+</mo>
<mi>&gamma;</mi>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<mo>(</mo>
<mrow>
<mi>W</mi>
<mo>-</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
</mrow>
<mo>)</mo>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>46</mn>
<mo>)</mo>
</mrow>
</mrow>
根据Schwarz不等式,有:
<mrow>
<mi>t</mi>
<mi>r</mi>
<mrow>
<mo>(</mo>
<msup>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mi>T</mi>
</msup>
<mo>(</mo>
<mi>W</mi>
<mo>-</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>)</mo>
</mrow>
<mo>)</mo>
<mo>&le;</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mo>|</mo>
<mo>|</mo>
<mi>W</mi>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mo>-</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>|</mo>
<msubsup>
<mo>|</mo>
<mi>F</mi>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>47</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,||·||F表示Frobenius范数;
将式(47)代入式(46),可得:
<mrow>
<mtable>
<mtr>
<mtd>
<mrow>
<msub>
<mover>
<mi>V</mi>
<mo>&CenterDot;</mo>
</mover>
<mn>3</mn>
</msub>
<mo>&le;</mo>
<mo>-</mo>
<msub>
<mi>k</mi>
<mi>min</mi>
</msub>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>+</mo>
<msub>
<mi>&epsiv;</mi>
<mi>N</mi>
</msub>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>+</mo>
<mi>&gamma;</mi>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>&lsqb;</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>^</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<mi>W</mi>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mo>-</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>&rsqb;</mo>
</mrow>
</mtd>
</mtr>
<mtr>
<mtd>
<mrow>
<mo>&le;</mo>
<mo>-</mo>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>&lsqb;</mo>
<msub>
<mi>k</mi>
<mi>min</mi>
</msub>
<mo>|</mo>
<mo>|</mo>
<mi>&xi;</mi>
<mo>|</mo>
<mo>|</mo>
<mo>-</mo>
<msub>
<mi>&epsiv;</mi>
<mi>N</mi>
</msub>
<mo>+</mo>
<mi>&gamma;</mi>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>^</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>^</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mo>-</mo>
<msub>
<mi>W</mi>
<mi>M</mi>
</msub>
<mo>)</mo>
</mrow>
</mrow>
</mtd>
</mtr>
</mtable>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>48</mn>
<mo>)</mo>
</mrow>
</mrow>
式中,εN为逼近误差的上界,kmin为可调参数矩阵k的最小特征值,WM为权重矩阵W的最大值元素;
考虑到如下等式:
<mrow>
<mi>&gamma;</mi>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mo>-</mo>
<msub>
<mi>W</mi>
<mi>M</mi>
</msub>
<mo>)</mo>
</mrow>
<mo>=</mo>
<mi>&gamma;</mi>
<msup>
<mrow>
<mo>(</mo>
<mo>|</mo>
<mo>|</mo>
<mover>
<mi>W</mi>
<mo>~</mo>
</mover>
<mo>|</mo>
<msub>
<mo>|</mo>
<mi>F</mi>
</msub>
<mo>-</mo>
<mfrac>
<mn>1</mn>
<mn>2</mn>
</mfrac>
<msub>
<mi>W</mi>
<mi>M</mi>
</msub>
<mo>)</mo>
</mrow>
<mn>2</mn>
</msup>
<mo>-</mo>
<mfrac>
<mi>&gamma;</mi>
<mn>4</mn>
</mfrac>
<msubsup>
<mi>W</mi>
<mi>M</mi>
<mn>2</mn>
</msubsup>
<mo>-</mo>
<mo>-</mo>
<mo>-</mo>
<mrow>
<mo>(</mo>
<mn>49</mn>
<mo>)</mo>
</mrow>
</mrow>
若使得则须有以下不等式成立:
或若则有||ξ||和一致最终有界,从||ξ||的收敛性可得:航迹跟踪精度与神经网络逼近误差上界εN、可调参数矩阵k有关;
由此,通过神经网络逼近器能够精确估计不确定的飞艇非线性动力学模型。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510221276.7A CN104793629B (zh) | 2015-05-04 | 2015-05-04 | 一种飞艇三维航迹跟踪的反步神经网络控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201510221276.7A CN104793629B (zh) | 2015-05-04 | 2015-05-04 | 一种飞艇三维航迹跟踪的反步神经网络控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN104793629A CN104793629A (zh) | 2015-07-22 |
CN104793629B true CN104793629B (zh) | 2017-09-26 |
Family
ID=53558513
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201510221276.7A Active CN104793629B (zh) | 2015-05-04 | 2015-05-04 | 一种飞艇三维航迹跟踪的反步神经网络控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN104793629B (zh) |
Families Citing this family (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN105353612B (zh) * | 2015-11-04 | 2016-08-17 | 中国人民解放军国防科学技术大学 | 一种飞艇模糊反步驻留控制方法 |
CN107065847B (zh) * | 2016-03-31 | 2020-03-20 | 北京航空航天大学 | 一种执行器非对称饱和的水面舰船轨迹跟踪控制方法 |
CN105890626A (zh) * | 2016-05-19 | 2016-08-24 | 极翼机器人(上海)有限公司 | 一种抗磁干扰的方法 |
CN106125757B (zh) * | 2016-07-12 | 2019-02-12 | 中国人民解放军国防科学技术大学 | 一种欠驱动飞艇航迹跟踪控制方法 |
CN106406095B (zh) * | 2016-10-26 | 2019-06-07 | 北京航空航天大学 | 输入输出非对称受限的全驱动水面舰船轨迹跟踪控制方法 |
CN106933237B (zh) * | 2017-02-28 | 2020-08-18 | 北京天恒长鹰科技股份有限公司 | 一种平流层飞艇的被动容错控制方法 |
CN107491088B (zh) * | 2017-08-23 | 2020-04-14 | 中国人民解放军国防科技大学 | 一种输入饱和的飞艇航迹控制方法 |
CN108388126A (zh) * | 2018-03-15 | 2018-08-10 | 浙江工业大学 | 基于非对称时变正切余弦复合型约束李雅普诺夫函数的四旋翼飞行器输出受限控制方法 |
CN108717265B (zh) * | 2018-05-30 | 2021-05-18 | 重庆邮电大学 | 一种基于控制变量参数化的无人飞行器巡航跟踪控制***及控制方法 |
CN112034865B (zh) * | 2020-08-12 | 2021-10-08 | 浙江大学 | 基于优化算法的全驱动水下航行器航迹跟踪控制方法 |
CN113189867B (zh) * | 2021-03-24 | 2023-11-14 | 大连海事大学 | 一种考虑位姿与速度受限的无人船自学习最优跟踪控制方法 |
Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6611823B1 (en) * | 2000-04-20 | 2003-08-26 | Board Of Regents, The University Of Texas System | Backlash compensation using neural network |
JP2011209988A (ja) * | 2010-03-30 | 2011-10-20 | Nippon Telegr & Teleph Corp <Ntt> | 軌道追従制御装置、方法及びプログラム |
CN102385316A (zh) * | 2011-09-16 | 2012-03-21 | 哈尔滨工程大学 | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 |
CN102759928A (zh) * | 2012-04-28 | 2012-10-31 | 中国人民解放军国防科学技术大学 | 一种平流层飞艇航迹控制方法 |
CN102866635A (zh) * | 2012-09-29 | 2013-01-09 | 西北工业大学 | 基于等价模型的高超声速飞行器离散神经网络自适应控制方法 |
CN103324195A (zh) * | 2013-06-14 | 2013-09-25 | 哈尔滨工程大学 | 基于反步法的船舶自适应鲁棒航向跟踪控制方法 |
CN104118555A (zh) * | 2014-07-14 | 2014-10-29 | 北京大学 | 一种无人自主飞艇及其飞行控制***的建立方法 |
CN104281155A (zh) * | 2014-11-07 | 2015-01-14 | 中国人民解放军国防科学技术大学 | 一种无人飞艇三维航迹跟踪方法 |
-
2015
- 2015-05-04 CN CN201510221276.7A patent/CN104793629B/zh active Active
Patent Citations (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US6611823B1 (en) * | 2000-04-20 | 2003-08-26 | Board Of Regents, The University Of Texas System | Backlash compensation using neural network |
JP2011209988A (ja) * | 2010-03-30 | 2011-10-20 | Nippon Telegr & Teleph Corp <Ntt> | 軌道追従制御装置、方法及びプログラム |
CN102385316A (zh) * | 2011-09-16 | 2012-03-21 | 哈尔滨工程大学 | 一种基于神经网络反步法的欠驱动自主水下航行器变深控制方法 |
CN102759928A (zh) * | 2012-04-28 | 2012-10-31 | 中国人民解放军国防科学技术大学 | 一种平流层飞艇航迹控制方法 |
CN102866635A (zh) * | 2012-09-29 | 2013-01-09 | 西北工业大学 | 基于等价模型的高超声速飞行器离散神经网络自适应控制方法 |
CN103324195A (zh) * | 2013-06-14 | 2013-09-25 | 哈尔滨工程大学 | 基于反步法的船舶自适应鲁棒航向跟踪控制方法 |
CN104118555A (zh) * | 2014-07-14 | 2014-10-29 | 北京大学 | 一种无人自主飞艇及其飞行控制***的建立方法 |
CN104281155A (zh) * | 2014-11-07 | 2015-01-14 | 中国人民解放军国防科学技术大学 | 一种无人飞艇三维航迹跟踪方法 |
Non-Patent Citations (2)
Title |
---|
基于神经动态模型的自治水面艇智能跟踪控制;潘昌忠;《中国博士学位论文全文数据库 信息科技辑》;20150215(第2期);全文 * |
自主飞艇姿态跟踪的终端滑模控制;杨跃能 等;《中国空间科学技术》;20120831(第4期);第29-36页 * |
Also Published As
Publication number | Publication date |
---|---|
CN104793629A (zh) | 2015-07-22 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN104793629B (zh) | 一种飞艇三维航迹跟踪的反步神经网络控制方法 | |
Wadoo et al. | Autonomous underwater vehicles: modeling, control design and simulation | |
CN109144084B (zh) | 一种基于固定时间收敛观测器的垂直起降重复使用运载器姿态跟踪控制方法 | |
Goodarzi et al. | Geometric adaptive tracking control of a quadrotor unmanned aerial vehicle on SE (3) for agile maneuvers | |
CN106773713B (zh) | 针对欠驱动海洋航行器的高精度非线性路径跟踪控制方法 | |
CN105242683B (zh) | 一种飞艇神经网络终端滑模航迹控制方法 | |
CN104360686B (zh) | 一种飞艇非奇异终端滑模航迹控制方法 | |
CN104281155B (zh) | 一种无人飞艇三维航迹跟踪方法 | |
Li et al. | Robust adaptive motion control for underwater remotely operated vehicles with velocity constraints | |
Dhadekar et al. | Robust control of quadrotor using uncertainty and disturbance estimation | |
CN105912009B (zh) | 基于极点配置和模糊自抗扰控制技术的四旋翼飞行器控制方法 | |
Woo et al. | Integration of path planning, trajectory generation and trajectory tracking control for aircraft mission autonomy | |
CN110347170A9 (zh) | 可重复使用运载器再入段鲁棒容错制导控制***及工作方法 | |
CN105629732A (zh) | 一种考虑控制受限的航天器姿态输出反馈跟踪控制方法 | |
CN104536448B (zh) | 一种基于Backstepping法的无人机姿态***控制方法 | |
CN110488854B (zh) | 一种基于神经网络估计的刚性飞行器固定时间姿态跟踪控制方法 | |
Wang et al. | Trajectory tracking of vertical take-off and landing unmanned aerial vehicles based on disturbance rejection control | |
Suresh et al. | An on-line learning neural controller for helicopters performing highly nonlinear maneuvers | |
Zhou et al. | Spatial path following control of an autonomous underactuated airship | |
Prach et al. | Development of a state dependent riccati equation based tracking flight controller for an unmanned aircraft | |
Lin et al. | Standoff tracking of a ground target based on coordinated turning guidance law | |
Zhao et al. | Trajectory tracking control for parafoil systems based on the model-free adaptive control method | |
Zhu et al. | Robust constrained trajectory tracking control for quadrotor unmanned aerial vehicle based on disturbance observers | |
Sandino et al. | On the applicability of linear control techniques for autonomous landing of helicopters on the deck of a ship | |
CN107703967B (zh) | 一种控制受限飞艇航迹控制方法 |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
EXSB | Decision made by sipo to initiate substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |