CN109062042A - 一种旋翼飞行器的有限时间航迹跟踪控制方法 - Google Patents
一种旋翼飞行器的有限时间航迹跟踪控制方法 Download PDFInfo
- Publication number
- CN109062042A CN109062042A CN201810859587.XA CN201810859587A CN109062042A CN 109062042 A CN109062042 A CN 109062042A CN 201810859587 A CN201810859587 A CN 201810859587A CN 109062042 A CN109062042 A CN 109062042A
- Authority
- CN
- China
- Prior art keywords
- rotor craft
- control
- controller
- aircraft
- track
- 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.)
- Granted
Links
- 238000000034 method Methods 0.000 title claims abstract description 25
- 238000011217 control strategy Methods 0.000 claims abstract description 15
- 238000013178 mathematical model Methods 0.000 claims abstract description 5
- 238000006073 displacement reaction Methods 0.000 claims description 20
- 230000009471 action Effects 0.000 claims description 12
- RZVHIXYEVGDQDX-UHFFFAOYSA-N 9,10-anthraquinone Chemical compound C1=CC=C2C(=O)C3=CC=CC=C3C(=O)C2=C1 RZVHIXYEVGDQDX-UHFFFAOYSA-N 0.000 claims description 9
- 238000004422 calculation algorithm Methods 0.000 claims description 5
- 238000012938 design process Methods 0.000 claims description 5
- 230000008878 coupling Effects 0.000 claims description 4
- 238000010168 coupling process Methods 0.000 claims description 4
- 238000005859 coupling reaction Methods 0.000 claims description 4
- 238000009795 derivation Methods 0.000 claims description 4
- 230000001133 acceleration Effects 0.000 claims description 3
- 230000005484 gravity Effects 0.000 claims description 3
- 230000003416 augmentation Effects 0.000 claims description 2
- 238000004364 calculation method Methods 0.000 abstract description 2
- 230000000694 effects Effects 0.000 description 10
- 230000007246 mechanism Effects 0.000 description 3
- 229920006395 saturated elastomer Polymers 0.000 description 3
- 238000000418 atomic force spectrum Methods 0.000 description 2
- 230000008901 benefit Effects 0.000 description 2
- 230000004044 response Effects 0.000 description 2
- 238000004088 simulation Methods 0.000 description 2
- 230000008859 change Effects 0.000 description 1
- 238000010586 diagram Methods 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 239000012530 fluid Substances 0.000 description 1
- 238000009415 formwork Methods 0.000 description 1
- 238000005498 polishing Methods 0.000 description 1
- 230000008569 process Effects 0.000 description 1
- 230000002040 relaxant effect Effects 0.000 description 1
- 238000005096 rolling process Methods 0.000 description 1
- 230000006641 stabilisation Effects 0.000 description 1
- 238000011105 stabilization Methods 0.000 description 1
- 230000001629 suppression Effects 0.000 description 1
- 239000011800 void material Substances 0.000 description 1
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
-
- 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/047—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 the criterion being a time optimal performance criterion
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/08—Control of attitude, i.e. control of roll, pitch, or yaw
- G05D1/0808—Control of attitude, i.e. control of roll, pitch, or yaw specially adapted for aircraft
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
- G05D1/10—Simultaneous control of position or course in three dimensions
- G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
Landscapes
- Engineering & Computer Science (AREA)
- Physics & Mathematics (AREA)
- Automation & Control Theory (AREA)
- General Physics & Mathematics (AREA)
- Computer Vision & Pattern Recognition (AREA)
- Medical Informatics (AREA)
- Software Systems (AREA)
- Evolutionary Computation (AREA)
- Health & Medical Sciences (AREA)
- Artificial Intelligence (AREA)
- Aviation & Aerospace Engineering (AREA)
- Radar, Positioning & Navigation (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明提供了一种旋翼飞行器的有限时间航迹跟踪控制方法,包含以下步骤:建立旋翼飞行器的数学模型;采用分层控制方案,将旋翼飞行器分为高度通道、平动***和姿态***,并针对每个通道单独设计控制器;针对高度通道,设计有限时间控制器产生飞行所需升力,并引入辅助***补偿输入饱和作用;针对平动***,设计有限时间控制器,产生期望滚转角和期望俯仰角;针对姿态***,设计线性自抗扰控制器,产生飞行所需力矩。本发明提供的控制策略不但能够提高旋翼飞行器的收敛速度、跟踪精度和抗扰动能力,还能有效补偿输入饱和对控制性能的影响;本发明提供的控制策略设计简单,计算量少,便于实现,具有很高的实际应用价值。
Description
技术领域
本发明涉及旋翼飞行器自动控制技术领域,具体涉及一种旋翼飞行器的有限时间航迹跟 踪控制方法。
背景技术
旋翼飞行器本质上的垂直起降、自主悬停和高机动飞行能力使其在各行各业都有广泛应 用;同时旋翼飞行器本身的欠驱动、非线性、强耦合特性,以及飞行环境中多变的外部扰动 又给其自主飞行控制带来很大难度,受到控制界专家学者的高度关注。
本发明中考虑的旋翼飞行器是一种共轴十二旋翼无人飞行器,结构如图1所示。十二个 旋翼两两一组,与机体平面成γ角度安装在连杆末端提供飞行动力,相邻的两个旋翼旋转方 向相反。通过改变各个旋翼的转速实现飞行器的各种运动:
高度运动:同时增大或者同时减小每个旋翼的转速。
滚转运动:Ω1+Ω2+Ω11+Ω12≠Ω5+Ω6+Ω7+Ω8
俯仰运动:Ω1+Ω2+Ω3+Ω4+Ω5+Ω6≠Ω7+Ω8+Ω9+Ω10+Ω11+Ω12
偏航运动:Ω1+Ω3+Ω5+Ω7+Ω9+Ω11≠Ω2+Ω4+Ω6+Ω8+Ω10+Ω12
其中Ω1,Ω2,Ω3,Ω4,Ω5,Ω6,Ω7,Ω8,Ω9,Ω10,Ω11,Ω12分别是旋翼1,2,3,4,5,6,7,8,9,10,11,12的转速。
旋翼飞行器的姿态稳定与航迹跟踪控制问题近年来一直受到广泛关注。现有的线性和非 线性控制方法比如PID控制、LQR控制、鲁棒控制、滑模控制、模型预测控制等,都能使 旋翼飞行器获得较好的控制效果,并在一定程度上抑制扰动作用。然而,已有算法大多获得 的仅仅是飞行器闭环***的渐近稳定性,并且没有考虑输入饱和问题。旋翼飞行器在实际飞 行过程中对实时性要求很高,需要对期望指令做出快速响应,闭环***的有限时间稳定性对 飞行器来说十分重要。同时由于飞行器本身的物理限制,即电机驱动旋翼的转速有限,导致 飞行器所能提供的升力有限。飞行器由于输入饱和问题引起的实际控制量与理想控制量的偏 差会降低***控制性能。如何保证飞行器的有限时间收敛特性,同时补偿输入饱和带来的负 面影响是一个难点。有限时间控制策略能够提高***的收敛速度、抗干扰能力和跟踪精度, 所以本发明针对旋翼飞行器的位移***设计了有限时间控制器,从理论上保证飞行器的有限 时间航迹跟踪性能,并引入有限时间收敛的辅助***,补偿输入饱和作用的同时不影响飞行 器位移***的有限时间稳定性。
发明内容
本发明的目的是为了解决飞行器存在输入饱和情况下的有限时间航迹跟踪控制问题,提 出了一种基于有限时间辅助***的有限时间控制策略,提高飞行器位移***的收敛速度、跟 踪精度和抗干扰能力,并保证位移***的有限时间稳定性。
为达到上述目的,本发明提出如下技术方案:
步骤1,建立旋翼飞行器包括位移***、姿态***和控制关系的整体数学模型。
图1描述了所考虑的共轴十二旋翼飞行器的结构图,以及所选择的地理坐标系 E={Ogxgygzg}和机体坐标系B={Obxbybzb}。
根据牛顿欧拉方程得到飞行器的位移***模型如下:
其中,φ,θ,ψ分别表示旋翼飞行器的滚转角、俯仰角与偏航角,x,y,z表示飞行器的位置坐标, u1表示飞行器的控制力,m表示飞行器的质量,dx,dy,dz分别表示作用于飞行器位移***各 个通道的扰动作用,g表示重力加速度,飞行所需控制力u1存在输入饱和约束如下:
式中,u是待综合的理想控制力,umax是输入饱和约束的上界,umin是输入饱和约束的下界。
根据牛顿欧拉方程得到飞行器的姿态***模型如下:
其中,p,q,r分别表示飞行器的滚转角速度、俯仰角速度与偏航角速度,u2,u3,u4表示飞行器 的控制力矩,Ix,Iy,Iz表示飞行器对机体各轴的转动惯量,dφ,dθ,dψ分别表示作用于飞行器 姿态***各个通道的扰动作用。
旋翼飞行器的控制关系模型为:
其中,M=[u2,u3,u4]T表示作用于飞行器的总力矩,
Ω1,Ω2,Ω3,Ω4,Ω5,Ω6,Ω7,Ω8,Ω9,Ω10,Ω11,Ω12分别是旋翼1,2,3,4,5,6,7,8,9,10,11,12的转速,l 表示飞行器质心和旋翼中心之间的距离,k1表示升力因子,k2表示反扭力矩因子,Ir表示旋 翼和电机转子的转动惯量,γ表示各个旋翼转轴与机体平面的夹角。
步骤2,设计旋翼飞行器的分层控制方案。图2给出了具体的设计过程:将旋翼飞行器 分为高度通道、平动***和姿态***,并针对每个通道单独设计控制器。所述控制方案将旋 翼飞行器分解为若干个二阶子***,简化设计过程。
针对高度通道,结合辅助***和有限时间控制策略设计飞行控制力,保证高度通道有限 时间稳定的同时补偿输入饱和作用。针对平动通道,基于有限时间控制策略设计虚拟控制量, 并基于此计算期望滚转角和期望俯仰角。针对姿态通道,设计线性自抗扰控制器产生飞行控 制力矩。所述分层控制方案解决了旋翼飞行器欠驱动特性带来的控制难度。
旋翼飞行器的状态信息η,ζ通过机载传感器获得(其中η=[φ,θ,ψ]T,ζ=[x,y,z]T),期 望轨迹xd,yd,zd和期望偏航角ψd由导航***生成。针对高度通道,设计有限时间控制器产 生理想飞行控制力u,并引入辅助***ξ1,ξ2补偿输入饱和作用;针对平动通道,设计有限时 间控制器产生虚拟控制量并通过非线性解耦方程计算出期望滚转角φd和俯仰角θd;针 对姿态通道,设计线性自抗扰控制器产生飞行控制力矩M。
步骤3,设计旋翼飞行器的高度控制器,基于有限时间控制策略设计高度控制器以产生 飞行所需控制力,并引入辅助***补偿输入饱和作用,保证高度通道的有限时间收敛特性和 抗干扰能力。根据高度信息z,期望轨迹zd和辅助***状态ξ1,ξ2给出理想控制力u。
首先设计有限时间辅助***如下:
其中,ξ1,ξ2是辅助***的状态变量,c1>0,c2>0,0<υ<1是辅助***参数。
定义补偿误差为:
其中,zd是期望高度,α是待设计的虚拟控制量。
设计虚拟控制量α:
其中,k1>0,l1>0,0<σ<1是待设计的控制器参数。
设计理想控制量u:
其中,k2>0,l2>0,0<σ<1是待设计的控制器参数。
所设计的高度控制器,能够补偿输入饱和作用的同时保证飞行器高度通道的有限时间稳 定性。
选择Lyapunov函数为:
对V求导并将所设计的α和u带入得到:
其中,
γ1=2k1,γ2=2k2,γ=min{γ1,γ2},β=min{β1,β2},ι=(σ+1)/2, Dz>|dz|是扰动作用dz的上界。
所设计的高度控制器能够补偿输入饱和作用,并且保证高度通道的有限时间稳定性。
步骤4,设计旋翼飞行器的平动控制器,采用有限时间控制策略设计平动控制器以产生 飞行器姿态***的期望滚转角与期望俯仰角,提高平动***的收敛速度和跟踪精度,保证平 动***的有限时间稳定性。根据位移信息ζ=[x,y,z]T,期望轨迹xd,yd,zd,给出虚拟控制量
定义跟踪误差为:
[χ11,χ12,χ13]T=[x-Υ1,y-Υ2,z-Υ3]T
其中,[xd,yd,zd]T=[Υ1,Υ2,Υ3]T表示期望轨迹,[α1,α2,α3]T表示待设计的中间控制量。
设计中间控制量αi:
其中,δ1i>0,λ1i>0,0<μi<1是待设计的控制器参数。
设计虚拟控制量
其中,δ2i>0,λ2i>0,0<μi<1是待设计的控制器参数。
选择Lyapunov函数为:
对Vi求导并将所设计的αi和带入得到:
其中,δi=min{2δ1i,2δ2i}, [dx,dy,dz]T=[d1,d2,d3]T表示作用于各个通道的扰动作用,Di>|di|是扰动作用di的上界。
所设计的虚拟控制器能够保证旋翼飞行器平动通道的有限时间稳定性。
通过非线性解耦模块,根据所设计的虚拟控制量计算出飞行器的期望滚转角和期望俯 仰角为:
步骤5,设计旋翼飞行器的姿态控制器,引入线性自抗扰算法设计姿态控制器以产生飞 行所需控制力矩,提高姿态***的鲁棒性。根据姿态信息η=[φ,θ,ψ]T,期望姿态角度 φd,θd,ψd,给出飞行控制力矩M。
将旋翼飞行器的姿态***写成如下统一的二阶***形式:
其中,τi=[u2,u3,u4]T,bi=[1/Ix,1/Iy,1/Iz]T,[ΔIx,ΔIy,ΔIz]T表 示参数不确定,τid是包含耦合,参数不确定和外扰的总扰动,分别表示为
τ1d=-((Iz+ΔIz)-(Iy+ΔIy))qr/(Ix+ΔIx)-ΔIxτφ/Ix(Ix+ΔIx)+dφ,
τ2d=-((Ix+ΔIx)-(Iz+ΔIz))pr/(Iy+ΔIy)-ΔIyτθ/Iy(Iy+ΔIy)+dθ,
τ3d=-((Iy+ΔIy)-(Ix+ΔIx))pq/(Iz+ΔIz)-ΔIzτψ/Iz(Iz+ΔIz)+dψ。
将总扰动τid扩张为姿态***的第三个状态变量并针对扩张***设计扩张状态 观测器为:
其中分别表示τid的估计值,表示估计误差,κi1>0,κi2>0,κi3>0 是观测器增益。
基于上述观测器的估计值,设计姿态控制器为:
其中,Di1>0,Di2>0是控制器增益,是期望姿态角度。
一般的,将观测器增益取为:
其中,是观测器带宽。
一般的,将控制器增益取为:
本发明提出了一种旋翼飞行器的有限时间航迹跟踪控制方法,目的是保证旋翼飞行器存 在输入饱和作用时的有限时间航迹跟踪性能。所提方法的优点在于:
(1)本发明通过引入有限时间控制策略,提高了旋翼飞行器位移***的收敛速度、跟 踪精度和抗扰动能力,保证了位移***的有限时间稳定性。
(2)本发明通过引入有限时间收敛的辅助***,补偿了输入饱和作用引起的理想控制 量与实际控制量的偏差对旋翼飞行器控制性能的负面影响,同时不影响位移***的有限时间 收敛特性。
(3)本发明提出的算法即使在没有引入任何扰动补偿机制的情况下,依然获得了较强 的鲁棒性,同时放宽了控制器参数的选择范围。
附图说明
图1是旋翼飞行器的结构图;
图2是旋翼飞行器的控制策略图;
图3是旋翼飞行器的位移x跟踪曲线;
图4是旋翼飞行器的位移y跟踪曲线;
图5是旋翼飞行器的高度z跟踪曲线;
图6是旋翼飞行器的3维轨迹跟踪曲线;
图7是旋翼飞行器的控制力曲线;
图8是有限时间辅助***的状态变量曲线;
具体实施方案
下面结合附图和仿真实例,对本发明的实施过程进行详细的描述。
本发明提出一种旋翼飞行器的有限时间航迹跟踪控制方法,其中涉及的旋翼飞行器如图 1所示,涉及的控制策略原理图如图2所示,主要包含:十二旋翼飞行器模块,高度控制器 模块,平动控制器模块,非线性解耦模块,姿态控制器模块。下面介绍每个模块的功能:
十二旋翼飞行器模块:通过牛顿欧拉方程建立十二旋翼飞行器的数学模型,描述飞行器 的运动机理。
高度控制器模块:根据采集的飞行器高度信息z和导航模块产生的期望轨迹zd,设计高 度控制器产生理想飞行控制力u,并将设计的辅助***状态信息ξ1,ξ2补偿给控制器,抵消输 入饱和作用产生的理想控制力u与饱和控制力u1的偏差对飞行器控制性能的影响。
平动控制器模块:根据采集的飞行器位移信息ζ=[x,y,z]T和导航模块产生的期望轨迹 xd,yd,zd,设计平动控制器产生虚拟控制量
非线性解耦模块:根据平动控制器模块产生的虚拟控制量计算出姿态***需要的期望 滚转角φd和期望俯仰角θd。
姿态控制器模块:根据非线性解耦模块产生的φd和θd,导航模块产生的ψd,和采集的 飞行器姿态信息η=[φ,θ,ψ]T,设计姿态控制器产生飞行控制力矩M。
本发明提供一种旋翼飞行器的有限时间航迹跟踪控制方法,很好的解决了飞行器欠驱动 特性问题,补偿了输入饱和作用,并保证了有限时间航迹跟踪性能。具体实施步骤如下:
1.建立旋翼飞行器的数学模型,描述其运动机理。
图1给出了所涉及的共轴十二旋翼飞行器的结构图,根据牛顿欧拉方程获得旋翼飞行器 的位移***模型为:
式中,φ,θ,ψ分别表示旋翼飞行器的滚转角、俯仰角与偏航角,x,y,z表示飞行器的位置坐标, 上述信息需要通过机载传感器测得,m=2.5kg表示飞行器的质量,dx=2sin(2πt)是作用于x 通道的扰动,作用于y通道的扰动dy是幅值为2的阶跃信号,dz=1是作用于z通道的扰动, g=9.8ms-2表示重力加速度,u1表示飞行器的控制力,存在输入饱和约束如下:
式中,u是待综合的理想控制力,umax=40N是输入饱和约束的上界,umin=0N是输入饱和 约束的下界。
根据牛顿欧拉方程获得旋翼飞行器的姿态***模型为:
式中,p,q,r分别表示飞行器的滚转角速度、俯仰角速度与偏航角速度,u2,u3,u4表示待设计 的飞行器控制力矩,Ix=0.0081Nms-2,Iy=0.0081Nms-2,Iz=0.0142Nms-2表示飞行器对机体各轴 的转动惯量,作用于滚转通道的扰动dφ是斜率为0.05的斜坡信号,作用于俯仰通道的扰动dθ 是幅值为0.7的方波信号,作用于偏航通道的扰动dψ是幅值为0.7的阶跃信号。
旋翼飞行器的控制关系为:
式中,M=[u2,u3,u4]T表示飞行器的总力矩,Ω1,Ω2,Ω3,Ω4,Ω5,Ω6,Ω7,Ω8,Ω9,Ω10,Ω11,Ω12分 别表示旋翼1,2,3,4,5,6,7,8,9,10,11,12的转速,l=0.5m表示飞行器质心和旋翼中心之间的距离, k1=54.2×10-6Ns2表示升力因子,k2=1.1×10-6Nms-2表示反扭力矩因子,Ir表示旋翼和电机 转子的转动惯量,γ=60°表示各个旋翼转轴与机体平面的夹角。
2.设计旋翼飞行器的分层控制方案,如图2所示。
3.设计高度控制器,产生飞行所需理想升力u。
设计辅助***如下:
其中,ξ1,ξ2是辅助***的状态变量,c1=0.5,c2=0.78,υ=0.8。
定义补偿误差为:
设计虚拟控制量α:
其中,k1=3,l1=5,σ=0.8。
设计理想控制量u:
其中,k2=2,l2=5。
4.设计平动控制器,产生虚拟控制量
定义跟踪误差为:
[χ11,χ12,χ13]T=[x-Υ1,y-Υ2,z-Υ3]T
其中,[xd,yd,zd]T=[Υ1,Υ2,Υ3]T表示期望轨迹。
设计中间控制量αi为:
式中,δ1i=[3,3,3]T,λ1i=[2,2,2]T,μi=[0.5,0.5,0.5]T。
设计虚拟控制量如下:
式中,δ2i=[2,2,2]T,λ2i=[1,1,1]T。
通过非线性解耦模块,基于所设计的虚拟控制量计算出期望滚转角φd和期望俯仰角 θd为:
5.设计姿态控制器,产生飞行力矩M。
将姿态***模型变形为如下统一的二阶***形式:
其中,τi=[u2,u3,u4]T,bi=[1/Ix,1/Iy,1Iz]T,[ΔIx,ΔIy,ΔIz]T表 示参数不确定,且满足ΔIx=0.1Ix,ΔIy=-0.1Iy,ΔIz=0.1Iz,τid是含有耦合,参数不确定和外 部扰动的总扰动作用,分别表示为
τ1d=-((Iz+ΔIz)-(Iy+ΔIy))qr/(Ix+ΔIx)-ΔIxτφ/Ix(Ix+ΔIx)+dφ,
τ2d=-((Ix+ΔIx)-(Iz+ΔIz))pr/(Iy+ΔIy)-ΔIyτθ/Iy(Iy+ΔIy)+dθ,
τ3d=-((Iy+ΔIy)-(Ix+ΔIx))pq/(Iz+ΔIz)-ΔIzτψ/Iz(Iz+ΔIz)+dψ。
将总扰动τid扩张为第三个状态变量并设计扩张状态观测器为:
式中分别表示τid的估计值,表示估计误差,κi1>0,κi2>0,κi3>0 表示观测器增益。一般的,将观测器增益取为:
其中,ω1=75,ω2=75,ω3=20是观测器的带宽。
基于上述观测器的估计值,设计姿态控制器为:
式中,表示期望姿态角度,Di1>0,Di2>0表示控制器增益。一般的,将控制器增益取为:
其中,ω1c=25,ω2c=25,ω3c=7是控制器带宽。
为了验证本发明所提出算法的可行性和有效性,在Matlab/Simulink平台上进行共轴十 二旋翼飞行器的轨迹跟踪仿真实验。
旋翼飞行器的期望轨迹是平面水平矩形轨迹如下:
式中,
旋翼飞行器的初始条件选取为:ζ0=[x0,y0,z0]T=[0.5,-0.5,0]Tm,
η0=[φ0,θ0,ψ0]T=[0,0,0.2]Trad
图3-图5是旋翼飞行器的轨迹跟踪结果。从图中可以看出,旋翼飞行器的位移通道x,y, z的响应速度快,动态性能好,超调量小,能够在短时间内跟踪期望轨迹,并且不受外部扰 动作用的影响,跟踪精度高。同时,初始位置的选择并不影响飞行器的控制效果。
图6是旋翼飞行器的3维轨迹跟踪结果。图6中的结果进一步说明了本发明提出算法的 有效性,使旋翼飞行器获得高精度的跟踪性能和极强的鲁棒性。
图7是旋翼飞行器的控制力曲线,图8是有限时间辅助***的状态变量曲线。图7说明 在实验过程中出现了输入饱和现象,而图8说明输入饱和带来的负面作用被辅助***有效的 补偿了。
综上所述,本发明提出的控制方法提高了旋翼飞行器的收敛速度,跟踪精度和抗扰动能 力,使旋翼飞行器能够在有限时间内跟踪期望轨迹,并且有效补偿输入饱和作用的负面影响, 提高飞行器的安全性。
上述详细介绍了本发明所提供的一种旋翼飞行器的有限时间航迹跟踪控制方法,但本发 明不仅限于上述实施例。对于本领域的一般技术人员,在没有做出原创性工作的前提下,在 与本发明相同原理和本质下的润色,修饰和变更所获得的其他实施例,都应当属于本发明的 保护范围。
Claims (10)
1.一种旋翼飞行器的有限时间航迹跟踪控制方法,其特征在于,所述方法包括以下步骤:
步骤1,建立旋翼飞行器的数学模型,所述模型包括飞行器的位移***模型、姿态***模型与控制关系模型;
步骤2,设计旋翼飞行器的分层控制方案,将飞行器分为高度通道、平动***与姿态***,并针对每个通道单独设计控制器,所述控制方案将旋翼飞行器分解为若干个二阶子***,简化设计过程;
步骤3,设计旋翼飞行器的高度控制器,基于有限时间控制策略设计高度控制器以产生飞行所需控制力,并引入辅助***补偿输入饱和作用,保证高度通道的有限时间收敛特性和抗干扰能力;
步骤4,设计旋翼飞行器的平动控制器,采用有限时间控制策略设计平动控制器以产生飞行器姿态***的期望滚转角与期望俯仰角,提高平动***的收敛速度和跟踪精度,保证平动***的有限时间稳定性;
步骤5,设计旋翼飞行器的姿态控制器,引入线性自抗扰算法设计姿态控制器以产生飞行所需控制力矩,提高姿态***的鲁棒性。
2.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,步骤1中所述旋翼飞行器为共轴十二旋翼飞行器,飞行器的位移***模型为:
其中,φ,θ,ψ分别表示旋翼飞行器的滚转角、俯仰角与偏航角,x,y,z表示飞行器的位置坐标,u1表示飞行器的控制力,m表示飞行器的质量,dx,dy,dz分别表示作用于飞行器位移***各个通道的扰动作用,g表示重力加速度,飞行所需控制力u1存在输入饱和约束如下:
式中,u是待综合的理想控制力,umax是输入饱和约束的上界,umin是输入饱和约束的下界。
3.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,步骤1中所述飞行器的姿态***模型为:
其中,p,q,r分别表示飞行器的滚转角速度、俯仰角速度与偏航角速度,u2,u3,u4表示飞行器的控制力矩,Ix,Iy,Iz表示飞行器对机体各轴的转动惯量,dφ,dθ,dψ分别表示作用于飞行器姿态***各个通道的扰动作用。
4.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,步骤1中所述飞行器的控制关系模型如下:
其中M=[u2,u3,u4]T表示作用于飞行器的总力矩,
Ω1,Ω2,Ω3,Ω4,Ω5,Ω6,Ω7,Ω8,Ω9,Ω10,Ω11,Ω12表示旋翼1,2,3,4,5,6,7,8,9,10,11,12的转速,l表示飞行器质心和旋翼中心之间的距离,k1表示升力因子,k2表示反扭力矩因子,Ir表示旋翼和电机转子的转动惯量,γ表示各个旋翼转轴与机体平面的夹角。
5.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,步骤2中针对高度通道,结合辅助***和有限时间控制策略设计飞行控制力,保证高度通道有限时间稳定的同时补偿输入饱和作用,针对平动通道,基于有限时间控制策略设计虚拟控制量,并基于此计算期望滚转角和期望俯仰角,针对姿态通道,设计线性自抗扰控制器产生飞行控制力矩,所述分层控制方案解决了旋翼飞行器欠驱动特性带来的控制难度。
6.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,步骤3中旋翼飞行器的高度控制器模块的输入是高度通道状态量z,期望轨迹zd和辅助***状态量ξ1,ξ2,输出是理想控制力u,高度控制器的设计过程如下:
首先设计有限时间收敛的辅助***为:
其中,ξ1,ξ2是辅助***的状态变量,c1>0,c2>0,0<υ<1是辅助***参数;
定义补偿误差为:
其中,zd是期望高度,α是待设计的虚拟控制量;
设计虚拟控制量为:
其中,k1>0,l1>0,0<σ<1是待设计的控制器参数;
设计理想控制力为:
其中,k2>0,l2>0,0<σ<1是待设计的控制器参数。
7.根据权利要求6所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,所设计的高度控制器,能够补偿输入饱和作用的同时保证飞行器高度通道的有限时间稳定性:
选取Lyapunov函数为:
对V求导,并将所设计的α和u带入中得到:
其中,
Dz>|dz|表示扰动作用dz的上界。
8.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,步骤4中旋翼飞行器的平动控制器模块的输入是位移信息ζ=[x,y,z]T,期望轨迹xd,yd,zd,输出是虚拟控制量平动控制器的设计过程如下:
定义跟踪误差为:
其中,[xd,yd,zd]T=[Υ1,Υ2,Υ3]T表示期望轨迹,[α1,α2,α3]T表示待设计的中间控制量;
设计中间控制量为:
其中,δ1i>0,λ1i>0,0<μi<1是待设计的控制器参数;
设计虚拟控制量为:
其中,δ2i>0,λ2i>0,0<μi<1是待设计的控制器参数;
那么,飞行器的期望滚转角和期望俯仰角可以由所设计的虚拟控制量表示为:
9.根据权利要求8所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,所设计的平动控制器能够保证飞行器平动通道的有限时间稳定性:
选取Lyapunov函数为
对Vi求导,并将所设计的αi和带入中得到:
其中,
[dx,dy,dz]T=[d1,d2,d3]T表示作用于各个通道的扰动作用,Di>|di|是扰动作用di的上界。
10.根据权利要求1所述的一种旋翼飞行器的有限时间航迹跟踪方法,其特征在于,步骤5中旋翼飞行器的姿态控制器模块的输入是姿态信息η=[φ,θ,ψ]T,期望姿态角度φd,θd,ψd,姿态控制器设计如下:
所述的旋翼飞行器姿态***模块写成如下统一的二阶***形式:
其中,表示参数不确定,τid是包含耦合,参数不确定和外扰的总扰动,分别表示为
τ1d=-((Iz+ΔIz)-(Iy+ΔIy))qr/(Ix+ΔIx)-ΔIxτφ/Ix(Ix+ΔIx)+dφ,
τ2d=-((Ix+ΔIx)-(Iz+ΔIz))pr/(Iy+ΔIy)-ΔIyτθ/Iy(Iy+ΔIy)+dθ,
τ3d=-((Iy+ΔIy)-(Ix+ΔIx))pq/(Iz+ΔIz)-ΔIzτψ/Iz(Iz+ΔIz)+dψ;
将总扰动τid扩张为第三个状态变量并针对扩张***设计扩张状态观测器为:
其中,分别表示的估计值,表示估计误差,κi1>0,κi2>0,κi3>0是观测器增益;
基于上述观测器的估计值,设计姿态控制器为:
其中,是控制器增益,是期望姿态角度。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810859587.XA CN109062042B (zh) | 2018-08-01 | 2018-08-01 | 一种旋翼飞行器的有限时间航迹跟踪控制方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810859587.XA CN109062042B (zh) | 2018-08-01 | 2018-08-01 | 一种旋翼飞行器的有限时间航迹跟踪控制方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109062042A true CN109062042A (zh) | 2018-12-21 |
CN109062042B CN109062042B (zh) | 2021-06-15 |
Family
ID=64832219
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810859587.XA Active CN109062042B (zh) | 2018-08-01 | 2018-08-01 | 一种旋翼飞行器的有限时间航迹跟踪控制方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109062042B (zh) |
Cited By (11)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109946969A (zh) * | 2019-03-29 | 2019-06-28 | 东北大学 | 一种控制输入受限的二阶混沌轨迹跟踪方法 |
CN110007596A (zh) * | 2019-03-29 | 2019-07-12 | 东北大学 | 一种控制输入受限的二阶混沌比例投影同步方法 |
CN110275542A (zh) * | 2019-06-14 | 2019-09-24 | 合肥工业大学 | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 |
CN110377044A (zh) * | 2019-07-24 | 2019-10-25 | 东南大学 | 一种无人直升机的有限时间高度和姿态跟踪控制方法 |
CN110471290A (zh) * | 2019-09-05 | 2019-11-19 | 山东科技大学 | 一种具有抗饱和功能的无人机直接自适应容错控制方法 |
CN110825114A (zh) * | 2019-11-27 | 2020-02-21 | 浙江大学 | 基于希尔伯特黄时间网格重构的飞行跟踪控制信号发生装置及方法 |
CN111538346A (zh) * | 2020-06-17 | 2020-08-14 | 郑州轻工业大学 | 一种四旋翼直升飞机的干扰观测补偿飞行控制方法 |
CN114115322A (zh) * | 2021-12-15 | 2022-03-01 | 西北工业大学 | 一种绳系飞行器***的跟踪控制方法 |
CN114185357A (zh) * | 2021-11-19 | 2022-03-15 | 合肥中科融道智能科技有限公司 | 基于自适应有限时间模糊***的电力巡检无人机姿态跟踪控制方法 |
CN116483109A (zh) * | 2023-06-25 | 2023-07-25 | 西安羚控电子科技有限公司 | 一种基于滑模控制的飞行器制导控制一体化方法及*** |
CN117270402A (zh) * | 2023-11-09 | 2023-12-22 | 西北工业大学 | 一种适用于极端风场的无人机复合抗扰航迹跟踪控制方法 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130119916A1 (en) * | 2011-11-10 | 2013-05-16 | Yebin Wang | Energy Efficient Motion Control System |
CN105676641A (zh) * | 2016-01-25 | 2016-06-15 | 南京航空航天大学 | 针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法 |
CN105911866A (zh) * | 2016-06-15 | 2016-08-31 | 浙江工业大学 | 四旋翼无人飞行器的有限时间全阶滑模控制方法 |
CN106325291A (zh) * | 2016-10-10 | 2017-01-11 | 上海拓攻机器人有限公司 | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** |
CN106406325A (zh) * | 2016-07-27 | 2017-02-15 | 浙江工业大学 | 基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法 |
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106774373A (zh) * | 2017-01-12 | 2017-05-31 | 哈尔滨工业大学 | 一种四旋翼无人机有限时间姿态跟踪控制方法 |
CN107203138A (zh) * | 2017-06-27 | 2017-09-26 | 金陵科技学院 | 一种输入输出饱和的飞行器鲁棒控制方法 |
CN107992082A (zh) * | 2017-12-26 | 2018-05-04 | 电子科技大学 | 基于分数阶幂次切换律的四旋翼无人机飞行控制方法 |
CN108233788A (zh) * | 2018-01-19 | 2018-06-29 | 南京信息工程大学 | 基于幂指数趋近率的无刷直流电机滑模变结构控制方法 |
-
2018
- 2018-08-01 CN CN201810859587.XA patent/CN109062042B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20130119916A1 (en) * | 2011-11-10 | 2013-05-16 | Yebin Wang | Energy Efficient Motion Control System |
CN105676641A (zh) * | 2016-01-25 | 2016-06-15 | 南京航空航天大学 | 针对四旋翼无人机非线性模型的基于反步和滑模控制技术的非线性鲁棒控制器的设计方法 |
CN105911866A (zh) * | 2016-06-15 | 2016-08-31 | 浙江工业大学 | 四旋翼无人飞行器的有限时间全阶滑模控制方法 |
CN106406325A (zh) * | 2016-07-27 | 2017-02-15 | 浙江工业大学 | 基于模糊扩张状态观测器的四旋翼无人机反馈线性化控制方法 |
CN106444826A (zh) * | 2016-09-07 | 2017-02-22 | 广西师范大学 | 四旋翼无人飞行器的飞行控制方法 |
CN106325291A (zh) * | 2016-10-10 | 2017-01-11 | 上海拓攻机器人有限公司 | 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及*** |
CN106774373A (zh) * | 2017-01-12 | 2017-05-31 | 哈尔滨工业大学 | 一种四旋翼无人机有限时间姿态跟踪控制方法 |
CN107203138A (zh) * | 2017-06-27 | 2017-09-26 | 金陵科技学院 | 一种输入输出饱和的飞行器鲁棒控制方法 |
CN107992082A (zh) * | 2017-12-26 | 2018-05-04 | 电子科技大学 | 基于分数阶幂次切换律的四旋翼无人机飞行控制方法 |
CN108233788A (zh) * | 2018-01-19 | 2018-06-29 | 南京信息工程大学 | 基于幂指数趋近率的无刷直流电机滑模变结构控制方法 |
Non-Patent Citations (1)
Title |
---|
徐东甫: "基于六轴多旋翼飞行器的赤眼蜂投放***设计与试验", 《农业机械学报》 * |
Cited By (19)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110007596A (zh) * | 2019-03-29 | 2019-07-12 | 东北大学 | 一种控制输入受限的二阶混沌比例投影同步方法 |
CN109946969B (zh) * | 2019-03-29 | 2021-08-10 | 东北大学 | 一种控制输入受限的二阶混沌轨迹跟踪方法 |
CN109946969A (zh) * | 2019-03-29 | 2019-06-28 | 东北大学 | 一种控制输入受限的二阶混沌轨迹跟踪方法 |
CN110275542A (zh) * | 2019-06-14 | 2019-09-24 | 合肥工业大学 | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 |
CN110275542B (zh) * | 2019-06-14 | 2022-04-08 | 合肥工业大学 | 一种基于自适应有限时间控制的四旋翼飞行器控制方法 |
CN110377044A (zh) * | 2019-07-24 | 2019-10-25 | 东南大学 | 一种无人直升机的有限时间高度和姿态跟踪控制方法 |
CN110471290B (zh) * | 2019-09-05 | 2022-05-27 | 山东科技大学 | 一种具有抗饱和功能的无人机直接自适应容错控制方法 |
CN110471290A (zh) * | 2019-09-05 | 2019-11-19 | 山东科技大学 | 一种具有抗饱和功能的无人机直接自适应容错控制方法 |
CN110825114A (zh) * | 2019-11-27 | 2020-02-21 | 浙江大学 | 基于希尔伯特黄时间网格重构的飞行跟踪控制信号发生装置及方法 |
CN111538346A (zh) * | 2020-06-17 | 2020-08-14 | 郑州轻工业大学 | 一种四旋翼直升飞机的干扰观测补偿飞行控制方法 |
CN111538346B (zh) * | 2020-06-17 | 2023-02-10 | 郑州轻工业大学 | 一种四旋翼直升飞机的干扰观测补偿飞行控制方法 |
CN114185357B (zh) * | 2021-11-19 | 2022-06-10 | 合肥中科融道智能科技有限公司 | 基于自适应有限时间模糊***的电力巡检无人机姿态跟踪控制方法 |
CN114185357A (zh) * | 2021-11-19 | 2022-03-15 | 合肥中科融道智能科技有限公司 | 基于自适应有限时间模糊***的电力巡检无人机姿态跟踪控制方法 |
CN114115322A (zh) * | 2021-12-15 | 2022-03-01 | 西北工业大学 | 一种绳系飞行器***的跟踪控制方法 |
CN114115322B (zh) * | 2021-12-15 | 2023-06-30 | 西北工业大学 | 一种绳系飞行器***的跟踪控制方法 |
CN116483109A (zh) * | 2023-06-25 | 2023-07-25 | 西安羚控电子科技有限公司 | 一种基于滑模控制的飞行器制导控制一体化方法及*** |
CN116483109B (zh) * | 2023-06-25 | 2023-09-05 | 西安羚控电子科技有限公司 | 一种基于滑模控制的飞行器制导控制一体化方法及*** |
CN117270402A (zh) * | 2023-11-09 | 2023-12-22 | 西北工业大学 | 一种适用于极端风场的无人机复合抗扰航迹跟踪控制方法 |
CN117270402B (zh) * | 2023-11-09 | 2024-01-26 | 西北工业大学 | 一种适用于极端风场的无人机复合抗扰航迹跟踪控制方法 |
Also Published As
Publication number | Publication date |
---|---|
CN109062042B (zh) | 2021-06-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109062042A (zh) | 一种旋翼飞行器的有限时间航迹跟踪控制方法 | |
Di Francesco et al. | Modeling and incremental nonlinear dynamic inversion control of a novel unmanned tiltrotor | |
CN105159305B (zh) | 一种基于滑模变结构的四旋翼飞行控制方法 | |
CN113342025B (zh) | 一种基于线性自抗扰控制的四旋翼无人机姿态控制方法 | |
CN109597303A (zh) | 一种复合式旋翼飞行器全模式飞行控制方法 | |
CN105759832A (zh) | 一种基于反演法的四旋翼飞行器滑模变结构控制方法 | |
CN111399531B (zh) | 高超声速飞行器滑翔段制导与姿态控制一体化设计方法 | |
CN105425812B (zh) | 一种基于双模型下的无人机自动着舰轨迹控制方法 | |
Chen et al. | Autonomous flight control for multi-rotor UAVs flying at low altitude | |
Zha et al. | Quaternion-based nonlinear trajectory tracking control of a quadrotor unmanned aerial vehicle | |
Di Francesco et al. | Incremental nonlinear dynamic inversion and control allocation for a tilt rotor UAV | |
CN104536448B (zh) | 一种基于Backstepping法的无人机姿态***控制方法 | |
Qiao et al. | Gain scheduling PID control of the quad-rotor helicopter | |
Baldi et al. | Towards adaptive autopilots for fixed-wing unmanned aerial vehicles | |
Liang et al. | Active disturbance rejection attitude control for a bird-like flapping wing micro air vehicle during automatic landing | |
CN107678442B (zh) | 一种基于双模型下的四旋翼自主着船控制方法 | |
Qingtong et al. | Backstepping-based attitude control for a quadrotor UAV using nonlinear disturbance observer | |
CN114721266A (zh) | 飞机舵面结构性缺失故障情况下的自适应重构控制方法 | |
Chen et al. | Adaptive attitude control for a coaxial tilt-rotor UAV via immersion and invariance methodology | |
Cheng et al. | Hover-to-cruise transition control for high-speed level flight of ducted fan UAV | |
McIntosh et al. | A Switching-Free Control Architecture for Transition Maneuvers of a Quadrotor Biplane Tailsitter | |
CN116430828A (zh) | 一种基于观测器的四旋翼故障容灾降级控制方法 | |
Huangzhong et al. | Tiltrotor aircraft attitude control in conversion mode based on optimal preview control | |
Safwat et al. | Generic UAV autopilot prototype based on adaptive modified incremental backstepping | |
CN116203840A (zh) | 可重复使用运载器自适应增益调度控制方法 |
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 |