CN105182990A - 具有输出受限的三自由度模型直升机的鲁棒控制方法 - Google Patents

具有输出受限的三自由度模型直升机的鲁棒控制方法 Download PDF

Info

Publication number
CN105182990A
CN105182990A CN201510641894.7A CN201510641894A CN105182990A CN 105182990 A CN105182990 A CN 105182990A CN 201510641894 A CN201510641894 A CN 201510641894A CN 105182990 A CN105182990 A CN 105182990A
Authority
CN
China
Prior art keywords
overbar
centerdot
subsystem
phi
delta
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
Application number
CN201510641894.7A
Other languages
English (en)
Other versions
CN105182990B (zh
Inventor
陈谋
崔庆梁
许坤
魏青铜
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Nanjing University of Aeronautics and Astronautics
Original Assignee
Nanjing University of Aeronautics and Astronautics
Priority date (The priority date 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 date listed.)
Filing date
Publication date
Application filed by Nanjing University of Aeronautics and Astronautics filed Critical Nanjing University of Aeronautics and Astronautics
Priority to CN201510641894.7A priority Critical patent/CN105182990B/zh
Publication of CN105182990A publication Critical patent/CN105182990A/zh
Application granted granted Critical
Publication of CN105182990B publication Critical patent/CN105182990B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Landscapes

  • Feedback Control In General (AREA)

Abstract

本发明公开一种具有输出受限的三自由度模型直升机的鲁棒控制方法,将三自由度模型直升机***分解为俯仰和滚转通道组成的子***①和偏航通道组成的子***②,包括步骤:(1)分别将子***①和子***②控制***变换成仿射非线性***方程形式;(2)分别根据子***①和子***②的仿射非线性***方程来设计鲁棒控制器。本发明考虑了三自由度模型直升机三个轴的运动,将整个***分成两个子***,分别针对子***①和②设计控制器。所设计的控制器使得三自由度模型直升机在***存在不确定性、未知外部干扰和不可直接测量状态的情况下具有良好的控制性能。

Description

具有输出受限的三自由度模型直升机的鲁棒控制方法
技术领域:
本发明涉及一种具有输出受限的三自由度模型直升机的鲁棒控制方法,其属于直升机飞行控制技术领域。
背景技术:
三自由度模型直升机***是一个构造简单且成本低廉的实验装置,但是作为一个被控对象,它又相当的复杂,是一个不稳定、多变量、非线性、强耦合的多输入多输出***,只有釆取行之有效的控制方法才能使其稳定运行。直升机***控制效果的稳定性和状态可以通过俯仰角度、滚转角度、旋转速度以及稳定时间来直观的度量。因此可将三自由度模型直升机***作为飞行控制技术研究平台来进行直升机飞行控制方法开发与验证。
Backstepping控制策略是一种非线性的反馈控制方法,在实际的控制***中相比于其他的非线性方法更容易实现。在对象的阶次不高时,计算量不大,因此广泛用于工程设计中。
由于***中存在不可直接测量的状态,会使得***的控制律不可实现。状态观测器是一个能简单且有效的解决***中出现状态不可直接测量的方法。利用状态观测器来观测***中未知的状态量,然后根据状态观测器估计出来的状态量来设计***的控制律。
考虑到径向基神经网络(RadialBasisFunctionNeuralNetworks,RBFNNs)能够以任意精度逼近任意连续函数,所以对于***中存在的建模不确定和外部未知干扰的问题,采用RBFNNs构造一种补偿器,利用RBFNNs估计出***中的未建模动态和外部未知干扰,在控制律设计中对其进行补偿。
针对三自由度模型直升机***的三个姿态角的输出受限的问题,在Backstepping控制器设计中加入BarrierLyapunovFunction,利用BarrierLyapunovFunction的特殊性,将***的输出限制在给定的范围内。
发明内容:
本发明的目的是提供一种能够使得直升机***在具有***建模不确定性,外部未知干扰和输出受限的综合影响下跟踪指定的姿态角信号的直升机鲁棒控制方法。
本发明采用如下技术方案:一种具有输出受限的三自由度模型直升机的鲁棒控制方法,首先将三自由度模型直升机***分解为俯仰和滚转通道组成的子***①和偏航通道组成的子***②,其包括如下步骤:
(1)分别将子***①和子***②控制***变换成仿射非线性***方程形式;
(2)分别根据子***①和子***②的仿射非线性***方程来设计鲁棒控制器。
进一步地,所述步骤(1)的子***①、②的仿射非线性***方程为:
C、子***①的模型为
θ ·· = l 1 k J 1 ( u d + u s ) c o s φ - T g J 1 c o s θ + Δ 1 + d 1 φ ·· = l r k J 3 ( u d - u s ) + Δ 2 + d 2
其中,J1为俯仰轴的转动惯量,J3为滚转轴的转动惯量,l1为螺旋桨到俯仰轴的距离,lr为螺旋桨到滚转轴的距离,k为电机的力常数,Δi,i=1,2分别为俯仰和滚转通道的未建模动态,di分别为俯仰和滚转通道所受的外界未知干扰,Tg为俯仰轴的平衡块产生的有效重力矩,Tg=mhgl1-mbgl2,mh是直升机螺旋桨部分的质量,mb为直升机平衡块的质量,l2为直升机平衡块到俯仰轴的距离,ud、us分别为两个电机所提供的电压,θ和φ分别为三自由度模型直升机的俯仰角和滚转角,分别为三自由度模型直升机的俯仰角加速度和滚转角加速度;
定义[x11x21]T=[θφ]T,写成仿射非线性***方程为:
x · i 1 = x i 2
x · i 2 = f ( y i ) + g ( y i ) u i + Δ i + d i
yi=xi1
式中, f ( y 1 ) f ( y 2 ) = - T g J 1 c o s θ 0 , u 1 u 2 = u d + u s u d - u s 为***的控制输入, g ( y 1 ) g ( y 2 ) = l 1 k J 1 c o s φ l r k J 3 , 子***①的输出量为[y1y2]T=[θφ]T
D、子***②的非线性模型为:
其中,G为直升机能悬浮在空中的悬浮力,J2为偏航轴的转动惯量,Δ3为偏航通道的未建模动态,d3为偏航通道所受的外界未知干扰,为子***②的输出偏航角,针对上式,进行如下变换,有
定义则写成仿射非线性***方程为
x ‾ · 1 = x ‾ 2
x ‾ · = b 3 u ‾ - b 3 φ + b 3 s i n φ + Δ 3 + d 3
y = x ‾ 1
其中,为***的虚拟控制量,由于滚转角的变化在一定的范围内,子***②的控制相当于考虑输入受限的问题,
u &OverBar; ( v ( t ) ) = s a t ( v ( t ) ) = s i g n ( v ( t ) ) , | v ( t ) | &GreaterEqual; u M v ( t ) | v ( t ) | < u M
其中uM为滚转角的界,在实际的***中根据具体的任务来确定
饱和项sat(v(t))可以用一个平滑的函数逼近为
h ( v ) = u M &times; tanh ( v u M ) = u M e v / u M - e - v / u M e v / u M + e - v / u M
子***②可以写为
x &OverBar; &CenterDot; 1 = x &OverBar; 2
x &OverBar; &CenterDot; 2 = b 3 h ( v ) + &Delta; &OverBar; 3 + d 3
y = x &OverBar; 1
其中 &Delta; &OverBar; 3 = - b 3 &phi; + b 3 s i n &phi; + &Delta; 3 + b 3 ( u &OverBar; - h ( v ) ) .
进一步地,所述步骤(2)的子***①、②的控制器的设计为:
a、利用Backstepping控制策略设计子***①的控制器,同时采用径向基函数神经网络对子***①中未建模动态进行逼近,采用扩维状态观测器来估计***中的未知状态和干扰,并用BarrierLaypunov函数来处理***的输出受限的问题,具体为:
a-1、利用径向基函数神经网络逼近***①的复合干扰项,
&Delta; ^ i = W ^ i T &Phi; i ( Z ^ )
其中,为第i个通道的未建模动态,为第i个通道的径向基函数神经网络的权值,权值的自适应调整律为σi0、pi2和Λi别为第i个通道的神经网络权值自适应律中的实数和参数矩阵,且σi0>0,为Λi的转置矩阵,为xi1的估计,采用状态观测器进行估计,为估计误差,为第i个通道的径向基向量,l为网络总节点数,为网络输入向量,中元素采用高斯基函数形式,即cik为网络第k个节点的中心向量,bik为网络第k个节点的基宽参数,k=1,2,…,l;
a-2、设计扩维状态观测器来估计***的中状态量及外界未知干扰
x ^ &CenterDot; i 1 = x ^ i 2 + l i 1 ( y i - y ^ i )
x ^ &CenterDot; i 2 = f ( y i ) + g ( y i ) u i + &Delta; ^ i + l i 2 ( y i - y ^ i ) + x ^ i 3
x ^ &CenterDot; i 3 = l i 3 ( y i - y ^ i )
y ^ i = x ^ i 1
其中,xi3=di为***的增广状态,为未知外界干扰di估计值,为xi2的估计值,j=1,2,3为的导数,lij>0为***扩维状态观测器待估计的增益;
a-3、根据a-1中获得未建模动态的估计值 &Delta; ^ = &Delta; ^ 1 &Delta; ^ 2 T 以及a-2中所观测出未知状态的估计值采用Backstepping法并结合BarrierLaypunov函数,最终得到子***①的控制器模型为:
u i = 1 g i ( y i ) ( - f i ( y i ) - z 1 , i K b , i 2 - z 1 , i 2 - W ^ i T &Phi; i ( Z ^ ) - d ^ i - l i 2 ( y i - y ^ i ) + &chi; i - k 2 , i z 2 , i - 1 2 ( &part; &alpha; i &part; x 1 i ) 2 z 2 , i )
式中,由于三自由度模型直升机***的限制,***的滚转角的变化所以gi(yi)≠0,存在,z1,i=xi1-xi1d为***的跟踪误差,其中αi为虚拟控制律, &alpha; i = - ( K b , i 2 - z 1 , i 2 ) k 1 , i z 1 , i + y &CenterDot; d , i - 1 2 z 1 , i K b , i 2 - z 1 , i 2 , &chi; i = &part; &alpha; i &part; x 1 , i x ^ i 2 + &part; &alpha; i &part; y d , i y &CenterDot; d , i + &part; &alpha; i &part; y &CenterDot; d , i y &CenterDot;&CenterDot; d , i , k1,i和k2,i为待设计的控制器的参数,Kb,i>0是z1,i的界,满足-Kb,i<z1,i<Kb,i,yd,i=xi1d为子***①的第i个期望跟踪姿态信号,为yd,i的一阶导数;
b、利用径向基函数神经网络逼近子***②中的未建模动态,采用扩维状态观测器来估计***中不能测量得到的角速度和外界未知干扰,构造辅助***来补偿***的输入受限的问题,并设计Backstepping控制器实现姿态跟踪控制,具体步骤为:
b-1、利用径向基函数神经网络逼近***的复合干扰项
&Delta; &OverBar; ^ 3 = W &OverBar; ^ T &Phi; &OverBar; ( Z &OverBar; ^ )
其中,为径向基神经网络的权值,分别为神经网络权值自适应律中的实数和参数矩阵,且的转置矩阵,为状态估计误差,采用状态观测器进行估计,为径向基向量,m为网络总节点数,为网络输入向量,中元素采用高斯基函数形式,即为网络第k个节点的中心向量,bk为网络第n个节点的基宽参数,n=1,2,…,m;
b-2、设计状态观测器估计状态量
x &OverBar; ^ &CenterDot; 1 = x &OverBar; ^ 2 + l &OverBar; 1 ( y - y ^ )
x &OverBar; ^ &CenterDot; 2 = b 3 g ( v ) + &Delta; &OverBar; ^ 3 + l &OverBar; 2 ( y - y ^ ) + x &OverBar; ^ 3
x &OverBar; ^ &CenterDot; 3 = l &OverBar; 3 ( y - y ^ )
y ^ = C &OverBar; x &OverBar; ^ 1
式中,为***的增广状态,的估计值,的导数,lj>0为***扩维状态观测器的增益;
b-3、构造辅助***来补偿***的输入受限的问题
&lambda; &CenterDot; 1 = - &xi; 1 &lambda; 1 + &lambda; 2 &lambda; &CenterDot; 2 = - &xi; 2 &lambda; 2 + b 3 ( h ( v ) - v )
其中,λi为辅助***的状态变量,ξi>0为***的设计参数;
b-4、根据b-1中获得的未建模动态的估计值b-2中估计出的未知状态量和外界干扰以及b-3中所构造的辅助***,采用Backstepping方法可得如下控制器模型:
v = 1 b 3 ( x &OverBar; &CenterDot;&CenterDot; 1 d - W &OverBar; ^ T &Phi; &OverBar; ( Z &OverBar; ^ ) - d ^ 3 + ( c 1 2 - 1 ) z &OverBar; 1 - c 2 z &OverBar; 2 - c 3 ( y - y ^ ) + &xi; 1 2 &lambda; 1 - ( &xi; 1 + &xi; 2 ) &lambda; 2 )
式中, z &OverBar; 1 = x &OverBar; ^ 1 - &lambda; 1 - x &OverBar; 1 d , z &OverBar; 2 = x &OverBar; ^ 2 - &lambda; 2 - x &OverBar; &CenterDot; 1 d - &alpha; &OverBar; 虚拟控制律 &alpha; &OverBar; = - c 1 z &OverBar; 1 - &zeta; 1 &lambda; 1 ; x &OverBar; ~ 1 = x &OverBar; 1 - x &OverBar; ^ 1 为状态的估计误差,为子***②的期望姿态跟踪信号,为子***②的期望输出的两阶导数,cj>0为控制***待设计的三个控制增益。
本发明与现有技术相比,具有以下显著的优点:本发明考虑了三自由度模型直升机三个轴的运动,并根据其模型的特点,将整个***分成两个子***,分别针对子***①和②设计控制器。针对子***①,利用径向基函数神经网络逼近***中的未知建模动态,采用扩维状态观测器来估计***中不能测量得到的角速度和外界未知干扰,基于BarrierLaypunov函数设计Backstepping控制器,解决姿态角输出受限的问题。对于子***②,利用径向基函数神经网络逼近***中的未知建模动态,采用扩维状态观测器来估计***中不能测量得到的角速度和外界未知干扰,构造辅助***来补偿***的输入受限的问题,并基于辅助***产生的补偿信号来设计Backstepping控制器。所设计的控制器使得三自由度模型直升机在具有***不确定性、未知外部干扰和不可直接测量的状态的情况下具有良好的控制性能。
附图说明:
图1为本发明三自由度模型直升机***的运动示意图。
图2为三自由度模型直升机姿态控制的鲁棒控制器的控制框图。
具体实施方式:
本发明设计了一种具有输出受限的三自由度模型直升机的鲁棒控制方法,根据三自由度模型直升机的运动特点将三自由度模型直升机***分解为俯仰和滚转通道组成的子***①和偏航通道组成的子***②。该方法基于子***①和子***②组成的闭环控制***来实现,其包括以下步骤:
首先将三自由度模型直升机***分解为俯仰和滚转通道组成的子***①和偏航通道组成的子***②,其特征在于:包括如下步骤
(1)分别将子***①和子***②控制***变换成仿射非线性***方程形式;
(2)分别根据子***①和子***②的仿射非线性***方程来设计鲁棒控制器;
其中步骤(1)的子***①、②的仿射非线性***方程为:
A、子***①的模型为
&theta; &CenterDot;&CenterDot; = l 1 k J 1 ( u d + u s ) c o s &phi; - T g J 1 c o s &theta; + &Delta; 1 + d 1 &phi; &CenterDot;&CenterDot; = l r k J 3 ( u d - u s ) + &Delta; 2 + d 2 - - - ( 1 )
其中,J1为俯仰轴的转动惯量,J3为滚转轴的转动惯量,l1为螺旋桨到俯仰轴的距离,lr为螺旋桨到滚转轴的距离,k为电机的力常数,Δi,i=1,2分别为俯仰和滚转通道的未建模动态,di分别为俯仰和滚转通道所受的外界未知干扰,Tg为俯仰轴的平衡块产生的有效重力矩,Tg=mhgl1-mbgl2,mh是直升机螺旋桨部分的质量,mb为直升机平衡块的质量,l2为直升机平衡块到俯仰轴的距离,ud、us分别为两个电机所提供的电压,θ和φ分别为三自由度模型直升机的俯仰角和滚转角,分别为三自由度模型直升机的俯仰角加速度和滚转角加速度;
定义[x11x21]T=[θφ]T,写成仿射非线性***方程为:
x &CenterDot; i 1 = x i 2
x &CenterDot; i 2 = f ( y i ) + g ( y i ) u i + &Delta; i + d i - - - ( 2 )
yi=xi1
式中, f ( y 1 ) f ( y 2 ) = - T g J 1 c o s &theta; 0 , u 1 u 2 = u d + u s u d - u s 为***的控制输入, g ( y 1 ) g ( y 2 ) = l 1 k J 1 c o s &phi; l r k J 3 , 子***①的输出量为[y1y2]T=[θφ]T
B、子***②的非线性模型为:
其中,G为直升机能悬浮在空中的悬浮力,J2为偏航轴的转动惯量,Δ3为偏航通道的未建模动态,d3为偏航通道所受的外界未知干扰,为子***②的输出偏航角,针对上式,进行如下变换,有
定义则写成仿射非线性***方程为
x &OverBar; &CenterDot; 1 = x &OverBar; 2 x &OverBar; &CenterDot; 2 = b 3 u &OverBar; - b 3 &phi; + b 3 sin &phi; + &Delta; 3 + d 3 y = x &OverBar; 1 - - - ( 5 )
其中,为***的虚拟控制量,由于滚转角的变化在一定的范围内,子***②的控制相当于考虑输入受限的问题,
u &OverBar; ( v ( t ) ) = s a t ( v ( t ) ) = s i g n ( v ( t ) ) , | v ( t ) | &GreaterEqual; u M v ( t ) | v ( t ) | < u M - - - ( 6 )
其中uM为滚转角的界,在实际的***中根据具体的任务来确定。
饱和项sat(v(t))可以用一个平滑的函数逼近为
h ( v ) = u M &times; tanh ( v u M ) = u M e v / u M - e - v / u M e v / u M + e - v / u M - - - ( 7 )
式(5)可以写为
x &OverBar; &CenterDot; 1 = x &OverBar; 2 x &OverBar; &CenterDot; 2 = b 3 h ( v ) + &Delta; &OverBar; 3 + d 3 y = x &OverBar; 1 - - - ( 8 )
其中
其中步骤(2)的子***①、②的控制器的设计为:
a、利用Backstepping控制策略设计子***①的控制器,同时采用径向基函数神经网络对子***①中未建模动态进行逼近,采用扩维状态观测器来估计***中的未知状态和干扰,并用BarrierLaypunov函数来处理***的输出受限的问题,具体为:
a-1、利用径向基函数神经网络逼近***①的复合干扰项,
&Delta; ^ i = W ^ i T &Phi; i ( Z ^ ) - - - ( 9 )
其中,为第i个通道的未建模动态,为第i个通道的径向基函数神经网络的权值,权值的自适应调整律为σi0、pi2和Λi别为第i个通道的神经网络权值自适应律中的实数和参数矩阵,且σi0>0,为Λi的转置矩阵,为xi1的估计,采用状态观测器进行估计,为估计误差,为第i个通道的径向基向量,l为网络总节点数,为网络输入向量,中元素采用高斯基函数形式,即cik为网络第k个节点的中心向量,bik为网络第k个节点的基宽参数,k=1,2,…,l;
a-2、设计扩维状态观测器来估计***的中状态量及外界未知干扰
x ^ &CenterDot; i 1 = x ^ i 2 + l i 1 ( y i - y ^ i ) x ^ &CenterDot; i 2 = f ( y i ) + g ( y i ) u i + &Delta; ^ i + l i 2 ( y i - y ^ i ) + x ^ i 3 x ^ &CenterDot; i 3 = l i 3 ( y i - y ^ i ) y ^ i = x ^ i 1 - - - ( 10 )
其中,xi3=di为***的增广状态,为未知外界干扰di估计值,为xi2的估计值,j=1,2,3为的导数,lij>0为***扩维状态观测器待设计的增益;
a-3、根据a-1中获得未建模动态的估计值 &Delta; ^ = &Delta; ^ 1 &Delta; ^ 2 T 以及a-2中所观测出未知状态的估计值采用Backstepping法并结合BarrierLaypunov函数,最终得到子***①的控制器模型为:
u i = 1 g i ( y i ) ( - f i ( y i ) - z 1 , i K b , i 2 - z 1 , i 2 - W ^ i T &Phi; i ( Z ^ ) - d ^ i - l i 2 ( y i - y ^ i ) + &chi; i - k 2 , i z 2 , i - 1 2 ( &part; &alpha; i &part; x 1 i ) 2 z 2 , i ) - - - ( 11 )
式中,由于三自由度模型直升机***的限制,***的滚转角的变化所以gi(yi)≠0,存在,z1,i=xi1-xi1d为***的跟踪误差,其中αi为虚拟控制律, &alpha; i = - ( K b , i 2 - z 1 , i 2 ) k 1 , i z 1 , i + y &CenterDot; d , i - 1 2 z 1 , i K b , i 2 - z 1 , i 2 , &chi; i = &part; &alpha; i &part; x 1 , i x ^ i 2 + &part; &alpha; i &part; y d , i y &CenterDot; d , i + &part; &alpha; i &part; y &CenterDot; d , i y &CenterDot;&CenterDot; d , i , k1,i和k2,i为待设计的控制器的参数,Kb,i>0是z1,i的界,满足-Kb,i<z1,i<Kb,i,yd,i=xi1d为子***①的第i个期望跟踪姿态信号,为yd,i的一阶导数;
b、利用径向基函数神经网络逼近子***②中的未建模动态,采用扩维状态观测器来估计***中不能测量得到的角速度和外界未知干扰,构造辅助***来补偿***的输入受限的问题,并设计Backstepping控制器实现姿态跟踪控制,具体步骤为:
b-1、利用径向基函数神经网络逼近***的复合干扰项
&Delta; &OverBar; ^ 3 = W &OverBar; ^ T &Phi; &OverBar; ( Z &OverBar; ^ ) - - - ( 12 )
其中,为径向基神经网络的权值,分别为神经网络权值自适应律中的实数和参数矩阵,且的转置矩阵,为状态估计误差,采用状态观测器进行估计,为径向基向量,m为网络总节点数,为网络输入向量,中元素采用高斯基函数形式,即为网络第k个节点的中心向量,bk为网络第n个节点的基宽参数,n=1,2,…,m;
b-2、设计状态观测器估计状态量
x &OverBar; ^ &CenterDot; 1 = x &OverBar; ^ 2 + l &OverBar; 1 ( y - y ^ ) x &OverBar; ^ &CenterDot; 2 = b 3 g ( v ) + &Delta; &OverBar; ^ 3 + l &OverBar; 2 ( y - y ^ ) + x &OverBar; ^ 3 x &OverBar; ^ &CenterDot; 3 = l &OverBar; 3 ( y - y ^ ) y ^ = C &OverBar; x &OverBar; ^ 1 - - - ( 13 )
式中,为***的增广状态,的估计值,的导数,lj>0为***扩维状态观测器的增益;
b-3、构造辅助***来补偿***的输入受限的问题
&lambda; &CenterDot; 1 = - &xi; 1 &lambda; 1 + &lambda; 2 &lambda; &CenterDot; 2 = - &xi; 2 &lambda; 2 + b 3 ( h ( v ) - v ) - - - ( 14 )
其中,λi为辅助***的状态变量,ξi>0为***的设计参数;
b-4、根据b-1中获得的未建模动态的估计值b-2中估计出的未知状态量和外界干扰以及b-3中所构造的辅助***,采用Backstepping方法可得如下控制器模型:
v = 1 b 3 ( x &OverBar; &CenterDot;&CenterDot; 1 d - W &OverBar; ^ T &Phi; &OverBar; ( Z &OverBar; ^ ) - d ^ 3 + ( c 1 2 - 1 ) z &OverBar; 1 - c 2 z &OverBar; 2 - c 3 ( y - y ^ ) + &xi; 1 2 &lambda; 1 - ( &xi; 1 + &xi; 2 ) &lambda; 2 ) - - - ( 15 )
式中, z &OverBar; 1 = x &OverBar; ^ 1 - &lambda; 1 - x &OverBar; 1 d , z &OverBar; 2 = x &OverBar; ^ 2 - &lambda; 2 - x &OverBar; &CenterDot; 1 d - &alpha; &OverBar; , 虚拟控制律 &alpha; &OverBar; = - c 1 z &OverBar; 1 - &zeta; 1 &lambda; 1 ; x &OverBar; ~ 1 = x &OverBar; 1 - x &OverBar; ^ 1 为状态的估计误差,为子***②的期望跟踪载体信号,为子***②的期望输出的两阶导数,cj>0为控制***待设计的三个控制增益。
4.子***①控制器设计
在对子***①进行控制器设计前需要如下定义和假设:
定义1:令Ω为一个包含原点的开区域,界限Lyapunov函数(BarrierLyapunovFunction,BLF)V(x)为定义在Ω上关于***的标量函数,它具有以下特性:(1)光滑、正定;(2)在Ω上的每个点的一阶连续偏导数存在;(3)当x趋向Ω的约束范围时,V(x)→∞;(4)当x(0)∈Ω时,对于所有的t>0,其中为某个正常数。
假设1:对子***①,期望姿态角向量Xd=[x1d,x2d]T=[θdd]T已知连续且其二阶导数存在。
假设2:对子***①,外部未知干扰连续且干扰的变化率有界,即
假设3:由于三自由度模型直升机***的限制,***的滚转角的变化不失一般性,假定滚转角的变化为 &phi; &Element; ( - &pi; 2 + &phi; l , &pi; 2 - &phi; l ) , 0 < &phi; l < &pi; 2 .
在子***①中,考虑了***的未建模动态和外部未知干扰,基于径向基函数神经网络设计Backstepping控制器。由于三自由度模型直升机平台的限制,子***①中的两个姿态角不能大范围变化,在子***①中利用BarrierLyapunov函数处理***输出受限的问题。
定理1:针对子***①,设计式(10)的扩维状态观测器,利用径向基函数神经网络逼近未建模动态,权值的自适应调整律采用式(9),子***①的Backstepping控制器设计为式(11),则子***①的状态估计误差和姿态跟踪误差在一个小个领域内,姿态输出在给定的界限内。
证明:选择Lyapunov函数为
V s = 1 2 &Sigma; i = 1 2 X ~ i T P i X ~ i + 1 2 &Sigma; i = 1 2 t r ( W ~ i T &Lambda; i - 1 W ~ i ) + 1 2 &Sigma; i = 1 2 log K b , i 2 K b , i 2 - z 1 , i 2 + 1 2 &Sigma; i = 1 2 z 2 , i 2 - - - ( 16 )
其中,为所选择的BarrierLyapunovFunction,为神经网络逼近权值的估计误差,Wi为神经网络逼近的理想权值,为神经网络权值的估计值。 X ~ i = x ~ i 1 x ~ i 2 x ~ i 3 T = x i 1 - x ^ i 1 x i 2 - x ^ i 2 x i 3 - x ^ i 3 T 为扩维状态观测器的估计误差, P i = p i 1 p i 2 p i 3 p i 2 p i 4 p i 5 p i 3 p i 5 p i 6 > 0.
为了证明方便,式(10)写成状态空间形式为
X ^ &CenterDot; i = A i X ^ i + B i u i + L i ( y i - y ^ i ) + F ( y i ) + H i &Delta; ^ i y ^ i = C i X ^ i - - - ( 17 )
其中 X ^ &CenterDot; i = x ^ &CenterDot; i 1 x ^ &CenterDot; i 2 x ^ &CenterDot; i 3 , X ^ i = x ^ i 1 x ^ i 2 x ^ i 3 , A i = 0 1 0 0 0 1 0 0 0 , B i = 0 g ( y i ) 0 , L i = l i 1 0 0 0 l i 2 0 0 0 l i 3 , H i = 0 1 0 , F ( y i ) = 0 f ( y i ) 0 , Ci=[100]。
原***(2)也可以写成如下形式:
X &CenterDot; i = A i X i + B i u i + F ( y i ) + E i d &CenterDot; i + H i &Delta; i
(18)
yi=CiXi
其中 X &CenterDot; i = x &CenterDot; i 1 x &CenterDot; i 2 x &CenterDot; i 3 , X i = x i 1 x i 2 x i 3 , E i = 0 0 1 .
比较式(17)和(18),可以得到状态估计的误差方程为:
X ~ &CenterDot; i = ( A i - L i C i ) X ~ i + 0 W i T &Phi; i ( Z ) - W ^ i T &Phi; i ( Z ^ ) 0 + 0 &epsiv; 0 + E i d &CenterDot; i - - - ( 19 )
z 1 , i z &CenterDot; 1 , i K b , i 2 - z 1 , i 2 = z 1 , i ( x ^ i 2 - y &CenterDot; d , i + x ~ i 2 ) K b , i 2 - z 1 , i 2 = z 1 , i ( z 2 , i + &alpha; i + x ~ i 2 - y &CenterDot; d , i ) K b , i 2 - z 1 , i 2 - - - ( 20 )
因为
z 1 , i x ~ 2 , i K b , i 2 - z 1 , i 2 &le; 1 2 z 1 , i 2 ( K b , i 2 - z 1 , i 2 ) 2 + 1 2 x ~ 2 , i 2 - - - ( 21 )
z 1 , i ( z 2 , i + &alpha; i + x ~ i 2 - y &CenterDot; d , i ) K b , i 2 - z 1 , i 2 &le; 1 2 z 1 , i 2 ( K b , i 2 - z 1 , i 2 ) 2 + 1 2 x ~ i 2 2 + z 1 , i ( z 2 , i + &alpha; i - y &CenterDot; d , i ) K b , i 2 - z 1 , i 2 = - k 1 , i z 1 , i 2 + z 1 , i z 2 , i K b , i 2 - z 1 , i 2 + 1 2 x ~ i 2 2 - - - ( 22 )
考虑式(19)和(22),对式(16)求导可得
V &CenterDot; s = 1 2 &Sigma; i = 1 2 ( X ~ &CenterDot; i T P i X ~ i + X ~ i T P i X ~ &CenterDot; i ) + &Sigma; i = 1 2 t r ( W ~ i T &Lambda; - 1 W ~ &CenterDot; i ) + &Sigma; i = 1 2 z 1 , i z &CenterDot; 1 , i K b , i 2 - z 1 , i 2 + &Sigma; i = 1 2 z 2 , i z &CenterDot; 2 , i &le; &Sigma; i = 1 2 t r ( W ~ i T &Lambda; - 1 W ~ &CenterDot; i ) + &Sigma; i = 1 2 ( ( A i - L i C i ) X ~ i + 0 W i T &Phi; i ( Z ) - W ^ i T &Phi; i ( Z ^ ) 0 + 0 &epsiv; 0 + E i d &CenterDot; i ) T P i X ~ i + X ~ i T P i ( ( A i - L i C i ) + 0 W i T &Phi; i ( Z ) - W ^ i T &Phi; i ( Z ^ ) 0 + 0 &epsiv; 0 + E i d &CenterDot; i ) + &Sigma; i = 1 2 ( - k 1 , i z 1 , i 2 + z 1 , i z 2 , i K b , i 2 - z 1 , i 2 + 1 2 x ~ i 2 2 + z 2 , i ( f i ( y i ) + g i ( y i ) u i + W ^ i T &Phi; i ( Z ^ ) + d ^ i + l i 2 x ~ i 1 - &chi; i - &part; &alpha; i &part; x i 1 x ~ i 2 ) )
由于
W i T &Phi; i ( Z ) - W ^ i T &Phi; i ( Z ^ ) = W i T &Phi; i ( Z ) - W i T &Phi; i ( Z ^ ) + W i T &Phi; i ( Z ^ ) - W ^ i T &Phi; i ( Z ^ ) = W i T ( &Phi; i ( Z ) - &Phi; i ( Z ^ ) ) + W ~ i T &Phi; i ( Z ^ ) - - - ( 24 )
将(11)和(24)带入(23),有
V &CenterDot; s &le; - &Sigma; i = 1 2 t r ( W ~ i T &Lambda; - 1 W ^ &CenterDot; i ) + 1 2 &Sigma; i = 1 2 X i T ( P i ( A i - L i C i ) + ( A i - L i C i ) T P i ) X ~ i + &Sigma; i = 1 2 X ~ i T P i 0 W ~ i T &Phi; i ( Z ^ ) 0 + &Sigma; i = 1 2 X ~ i T P i 0 &epsiv; 0 + &Sigma; i = 1 2 X ~ i T P i 0 W i T ( &Phi; i ( Z ^ ) - &Phi; i ( Z ^ ) ) 0 + &Sigma; i = 1 2 X ~ T P i E i d &CenterDot; i + &Sigma; i = 1 2 ( - k 1 , i z 1 , i 2 - k 2 , i z 2 , i 2 - 1 2 ( &part; &alpha; i &part; x i 1 ) 2 z 2 , i 2 - &part; &alpha; i &part; x i 1 x ~ i 2 z 2 , i + 1 2 x ~ i 2 2 ) &le; - &Sigma; i = 1 2 &sigma; i 0 t r ( W ~ i T W ~ i ) + 1 2 &Sigma; i = 1 2 X ~ i T ( P i ( A i - L i C i ) + ( A i - L i C i ) T P i ) X ~ i + &Sigma; i = 1 2 ( X ~ i T P i 0 &epsiv; 0 + x ~ i 2 T p i 4 W ~ i T &Phi; i ( Z ^ ) + x ~ i 3 T p i 5 W ~ i T &Phi; i ( Z ^ ) + &Sigma; i = 1 2 X ~ i T P i 0 W i * T ( &Phi; i ( Z ^ ) - &Phi; i ( Z ^ ) ) 0 + &Sigma; i = 1 2 ( - k 1 , i z 1 , i 2 - k 2 , i z 2 , i 2 - 1 2 ( &part; &alpha; i &part; x i 1 ) 2 z 2 , i 2 - &part; &alpha; i &part; x 1 , i x ~ i 2 z 2 , i + 1 2 x ~ i 2 2 ) + &Sigma; i = 1 2 X ~ T P i E i d &CenterDot; i - - - ( 25 )
由于
x ~ i 2 p i 4 W ~ i T &Phi; i ( Z ^ ) = 1 2 x ~ i 2 2 p i 4 2 + 1 2 W ~ i T &Phi; i ( Z ^ ) &Phi; i ( Z ^ ) T W ~ i &le; 1 2 X ~ i T 0 0 0 0 p i 4 2 0 0 0 0 X ~ i + 1 2 l W ~ i T W ~ i - - - ( 26 )
x ~ i 3 p i 5 W ~ i T &Phi; i ( Z ^ ) = 1 2 x ~ i 3 2 p i 5 2 + 1 2 W ~ i T &Phi; i ( Z ^ ) &Phi; i ( Z ^ ) T W ~ i &le; 1 2 X ~ i T 0 0 0 0 0 0 0 0 p i 5 2 X ~ i + 1 2 l W ~ i T W ~ i - - - ( 27 )
X ~ i T P 0 W i T ( &Phi; i ( Z ^ ) - &Phi; i ( Z ^ ) ) 0 i &le; 1 2 X ~ i T P i P i T X ~ i + 1 2 | | W i * T ( &Phi; i ( Z ) - &Phi; i ( Z ^ ) ) | | 2 - - - ( 28 )
X ~ i T P 0 &epsiv; i 0 &le; 1 2 X ~ i T P i P i T X ~ i + 1 2 | | &epsiv; i | | 2 - - - ( 29 )
- &part; &alpha; i &part; x i 1 x ~ i 2 z 2 , i &le; 1 2 ( &part; &alpha; i &part; x i 1 ) 2 z 2 , i 2 + 1 2 x ~ i 2 2 - - - ( 30 )
X ~ T P i E i &Delta; &CenterDot; i &le; 1 2 X ~ T P i P i T X ~ + 1 2 E i T E i | d &CenterDot; i | 2 &le; 1 2 X ~ T P i P i T X ~ + 1 2 &Sigma; i = 1 2 &beta; i 2 - - - ( 31 )
将式(26)-(31)带入式(25)有
V &CenterDot; s &le; - 1 2 &Sigma; i = 1 2 X ~ i T N i X ~ i - &Sigma; i = 1 2 ( k 1 , i z 1 , i 2 + k 2 , i z 2 , i 2 ) - &Sigma; i = 1 2 ( &sigma; 0 t r ( W ~ i T W ~ i ) ) + &Sigma; i = 1 2 x ~ i 2 2 + &Sigma; i = 1 2 ( X ~ i T P i P i T X ~ i + 1 2 X ~ i T 0 0 0 0 p i 4 2 0 0 0 p i 5 2 X ~ i + l W ~ i T W ~ i + 1 2 X ~ T P i P i T X ~ ) + 1 2 &Sigma; i = 1 2 ( | | W i T ( &Phi; i ( Z ) - &Phi; i ( Z ^ ) ) | | 2 + | | &epsiv; i | | 2 + &beta; i 2 ) &le; - ( &sigma; i 0 - l ) t r ( W ~ i T W ~ i ) - &Sigma; i = 1 2 X ~ i T ( 1 2 N i - 3 2 P i P i T - 1 2 T ) X ~ i - &Sigma; i = 1 2 ( k 1 , i z 1 , i 2 + k 2 , i z 2 , i 2 ) + 1 2 &Sigma; i = 1 2 ( | | W i T ( &Phi; i ( Z ) - &Phi; i ( Z ^ ) ) | | 2 + | | &epsiv; i | | 2 + &Sigma; i = 1 2 &beta; i 2 ) &le; - &kappa;V 4 + &tau; - - - ( 32 )
由于Φi(Z)为高斯函数,则有
式(32)中,l为径向基函数神经网络的节点数, T = 0 0 0 0 2 + p i 4 2 0 0 0 p i 5 2 , &kappa; = min ( k 1 , i , k 2 , i , &sigma; i 0 - l , &lambda; min ( 1 2 N i - 3 2 P i P i T - 1 2 T ) ) , &tau; = 1 2 &Sigma; i = 1 2 ( o | | W i T | | 2 + | | &epsiv; i | | 2 + &beta; i 2 ) 为一个未知的常数。
上式中,Ni和Pi满足李氏第二稳定性理论,即有
Pi(Ai-LiCi)+(Ai-LiCi)TPi=-Ni
可见,选择合适的参数,可使得子***①以指数收敛的形式收敛到一个小的邻域内,则***的状态估计误差神经网络以及姿态跟踪误差是有界的。即证。
5.子***②控制器设计
在对子***②进行控制器设计前需要如下假设:
假设4:对子***②,期望姿态角向量已知连续且其二阶导数存在。
假设5:对子***②,外界未知干扰的连续且导数存在且有界,即
由于子***①中的滚转角作为子***②的虚拟控制输入,因此在子***①的控制器的设计中构造辅助设计***来处理***的输入饱和问题。考虑了***的未建模动态和外部未知干扰,即子***②中的复合干扰由***的未建模动态和外部未知干扰组成,基于神经网络设计Backstepping控制器。
定理2:对于子***②,设计式(14)辅助设计***,采用径向基函数神经网络逼近***的复合干扰项,权值的自适应调整律选为(12),扩维状态观测器设计为(13),子***②控制器设计成式(15),则子***②姿态角跟踪误差、状态估计误差和干扰估计误差以指数收敛在一个小的领域内。
为了证明方便,式(13)写成状态空间形式为
x &OverBar; ^ &CenterDot; = A &OverBar; x &OverBar; ^ + L &OverBar; ( y - y ^ ) + E &OverBar; &Delta; &OverBar; ^ 3 + B &OverBar; h ( v ) y &OverBar; ^ = C &OverBar; x &OverBar; ^ - - - ( 33 )
其中 x &OverBar; ^ &CenterDot; = x &OverBar; ^ &CenterDot; 1 x &OverBar; ^ &CenterDot; 2 x &OverBar; ^ &CenterDot; 3 , x &OverBar; ^ = x &OverBar; ^ 1 x &OverBar; ^ 2 x &OverBar; ^ 3 , A &OverBar; = 0 1 0 0 0 1 0 0 0 , B &OverBar; = 0 b 3 0 , L &OverBar; = l &OverBar; i 1 0 0 0 l &OverBar; i 2 0 0 0 l &OverBar; i 3 , E &OverBar; = 0 1 0 , C &OverBar; = 1 0 0 .
原***(5)也可以写成如下形式:
x &OverBar; &CenterDot; = A &OverBar; x &OverBar; + E &OverBar; &Delta; &OverBar; ^ 3 + B &OverBar; h ( v ) + H &OverBar; d &CenterDot; 3 y &OverBar; = C &OverBar; x &OverBar; - - - ( 34 )
其中 H &OverBar; = 0 0 1 .
比较式(33)和(34),可以得到状态估计的误差方程为:
x &OverBar; ~ = ( A &OverBar; - L &OverBar; C &OverBar; ) x &OverBar; ~ + 0 W &OverBar; * T &Phi; &OverBar; ( Z &OverBar; ) - W ^ T &Phi; ( Z &OverBar; ^ ) 0 + 0 &epsiv; &OverBar; 0 + H &OverBar; d &CenterDot; 3 - - - ( 35 )
证明:其证明方法与子***①类似,选择Lyapunov函数为
V f = 1 2 x &OverBar; ~ T P &OverBar; x &OverBar; ~ + 1 2 z &OverBar; 1 2 + 1 2 z &OverBar; 2 2 + 1 2 t r ( W &OverBar; ~ T &Lambda; &OverBar; - 1 W &OverBar; ~ ) - - - ( 36 )
其中 z &OverBar; 1 = x &OverBar; ^ 1 - x &OverBar; 1 d - &lambda; 1 , z &OverBar; 2 = x &OverBar; ^ 2 - x &OverBar; &CenterDot; 1 d - &lambda; 2 - &alpha; &OverBar; , 虚拟控制量为 &alpha; &OverBar; = - c 1 z &OverBar; 1 - &xi; 1 &lambda; 1 , W &OverBar; ~ = W &OverBar; - W &OverBar; ^ 为神经网络逼近权值的估计误差,为神经网络逼近的理想权值,为神经网络权值的估计值。 x &OverBar; ~ = x &OverBar; ~ 1 x &OverBar; ~ 2 x &OverBar; ~ 3 T = x &OverBar; 1 - x &OverBar; ^ 1 x &OverBar; 2 - x &OverBar; ^ 2 x &OverBar; 3 - x &OverBar; ^ 3 T 为扩维状态观测器的估计误差, P &OverBar; = p &OverBar; 1 p &OverBar; 2 p &OverBar; 3 p &OverBar; 2 p &OverBar; 4 p &OverBar; 5 p &OverBar; 3 p &OverBar; 5 p &OverBar; 6 > 0.
对式(36)求导可得
V &CenterDot; f = 1 2 x &OverBar; ~ &CenterDot; T P &OverBar; x &OverBar; ~ + 1 2 x &OverBar; ~ T P &OverBar; x &OverBar; ~ &CenterDot; + t r ( W &OverBar; ~ T &Lambda; &OverBar; - 1 W &OverBar; ~ &CenterDot; ) + z &OverBar; &CenterDot; 1 z &OverBar; 1 + z &OverBar; 2 z &OverBar; &CenterDot; 2 = t r ( W &OverBar; ~ T &Lambda; &OverBar; - 1 W &OverBar; ~ &CenterDot; ) + 1 2 ( ( A &OverBar; - K &OverBar; C &OverBar; ) x &OverBar; ~ + 0 W &OverBar; T &Phi; &OverBar; ( Z &OverBar; ) - W ^ T &Phi; ( Z &OverBar; ^ ) 0 + 0 &epsiv; &OverBar; 0 + H &OverBar; d &CenterDot; 3 ) T P &OverBar; x &OverBar; + 1 2 x &OverBar; ~ T P &OverBar; ( ( A &OverBar; - K &OverBar; C &OverBar; ) + 0 W &OverBar; T &Phi; &OverBar; ( Z &OverBar; ) - W ^ T &Phi; ( Z &OverBar; ^ ) 0 + 0 &epsiv; &OverBar; 0 + H &OverBar; d &CenterDot; 3 ) + z &OverBar; 1 ( x &OverBar; ^ 2 - x &OverBar; &CenterDot; 1 d + k 1 x &OverBar; ~ 1 - &lambda; &CenterDot; 1 ) + z &OverBar; 2 ( x &OverBar; ^ &CenterDot; - &alpha; &OverBar; &CenterDot; - x &OverBar; &CenterDot;&CenterDot; 1 d - &lambda; &CenterDot; 2 ) = - &sigma; &OverBar; 0 t r ( W &OverBar; ~ T W &OverBar; ~ ) + 1 2 x &OverBar; ~ T P &OverBar; ( ( A &OverBar; - K &OverBar; C &OverBar; ) + ( A &OverBar; - K &OverBar; C &OverBar; ) T P &OverBar; ) x &OverBar; ~ T P &OverBar; 0 W &OverBar; T ( &Phi; &OverBar; ( Z &OverBar; ) - &Phi; ( Z &OverBar; ^ ) ) 0 + x &OverBar; ~ T P &OverBar; 0 &epsiv; &OverBar; 0 - c 1 z &OverBar; 1 2 - ( c 2 - c 1 ) z &OverBar; 2 2 + z 1 k 1 x &OverBar; ~ 1 + z &OverBar; 2 x &OverBar; ~ 1 ( c 1 &zeta; 1 + &zeta; 2 - c 3 ) + x &OverBar; ~ 3 p &OverBar; 5 W ~ T &Phi; ( Z &OverBar; ^ ) + x &OverBar; ~ 2 p &OverBar; 4 W ~ T &Phi; ( Z &OverBar; ^ ) + x &OverBar; ~ T P &OverBar; H &OverBar; d &CenterDot; 3 - - - ( 37 )
V &CenterDot; f &le; - ( &sigma; &OverBar; 0 - m ) t r ( W &OverBar; ~ T W &OverBar; ~ ) - 1 2 x &OverBar; ~ T N &OverBar; x &OverBar; ~ + x &OverBar; ~ T P &OverBar; P &OverBar; T x &OverBar; ~ + 1 2 o | | W &OverBar; T | | 2 + 1 2 x &OverBar; ~ T P &OverBar; P &OverBar; T x &OverBar; ~ + 1 2 | | &epsiv; &OverBar; | | 2 - c 1 z &OverBar; 1 2 - ( c 2 - c 1 ) z &OverBar; 2 2 + k 1 ( 1 2 x &OverBar; ~ 1 2 + 1 2 z &OverBar; 1 2 ) + ( c 1 &zeta; 1 + &zeta; 2 - c 3 ) ( 1 2 x &OverBar; ~ 1 2 + 1 2 z &OverBar; 2 2 ) + 1 2 x &OverBar; ~ T 0 0 0 0 p &OverBar; 4 2 0 0 0 p &OverBar; 5 2 x &OverBar; ~ + 1 2 &beta; 3 2 = - ( &sigma; &OverBar; 0 - m ) t r ( W &OverBar; ~ T W &OverBar; ~ ) - x &OverBar; ~ T ( 1 2 N &OverBar; - 3 2 P &OverBar; P &OverBar; T - T &OverBar; ) x &OverBar; ~ - ( c 1 - 1 2 k 1 ) z &OverBar; 1 2 - ( c 2 - c 1 - 1 2 ( c 1 &zeta; 1 + &zeta; 2 - c 3 ) ) z &OverBar; 2 2 + 1 2 o | | W &OverBar; T | | 2 + 1 2 | | &epsiv; &OverBar; | | 2 + 1 2 &beta; 3 2 &le; - &kappa; &OverBar; V f + &tau; &OverBar;
式(38)中,满足李氏第二稳定性理论,即有
P &OverBar; ( A &OverBar; - L &OverBar; C &OverBar; ) + ( A &OverBar; - L &OverBar; C &OverBar; ) T P &OverBar; = - N &OverBar;
其中,m为所选RBF神经网络的节点数, T &OverBar; = 1 2 c 1 &zeta; 1 + &zeta; 2 - c 3 + k 1 0 0 0 p &OverBar; 4 2 0 0 0 p &OverBar; 5 2 , &kappa; &OverBar; = m i n ( ( c 1 - 1 2 k 1 ) , ( c 2 - c 1 - 1 2 ( c 1 &zeta; 1 + &zeta; 2 - c 3 ) ) , &lambda; m i n ( 1 2 N &OverBar; - 3 2 P &OverBar; P &OverBar; T - T &OverBar; ) , ( &sigma; &OverBar; 0 - m ) ) , &beta; = 1 2 o | | W &OverBar; T | | 2 + 1 2 | | &epsiv; &OverBar; | | 2 + 1 2 &beta; 3 2 为一个未知的常数。
可见,选择合适的参数,可使得子***②以指数收敛的形式收敛到一个小的邻域内,则***的状态估计误差神经网络以及姿态跟踪误差是有界的。即证。
以上所述仅是本发明的优选实施方式,应当指出,对于本技术领域的普通技术人员来说,在不脱离本发明原理的前提下还可以做出若干改进,这些改进也应视为本发明的保护范围。

Claims (3)

1.一种具有输出受限的三自由度模型直升机的鲁棒控制方法,首先将三自由度模型直升机***分解为俯仰和滚转通道组成的子***①和偏航通道组成的子***②,其特征在于:包括如下步骤
(1)分别将子***①和子***②控制***变换成仿射非线性***方程形式;
(2)分别根据子***①和子***②的仿射非线性***方程来设计鲁棒控制器。
2.如权利要求1所述的具有输出受限的三自由度模型直升机的鲁棒控制方法,其特征在于:所述步骤(1)的子***①、②的仿射非线性***方程为:
A、子***①的模型为
&theta; &CenterDot;&CenterDot; = l 1 k J 1 ( u d + u s ) c o s &phi; - T g J 1 c o s &theta; + &Delta; 1 + d 1 &phi; &CenterDot;&CenterDot; = l r k J 3 ( u d - u s ) + &Delta; 2 + d 2
其中,J1为俯仰轴的转动惯量,J3为滚转轴的转动惯量,l1为螺旋桨到俯仰轴的距离,lr为螺旋桨到滚转轴的距离,k为电机的力常数,Δi,i=1,2分别为俯仰和滚转通道的未建模动态,di分别为俯仰和滚转通道所受的外界未知干扰,Tg为俯仰轴的平衡块产生的有效重力矩,Tg=mhgl1-mbgl2,mh是直升机螺旋桨部分的质量,mb为直升机平衡块的质量,l2为直升机平衡块到俯仰轴的距离,ud、us分别为两个电机所提供的电压,θ和φ分别为三自由度模型直升机的俯仰角和滚转角,分别为三自由度模型直升机的俯仰角加速度和滚转角加速度;
定义[x11x21]T=[θφ]T, x 12 x 22 T = x &CenterDot; 11 x &CenterDot; 21 T = &theta; &CenterDot; &phi; &CenterDot; T , 写成仿射非线性***方程为:
x &CenterDot; i 1 = x i 2
x &CenterDot; i 2 = f ( y i ) + g ( y i ) u i + &Delta; i + d i
yi=xi1
式中, f ( y 1 ) f ( y 2 ) = - T g J 1 c o s &theta; 0 , u 1 u 2 = u d + u s u d - u s 为***的控制输入, g ( y 1 ) g ( y 2 ) = l 1 k J 1 c o s &phi; l r k J 3 , 子***①的输出量为[y1y2]T=[θφ]T
B、子***②的非线性模型为:
其中,G为直升机能悬浮在空中的悬浮力,J2为偏航轴的转动惯量,Δ3为偏航通道的未建模动态,d3为偏航通道所受的外界未知干扰,为子***②的输出偏航角,针对上式,进行如下变换,有
定义则写成仿射非线性***方程为
x &OverBar; &CenterDot; 1 = x &OverBar; 2
x &OverBar; &CenterDot; 2 = b 3 u &OverBar; - b 3 &phi; + b 3 s i n &phi; + &Delta; 3 + d 3
y = x &OverBar; 1
其中, 为***的虚拟控制量,由于滚转角的变化在一定的范围内,子***②的控制相当于考虑输入受限的问题,
u &OverBar; ( v ( t ) ) = s a t ( v ( t ) ) = s i g n ( v ( t ) ) , | v ( t ) | &GreaterEqual; u M v ( t ) | v ( t ) | < u M
其中uM为滚转角的界,在实际的***中根据具体的任务来确定
饱和项sat(v(t))可以用一个平滑的函数逼近为
h ( v ) = u M &times; tanh ( v u M ) = u M e v / u M - e - v / u M e v / u M + e - v / u M
子***②可以写为
x &OverBar; &CenterDot; 1 = x &OverBar; 2
x &OverBar; &CenterDot; 2 = b 3 h ( v ) + &Delta; &OverBar; 3 + d 3
y = x &OverBar; 1
其中 &Delta; &OverBar; 3 = - b 3 &phi; + b 3 s i n &phi; + &Delta; 3 + b 3 ( u &OverBar; - h ( v ) ) .
3.如权利要求2所述的具有输出受限的三自由度模型直升机的鲁棒控制方法,其特征在于:所述步骤(2)的子***①、②的控制器的设计为:
a、利用Backstepping控制策略设计子***①的控制器,同时采用径向基函数神经网络对子***①中未建模动态进行逼近,采用扩维状态观测器来估计***中的未知状态和干扰,并用BarrierLaypunov函数来处理***的输出受限的问题,具体为:
a-1、利用径向基函数神经网络逼近***①的复合干扰项,
&Delta; ^ i = W ^ i T &Phi; i ( Z ^ )
其中,为第i个通道的未建模动态,为第i个通道的径向基函数神经网络的权值,权值的自适应调整律为σi0、pi2和Λi别为第i个通道的神经网络权值自适应律中的实数和参数矩阵,且σi0>0, 为Λi的转置矩阵,为xi1的估计,采用状态观测器进行估计,为估计误差,为第i个通道的径向基向量,l为网络总节点数,为网络输入向量,中元素采用高斯基函数形式,即cik为网络第k个节点的中心向量,bik为网络第k个节点的基宽参数,k=1,2,…,l;
a-2、设计扩维状态观测器来估计***的中状态量及外界未知干扰
x ^ &CenterDot; i 1 = x ^ i 2 + l i 1 ( y i - y ^ i )
x ^ &CenterDot; i 2 = f ( y i ) + g ( y i ) u i + &Delta; ^ i + l i 2 ( y i - y ^ i ) + x ^ i 3
x ^ &CenterDot; i 3 = l i 3 ( y i - y ^ i )
y ^ i = x ^ i 1
其中,xi3=di为***的增广状态,为未知外界干扰di估计值,为xi2的估计值,j=1,2,3为的导数,lij>0为***扩维状态观测器待估计的增益;
a-3、根据a-1中获得未建模动态的估计值 &Delta; ^ = &Delta; ^ 1 &Delta; ^ 2 T 以及a-2中所观测出未知状态的估计值采用Backstepping法并结合BarrierLaypunov函数,最终得到子***①的控制器模型为:
u i = 1 g i ( y i ) ( - f i ( y i ) - z 1 , i K b , i 2 - z 1 , i 2 - W ^ i T &Phi; i ( Z ^ ) - d ^ i - l i 2 ( y i - y ^ i ) + &chi; i - k 2 , i z 2 , i - 1 2 ( &part; a i &part; x 1 i ) 2 z 2 , i )
式中,由于三自由度模型直升机***的限制,***的滚转角的变化所以gi(yi)≠0,存在,z1,i=xi1-xi1d为***的跟踪误差,其中αi为虚拟控制律, &alpha; i = - ( K b , i 2 - z 1 , i 2 ) k 1 , i z 1 , i + y &CenterDot; d , i - 1 2 z 1 , i K b , i 2 - z 1 , i 2 , &chi; i = &part; &alpha; i &part; x 1 , i x ^ i 2 + &part; &alpha; i &part; y d , i y &CenterDot; d , i + &part; &alpha; i &part; y &CenterDot; d , i y &CenterDot;&CenterDot; d , i , k1,i和k2,i为待设计的控制器的参数,Kb,i>0是z1,i的界,满足-Kb,i<z1,i<Kb,i,yd,i=xi1d为子***①的第i个期望跟踪姿态信号,为yd,i的一阶导数;
b、利用径向基函数神经网络逼近子***②中的未建模动态,采用扩维状态观测器来估计***中不能测量得到的角速度和外界未知干扰,构造辅助***来补偿***的输入受限的问题,并设计Backstepping控制器实现姿态跟踪控制,具体步骤为:
b-1、利用径向基函数神经网络逼近***的复合干扰项
&Delta; &OverBar; ^ 3 = W &OverBar; ^ T &Phi; &OverBar; ( Z &OverBar; ^ )
其中,为径向基神经网络的权值,分别为神经网络权值自适应律中的实数和参数矩阵,且 的转置矩阵,为状态估计误差,采用状态观测器进行估计,为径向基向量,m为网络总节点数,为网络输入向量,中元素采用高斯基函数形式,即为网络第k个节点的中心向量,bk为网络第n个节点的基宽参数,n=1,2,…,m;
b-2、设计状态观测器估计状态量
x &OverBar; ^ &CenterDot; 1 = x &OverBar; ^ 2 + l 1 &OverBar; ( y - y ^ )
x &OverBar; ^ &CenterDot; 2 = b 3 g ( v ) + &Delta; &OverBar; ^ 3 + l 2 &OverBar; ( y - y ^ ) + x &OverBar; ^ 3 x &OverBar; ^ &CenterDot; 3 = l 3 &OverBar; ( y - y ^ )
y ^ = C &OverBar; x &OverBar; ^ 1
式中,为***的增广状态, 的估计值,的导数,lj>0为***扩维状态观测器的增益;
b-3、构造辅助***来补偿***的输入受限的问题
&lambda; &CenterDot; 1 = - &xi; 1 &lambda; 1 + &lambda; 2 &lambda; &CenterDot; 2 = - &xi; 2 &lambda; 2 + b 3 ( h ( v ) - v )
其中,λi为辅助***的状态变量,ξi>0为***的设计参数;
b-4、根据b-1中获得的未建模动态的估计值b-2中估计出的未知状态量和外界干扰以及b-3中所构造的辅助***,采用Backstepping方法可得如下控制器模型:
v = 1 b 3 ( x &OverBar; &CenterDot;&CenterDot; 1 d - W &OverBar; ^ T &Phi; &OverBar; ( Z &OverBar; ^ ) - d ^ 3 + ( c 1 2 - 1 ) z &OverBar; 1 - c 2 z &OverBar; 2 - c 3 ( y - y ^ ) + &xi; 1 2 &lambda; 1 - ( &xi; 1 + &xi; 2 ) &lambda; 2 )
式中, z &OverBar; 1 = x &OverBar; ^ 1 - &lambda; 1 - x &OverBar; 1 d , z &OverBar; 2 = x &OverBar; ^ 2 - &lambda; 2 - x &OverBar; &CenterDot; 1 d - &alpha; &OverBar; , 虚拟控制律 &alpha; &OverBar; = - c 1 z &OverBar; 1 - &zeta; 1 &lambda; 1 ; x &OverBar; ~ 1 = x &OverBar; 1 - x &OverBar; ^ 1 为状态的估计误差,为子***②的期望姿态跟踪信号,为子***②的期望输出的两阶导数,cj>0为控制***待设计的三个控制增益。
CN201510641894.7A 2015-09-30 2015-09-30 具有输出受限的三自由度模型直升机的鲁棒控制方法 Active CN105182990B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201510641894.7A CN105182990B (zh) 2015-09-30 2015-09-30 具有输出受限的三自由度模型直升机的鲁棒控制方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201510641894.7A CN105182990B (zh) 2015-09-30 2015-09-30 具有输出受限的三自由度模型直升机的鲁棒控制方法

Publications (2)

Publication Number Publication Date
CN105182990A true CN105182990A (zh) 2015-12-23
CN105182990B CN105182990B (zh) 2019-08-20

Family

ID=54905129

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201510641894.7A Active CN105182990B (zh) 2015-09-30 2015-09-30 具有输出受限的三自由度模型直升机的鲁棒控制方法

Country Status (1)

Country Link
CN (1) CN105182990B (zh)

Cited By (6)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105676854A (zh) * 2016-01-14 2016-06-15 北京航空航天大学 一种三自由度直升机抗饱和姿态跟踪控制方法
CN105698792A (zh) * 2016-01-26 2016-06-22 上海实汇机电科技有限公司 一种基于自适应鲁邦融合算法的动态mems惯性姿态测量***
CN107728470A (zh) * 2017-08-31 2018-02-23 电子科技大学 一种无速率测量的机械臂姿态控制方法
CN110737279A (zh) * 2019-10-28 2020-01-31 北京航空航天大学 一种无人直升机空投吊挂的纵向摆动幅度控制方法
CN111173678A (zh) * 2020-01-09 2020-05-19 曲阜师范大学 一种rbf神经网络俯仰干扰补偿的风力机舱悬浮控制方法
CN111609878A (zh) * 2020-06-10 2020-09-01 江南大学 三自由度直升机***传感器运行状态监测方法

Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103425135A (zh) * 2013-07-30 2013-12-04 南京航空航天大学 一种具有输入饱和的近空间飞行器鲁棒控制方法
CN104049537A (zh) * 2014-06-19 2014-09-17 金陵科技学院 非仿射非线性飞控***鲁棒自适应容错控制***

Patent Citations (2)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103425135A (zh) * 2013-07-30 2013-12-04 南京航空航天大学 一种具有输入饱和的近空间飞行器鲁棒控制方法
CN104049537A (zh) * 2014-06-19 2014-09-17 金陵科技学院 非仿射非线性飞控***鲁棒自适应容错控制***

Non-Patent Citations (6)

* Cited by examiner, † Cited by third party
Title
CUI QINGLIANG 等: "Disturbance Observer Based Attitude Control for a Three-Degree-of-Freedom Laboratory Helicopter", 《PROCEEDINGS OF THE 34TH CHINESE CONTROL CONFERENCE》 *
WEI QINGTONG 等: "Backstepping-Based Attitude Control for a Quadrotor UAV Using Nonlinear Disturbance Observer", 《PROCEEDINGS OF THE 34TH CHINESE CONTROL CONFERENCE》 *
张强 等: "基于Backstepping的非仿射非线性***鲁棒控制", 《控制与决策》 *
张强: "近空间飞行器非线性飞控***鲁棒自适应控制", 《中国博士学位论文全文数据库工程科技Ⅱ辑》 *
陈蕾: "基于干扰观测器的挠性姿态控制方法研究", 《道客巴巴》 *
陈龙胜 等: "一类非仿射非线性不确定***自适应鲁棒控制", 《控制理论与应用》 *

Cited By (9)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN105676854A (zh) * 2016-01-14 2016-06-15 北京航空航天大学 一种三自由度直升机抗饱和姿态跟踪控制方法
CN105676854B (zh) * 2016-01-14 2020-05-05 北京航空航天大学 一种三自由度直升机抗饱和姿态跟踪控制方法
CN105698792A (zh) * 2016-01-26 2016-06-22 上海实汇机电科技有限公司 一种基于自适应鲁邦融合算法的动态mems惯性姿态测量***
CN107728470A (zh) * 2017-08-31 2018-02-23 电子科技大学 一种无速率测量的机械臂姿态控制方法
CN107728470B (zh) * 2017-08-31 2020-07-21 电子科技大学 一种无速率测量的机械臂姿态控制方法
CN110737279A (zh) * 2019-10-28 2020-01-31 北京航空航天大学 一种无人直升机空投吊挂的纵向摆动幅度控制方法
CN111173678A (zh) * 2020-01-09 2020-05-19 曲阜师范大学 一种rbf神经网络俯仰干扰补偿的风力机舱悬浮控制方法
CN111173678B (zh) * 2020-01-09 2022-02-01 曲阜师范大学 一种rbf神经网络俯仰干扰补偿的风力机舱悬浮控制方法
CN111609878A (zh) * 2020-06-10 2020-09-01 江南大学 三自由度直升机***传感器运行状态监测方法

Also Published As

Publication number Publication date
CN105182990B (zh) 2019-08-20

Similar Documents

Publication Publication Date Title
CN105700536B (zh) 基于绳系拖曳***的主动星姿态和系绳摆振联合控制方法
CN105182990A (zh) 具有输出受限的三自由度模型直升机的鲁棒控制方法
Rubio et al. Structure regulator for the perturbations attenuation in a quadrotor
CN109144084B (zh) 一种基于固定时间收敛观测器的垂直起降重复使用运载器姿态跟踪控制方法
Yang et al. Input shaping enhanced active disturbance rejection control for a twin rotor multi-input multi-output system (TRMS)
Chen et al. Robust attitude control of near space vehicles with time-varying disturbances
CN105242676B (zh) 一种有限时间收敛时变滑模姿态控制方法
CN106325291B (zh) 基于滑模控制律和eso的四旋翼飞行器姿态控制方法及***
CN105159305B (zh) 一种基于滑模变结构的四旋翼飞行控制方法
CN107422741B (zh) 基于学习的保预设性能集群飞行分布式姿态追踪控制方法
CN104238357A (zh) 一种近空间飞行器的容错滑模控制方法
CN105404304A (zh) 基于归一化神经网络的航天器容错姿态协同跟踪控制方法
CN103853157A (zh) 一种基于自适应滑模的飞行器姿态控制方法
Chen et al. Study on fast terminal sliding mode control for a helicopter via quantum information technique and nonlinear fault observer
CN109507890A (zh) 一种基于eso的无人机动态逆广义预测控制器
CN110414125B (zh) 基于事件驱动的航天器交会故障诊断与滤波器设计方法
CN109062043A (zh) 考虑网络传输以及执行器饱和的航天器自抗扰控制方法
CN105116905A (zh) 一种飞行器姿态控制方法
Ma et al. Finite-time trajectory tracking control of quadrotor UAV via adaptive RBF neural network with lumped uncertainties
CN110109357A (zh) 针对非标准型非线性航空器的半全局自适应控制方法
Gao et al. Attitude tracking control of a quadrotor based on linear active disturbance rejective control
Shen et al. An improved chattering-free sliding mode control with finite time convergence for reentry vehicle
Li et al. Trajectory tracking control for quadrotor unmanned aerial vehicle with input delay and disturbances
CN114415734B (zh) 基于adp和避障机制的四旋翼无人机编队重构控制***
Hu et al. Quadrator QFT control based on model reduction method

Legal Events

Date Code Title Description
C06 Publication
PB01 Publication
C10 Entry into substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant