CN107450319B - 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 - Google Patents
一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 Download PDFInfo
- Publication number
- CN107450319B CN107450319B CN201710731297.2A CN201710731297A CN107450319B CN 107450319 B CN107450319 B CN 107450319B CN 201710731297 A CN201710731297 A CN 201710731297A CN 107450319 B CN107450319 B CN 107450319B
- Authority
- CN
- China
- Prior art keywords
- airship
- terminal sliding
- sliding mode
- track
- coordinate
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05B—CONTROL OR REGULATING SYSTEMS IN GENERAL; FUNCTIONAL ELEMENTS OF SUCH SYSTEMS; MONITORING OR TESTING ARRANGEMENTS FOR SUCH SYSTEMS OR ELEMENTS
- G05B13/00—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion
- G05B13/02—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric
- G05B13/04—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators
- G05B13/042—Adaptive control systems, i.e. systems automatically adjusting themselves to have a performance which is optimum according to some preassigned criterion electric involving the use of models or simulators in which a parameter or coefficient is automatically adjusted to optimise the performance
Landscapes
- Engineering & Computer Science (AREA)
- Software Systems (AREA)
- Artificial Intelligence (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Evolutionary Computation (AREA)
- Medical Informatics (AREA)
- Health & Medical Sciences (AREA)
- Physics & Mathematics (AREA)
- General Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- Other Investigation Or Analysis Of Materials By Electrical Means (AREA)
- Medicines Containing Antibodies Or Antigens For Use As Internal Diagnostic Agents (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,针对终端滑模控制的奇异问题以及误差收敛时间问题,定义了一种指定时间收敛的终端滑模函数,设计了非奇异终端滑模航迹控制律。由该方法控制的闭环系统能够在指定时间跟踪指令航迹,跟踪误差在指定时间内收敛至零,为飞艇航迹控制的工程实现提供了有效方案。
Description
技术领域
本发明涉及自动控制技术领域,具体的涉及一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法。
背景技术
飞艇是一种典型的浮空器,依靠艇囊内轻于空气的气体(如氦气)升空,具有能耗低、滞空时间长等优点,广泛应用于对地观测、侦察监视、环境监测、国土测绘等领域,具有重要应用价值和广阔的应用前景,当前已成为航空领域的研究热点。完成上述飞行任务均要求高精度的航迹控制,即操控飞艇按照预定的航迹飞行。飞艇的飞行力学具有非线性、通道耦合、不确定等特点,使得航迹控制成为一项关键技术难题。
已有文献针对飞艇航迹控制问题,采用滑模控制方法设计航迹控制律。滑模控制中的滑动模态可以按需要设计,且系统的滑模运动与受控对象的参数变化及外界扰动无关,因此,滑动模态对系统参数摄动及外界干扰不敏感,具有良好的鲁棒性。但是,滑模控制的跟踪误差不能在有限时间收敛,是渐近收敛的。由此,提出了终端滑模控制方法以解决滑模控制的渐近收敛问题。但是,终端滑模控制存在两大问题:一是奇异问题,二是收敛时间与初始状态及滑模参数有关。
发明内容
为解决上述问题,本发明提供了一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法。
本发明针对飞艇的航迹跟踪问题,建立了其空间运动的数学模型;以此模型为受控对象,定义了一种指定时间收敛的终端滑模函数,设计了非奇异终端滑模航迹控制律。由该方法控制的闭环系统能够在指定时间跟踪指令航迹,跟踪误差在指定时间内收敛至零,为飞艇航迹控制的工程实现提供了有效方案。
本发明提供一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,包括以下步骤:
步骤S100:设定指令航迹:ηd=[xd,yd,zd,θd,ψd,φd]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角,上标T表示向量或矩阵的转置,计算指令航迹与实际航迹之间的误差量e及其导数定义系统状态误差为
步骤S200:建立飞艇空间运动的数学模型;
步骤S300:定义指定时间收敛的终端滑模面:
终端滑模面定义如下:
s=CE(t)-CP(t) (1)
式中,C=[c1,c2],cα=diag(cα1,cα2,cα3,cα4,cα5,cα6),cαj>0为设计参数,α=1,2,j=1,2,3,4,5,6;p(t)=[p1(t),p2(t),p3(t),p4(t),p5(t),p6(t)]T,pi(t),i=1,2,3,4,5,6,其中,pi(t)满足以下条件:pi(t)∈C2[0,∞),对某一常数T>0,pi(t)在[0,T]区间有界,且pi(0)=ei(0),
函数pi(t)表达式为:
式中,k=0,1,2,aλn为设计参数,λ,n=0,1,2;
步骤S400:根据数学模型和终端滑模面设计终端滑模的航迹控制律u,
航迹控制律为:
其中,γ>0,
其中,在步骤S100中指令航迹为广义坐标ηd=[xd,yd,zd,θd,ψd,φd]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角,上标T表示向量或矩阵的转置;
步骤S500:根据控制律u计算航迹控制量,输出控制量对飞艇进行控制,对控制量的控制结果进行判断是否满足预设控制要求,如果不满足,则调整控制参数后返回步骤S200重新定义终端滑膜面,如果满足则控制结束。
进一步地,建立飞艇空间运动的数学模型包括以下步骤:
步骤S310:确定飞艇的坐标系及运动参数;
采用地面坐标系oexyz和体坐标系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;步骤S320:构建飞艇的数学模型:
飞艇空间运动的数学模型描述如下:
式中
其中:
式中,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的距离,
式(5)为关于广义速度V的表达式,需要将其变换为关于广义坐标η的表达式,
由式(4)可得:
式中,J-1(η)为J(η)的逆矩阵,
对式(18)微分,可得
式中
式(21)左乘RTM,可得
综合式(5)、式(21)以及式(24)可得:
式中
Mη=RTMR (25)
u=RTτ (28)
其中,u=[u1,u2,u3,u4,u5,u6]T,τ=[τ1,τ2,τ3,τ4,τ5,τ6]T。
进一步地,按下式计算指令航迹与实际航迹之间的误差量:
e=η-ηd=[x-xd,y-yd,z-zd,θ-θd,ψ-ψd,φ-φd]T (29)
其中,η=[x,y,z,θ,ψ,φ]T为实际航迹,x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角。
进一步地,按下式计算指令航迹与实际航迹之间的误差量的导数:
本发明的技术效果:
1、本发明提供的飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,该方法能够在指定时间内使得跟踪误差收敛至零,解决了传统滑模控制的渐近收敛问题,且收敛时间能够任意指定,与初始状态及滑模参数无关。
2、本发明提供的飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,该方法有效避免了终端滑模控制的奇异问题。控制工程师在应用过程中可以根据实际飞艇给定任意指令航迹,并将由该方法得到的控制量传输至执行机构实现航迹控制功能。
具体请参考根据本发明的飞艇航迹跟踪的指定时间非奇异终端滑模控制方法提出的各种实施例的如下描述,将使得本发明的上述和其他方面显而易见。
附图说明
图1是本发明提供的飞艇航迹跟踪的指定时间非奇异终端滑模控制方法流程示意图;
图2是本发明优选实施例中飞艇坐标系及运动参数定义示意图;
图3是为本发明优选实施例中飞艇航迹控制结果;
图4是本发明优选实施例中飞艇航迹控制误差结果示意图,其中包括X、Y、Z三个轴向上的误差示意图;
图中符号说明如下:
η=[x,y,z,θ,ψ,φ]T为飞艇航迹,其中,x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角;
ηd=[xd,yd,zd,θd,ψd,φd]T为指令航迹,其中xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角;
V=[u,v,w,p,q,r]T为飞艇速度,其中,u、v、w分别为体坐标系中轴向、侧向和垂直方向的速度,p、q、r分别为滚转、俯仰和偏航角速度;
oexyz表示地面坐标系;
obxbybzb表示飞艇体坐标系;
CV为飞艇的浮心;
CG为飞艇的重心;
rG=[xG,yG,zG]T为浮心到重心的矢量;
e=[xe,ye,ze,θe,ψe,φe]T为航迹控制误差,xe、ye、ze、θe、ψe和φe分别为航迹控制的x坐标误差、y坐标误差、z坐标误差、俯仰角误差、偏航角误差和滚转角误差;
u=[u1,u2,u3,u4,u5,u6]T为飞艇航迹控制量,u1为轴向控制力、u2为侧向控制力、u3为垂直方向控制力、u4为滚转控制力矩、u5俯仰控制力矩、u6为偏航控制力矩。
具体实施方式
构成本申请的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。
本发明提供的一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,首先由给定的指令航迹和实际航迹计算误差量及其导数,定义系统状态误差,然后设计一种指定时间收敛的终端滑模面,设计非奇异终端滑模航迹控制律。实际应用中,飞艇航迹由组合导航系统测量得到,将由该方法计算得到的控制量传输至执行机构即可实现航迹控制功能。
参见图1,本发明提供的一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,包括以下步骤:
步骤S100:设定指令航迹:ηd=[xd,yd,zd,θd,ψd,φd]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角,上标T表示向量或矩阵的转置,计算指令航迹与实际航迹之间的误差量e及其导数定义系统状态误差为
步骤S200:建立飞艇空间运动的数学模型;
步骤S300:定义指定时间收敛的终端滑模面:
终端滑模面定义如下:
s=CE(t)-CP(t) (1)
式中,C=[c1,c2],cα=diag(cα1,cα2,cα3,cα4,cα5,cα6),cαj>0为设计参数,α=1,2,j=1,2,3,4,5,6;p(t)=[p1(t),p2(t),p3(t),p4(t),p5(t),p6(t)]T。pi(t),i=1,2,3,4,5,6,其中,pi(t)满足以下条件:pi(t)∈C2[0,∞),对某一常数T>0,pi(t)在[0,T]区间有界,且pi(0)=ei(0),
函数pi(t)表达式为:
式中,k=0,1,2,aλn为设计参数,λ,n=0,1,2;
步骤S400:根据数学模型和终端滑模面设计终端滑模的航迹控制律u,
航迹控制律为:
其中,γ>0。
其中,在步骤S100中指令航迹为广义坐标ηd=[xd,yd,zd,θd,ψd,φd]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角,上标T表示向量或矩阵的转置;
步骤S500:根据控制律u计算航迹控制量,输出控制量对飞艇进行控制,对控制量的控制结果进行判断是否满足预设控制要求,如果不满足,则调整控制参数后返回步骤S200重新定义终端滑膜面,如果满足则控制结束。
通过设计得到的航迹控制律,在指定时间内使得跟踪误差收敛至零,且收敛时间能够任意指定,与初始状态及滑模参数无关。该方法中未详述部分按现有方法中的常用步骤进行即可。终端滑模控制的误差收敛时间由初始状态及滑模参数决定。飞艇空间运动的数学模型构建可以按现有方法进行。
优选的,建立飞艇空间运动的数学模型包括以下步骤:
步骤S310:确定飞艇的坐标系及运动参数;
为便于描述,飞艇空间运动的坐标系及运动参数如图2所示,采用地面坐标系oexyz和体坐标系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。
步骤S320:构建飞艇的数学模型:
飞艇空间运动的数学模型描述如下:
式中
其中
式中,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的距离。
式(5)为关于广义速度V的表达式,需要将其变换为关于广义坐标η的表达式。
由式(4)可得:
式中,J-1(η)为J(η)的逆矩阵。
对式(18)微分,可得
式中
式(21)左乘RTM,可得
综合式(5)、式(21)以及式(24)可得:
式中
Mη=RTMR (25)
u=RTτ (28)
其中,u=[u1,u2,u3,u4,u5,u6]T,τ=[τ1,τ2,τ3,τ4,τ5,τ6]T。
优选的,按下式计算指令航迹与实际航迹之间的误差量:
e=η-ηd=[x-xd,y-yd,z-zd,θ-θd,ψ-ψd,φ-φd]T (29)
其中,η=[x,y,z,θ,ψ,φ]T为实际航迹,x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角。
优选的,按下式计算指令航迹与实际航迹之间的误差量的导数:
下面结合附图,对本发明中的设计方法作进一步的说明:
本发明提供的一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,包括以下步骤:
步骤一:给定指令航迹
给定指令航迹为:
ηd=[xd,yd,zd,θd,ψd,φd]T=[180sin(0.01t)m,120sin(0.02t)m,10m,0rad,0.02rad,0rad]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角;
步骤二:误差量计算
计算指令航迹与实际航迹之间的误差量:
e=η-ηd=[x-xd,y-yd,z-zd,θ-θd,ψ-ψd,φ-φd]T,
其中,η=[x,y,z,θ,ψ,φ]T为实际航迹,x、y、z、θ、ψ、φ分别为实际航迹的x坐标、y坐标、z坐标、俯仰角、偏航角和滚转角,为连续变化值。
初始航迹为:
η0=[x0,y0,z0,θ0,ψ0,φ0]T=[50m,-50m,10m,0.01rad,0.01rad,0.01rad]T。
初始速度:
V0=[u0,v0,w0,p0,q0,r0]T=[15m/s,2.5m/s,0m/s,0.001rad/s,0.001rad/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的距离。
式(31)为关于广义速度V的表达式,需要将其变换为关于广义坐标η的表达式。
由式(30)可得:
式中,J-1(η)为J(η)的逆矩阵,
对式(44)微分,可得
式中
式(47)左乘RTM,可得
综合式(31)、式(47)以及式(49)可得:
式中
Mη(η)=RTMR (52)
u=RTτ (55)
其中,u=[u1,u2,u3,u4,u5,u6]T,τ=[τ1,τ2,τ3,τ4,τ5,τ6]T。
本实施例中的飞艇参数见表1。
表1飞艇参数表
2)航迹控制律设计
定义如下终端滑模面:
s=CE(t)-CP(t) (56)
式中,C=[c1,c2],c1=diag(2,2,2,5,5,5),c2=diag(0.001,0.002,0.002,0.01,0.01,0.01);diag(·)表示对角矩阵;p(t)=[p1(t),p2(t),p3(t),p4(t),p5(t),p6(t)]T。pi(t),i=1,2,3,4,5,6,pi(t)表达式为:
其中,T=20s。
设计航迹控制律,航迹控制量为:
其中,γ=10。
本实施例中的飞艇三维航迹跟踪结果如图3~4所示。图3给出了飞艇航迹控制结果,由图3可得:飞艇的实际航迹η能够准确地跟踪指令航迹ηd,验证了本发明所提出的航迹控制方法的有效准确性。图4为航迹控制误差,由图4可得:飞艇X、Y、Z方向上的航迹控制误差能够在较短的指定的时间内收敛至零,均能在20s左右的时间内实现收敛。
本领域技术人员将清楚本发明的范围不限制于以上讨论的示例,有可能对其进行若干改变和修改,而不脱离所附权利要求书限定的本发明的范围。尽管己经在附图和说明书中详细图示和描述了本发明,但这样的说明和描述仅是说明或示意性的,而非限制性的。本发明并不限于所公开的实施例。
通过对附图,说明书和权利要求书的研究,在实施本发明时本领域技术人员可以理解和实现所公开的实施例的变形。在权利要求书中,术语“包括”不排除其他步骤或元素,而不定冠词“一个”或“一种”不排除多个。在彼此不同的从属权利要求中引用的某些措施的事实不意味着这些措施的组合不能被有利地使用。权利要求书中的任何参考标记不构成对本发明的范围的限制。
Claims (4)
1.一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,其特征在于,包括以下步骤:
步骤S100:设定指令航迹:ηd=[xd,yd,zd,θd,ψd,φd]T,xd、yd、zd、θd、ψd和φd分别为指令x坐标、指令y坐标、指令z坐标、指令俯仰角、指令偏航角和指令滚转角,上标T表示向量或矩阵的转置,计算所述指令航迹与实际航迹之间的误差量e及其导数定义系统状态误差为
步骤S200:建立飞艇空间运动的数学模型;
步骤S300:定义指定时间收敛的终端滑模面:
所述终端滑模面定义如下:
s=CE(t)-CP(t) (1)
式中,C=[c1,c2],cα=diag(cα1,cα2,cα3,cα4,cα5,cα6),cαj>0为设计参数,α=1,2,j=1,2,3,4,5,6;p(t)=[p1(t),p2(t),p3(t),p4(t),p5(t),p6(t)]T,pi(t),i=1,2,3,4,5,6,其中,pi(t)满足以下条件:对某一常数T>0,pi(t)在[0,T]区间有界,且pi(0)=ei(0),ei(0)为所述误差量e在t=0时刻的值,
函数pi(t)表达式为:
式中,k=0,1,2,aλn为设计参数,λ,n=0,1,2;
步骤S400:根据所述数学模型和所述终端滑模面设计所述终端滑模的非奇异终端滑模控制律u,
所述终端滑模的非奇异终端滑模控制律为:
其中:
Nu=(m+m22)vr-(m+m33)wq+m[xG(p2+r2)-yGpq-zGpr]+QV2/3(-CX cosαcosβ+CY cosαsinβ+CZ sinα)
Nv=(m+m33)wp-(m+m11)ur-m[xGpq-yG(p2+r2)+zGqr]+QV2/3(CX sinβ+CY cosβ)
Nw=(m+m22)vp-(m+m11)uq-m[xGpr+yGqr-zG(p2+q2)]+QV2/3(-CX sinαsinβ+CY sinαcosβ-CZ cosα)
Np=[(Iy+I22)-(Iz+I33)]qr+Ixzpq-Ixypr-Iyz(r2-q2)+[mzG(ur-wp)+yG(uq-vp)]+QVCl
Nq=[(Iz+I33)-(Ix+I22)]pr+Ixyqr-Iyzpq-Ixz(p2-r2)+m[xG(vp-uq)-zG(wp-vr)]+QVCm
Nr=[(Iy+I22)-(Ix+I11)]pq-Ixzqr-Ixy(q2-p2)+Iyzpr+m[yG(wq-vr)-xG(ur-wp)]+QVCn
式中,采用地面坐标系oexyz和体坐标系obxbybzb对飞艇的空间运动进行描述,CV为浮心,CG为重心,浮心到重心的矢量为rG=[xG,yG,zG]T,
运动参数定义:位置P=[x,y,z]T,姿态角Ω=[θ,ψ,φ]T,速度v=[u,v,w]T,u、v、w分别为体坐标系中轴向、侧向和垂直方向的速度;角速度ω=[p,q,r]T,p、q、r分别为滚转、俯仰和偏航角速度,
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的惯量积;lx、ly、lz表示推力作用点距原点ob的距离,
其中,在步骤S100中所述指令航迹为广义坐标,所述函数pi(t)中T的取值决定所述终端滑模面在所述终端滑模的非奇异终端滑模控制律u控制下的收敛时间长度;
步骤S500:根据所述终端滑模的非奇异终端滑模控制律u计算航迹控制量,输出所述控制量对所述飞艇进行控制,对所述控制量的控制结果进行判断是否满足预设控制要求,如果不满足,则调整控制参数后返回步骤S200重新定义所述终端滑膜面,如果满足则控制结束。
2.根据权利要求1所述的飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,其特征在于,所述建立飞艇空间运动的数学模型包括以下步骤:
步骤S310:确定所述飞艇的坐标系及运动参数;
记广义速度为V=[u,v,w,p,q,r]T;
步骤S320:构建所述飞艇的数学模型:
飞艇空间运动的数学模型描述如下:
式中
T为推力大小,μ为推力矢量与obxbzb面之间的夹角,规定其在obxbzb面之左为正,υ为推力矢量在obxbzb面的投影与obxb轴之间的夹角,规定其投影在obxb轴之下为正;式(5)为关于广义速度V的表达式,需要将其变换为关于广义坐标η的表达式,
由式(4)可得:
式中,J-1(η)为J(η)的逆矩阵,
对式(18)微分,可得
式(21)左乘RTM,可得
综合式(5)、式(21)以及式(24)可得:
式中
u=RTτ (28)
其中,u=[u1,u2,u3,u4,u5,u6]T,τ=[τ1,τ2,τ3,τ4,τ5,τ6]T。
3.根据权利要求1所述的飞艇航迹跟踪的指定时间非奇异终端滑模控制方法,其特征在于,按下式计算所述指令航迹与所述实际航迹之间的误差量:
e=η-ηd=[x-xd,y-yd,z-zd,θ-θd,ψ-ψd,φ-φd]T(29)。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710731297.2A CN107450319B (zh) | 2017-08-23 | 2017-08-23 | 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201710731297.2A CN107450319B (zh) | 2017-08-23 | 2017-08-23 | 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN107450319A CN107450319A (zh) | 2017-12-08 |
CN107450319B true CN107450319B (zh) | 2020-10-30 |
Family
ID=60493838
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201710731297.2A Active CN107450319B (zh) | 2017-08-23 | 2017-08-23 | 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN107450319B (zh) |
Families Citing this family (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN111781828B (zh) * | 2020-06-17 | 2022-05-10 | 中国人民解放军军事科学院国防科技创新研究院 | 基于自适应非奇异终端滑模控制的航天器集群控制方法 |
CN115268503B (zh) * | 2022-09-28 | 2023-01-10 | 中国人民解放军国防科技大学 | 一种去奇异化的多飞行器三维协同制导方法 |
Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104360686A (zh) * | 2014-11-07 | 2015-02-18 | 中国人民解放军国防科学技术大学 | 一种飞艇非奇异终端滑模航迹控制方法 |
CN105242683A (zh) * | 2015-11-04 | 2016-01-13 | 中国人民解放军国防科学技术大学 | 一种飞艇神经网络终端滑模航迹控制方法 |
Family Cites Families (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP2016057909A (ja) * | 2014-09-10 | 2016-04-21 | 日産自動車株式会社 | スライディングモード制御装置及び制御方法並びに車両位置決め制御装置 |
CN105700542B (zh) * | 2016-03-30 | 2019-03-01 | 北京航空航天大学 | 一种基于矢量场制导和最小二乘法的平流层飞艇控制分配方法 |
-
2017
- 2017-08-23 CN CN201710731297.2A patent/CN107450319B/zh active Active
Patent Citations (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104360686A (zh) * | 2014-11-07 | 2015-02-18 | 中国人民解放军国防科学技术大学 | 一种飞艇非奇异终端滑模航迹控制方法 |
CN105242683A (zh) * | 2015-11-04 | 2016-01-13 | 中国人民解放军国防科学技术大学 | 一种飞艇神经网络终端滑模航迹控制方法 |
Non-Patent Citations (3)
Title |
---|
Neural network approximation-based nonsingular terminal sliding mode control for trajectory tracking of robotic airships;Yueneng Yang,et al.;《Aerospace Science and Technology》;20160731;第54卷;全文 * |
平流层飞艇动力学建模与控制方法研究;杨跃能;《CNKI中国博士学位论文全文数据库(电子期刊)工程科技II辑》;20141231;第4.1.3.1节,第4.2.3节,及图4.8 * |
自主飞艇姿态跟踪的终端滑模控制;杨跃能 等;《中国空间科学技术》;20120831(第4期);全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN107450319A (zh) | 2017-12-08 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
Zhao et al. | Nonlinear robust adaptive tracking control of a quadrotor UAV via immersion and invariance methodology | |
CN107491088B (zh) | 一种输入饱和的飞艇航迹控制方法 | |
Lee et al. | Adaptive image-based visual servoing for an underactuated quadrotor system | |
JP4685866B2 (ja) | 動的システムを制御するためのシステムおよび方法 | |
Xie et al. | Input saturated visual servoing for unmanned aerial vehicles | |
Zhao et al. | Robust visual servoing control for ground target tracking of quadrotors | |
CN106842912B (zh) | 高超声速机动飞行抗舵面饱和鲁棒控制方法 | |
CN106970530B (zh) | 空间非合作目标自主视线交会的无模型预设性能控制方法 | |
CN104360686B (zh) | 一种飞艇非奇异终端滑模航迹控制方法 | |
CN109703768B (zh) | 一种基于姿态/轨迹复合控制的软式空中加油对接方法 | |
CN114509946B (zh) | 一种基于预设时间滑模的飞行器制导控制一体化设计方法 | |
CN112198885A (zh) | 一种满足机动平台自主降落需求的无人机控制方法 | |
CN109032156A (zh) | 一种基于状态观测的吊挂载荷四旋翼无人机悬停控制方法 | |
CN114815888B (zh) | 一种仿射形式的制导控制一体化控制方法 | |
CN107450319B (zh) | 一种飞艇航迹跟踪的指定时间非奇异终端滑模控制方法 | |
CN107817818A (zh) | 一种模型不确定飞艇航迹跟踪有限时间控制方法 | |
CN107703967B (zh) | 一种控制受限飞艇航迹控制方法 | |
Le Bras et al. | Nonlinear image-based visual servo controller for automatic landing guidance of a fixed-wing aircraft | |
Diao et al. | An output feedback attitude tracking controller design for quadrotor unmanned aerial vehicles using quaternion | |
Tang et al. | Aircraft landing using dynamic two-dimensional image-based guidance control | |
Serra et al. | Visual servo aircraft control for tracking parallel curves | |
Wang et al. | L1 adaptive neural network controller for autonomous aerial refueling with guaranteed transient performance | |
Huo et al. | Integrated guidance and control based on high-order sliding mode method | |
CN114510065A (zh) | 一种多旋翼无人机地面目标跟踪控制方法 | |
Verma et al. | A novel trajectory tracking methodology using structured adaptive model inversion for uninhabited aerial vehicles |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
PB01 | Publication | ||
PB01 | Publication | ||
SE01 | Entry into force of request for substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
GR01 | Patent grant | ||
GR01 | Patent grant |